DSP主控之兩輪機器人平衡與兩輪同步控制

以作者查詢圖書館館藏

、以作者查詢臺灣博碩士

、以作者查詢全國書目

、勘誤回報

、線上人數：25

、訪客IP：3.149.252.207

姓名

蔡僑倫(Chiao-Lun Tsai) 查詢紙本館藏

畢業系所

電機工程學系

論文名稱

DSP主控之兩輪機器人平衡與兩輪同步控制
(DSP-based balance and two-wheel synchronous control for two-wheel robot)

相關論文

★ 直接甲醇燃料電池混合供電系統之控制研究	★ 利用折射率檢測法在水耕植物之水質檢測研究
★ DSP主控之模型車自動導控系統	★ 旋轉式倒單擺動作控制之再設計
★ 高速公路上下匝道燈號之模糊控制決策	★ 模糊集合之模糊度探討
★ 雙質量彈簧連結系統運動控制性能之再改良	★ 桌上曲棍球之影像視覺系統
★ 桌上曲棍球之機器人攻防控制	★ 模型直昇機姿態控制
★ 模糊控制系統的穩定性分析及設計	★ 門禁監控即時辨識系統
★ 桌上曲棍球：人與機械手對打	★ 麻將牌辨識系統
★ 相關誤差神經網路之應用於輻射量測植被和土壤含水量	★ 三節式機器人之站立控制

檔案

[Endnote RIS 格式]

[Bibtex 格式]

[相關文章]

[文章引用]

[完整記錄]

[館藏目錄]

[檢視]

[下載]

本電子論文使用權限為同意立即開放。
已達開放權限電子全文僅授權使用者為學術研究之目的，進行個人非營利性質之檢索、閱讀、列印。
請遵守中華民國著作權法之相關規定，切勿任意重製、散佈、改作、轉貼、播送，以免觸法。

摘要(中)

兩輪機器人系統是一個兩輪自我平衡的機器車，可遙控前進、後退、轉彎及定位，它主要是以DSP F2812來做整個控制的核心，包括：模糊控制演算法、馬達伺服控制、A/D Converter、類比濾波器、數位濾波器、無線傳輸模組…等。系統中使用車身動態感測器（傾斜器、陀螺儀）量測車身傾斜角度及角速度，利用類比低通濾波器及數位濾波器進行訊號處理，以準確的計算車身與地面傾斜的角度及角速度等資訊，再使用編碼器量測車子馬達轉動的速度及角速度。接著以模糊控制演算法，利用重心之調整來維持兩輪機器人車身的平衡。最後再利用無線數據機，從Client端發出決策命令至兩輪機器人的接收端，進行兩輪車機器人前進、後退、轉彎…等控制功能。

摘要(英)

Two-wheel robot system is a self-balance two-wheel robot car, we can control it self-balance, going forward and backward, making a turn and fixed position. DSP F2812 is the control center of the two-wheel-robot system, which includes fuzzy control algorithm, motor servo control, A/D converter, analog filter, digital filter, and wireless transmission module etc. In the system, the sensors tilt and gyro are used to measure inclination angle and angle velocity of the robot. Analog low-pass filter and digital filter process the above two signals to be usable. We use encoder to measure velocity and angle velocity of the motors of robot. Then the robot’s motions self-balance, going forward and backward, and making a turn are controlled by the designed fuzzy control algorithm in DSP. All control signals are transmitted via wireless transmission module.

關鍵字(中)

★ 平衡
★ 數位訊號處理
★ 模糊
★ 兩輪

關鍵字(英)

★ fuzzy
★ DSP
★ balance
★ two wheels

論文目次

