臺灣博碩士論文加值系統

雙輪機器人為同時擁有移動及轉動動量的倒單擺結構系統，系統有線性、非線性、多變數等特徵。雙輪機器人有許多應用連帶造成多樣的需求，因此系統設計上應講求結構簡單，讓機器人能夠擁有靈巧的動作。
本論文以實現娛樂雙輪機器人為目標來製作雙輪機器人，使用Altera的FPGA作為系統硬體發展平台，並以此建立核心模組。建立人機介面，提供控制管道及提高系統可視度，使用者透過安裝在PC的人機介面下達指令，不但能使系統自動保持直立平衡、前後行走以及轉彎等單獨運動模式，且能讓系統串聯運動模式進行連續運動，達成提高機器人娛樂的價值並可供後人研發更多高階運動模式使用。
系統上主要分為兩個部分，首先在感測器部分使用陀螺儀、加速計為輸入，以卡爾曼濾波器來融合感測器訊號，使其更準確以及去除感測器的雜訊。並使用紅外線感測器，三個感測器來量測機器人當前狀態，
其次，在控制系統方面採用PID控制器，該控制器可以在沒有精確的數學模型情況下運行，並擁有結構簡單容易實現的優點。接著，利用規則庫改良PID控制器。此控制方法是系統根據機器人不同的狀態，及時的調整PID參數。
除兩大部分之外，本研究為提高研發效率，透過系統自動分析三個感測器的訊號，達成自動化分析PID參數並設定中心點及錯誤事件偵測。自動化設定中心點可以減少系統在不同環境下的設定時間，而錯誤事件偵測除檢察系統錯誤外也有助於後人維護系統運作。

This research is trying to build a control system of a Two-Wheeled Entertainment Robot, two-wheeled robot is an inverted pendulum system which has multi-variables with non-linear characteristics in control. Because the robot may be applied on different working environments, the design of this system should be flexible in motion and simple in structure.
The core of control system of Two-Wheeled Entertainment Robot is implemented on Altera’s FPGA. The robot can stably be balanced upright, walking and turning around by user’s instruction.
The research uses many sensors and modules such as the Infrared, Gyroscope and Accelerometer to catch the signals of the posture of robot. The signals from Gyroscope and Accelerometer are process by a discrete Kalman filter before PID control. Kalman filter has the role of removing noise and predicting signals of angle of robot precisely.
PID control algorithm has been used for many years and implemented without complicated mathematical models. We design a rule table of PID controller to improve the original PID controller. The control rule table uses parameters listed for different postures of robot for real-time adjustment independently. The results in experiments of motion control of two-wheeled robot have improved on stability of motion control, quick response of error of system and better robustness of system.

第一章 前言 1
1-1.研究動機 1
1-2.相關文獻 1
1-3.研究目標 4
1-4.問題研究與分析 5
1-5.論文架構 6
第二章 雙輪機器人硬體相關背景與模件 7
2-1.感測器介紹 7
2-1-1.加速計 7
2-1-2.陀螺儀 10
2-2.脈衝寬度調變(PWM) 11
2-3. 直流馬達驅動電路 12
2-4.nRF24L01無線模組 14
2-5.紅外線模組介紹 15
2-6.可程化閘陣列(FPGA)介紹 15
第三章 雙輪機器人理論背景 18
3-1.雙輪機器人運動原理 18
3-2.卡爾曼濾波器(Kalman filter) 19
3-3.PID控制器 21
3-4.PID控制器的架構 22
3-5.數位化實現PID控制器 23
3-5-1.取樣頻率 23
3-5-2.PID控制器的離散化 23
3-6.PID控制器參數的調整 24
3-7.旋轉編碼器 24
第四章 系統設計與架構 27
4-1.系統設計規劃 27
4-2-1.感測系統 30
4-2-2.控制系統架構 30
4-2-3.無線傳輸系統 32
第五章 難題分析與解決方法 33
5-1.控制器於非線性控制 33
5-2.運動模式設計及穩定提升 37
5-2-1.定點平衡模式 38
5-2-2.前進以及後退模式 40
5-2-3.自轉以及左轉右轉模式 41
5-2-4.連續動作模式 42
5-3.速度及定位感測 42
5-4.意外處理機制:倒地再起機制 44
5-5.煞車系統 44
5-6.提升研究效率及維護：錯誤事件偵測系統 44
5-7.人機介面與系統平台的配合 45
第六章 提升研究效率:錯誤事件偵測系統 49
6-1.角度計算異常 49
6-2.角速度計算異常 50
6-3.角速度和角加速度過快 51
6-4.小傾倒 52
6-5.大傾倒 53
6-6.加速度過快 54
6-7.移動速度異常 54
6-8.定點異常 55
第七章 人機介面:數據分析 56
7-1.PID 56
7-2.輪胎轉速以及位移 57
7-3.實際例子:卡爾曼濾波器異常 58
第八章 實驗結果分析 60
8-1.卡爾曼濾波器分析 60
8-2.規則庫實驗分析 62
8-3.錯誤事件偵測系統驗證 64
8-4.自由平衡實驗 69
8-5.定點平衡實驗 70
8-6.前進後退實驗 71
8-7.轉彎實驗 73
8-8.連續運動實驗 74
8-9.煞車系統實驗 75
第九章 結論 77
9-1.結論 77
9-2.未來發展 78
參考文獻 80
附錄 83
I.參數清單 83

