跳到主要內容

簡易檢索 / 詳目顯示

研究生: 陳子蔚
Tzu-Wei Chen
論文名稱: 球上平衡機器人
The Balancing of Ballbot
指導教授: 羅吉昌
Ji-Chang Lo
口試委員:
學位類別: 碩士
Master
系所名稱: 工學院 - 機械工程學系
Department of Mechanical Engineering
論文出版年: 2020
畢業學年度: 108
語文別: 中文
論文頁數: 90
中文關鍵詞: 球上平衡機器人平衡Arduino慣性量測單元麥克納姆輪
外文關鍵詞: Ballbot, Balance, Arduino, IMU, Mecanum wheel
相關次數: 點閱:3下載:0
分享至:
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報
  • 球上平衡機器人,顧名思義,是將機器人平衡在球上。機構上以微控制器Arduino 做為系統的主控板,搭配上慣性量測單元IMU和四顆直流馬達組合成機器人。IMU 使用的是六軸感測器模組GY521,經由三軸加速度計和三軸陀螺儀計所獲得的資訊計算出二維空間的翻滾角和俯仰角,並運用馬達驅動板L298N 控制各個直流馬達。根據與水平面形成的角度差,做為系統的輸入,使用PID 控制做運算,得到相對應的輸出量,使用脈衝寬度調變技術PWM,透過逆向運動學(Inverse kinematics)計算出各個馬達所需要的控制量,輸入至各個馬達中,控制麥克納姆輪的轉速。同時,依照翻滾角和俯仰角的正負值,決定馬達的旋轉方向,使該機器人平衡在球上。


    Ballbot, the robot balancing on a ball. Mechanically, it is a robot consisting of microcontroller Arduino being the main control board of the system which has the Inertial Measurement Unit (IMU) and four DC motors.The IMU is a six-axis sensor GY521,through the accelerometer and gyroscope to calculate the roll and pitch angles. With that feedback signals,the motor driver board L298N uses them to control DC motors.Through inverse kinematics, the PID control is to calculate the required control amount and is realized by Pulse Width Modulation (PWM) that are fed into each motor, to control the rotation speed of the Mecanum wheels.Simultaneously, the roll angle and the pitch angle are used to determine the rotation direction of the motor, so that the robot is balanced on the ball.

    誌謝 vii 目錄 viii 一、緒論 1 1.1 背景介紹....................... 1 1.2 研究動機....................... 2 1.3 文獻回顧....................... 3 1.4 論文架構....................... 5 二、系統架構及元件介紹 7 2.1 系統架構....................... 7 2.2 硬體元件....................... 9 三、機構設計 15 3.1 設計概念...................... 15 3.2 零件繪製...................... 16 3.2.1 各零件圖檔.................. 17 3.3 層架設計...................... 20 3.3.1 第一層...................... 21 3.3.2 第二層...................... 22 3.3.3 第三層...................... 22 3.4 完整機構...................... 23 四、姿態運算 28 4.1 簡介.......................... 28 4.2 前置作業....................... 29 4.3 校正數據....................... 33 4.4 合成姿態角..................... 35 4.4.1 加速度計..................... 37 4.4.2 陀螺儀....................... 37 4.4.3 互補濾波..................... 38 五、運動學分析 40 5.1 模型描述....................... 40 5.2 假設........................... 42 5.3 轉矩轉換........................ 43 5.4 差異........................... 47 5.5 逆向運動學...................... 50 5.6 正向運動學...................... 50 六、控制方法 53 6.1 L298N 控制..................... 53 6.1.1 PWM ......................... 54 6.2 PID 控制....................... 56 6.2.1 角度控制...................... 58 6.2.2 速度控制...................... 59 6.3 旋轉編碼器...................... 61 6.3.1 編碼器的分辨率................. 63 6.3.2 中斷服務...................... 65 6.4 馬達轉向控制..................... 67 七、結論與未來展望 70 7.1 結論............................ 70 7.2 未來展望........................ 71 參考文獻 72

    1. Hollis, R. DynamicallyStable
    Mobile Robots in Human Environments Projects
    Microdynamic
    Systems Laboratory http://www.msl.ri.cmu.edu/projects/
    ballbot/.
    2. Hollis, R. Ballbots Scientific American. Library Catalog: www.scientificamerican.com.
    https://www.scientificamerican.com/article/ballbots/.
    3. Lauwers, T., Kantor, G. & Hollis, R. A dynamically stable singlewheeled
    mobile
    robot with inverse mouseball
    drive in Proceedings 2006 IEEE International Conference
    on Robotics and Automation, 2006. ICRA 2006. Proceedings 2006 IEEE
    International Conference on Robotics and Automation, 2006. ICRA 2006. ISSN:
    10504729
    (May 2006), 2884–2889.
    4. Nagarajan, U., Kantor, G. & Hollis, R. L. Trajectory planning and control of an
    underactuated dynamically stable single spherical wheeled mobile robot in 2009
    IEEE International Conference on Robotics and Automation 2009 IEEE International
    Conference on Robotics and Automation. ISSN: 10504729
    (May 2009),
    3743–3748.
    5. Nagarajan, U., Mampetta, A., Kantor, G. A. & Hollis, R. L. State transition, balancing,
    station keeping, and yaw control for a dynamically stable single spherical
    wheel mobile robot in 2009 IEEE International Conference on Robotics and Automation
    2009 IEEE International Conference on Robotics and Automation. ISSN:
    10504729
    (May 2009), 998–1003.
    6. Nagarajan, U., Kantor, G. & Hollis, R. L. Humanrobot
    physical interaction with dynamically
    stable mobile robots in Proceedings of the 4th ACM/IEEE international
    conference on Human robot interaction (Association for Computing Machinery, La
    Jolla, California, USA, Mar. 9, 2009), 281–282. ISBN: 9781605584041.
    https:
    //doi.org/10.1145/1514095.1514176.
    7. Matsuoka, Y., DurrantWhyte,
    H. & Neira, J. Robotics: Science and Systems
    VI GoogleBooksID:
    q9TxCwAAQBAJ. 341 pp. ISBN: 9780262298063
    (MIT
    Press, Aug. 5, 2011).
    8. Nagarajan, U., Kantor, G. & Hollis, R. Integrated planning and control for graceful
    navigation of shapeaccelerated
    underactuated balancing mobile robots in 2012
    IEEE International Conference on Robotics and Automation 2012 IEEE International
    Conference on Robotics and Automation. ISSN: 10504729
    (May 2012),
    136–141.
    9. Kumagai, M. & Ochiai, T. Development of a Robot Balanced on a Ball –First
    Report, Implementation of the Robot and Basic Control –. Journal of Robotics
    and Mechatronics 22. Publisher: Fuji Technology Press Ltd., 348–355. https :
    //www.fujipress.jp/jrm/rb/robot002200030348/ (June 20, 2010).
    10. Guizzo, E. A Robot That Balances on a Ball IEEE
    Spectrum IEEE Spectrum:
    Technology, Engineering, and Science News. Library Catalog: spectrum.ieee.org.
    https : / / spectrum . ieee . org / automaton / robotics / robotics - software /
    042910-a-robot-that-balances-on-a-ball.
    11. Waibel, M. Project Rezero: Ball Balancing Robot With Style IEEE
    Spectrum
    IEEE Spectrum: Technology, Engineering, and Science News. Library Catalog:
    spectrum.ieee.org. https://spectrum.ieee.org/automaton/robotics/diy/
    project-rezero-ball-balancing-elegance.
    12. Jespersen, T. K. mindThomas/KugleMATLAB
    GitHub. Library Catalog: github.com.
    https://github.com/mindThomas/Kugle-MATLAB.
    13. MagicJackTing. I2C bus 簡介(InterIntegrated
    Circuit Bus) @ 傑克! 真是太神奇
    了! :: 痞客邦:: https://magicjackting.pixnet.net/blog/post/173061691-
    i2c-bus-%E7%B0%A1%E4%BB%8B-(inter-integrated-circuit-bus).
    14. Kumagai, M. & Ochiai, T. Development of a robot balancing on a ball in 2008
    International Conference on Control, Automation and Systems 2008 International
    Conference on Control, Automation and Systems (Oct. 2008), 433–438.
    15. Lee, H. & Lee, J. Optimal Control of an Inverted BallDriving
    Robot Based upon
    Slip Patterns. International Journal of Humanoid Robotics 15. Publisher: World
    Scientific Publishing Co., 1850007. ISSN: 02198436.
    https://www.worldscientific.
    com/doi/abs/10.1142/S021984361850007X (Mar. 13, 2018).
    16. Wang, D. Arduino 教程:MPU6050 的數據獲取、分析與處理知乎專欄. Library
    Catalog: zhuanlan.zhihu.com. https://zhuanlan.zhihu.com/p/20082486.
    17. Dejan. Arduino and MPU6050 Accelerometer and Gyroscope Tutorial HowToMechatronics.
    Library Catalog: howtomechatronics.com Section: Arduino Tutorials. https:
    //howtomechatronics.com/tutorials/arduino/arduino-and-mpu6050-accelerometerand-
    gyroscope-tutorial/.
    18. 對折之內. 加速度計和陀螺儀融合得到精確角度Arduino
    中文社區Powered
    by
    Discuz! https://www.arduino.cn/forum.php?mod=viewthread&tid=18392&
    page=1.
    19. Debra. Gyroscopes and Accelerometers on a Chip Geek Mom Projects. Library
    Catalog: www.geekmomprojects.com. http://www.geekmomprojects.com/gyroscopesand-
    accelerometers-on-a-chip/.
    20. Fankhauser, P. & Gwerder, C. Modeling and Control of a Ballbot. Medium: application/
    pdf,OnlineRessource
    Publisher: ETH Zurich. http://hdl.handle.net/
    20.500.11850/154271 (2010).
    21. Kumagai, M. Development of a ball drive unit using partially sliding rollers —An
    alternative mechanism for semiomnidirectional
    motion — in 2010 IEEE/RSJ International
    Conference on Intelligent Robots and Systems 2010 IEEE/RSJ International
    Conference on Intelligent Robots and Systems. ISSN: 21530866
    (Oct.
    2010), 3352–3357.
    22. Barr, M. BEGINNER’S CORNER Pulse Width Modulation, 09/2001, 2.
    23. Kocur, M., Kozak, S. & Dvorscak, B. Design and Implementation of FPGA digital
    based PID controller in Proceedings of the 2014 15th International Carpathian
    Control Conference (ICCC) Proceedings of the 2014 15th International Carpathian
    Control Conference (ICCC) (May 2014), 233–236.
    24. Dejan. How Rotary Encoder Works and How To Use It with Arduino HowToMechatronics.
    Library Catalog: howtomechatronics.com Section: Arduino Tutorials. https:
    //howtomechatronics.com/tutorials/arduino/rotary-encoder-works-usearduino/.
    25. Smoot, R. What's the Difference Between an Incremental Encoder's PPR,
    CPR, and LPR? CUI Devices. Library Catalog: www.cuidevices.com. https://
    www.cuidevices.com/blog/what-is-encoder-ppr-cpr-and-lpr.

    QR CODE
    :::