目錄
頁次
摘要……………………………………………………………………………I
圖目錄…………………………………………………………………….…..V
表目錄………………………………………………………………………VII
第一章緒論…………………………………………………………………..1
1.1研究動機與目的……………………………………………………..1
1.2論文目標……………………………………………………………..2
1.3論文架構……………………………………………………………..2
第二章硬體架構……………………………………………………………..4
2.1直流伺服馬達、編碼器與馬達驅動器…….………………………. 5
2.1.1直流伺服馬達(含減速齒輪)...……………………………….5
2.1.2編碼器………………………………………………………...6
2.1.3.馬達驅動電路………………………………………………...6
2.2傾斜器、陀螺儀、濾波器電路…….………………………………...9
2.2.1傾斜器…………………………….…………………………..9
2.2.2陀螺儀………………………………………………………...9
2.2.3濾波器電路………………………………………………….10
2.3電池與電源轉換器…………………………………………………10
2.3.1電池………………………………………………………….10
2.3.2電源轉換器……………………..…………………………...11
2.4 DSP board……………..……………...…………………………….13
2.5 RS-232無線傳輸數據機與準系統………………………………...15
2.5.1 RS-232無線傳輸數據機………………………...………….15
2.5.2準系統……….………………………………………..……..16
第三章車身平衡與兩輪同步控制…………………..……………………..18
3.1車子動作描述 ……………………………………………………..18
3.2行動與決策 ……...………………………………………………...18
3.3訊號處理…………………….……………………………………...19
3.3.1電源上使用穩壓器……………………………...…………..20
3.3.2使用外部A/D converter……….…………………………….20
3.3.3加入類比濾波器……….…………………………………....20
3.3.4加入數位濾波器…………………………………………….21
3.3.5各司其職…………………………………………………….24
3.4車身平衡控制器 …………………………………………………..24
3.4.1控制器的輸入及輸出 ………………..…………………….25
3.4.2歸屬函數 ………………..………………………………….25
3.4.3模糊規則庫 ………………………………..……………….26
3.4.4模糊推論與解模糊化…………………………..……….…..27
3.5兩輪同步控制器……………………………………………………28
3.5.1控制器的輸入及輸出……………………………………….28
3.5.2歸屬函數………………………………………………….…29
3.5.3模糊規則庫……………………………………………….…30
3.5.4模糊推論與解模糊化…………………………………...…..30
第四章實驗結果分析與討論……..………………..………………………31
4.1實驗一：車身平衡控制……………………………………………31
4.2實驗二：兩輪同步控制……………………………………………32
4.3實驗三：外加干擾力測試…..………………………………………34
4.3.1加兩輪同步控制器………………………………………...34
4.3.2不加兩輪同步控制器……………..………..…………...35
4.4實驗四：Kalman filter測試…………………………………………37
4.5分析討論…………………………………………………………....38
第五章結論………………………………………………………………....39
5.1結論 ……………..…………………………………………………39
5.2困難處與解決方法………..………………………………………..39
5.3未來展望 ………………………..…………………………………40
參考文獻…………………..…………………………………………………42
附錄…………………………………………………………………………..45

參考文獻