[1]DRDO網站," http://www.drdo.gov.in/"
[2]iRobot網站," http://www.irobot.com/"
[3]Guardium維基網站," http://en.wikipedia.org/wiki/Guardium"
[4]K.Yamafuji and T.Kawamura, "Postural Control of a monoaxial bicycle", Joural of Robotics Society of Japan, Vol.1 No.4 pp.74-79,1988
[5]Segway網站," http://www.segway.com/"
[6]DEKA網站," http://www.dekaresearch.com/"
[7]LEGO網站," http://www.lego.com/"
[8]Felix Grasser, Aldo D''Arrigo, Silvio Colombi, Alfred C.Rufer. JOE: A Mobile Inverted Pendulum[j]". IEEE Transactions on Industrial Electronics, vol.49, No.1 February 2002
[9]鄒耿孟,碩士論文, "雙輪自動車之動態操空性的設計",私立義守大學碩士論文, 2012年1月
[10]李瑞勗, 碩士論文, "以FPGA為平台知道單擺雙輪機器人運動控制與規劃", 私立義守大學碩士論文, 2013年7月
[11]何宗諺,陳政雄,"基於USB傳輸之及時振動監測膜組織研發, "中央大學機械工程學系研究所",2013年5月
[12]甘家飛,碩士論文,"兩輪自平衡機器人的系統設計及運動控制研究",北京工業大學碩士論文,2010年5月
[13]R. E. KALMAN,"A New Approach to Linear Filtering and Prediction Problems",1960
[14]Greg Welch and Gary Bishop, "An introduction to the Kalman Filter", TR 95-041 Department of computer science University of North Carolina at Chapel hill chapel hill,NV 27599-3175, Monday July 24,2006.
[15]鄭自立, "卡爾曼濾波與維納濾波", 哈爾濱工業大學出版社, 2001年7月
[16]Nguyen Gia Minh Thao, Duong Hoai Nghia, Nguyen Huu Phuc," A PID Backstepping Controller For Two-Wheeled Self-Balancing Robot, Faculty of Electrical and Electronics EngineeringHoChiMinh city University of Technology,2010
[17]Victor M. Hernandez, "A Combined Sliding Mode-Generalized PI Control Scheme for Swinging Up and Balancing the Inertia Wheel Pendulum", Asian Joumal of Control, Vol.5, No.4, pp.620-625, December 2003
[18]Kok K. Tan, Quing-Guo Wang, Chang C., "Advances in Pid Control", published November 23,1999 bySpringer.
[19]Eric William Zurita-Bustamante, Jes?s Linares-Flores, Enrique Guzm?n-Ram?rez, and Hebertt Sira-Ram?rez,"A comparison between the GPI and PID controllers for the Stabilization of a DC-DC "Buck" converter: A field programmable gate array implementation", IEEE transactions on industrial electronics, vol. 58,no. 11,Novermber 2011.
[20]李珈松, 碩士論文, "車輪使倒單擺平衡PID控制", 國立台灣科技大學碩士論文, 2005年7月
[21]Yan-Hou Wen, Yu-sheng Lin, Yih-Guang Leu," Design and Implementation of the Balance of Two-Wheeled Robot", International Conference onAdvanced Robotics and Intelligent Systems, 2013
[22]Ali Unluturk, Omer Aydogdu, Ufuk Guner, "Design and PID Control of Two Wheeled Autonmous Balance Robot", Electric-Electronic Engineer ANKARA/TURKEY, 2013
[23]Ziegler J. G. and N. B. Nichols , "Optimal Settings for Automatic Controllers," Trans. Amer. Soc. Mech. Eng., Vol.64, pp.759-768, 1942
[24]金以惠, "過程控制",清華大學出版社，1993
[25]Karl Johan Astrom, Richard M. Murray, "Feedback Systems", Princeton, 2007
[26]Yuen Fong Chan, M, "Design and implementation of modular FPGA-based PID controllers", IEEE transactions on industrial electronics, Vol. 54, no. 4, August 2007.
[27]K. I. Hwu, Y. T. Yau, "Performance Enhancement of Boost Converter Based on PID Controller Plus Linear-to-Nonlinear Translator" , IEEE transactions on power electronics, Vol. 25, no. 5, May 2010.
[28]Chia-Feng Juang, Chia-Hung Hsu, "Reinforcement Ant Optimized Fuzzy Controller for Mobile-Robot Wall-Following Control", IEEE transactions on industrial electronics, Vol. 56, no. 10, October 2009.
[29]沈金鐘博士, "PID控制器 理論、調整與實現", 滄海書局, 2001年
[30]蔡喬倫, 碩士論文, "DSP主控之兩輪機器人平衡與兩輪同步控制", 國立中央大學碩士論文, 2004年6月