簡易檢索 / 詳目顯示

研究生: 廖柏翔
Liao, Po-Hsiang
論文名稱: 以陀螺效應平衡單輪機器人之控制
Control of the Gyroscopically Balanced Unicycle Robot
指導教授: 何明字
Ho, Ming-Tzu
學位類別: 碩士
Master
系所名稱: 工學院 - 工程科學系
Department of Engineering Science
論文出版年: 2020
畢業學年度: 108
語文別: 中文
論文頁數: 201
中文關鍵詞: 控制力矩陀螺儀單輪機器人
外文關鍵詞: control moment gyroscope, unicycle robot
相關次數: 點閱:129下載:0
分享至:
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報
  • 本論文旨在研究以控制力矩陀螺儀為致動器之單輪機器人系統,目的為改善以反應輪為致動器時所提供側向平衡力矩不足而造成系統強健性不彰的問題,因控制力矩陀螺儀擁有較小的體積卻可產生較大的力矩。論文中先以Euler-Lagrange的方法建立數學動態模型,再將系統模型線性化後,使用MATLAB設計平衡控制器,再於Simulink中建構控制系統模型進行模擬,評估控制系統的強健性及可行性。在實作的部分,本論文以光學編碼器量測車輪及陀螺翻轉角度,以加速規、陀螺儀及電子羅盤等慣性量測單元(inertial measurement units)來偵測系統姿態,再利用室內定位模組來取得系統之即時位置資訊,最後以STM32F407開發板為核心並使用C語言撰寫控制器,進而達成以控制力矩陀螺儀之單輪機器人平衡控制;而本論文亦設計路徑追隨控制器,並以模擬探討路徑追隨之可行性及相關問題。

    The objective of this thesis is to design and implement a unicycle robot that is stabilized by two control moment gyroscopes. The control moment gyroscopes can generate more lateral balancing torque with a compact size rather than using a reaction wheel, which would lead to weaker robustness. In this thesis, the Euler-Lagrange method is used to derive the dynamic model of the system. Then, based on the linearized system model, MATLAB is used to design the stabilizing controller, and the simulation is conducted through Simulink to verify robustness and feasibility. In the experiments, an inertial measurement unit and encoders are used as the posture sensors. An indoor GPS module is used to obtain the position of the robot. An STM32F407 microcontroller board is used to implement the control law. It is shown experimentally that the designed control system stabilizes the robot at its upright position. Furthermore, this thesis also presents the design, simulation, and experimental studies of trajectory tracking control.

    摘要 I Extended Abstract II 致謝 VII 目錄 VIII 圖目錄 XI 表目錄 XIX 第一章 緒論 1-1 研究背景與動機 1-1 1-2 研究目的 1-1 1-3 研究步驟 1-4 1-4 相關文獻回顧 1-5 1-5 本實驗室相關研究 1-9 1-6 論文結構 1-9 第二章 雙陀螺制動平衡之單輪車數學模型推導 2-1 前言 2-1 2-2 控制力矩陀螺儀致動平衡單輪車之數學模型 2-2 第三章 平衡控制器設計與模擬結果 3-1 前言 3-1 3-2 控制力矩陀螺儀致動單輪車姿態控制器設計 3-1 3-3 控制系統模擬 3-14 3-4 系統強健性測試模擬 3-24 3-4-1 自轉軸加入摩擦力 3-24 3-4-2 陀螺轉速差異 3-30 3-4-3 外部敲擊干擾測試模擬 3-35 3-4-4 直線前行 3-45 第四章 路徑追隨控制法則及模擬結果 4-1 前言 4-1 4-2 輪型機器人系統的位置調節控制 4-1 4-3 單輪機器人之路徑追隨控制器設計 4-5 4-4 單輪機器人路徑追隨控制器的模擬結果 4-8 第五章 系統機構設計與製作 5-1 前言 5-1 5-2 單輪機器人系統機構設計與製作 5-2 第六章 外部硬體電路與控制架構介紹 6-1 前言 6-1 6-2 STM32F407VG-DISC1微處理器 6-2 6-2-1 STM32F4定時器 6-3 6-3 電源配置 6-4 6-4 直流有刷馬達驅動器 6-4 6-5 直流無刷馬達驅動器 6-6 6-6 光學編碼器 6-6 6-7 IMU姿態感測器 6-7 6-7-1 IMU姿態感測器通訊 6-8 6-7-2 IMU姿態感測器校正 6-8 6-8 室內定位模組 6-23 6-9 Arduino Leonardo開發板6-25 6-10 控制系統架構 6-26 第七章 單輪機器人系統實驗結果 7-1 前言 7-1 7-2 單輪機器人原地平衡及抗干擾實驗 7-1 7-3 單輪機器人直線前行實驗 7-8 7-4 路徑追隨實驗 7-16 第八章 結論與未來展望 8-1 結論 8-1 8-2 未來展望 8-1 參考文獻 Ref-1 附錄A A-1 附錄B B-1

    [1] N. Tlale and M. de Villiers, “Kinematics and Dynamics Modeling of a Mecanum Wheeled Mobile Platform,” Proceedings of 15th International Conference on Mechatronics and Machine Vision in Practice, pp. 657-662, Dec. 2008.
    [2] 陳奕隆,「單輪車系統平衡控制之設計與實現」,國立成功大學工程科學系碩士論文,民國九十九年七月。
    [3] 柯俊廷,「單輪車機器人之路徑追隨控制」,國立成功大學工程科學系碩士論文,民國一○二年六月。
    [4] 王俊諺,「利用二階順滑模態控制之單輪機器人平衡與路徑追隨」,國立成功大學工程科學系碩士論文,民國一○五年六月。
    [5] 楊文皓,「單輪機器人之穩定與路徑追隨控制」,國立成功大學工程科學系碩士論文,民國一○八年七月。
    [6] 黃建琛,「控制力矩陀螺致動倒單擺系統之平衡控制」,國立成功大學工程科學系碩士論文,民國一○三年七月。
    [7] 陳之凱,「控制力矩陀螺致動之二維倒單擺系統平衡控制」,國立成功大學工程科學系碩士論文,民國一○五年七月。
    [8] 楊景文,控制力矩陀螺儀致動倒單擺系統之平衡暨自轉控制,國立成功大學工程科學系碩士論文,民國一○八年七月。
    [9] D.V. Zenkov, A. M. Bloch, and J. E. Marsden, “The Lyapunov-Malkin Theorem and Stabilization of the Unicycle with Rider,” Systems and Control Letters, Vol. 45, No. 4, pp. 293-302, Apr. 2002.
    [10] Y. Yavin, “Inclination Control of the Motion of a Rolling Disk by Using a Rotor,” Computer Methods in Applied Mechanics and Engineering, Vol. 146, No. 3-4, pp. 253-263, Jul. 1997.
    [11] Y. Yavin, “Stabilization and Control of the Motion of a Rolling Disk by Using two Rotors Fixed along its Axis,” Computer Methods in Applied Mechanics and Engineering, Vol. 169, No. 1-2, pp. 107-122, Jan. 1999.
    [12] P. D. Kemp and Y. Yavin, “Stabilization and Control of the Motion of a Rolling Disk by Using two Overhead Rotors,” Computers & Mathematics with Applications, Vol. 39, No. 7-8, pp. 237-252, Apr. 2000.
    [13] S. Han and J. Lee, “Decoupled Dynamic Control for Pitch and Roll Axes of the Unicycle Robot,” IEEE Transactions on Industrial Electronics, Vol. 60, No. 9, pp. 3814-3822, Sep. 2013.
    [14] The Brennan Gyro-Monorail 單軌列車介紹網站網址 http://www.douglas-self.com/MUSEUM/LOCOLOCO/brennan/brennan.htm
    [15] LIT MOTORS網站 http://litmotors.com/c1
    [16] H. Jin, T. Wang, F. Yu, Y. Zhu, J. Zhao, and J. Lee, “Unicycle Robot Stabilized by the Effect of Gyroscopic Precession and Its Control Realization Based on Centrifugal Force Compensation,” IEEE Transactions on Mechatronics, Vol. 21, No. 6, pp. 2737-2745, Dec. 2016.
    [17] S. Chantarachit and M. Parnichkun, “Development and Control of a Unicycle Robot with Double Flywheels,’’ Mechatronics, Vol. 40, pp. 28-40, Oct. 2016.
    [18] S. Chantarachit, “Design and Simulate of LQR-Fuzzy Controller for Unicycle Robot with Double Flywheels,’’ Matec Web of Conferences, Vol. 192, No. 02001, Jan. 2018.
    [19] R. C. Hibbeler, Engineering Mechanics Dynamics, Prentice Hall, Upper Saddle River, NJ, 2009.
    [20] 劉士源,「以回授線性化與順滑模態控制之球與球系統的平衡控制」,國立成功大學工程科學系碩士論文,民國九十八年七月。
    [21] K. M. Lynch and F. C. Park, Modern Robotics: Mechanics, Planning, and Control, Cambridge University Press, New York, 2017.
    [22] H. K. Khalil, Nonlinear Systems, Prentice-Hall, Englewood Cliffs, NJ, 2014.
    [23] maxon motor網站 http://www.maxonmotor.com.tw/
    [24] 意法半導體官方網站 https://www.st.com/en/microcontrollersmicroprocessors/stm32f407-417.html
    [25] 黃彥翔,「姿態航向參考系統研發與雙足機器人之步態規劃」,國立成功大學工程科學系碩士論文,民國一○三年七月。
    [26] O. Talat, Calibrating an eCompass in the Presence of Hard and Soft-iron Interference, Freescale Semiconductor Ltd., 2012.
    [27] Marvelmind robotics官方網站 https://marvelmind.com/
    [28] Arduino官方網站 https://www.arduino.cc/en/Main/Arduino_BoardLeonardo
    [29] M. Q. Dao and K. Z. Liu, “Gain-Scheduled Stabilization Control of a Unicycle Robot,” JSME International Journal, Vol. 48, No. 4, pp. 469-656, Jan. 2005.

    下載圖示 校內:2025-07-28公開
    校外:2025-07-28公開
    QR CODE