[1] F. Grasser, A. D'Arrigo, S. Colombi and A.C. Rufer,“JOE: a mobile, inverted pendulum,’ IEEE Transactions on Industrial Electronics, Vol.39, No. 1, pp. 107-114, Feb. 2002.
[2] Y. Ha and S. Yuta,“Trajectory Tracking Control for Navigation of Self-Contained Mobile Inverse Pendulum,” IEEE/RSJ/GI Int. Conf. On Advanced Robotic Systems and the Real World', vol. 3, pp. 12-16, September 1994.
[3] Y. Takahashi, S. Ogawa and S. Machida,“Step climbing using power assist wheel chair robot with inverse pendulum control,”IEEE Int. Conf. on Robot. Automat., vol. 2, pp. 1360-1365, April 2000.
[4] O. Matsumoto, S. Kajita and K. Tani , “Estimation and control of the attitude of a dynamic mobile robot using internal sensors,”Advanced Robotics, Vol. 7, No. 2, pp. 159-178, 1993.
[5] A. Alessandri, G. Bartolini, P. Pavanati, E. Punta and A. Vina, “An Application of The Extented Kalman Filter for Integrated Navigation in Mobile Robotics,”Proceeding of the American Control Conference. Albuquerque New Mexico.June 1997.
[6] G. Welch and G. Bishop “An Introduction to the Kalman Filter” University of North Carolina at Chapel Hill Department of Computer Science Chapel Hill, NC 27599-3175. http://www.cs.unc.edu/~{welch, gb}
[7] O. Matsumoto, S. Kajita and K. Komoriya, “Flexible locomotion control of a self-contained biped leg-wheeled system,” IEEE Int. Conf. on Intelligent Robots and System, October 2002.
[8] Y. Takahashi, T. Takagaki, J. Kishi and Y. Ishii, “Back and forward moving scheme of front wheel raising for inverse pendulum control wheel chair robot,” IEEE Int. Conf. on Robotics and Automation, May 21-26, 2001.
[9] Y. Ota, K. Yoneda, T. Tamaki and S. Hirose, “A walking and wheeled hybrid locomotion with twin-frame structure robot,” IEEE Int. Conf. on Intelligent Robots and System, October 2002.
[10] A. J. Baerveldt and R. Klang. “A low-cost and low weight attitude estimation system for an autonomous helicopter”. IEEE International Conference on Intelligent Engineering Systems, Proceedings, pages 391–395, 1997.
[11] E. Foxlin, M. Harrington, and Y. Altshuler. “Miniature 6-DOF inertial system for tracking HMD”. In Proceedings of the SPIE, volume 3362, pages 214–228, 1998.
[12] M. Greene. “A solid state attitude heading reference system for general aviation”. In Proceedings.1996 IEEE Conference on Emerging Technologies and Factory Automation, volume 2, pages 413–17, 1996.
[13] T. Sakaguchi, K. Tsutomu, H. Katayose, K. Sato, and S. Inokuchi. “Human motion capture by integrating gyroscopes and accelerometers”. In Proceedings of the 1996 IEEE/SICE/RSJ International Conference on Multisensor Fusion and Integration for Intelligent Systems, pages 470–475, 1996.
[14] J. Borenstein and L. Feng “Gyrodometry: A new method for combining data from gyros and odometry in mobile robot ”. In Proceedings of the 1996 IEEE International Conference on Robotics and Automation, Minneapolis, Apr. 22-28, 1996, pp. 423-428.
[15] “TMS320C28x Optimizing C & C++ Compiler User's Guide” Texas Instruments, 2001.
[16] “TMS320C28x DSP CPU and Instruction Set Reference Guide” Texas Instruments, 2002.
[17] “TMS320F28x Analog to Digital Converter (ADC) Reference Guide” Texas Instruments, 2003.
[18] “TMS320F28x Boot ROM Reference Guide” Texas Instruments, 2003.
[19] “TMS320F28x Control and Interrupts Reference Guide” Texas Instruments, 2003.
[20] “TMS320F28x Event Manager (EV) Reference Guide” Texas Instruments, 2003.
[21] “TMS320F28x External Interface (XINTF) Reference Guide” Texas Instruments, 2003.
[22] “TMS320F28x Peripherals Reference Guide” Texas Instruments, 2003.
[23] “TMS320F28x Serial Communications Interface (SCI) Reference Guide” Texas Instruments, 2003.
[24] “TMS320F28x Serial Peripheral Interface (SPI) Reference Guide” Texas Instruments, 2003.
[25] 王文俊, “認識Fuzzy”, 全華科技圖書股份有限公司, 2001年.
[26] 鄭鈞元,“兩輪自我平衡機器人之平衡控制”, 國立中央大學電機所碩士論文, 2003年六月, (王文俊指導).
[27] 王禎祥,“兩輪自我平衡機器人之前後行走控制”, 國立中央大學電機所碩士論文, 2003年六月, (王文俊指導).
[28] 王培霖, “DSP主控之兩輪機器人之行動控制”, 國立中央大學電機所碩士論文, 2004年六月, (王文俊指導).
[29] Segway之網站http://www.segway.com/
[30] Nbot 之網站http://geology.heroy.smu.edu/~dpa-www/robo/nbot/
[31] Gyrobot之網站http://www.barello.net/Robots/Gyrobot/

指導教授

王文俊(Wen-June Wang)

審核日期

2004-7-9

推文