| 研究生: |
洪聆剛 Hong, Ling-Gang |
|---|---|
| 論文名稱: |
兩輪倒單擺機器人之平衡控制 Balance Control of a Two-Wheeled Inverted Pendulum Mobile Robot |
| 指導教授: |
何明字
Ho, Ming-Tzu |
| 學位類別: |
碩士 Master |
| 系所名稱: |
工學院 - 工程科學系 Department of Engineering Science |
| 論文出版年: | 2010 |
| 畢業學年度: | 98 |
| 語文別: | 中文 |
| 論文頁數: | 103 |
| 中文關鍵詞: | 倒單擺 、互補濾波器 、加速規 |
| 外文關鍵詞: | inverted pendulum, complementary filter, accelerometer |
| 相關次數: | 點閱:118 下載:4 |
| 分享至: |
| 查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報 |
兩輪倒單擺機器人是一種特殊的輪式機器人,由於馬達裝置在兩側,所以具機動性強及體積小之優點。本論文旨在推導兩輪倒單擺機器人之動態數學模型,針對此模型利用LQR控制法則設計平衡控制器。在兩輪倒單擺機器人的姿態角度估測方面,則使用加速規和陀螺儀配合互補濾波器得到較佳的傾角訊號。控制器的實現是以數位信號處理器(digital signal processor, DSP)為基礎,使用德州儀器公司所生產之定點式數位信號處理器,型號為TMS320F2812。實作方面以C語言來實現所有控制演算法,透過DSP控制板來提供系統控制力的運算及輸出,再搭配PWM驅動電路驅動直流馬達帶動兩輪平衡機器人達到平衡控制的目的。由模擬與實驗結果顯示,所完成之控制系統可達到平衡控制之目的。
The two-wheeled inverted pendulum mobile robot is a special type of wheeled robots. It has advantage of good mobility and small size because it has only two motors placed on both side. In this study, the dynamic model of the two-wheeled inverted pendulum robot is derived. In controll design, the LQR control law is used in the balance control of this system. In order to obtain an optimal estimation of the tilt angle, the complementary filter is used for data fusion with the angular measurements obtained from a rate gyroscope sensor and an accelerometer. The implementation of the controller is based on a digital signal processor (TMS320F2812) produced by Texas Instruments. In the experiment, the control law is implemented on the digital signal processor using C language. DC motors are driven by a PWM driver board. The simulation and experimental results are provided to show the effectiveness of the control system.
[1]Segway 網站http://www.segway.com/
[2]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.
[3]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.
[4]洪介仁,「車與桿倒單擺系統之平衡控制」,國立成功大學工程科學系碩士論文,民國九十二年七月。
[5]詹富強,「以數位信號處理器為基礎單板獨立旋轉型倒單擺甩上與平衡控制系統之實現」,國立成功大學工程科學系碩士論文,民國九十三年七月。
[6]楊志偉,「以視覺伺服為基礎之倒單擺系統平衡控制」,國立成功大學工程科學系碩士論文,民國九十四年七月。
[7]呂育勝,「利用順滑模態之球與弧系統的平衡控制」,國立成功大學工程科學系碩士論文,民國九十七年。
[8]翁義清,「全向移動機器人之路徑追蹤控制」,國立成功大學工程科學系碩士論文,民國九十七年。
[9]DC motor 7E4060B-20Y datasheet, SOHO PRECISION MACHINERY Inc, 2003.
[10]Z. Yu and R. Choe, “Development & Verification of a Low-Cost IMU for Vehicle Attitude Determination” Aerospace Technology Seminar Singapore, March 2007.
[11]R. G. Brown and P. Y. C. Hwang, Introduction to Random Signals and Applied Kalman Filtering, pp. 192~197, John Wiley & Sons, New York, March 1992
[12]R. P. G. Collinson, Introduction to Avionics System, pp. 277~280, Kluwer Academic Publishers, Boston, 2003.
[13]S. Merhav, Aerospace Sensor System and Applications, pp. 396~407, Springer-Verlag, New York, 1996.