輪式機器人控制技術研究

輪式機器人控制技術研究,輪式,機器人,控制,技術研究 1輪式機器人控制技術研究輪式機器人控制技術研究答辯人：張俊答辯人：張俊指導教師：邢超老師指導教師：邢超老師西北工業(yè)大學明德學院本科畢業(yè)設計論文答辯西北工業(yè)大學明德學院本科畢業(yè)設計論文答辯西北工業(yè)大學明德學院本科畢業(yè)設計論文答辯西北工業(yè)大學明德學院本科畢業(yè)設計論文答辯2答辯提綱答辯提綱l選題背景以及研究意義選題背景以及研究意義l移動機器人系統(tǒng)概述移動機器人系統(tǒng)概述l移動機器人系統(tǒng)設計移動機器人系統(tǒng)設計l算法優(yōu)化及實驗算法優(yōu)化及實驗3選題背景選題背景 移動機器人是一個對外界環(huán)境高度開放的智能系統(tǒng)，能移動機器人是一個對外界環(huán)境高度開放的智能系統(tǒng)，能夠在執(zhí)行預先給定的任務指令的同時，根據(jù)行進中不斷感夠在執(zhí)行預先給定的任務指令的同時，根據(jù)行進中不斷感知到的周圍局部環(huán)境信息，自主地做出各種決策，引導自知到的周圍局部環(huán)境信息，自主地做出各種決策，引導自身安全地行使到指定的目標位置。這對解決工業(yè)中危險地身安全地行使到指定的目標位置。這對解決工業(yè)中危險地區(qū)的標本采集和故障處理等問題有著實際的指導意義。區(qū)的標本采集和故障處理等問題有著實際的指導意義。移動機器人控制技術是當今自動化領域技術發(fā)展的熱點移動機器人控制技術是當今自動化領域技術發(fā)展的熱點之一，受到了各方面的關注。社會經(jīng)濟的飛速發(fā)展和各個之一，受到了各方面的關注。社會經(jīng)濟的飛速發(fā)展和各個行業(yè)對自動化程度要求的提高，都極大地推動了機器入技行業(yè)對自動化程度要求的提高，都極大地推動了機器入技術的發(fā)展。機器人的關鍵技術是機器人的控制。術的發(fā)展。機器人的關鍵技術是機器人的控制。4移動機器人系統(tǒng)概述移動機器人系統(tǒng)概述輪式移動機器人系統(tǒng)主要包括小車機械結構、驅動系統(tǒng)、傳感器信息采集系統(tǒng)、控制系統(tǒng)、移動機器人運動學模型和路徑跟蹤等?？刂葡到y(tǒng)結構方式：主從式控制。移動機器人行駛機構：輪式行駛移動機器人路徑規(guī)劃：全局和局部移動機器人運動學模型：速度運動學模型5移動機器人的位姿分析通過Vl和Vr分別控制兩個驅動輪來決定機器人前進速度yy6 主要論述移動機器人的非完整約束問題、控制系統(tǒng)硬件結主要論述移動機器人的非完整約束問題、控制系統(tǒng)硬件結構、以及各硬件及相關應用電路的應用。重點介紹硬件設計，構、以及各硬件及相關應用電路的應用。重點介紹硬件設計，包括光電編碼盤抗干擾電路、電機驅動器設計、傳感器信息采包括光電編碼盤抗干擾電路、電機驅動器設計、傳感器信息采集系統(tǒng)、電源系統(tǒng)設計及硬件的可靠性設計等。集系統(tǒng)、電源系統(tǒng)設計及硬件的可靠性設計等。移動機器人系統(tǒng)設計移動機器人系統(tǒng)設計控制系統(tǒng)硬件結構：主從式結構單片機的最小系統(tǒng)電路：電源，復位電路，系統(tǒng)時鐘等步進電機驅動單元：兩相步進電機運動控制系統(tǒng)軟件：VisualC+7控制系統(tǒng)硬件結構控制系統(tǒng)硬件結構控制器硬件結構框圖主機完成復雜計算，將處理后的數(shù)據(jù)傳遞給下位機，下位機即單片機完成對 輪式機器人的控制。8步進電機控制圖步進電機控制圖步進電機驅動控制步進電機驅動控制以兩相步進電機作驅動單元，控制器發(fā)出脈沖信號為環(huán)形分配器提供脈沖序列，然后經(jīng)分配器分配再放大后加到步進電機驅動電源的各項輸入端，以驅動步進電機轉動。9步進電機控制驅動器部分原理圖步進電機控制驅動器部分原理圖硬件電路設計硬件電路設計步進電機控制驅動器由STC89LE52RC單片機、光電耦合器、集成芯片L297和L298組成。STC89LE52RC芯片是高性能低電壓8位單片機內(nèi)置8K字節(jié)可重復擦寫的Flash閃速存儲器，256字節(jié)RAM，3個16位定時器，可以完成步進電機簡單控制10Visual C+運行過程運行過程運動控制系統(tǒng)軟件設計運動控制系統(tǒng)軟件設計Visual C+的項目主要由框架窗口類(CmainFrame)應用程序類(CtextApp)文檔類(CtextDoc)及視圖類(CtextView)構成，當運行用戶應用程序時，程序中的應用程序類首先獲得控制權然后依次執(zhí)行以下功能：(1)做部分初始化工作；(2)調(diào)用應用程序類的構造函數(shù)，構造應用程序的唯一應用類對象；(3)調(diào)用WinMain()函數(shù)(該函數(shù)隱藏在應用程序框架內(nèi)部)；(4)從WinMain()函數(shù)返回后刪除應用程序的唯一應用類對象；(5)終止應用程序.11速度調(diào)節(jié)速度調(diào)節(jié)算法優(yōu)化及實驗算法優(yōu)化及實驗圖為直線(恒定)加減速控制算法，這種加減速定位控制方式，就是通過加速、恒定高速、減速的過程使電機從一個位置運行到另一個位置。在這個過程中，要對步進電機的步進過程及走的總步數(shù)進行有效而相對精確地控制。12上下位機的數(shù)據(jù)傳輸單片機通過中斷方式接收并保存，接收程序在串口中斷服務子程序中保存接收的數(shù)據(jù)到預定的存儲區(qū)域。中斷接收程序：13步進電機控制步進電機控制程序：程序：單片機對電機單片機對電機的控制可以通的控制可以通過中斷方式過中斷方式上下位機的數(shù)據(jù)傳輸14MATLAB編程編程機器人運動仿真機器人運動仿真以MATLAB輔助分析二階欠阻尼電路的零輸入相應原理流程15期望路徑為直線，選定機器人的初始狀態(tài)，跟期望路徑為直線，選定機器人的初始狀態(tài)，跟蹤直線的坐標的變化曲線蹤直線的坐標的變化曲線運行結果運行結果16程序運行校正圖，表示了校正后單位階躍響程序運行校正圖，表示了校正后單位階躍響應曲線之間的關系應曲線之間的關系運行結果運行結果17總結總結 結合當今機器人研究的發(fā)展潮流，為使機器人更具實用結合當今機器人研究的發(fā)展潮流，為使機器人更具實用性，滿足未來的機器人應用領域擴廣的需要，在如下幾個方性，滿足未來的機器人應用領域擴廣的需要，在如下幾個方面的研究還有待加強：面的研究還有待加強：（1）移動機器人的生命力就在于其工程應用。后續(xù)大量的）移動機器人的生命力就在于其工程應用。后續(xù)大量的試驗及由此獲得的試驗數(shù)據(jù)和經(jīng)驗仍然是完善和提高機器人試驗及由此獲得的試驗數(shù)據(jù)和經(jīng)驗仍然是完善和提高機器人性能所不可缺少的。性能所不可缺少的。（2）比較性研究工作不足。也就是說與各種成熟的算法之）比較性研究工作不足。也就是說與各種成熟的算法之間的基本特性及性能特點的對比研究還不是十分充分，而且間的基本特性及性能特點的對比研究還不是十分充分，而且還缺乏用于性能評估的標準測試集。還缺乏用于性能評估的標準測試集。比較性研究工作不足。也就是說與各種成熟的算法之比較性研究工作不足。也就是說與各種成熟的算法之間的基本特性及性能特點的對比研究還不是十分充分，而且間的基本特性及性能特點的對比研究還不是十分充分，而且還缺乏用于性能評估的標準測試集。還缺乏用于性能評估的標準測試集。18感謝邢老師的辛勤指導!請各位老師批評指正!謝謝!西北工業(yè)大學明德學院畢業(yè)設計論文 本科畢業(yè)設計論文 題 目 輪式機器人控制技術研究 專業(yè)名稱 自動化 學生姓名 張俊 指導教師 邢超 畢業(yè)時間 2014.06 設計 論文 畢業(yè) 任務書 一、題目 輪式機器人控制技術研究 二、指導思想和目的要求 1、 利用已有的專業(yè)知識，培養(yǎng)學生解決實際工程問題的能力； 2、 鍛煉學生的科研工作能力和培養(yǎng)學生的團結合作攻關能力； 三、主要技術指標 1. 研究輪式機器人控制算法； 2. 完成演示程序 四、進度和要求 第01周----第02周： 英文翻譯； 第03周----第04周： 學習輪式機器人動力學與控制理論； 第05周----第10周： 研究輪式機器人算法； 第11周----第16周： 設計演示程序； 第17周----第18周： 撰寫畢業(yè)設計論文，論文答辯； 五、主要參考書及參考資料 [1] 《Mobile Robotics: Mathematics, Models, and Methods Hardcover》 Alonzo Kelly , Cambridge University Press , 2013 [2] 《Arduino Robotics》John-David Warren, Josh Adams, Harald Molle, Apress; 1 edition , 2011 [3] 《Intermediate Robot Building (Technology in Action)》David Cook, Apress; 2 edition 2011. 學生 張俊 指導教師 邢超 系主任 __________ 摘 要 移動機器人在軍事和國民經(jīng)濟領域有著廣泛的應用前景。移動機器人運動控制技術作為機器人學的一個重要分支，是一項具有多年歷史而且具有廣泛應用前景的技術。在查閱大量資料的基礎上，分析了移動機器人運動控制技術特點及發(fā)展現(xiàn)狀，研究并設計了兩輪驅動的機器人運動控制系統(tǒng)。移動機器人的位置和姿態(tài)識別是移動機器人運動控制系統(tǒng)中的一個最基本的問題。本文根據(jù)兩輪差速驅動機器人的運動學方程，采用了一種簡潔實用的航位推算公式。這種方法可以在性能較高的微處理器中采用，進行實時推算，具有一定的效率優(yōu)勢。 移動機器人運動控制結構決定了它的運動能力。本文采用主從式控制結構， 即由主機完成復雜運算并將處理后的數(shù)據(jù)傳遞給從機，由從機完成小車本體的控 制，從機通過數(shù)控插補技術來實現(xiàn)機器人小車兩驅動輪的聯(lián)動；由運動函數(shù)構成 的運動控制源程序在PC機編寫，經(jīng)編譯生成相應的目標代碼并通過串口發(fā)送到從機，從機的功能一是接收來自主機的數(shù)據(jù)和命令，二是根據(jù)主機發(fā)送的數(shù)據(jù)執(zhí)行 插補運算并驅動電機。從機是以STC89LE52為核心的運動控制器，利用STC89LE52 芯片的控制功能，實現(xiàn)了移動機器人兩驅動電機的控制。由從機構成的運動控制 器，成本低，功能強，使用方便，而具有十分廣闊的應用前景。 關鍵詞：運動控制，航跡推算，插補，步進電機，單片機 Abstract As an important branch subject of robotics，the motion controller technology of mobile robot has a long history and will be widely used in the future，Based On refer ringto a great deal of the information and the research of the technology and development of mobile robot available，a two-wheel differential driving mobile robot was designed in the work presented here． The identity of location and position is a fundamental problem of the motion controller system of mobile robot。In this paper，based On the research of two-wheel differential driving mobile’s motive equation，a compact and practicably equation was induced．This method Call be used in a high performance micro-controller to perform real-time calculation and win show its efficient advantage． The motion abillty of a wheeled mobile robot iS determined by its motion controller system．Based on the utilization of a PC and a slaver micro·computer，a control system for a wheeled mobile robot with two stepping motors is designed and implemented．The control system is able to control the turning and speed of the two motors by interpolation technique．The source motion control program is written with these motion functions on PC and it is complied to object code．The code is transmitted to RAM of micro．controller through serial port of PC．The micro—controller has two main functions．The first iS receiving data or instructions from PC．The second is executing the instructions．The step．motor Can be controlled by STC89LE52 with its out put module，This kind of motion controller has the features of lower cost and powerful function．So it has wide application prospect. Key words：motion, control course, calculation, nterpolating,stepping,motor, micro-controlle 目錄 第一章 緒論 1 1.1題目的來源及研究意義 1 1.2移動機器人國內(nèi)外的研究歷史與現(xiàn)狀 2 第二章 移動機器人系統(tǒng)概述 5 2.1移動機器人控制系統(tǒng)結構 5 2.2移動機器人傳感器技術 5 2.3移動機器人感知系統(tǒng) 7 2.4移動機器人路徑規(guī)劃技術 10 2.4.1移動機器人的全局路徑規(guī)劃 11 2.4.2移動機器入的局部路徑規(guī)劃 12 2.5移動機器人運動學模型 13 2.6移動機器人航跡推算 15 2.7本章小結 16 第三章 移動機器人系統(tǒng)設計 18 3.1控制系統(tǒng)硬件結構 18 3.2單片機的最小系統(tǒng)電路 20 3.3步進電機驅動單元 22 3.5本章小結 28 第四章 算法優(yōu)化及實驗 29 4.1速度調(diào)節(jié) 29 4.2平面運動速度 30 4.3上下位機的數(shù)據(jù)傳輸實驗 31 4.4 機器人運動仿真 32 4.4.1 MATLAB編程 32 4.4.2運行結果 33 4.5本章小結 37 第五章 結束語 38 5.1總結 38 參考文獻 39 致謝 42 42 第一章 緒論 1.1題目的來源及研究意義 移動機器人技術是機器人學中的一個重要分支，它的研究始于二十世紀六十年代，以斯坦福大學研制的自主移動式機器人SHAKEY為標志，其主要目標是 研究在復雜環(huán)境下機器人系統(tǒng)的實時控制問題，涉及到任務規(guī)劃、運動規(guī)劃與導航、目標識別與定位、機器視覺、多傳感器信息處理與融合以及系統(tǒng)集成等多項關鍵技術。 移動機器人可以作為研究其它領域如人工智能等的平臺，同時移動機器人的研究也提出了許多新的、挑戰(zhàn)性的理論與工程技術課題，引起了越來越多的專家學者和工程技術人員的興趣。與任何一門現(xiàn)代技術分支一樣，移動機器人研究的興起一方面是社會生產(chǎn)發(fā)展的需要，另一方面也是相關技術領域交叉互相促進發(fā)展的結果。信息技術、人工智能技術、計算機以及機械電子技術的發(fā)展大大推動了在移動機器人研究領域向縱深方向延伸。其中一個最直接的因素是計算機技術的發(fā)展。計算機運算速度和存儲能力的大幅度提高，為移動機器人運行更復雜的實時控制算法創(chuàng)造了條件；另外計算機科學出現(xiàn)了一系列諸如人工智能、專家系統(tǒng)等新興技術分支學科，這些學科為移動機器人在未知或動態(tài)環(huán)境下的實時導航開辟道路。移動機器人技術己經(jīng)成為眾多高新技術的產(chǎn)物，同時也為其它技術的發(fā)展提供了廣闊的應用場所。 隨著機器人技術的不斷發(fā)展，移動機器人的應用范圍不斷拓展，功能不斷提高，不僅在工業(yè)、國防、服務等行業(yè)中得到廣泛的應用，而且在野外作業(yè)以及在有害、危險環(huán)境作業(yè)中的應用也得到世界各國的高度重視。目前，由于移動機器人具有更大的使用靈活性已使其成為機器人技術研究的一個熱點。 機器人是一個集環(huán)境感知，動態(tài)決策與規(guī)劃，行為控制與執(zhí)行等多功能于一體的綜合系統(tǒng)，它集中了傳感器技術，機械工程，電子工程，計算機工程，自動化控制工程以及人工智能等多學科的研究成果，代表機電一體化的最高成就，是目前科學技術發(fā)展最活躍的領域之一。隨著機器人性能不斷地完善，移動機器人的應用范圍大為擴展，不僅在工業(yè)，農(nóng)業(yè)，國防，醫(yī)療，服務等行業(yè)中得到廣泛的應用[1-2]，而且在排雷，搜捕，救援，輻射和空間領域等有害與危險場合得到很好的應用。因此，機器人技術的研究和發(fā)展受到了越來越多的重視。 移動機器人是一個對外界環(huán)境高度開放的智能系統(tǒng)，能夠在執(zhí)行預先給定的任務指令的同時，根據(jù)行進中不斷感知到的周圍局部環(huán)境信息，自主地做出各種決策，自動避開障礙物，引導自身安全地行使到指定的目標位置。這對解決工業(yè)中危險地區(qū)的標本采集和故障處理等問題有著實際的指導意義。 移動機器人控制技術是當今自動化領域技術發(fā)展的熱點之一，受到了各方面的關注。社會經(jīng)濟的飛速發(fā)展和各個行業(yè)對自動化程度要求的提高，都極大地推動了機器入技術的發(fā)展。機器人的關鍵技術是機器人的控制。 1.2移動機器人國內(nèi)外的研究歷史與現(xiàn)狀 自從五十年代世界上第一臺機械手在美國誕生以來，經(jīng)過近半個世紀的努力，機器人技術取得了巨大的進步，機器人的使用改變了許多行業(yè)的面貌。與此同時，機器人學也發(fā)展成為一門獨立的科學，取得了許多耀眼的成果。 近年來，新的形勢為機器人學提出了新的課題。經(jīng)濟領域內(nèi)的某些概念如計 算機集成制造系統(tǒng)(CIMs)和敏捷制造等都要求系統(tǒng)具有一定的‘柔性’，對于其中使用的機器人則要求與傳統(tǒng)的具有固定機座的機械手不同，要具有一定的移動能力。另一方面，未來戰(zhàn)爭中戰(zhàn)場要素的變化也為移動機器人提供了廣闊的舞臺， 由于這些原因，移動機器人成為機器人學中一個非?；钴S的領域。 國外PID控制是最早發(fā)展起來的控制策略之一。由于PID控制器具有簡單而固定的形式，算法簡單、可靠性高，在很寬的操作條件范圍內(nèi)都能保持較好的魯棒性[2]，能給設計人員提供一種簡單而直接的調(diào)節(jié)方式，故在工業(yè)控制過程中，PID控制器是應用最多的一種控制方式。 自1965年美國加利福尼亞大學控制論專家zadeh首次提出了用“隸屬函數(shù)” 概念來定量描述事物模糊性的模糊集合理論以來，其理論和方法日臻完善zadeh 把模糊控制應用于自動控制領域，開辟了模糊控制理論及其工程應用的新時代。 國內(nèi)在機器人運動控制器中，處理器件接受高層控制級的指令，計算和輸出多路控制信號，協(xié)調(diào)各驅動輪，并對系統(tǒng)狀態(tài)進行監(jiān)控。目前，許多機器人的運動控制系統(tǒng)均采用專用的微處理器，如以DSP為核心的微處理器制作專用的主板，采用專用的編程語言，并將控制算法固化在EPROM中。 運動控制算法是移動機器人運動控制的關鍵，由于PID控制器結構簡單、參 數(shù)易于調(diào)整，因此在移動機器人運動控制中得到了廣泛的應用，但是移動機器人 運動控制系統(tǒng)的模型在實際系統(tǒng)中存在控制參數(shù)難以調(diào)整、控制系統(tǒng)存在噪聲影 響等問題，即用傳統(tǒng)的比例控制器己不能達到較好的控制效果。 模糊邏輯法模擬駕駛員的駕駛思想，將模糊控制[3]本身所具有的魯棒性與基于生理學上的“感知一動作”行為結合起來，為移動機器人在未知環(huán)境中運動提出了一種新思路，模糊控制不需要建立數(shù)學模型，可以利用語言描述復雜的非線性系統(tǒng)，是一種基于非數(shù)學模型的控制方法，但是難以建立完善的推理規(guī)則。 在我國，移動機器人已在水下探險、自動搬運等方面有了初步的應用，有些方面已經(jīng)達到或接近于美日歐發(fā)達國家水平，但由于我們起步晚，總體水平還比較落后。因此，開展分工合作，各單位選擇適合自己的研究方向，跟蹤國外學科發(fā)展前沿，對提高我國自動化水平、推廣移動機器人的應用，進而創(chuàng)造更多經(jīng)濟效益都是很重要的。敏捷制造、柔性加工系統(tǒng)、計算機集成制造系統(tǒng)的開發(fā)和推廣、應用在我國勢在必行，而在柔性加工單元中，用作搬運的自主移動機器人，要求能隨工作任務和環(huán)境的改變，智能地重規(guī)劃行駛路徑，并要求能實時避開途中的障礙物。要達到這種水平，當前還有很多問題需要深入的研究，而其中的智能導航問題是最基本也是最重要的一個。 我國的機器人學研究起步較晚，但進步較快，己在工業(yè)機器人、特種機器人和智能機器人各個方面都取得了顯著成績。在“七五”期間，完成了示教再現(xiàn)工業(yè)機器聲成套技術(包括機械手、控制系統(tǒng)、驅動傳動單元、測試系統(tǒng)的設計、制造應用和小批量生產(chǎn)的工藝技術等)。為跟蹤國外高技術，80年代國家高技術計劃中安排了智能機器人的研究開發(fā)，包括水下無纜機器人、高功能裝配機器人和多種特種機器人。進行了智能機器人體系結構、機構、控制、人工智能、機器視覺，高性能傳感器及新材料的應用研究，取得了大量成果。其中，輪式移動機器人的研究也碩果累累。 目前，國內(nèi)研究輪式移動機器人的科研單位及公司主要有研制能力風暴As．R機器人的上海廣茂達伙伴機器人有限公司；研制的CASIA．1自主移動機器人的中科院自動化所[4]；研制“青青”輪式移動機器人的哈爾濱工業(yè)大學研制“小蜘蛛”輪式移動機器人登月車的上海交大等。當前，移動機器人技術的研究與發(fā)展的趨勢包括有：機器人機構、導航和定位、路徑規(guī)劃、傳感器信息融合技術、智能技術、移動機器人傳感器技術等研究。 第二章 移動機器人系統(tǒng)概述 一般來說，輪式移動機器人系統(tǒng)主要包括小車機械結構、驅動系統(tǒng)、傳感器信息采集系統(tǒng)、控制系統(tǒng)、移動機器人運動學模型和路徑跟蹤等，以下分別作些簡要介紹，各部分具體將在后續(xù)章節(jié)詳細介紹。 2.1移動機器人控制系統(tǒng)結構 移動機器人控制系統(tǒng)是整個機器人的核心，他決定了控制系統(tǒng)的性能劣。目前，移動機器人控制系統(tǒng)主要有三種結構方式：集中式控制，主從式控制[5]和分布式控制。集中式控制方式是指用一臺功能比較強大的計算機實現(xiàn)其全部控制功能，在早期的機器人控制系統(tǒng)中較多地采用這種方式。隨著計算機技術的飛速發(fā)展和機器人控制要求的不斷提高，逐漸出現(xiàn)了主從式控制和分布式控制。在主從式控制結構中，有上下兩級計算機，其中上位機利用它的運算能力和龐大的資源來完成復雜數(shù)據(jù)的處理，并把數(shù)據(jù)傳遞給下位機，下位機完成控制對象的位置控制，并把相關的數(shù)據(jù)傳遞給上位機。當前投入使用的移動機器人控制系統(tǒng)大多采用主從式控制，也采用上下二級的分布式結構，上位機負責整個系統(tǒng)管理以及運輪式移動機器人運動控制系統(tǒng)研究與設計動學計算，路徑規(guī)劃等，下位機可由一個或多個CPU組成，這些CPU和主控機聯(lián)系是通過總線形式的緊耦合，處理器承擔固定的任務，這種結構的控制器對工作速度和控制性能要求較高。 2.2移動機器人傳感器技術 移動機器人傳感技術主要是對機器人自身內(nèi)部的位置和方向等信息以及外部環(huán)境信息的檢測和處理。一般來說，移動機器人的傳感器分為內(nèi)部傳感器和外部傳感器。其中內(nèi)部傳感器有編碼器、線加速度計、陀螺儀、GPS、磁羅盤、角速度傳感器等。外部傳感器有：視覺傳感器、超聲波傳感器、紅外傳感器、接觸和接近傳感器等。如何提高移動機器人傳感器的可靠性和精度也是移動機器人的研究熱點。 移動機器人的傳感系統(tǒng)負責獲取機器人內(nèi)部狀態(tài)和外部工作環(huán)境的信息，是移動機器人感知、決策和動作三大要素之一。傳感系統(tǒng)的硬件組成單元是傳感器，其功能是為機器人提供諸如視覺、力覺、觸覺等對外部環(huán)境的感知能力，同時還可以感知機器人本身的工作狀態(tài)和位置。 移動機器人其行駛機構的形式層出不窮，美國、俄羅斯、法國和日本等西方發(fā)達國家己經(jīng)研制出了多種復雜奇特的三維行駛機構[6]，有的己經(jīng)進入了實用化和商業(yè)化階段。由于我國的市場要求較小，所以現(xiàn)在只有一些零星的研究工作。面對21世紀深空探測的挑戰(zhàn)，對各種自主系統(tǒng)的研制是急需的，也是必要的，而行駛機構又是自主移動機器人系統(tǒng)最基本與最關鍵的環(huán)節(jié)。己經(jīng)出現(xiàn)的行駛機構主要有履帶式、腿式和輪式。 輪式機器人具有運動速度快的優(yōu)點，只是越野性能不太強。但隨著各種各樣輪子底盤的出現(xiàn)，并可以和腿式機器人相媲美，于是人們對移動機器人行駛機構研究的重心轉移到輪式機構上來。在移動機器人行駛機構的研究方面，很難再找到開發(fā)腿式結構的了，幾乎都在進行輪式結構的研究。輪式機器人適合于條件較好的路面。輪式移動機構運動平穩(wěn)，自動操縱簡單，最適合平地行走，在無人工廠中，常用來搬運零部件或做其他工作，應用最廣泛。所以本課題采用輪式。 三輪移動機構結構最簡單，控制最方便。三點確定一個平面，三輪支撐理論上是穩(wěn)定的，采用三輪移動機構的機器人來說，重心都比較低，載荷穩(wěn)定且中心位置基本不發(fā)生變化，所以三輪移動機構能滿足要求。前輪為萬向輪，只起支撐作用，后兩輪為驅動輪，固定不可轉向，且相互獨立。后兩輪差動驅動的移動機器人結構如圖2．2所示。 2.3移動機器人感知系統(tǒng) 對移動機器人而言，機器入視覺系統(tǒng)正如入的眼睛一樣，是機器入感知局部環(huán)境的重要“感官"。能否正確、實時地處理視覺信息直接關系到機器人行駛速度、跟蹤效果以及對障礙物的避碰，對系統(tǒng)的實時性和魯棒性具有決定性作用， θ p x x y y 圖2.2輪式移動機器人結構 其處理技術是移動機器人研究中最關鍵的技術之一。視覺傳感器方式具有信息量大、信息完整等優(yōu)點，使得通過視覺傳感器準確獲取信息成為輪式移動機器人的主要發(fā)展方向之一。視覺導航[7]主要完成障礙物和陸標的探測及識別，這種能力將不僅使機器人能感知二維環(huán)境中物體的幾何信息，如形狀、位置、姿態(tài)等信息，而且能對它們進行描述、存儲、識別與理解。過去，由于圖像采集及處理的硬件設備運行速度低，利用視覺系統(tǒng)感知環(huán)境導引機器人進行跟蹤受到了很大限制。 近年來，隨著科學技術的迅速發(fā)展，視頻設備及計算機硬件運行速度得到了很大提高，越來越多的研究者投入到視覺導航領域中。因此，研究視覺導航技術已成為移動機器人導航研究的趨勢。但是，如何讓機器人具有類似于人類的自主視覺能力，如何提高機器人運動中的控制精度，仍然是需要長期解決的問題。視覺系統(tǒng)是移動機器人視覺導航進行路徑跟蹤的一個重要組成部分。本文所研究的輪式移動機器人的視覺系統(tǒng)主要由圖像采集、圖像處理、圖像辨識三個模塊構成。其中圖像采集模塊用來獲取數(shù)字圖像；圖像處理模塊是對提取到的外界路面信息進行處理，得到需要的特征信息；圖像辨識模塊是在具有特征信息的圖像中辨識出期望跟蹤路徑的直線斜率、曲線曲率等一些信息用于對機器人的反饋控制。 立體視覺是仿照人類利用雙目視覺線感知距離的方法，實現(xiàn)對三維信息的感 知，在實現(xiàn)上采用基于三角測量的方法，利用兩個或多個攝像機對同一景物從不 同位置成像，從而從視差中恢復距離信息。一個完整的機器人立體視覺系統(tǒng)包括： 圖像獲取、攝像機標定、特征提取、立體匹配、三維信息恢復及后處理5個部分。 （1）圖像獲取 獲取數(shù)字圖像是進行圖像處理和實現(xiàn)計算機視覺的前提條件。立體圖像獲取方式很多，主要取決于應用的場合和目的。在機器人視覺系統(tǒng)中，數(shù)字圖像獲取常用的設備一般是CCD攝像頭和視頻采集卡。圖像采集不但要滿足系統(tǒng)的應用要求，而且要考慮視點差異、光照條件、攝像機性能以及景物特點等因素的影響，以利于立體視覺計算[8]。 （2）攝像機標定 要從圖像中恢復出物體的三維信息，必須已知空間坐標系中的物體點同它在 圖像平面上像點之間的對應關系，而這個對應關系是由攝像機的位置、屬性參數(shù) 和成像模型所決定的。確定這些攝像機參數(shù)的過程就稱為攝像機標定，攝像機標 定實質(zhì)上就是確定出由空間坐標系到圖像坐標系的變換矩陣。 （3）圖像預處理與特征提取 由光學成像系統(tǒng)生成的二維圖像，包含了各種各樣的隨機噪聲和畸變，因此 需要對原始圖像進行預處理，突出有用信息、抑制無用信息，從而改善圖像質(zhì)量。圖像預處理的目的主要有兩個：一是改善圖像的視覺效果，提高圖像質(zhì)量的清晰 度；二是使圖像變的更有利于計算機的處理，便于各種特征分析。圖像預處理技 術，包括圖像對比度的增強、隨機噪聲的去除、邊緣特征的加強等。 特征提取是為了得到匹配賴以進行的圖像特征，由于目前尚沒有一種普遍適 用的理論可用于圖像特征的提取，從而導致了立體視覺研究中匹配特征的多樣性。 目前，常用的匹配特征主要有點特征、線特征和區(qū)域特征等。一般來講，大尺度 特征含有豐富的圖像信息，在圖像中的數(shù)目較少，易于得到快速匹配，但他們的 定位精度差，特征提取與描述困難，而小尺度特征數(shù)目較多，其所含有信息較少，因而在匹配時需要較強的約束準則和匹配策略，以克服歧義匹配和提高運算效率，良好的匹配特征應具有可區(qū)分性、不變性、穩(wěn)定性、唯一性以及有效解決歧義匹配的能力。 (4)立體匹配 立體匹配是立體視覺中最重要也是最困難的問題。它要解決同一空間點在不同圖像中像點的對應關系。當空間三維場景被投影為二維圖像時，同一景物在不同視點下的圖像會有很大的不同，而且場景中的諸多因素，如光照條件、景物幾何形狀和物理特性、噪聲干擾和畸變以及攝像機特性等，都被綜合成單一的圖像中的灰度值。因此，要準確地對包含了如此之多不利因素的圖像進行無歧義的匹配，顯然是十分困難的。對于任何一種立體匹配方法，其有效性有賴于3個問題的解決，即選擇正確的匹配特征，尋找特征之間的本質(zhì)屬性及建立能正確匹配所選特征的穩(wěn)定算法。立體匹配的研究都圍繞這三方面展開，并已提出了大量各具特色的匹配方法。但是由于立體匹配涉及的問題太多，至今仍未得到很好的解決，特別是在復雜場景中，如何提高算法的去歧義匹配和抗干擾能力，降低實現(xiàn)的復雜讀和計算量，都需要更深入的研究。 (5)三維重建 立體視覺的任務就是得出感興趣場景的三維信息，對于不同的應用可以有不同的要求，但最基本的就是要計算目標的深度信息，得到三維坐標。若系統(tǒng)需要結果的可視化，則可對場景進行重建。已知立體成像模型和完成立體匹配后，三維信息的恢復是比較容易的。重要的是如何提高計算的精確度，其影響因素是多方面的，如攝像機參數(shù)標定，圖像特征定位的精度和立體匹配的準確性等，因此要提高三維重建的精度還需要更深入的研究。 2.4移動機器人路徑規(guī)劃技術 路徑規(guī)劃是指移動機器入在障礙物環(huán)境中，如何尋找出一條從起始點到目的地的合適路徑，并要求該路徑能保證在運行過程中能安全地避開障礙物。輪式移動機器人的主要工作環(huán)境在地面，在室外環(huán)境中容易受到地面建筑物、街道和行人的影響，在室內(nèi)環(huán)境中容易受到燈光、墻壁、門、走廊還有安裝在地面的設備和工作人員行走的影響，需要進行路徑規(guī)劃，因此研究人員進行大量深入的研究。 近年來，機器人路徑規(guī)劃的方法主要有可以分為兩大類：傳統(tǒng)路徑規(guī)劃方法和智能路徑規(guī)劃方法。傳統(tǒng)路徑規(guī)劃方法主要包括：自由空間法，圖搜索法，柵格解耦法和人工勢場法?。大部分機器人路徑規(guī)劃中的全局規(guī)劃都是基于上述幾種方法進行的，但是以上這些傳統(tǒng)方法在路徑搜索效率及路徑優(yōu)化方面尚有待于迸一步改善。而現(xiàn)在通常使用的搜索技術包括：梯度法，A等圖搜索方法，枚舉法，隨機搜索法等。這些方法中，梯度法易陷入局部最小點，圖搜索方法、枚舉法不能用于高維的優(yōu)化問題，而隨機搜索法則計算效率太低。近年來，隨著遺傳算法等智能方法的廣泛應用，機器人路徑規(guī)劃方法也有了長足的發(fā)展，許多研究者把目光放在了基于智能方法的路徑規(guī)劃研究上。其中，應用較多的算法主要有模糊方法，神經(jīng)網(wǎng)絡算法和遺傳算法。 機器人規(guī)劃問題是指綜合機器人的動作序列并執(zhí)行的問題，從給定的狀態(tài)出發(fā)，這個序列能夠使機器人達到預期的工作目標，完成規(guī)定動作的工作任務。機器人規(guī)劃問題通常分為兩級不同規(guī)劃問題：任務規(guī)劃和路徑規(guī)劃[9]。路徑規(guī)劃是根據(jù)環(huán)境信息，將任務規(guī)劃的結果變成一條由起點到終點的無碰撞優(yōu)化路徑。對于自主式移動機器人，路徑規(guī)劃也稱為行動規(guī)劃或運動規(guī)劃。路徑規(guī)劃本身又可分為全局規(guī)劃和局部規(guī)劃。全局規(guī)劃是基于環(huán)境模型，在有限條件下對任意指定的起點和終點產(chǎn)生一條優(yōu)化路徑，即給出實際路徑上的一系列關鍵點。其主要方法有：可視圖法、廣義錐法、位置空間法、頂點法、勢場法、柵格法等。局部規(guī)劃是處于規(guī)劃的底層，它通過各種傳感器、處理器同環(huán)境交互信息，把全局規(guī)劃得到的一系列路徑關鍵點作為系統(tǒng)的子目標序列，規(guī)劃一條實際的路徑。移動機器人局部規(guī)劃的主要任務實避碰，即實時地躲避各種突發(fā)障礙物。 2.4.1移動機器人的全局路徑規(guī)劃 移動機器人的全局路徑規(guī)劃方法主要有：可視圖法、拓撲法、柵格法、自由空間法、最優(yōu)控制法和神經(jīng)網(wǎng)絡法等[10]。 可視圖法將移動機器人視為一點，把機器人、目標點和多邊形障礙物的各個頂點進行組合連接，并保證這些直線均不與障礙物相交，這就形成了一張圖，稱為可視圖。由于任意兩個頂點都是可見的，從起點沿著這些直線到達目標點所有路徑都是可見的，從起點沿著這些直線到達目標點的所有路徑均是運動體的無碰路徑。搜索最優(yōu)路徑的問題就轉換為從起點到目標點經(jīng)過這些可視線段的最短距離問題。運用優(yōu)化算法，可刪除一些不必要的連線以簡化可視圖，縮小搜索時間。該算法能夠找到最短路徑。但是該方法缺陷在于忽略了移動機器人的尺寸大小，使得機器人通過障礙物頂點時離障礙物太近甚至接觸，并且搜索時間比較長。 切線圖法和vornoi圖法都是對可視圖法進行的改進。切線圖用障礙物的切線表示弧，因此是從起始點到目標點的最短路徑的圖，即移動機器人幾乎接近障礙物行走。其缺點是如果控制過程中產(chǎn)生位置誤差，移動機器人就容易碰到障礙物。vomoi圖法用盡可能遠離障礙物[11]和墻壁的路徑表示弧。因此，從起始點到目標點的路徑將會增長，但采用該方法既使產(chǎn)生位置誤差，移動機器人也不會碰到障礙物。 拓撲法將規(guī)劃空間分割成具有拓撲特征子空間，根據(jù)彼此連通性建立拓撲網(wǎng)絡，在網(wǎng)絡上尋找從起始點到目標點的拓撲路徑，最終由拓撲路徑求出幾何路徑拓撲法基本思想是降維法，即將在高維幾何空間中尋求路徑的問題轉化為低維拓撲空間中判別連通性的問題。優(yōu)點在于利用拓撲特征大大縮小了搜索空間，并且 該算法復雜性僅依賴于障礙物數(shù)目且在理論上是完備的。而且拓撲法通常不需要機器人的準確位置，對于位置誤差也就有了更好的魯棒性。缺點是建立拓撲網(wǎng)絡的過程相當復雜，特別在增加障礙物時如何有效地修正己經(jīng)存在的拓撲網(wǎng)是有待解決的問題。 柵格法將移動機器人工作環(huán)境分解成一系列具有二值信息的網(wǎng)格單元，多采用四叉樹或八叉樹表示，并通過優(yōu)化算法完成路徑搜索。該方法以柵格為單位記錄環(huán)境信息，有障礙物的地方累積值比較高，移動機器人就會采用優(yōu)化算法避開。環(huán)境被量化成具有一定分辨率的柵格，柵格大小直接影響環(huán)境信息存儲量大小和規(guī)劃時間長短，柵格劃分大了，環(huán)境信息存儲量小，規(guī)劃時間短，但分辨率下降，在密集環(huán)境下發(fā)現(xiàn)路徑的能力減弱，柵格劃分小了，環(huán)境分辨率高，在密集環(huán)境下發(fā)現(xiàn)路徑的能力強，但環(huán)境信息存儲量大，規(guī)劃時間長。柵格法經(jīng)改進也廣泛應用于局部路徑規(guī)劃。 自由空間法應用于移動機器人路徑規(guī)劃，采用預先定義的如廣義錐形和凸多邊形等基本形狀構造自由空間，并將自由空間表示為連通圖，通過搜索連通圖來進行路徑規(guī)劃。自由空間的構造方法是：從障礙物的一個頂點開始，依次作其它頂點的鏈接線，刪除不必要的鏈接線，使得鏈接線與障礙物邊界所圍成的每一個自由空間都是面積最大的凸多邊形；連接各鏈接線的中點形成的網(wǎng)絡圖即為機器可自由運動的路線。其優(yōu)點是比較靈活，起始點和目標點的改變不會造成連通圖的重構，缺點是復雜程度與障礙物的多少成正比，且有時無法獲得最短路徑。柵格法建模存在空間分辨率和內(nèi)存容量的矛盾。而自由空間法建模，解決了這一矛盾。但自由空間法的分割需構造想象邊界，想象邊界本身具有任意性，于是導致路徑的不確定性。 可視圖法缺乏靈活性，且不適用于圓形障礙物的路徑規(guī)劃問題。神經(jīng)網(wǎng)絡法用于全局路徑規(guī)劃可以解決以上問題。引入網(wǎng)絡結構和模擬退火方法，計算簡單，且能避免局部極值情況。根據(jù)路徑點位于障礙物內(nèi)外的不同位置，選取不同運動方程，并針對障礙物形狀設定各條邊的模擬退火初始溫度，該方法計算簡單，收斂速度快，能避免局部極值，使規(guī)劃的無碰路徑達到最短。 2.4.2移動機器入的局部路徑規(guī)劃 局部路徑規(guī)劃包括人工勢場法、模糊邏輯算法、神經(jīng)網(wǎng)絡算法和遺傳算法等[12]人工勢場法是由心Khatib提出的一種虛擬力法，其基本思想是將移動機器人在環(huán)境中的運動視為一種虛擬入工受力場中的運動。障礙物對移動機器入產(chǎn)生斥力，目標點產(chǎn)生引力，引力和斥力周圍由一定的算法產(chǎn)生相應的勢，機器人在勢場中受到抽象力作用，抽象力使得機器人繞過障礙物。該法結構簡單，便于低層的實時控制，在實時避障和平滑的軌跡控制方面，得到了廣泛應用，其不足在于存在局部最優(yōu)解，容易產(chǎn)生死鎖現(xiàn)象，因而可能使移動機器人在到達目標點之前就停留在局部最優(yōu)點。為解決局部最優(yōu)問題，已經(jīng)研究出一些改進算法，如Sato提出的Laplace勢場法。改進算法是通過數(shù)學上合理定義勢場方程，來保證勢場中不存在局部極值。 模糊邏輯算法[13]是基于對駕駛員的工作過程觀察研究得出的。駕駛員避碰動作并非對環(huán)境信息精確計算完成的，而是根據(jù)模糊的環(huán)境信息，通過查表得到規(guī)劃出的信息，完成局部路徑規(guī)劃。優(yōu)點是克服了勢場法易產(chǎn)生的局部最優(yōu)問題，對處理未知環(huán)境下的規(guī)劃問題顯示出很大優(yōu)越性，對于解決用通常的定量方法來說是很復雜的問題或當外界只能提供定性近似的、不確定信息數(shù)據(jù)時非常有效，模糊邏輯算法有諸多優(yōu)點，但也存在固有缺陷：人的經(jīng)驗不一定完備，輸入量增多時，推理規(guī)則或模糊表會急劇膨脹。 2.5移動機器人運動學模型 在過去幾十年里，機器人學已經(jīng)發(fā)展成很成熟的一門學科，移動機器人運動學模型分為位移運動學模型，速度運動學模型加速速度運動學模型[14-17]三種，在這里對移動機器人的速度運動學模型進行分析。圖2．3所示兩后輪驅動的模型，用(x，y)和小車縱軸與X軸之間的央角θ來描述機器人小車的位姿P。 vl θ w X Y vr 圖 2.3移動機器人位姿分析 機器人的位姿可以表示為： P=[X，Y，θ]T 式(2．1) 其中(x，y)為機器人的坐標，0為機器人的姿態(tài)角，即機器人前進方向相對于X軸的方位角。vl和vr分別為機器人本體左右車輪的線速度，y是移動機器人本體的前進速度，w是移動機器人本體自身的角速度。機器人的運動學方程進行了詳細的推導，可以得到機器人車體的運動方程為： xyθ=cosθ0sinθ001 vw 式（2．2) 這樣就可以通過V和w來控制機器人的位姿。 對機器人而言，能夠直接進行控制的是兩個獨立驅動電機，因此采用 U=[VL，VR]T 形式的輸入控制量，來分別控制兩個驅動輪。所以這就需要將機器人的前進速度v和w轉動速度轉化為兩個輪子的線速度 。如圖2．4所示： V V V M N 圖 2.4 控制量轉化示意圖 輪式機器人的加速度w由兩輪的線速度決定，機器人的線速度為V，左右輪的距離為2L，N是移動機器人的質(zhì)心，M是移動機器人的速度瞬心，N M之間的距離即為機器人的轉動半徑，設為r。 則機器人的前進速度可以表示為： V= VL+VR2 式（2．3) 移動機器人的左右輪具有相同的角速度： θ=w=Vr =VLr-L=VRr+L 式（2．4) 由以上的推導可得移動機器人左右兩輪的線速度與機器人的角速度之間的關系如下： VL=V-wLVR=V+wL 式(2．5) 可見，只要分別控制兩個車輪的轉速，就能達到控制機器人位姿的目的。 2.6移動機器人航跡推算 移動機器人的位置和姿態(tài)識別[18-20]是移動機器人導航控制中的一個最基本的問題。航位推算方法是建立在所設計的兩輪差速驅動機器入車體結構和各種傳感器提供的信息的基礎之上的。移動機器人一般每個采樣周期需要推算一次自身位姿，因此航位推算方法在保證精確度的同時，要注意算法的實時性。 移動機器人與臂式機械手不同，它對于環(huán)境來說沒有一個固定點。機械手能夠以固定點為基準點，利用編碼器等檢測器件很容易得到各關節(jié)和杠桿的位置和姿態(tài)，而移動機器人的位置和姿態(tài)識別卻是移動機器人導航控制的一個最基本的問題。位姿識別大致可以分為兩種：一種是利用檢測運動狀態(tài)的內(nèi)傳感器進行航位推算，另一種是利用外傳感器收集環(huán)境信息進行位姿識別. 為便于研究，分別建立WMR工作空間坐標系標XOY系和WMR坐標系XaOaYa WMR的運動軌跡用ΣXOY中的方程f（X，Y,θ）=0,表示，位置（X，Y）為XaOaYa的原點Oa在XOY中的坐標，姿態(tài)θ為Xa軸與X軸的夾角，即其位姿為P=[X，Y，θ]T 。理想狀態(tài)：車體工作地為平整水平面；運動過程中車輪與地面間無相對運動；車體的幾何參數(shù)如輪徑等保持不變?？刂芖MR以設定的速度沿軌跡f（X，Y, θ）=0,運動時，控制左、右驅動輪的運動速度和即可。定義Uc=[Vcl，Vcr]T。設在t（i）時刻已知WMR的Uc(i)=[Vcl(i)，Vcr(i)]T和P(i)=[X(i),Y(i), θ(i) ] ，則在t(i+1)時刻WMR的p(i+1)可為： p(i+1)=p(i)+A（i）UC（i) 式(2．6) 式中： A(i)=Tcos（θi+?θ2Tcos（θi+?θ2Tsin(θi+?θ2Tsin(θi+?θ2-TBTB 式（2.7） ?θ=T（Vcr(i)-Vcl(i)）/2B，T為控制周期，B為兩驅動輪間距。。同時，Uc(i)應滿足Vc=(Vcri+Vcli) / 2。可見，若無外界干擾，欲控制WMR在t(i+1)到達目標位姿P=（i+1），根據(jù)WMR 在t（i）時刻的P（i）控制即可?？刂芔c(i)可轉化為控制在T內(nèi)發(fā)給驅動電機的脈沖數(shù)?ci=[?cli,?cri]T，令 K=π*RNm*Rate 式（2.8) 式中：Nm和Rate分別為電機轉一應發(fā)給電機的脈沖數(shù)和電機至驅動輪的降速比[21]；R為驅動輪半徑。則有Uc(i)=2K?ci/T，式(2．6)就轉換為系統(tǒng)的控制模型，即： P（i+1）=P（i）+ A1i*?ci 式(2.9) 式中：?c為系統(tǒng)的運動控制量， A1i=Kcos（θSi+dθi)Kcos（θSi+dθi)Ksin（θSi+dθi)Ksin（θSi+dθi)-2K/B2K/B 式(2.10) dθi=K（?cri-?cliB 式(2.11) 2.7本章小結 本章主要對移動機器人的總體結構、控制系統(tǒng)結構、感知系統(tǒng)、路徑規(guī)劃技術、移動機器人運動學模型及規(guī)劃路徑的離散化等作了詳細介紹，是本課題具體實現(xiàn)的理論基礎。 首先，介紹了移動機器人的總體結構及其控制系統(tǒng)結構，移動行使機構。主要是為了后續(xù)章節(jié)的討論奠定基礎； 其次，介紹了移動機器人感知系統(tǒng)，路徑規(guī)劃方面的基礎知識，為本文后續(xù)章節(jié)提供理論基礎： 最后，概述了移動機器人運動學模型及規(guī)劃路徑的離散化處理，為后續(xù)章節(jié)控制算法的提出提供理論基礎。 第三章 移動機器人系統(tǒng)設計 隨著機器人技術的發(fā)展，移動機器人應用領域的不斷擴大，對移動機器人的硬件性能提出了更高的要求。 本章主要論述移動機器人的非完整約束問題、控制系統(tǒng)硬件結構、以及各硬件及相關應用電路的應用。重點介紹硬件設計，包括光電編碼盤抗干擾電路、電機驅動器設計、傳感器信息采集系統(tǒng)、電源系統(tǒng)設計及硬件的可靠性設計等。 3.1控制系統(tǒng)硬件結構 控制系統(tǒng)在移動機器人系統(tǒng)中占有重要地位?？刂葡到y(tǒng)硬件是機器人的基礎，它決定了控制性能的優(yōu)劣，也決定了機器人使用的方便程度。計算機控制系統(tǒng)有三種結構：集中控制、主從控制和分布式控制[22]。本課題選用主從控制。 采用主從式結構的控制系統(tǒng)，即由上位機完成復雜計算，將處理后的數(shù)據(jù)傳遞給下位機，由下位機完成對小車本體的控制；機器人小車采用三輪結構，前輪為萬向輪，后兩輪為驅動輪，機器人小車的驅動采用步進電機。因而，有效地降低了成本。該控制器器通過串口與上位機通信，這樣，就簡化了控制器與上位機的連接，但不妨礙充分利用上位機的有關軟件資源。運動控制系統(tǒng)硬件結構如圖3．1所示 移動機器人運動控制系統(tǒng)的核心是微控制器，作為機器人控制器的核心高性能的CPU是必需的，選擇一個什么樣的微控制器對于機器人小車的性能、控制系統(tǒng)的設計方式有很大的影響，應具體分析控制系統(tǒng)的特征和要求進行微控制器的選擇， 應以運算速度、功能、兼容性、整個移動機器人系統(tǒng)的結構、通信方式及通信速率、電機控制方式、ROM及RAM的大小為依據(jù)來選擇合適的微控制器[24]。 圖 3.1控制器硬件結構框圖 目前微控制器主要有數(shù)字信號處理器DSP、現(xiàn)場可編程邏輯門陣列FPGA和單片機等類型。DSP具有數(shù)據(jù)處理能力強、速度快等優(yōu)點，且其體積較小，有利于電路板布局，但是DSP在中斷處理、位處理或邏輯操作方面不如單片機，芯片價格尤其是浮點器件價格較貴，系統(tǒng)開發(fā)成本較高；FPGA是Filed Programmable GateArray的縮寫，即現(xiàn)場可編程邏輯門陣列。FPGA是在CPLD的基礎上發(fā)展起來的新型高性能可編程邏輯器件，它一般采用SRAM工藝[25]，也有一些專用器件采用Flash工藝或反熔絲(Anti．Fuse)212藝等。FPGA的集成度很高，其器件密度從數(shù)萬系統(tǒng)門到數(shù)千萬系統(tǒng)門不等，可以完成極其復雜的時序與組合邏輯電路功能，適用于高速、高密度的高端數(shù)字邏輯電路設計領域，但其系統(tǒng)開發(fā)成本較高。單片機雖然在運算任務的完成上不如DSP，但是其成本低、易于開發(fā)、相關資料較全，配合一定的外圍芯片能夠很好地完成本系統(tǒng)的控制任務，隨著微電子工藝水平的提高，單片微型計算機技術有了飛躍的發(fā)展。單片機型號之多，已到了難以統(tǒng)計的地步。在MSC．5l系列單片機內(nèi)核8051／80C5l的基礎上Intel，Philips，Siemens等大公司紛紛推出各種派生芯片。如目前應用最廣的8位單片機89C51，價格低廉、功能強大。但在一些復雜的系統(tǒng)中，就不得不考慮16位單片機。MCS．96系列16位單片機廣泛應用于伺服系統(tǒng)、變頻調(diào)速等各類要求實時處理的控制系統(tǒng)。考慮到機器人尺寸的限制，功耗等因素選擇一個功能齊全的單片機是比較合適的，定位合理的方案，可獲得較高的性能價格比。 綜合比較之下，以單片機為核心確定整個控制系統(tǒng)的設計方案是比較合適 的。本文中運動控制器采用一種CPU數(shù)字控制系統(tǒng)體系結構，CPU采用STC89LE52單片機。 STC89C51Rc／RD+系列單片機是宏晶科技推出的新一代超強抗干擾高速低功耗的單片機，指令代碼完全兼容傳統(tǒng)8051單片機，12時鐘機器周期，6時鐘機器周期可任意選擇，最新的D版本內(nèi)部集成MAX810專用復位電路。 3.2單片機的最小系統(tǒng)電路 單片機可以工作的最小系統(tǒng)一般由電源、復位電路、系統(tǒng)時鐘等構成。 (1)復位電路 關于復位電路，當晶振在20MHz以下時，電容可以不用，電阻為1K。復位電路如圖4．3所示。 圖 3.3 復位電路圖 采用外部時鐘源，時鐘頻率為0-40MHz，CPu最大操作時鐘頻率可達48MHz，振蕩器輸出頻率稱為系統(tǒng)時鐘電路。 圖 3.4 時鐘電路 (3)串口電路 上位機利用MSComm控件將編碼數(shù)據(jù)從串12發(fā)送至下位機，由于本系統(tǒng)使用了串13，串1：3使用Maxim公司的MAX232芯片，只需4個小容量電容，接口使用DB9母頭，方便與串口延長線連接。 使用MAX3232進行RS232電平轉換，MAX3232是3VI作電源的RS232轉換芯片。采用串12和上位機通訊一個目的是進行ISP功能燒寫芯片，另一個是為調(diào)試系統(tǒng)的串口通訊。電路如圖3 5所示。 圖 3.5串口電路 (4)電源單元 安全可靠的電源系統(tǒng)是控制系統(tǒng)能否正常工作的先決條件，因此，機器人電源系統(tǒng)必須進行合理設計。從上述的各個單元分析可以總結出，為了各集成電路模塊正常工作，電路需要提供的電壓基準有3．3v供電，5v供電。由于系統(tǒng)對電源的穩(wěn)定性要求很高，所以要采取穩(wěn)壓芯片。 3.3步進電機驅動單元 步進電機是一種將電脈沖轉化為角位移的執(zhí)行機構。通俗一點講：當步進驅動器接收到一個脈沖信號，它就驅動步進電機按設定的方向轉動一個固定的角度(即步進角)?？梢酝ㄟ^控制脈沖個數(shù)來控制角位移量，從而達到準確定位的目的，同時也可以通過控制脈沖頻率來控制電機轉動的速度和加速度，從而達到調(diào)速的目的。 步進電機分三種：永磁式(PM)，反應式(VR)和混合式(HB)[26-27]。永磁式步進電機一般為兩相，轉矩和體積較小，步進角一般為7．5度或15度；反應式步進電機一般為三相，可實現(xiàn)大轉矩輸出，步進角一般為1．5度，但噪聲和振動都很大，在歐美等發(fā)達國家80年代已被淘汰：混合式步進電機混合了永磁式和反應式的優(yōu)點，分為兩相和五相，兩相步進角一般為1．8度而五相步進角一般為0．72度，這種步進電機的應用最為廣泛。 步進電機具有如下特點： 1、一般步進電機的精度為步進角的3-5％，步距值不受各種干擾因素的影響。簡而言之，轉子運動的速度主要取決于脈沖信號的頻率，而轉子運動的總位移量取決于總的脈沖個數(shù)。 2、位移與輸入脈沖信號相對應，步距誤差不長期積累。因此可以組成結構較為簡單而又具有一定精度的丌環(huán)控制系統(tǒng)，也可以在要求更高精度時組成閉環(huán)控制系統(tǒng)。 3、步進電機外表允許的最高溫度取決于不同的磁性材料。步進電機溫度過高首先會使電機的磁性材料退磁，從而導致力矩下降乃至于失步，因此電機外表允許的最高溫度應取決于不同電機磁性材料的退磁點，一般來講，磁性材料的退磁點都在攝氏130度以上，有的甚至高達攝氏200度以上。所以步進電機外表溫度在攝氏80．90度完全正常。 4、步進電機的力矩會隨轉速的升高而下降。當步進電機轉動時，電機各相繞組的電感將形成一個反向電動勢；頻率越高，反向電動勢越大。在它的作用下，電機隨頻率(或速度)的增大而相電流減小，從而導致力矩下降。 5、步進電機有啟動頻率要求和加速過程。雖然步進電機低速時可以正常運轉，但若高于一定速度就無法啟動，并伴有嘯叫聲。步進電機有一個技術參數(shù)為“空載啟動頻率"，即步進電機在空載情況下能夠正常啟動的脈沖頻率，如果脈沖頻率高于該值，電機不能正常啟動，可能發(fā)生丟步或堵轉。在有負載的情況下，啟動頻率應更低。如果要使電機達到高速轉動，脈沖頻率應該有加速過程，即啟動頻率較低，然后按一定加速度升到所希望的高頻(電機轉速從低速升到高速)。 6、無刷，電動機本體部件少，可靠性高；控制性能好，起動、停車、反轉及其它運行方式的改變，都在少數(shù)脈沖內(nèi)完成，在一定的頻率范圍內(nèi)運行時，任何運行方式都不會丟步；停止時有自鎖能力。 因此本系統(tǒng)采用57BYGH311-01兩相步進電機作為驅動單元，由于步進電機是一種將電脈沖信號轉換成直線或角位移的執(zhí)行元件，它不能直接接到交直流電源上，而必須使用專用設備一步進電機控制驅動器。典型步進電機控制系統(tǒng)如圖3．7所示：控制器可以發(fā)出脈沖頻率從幾赫茲到幾萬赫茲可以連續(xù)變化的脈沖信號，它為環(huán)形分配器提供脈沖序列。環(huán)形分配器的主要功能是把來自控制環(huán)節(jié)的脈沖序列按一定的規(guī)律分配后，經(jīng)過功率放大器的放大加到步進電機驅動電源的各項輸人端，以驅動步進電機的轉動。環(huán)形分配器主要有兩大類：一類是用計算機軟件設計的方法實現(xiàn)環(huán)形分配器要求的功能，通常稱軟環(huán)形分配器：另一類是用硬件構成的環(huán)形分配器，通常稱為硬環(huán)形分配器。功率放大器主要對環(huán)形分配器的較小輸出信號進行放大，以達到驅動步進電機目的。 圖 3.7步進電機控制圖 文中所控制的步進電機是兩相步進電動機。步進電機控制驅動器的電路如圖3.8所示。它由STC89LE52RC單片機、光電耦合器、集成芯片L297和L298組成。高性能低電壓8位單片機是STC89LE52RC芯片。內(nèi)置8K字節(jié)可重復擦寫的Flash閃速存儲器，256字節(jié)RAM，3個16位定時器，對完成步進電機簡單控制已足以勝任。 圖3．8步進電機控制驅動器部分原理圖 L297芯片是一種硬件環(huán)分集成芯片，它可產(chǎn)生四相驅動信號，用于計算機控制的兩相雙極或四相單極步進電機。它的心臟部分是一組譯碼器它能產(chǎn)生各種所需的相序，這一部分是由兩種輸人模式控制，方向控制(CW/CCW)和HALF/FULL以及步進式時鐘CLOCK，它將譯碼器從一階梯推進至另一階梯。譯碼器有四個輸出點連接到輸出邏輯部分，提供抑制和斬波功能所需的相序。因此L297能產(chǎn)生三種相序信號，對應于三種不同的工作方式：即半步方式(HALFS TEP))基本步距(FULL STEP，整步)一相激勵方式；基本步距兩相激勵方式。脈沖分配器內(nèi)部是一個3bit可逆計數(shù)器，加上一些組合邏輯，產(chǎn)生每周期8步格雷碼時序信號，這也就是半步工作方式的時序信號。此時HALF/FUL