系統識別號 | U0002-0207200500250300 |
---|---|
DOI | 10.6846/TKU.2005.00024 |
論文名稱(中文) | 四節機器人之研究 |
論文名稱(英文) | Study of a Four-Link Robot |
第三語言論文名稱 | |
校院名稱 | 淡江大學 |
系所名稱(中文) | 機械與機電工程學系碩士班 |
系所名稱(英文) | Department of Mechanical and Electro-Mechanical Engineering |
外國學位學校名稱 | |
外國學位學院名稱 | |
外國學位研究所名稱 | |
學年度 | 93 |
學期 | 2 |
出版年 | 94 |
研究生(中文) | 張昱升 |
研究生(英文) | Yu-Seng Chang |
學號 | 692340788 |
學位類別 | 碩士 |
語言別 | 繁體中文 |
第二語言別 | |
口試日期 | 2005-06-09 |
論文頁數 | 87頁 |
口試委員 |
指導教授
-
楊智旭
委員 - 王文俊 委員 - 王銀添 |
關鍵字(中) |
四節機器人 模糊控制 零力矩點(ZMP) 類神經網路(ANN) |
關鍵字(英) |
Four-Link Robot Fuzzy Control Zero Moment Point Artificial Neural Network |
第三語言關鍵字 | |
學科別分類 | |
中文摘要 |
本論文是設計及製作一個由三個五相步進馬達及四節等長機構所組成的機器人,主要以探討四節機器人的自我平衡垂直站立與爬行運動控制及實現,首先於個人電腦(PC)設計四節機器人的平衡垂直站立與爬行運動路徑規劃,再利用類神經網路訓練與模糊系統的控制使其完成各項指定動作。硬體方面包含機構設計、馬達、傾斜計、電路配線、類比/數位(A/D)介面卡及通訊介面的製作,在平衡垂直站立運動中以零力矩點(Zero Moment Point, ZMP)理論來計算機器人的重心,以此來判斷機器人之平衡情形,另外在爬行運動中以機器人的摩擦力為模糊控制的設計參數,利用各馬達之目標角度及速度來設計模糊控制器,經由PC運算後下達運動命令給馬達,修正其速度以實現平衡垂直站立或爬行的動作。另外在四節機器人的底部(第一節)裝設傾斜計,經由類比/數位(A/D)透過串並列通訊控制埠(RS232)傳達數據資料,所量測的角度作為站立成功與否的重要依據。經實驗驗證,四節機器人能夠完成平衡垂直站立及爬行動作的具體實現。 |
英文摘要 |
This objective of this thesis is to develop a four-link robot to stand up vertically and stablly, and to craw on a flat surface smoothly. The robot is composed of three five-phases stepping motors, four equal-length linkages and a tilt sensor. The hardware of this system includes mechanism part, a sensor, a electrical circuit, A/D, I/O interface, stepping motors, motor drivers, and a PC. First, the sequence of standing and crawling behaviors of this robot is designed and assigned by a developed software program in a PC. The artificial neural network (ANN) and fuzzy algorithm are applied to develop the standing and crawling controller for the robot. In the standing processes, the center of gravity(COG) of this robot is calculated by the developed software program in a PC. The position of the COG is an important factor to determine the stability of the standing robot by the ZMP method. In the crawling processes, the friction forces between the links and ground are calculated to determine the sequence of dynamic behaviors by a fuzzy controller. Then, the robot links are driven by the corresponding motors to display its dynamic behaviors step by step automatically. Form the experimental results, the developed robot is able to stand up vertically and stablly, and craw smoothly either on a horizontal flat surface or on a inclined plane (±2°). |
第三語言摘要 | |
論文目次 |
目錄 淡江大學論文提要....................................................................................I 英文提要....................................................................................................II 目錄..........................................................................................................IV 符號表......................................................................................................VI 圖表目錄..................................................................................................IX 第一章 緒論...............................................................................................1 1-1 前言.............................................................................................1 1-2 研究動機與目的.........................................................................2 第二章 基礎理論......................................................................................4 2-1 重心平衡.....................................................................................4 2-2 摩擦力分析.................................................................................9 第三章 四節機器人之架構與研究方法................................................12 3-1 硬體系統...................................................................................13 3-1-1 機構設計........................................................................13 3-1-2 電控設計........................................................................17 3-2 軟體系統...................................................................................22 3-2-1 四節機器人之動作規劃................................................22 3-2-2 控制器設計....................................................................35 第四章 實驗.............................................................................................44 4-1 實驗說明...................................................................................44 4-2 平衡垂直站立實驗...................................................................45 4-3 爬行實驗...................................................................................51 4-4 結果...........................................................................................57 第五章 結論與討論................................................................................59 5-1 結論...........................................................................................59 5-2 討論...........................................................................................60 參考文獻...................................................................................................62 附錄 A 類神經網路簡介..................................................................66 A-1 學習規則..............................................................................69 A-2 倒傳遞演算法則..................................................................71 附錄 B 模糊系統簡介......................................................................81 附錄 C 上台階動作..........................................................................85 圖表目錄 圖2-1 第一節(Link 1)計算重心變數示意圖.......................................5 圖2-2 計算重心變數示意圖................................................................7 圖2-3 站立動作重心穩定範圍示意圖................................................9 圖2-4 計算正向力變數示意圖..........................................................10 圖3-1 四節機器人硬體規格圖..........................................................14 圖3-2 四節機器人實體圖..................................................................14 圖3-3 馬達驅動器實體圖..................................................................15 圖3-4 傾斜計實體圖..........................................................................16 圖3-5 A/D微處理器示意圖...............................................................18 圖3-6 A/D光耦合器示意圖...............................................................18 圖3-7 A/D通訊處理器示意圖...........................................................19 圖3-8 A/D系統電路圖........................................................................20 圖3-9 A/D實體電路系統....................................................................20 圖3-10 系統整合架構圖......................................................................21 圖3-11 Visual Basic控制介面圖..........................................................22 圖3-12 四節機械人各節活動範圍......................................................23 圖3-13 傾斜計可量測角度範圍示意圖..............................................24 圖3-14 平衡垂直站立動作步驟示意圖..............................................27 圖3-15 Link 1與Link 4傾斜角示意圖...............................................28 圖3-16 平衡垂直站立控制流程圖......................................................29 圖3-17 爬行動作步驟示意圖..............................................................33 圖3-18 爬行控制流程圖......................................................................34 圖3-19 倒傳遞網路訓練架構圖..........................................................36 圖3-20 平衡控制系統方塊圖..............................................................37 圖3-21 爬行控制系統方塊圖..............................................................38 圖3-22 重心位置誤差量(CE)之歸屬函數圖.......................................39 圖3-23 馬達一(M1)角速度(ωb)之歸屬函數圖...................................39 圖3-24 馬達一(M1)角速度修正量(△ωb)之歸屬函數圖..................40 圖3-25 角度位置誤差量(θE)之歸屬函數圖........................................40 圖3-26 馬達一(M1)及馬達三(M3)角速度(ωC)之歸屬函數圖...........41 圖3-27 馬達一(M1)及馬達三(M3)角速度修正量(△ωC)之歸屬函數圖.......................41 圖4-1 2°斜坡示意圖..........................................................................44 圖4-2 -2°斜坡示意圖.........................................................................45 圖4-3 平衡垂直站立實驗之連拍照片..............................................47 圖4-4 平衡垂直站立實驗於水平平台之重心變化..........................49 圖4-5 平衡垂直站立實驗於斜坡(2°)平台之重心變化....................50 圖4-6 平衡垂直站立實驗於斜坡(-2°)平台之重心變化...................50 圖4-7 爬行實驗之連拍照片..............................................................53 圖4-8 爬行實驗於水平平台之動摩擦力曲線圖..............................55 圖4-9 爬行實驗於斜坡(2°)平台之動摩擦力曲線圖........................56 圖4-10 爬行實驗於斜坡(-2°)平台之動摩擦力曲線圖.......................56 圖A-1 倒傳遞類神經網路模型..........................................................68 圖B-1 模糊系統的基本架構..............................................................82 圖C-1 上台階實驗之連拍照片(一)....................................................86 圖C-2 上台階實驗之連拍照片(二)....................................................87 表3-1 五相步進馬達規格表..............................................................15 表3-2 平衡垂直站立控制規則表......................................................42 表3-3 爬行控制規則表......................................................................43 表4-1 爬行動作與動摩擦力比較表..................................................54 表A-1 類神經網路訓練樣本..............................................................77 |
參考文獻 |
[1] 黃緒哲,基本機器人學,徐氏基金會,民國77年3月。 [2] Isaac Asimov,I, Robot,I Book,April 1, 2004. [3] http://www.honda-taiwan.com.tw/asimo/ [4] http://www.sony.net/SonyInfo/QRIO/top.html [5] 林彥誠,彈性體連結之機器蛇的研發與其最佳速度之規劃,台灣大學生物產業機電工程學研究所碩士論文,民國93年6月。 [6] 李曉芳,彈性體連結之機器蛇的研發與其最佳避障路徑規劃,台灣大學生物產業機電工程學研究所碩士論文,民國93年6月。 [7] http://news.sel.sony.com/pressrelease/5228 [8] 美國國家航空暨太空總署(NASA),”太空探險新利器蜘蛛機器人問世”,中央日報第五版(法新社/華盛頓訊),民國91年12月20日。 [9] J. Morimoto and K. Doya , “Acquisition of Stand-up Behavior by a Real Robot Using Hierarchical Reinforcement Learning , ” Robotics and Autonomous Systems, vol. 36, Issue: 1, pp. 37–51, 2001. [10] 廖俸慶,三節式機器人之站立控制,中央大學電機工程研究所碩士論文,民國92年6月。 [11] 蔡明倫,三節式機器人之爬行控制,中央大學電機工程研究所碩士論文,民國92年6月。 [12] 陳威豪,改良式三節式機器人(一)站立與躺下控制設計,中央大學電機工程研究所碩士論文,民國93年6月。 [13] 蔡家煒,改良式三節機器人(二)上下階台控制設計,中央大學電機工程研究所碩士論文,民國93年6月。 [14] 陳維方、鐘明吉、蔡若鵬、龔傑、陳世宏、周德明,應用力學-動力學(第四版),全華科技圖書股份有限公司,民國89年5月。 [15] Q. Huang, K. Yokoi, S. Kajita, K. Kaneko, H. Arai, N. Koyachi, and K. Tanie, “Planning Walking Patterns for a Biped Robot,” IEEE Transactions on Robotics and Automation, vol. 17, pp. 280–289, Issue: 3, Jun 2001. [16] Q. Li, A. Takanishi, and I. Kato, “Learning Control of Compensative Trunk Motion for Biped Walking Robot Based on ZMP Stability Criterion,” IEEE/RSJ International Conference on Intelligent Robots and Systems, vol. 1, pp. 597–603, Jul 1992. [17] K. Erbatur, T. Takahashi, A. Okazaki, K. Obiya, A. Kawamura, “A Study on the Zero Moment Point Measurement for Biped Walking Robots,” Proc. of IEEE International Workshop on Advanced Motion Control, pp.431-436, Jul 2002. [18] 顏鴻森,機構學,東華書局,民國88年3月。 [19] 范逸之、陳立元、孫德萱、程正孚,“Visual Basic與串並列通訊控制實務”,文魁資訊股份有限公司,2002年5月。 [20] 吳建郎、施殿金、張如松,物理,高立圖書有限公司,民國76年5月。 [21] 蘇木春、張孝德,機器學習:類神經網路、模糊系統以及基因演算法則,全華科技圖書股份有限公司,民國91年3月。 [22] 許溢适,步進馬達原理與應用,全華科技圖書股份有限公司,民國73年7月。 [23] 黃世陽、吳明哲,VISUAL BASIC 6.0學習範本,松崗電腦圖書資料股份有限公司,2000年8月。 [24] A. M. Erkmen, F. Matsuno, R. Chatterjee, and T. Kamegawa, “Snake Robots to the Rescue,” IEEE Robotics & Automation Magazine, vol. 9, Issue: 3, pp. 17–25, Sep 2002. [25] 孫宗瀛、楊英魁,FUZZY控制:理論、實作與應用,全華科技圖書股份有限公司,民國88年12月。 [26] 李允中、王小璠、蘇木春,模糊理論及其應用,全華科技圖書股份有限公司,民國92年1月。 [27] K. Hirai, M. Hirose, Y. Haikawa, and T. Takenaka, “The Development of Honda Humanoid Robot,” IEEE International Conference on Robotics & Automation, vol. 2 , pp. 1321–1326, May 1998. [28] http://pdfserv.maxim-ic.com/en/ds/MAX220-MAX249.pdf [29] Neural Network Toolbox User’s Guide. Howard Demuth, Mark Beale, 1992. [30] 王進德、蕭大全,類神經網路與模糊控制理論入門,全華科技圖書股份有限公司,民國92年9月。 [31] 葉怡成,類神經網路模式應用與實作,儒林圖書有限公司,民國93年9月。 [32] 陳伯儒,撞球機器人之類神經模糊補償器設計,淡江大學機械與機電工程學研究所碩士論文,民國92年6月。 |
論文全文使用權限 |
如有問題,歡迎洽詢!
圖書館數位資訊組 (02)2621-5656 轉 2487 或 來信