一種輪式移動機器人控制系統(tǒng)設(shè)計與實現(xiàn)_第1頁
一種輪式移動機器人控制系統(tǒng)設(shè)計與實現(xiàn)_第2頁
一種輪式移動機器人控制系統(tǒng)設(shè)計與實現(xiàn)_第3頁
一種輪式移動機器人控制系統(tǒng)設(shè)計與實現(xiàn)_第4頁
一種輪式移動機器人控制系統(tǒng)設(shè)計與實現(xiàn)_第5頁
已閱讀5頁,還剩19頁未讀, 繼續(xù)免費閱讀

下載本文檔

版權(quán)說明:本文檔由用戶提供并上傳,收益歸屬內(nèi)容提供方,若內(nèi)容存在侵權(quán),請進行舉報或認(rèn)領(lǐng)

文檔簡介

一、緒論(一)移動機器人技術(shù)概述機器人是一自動的、位置可控的、具有編程能力的多功能操作機。機器人技術(shù)涉及計算機技術(shù)、控制技術(shù)、傳感器技術(shù)、通訊技術(shù)、人工智能、材料科學(xué)和仿生學(xué)等多類學(xué)科[7]。作為機器人學(xué)的重要分支,移動機器人能夠運動到特定位置,執(zhí)行相應(yīng)任務(wù),具備環(huán)境感知、實時決策和行為控制等功能,擁有很高的軍事、商業(yè)價值[1-5]。移動機器人按運動方式分為輪式移動機器人步行移動機器人、履帶式移動機器人、爬行機器人等;按功能和用途分為醫(yī)療機器人、軍用機器人、清沽機器人等;按作業(yè)空間分為陸地移動機器人、水下機器人、無人飛機和空間機器人。(二)移動機器人控制技術(shù)動態(tài)1.移動機器人控制技術(shù)開展概況步入2I世紀(jì),隨著電子技術(shù)的飛速開展,機器人用傳感器的不斷研制、計算機運算速度的顯著提高,移動機器人控制技術(shù)逐步得到完善和開展。移動機器人從最初的示教模仿型向具備環(huán)境信息感知、在線決策等功能的自治型智能化方向開展。移動機器人控制系統(tǒng)性能不斷提高,各類新型移動機器人也紛紛面世。步行式機器人是指按照邁步方式前進的移動機器人,由于符合動物的行進模式,可很好的在自然環(huán)境中運動,具有較強的越野性能。如美國NASA資助研制的丹蒂行走機器人,主要用于遠程機器人探險,其控制系統(tǒng)涉及環(huán)境感知、障礙物監(jiān)測、機械臂控制和超遠程遙操作等多方面技術(shù)。丹蒂方案的最終目標(biāo)是,為實現(xiàn)在充滿碎片的月球或其它星球的外表進行探險提供一種運動機器人解決方案。輪椅機器人是指使用了移動機器人技術(shù)的電動輪椅[8]。德國烏爾姆大學(xué)開發(fā)一種智能輪椅機器人,使喪失行動能力的人也能外出“走動〞。該輪椅機器人,能夠自動識別和判斷出行駛的前方是否有行人擋路,或是否可能出現(xiàn)行駛不通的情況,自動采取繞行動作,并能夠提醒擋路的行人讓開道路。該機器人的控制系統(tǒng),綜合運用了多傳感器信息融合、模式識別、避障、電機控制和人機接口等技術(shù)。消防機器人是指能在高溫、強熱輻射、濃煙、地形復(fù)雜、障礙物多、化學(xué)腐蝕、易燃易爆等惡劣條件下進行滅火和救援工作的移動機器人。其控制系統(tǒng)的設(shè)計重點包括障礙物檢測、爆等惡劣條件下進行滅火和救援工作的移動機器人。其控制系統(tǒng)的設(shè)計重點包括障礙物檢測、火焰檢測和系統(tǒng)可靠性設(shè)計等多項技術(shù)。日本投入應(yīng)用的消防機器人最多,美、英等國已研制出能依靠感覺信息控制的救災(zāi)智能機器人。我國上海交大機器人研究所也在國家“863〞方案和公安部聯(lián)合投資下,與上海消防所合作開發(fā)消防機器人的產(chǎn)品樣機。另外,隨著社會老齡化程度的不斷加劇,仿人機器人將彌補年輕勞動力的缺乏,解決老齡化社會家庭效勞和醫(yī)療看護等社會問題[9]。此類效勞型機器人的控制系統(tǒng)那么綜合運用了環(huán)境感知、路徑規(guī)劃、地圖遍歷、避障,防跌落等技術(shù),以適合在家中使用。如韓國Yujin機器人科技公司制造的家用機器人iRobot,日本歐姆龍公司開發(fā)的電子守衛(wèi)恐龍,以及三菱重工推出的可協(xié)助家庭保健和看家的機器人,都為家用機器人的市場化進程發(fā)揮了重要的作用。2.移動機器人控制系統(tǒng)關(guān)鍵技術(shù)目前,移動機器人控制技術(shù)的研究熱點和開展趨勢主要包括[1-4]:(1)運動控制中的路徑規(guī)劃技術(shù)。路徑規(guī)劃是移動機器人導(dǎo)航的根本環(huán)節(jié)之一,定義是按照某一性能指標(biāo)搜索一條從起始狀態(tài)到目標(biāo)狀態(tài)的最優(yōu)或近似最優(yōu)的無碰路徑。根據(jù)機器人對環(huán)境信息感知的程度,路徑規(guī)劃可分為環(huán)境信息完全可知的全局路徑規(guī)劃;環(huán)境信息局部未知甚至完全未知,移動機器人通過傳感器實時地對的工作環(huán)境進行探測,以獲取障礙物的位置、形狀和尺寸等信息進行的局部路徑規(guī)劃。(2)控制系統(tǒng)中的傳感技術(shù)。移動機器人傳感技術(shù)主要是對機器人自身內(nèi)部的位置和方向信息以及外部環(huán)境信息的檢測和處理。獲取真實有效的環(huán)境信息,是控制系統(tǒng)進行決策的保證。通常采用的傳感器包括分為內(nèi)部傳感器和外部傳感器。內(nèi)部傳感器主要包括:編碼器、線加速度計、陀螺儀、磁羅盤等。外部傳感器主要包括:視覺傳感器、超聲波傳感器、紅外傳感器、接觸和接近傳感器等。(3)控制系統(tǒng)的多傳感器信息融合技術(shù)。多傳感器信息融合是把分卻在不同位置的傳感器所提供的局部環(huán)境的不完整信息加以綜合,消除多傳感器之間可能存在的冗余和矛盾,以降低其不確定性,形成對系統(tǒng)環(huán)境的相對完整一致的感知描述,從而提高智能系統(tǒng)決策、規(guī)劃的快速性和正確性,同時降低決策風(fēng)險。(4)控制系統(tǒng)的開發(fā)技術(shù)。重點研究開放式、模塊化控制系統(tǒng)。機器人控制器結(jié)構(gòu)的標(biāo)準(zhǔn)化,以及網(wǎng)絡(luò)式控制器成為研究熱點。編程技術(shù)進一步提高在線編程的可操作性,離線編程的人機界面更加友好、自然語言化編程和圖形化編程的迸一步推廣也是今后研究的重點。(5)控制系統(tǒng)的智能化技術(shù)??刂葡到y(tǒng)的智能特征包括知識理解、歸納、推斷、反響和問題求解等內(nèi)容。涉及領(lǐng)域包括圖像理解、語音和文字符號的處理與理解、知識的表達和獲取等方面。智能控制方法常使用神經(jīng)網(wǎng)絡(luò)和模糊控制方法,但前者往往伴隨著對存儲容量、運算速度的較高要求,這與移動機器人高速高精度運動控制的要求存在一定差距,故模糊控制方法在機器人控制方面有著較大的優(yōu)勢。(三)本課題的意義本課題討論的移動機器人控制系統(tǒng),具有很高的系統(tǒng)集成度和廣泛的功能擴展空間,很好的兼顧了控制系統(tǒng)的通用性和實用性要求。該控制系統(tǒng),適用于多種移動機器人平臺,如家用娛樂機器人、展覽用導(dǎo)游機器人等。并可通過控制單元的擴充和升級,增加語音識別、人臉識別、視覺追蹤等交互性更強的功能。同時,該控制系統(tǒng)的設(shè)計完成,對于降低上述各類型機器人的開發(fā)難度,縮短從客戶提出需求到完成最終產(chǎn)品的開發(fā)周期,具有很強的指導(dǎo)意義。另外,本課題設(shè)計的移動機器人控制系統(tǒng),由于集成有通用微控制器開發(fā)平臺、避障模塊、電機驅(qū)動模塊等多種功能單元,因此,可作為數(shù)字電子技術(shù)、自動控制技術(shù)、傳感器技術(shù)、路徑規(guī)劃及人工智能等多學(xué)科多領(lǐng)域的通用實驗平臺。二、移動機器人的機械結(jié)構(gòu)和運動學(xué)模型(一)移動機器人機械結(jié)構(gòu)移動機器人運動方式有很多種,主要分為車輪式和步行式兩類。車輪移動方式的技術(shù)相對成熟,控制也較為容易實現(xiàn);步行式控制難度較大,但隨著傳感器技術(shù)和微控制器技術(shù)的快速開展,該種移動方式也得到了較大的開展。本文研究的移動機器人采用車輪式移動機構(gòu)。移動機器人總體結(jié)構(gòu)相對簡介,主體局部是基于圓形底座的車架。這種圓形車體結(jié)構(gòu)在運動過程能夠有效降低機器人與外界障礙發(fā)生碰撞的概率,從而獲得更大的相對運動空問。機器人的驅(qū)動車輪安裝于車架底部。避障傳感器分布于車體周圍。車身內(nèi)部自下至上依次固定有系統(tǒng)電源和控制電路。EMBEDAutoCAD.Drawing.16圖2.1移動機器人機械結(jié)構(gòu)示意圖移動機器人機械局部主要包括車架、車輪、直流減速電機和相關(guān)連接部件。如圖2.1移動機器人機械結(jié)構(gòu)示意圖所示。車架底座選用5mm厚的PVC板,能夠承受系統(tǒng)所需要的重量和強度,它是整個機器人的根底局部。車架底座由安裝于車體底部的三個車輪支撐,三個車輪構(gòu)成三角平面,符合架構(gòu)穩(wěn)定要求。在移動機器人車架底部安裝有三個車輪,其中自U輪為從動輪,選用直徑為30mm的萬向塑膠輪;兩后輪為相互獨立的驅(qū)動輪,為固定式不可轉(zhuǎn)向輪,選用直徑為45mm硬橡膠輪。為增大摩擦,防止驅(qū)動輪打滑,兩后輪分別粘貼有2mm厚的軟海綿。兩個后輪分別配有獨立的電機驅(qū)動模塊和減速機構(gòu),減速機構(gòu)采用與驅(qū)動電機集成的減速傳動裝置。三個車輪于車架底板成等邊三角形分布。這種車輪安裝的幾何對稱性有利于實現(xiàn)車體的前后左右便捷的零半徑轉(zhuǎn)向,也簡化了車體姿念的計算和控制。為測量驅(qū)動電機的轉(zhuǎn)速,其輸出轉(zhuǎn)軸內(nèi)側(cè)底板上裝有與驅(qū)動電機同軸的增量式光電編碼器。該編碼器與驅(qū)動輪同速旋轉(zhuǎn),車輪每旋轉(zhuǎn)一周,編碼器即輸出500個脈沖信號。車身的前進方向和速度依靠調(diào)節(jié)兩個驅(qū)動輪的轉(zhuǎn)速來實現(xiàn)。(二)移動機器人運動學(xué)模型[10-14]移動機器人采用獨立雙輪驅(qū)動模式,通過控制左右驅(qū)動輪的轉(zhuǎn)速差實現(xiàn)前進、后退、轉(zhuǎn)向等各種根本的動作,現(xiàn)建立坐標(biāo)系說明移動機器人的運動學(xué)模型,具體坐標(biāo)系和運動參量見圖2.2移動機器人的運動示意圖。圖2.2移動機器人的運動示意圖圖2.2中,V代表機器人質(zhì)心的線速度:VL和VR分別是左右輪的線速度;R為左右輪的半徑;L為兩輪的間距;X,Y代表機器人質(zhì)心的二維平面坐標(biāo)。那么移動機器人滿足剛體運動規(guī)律,運動方程(2-1)和(2-2)成立。(2-1)(2-2)式(2-1)和式(2-2)中,ωL和ωR分別代表左右輪的角速度,ω為質(zhì)心的角速度,1,v為質(zhì)心的線速度。由式(2-2)可知,當(dāng)VL=VR時,質(zhì)心的角速度ω為0,即機器人沿直線運動;當(dāng)VL=VR時,質(zhì)心的線速度為0,那么機器人可實現(xiàn)原地轉(zhuǎn)身,即此時機器人將以零半徑轉(zhuǎn)彎。按照公式(2-2)計算得到VL和VR即可實現(xiàn)移動機器人的運動控制。假設(shè)將式(2-1)代入式(2-2),可得(2-3)而機器人的質(zhì)心運動方程為(2-4)將式(2-3)代入式(2-4),得(2-5)方程(2-5)中各變量相互關(guān)聯(lián),設(shè)計控制器時比擬復(fù)雜,為此,先進行解耦處理。因為θ只與質(zhì)心的角速度有關(guān),X、Y只與質(zhì)心的線速度有關(guān),故可將控制變量轉(zhuǎn)為質(zhì)心的線速度和角速度。方程如下:(2-6)再將左右輪角速度表示成質(zhì)心的角速度和線速度,即(2-7)由上式可知,根據(jù)移動機器人(質(zhì)心)設(shè)定的目標(biāo)線速度和角速度即可分別求得左右輪的實時角速度,從而通過電機驅(qū)動機構(gòu)完成速度調(diào)節(jié),實現(xiàn)移動機器人運動方向和速度的實時控制。然而,在實際應(yīng)用中,由于編碼器檢測車輪的旋轉(zhuǎn)的分辨誤差、負載使車輪的等效半徑產(chǎn)生變化、加速度及旋轉(zhuǎn)產(chǎn)生的離心力使車輪的等效半徑變化以及路面的凹凸和傾斜等因素的影響,使上述公并非嚴(yán)格成立。通常采用多種方法綜合采用的方案來完成移動機器人的運動控制。三、移動機器人控制系統(tǒng)設(shè)計〔一〕移動機器人控制系統(tǒng)方案在移動機器人系統(tǒng)的總體設(shè)計中,控制系統(tǒng)的設(shè)計尤為重要??刂葡到y(tǒng)是整個機器人系統(tǒng)的靈魂??刂葡到y(tǒng)的先進與否,直接決定了整個機器人系統(tǒng)智能化水平的上下。移動機器人的各種功能都在控制系統(tǒng)的統(tǒng)一協(xié)調(diào)下實現(xiàn);控制系統(tǒng)設(shè)計謀略也決定了整個機器人系統(tǒng)的功能特點和可擴展性[15-21].本課題設(shè)計的移動機器人控制系統(tǒng),具備障礙物檢測避碰、速度檢測和調(diào)節(jié)、原地零半徑轉(zhuǎn)向、電源低電壓監(jiān)測和充電等功能并可工作于實時手動遙控、預(yù)編程路徑運動及自動沿墻跟蹤等多種模式。圖3.1移動機器人控制系統(tǒng)框圖根據(jù)移動機器人的功能要求,本課題研究的控制系統(tǒng)主要包括:微控制器模塊、避障模塊、電機驅(qū)動模塊、測速模塊、遙操作模塊、串行通信模塊及電源模塊等局部??刂葡到y(tǒng)的總體框圖如圖3.1所示。具體設(shè)計過程中,上述各個模塊力求相對獨立,以便系統(tǒng)日常的維護和今后的升級。其中:·微控制器模塊作為控制系統(tǒng)的核心,主要進行各種信息、數(shù)據(jù)的處理,協(xié)調(diào)系統(tǒng)中各功能模塊完成預(yù)定任務(wù);·避障模塊由超聲波測距傳感器和對射式紅外傳感器組成,主要負責(zé)移動機器人運動過程的障礙物的檢測,超聲波傳感器用于遠距離障礙物檢測,紅外傳感器用于近距離障礙物檢測;·電機驅(qū)動模塊負責(zé)機器人左右輪的獨立驅(qū)動,主要由功率轉(zhuǎn)換模塊和微控制器內(nèi)置的PWM單元組成,實現(xiàn)左右輪的差速控制;·測速模塊由增量式光電編碼器組成,用于左右輪轉(zhuǎn)速、轉(zhuǎn)向的實時測量,以實現(xiàn)移動機器人的運動控制;編解碼和無線收發(fā)局部,用于移動機器人遙控模式;·電源模塊負責(zé)整個控制系統(tǒng)各局部的電源供應(yīng),并實現(xiàn)鋰電池的電量檢測和充電?!ご型ㄐ拍K包括異步通信、同步通信兩局部,異步通信用于預(yù)編成路徑的下載,同步通信用于預(yù)編成路徑數(shù)據(jù)的存儲和現(xiàn)場溫度的采集以實現(xiàn)超聲波測距的修正;本章將從各模塊的設(shè)計原理和功能出發(fā),闡述各模塊的設(shè)計要點?!捕澄⒖刂破髂K在本課題中,采用微控制器(MicroControllerUnit,MCU)作為移動機器人控制系統(tǒng)的核心。微控制器在整個系統(tǒng)中扮演的角色類似于人的大腦,主要完成各種信息的運算和決策。微控制器是一種嵌入式微處理器,顧名思義,就是將整個計算機系統(tǒng)集成到一塊芯片中。微控制器一般以某一種CPU內(nèi)核為核心,芯片內(nèi)部集成ROM、EPROM、EEPROM、FLASH、RAM、A/D、D/A、定時器/計數(shù)器、看門狗、I/O、串行接口、脈寬調(diào)制器等功能單元。與CPU相比,MCU的最大特點是使PC機單片化,體積大大減小,功耗和本錢下降,可靠性提高。因此微控制器逐漸成為嵌入式PC系統(tǒng)的主流核心器件。1.微控制器的選用依據(jù)微控制器是整個控制系統(tǒng)的核心部件,直接影響到控制系統(tǒng)的功能和性能。因此,合理選用控制系統(tǒng)的核心控制器,對系統(tǒng)的設(shè)計至關(guān)重要[18-19]。在硬件平臺的設(shè)計過程中,對微控制器的選型往往需要考慮諸多因素,本課題的微控制器選用依據(jù)主要包括以下幾個方面:(1)對于微控制器類型,目前國內(nèi)外移動機器人平臺采用的微控制器有多種,如飛思卡爾微控制器、東芝微控制器,甚至有的設(shè)計采用更高檔16位、32位微控制器??紤]到本文設(shè)計的移動機器人結(jié)構(gòu)特點和功能要求,須在高性能計算與低功耗之間得到很好的平衡。并且該種微控制器的片內(nèi)資源應(yīng)當(dāng)較為豐富,以減小電路板面積并提高整機穩(wěn)定性。(2)從功能需求上,考慮到移動機器人的運動和動作大多采用直流電機驅(qū)動,因此選用的微控制器應(yīng)具有高精度(分辨率8位以上)PWM功能,以方便實現(xiàn)直流電機的調(diào)速控制。此外,為便于日后擴展移動機器人的功能,微控制器應(yīng)具有較強的T/O能力。(3)從控制軟件開發(fā)支持上,應(yīng)便于開發(fā)和調(diào)試應(yīng)用程序,需要較大的存儲空間和更高的運行速度。同時,為實現(xiàn)電路完成后的程序升級,微控制器需支持代碼在系統(tǒng)下載功能?;谏鲜鲂枨蠓治?,經(jīng)過全面調(diào)研、反復(fù)比擬,最終選用了ATMEL公司的ATMEGAl6型微控制器作為本系統(tǒng)的控制核心。ATmegal6是基于增強的AVRRISC結(jié)構(gòu)的低功耗8位CMOS微控制器。由于其先進的指令集和單時鐘周期指令執(zhí)行時間,ATmegal6的數(shù)掘吞吐率高達1MIPS/MHz,從而可以緩減系統(tǒng)在功耗和處理速度之間的矛盾.AVR內(nèi)核具有豐富的指令集和32個通用工作存放器。所有的存放器都直接與算術(shù)邏輯單元(ALU)相連接,使得一條指令可以在一個時鐘周期內(nèi)同時訪問兩個獨立的存放器。這種結(jié)構(gòu)大大提高了代碼效率,并且具有比普通的CISC微控制器最高至10倍的數(shù)掘吞吐率。通過將8位RISCCPU與系統(tǒng)內(nèi)可編程的Flash集成在一個芯片內(nèi),ATmegal6成為一個功能強大的微控制器,為許多嵌入式控制應(yīng)用提供了靈活而低本錢的解決方案。2.ATMEGAI6微控制器特點1997年,ATMEL挪威設(shè)計中心出于市場考慮,充分發(fā)揮其Flash技術(shù)優(yōu)勢,推出全新的精簡指令集(RISC)微控制器,簡稱AVR微控制器。ATMEGAl6微控制器主要有以下特點:(1)先進的RISC結(jié)構(gòu),工作于16MHz時性能高達16MIPS;(2)四通道PWM;(3)8路10位ADC;片內(nèi)模擬比擬器;(4)面向字節(jié)的兩線接口;兩個串行USART;可工作于主機/從機模式的SPI串行接口;具有獨立片內(nèi)振蕩器的可編程看門狗定時器;〔三〕避障模塊移動機器人運行的過程中,可能在運動路徑上遇到移動或靜止的障礙物。此時,假設(shè)機器人無法檢測到該障礙物并及時調(diào)整行進路線,就很有可能與之發(fā)生碰撞,進而造成機器人本體的損傷或被碰撞物(人)的損害。因此,移動機器人控制系統(tǒng)必須配有能夠?qū)崟r檢測環(huán)境障礙物的傳感器。當(dāng)前,國內(nèi)外研制的移動機器人,多采用紅外避障傳感器和超聲波測距傳感器實現(xiàn)障礙物檢測嘲[]。紅外傳感器探測視角小、方向性強,但對障礙物的顏色(亮度)較為敏感,其探測敏感度隨著障礙物的顏色不同而有較大差異,一般只用作近距離探測。超聲波測距是近年來開展起來的一種測距方法,但由于超聲波傳播速度較慢、發(fā)射角度較大等特性,使其探測方向性較差,故只用以獲得前方障礙物的距離信息,不能提供障礙物的嚴(yán)格邊界信息。綜上分析,考慮到單一傳感器探測的局限性,在實際應(yīng)用中,往往通過綜合運用多種傳感器以進行信息補償。本課題中,將紅外探測與超聲波探測相結(jié)合,利用紅外傳感器探測近距離障礙物的有無,超聲波傳感器探測較遠障礙物的距離信息。本課題所設(shè)計的移動機器人,于車體周圍安裝有4個紅外避障傳感器,分別用于前方避障和側(cè)面尋墻;于車體內(nèi)部,分左右安裝有2個超聲波測距傳感器,用于測量機器人距前方障礙物的距離信息。具體的安裝位置如圖3.2所示。圖3.2避障傳感器安裝位置示意圖〔四〕電機驅(qū)動模塊移動機器人采用左右兩輪獨立驅(qū)動,采用差速轉(zhuǎn)向機構(gòu),每個車輪分別由一個直流電機單獨控制。機器人的運動控制主要通過對這兩個電機的驅(qū)動實現(xiàn),包括速度和轉(zhuǎn)向的控制。本設(shè)計選用直流力矩電機驅(qū)動車輪。該直流電機具有優(yōu)良的速度控制性能,具體來說,它有以下優(yōu)點:(1)具有較大的轉(zhuǎn)矩,以克服傳動裝置的摩擦轉(zhuǎn)矩和負載轉(zhuǎn)矩;(2)調(diào)速范圍寬,且運行速度平穩(wěn);(3)具有快速響應(yīng)能力,可以適應(yīng)復(fù)雜的速度變化;(4)電機的負載特性硬,有較大的過載能力,確保運行速度不受負載沖擊的影響。本設(shè)計選用的電機為寧波三佳公司的12V直流電機JS-30VZJ,轉(zhuǎn)速為3000r/m,配有減速比為l:30的減速器?!参濉彻怆娋幋a器測速模塊測速元件是速度閉環(huán)控制系統(tǒng)的關(guān)鍵元件。本設(shè)計中,采用增量式光電編碼器測量移動機器人左右兩輪的實時轉(zhuǎn)速,進而通過特定算法得到實時電機驅(qū)動模塊的PWM控制量,實現(xiàn)運動機器人運動的閉環(huán)控制。1.增量式光電編碼器光電編碼器俗稱碼盤,是一種通過光電轉(zhuǎn)換將軸上的機械幾何位移量轉(zhuǎn)換成脈沖或數(shù)字量的傳感器,主要用于機械轉(zhuǎn)角位置和旋轉(zhuǎn)速度的檢測和控制。光電編碼器的根本結(jié)構(gòu)由旋轉(zhuǎn)軸上的編碼圓盤以及裝在圓盤兩側(cè)的發(fā)光元件和光敏元件組成。圓盤上規(guī)那么地刻有透光和不透光的線條或孔,當(dāng)圓盤隨著轉(zhuǎn)軸旋轉(zhuǎn)時,光敏元件接收的光通量強弱隨著光線條同步變化,光敏元件波形經(jīng)過整形輸出變?yōu)槊}沖輸出。一般圓盤上還設(shè)有定相標(biāo)志,產(chǎn)生零信號,每轉(zhuǎn)一圈產(chǎn)生一個,又稱基準(zhǔn)脈沖。本設(shè)計選用ZKX-6-50BM7型增量式光電編碼器是一款高精度角位移傳感器,主軸每旋轉(zhuǎn)一周分兩路輸出500個電壓脈沖信號Out_A和Out_B。其中,Out_A和Out_B兩路信號相位差為90度,可通過Out_A和Out_B的相位關(guān)系,判斷主軸的轉(zhuǎn)動方向。2.移動機器人驅(qū)動輪線速度的測量通常,根掘脈沖計數(shù)來測量轉(zhuǎn)速的方法有三種,分別介紹如下[25-27]。(1)M法測速:在規(guī)定的時間間隔內(nèi),測量所產(chǎn)生的脈沖數(shù)M,來獲得被測速度值,這種方法稱為M法,適合于高速測量場合。(2)T法測速:測量相鄰兩個脈沖的時間間隔來確定被測速度的方法叫做T法測速,適合于低速時測量。(3)M/T法測速:M/T法是同時測量檢測時間和在此檢測時問內(nèi)脈沖發(fā)生器發(fā)送的脈沖數(shù)束確定被測轉(zhuǎn)速,兼有M法和T法的優(yōu)點。本設(shè)計中基于T法測量移動機器人驅(qū)動電機的實時轉(zhuǎn)速。將光電編碼器輸出接至微控制器的外部中斷INT2,那么轉(zhuǎn)動引起的每一個電壓脈沖都會觸發(fā)微控制器外部中斷。通過編制中斷子函數(shù),就可以實現(xiàn)對光電編碼器輸出脈沖個數(shù)的準(zhǔn)確計算,經(jīng)換算后即得轉(zhuǎn)動軸轉(zhuǎn)過的精確角位移。因此,根據(jù)光電編碼器轉(zhuǎn)動單位角位移所需的時間,就可求得轉(zhuǎn)動軸的角速率,結(jié)合光電編碼器同軸驅(qū)動輪的半徑,就可算得移動機器人驅(qū)動輪的實時線速度。實際編程中,使用微控制器定時器0產(chǎn)生的IKHz時基中斷產(chǎn)生固定時間段。設(shè)V為t時間內(nèi)的平均速度,由于計算速度所需的時間段足夠小,所以可將平均速度V近似為實時速度,那么實時速度(3-1)式中,S為驅(qū)動輪轉(zhuǎn)動產(chǎn)生的位移,n為所經(jīng)歷的固定時間段的記數(shù),l為光電編碼器驅(qū)動輪的周長,N為光電編碼器旋轉(zhuǎn)一周輸出的脈沖數(shù),此處N=500.3.光電編碼器測速的誤差分析影響光電編碼器計數(shù)精度的原因在于,編碼器的主碼盤被激振而附加了瞬間的隨機高頻振動,從而引起在透光窗邊沿附近發(fā)生小幅度晃動,振動的響應(yīng)和頻率與主碼盤本身及激振的頻率有關(guān)。.在瞬間高頻振動的時刻,原來一個方波周期內(nèi)可能包含幾個高頻方波脈沖,如果計數(shù)電路中不加措施就會導(dǎo)致計數(shù)結(jié)果偏離實際值,引起誤計數(shù)?!擦尺b操作模塊本課題的移動機器人具備多種工作模式,既可以按照預(yù)先編程的路徑運動,也可以根據(jù)遙控指令,實時調(diào)整自身運動狀態(tài),完成前進、后退、停止、轉(zhuǎn)向等根本動作。圖3.3遙操作模塊工作原理圖移動機器人遙操作模塊的工作原理如圖3.3所示。按鍵的鍵值被編碼模塊編譯為特定串行碼,此串行碼輸入至發(fā)射電路,作為發(fā)射電路的控制信號。串行碼由發(fā)射電路調(diào)制到高頻載波,通過天線向外發(fā)射。接收局部經(jīng)天線收到調(diào)制信號,該調(diào)制信號由接收電路處理為特定串行碼,此串行碼包含了操作者的按鍵信息。通過和編碼模塊配套使用的解碼模塊,即可從串行碼中別離出相應(yīng)鍵值。從而移動機器人根掘操作者的按鍵值,做出相應(yīng)動作[28,31,32].其中,發(fā)射和接收電路采用模塊化的315MHz超再生式RF收發(fā)模塊。RF收發(fā)模塊的引腳分別為DATAOUT/IN、VCC和GND三線接口。只需將編碼器的數(shù)據(jù)輸出端與RF發(fā)射模塊的DATAIN引腳連接,RF接收模塊的DATAOUT引腳與解碼器的數(shù)據(jù)輸入端14連接,系統(tǒng)即可正常工作。編解碼電路選用臺灣普城公司生產(chǎn)的PT2262/2272專用編解碼芯片。PT2262/2272是一種CMOS工藝制造的低功耗低價位通用編解碼電路,PT2262/2272最多可有12位(AO-A11)三態(tài)地址端管腳(懸空、接高電平、接低電平),任意組合可提供531441地址碼。PT2262最多可有6位(DO-D5)數(shù)據(jù)端管腳,設(shè)定的地址碼和數(shù)據(jù)碼從17腳串行輸出,主要用于無線遙控發(fā)射電路[29,30]。編碼芯片PT2262發(fā)出的編碼信號由:地址碼、數(shù)掘碼、同步碼組成一個完整的碼字,解碼芯片PT2272接收到信號后,其地址碼經(jīng)過兩次比擬核對后,VT腳才輸出高電平,與此同時相應(yīng)的數(shù)掘腳也輸出高電平。因此,微控制器讀取PT2272的數(shù)據(jù)輸出端電平即可獲得操作者的按鍵鍵值。如果發(fā)送端一直按住按鍵,編碼芯片也會連續(xù)發(fā)射。當(dāng)發(fā)射機沒有按鍵按下時,PT2262不接通電源,其17腳為低電平,所以315MHz的高頻發(fā)射電路不工作,當(dāng)有按鍵按下時,PT2262得電工作,其第17腳輸出經(jīng)調(diào)制的串行數(shù)掘信號。當(dāng)17腳為高電平時315MHz的高頻發(fā)射電路起振并發(fā)射等幅高頻信號,當(dāng)17腳為低平時315MHz的高頻發(fā)射電路停止振蕩。所以高頻發(fā)射電路完全受控于PT2262的17腳輸出的數(shù)字信號,從而對高頻電路完成幅度鍵控(ASK調(diào)制)相當(dāng)于調(diào)制度為100%的調(diào)幅。以下是主程序中檢測l鍵是否按下的局部源碼,設(shè)計中添加了檢測松開按鍵時產(chǎn)生的上跳沿的功能。#defineK16//PB6#defineK27//PB7#defineK36//PD6#defineK47//PD7If(PINB&BIT(K1)){//specialfunctionsforK1while(PINB&BIT(K1);//waitingforreleaseK1}〔七〕電源模塊作為無纜工作的移動機器人,必需自帶能源。本課題設(shè)計的移動機器人,能耗主要來源于機器人控制電路和驅(qū)動電機兩局部。其中機器人控制電路局部使用+5V直流供電,驅(qū)動電機局部那么需要+12V直流供電。綜合考慮移動機器人自重、單次工作時間以及電池體積、維護本錢等多方面因素,我們將單節(jié)容量600mAH、額定電壓3.7V的鋰電池4節(jié)串連后使用,作為移動機器人的車載能源。與密封鉛酸電池、鎳鎘電池、鎳氫電池相比,鋰電池具有最高的能量/重量比和能量/體積比。并且,鋰電池具有輸出電流大,無記憶效應(yīng)、無污染、電池循環(huán)充放電次數(shù)多(壽命長)等優(yōu)點[33,34]。1.移動機器人電源設(shè)計如前文所述,采用4節(jié)3.7V鋰電池串連使用可以提供14.8V直流電壓。而機器人控制電路需要+5V直流供電,驅(qū)動電機局部那么需要+12V直流供電。假設(shè)采用傳統(tǒng)穩(wěn)壓方案,將14.8V直流電壓依次通過7812、7809、7805得到+12V和+5V電壓,會存在嚴(yán)重的能源損耗問題。這是由于78XX系列穩(wěn)壓塊均采用線性調(diào)壓原理,即輸入高電壓和輸出穩(wěn)壓值之間的壓差全部以發(fā)熱的形式消耗。因此,這種供電方案不適合用于對能源利用效率要求相對苛刻的移動機器人系統(tǒng)。為了消除線性穩(wěn)壓的弊端,有效提高能源利用效率,本課題采用單片開關(guān)式lA穩(wěn)壓電路LM2575-12和LM2575-5作為系統(tǒng)電源的核心。LM2575系列開關(guān)穩(wěn)壓集成電路由美國國家半導(dǎo)體公司生產(chǎn),它內(nèi)部集成了一個固定的振蕩器,只須極少外圍器件便可構(gòu)成一種高效的穩(wěn)壓電路,可大大減小散熱片的體積,而且在大多數(shù)情況下不需散熱片;內(nèi)部有完善的保護電路,包括電流限制及熱關(guān)斷電路等;芯片可提供外部控制引腳。LM2575系列開關(guān)穩(wěn)壓集成電路最大輸出電流1A:最大輸入電壓為45V;內(nèi)置振蕩頻率54kHz;最大穩(wěn)壓誤差4%;轉(zhuǎn)換效率可達75%~88%(不同的電壓輸出的效率不同)。在使用LM2575設(shè)計電路時,著重考慮了以下幾點:(1)電感的選擇。根掘輸出的電壓檔次、最大輸入電壓Vin(MAX)、最大負載電流Iload(MAX)等參數(shù)選擇電感時可參照產(chǎn)品手冊上相應(yīng)的電感曲線圖來查找所需采用的電感值。(2)輸入輸出電容的選擇。輸入電容應(yīng)大于47uF,并要求盡量靠近電路:而輸出電容推薦使用的電容量為100uF~470uF,其耐壓值應(yīng)大于額定輸出的1.5~2倍。例如,對于5V電壓輸出,推薦使用耐壓值為16V的電容。(3)二極管的選擇。二極管的額定電流值應(yīng)大于最大負載電流的1.2倍,但考慮到負載短路的情況,二極管的額定電流值應(yīng)大于LM2575的最大電流限制;另外二極管的反向電壓應(yīng)大于最大輸入電壓的1.25倍。(4)控制電路中,紅外一體化接收頭必須有良好的電源濾波,以減少電源紋波對傳感器內(nèi)部電路的干擾?!舶恕钞惒酱型ㄐ拍K本課題討論的移動機器人,具備離線預(yù)定義運動路徑的功能。可通過上位機應(yīng)用程序?qū)C器人的運動路徑進行預(yù)編程,然后將運動路徑由異步串口下載至機器人內(nèi)部存儲器。之后,將機器人切換到預(yù)定義運動模式,機器人即可按照事先編程的路徑運動。此功能對實現(xiàn)特定環(huán)境中的嚴(yán)格運動控制有較大的意義[35]。由于運動路徑下載過程中,移動機器人與上位機位置相對較近,故本設(shè)計選用RS-232異步串行口實現(xiàn)全雙工通信。兩者之間使用三芯屏蔽電纜作為傳輸介質(zhì)。RS-232是為早期公共網(wǎng)數(shù)掘通信制定的標(biāo)準(zhǔn),以+5V~+15V表示低電平O、-5V~-15V表示高電平1,與現(xiàn)有微控制器邏輯電平不一致,二者之間必須進行電平轉(zhuǎn)換。此處選用MAXIM公司生產(chǎn)的MAX232芯片實現(xiàn)電平轉(zhuǎn)換。MAX232芯片具有兩個接收發(fā)送通道,功耗低、集成度高、+5V電壓供電,僅需外接少量阻容元件,就能實現(xiàn)微控制器標(biāo)準(zhǔn)電平與RS-232電平的轉(zhuǎn)換。其中,上位機發(fā)送的數(shù)據(jù)通過串口2針XRXD進入MAX232芯片8腳,轉(zhuǎn)換后由9腳輸出至ATMEGAl6的PDO,即下位機RXD。下位機ATMEGAl6發(fā)送的數(shù)據(jù),通過PDl即下位機TXD進入MAX232芯片10腳,轉(zhuǎn)換后由7腳輸出到串口3針XTXD,發(fā)送至上位機。兩者之間通信采用基于幀的傳輸協(xié)議,即串口傳輸?shù)臄?shù)據(jù)以幀的格式發(fā)送接收。上位機是主控者,下位機微控制器是處于從動方式。串行通信的數(shù)據(jù)格式采用(4800,N,8,1),即4800波特率,無奇偶校驗,8位數(shù)掘位,l位停止位。數(shù)據(jù)內(nèi)容選用定長幀結(jié)構(gòu)存儲。上位機發(fā)送的幀包括起始幀和數(shù)據(jù)幀。兩者的幀長度都為4個字節(jié)。具體結(jié)構(gòu)如表3.1所示。表3.1異步通信幀的組成起始標(biāo)志位運動步驟數(shù)OxffOxffOxff0~255左輪轉(zhuǎn)速右輪轉(zhuǎn)速運動時間0~2500~2500~2550~255其中,起始幀的前3個字節(jié)做為起始標(biāo)志,填充Oxff:第4個字節(jié)指明預(yù)編程運動路徑中總共包括的步驟數(shù)。數(shù)掘幀的第1、2個字節(jié)分別為移動機器人左右輪的轉(zhuǎn)速的相對值,取值范圍0~250,以區(qū)別于起始標(biāo)志位的255;第3、4個字節(jié)為機器人保持此種運動狀念的持續(xù)時間,單位為lOms,取值范圍0~655s。微控制器將每個幀數(shù)據(jù)接收并保存于外部存儲器,當(dāng)收到按照預(yù)編程路徑運動的指令時,移動機器人只需依次讀取每個幀的數(shù)據(jù),并轉(zhuǎn)換為后一個的運動狀態(tài)就可以實現(xiàn)全部的運動要求。微控制器局部采用中斷方式接收上位機傳輸?shù)臄?shù)據(jù),以保證通信的實時性。其中,串行通信的中斷效勞程序的流程如圖3.4所示:圖3.4異步通信程序流程圖〔九〕I2C同步串行通信模塊12C(Inter--IntegratedCircuit)總線是一種由PHILIPS公司開發(fā)的兩線式串行總線,用于連接微控制器及其外圍設(shè)備[38,39]。I℃總線最初為音頻和視頻設(shè)備開發(fā),如今主要在效勞器管理中使用,其中包括單個組件狀態(tài)的通信。例如管理員可對各個組件進行查詢,以管理系統(tǒng)的配置或掌握組件的功能狀態(tài)??呻S時監(jiān)控內(nèi)存、硬盤,網(wǎng)絡(luò)、系統(tǒng)溫度等多個參數(shù),增加了系統(tǒng)的平安性,方便了管理[36,37]。隨著I2C總線在嵌入式開發(fā)中應(yīng)用的普及,很多微控制器件片內(nèi)集成了硬件I2C單元,即通過硬件產(chǎn)生通信所需的時序,開發(fā)者只需設(shè)定各種根本操作的步驟即可,大大提高了開發(fā)效率和微控制器帶寬的利用率。本設(shè)計所采用的ATMEGAl6內(nèi)部集成有硬件I2C單元。1.I2C總線工作原理I2C總線是由數(shù)掘線SDA和時鐘SCL構(gòu)成的串行總線,可發(fā)送和接收數(shù)據(jù)。在CPU與被控IC之間、IC與IC之間進行雙向傳送,最高傳送速率lOOkbps。各種被控制電路均并聯(lián)在這條總線上,但就像機一樣只有撥通各自的號碼才能工作,所以每個電路和模塊都有唯一的地址。在信息的傳輸過程中,I2C總線上并接的每一模塊電路既是主控器(或被控器),又是發(fā)送器(或接收器),這取決于它所要完成的功能。CPU發(fā)出的控制信號分為地址碼和控制量兩局部,地址碼用來選址,即接通需要控制的電路,確定控制的種類;控制量決定該調(diào)整的類別(如比照度、亮度等)及需要調(diào)整的量。這樣,各控制電路雖然掛在同一條總線上,卻彼此獨立,互不相關(guān)。2.總線根本操作I2C規(guī)程運用主/從雙向通訊。器件發(fā)送數(shù)據(jù)到總線上,那么定義為發(fā)送器,器件接收數(shù)據(jù)那么定義為接收器。主器件和從器件都可以工作于接收和發(fā)送狀態(tài)??偩€必須由主器件(通常為微控制器)控制,主器件產(chǎn)生串行時鐘(SCL)控制總線的傳輸方向,并產(chǎn)生起始和停止條件。SDA線上的數(shù)據(jù)狀態(tài)僅在SCL為低電平的期問才能改變。I2C總線在傳送數(shù)據(jù)過程中共有三種類型信號,它們分別是:開始信號、結(jié)束信號和應(yīng)答信號。開始信號:SCL為高電平時,SDA由高電平向低電平跳變,開始傳送數(shù)據(jù)。結(jié)束信號:SCL為低電平時,SDA由低電平向高電平跳變,結(jié)束傳送數(shù)據(jù)。應(yīng)答信號:接收數(shù)據(jù)的IC在接收到8bit數(shù)據(jù)后,向發(fā)送數(shù)據(jù)的IC發(fā)出特定的低電平脈沖,表示已收到數(shù)掘。CPU向受控單元發(fā)出一個信號后,等待受控單元發(fā)出一個應(yīng)答信號,CPU接收到應(yīng)答信號后,根據(jù)實際情況做出是否繼續(xù)傳遞信號的判斷。其中,I2C總線的開始信號和結(jié)束信號的時序如圖3.5所示。圖3.5I2C總線起止信號時序圖在起始條件之后,必須是器件的控制字節(jié),其中高四位為器件類型識別符,不同的芯片類型有不同的定義;接著三位為片選,最后一位為讀寫位,當(dāng)為1時為讀操作,為0時為寫操作。如表3.2所示。器件類型器件地址讀寫標(biāo)志位1010A2A1A0R/W表3.2I2C總線控制字節(jié)結(jié)構(gòu)發(fā)送到SDA線上的每個字節(jié)必須為8位。每次傳輸可以發(fā)送的字節(jié)數(shù)量不受限制,每個字節(jié)后必須跟一個響應(yīng)位,首先傳輸?shù)氖菙?shù)掘的最高位MSB。如果從機要完成一些其他功能后(例如一個內(nèi)部中斷效勞程序)就能接收或發(fā)送下一個完整的數(shù)據(jù)字節(jié),那么可以通過將時鐘線SCL拉低,迫使主機進入等待狀態(tài)。當(dāng)從機準(zhǔn)備好接收下一個數(shù)據(jù)字節(jié)并釋放時鐘線SCL后,數(shù)掘傳輸繼續(xù)。3.E2PROM存儲器接口設(shè)計本設(shè)計中,移動機器人具備按照預(yù)編程路徑運動的功能。每一運動步驟需要的信息包括左右輪轉(zhuǎn)速及該步驟的執(zhí)行時間。其中,左右輪轉(zhuǎn)速各占1個字節(jié),執(zhí)行時間占2個字節(jié),故每存儲一個運動步驟需4個字節(jié)的存儲器空間。對于運動步驟信息的保存,設(shè)計時必須滿足以下幾個方面:(1)支持在應(yīng)用(IAP)下載功能。即,每次下載新的運動數(shù)據(jù)時,無需更改機器人控制器源程序,這使移動機器人產(chǎn)品化后,用戶操作的簡潔性和產(chǎn)品內(nèi)核的保密性得到了保證。(2)存儲器必須為非揮發(fā)性。即,數(shù)據(jù)掉電不喪失。路徑存儲一次,之后,移動機器人每接收到此工作模式指令,都可以按照該路徑運動,不需重復(fù)編程。(3)存儲器需要支持按字節(jié)讀寫,并且讀寫次數(shù)足夠大>100000次。(4)存儲器接口電壓和工作電壓應(yīng)與微控制器電路匹配,接口簡單。對照以上要求,ATMEGAl6微控制器片內(nèi)自帶有8k字節(jié)FLASH程序存儲器,但無法實現(xiàn)非代碼段的在應(yīng)用編程,故不能采用;外擴FLASH存儲器具有掉電數(shù)據(jù)保存10年,單字節(jié)本錢很低等優(yōu)勢,但由于FLASH存儲器不支持按字節(jié)讀寫,并且讀寫次數(shù)<10000次,工作電壓<3.3V,故也不符合設(shè)計要求。最終,本設(shè)計中采用CATALYST公司的CAT24WCl6作為外擴預(yù)編程路徑存儲器,CAT24WCl6完全符合上述設(shè)計要求。CAT24WCl6是一個16K位串行CMOSEZPROM,內(nèi)部含有2048個8位字節(jié)。CATALYST公司的先進CMOS技術(shù)實質(zhì)上減少了器件的功耗。CAT24WCl6有一個16字節(jié)的頁寫緩沖器。該器件通過I℃總線接口進行操作,并且芯片內(nèi)部有專門的寫保護功能。圖3.624WCl6E2PROM引腳示意圖CAT24WCl6有DIP、SOIC或TSSOP等多種封裝形式,本設(shè)計采用DIP-8封裝。其中,AO~A2是器件地址選擇端,通過將相應(yīng)引腳接高或低以實現(xiàn)不同存儲器的地址,從而實現(xiàn)在總線上掛接多個存儲器;SDA是串行數(shù)據(jù)端,SCL是串行時鐘端;WP是寫保護使能端,當(dāng)WP引腳接高電平時,存儲器被寫保護,內(nèi)部數(shù)據(jù)只能讀出,無法修改,當(dāng)WP引腳接地或懸空時,那么允許器件進行正常的讀、寫操作;Vcc、Vss分別為電源正和地。電路連接中,微控制器的SCL(PCO)引腳和SDA(PCI)引腳分別與CAT24WCl6的相應(yīng)6、5腳連接即可。在字節(jié)寫模式下,主器件發(fā)送起始命令和從器件地址信息R/W給從器件。在從器件產(chǎn)生應(yīng)答信號后,主器件發(fā)送CAT24WCl6的字節(jié)地址。主器件在收到從器件的另一個應(yīng)答信號后,再發(fā)送數(shù)掘到被尋址的存儲單元。CAT24WCl6再次應(yīng)答并在主器件產(chǎn)生停止信號后,開始內(nèi)部數(shù)掘的擦寫。在內(nèi)部擦寫過程中CAT24WCl6不再應(yīng)答主器件的任何請求。在頁寫模式下,CAT24WCl6一次可以寫入16個字節(jié)的數(shù)據(jù)。頁寫操作的啟動和字節(jié)寫一樣。不同在于,傳送了1字節(jié)數(shù)掘后并不產(chǎn)生停止信號,主器件被允許發(fā)送15個額外的字節(jié)。每發(fā)送一個字節(jié)數(shù)掘后,CAT24WCl6產(chǎn)生一個應(yīng)答位,并將字節(jié)地址低位加1、高位保持不變。如果在發(fā)送停止信號之前主器件發(fā)送超過15個字節(jié),地址計數(shù)器將自動翻轉(zhuǎn),先前寫入的數(shù)掘被覆蓋。接收到16字節(jié)數(shù)據(jù)和主器件發(fā)送的停止信號后,CAT24WCl6啟動內(nèi)部寫周期,將數(shù)據(jù)寫到數(shù)據(jù)區(qū)。所有接收的數(shù)據(jù)在一個寫周期內(nèi)寫入CAT24WCl6。選擇性讀操作,允許主器件對存放器的任意字節(jié)進行讀操作。主器件首先通過發(fā)送起始信號、從器件地址和它想讀取的字節(jié)數(shù)據(jù)的地址,執(zhí)行一個偽寫操作。在CAT24WCl6應(yīng)答之后,主器件重新發(fā)送起始信號和從器件地址。此時R/W位置l。CAT24wcl6響應(yīng)并發(fā)送應(yīng)答信號,然后輸出所要求的一個8位字節(jié)數(shù)掘。主器件不發(fā)送應(yīng)答信號但產(chǎn)生一個停止信號。連續(xù)讀操作可通過選擇性讀操作啟動。在CAT24WCl6發(fā)送完一個8位字節(jié)數(shù)掘后,主器件產(chǎn)生一個應(yīng)答信號來響應(yīng)告知cAT24wCl6主器件要求更多的數(shù)據(jù)。對應(yīng)每個主機產(chǎn)生的應(yīng)答信號,CAT24WCl6將發(fā)送一個8位數(shù)據(jù)字節(jié)。當(dāng)主器件不發(fā)送應(yīng)答信號而發(fā)送停止位時結(jié)束此操作[39]?!彩诚到y(tǒng)可靠性設(shè)計控制系統(tǒng)質(zhì)量的上下主要表現(xiàn)在技術(shù)性能、可靠性、適應(yīng)性和經(jīng)濟性四個方面,其中技術(shù)性和可靠性是最重要的方面。但在系統(tǒng)的具體設(shè)計工作中,往往特別強調(diào)其技術(shù)性能指標(biāo)而無視了它的可靠性。而由于可靠性設(shè)計的不周密,在偶然因素或意外事件的作用下,系統(tǒng)便不能證常工作,從而可能造成災(zāi)難性的后果[40-43]。系統(tǒng)的可靠性保證有賴于完善的可靠性設(shè)計、嚴(yán)格的部件制作、標(biāo)準(zhǔn)的設(shè)備安裝調(diào)試、正確的操作使用和經(jīng)常性的維護。1.影晌系統(tǒng)可靠性的因素要提高控制系統(tǒng)運行的可靠性,必需依靠一系列可靠性技術(shù)束保證。引起系統(tǒng)故障的原因一般有兩大方面,一是系統(tǒng)運行的外界環(huán)境條件通過系統(tǒng)內(nèi)部反映出來的故障,二是系統(tǒng)內(nèi)部自身產(chǎn)生的故障。由環(huán)境條件引起故障的主要因素有:工作電源的異常、環(huán)境溫度的異常、電磁干擾、機械的沖擊和振動等等。由系統(tǒng)內(nèi)部引起故障的因素有:元器件的失效、焊接點的虛焊脫焊、接插件的導(dǎo)電接觸面的氧化或腐蝕、線路連接線的丌路或短路等等。因此結(jié)合引發(fā)系統(tǒng)故障的原因,一般在硬件電路設(shè)計和軟件程序設(shè)計中采取相應(yīng)措施提高系統(tǒng)的可靠性。2.采取的措施本運動控制系統(tǒng)的設(shè)計充分考慮了可靠性這一指標(biāo),主要表達在以下幾個方面[40-43]:(1)屏蔽技術(shù)本系統(tǒng)中,直流電機、驅(qū)動部件的PWM輸出甚至是微控制器使用的振蕩器,都是電磁干擾的噪聲源。當(dāng)距離較近時,電磁波會通過分布電容和電感藕合到信號回路而形成電磁干擾;當(dāng)距離較遠時,電磁波那么以輻射形式構(gòu)成干擾。針對上述情況,主要通過選用高導(dǎo)磁材料做成屏蔽體,使電磁波經(jīng)屏蔽體壁的低磁阻磁路快速衰減,以降低干擾。(2)地線的處理理解產(chǎn)生地線噪聲的機制對于減小地線干擾至關(guān)重要,所有地線都有阻抗,和所有電路一樣,電流必須流回其源點,電流通過地線上的有效阻抗將產(chǎn)生一個電壓降,這些電壓降就是地線干擾的原因。正確接地是控制系統(tǒng)抑制干擾所必須注意的重要問題,在設(shè)計中假設(shè)能把接地和屏蔽正確的結(jié)合,可很好地消除外界干擾的影響。接地設(shè)計的根本目的是消除各電路電流流經(jīng)公共地線時所產(chǎn)生的噪聲電壓,以及免受電磁場和地位差的影響,即使其不能形成地環(huán)路。(3)抑制自感電動勢干擾在本系統(tǒng)中,使用了電動機這種具有較大電感量的器件。當(dāng)電感回路的電流被切斷時,會產(chǎn)生很大的反電勢而形成噪聲干擾。這種噪聲不但能產(chǎn)生電磁場干擾其它回路,甚至還有可能擊穿電路中的晶體管之類的器件。對此在線圈兩端并聯(lián)了二極管束抑制反向自感電勢的干擾。(4)看門狗技術(shù)[44]微控制器受到干擾而失控,引起程序亂飛,也可能使程序陷入“死循環(huán)〞,導(dǎo)致無法執(zhí)行正常的程序流程。要使程序擺脫“死循環(huán)〞的困境,通常采用程序監(jiān)視技術(shù),又稱“看門狗(WatchDog)〞技術(shù)??撮T狗實際上是一個特殊的定時器DogTimer,DogTimer按固定速率計時,計滿預(yù)定時間就發(fā)出溢出脈沖,使微控制器復(fù)位。如果每次在DogTimer溢出前強行使DogTimer清零,就不會發(fā)出溢出脈沖。清零脈沖由微控制器發(fā)出,在程序中每隔一段語句放一個清DogTimer的喂狗語句,以保證程序正常運行時DogTimer不會溢出,一旦程序進入一個不含喂狗語句的死循環(huán),DogTimer將溢出,導(dǎo)致系統(tǒng)復(fù)位,跳出這個死循環(huán),由初始化局部丌始重新執(zhí)行。本設(shè)計使用ATMEGAl6內(nèi)置的看門狗功能,DogTimer溢出時間設(shè)定為1.0s。程序在主循環(huán)中每執(zhí)行一個或幾個子程序喂一次看門狗,兩次喂狗的時間不能超過1.0s。四、總結(jié)本論文首先對國內(nèi)外移動機器人的研究現(xiàn)狀進行了總結(jié),分析了移動機器人控制系統(tǒng)的研究背景和意義。在此根底上,設(shè)計了移動機器人的控制系統(tǒng),并提出了基于模糊控制策略的運動控制方案。在本論文完成過程中涉及的工作主要包括以下方面:設(shè)計實現(xiàn)了遠、近距離下均具有很高靈敏度的避障模塊。設(shè)計實現(xiàn)了電機驅(qū)動模塊。驅(qū)動輪的速度通過同軸安裝的增量式光電編碼器實時獲得,作為速度閉環(huán)控制的依據(jù)。設(shè)計實現(xiàn)了預(yù)編程路徑存儲模塊。參考文獻[1]李磊,葉濤等.移動機器人技術(shù)研究現(xiàn)狀與未來.機器人.2002年9月:475-480[2]章小兵.宋愛國.地面移動機器人研究現(xiàn)狀及開展趨勢.機器人技術(shù)與府刪,2005年2劃:19-23[3]張明路,丁承君等.移動機器人的研究現(xiàn)狀與趨勢.,河北工業(yè)大學(xué)學(xué)報,2004年4月:110-114[4]徐國華.譚民.移動機器人的開展現(xiàn)狀及其趨勢.機器人技術(shù)與應(yīng)用,2001年第3期:7-14[5]蔡自興.機器人學(xué).清華大學(xué)出版社,2000[6]TFong,INourbakhsh.AsurveyofsociallyinteractiverobotsRoboticsandAutonomousSystems,v0l.42。2003,PP.143-166[7]馬光.仿生機器人的研究進展.機器人,2001年9月:463--465[8]何消華,繭素平.智能輪椅的研究現(xiàn)狀和開展趨勢.機器人技術(shù)與應(yīng)用,2003年第2期:12-16[9]譚定忠,千啟明答.清沾機器人研究開展現(xiàn)狀.機械1:稃師,2004年6月:9-10[10]柳長安,李國棟等.籌動驅(qū)動式移動機器人的運動規(guī)劃.哈爾濱工業(yè)大學(xué)學(xué)報,2003年9月:1095-1097[11]徐俊飽,張培仁:.非完整輪式移動機器人軌跡跟蹤控制研究中國科學(xué)技術(shù)大學(xué)學(xué)報,2004年6月:336-380[12]金秀慧,伊近云等.基丁通用運動學(xué)模型的移動機器人避障路徑規(guī)劃.機械工程師,2005年第12期:34-35[13]朱向彬,曹作良,移動機器人動力學(xué)建模及返動控制仿真.天津理工大學(xué)學(xué)報,2005年1期:54-57[14]黃永忠,陳甲爾.兩輪移動機器人運動控制系統(tǒng)的設(shè)計與實現(xiàn).機器人,2004年1期:40-43[15]韓人鵬,韋慶.機器人控制器的一種模塊化設(shè)計方法,微計算機信息,2005年第5期:3-4[16]MasahiroFujita,HiroakiKitano.Areconfigurablerobotplatform.RoboticsandAutonomousSystems29(1999):119-132[17]ElieMaalouf,MaaroufSaad.Ahigherlevelpathtrackingcontrollerforafour—wheeldifferentiallysteeredmobilerobot.RoboticsandAutonomousS

溫馨提示

  • 1. 本站所有資源如無特殊說明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請下載最新的WinRAR軟件解壓。
  • 2. 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
  • 3. 本站RAR壓縮包中若帶圖紙,網(wǎng)頁內(nèi)容里面會有圖紙預(yù)覽,若沒有圖紙預(yù)覽就沒有圖紙。
  • 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
  • 5. 人人文庫網(wǎng)僅提供信息存儲空間,僅對用戶上傳內(nèi)容的表現(xiàn)方式做保護處理,對用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對任何下載內(nèi)容負責(zé)。
  • 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請與我們聯(lián)系,我們立即糾正。
  • 7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時也不承擔(dān)用戶因使用這些下載資源對自己和他人造成任何形式的傷害或損失。

最新文檔

評論

0/150

提交評論