研究生: |
洪祥富 Siang-Fu Hong |
---|---|
論文名稱: |
雙輪倒單擺車設計與穩定控制 Two Wheeled Inverted Pendulum Vehicle Design and Stable Control |
指導教授: |
黃緒哲
Shiuh-Jer Huang |
口試委員: |
林紀穎
Chi-Ying Lin 周瑞仁 Jui-Jen Chou |
學位類別: |
碩士 Master |
系所名稱: |
工程學院 - 機械工程系 Department of Mechanical Engineering |
論文出版年: | 2013 |
畢業學年度: | 101 |
語文別: | 中文 |
論文頁數: | 102 |
中文關鍵詞: | FSMC 、兩輪式倒單擺 、AVR-ATmega328 、陀螺儀 |
外文關鍵詞: | FSMC, Two-Wheeled Inverted Pendulum, AVR-ATmega328, Gyroscope |
相關次數: | 點閱:318 下載:12 |
分享至: |
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報 |
本論文主要是設計一台雙輪倒單擺車,使用AVR晶片ATmega328做為控制核心以及直流輪轂馬達做為驅動動力源。透過陀螺儀與加速度計回授車體傾斜角與傾斜角速度,使用旋轉編碼器量測輪轂馬達轉速與行程,並採用靴帶電路設計H橋驅動器驅動輪轂馬達。此雙輪倒單擺車具有手把機構,透過一電位計傳送手把左右擺動之資訊使馬達產生差速,達到車體轉向之功能
控制器部分採用不需要模型且具有高強健性的模糊滑動控制器(FSMC),以及比例-微分(PD)控制器。並於傾斜角度、傾斜角速度回授加入灰色預測模型,預測未來狀態。經實驗結果證明,使用灰色預測模型能使系統抑制高頻振盪的幅度,搭配PD控制器或FSMC控制器成功使系統得到穩定的平衡控制。
A two-wheeled inverted pendulum (TWIP) vehicle system is constructed. The control kernel is a microcontroller-ATmega328. The DC hub motor is employed for motion actuating and balancing. Both accelerometer and gyroscope sensors are used to measure the tilt angle and angular velocity of the inverted pendulum, respectively and two encoders are used to measure the rotation speed of motors. The H-bridge driver combined with bootstrap circuit is designed to drive the DC hub motor. The motion direction of TWIP can let change based on the signal of a handle bar on TWIP.
Since the accurate dynamic model of this TWIP vehicle is difficult to establish, the model-free and robust fuzzy sliding model controller (FSMC) and proportional-derivative (PD) controller are chosen for controlling this system. Gray prediction model (GPM) is employed to predict the future state of the tilt angle and angular velocity. The experiment of results show that the GPM could improve the high frequency vibration situation and the FSMC and PD controller can successfully control the TWIP system motion stability .
【1】 S.Mori,H. Nishihara, and K. Furuta, “Control of unstable mechanical system control of pendulum,” Int. J. Control, Vol. 23. No.5, pp. 673-692, 1976.
【2】 K. Yamafuji, and T. Kawamura, “Postural control a monoaxial bicycle,” Journal of the Robotics Society of Japan, Vol.1 No.4 pp.74-79, 1988.
【3】 T. Yamakawa, “Stabilization of an inverted pendulum by a high speed fuzzy logic controller hardware system,” Fuzzy Sets and Systems , Vol. 32 , pp. 161-180,1989.
【4】 C. E. Lin, and Y. R. Sheu, “A Hybrid-Control Approach for pendulum Car control,” IEEE Transactions on Industrial Electronics, Vol. 39, No.3, pp. 208-214, 1992.
【5】 Y. Ha, and S. Yuta, “ Trajectory Tracking Control for Navigation of Self-Contained Mobile Inverse Pendulum,” IEEE/RSJ/GJ Int. Conf Advanced Robotic Systems and the Real World, Munich, Germany, Vol. 3, pp. 12-16, September 1994.
【6】 S. J. Huang, and C. L. Huang, “Control of an Inverted Pendulum Using Grey Prediction Model,” IEEE Transactions on Industry Applications, Vol. 36, NO.2, pp. 452-458, 2000.
【7】 R.J. Wai, and L.J. Chang, “Adaptive Stabilizing and Tracking Control for a Nonlinear Inverted-Pendulum System via Sliding-Mode Technique,” IEEE Transactions on Industrial Electronics, Vol. 53, NO.2, April 2006.
【8】 X.H. Yang, H.S. Liu, G.P. Liu, and G.F. Xiao, “Control Experiment of the Inverted Pendulum Using Adaptive Neural-Fuzzy Controller,” International Conference on Electrical and Control Engineering, Wuhan, China, pp.629-632, 2010.
【9】 W. Li, H, Ding, and K, Cheng, “An Investingation on the Design and Performance Assessment of double-PID and LQR Controllers for the Inverted pendulum,” UKACC International Conference on Control, Cardiff, United Kingdom, pp.190-196, September 2012.
【10】 Segway Inc, “Segway Inc.'s Human Transporter (HT) models,” Retrieved July 2, 2013, from https://www.msu.edu/~luckie/segway/
iBOT/iBOT.html
【11】 Segway of West Texas, “i2 Models,” Retrieved July 2, 2013, from http://www.segwaytexaswest.com/i2%20Models.htm
【12】 T. B. Lauwers, G. A. Kantor, and R. L. Hollis, “A Dynamically Stable Single-Wheeled Mobile Robot with Inverse Mouse-Ball Drive,” IEEE International Conference on Robotics and Automation, Orlando, United States, May 2006.
【13】 M. Kumagai, and T. Ochiai, “A Study on Transpotation using Robots Balanced on Balls,” 計測自動制御学会東北支部第247回研究集会, Miyagi, Japan, NO.3, Dec 2008.
【14】 Lotpro, “You Meet the Nicest People on a Honda Unicycle,” Retrieved July 2, 2013, from http://www.lotpro.com/blog/2009/09/24/
you-meet-the-nicest-people-on-a-honda-unicycle/
【15】 台灣歐姆龍工業自動化, “E6C2-C-旋轉編碼器,” Retrieved July 2, 2013, from http://www.omron.com.tw/product_detail_data.asp?
ID=520&CLASS_ID=200&LEVEL=2&CLASS_LEVEL=2&Menu=1
【16】 SparkFun Electronics, “Triple Axis Accelerometer Breakout - MMA7361,” Retrieved July 2, 2013, from https://www.sparkfun.com/
products/9652
【17】 SparkFun Electronics, “Gyro Breakout Board - LPY503AL Dual 30°/s,” Retrieved July 2, 2013, from https://www.sparkfun.com/products/11341
【18】 SparkFun Electronics, “XBee 1mW Wire Antenna - Series 1 (802.15.4),” Retrieved July 2, 2013, from https://www.sparkfun.com/products/8665
【19】 B2BFOO, “Electric Bicycle Wheel Hub Motor,” Retrieved July 2, 2013, from http://shengp1985.en.b2bfoo.com/products/226646/
Electric-Bicycle-Wheel-Hub-Motor.html
【20】 The Custom Geek , Retrieved July 2, 2013, from http://thecustomgeek.com/wp-content/uploads/2012/09/328sm.jpeg
【21】 普特企業有限公司-飆機器人, “Arduino Nano-328微處理器,” Retrieved July 2, 2013, from http://www.playrobot.com/cart/
mycart.php?cheak=y
【22】 Science Prog, “USB bootloaders for AVR microcontrollers,” Retrieved July 2, 2013, from http://www.scienceprog.com/
usb-bootloaders-for-avr-microcontrollers/ . July 2,2013.
【23】 Atmel Corporation, “ATMEGA328P datasheet,” Figure 15-1, October 2009.
【24】 International Rectifier, “IR2104-DataSheet,” No. PD60046-S,p1,2004.
【25】 International Rectifier, “Design Tip 98-02,” figure 1,2001.
【26】 黃安橋教授,“非線性系統上課講義, ”國立台灣科技大學機械工程研究所.
【27】 J.J. Gonzalez, and G. R. Widmann, “Force commanded impedance control scheme for robots with hard nonlinearities,” IEEE Transactions on Control System Technology, Vol. 3, No.4, pp. 398-408, 1995.
【28】 R. J. Anderson, and M. W. Spong, “Jybrid impedance control of robotic manipulators,” IEEE Transactions on Robotics and Automation, Vol. 4, No.5, pp. 549-556, 1988.
【29】 G. Ferretti, Magnani, and P. Rocco, “Toward the Implementation of Hybrid Position﹙Force Control in Industrial Robots,” IEEE Transactions on Robotics and Automation, Vol. 13, No.6, December 1997.
【30】 G. Ferretti, G. A. Magnani, and P. Rocco, “Impedance control for elastic joints industrial manipulators,” IEEE Transactions on Robotics and Automation, Vol. 20, NO.3, pp.488-498, 2004.
【31】 游喬焜, “以系統晶片結合力量感測器發展具有力量控制功能之機械手臂,” 碩士論文,國立台灣科技大學機械工程研究所,2009.
【32】 R.R. Yager, and D.P. Filev, “Essentials of fuzzy modeling and control,” John Wiley and Sons, New York, 1994.
【33】 S.Y. Yi, and M.J. Chung, “Robustness of Fuzzy Logic Control for an Uncertain Dynamic System,” IEEE Transactions on Fuzzy Systems, Vol.6, No.2, pp. 216-225, May 1998.
【34】 巫憲欣, “以系統晶片發展具機器視覺之機械手臂運動控制,” 碩士論文, 國立台灣柯計大學機械工程系, 2006.
【35】 黃國希, “雙層振動系統之控制,” 碩士論文, 國立台灣科技大學機械工程系, 1999.
【36】 林威成, “主動式車輛懸吊系統之控制器設計,” 碩士論文, 國立台灣技技大學機械工程系, 2000.
【37】 謝欣瑋, “氣壓平台之運動控制,” 碩士論文, 國立台灣技技大學機械工程系, 2000.
【38】 蔡金波, “機器人於自動化組裝之應用,” 碩士論文, 國立台灣技技大學機械工程系, 2003.
【39】 蘇明田, “光碟機控制器之設計應用,” 碩士論文, 國立台灣技技大學機械工程系, 2004.
【40】 王振權, “單向加熱器溫度系統之控制器設計,” 碩士論文, 國立台灣技技大學機械工程系, 2005.
【41】 王世賢, “長行程奈米定位系統之控制器設計,” 碩士論文, 國立台灣技技大學機械工程系, 2005.
【42】 林淑怡, “X-Y 精密定位平台於彩色濾光片影像對位控制之應用,” 碩士論文, 國立台灣技技大學機械工程系, 2006.
【43】 劉軒, “具立體視覺之移動式仿人型機器人,” 碩士論文, 國立台灣技技大學機械工程系, 2010.
【44】 Deng Julong, “Control problems of Grey System,” System and Control Letters, Vol. 5, pp. 288-294, 1982.
【45】 鄧聚龍, “灰色控制系統,華中理工大學出版社,” 中國武漢, 1984.
【46】 H.K. Chiang, and C.H. Tseng, “Designed and Implementation of a Grey Sliding Mode Controller for Synchronous Reluctance Motor Drive,” Control Engineering practice, pp. 155-163, 2004.
【47】 Z.X. Xiao, and H.W. Fang, “Speed Control of Brushless DC Motor With Grey Predictor,” Apperceiving Computing and Intelligence Analysis, Chengdu, China, International Conference, pp. 395-398, 2009.
【48】 D.F. Wang, P. Han, Z.Z. Jia, and N.L. Wang, “Grey Fuzzy Sliding Mode Control for Uncertain Systems,” Proceedings of the Third Intemationd Conference on Machine Leaming and Cyhemetics, Shanghai, China, 26-29 August 2004.
【49】 J. Deng, “Five step modeling of grey systems,” Grey System, China Ocean Press.
【50】 J. Deng, “Grey forecasting control,” Grey System, China Ocean Press, 1988.