




已閱讀5頁,還剩28頁未讀, 繼續(xù)免費(fèi)閱讀
版權(quán)說明:本文檔由用戶提供并上傳,收益歸屬內(nèi)容提供方,若內(nèi)容存在侵權(quán),請(qǐng)進(jìn)行舉報(bào)或認(rèn)領(lǐng)
文檔簡介
基于超聲波測距的自主移動(dòng)機(jī)器人路徑規(guī)劃摘要隨著機(jī)器人技術(shù)的不斷發(fā)展,自主移動(dòng)機(jī)器人正越來越成為研究的熱點(diǎn)。導(dǎo)航技術(shù)是其研究核心,而路徑規(guī)劃又是移動(dòng)機(jī)器人導(dǎo)航中最重要的任務(wù)之一?;诔暡y距的自主移動(dòng)機(jī)器人路徑規(guī)劃是移動(dòng)機(jī)器人技術(shù)中的一項(xiàng)重要研究課題。本文對(duì)基于超聲波測距的自主移動(dòng)機(jī)器人路徑規(guī)劃問題進(jìn)行了較為深入的探討和分析。首先。對(duì)自主移動(dòng)機(jī)器人的發(fā)展?fàn)顩r,以及移動(dòng)機(jī)器人導(dǎo)航技術(shù)和路徑規(guī)劃技術(shù)的國內(nèi)外發(fā)展現(xiàn)狀進(jìn)行了綜述。然后介紹了超聲波測距原理,討論了超聲波測距系統(tǒng)應(yīng)用于導(dǎo)航技術(shù)的優(yōu)勢。重點(diǎn)探討了基于超聲波測距的自主移動(dòng)機(jī)器人路徑規(guī)劃技術(shù),采用柵格法進(jìn)行環(huán)境建模,運(yùn)用了一種稱作沿邊走的算法進(jìn)行了路徑規(guī)劃。最后分析了現(xiàn)有方案的優(yōu)缺點(diǎn),展望了機(jī)器人路徑規(guī)劃技術(shù)的未來發(fā)展趨勢和研究方向。關(guān)鍵字:自主移動(dòng)機(jī)器人;超聲波;路徑規(guī)劃 THE PATH PLANNING OF AUTONOMOUS MOBILE ROBOT BASED ON ULTRASONIC RANGINGABSTRACTWith the continuous development of the robot technology, the autonomous mobile robot technology is becoming the hot. Among which,the navigation technique is the core question,at the same time,the path planning is the most important task of the autonomous mobile robot navigation technology.It is an important research of the mobile robot technology that the path planning of autonomous mobile robot based on ultrasonic ranging.The present development situation of the autonomous mobile robot and the navigation technology of the mobile robot and path planning technology in the domestic and foreign are introduced in the thesis.It has introduced the ultrasonic ranging principle and discusses the superiority of ultrasonic ranging system to apply in the navigation. It has discussed the question with emphasis that the path planning of autonomous mobile robot based on ultrasonic ranging. In this thesis,a method called grid is used to carry on the environment model, and a kind of algorithm called along wall is used to plan the path. Finally it has analyzed the advantage and shortcoming of existing planning method,and forecasted the future development tendency and the research direction of the robot path planning technology.Key words: autonomous mobile robot ; ultrasonic; path planning 目 錄第一章 緒論-51.1 論文背景和意義-51.2 國內(nèi)外研究現(xiàn)狀-61.2.1 自主移動(dòng)機(jī)器人導(dǎo)航技術(shù)現(xiàn)狀-61.2.2 自主移動(dòng)機(jī)器人路徑規(guī)劃技術(shù)現(xiàn)狀-71.3 本論文的主要內(nèi)容-9第二章 超聲波測距技術(shù)-102.1 移動(dòng)機(jī)器人中的測距技術(shù)-102.1.1 無源測距技術(shù)-102.1.2 有源測距技術(shù)-102.2 測距傳感器的選擇性分析-122.3 超聲波測距-132.3.1 超聲波發(fā)生器-132.3.2 壓電式超聲波發(fā)生器原理-142.3.3 超聲波測距原理-142.4 本章小結(jié)-15第三章 環(huán)境建模-163.1 柵格法簡介-163.2 柵格法建模-173.3 基于超聲波傳感器測距的柵格化方法-173.4 本章小結(jié)-18第四章 基于超聲波測距的沿邊走路徑規(guī)劃的導(dǎo)航算法-19 4.1 坐標(biāo)系的建立-194.2 基于超聲波測距的沿邊走路徑規(guī)劃機(jī)器人的導(dǎo)航算法-20 4.2.1 沿邊走算法簡介-20 4.2.2 沿邊走過程-21 4.3 沿邊走路徑規(guī)劃流程圖-234.4 本章小結(jié)-24 第五章 結(jié)果分析-255.1仿真結(jié)果-255.2 結(jié)果分析-265.3 本章小結(jié)-26第六章 現(xiàn)有方案缺陷及路徑規(guī)劃技術(shù)的發(fā)展趨勢-27 第七章 結(jié)論-29參考文獻(xiàn)-30致謝-31附錄-32第一章 緒論1.1 論文背景和意義自1962年美國研制出世界上第一臺(tái)工業(yè)機(jī)器人以來,經(jīng)過40余年的發(fā)展,機(jī)器人技術(shù)以及應(yīng)用都已取得非常大的進(jìn)步??梢哉f機(jī)器人的出現(xiàn),是20世紀(jì)人類最偉大的發(fā)明之一。科學(xué)家對(duì)機(jī)器人的定義是:“機(jī)器人是一種自動(dòng)化的機(jī)器,所不同的是這種機(jī)器具備一些與人或生物相似的智能能力,如感知能力、規(guī)劃能力、動(dòng)作能力和協(xié)同能力,是一種具有高度靈活性的自動(dòng)化機(jī)器”1。隨著機(jī)器人的應(yīng)用越來越廣泛,人們對(duì)機(jī)器人技術(shù)智能化本質(zhì)的認(rèn)識(shí)也在不斷加深,機(jī)器人技術(shù)開始向人類活動(dòng)的各個(gè)領(lǐng)域滲透。于是出現(xiàn)了各式各樣的具有感知、決策、行動(dòng)和交互能力的特種機(jī)器人和各種智能機(jī)器,如微機(jī)器人、水下機(jī)器人、醫(yī)療機(jī)器人、軍用機(jī)器人、空中空間機(jī)器人、娛樂機(jī)器人等。機(jī)器人技術(shù)在不斷發(fā)展,人們對(duì)機(jī)器人在社會(huì)服務(wù)、野外作業(yè)以及在有害、危險(xiǎn)環(huán)境作業(yè)中的應(yīng)用也越來越重視。研究能夠在復(fù)雜環(huán)境中自主運(yùn)動(dòng)和自動(dòng)作業(yè)的智能自主移動(dòng)機(jī)器人勢在必行。移動(dòng)機(jī)器人是機(jī)器人學(xué)的一個(gè)重要分支,其研究始于20 世紀(jì)60年代。移動(dòng)機(jī)器人由于具有更大的使用靈活性已成為目前機(jī)器人技術(shù)研究的一個(gè)熱點(diǎn)。近年來,移動(dòng)機(jī)器人技術(shù)在工業(yè)、農(nóng)業(yè)、航天及空間探測等許多領(lǐng)域都起到了重要的作用,顯示了廣泛的應(yīng)用前景2。自主式移動(dòng)機(jī)器人具有高度自規(guī)劃、自組織、自適應(yīng)能力,適合于在復(fù)雜的非結(jié)構(gòu)化環(huán)境中工作。自主式移動(dòng)機(jī)器人的目標(biāo)是在沒有人的干預(yù)、無需對(duì)環(huán)境做任何規(guī)定和改變的條件下,有目的地移動(dòng)和完成相應(yīng)任務(wù)。在自主式移動(dòng)機(jī)器人相關(guān)技術(shù)的研究中,導(dǎo)航技術(shù)是其研究核心,也是移動(dòng)機(jī)器人實(shí)現(xiàn)智能化及完全自主的關(guān)鍵技術(shù)。而路徑規(guī)劃又是移動(dòng)機(jī)器人導(dǎo)航中最重要的任務(wù)之一?;诔暡y距的自主移動(dòng)機(jī)器人路徑規(guī)劃正是機(jī)器人智能控制技術(shù)中的一項(xiàng)重要課題。1.2 國內(nèi)外研究現(xiàn)狀 機(jī)器人技術(shù)是一門綜合性的學(xué)科。世界各地的專家學(xué)者都在不斷致力于機(jī)器人技術(shù)的研究,尤其是移動(dòng)機(jī)器人的導(dǎo)航和路徑規(guī)劃技術(shù)方面,已經(jīng)取得了相當(dāng)多的研究成果。1.2.1 自主移動(dòng)機(jī)器人導(dǎo)航技術(shù)現(xiàn)狀導(dǎo)航是移動(dòng)機(jī)器人應(yīng)具備的基本功能,是移動(dòng)機(jī)器人實(shí)現(xiàn)智能化及完全自主工作的關(guān)鍵技術(shù)之一。理想的移動(dòng)機(jī)器人應(yīng)具有以下能力:當(dāng)處于一個(gè)未知的、復(fù)雜的、動(dòng)態(tài)的非結(jié)構(gòu)環(huán)境中,并且在沒有人的干預(yù)下,通過感知環(huán)境,能夠到達(dá)期望的目的地,同時(shí)應(yīng)盡量減少時(shí)間或能量的消耗等。正是由于有了導(dǎo)航裝置,移動(dòng)機(jī)器人在行走過程中才能確定行動(dòng)的方向,才不會(huì)與障礙物發(fā)生碰撞。移動(dòng)機(jī)器人常見的導(dǎo)航方式有磁導(dǎo)航、慣性導(dǎo)航、激光導(dǎo)航、視覺導(dǎo)航等。地下埋線的導(dǎo)航方式是20世紀(jì)50年代美國開發(fā)的,到20世紀(jì)70年代這種導(dǎo)航方式迅速發(fā)展并應(yīng)用于柔性生產(chǎn)。目前,國內(nèi)制造行業(yè)使用的移動(dòng)機(jī)器人大多還是基于這種導(dǎo)航方式。該導(dǎo)航方式的技術(shù)已十分成熟,但其成本高,改造和維護(hù)困難。就國內(nèi)研究現(xiàn)狀來看,以上幾種導(dǎo)航方式均在研究之中,而磁導(dǎo)航方式的技術(shù)已相當(dāng)成熟。中國科學(xué)院沈陽自動(dòng)化研究所已生產(chǎn)出基于磁導(dǎo)航的多代機(jī)器人產(chǎn)品。其他導(dǎo)航方式的機(jī)器人也在研究之中,如:清華大學(xué)已研制的三代THMR 移動(dòng)機(jī)器人,上海大學(xué)的“導(dǎo)購機(jī)器人”、哈爾濱工業(yè)大學(xué)研制的“導(dǎo)游機(jī)器人”和正在開發(fā)的各種服務(wù)機(jī)器人。諸多研究表明:視覺導(dǎo)航方式具有信號(hào)探測范圍寬、獲取信息完整等優(yōu)點(diǎn), 將成為未來機(jī)器人導(dǎo)航的一個(gè)主要發(fā)展方向。在視覺導(dǎo)航方式中,目前國內(nèi)外應(yīng)用最多的還是采用在機(jī)器人上安裝車載攝像機(jī)的基于局部視覺的導(dǎo)航方式,如:D. L. Boley3等研制的移動(dòng)機(jī)器人利用車載攝像機(jī)和較少的傳感器通過識(shí)別路標(biāo)進(jìn)行導(dǎo)航,比直接采用卡爾曼濾波器獲得了更好的實(shí)時(shí)性,并有效抑制了噪聲;A. Ohya4等利用車載攝像機(jī)和超聲波傳感器研究了基于視覺導(dǎo)航系統(tǒng)中的避碰問題;P. I. Corke5等對(duì)由車載攝像機(jī)構(gòu)成的移動(dòng)機(jī)器人視覺閉環(huán)系統(tǒng)的研究表明,這種控制方法對(duì)提高路徑跟蹤精度有較好效果。視覺導(dǎo)航研究由于受到現(xiàn)有計(jì)算設(shè)備運(yùn)算速度和存儲(chǔ)容量的限制而發(fā)展較慢,但隨著計(jì)算機(jī)圖像處理能力和技術(shù)的提高,加之視覺導(dǎo)航具有信號(hào)探測范圍寬、目標(biāo)信息完整等優(yōu)勢,在圖像處理速度得到解決之后,視覺導(dǎo)航仍將是主要導(dǎo)航方式。在一個(gè)智能系統(tǒng)中,使用單一的智能控制方法,往往不能取得滿意的效果。應(yīng)綜合采用常規(guī)控制方法和智能控制方法,才能夠取得良好效果。 神經(jīng)網(wǎng)絡(luò)和模糊推理是自主導(dǎo)航研究中的兩個(gè)重要工具,但是神經(jīng)網(wǎng)絡(luò)樣本集的完整性研究尚未取得突破,將事件空間的每一點(diǎn)都作為網(wǎng)絡(luò)的學(xué)習(xí)樣本顯然是不可取的;模糊邏輯推理則側(cè)重于模糊規(guī)則的選取,但有些規(guī)則很難形式化描述,或者必須用大量的規(guī)則描述而增大運(yùn)算量,這樣就背離了模糊邏輯應(yīng)用的初衷,因此近年來將神經(jīng)網(wǎng)絡(luò)與模糊邏輯結(jié)合起來,應(yīng)用到自主導(dǎo)航研究中就成了機(jī)器人研究的熱門課題。傳感器融合技術(shù)在近年來被引入到了機(jī)器人導(dǎo)航研究中,并已取得令人振奮的成果,采用常規(guī)傳感器導(dǎo)航的移動(dòng)機(jī)器人將成為機(jī)器人產(chǎn)業(yè)的主要發(fā)展方向。 當(dāng)然,在一些復(fù)雜的地理?xiàng)l件下,非視覺傳感器的探測范圍就不如視覺系統(tǒng)那么完整,目前對(duì)于一些高精度的導(dǎo)航還難以勝任,因而開發(fā)新型傳感器或按照一定融合策略構(gòu)造傳感器陣列以彌補(bǔ)單個(gè)傳感器的缺陷,以及提出新的融合方法來完善探測的結(jié)果,都將是重要的研究方向。1.2.2 移動(dòng)機(jī)器人路徑規(guī)劃技術(shù)現(xiàn)狀路徑規(guī)劃是移動(dòng)機(jī)器人導(dǎo)航中最重要的任務(wù)之一。它是按照某一性能指標(biāo)搜索一條從起始狀態(tài)到目標(biāo)狀態(tài)的最優(yōu)或近似最優(yōu)的無碰路徑。機(jī)器人路徑規(guī)劃的研究起始于20 世紀(jì)70 年代,目前對(duì)這一問題的研究仍然十分活躍,國內(nèi)外學(xué)者作了大量的工作。目前,路徑規(guī)劃可以分為三種類型:一種是基于環(huán)境先驗(yàn)完全信息的路徑規(guī);另一種是基于傳感器信息的不確定環(huán)境的路徑規(guī)劃;第三種是基于行為的路徑規(guī)劃方法。(1) 基于環(huán)境先驗(yàn)完全信息的路徑規(guī)劃 該方法也被稱為全局路徑規(guī)劃,能夠處理完全已知環(huán)境下的移動(dòng)機(jī)器人路徑規(guī)劃。當(dāng)環(huán)境發(fā)生變化時(shí),如出現(xiàn)未知障礙物時(shí),這種方法就無能為力了。這種方法包括以下幾種:可視圖法,柵格法和拓?fù)浞ǖ???梢晥D法(visibility graph)6是將機(jī)器人視為一點(diǎn),把機(jī)器人、目標(biāo)點(diǎn)和多邊形障礙物的各個(gè)頂點(diǎn)進(jìn)行連接,要求機(jī)器人和障礙物各頂點(diǎn)之間,目標(biāo)點(diǎn)和障礙物各頂點(diǎn)之間以及各障礙物頂點(diǎn)與頂點(diǎn)之間的連線,都不能穿越障礙物,這樣就形成了一張圖,稱之為可視圖。由于任意兩直線的頂點(diǎn)都是可視的,顯然移動(dòng)機(jī)器人從起點(diǎn)沿著這些連線到達(dá)目標(biāo)點(diǎn)的所有路徑均是無碰路徑。對(duì)可視圖進(jìn)行搜索,并利用優(yōu)化算法刪除一些不必要的連線以簡化可視圖,縮短了搜索時(shí)間,最終就可以找到一條無碰最優(yōu)路徑。柵格法(grids)7是將移動(dòng)機(jī)器人工作環(huán)境分解成一系列具有二值信息的網(wǎng)格單元,多采用二維笛卡兒矩陣柵格表示工作環(huán)境,每一個(gè)矩形柵格都有一個(gè)累積值CV,表示在此方位中存在障礙物的可信度。CV 值越高,表征存在障礙物的可能性越高。用柵格法表示格子環(huán)境模型中存在障礙物的可能性的方法起源于美國CMU大學(xué)。通過優(yōu)化算法在單元中搜索最優(yōu)路徑。由于該方法以柵格為單位記錄環(huán)境信息,環(huán)境被量化成具有一定分辨率的柵格,因此柵格的大小直接影響著環(huán)境信息存儲(chǔ)量的大小以及路徑搜索的時(shí)間,因此在實(shí)用上受到一定的限制。拓?fù)浞?是根據(jù)環(huán)境信息和運(yùn)動(dòng)物體的幾何特點(diǎn),將組成空間劃分成若干具有拓?fù)涮卣饕恢碌淖杂煽臻g,然后根據(jù)彼此間的連通性建立拓?fù)渚W(wǎng),從該網(wǎng)中搜索一條拓?fù)渎窂?。該方法的?yōu)點(diǎn)在于因?yàn)槔昧送負(fù)涮卣鞫蟠罂s小了搜索空間,其算法復(fù)雜性只與障礙物的數(shù)目有關(guān),在理論上是完備的。但建立拓?fù)渚W(wǎng)的過程是相當(dāng)復(fù)雜而費(fèi)時(shí)的,特別是當(dāng)增加或減少障礙物時(shí),如何有效地修正已經(jīng)存在的拓?fù)渚W(wǎng)絡(luò)以及如何提高圖形搜索速度是目前亟待解決的問題10 。但是針對(duì)一種環(huán)境,拓?fù)渚W(wǎng)只需建立一次,因而在其上進(jìn)行多次路徑規(guī)劃就可期望獲得較高的效率。(2) 基于傳感器信息的局部路徑規(guī)劃人工勢場法( artificial potential field) 最初由Khatib 提出9,這種方法由于它的簡單性和優(yōu)美性而被廣泛采用。其基本思想是把移動(dòng)機(jī)器人在已知全局環(huán)境中的運(yùn)動(dòng)看作一種虛擬的人工受力場中的運(yùn)動(dòng)。目標(biāo)點(diǎn)對(duì)機(jī)器人產(chǎn)生引力作用,障礙物對(duì)機(jī)器人產(chǎn)生斥力作用,引力和斥力的合力控制機(jī)器人的運(yùn)動(dòng)。這種方法結(jié)構(gòu)簡單,易于實(shí)現(xiàn)。但是這種方法也存在著一些缺點(diǎn):如存在陷阱區(qū),在相近的障礙物前不能發(fā)現(xiàn)路徑,在障礙物前產(chǎn)生振蕩以及在狹窄通道中擺動(dòng)等缺點(diǎn)。針對(duì)人工勢場法的缺陷,國內(nèi)外許多專家學(xué)者不斷尋找新的途徑,以克服該方法所存在的弊端。如文獻(xiàn)10結(jié)合柵型聲納測試,建立一種新類型的勢場函數(shù),為距離轉(zhuǎn)換路徑尋找算法。文獻(xiàn)11采用預(yù)測與勢場法相結(jié)合的算法解決移動(dòng)機(jī)器人的導(dǎo)航問題,取得了良好的效果。文獻(xiàn)12通過引入虛擬障礙物使搜索過程跳出局部最優(yōu)的陷阱,但引入虛擬障礙物可能會(huì)產(chǎn)生新的局部極小點(diǎn),同時(shí)也增加了算法的復(fù)雜度。基于傳感器的模糊控制方法和神經(jīng)網(wǎng)絡(luò)控制方法見文獻(xiàn),因其對(duì)硬件要求比較高,簡單的配置不易使移動(dòng)機(jī)器人實(shí)現(xiàn)快速實(shí)時(shí)運(yùn)動(dòng)規(guī)劃。(3) 基于行為的路徑規(guī)劃方法 所謂基于行為的研究方法是把移動(dòng)機(jī)器人所要完成的任務(wù)分解成一些基本的、簡單的行為單元,這些單元彼此協(xié)調(diào)工作。每個(gè)單元有自己的感知器和執(zhí)行器,二者緊耦合在一起,構(gòu)成感知?jiǎng)幼餍袨?,機(jī)器人根據(jù)行為的優(yōu)先級(jí)及結(jié)合本身的任務(wù)綜合作出反應(yīng)。該方法的主要優(yōu)點(diǎn)在于每個(gè)行為的功能較簡單,因此可以通過簡單的傳感器及其快速信息處理過程獲得良好的運(yùn)行效果。但這種方法主要考慮機(jī)器人的行為,而對(duì)機(jī)器人所要解決的問題以及所面臨的環(huán)境沒有任何的描述,只是通過在實(shí)際的運(yùn)行環(huán)境中機(jī)器人行為的選擇,達(dá)到最終的目標(biāo)。如何構(gòu)造和優(yōu)化機(jī)器人行為控制器是成功與否的關(guān)鍵。主要方法包括:基于傳感器信息的局部運(yùn)動(dòng)規(guī)劃方法和基于模糊邏輯及神經(jīng)網(wǎng)絡(luò)的監(jiān)督學(xué)習(xí)方法等。1.3 本論文的主要內(nèi)容本論文的主要研究基于超聲波測距的自主移動(dòng)機(jī)器人路徑規(guī)劃技術(shù),重點(diǎn)進(jìn)行了以下工作:(1)概述自主移動(dòng)機(jī)器人的發(fā)展?fàn)顩r,以及國內(nèi)外導(dǎo)航技術(shù)和路徑規(guī)劃技術(shù)的發(fā)展現(xiàn)狀。(2)介紹移動(dòng)機(jī)器人中的兩種常用測距技術(shù)有源測距和無源測距。并詳細(xì)介紹機(jī)器人超聲波測距原理以及超聲波測距系統(tǒng)應(yīng)用于導(dǎo)航技術(shù)的優(yōu)勢。(3)重點(diǎn)探討基于超聲波測距的自主移動(dòng)機(jī)器人路徑規(guī)劃技術(shù)。采用柵格法進(jìn)行環(huán)境建模,運(yùn)用一種稱作沿邊走的算法來進(jìn)行路徑規(guī)劃。(4)分析現(xiàn)有方案的優(yōu)缺點(diǎn),展望機(jī)器人路徑規(guī)劃技術(shù)的未來發(fā)展趨勢和研究方向。第二章 超聲波測距技術(shù)2.1 移動(dòng)機(jī)器人中的測距技術(shù) 在研究機(jī)器人的避障時(shí),環(huán)境信息的采集是研究的關(guān)鍵問題。距離測量為移動(dòng)機(jī)器人提供了周圍環(huán)境的二維或三維信息,是移動(dòng)機(jī)器人中不可缺少的組成部分。移動(dòng)機(jī)器人可以根據(jù)這些信息進(jìn)行實(shí)時(shí)避障、導(dǎo)航和執(zhí)行特定的任務(wù)。通常,對(duì)獲取這類環(huán)境信息的傳感器有兩方面的要求:一方面,需要有足夠大的視場來覆蓋整個(gè)工作區(qū);另一方面,需要有足夠高的采集速率以保證在運(yùn)動(dòng)的環(huán)境中提供實(shí)時(shí)的信息。2.1.1 無源測距技術(shù)經(jīng)典的距離測量方法使用無源測距技術(shù),我們稱之為被動(dòng)方法,例如立體視覺和結(jié)構(gòu)光方法。立體視覺:在機(jī)器人獲取信息的各種感知器中,視覺系統(tǒng)無疑是最重要的。從仿生學(xué)的角度來說,基于雙目視覺原理的立體視覺系統(tǒng)最接近生物體的視覺系統(tǒng),但由于受到原理計(jì)算法的限制,測距精度和成象速度不能滿足要求。結(jié)構(gòu)光測距:結(jié)構(gòu)光測距的原理與光學(xué)測距法類似,使用單一光點(diǎn)或平面逐點(diǎn)測量從而獲得物體的完整的三維描述。這種方法雖然能夠產(chǎn)生比較精確的結(jié)果,但是其速度過慢而無法用于實(shí)時(shí)任務(wù)。在移動(dòng)機(jī)器人的領(lǐng)域中,無源測距方法大都無法同時(shí)滿足可靠性或?qū)嵱眯缘囊蟆S性礈y距技術(shù)使用主動(dòng)傳感器替代被動(dòng)傳感器,它由于具有以下的兩大優(yōu)點(diǎn)而在實(shí)時(shí)機(jī)器人領(lǐng)域顯示出誘人的魅力:(1)主動(dòng)傳感器不存在復(fù)雜的圖象匹配技術(shù),不象立體視覺需要通過大量的計(jì)算獲取距離數(shù)據(jù),因而實(shí)時(shí)性好,測距速度快。(2)主動(dòng)傳感器不易受到如天氣狀況、光照條件及表面標(biāo)記、陰影、污漬等外界條件的影響。主動(dòng)傳感器工作時(shí)不僅使用自然光照,它自身也對(duì)被測物體產(chǎn)生光照。此外,在多數(shù)主動(dòng)傳感器系統(tǒng)中,有源光的發(fā)送和接受是同軸的,這就從本質(zhì)上解決了結(jié)構(gòu)光和立體視覺方法難于解決的“消失片段”問題。2.1.2 有源測距技術(shù) 在有源測距技術(shù)中,常用的主動(dòng)傳感器主要有超聲波、微波雷達(dá)和激光雷達(dá)三種。(1)超聲波傳感器超聲波是一種只有少數(shù)生物(如蝙蝠、海豚)才能感覺到的機(jī)械波,其頻率在20KHz以上,波長短,繞射小,能定向傳播。它具有縱波(在氣、液、固中傳播)、橫波(在固體中傳播)和表面波(沿固體表面?zhèn)鞑ィ┤N波形,而且遇到雜質(zhì)或傳播界面回產(chǎn)生明顯的反射13。這種反射不是嚴(yán)格定向的,具有散射性。在移動(dòng)機(jī)器人中應(yīng)用的超聲波傳感器,是利用超聲波在空氣中的定向傳播和固體反射特性(縱波),通過接收自身反射的超聲波反射信號(hào),根據(jù)超聲波發(fā)出和回波接收時(shí)間差及傳播速度,計(jì)算出傳播距離,從而得到障礙無物到機(jī)器人的距離。從發(fā)射波束特性知,由于擴(kuò)散角的原因,使超聲波測距的角度分辨率較低,但距離分辨率較高。超聲波傳感器具有反應(yīng)靈敏、探測速度快的優(yōu)點(diǎn),而且結(jié)構(gòu)簡單,體積小,成本低,因而在目前已知的移動(dòng)機(jī)器人中,多數(shù)都安裝了它,用于室內(nèi)和室外近距離避障。通常,以多個(gè)傳感器組成陣列形式,根據(jù)單個(gè)傳感器擴(kuò)散角及反射特性。確定合理的密度,以覆蓋要求的探測區(qū)域??偟膩碚f,超聲波傳感器的造價(jià)低廉、速度快、距離分辨率較高,但其方向性差、鏡面反射嚴(yán)重、測距范圍小,因此,比較適用于室內(nèi)環(huán)境的距離測量。(2)微波雷達(dá)微波是一種電磁波,其波長為,頻率為,定向傳播及反射性能介于超聲波和激光之間。作為新型測距傳感器,其工作原理與超聲波傳感器相同。角度分辨率高于超聲波和紅外傳感器,低于激光傳感器,距離分辨率略高于超聲波傳感器。目前最大探測距離介于超聲波和激光測距之間,最小探測盲區(qū)距離略低于超聲波傳感器。微波雷達(dá)的優(yōu)點(diǎn)是因目標(biāo)的顏色、材質(zhì)等不同而引起的反射率變化小,對(duì)霧的透過率高,受灰塵、霧、雨的影響小,在各種目標(biāo)和氣候條件下都能比較穩(wěn)定的進(jìn)行探測。缺點(diǎn)是利用車載的小型天線時(shí)因?yàn)椴荒苄纬杉怃J的射束,所以不能進(jìn)行高精度測角。一般很難進(jìn)行高精度測位。另外,根據(jù)目前的電波法規(guī)定,微波一般是不能使用的,但是不久的將來,經(jīng)過修改以后,這種規(guī)定會(huì)被解除的,這項(xiàng)高新技術(shù)的產(chǎn)品,已用于國外汽車倒車及高速公路車輛間距監(jiān)測等實(shí)用技術(shù)領(lǐng)域,并開始安裝在新研制的移動(dòng)機(jī)器人上,是一種很有前途的移動(dòng)機(jī)器人深度信息傳感器。(3)激光雷達(dá)近年來,激光雷達(dá)因具有測量速度快、測程遠(yuǎn)、測距精度高、方向性好、鏡面反射小、造價(jià)適中等優(yōu)點(diǎn)而受到廣泛重視。激光調(diào)制波的強(qiáng)度大,有利于遠(yuǎn)距離目標(biāo)的測量及目標(biāo)與背景的區(qū)分;光速窄、平行性好、散射小,保證了很好的測距方向分辨率;一般為單一頻率的光波,光譜比較純,保證了較高的信噪比。通過二維或三維的掃描激光束或光平面,激光測距雷達(dá)能夠以相對(duì)高的頻率提供大量準(zhǔn)確的距離數(shù)據(jù)。激光測距雷達(dá)與其它距離傳感器相比,它能夠較好的同時(shí)考慮到精度要求和速度要求,特別是在移動(dòng)機(jī)器人領(lǐng)域。它與傳統(tǒng)獲得深度信息的方法不同,激光測距雷達(dá)不僅可以在有環(huán)境光的情況下工作,也可以在無環(huán)境光中工作,而且在無環(huán)境光的情況下測量效果更好。但由于光線的傳播速度極快,通常難以通過簡單的裝置估算其傳播距離,因此在簡單、低成本的應(yīng)用中,并不適用。2.2 測距傳感器的選擇性分析在本課題中,自主移動(dòng)需要在實(shí)現(xiàn)避障和路徑規(guī)劃的基礎(chǔ)上,完成局部自主式移動(dòng),因此它必須對(duì)其工作環(huán)境的狀態(tài)有一清楚的了解。同時(shí),由于涉及到不同的工作場合,成本的高低,安裝麻煩等限制,我們?cè)谠O(shè)計(jì)的過程中,排除了用外部的測量、定位和導(dǎo)航系統(tǒng)的可能性。因此,在這里,機(jī)器人將依靠其自身攜帶的傳感器,通過主動(dòng)探測的方式來完成對(duì)外部環(huán)境的感知。由于在實(shí)現(xiàn)避障和無碰撞路徑規(guī)劃的過程中,機(jī)器人本身與周圍環(huán)境以及障礙物之間的距離是最關(guān)鍵的因素。因此,我們對(duì)于傳感器的選擇,也集中在測量距離這一參數(shù)上。如上一節(jié)所述,超聲波測距技術(shù)是一種有源非接觸性測距技術(shù),是利用超聲波在空氣中的定向傳播特性和固體反射特性,通過接收自身反射的超聲波反射信號(hào),根據(jù)超聲波發(fā)出及回波接收時(shí)間差及傳播速度,計(jì)算出傳播距離,從而得到障礙物到機(jī)器人的距離。由于超聲波傳感器具有成本低廉,采集速度快,距離分辨率高,質(zhì)量輕、體積小、易于裝卸的優(yōu)點(diǎn),并且超聲波傳感器在采集環(huán)境信息時(shí)不存在復(fù)雜的圖象匹配技術(shù),不需要通過大量的計(jì)算就可獲得數(shù)據(jù),因而其測距速度快,實(shí)用性好。同時(shí)超聲波傳感器不易受到天氣條件、環(huán)境光照及障礙物陰影、表面粗糙度、裂縫等外界環(huán)境條件的影響。鑒于以上種種優(yōu)點(diǎn),使得超聲波傳感器在移動(dòng)機(jī)器人的應(yīng)用中具有很大的優(yōu)勢。因此,在這里我們選擇超聲波測距傳感器作為智能機(jī)器人的主要傳感部件。目前,超聲波測距傳感器在移動(dòng)式機(jī)器人導(dǎo)航中應(yīng)用十分廣泛。它的測量原理是基于測量渡越時(shí)間,即測量從發(fā)射換能器發(fā)出的超聲波,經(jīng)目標(biāo)反射后,沿原路返回到接收換能器所需的時(shí)間。由渡越時(shí)間和介質(zhì)中的聲速即可求得目標(biāo)與傳感器之間的距離。2.3 超聲波測距 為了檢測作業(yè)對(duì)象及環(huán)境或機(jī)器人與它們的關(guān)系,在機(jī)器人上安裝了觸覺傳感器、視覺傳感力覺傳感器、接近覺傳感器、超聲波傳感器和聽覺傳感器,大大改善了機(jī)器人工作狀況,使其能夠更充分地完成復(fù)雜的工作。由于外部傳感器為集多種學(xué)科為一身的產(chǎn)品,有些方面還在探索之中,隨著外部傳感器的進(jìn)一步完善,機(jī)器人的功能越來越強(qiáng)大,將在許多領(lǐng)域?yàn)槿祟愖龀龈筘暙I(xiàn)。為了使移動(dòng)機(jī)器人能自動(dòng)避障行走,就必須裝備測距系統(tǒng),以使其及時(shí)獲取距障礙物的距離信息(距離和方向)。由于超聲波指向性強(qiáng),能量消耗緩慢,在介質(zhì)中傳播的距離較遠(yuǎn),因而超聲波經(jīng)常用于距離的測量,如測距儀和物位測量儀等都可以通過超聲波來實(shí)現(xiàn)。利用超聲波檢測往往比較迅速、方便、計(jì)算簡單、易于做到實(shí)時(shí)控制,并且在測量精度方面能達(dá)到工業(yè)實(shí)用的要求,因此在移動(dòng)機(jī)器人的研制上也得到了廣泛的應(yīng)用。 2.3.1 超聲波發(fā)生器 超聲波發(fā)生器可以分為兩大類:一類是用電氣方式產(chǎn)生超聲波,一類是用機(jī)械方式產(chǎn)生超聲波。電氣方式包括壓電型、磁致伸縮型和電動(dòng)型等;機(jī)械方式有加爾統(tǒng)笛、液哨和氣流旋笛等。它們所產(chǎn)生的超聲波的頻率、功率和聲波特性各不相同,因而用途也各不相同。目前較為常用的是壓電式超聲波發(fā)生器。 按收發(fā)方式又分兩類:一類是發(fā)射和接收分別是兩種不同的分體式超聲波傳感器,此類傳感器測距有效范圍比較大,但不具備防塵、防水性能,如用于發(fā)射的MA40A5S及用于接收的MA40A5R 。另一類是具有雙向的發(fā)射/接收功能的收發(fā)一體式超聲波傳感器,如R/S40,不僅用于發(fā)射超聲波,也用于接收超聲波,此類超聲波測距有效范圍比較小,防塵、防水性能好,主要用于汽車倒車?yán)走_(dá)。2.3.2 壓電式超聲波發(fā)生器原理 壓電式超聲波發(fā)生器實(shí)際上是利用壓電晶體的諧振來工作的。超聲波發(fā)生器內(nèi)部結(jié)構(gòu)如圖2-1所示,它有兩個(gè)壓電晶片和一個(gè)共振板。當(dāng)它的兩極外加脈沖信號(hào),其頻率等于壓電晶片的固有振蕩頻率時(shí),壓電晶片將會(huì)發(fā)生共振,并帶動(dòng)共振板振動(dòng),便產(chǎn)生超聲波。反之,如果兩電極間未外加電壓,當(dāng)共振板接收到超聲波時(shí),將壓迫壓電晶片作振動(dòng),將機(jī)械能轉(zhuǎn)換為電信號(hào),這時(shí)它就成為超聲波接收器了。超聲波傳感器在機(jī)器人上的分布如圖2-2所示。 圖2-1 超聲波傳感器結(jié)構(gòu) 圖2-2 超聲波傳感器位置分布圖 2.3.3 超聲波測距原理超聲波是一種一定頻率范圍的聲波。它具有在同種媒質(zhì)中以恒定速率傳播的特性,而在不同媒質(zhì)的界面,會(huì)產(chǎn)生反射現(xiàn)象。利用這一特性,就可以根據(jù)測量反射波與發(fā)射波之間的時(shí)間間隔,從而達(dá)到測量距離的作用。其主要有三種測量方法:(1)相位檢測法相位檢測法雖然精度高,但檢測范圍有限(2)聲波幅值檢測法聲波幅值檢測法易受反射波的影響(3)渡越時(shí)間檢測法超聲波測距是通過不斷檢測超聲波發(fā)射后遇到障礙物所反射的回波,從而測出發(fā)射和接收回波的時(shí)間差t,然后求出就可以計(jì)算出發(fā)射點(diǎn)距障礙物的距離:D = C T/ 2 (2-1)這就是渡越時(shí)間法測距機(jī)理。式中:D距離;S聲波在介質(zhì)中傳播的速度; T聲波傳輸所用時(shí)間。聲波在空氣中傳輸速率為: (2-2) 式中:T絕對(duì)溫度;331.4 m/s。在測距精度不是很高的情況下,一般認(rèn)為C為常數(shù)340m/s。附錄中表2列出了幾種不同溫度下的聲速。在使用時(shí),如果溫度變化不大,則可認(rèn)為聲速是基本不變的。如果測距精度要求很高,則應(yīng)通過溫度補(bǔ)償?shù)姆椒右孕US糜谛凶邫C(jī)器人上的超聲測距系統(tǒng)共有4對(duì)超聲波換能器,分別裝在前、后、左、右4個(gè)方向上。采用AT89C52單片機(jī),由單片機(jī)定時(shí)向發(fā)射機(jī)發(fā)出控制信號(hào),其脈沖寬度為0.25ms,同時(shí)啟動(dòng)定時(shí)器。發(fā)射機(jī)產(chǎn)生40KHz左右的調(diào)制脈沖,經(jīng)換能器轉(zhuǎn)換為超聲波信號(hào)向前方空間發(fā)射。超聲波信號(hào)在空間中傳播遇到障礙物后,將反射回波。其反射波被接受機(jī)收到后,變成電信號(hào)脈沖,該信號(hào)經(jīng)放大、濾波、整流、比較后,產(chǎn)生負(fù)脈沖觸發(fā)單片機(jī)外部中斷讀出此時(shí)定時(shí)器值,即得出超聲波在空氣中傳播的時(shí)間。再根據(jù)公式(2-1)即可求得距離。2.4 本章小結(jié)本章先介紹了移動(dòng)機(jī)器人中常用的兩種測距技術(shù)無源測距和有源測距,并對(duì)測距傳感器的選擇做了分析,討論了超聲波測距的優(yōu)越性。然后詳細(xì)講述了超聲波發(fā)生器原理和超聲波測距原理。 第三章 環(huán)境建模對(duì)環(huán)境的感知是自主式移動(dòng)機(jī)器人研究的關(guān)鍵技術(shù)之一。環(huán)境信息的描述是實(shí)現(xiàn)機(jī)器人自主式導(dǎo)航的算法基礎(chǔ)。環(huán)境信息采集和建模描述的精確度應(yīng)該以實(shí)現(xiàn)對(duì)機(jī)器人導(dǎo)航的可靠性為基礎(chǔ)。強(qiáng)制要求傳感器對(duì)環(huán)境信息采集和描述的精確度會(huì)影響傳感器的信息采集速率,增加算法復(fù)雜度和計(jì)算量,從而影響算法的實(shí)時(shí)性、可靠性和魯棒性。雖然現(xiàn)在對(duì)環(huán)境信息的建模方法有很多種,比較成功和有效的方法主要有勢場法和柵格法。這里僅介紹和使用柵格法來進(jìn)行環(huán)境建模。3.1 柵格法簡介柵格法(grids) 是將移動(dòng)機(jī)器人工作環(huán)境分解成一系列具有二值信息的網(wǎng)格單元,多采用二維笛卡兒矩陣柵格表示工作環(huán)境,每一個(gè)矩形柵格都有一個(gè)累積值CV ,表示在此方位中存在障礙物的可信度。CV 值越高,表征存在障礙物的可能性越高。用柵格法表示格子環(huán)境模型中存在障礙物的可能性的方法起源于美國CMU大學(xué)。通過優(yōu)化算法在單元中搜索最優(yōu)路徑。由于該方法以柵格為單位記錄環(huán)境信息,環(huán)境被量化成具有一定分辨率的柵格,因此柵格的大小直接影響著環(huán)境信息存儲(chǔ)量的大小以及路徑搜索的時(shí)間,因此在實(shí)用上受到一定的限制。柵格法將基于傳感器系統(tǒng)的地圖模型識(shí)別法和測距法相結(jié)合,環(huán)境描述易于創(chuàng)建和維護(hù),對(duì)某個(gè)網(wǎng)絡(luò)的感知信息可直接與環(huán)境中某個(gè)區(qū)域?qū)?yīng),機(jī)器人對(duì)所測的障礙物具體形狀不太敏感,具有直觀簡潔、分辨率高等特點(diǎn),適用于室內(nèi)等中小環(huán)境路徑規(guī)劃地圖模型的建立14。柵格法與其它環(huán)境建模方法相比具有以下特點(diǎn):(1)所建立的柵格跟系統(tǒng)所采用的傳感器類型有關(guān)。不同的傳感器由于采集環(huán)境信息的方法不同,所獲得柵格形狀和精確度也不同。(2)對(duì)柵格中的障礙物形狀和具體定位在全局坐標(biāo)中不能表示出來。3.2 柵格法建模在這里采用柵格法建立環(huán)境地圖模型。忽略機(jī)器人的旋轉(zhuǎn)運(yùn)動(dòng),墻壁為直線型,視房間為一個(gè)矩形,按照設(shè)定好的清潔范圍,以機(jī)器人大小尺寸為基本單元,將房間自動(dòng)劃分成互不重疊的單元格,形成柵格圖,每個(gè)柵格表示一個(gè)自由區(qū)域或障礙區(qū)域。如圖 圖3-1環(huán)境地圖模型圖中,A點(diǎn)為機(jī)器人停放位置,機(jī)器人的工作位置可以通過坐標(biāo)(x,y)表示,設(shè)工作房間長X,寬Y,則x為沿X方向坐標(biāo),y為沿Y方向坐標(biāo)。參數(shù)X和Y可以任意調(diào)整。白色區(qū)域表示自由區(qū),機(jī)器人可以自由活動(dòng)。黑色區(qū)域表示障礙區(qū),機(jī)器人不能通過,非線形障礙物可以近似等效為線形。3.3 基于超聲波傳感器測距的柵格化方法如圖3-2所示,我們利用多對(duì)超聲波傳感器的角度掃描范圍,以及傳感器最大距離探測誤差為半徑分割整個(gè)平面,這樣,我們就得到一個(gè)被分割成許多柵格的平面。 圖3-2 超聲波掃描測距示意圖由于超聲波傳感器角度分辨率差,利用柵格法獲取環(huán)境信息是較為可行的基本方法?,F(xiàn)在,我們就兩個(gè)超聲波傳感器A、B討論一下環(huán)境信息的獲取。圖中,a為傳感器的角度探測范圍,b為傳感器B的角度探測范圍。Ra為A探測到的最近障礙物的距離,Rb為B探測到的最近障礙物的距離。當(dāng)RaRb(Ra與Rb之間差距大于一個(gè)閥值)時(shí),我們認(rèn)為距離A最近的障礙物在柵格1中,也就是柵格1中存在障礙物,而在柵格2中不存在障礙物。同理,當(dāng)RbRa時(shí)我們認(rèn)為距離B最近的障礙物在柵格3中,也就是柵格3中存在障礙物,而柵格2中不存在障礙物。而當(dāng)Ra=Rb時(shí),我們認(rèn)為距離a或b最近的障礙物可能在1,2,3任意柵格中,也就是1,2,3中都有有存在障礙物的可能。當(dāng)然,這只是推理的原理,在實(shí)際應(yīng)用中,我們是根據(jù)柵格中存在障礙物的可信度來記錄環(huán)境信息的。也就是說,當(dāng)我們進(jìn)行一次探測后,我們將可能存在障礙物的柵格的CV值加1。而在另一方面,我們將不可能存在障礙物的柵格的CV值設(shè)為05。這樣,我們就超聲波傳感器獲取的環(huán)境信息轉(zhuǎn)化為我們所需的柵格信息。我們可以看到,隨著超聲波傳感器數(shù)量增多,柵格的粒度就越小,我們獲取的柵格信息也就越精確。由于超聲波掃描本身的特性,使得所建立的柵格是扇形的,這樣不利于對(duì)整個(gè)工作環(huán)境(如房間,大廳等)進(jìn)行柵格化,只要傳感器的數(shù)量較多,這樣的近似是可以接受的。另外,如果是家用自主式移動(dòng)機(jī)器人如智能吸塵機(jī)器人,其所工作的環(huán)境是室內(nèi),并且由于超聲波測距范圍和精確度,以及工作環(huán)境面積大小等因素,這樣就不能要求超聲波傳感器能在某個(gè)具體的位置,就能把整個(gè)室內(nèi)環(huán)境的信息全部記錄下來。因此超聲波傳感器采集信息的工作方式應(yīng)該是邊走邊掃描記錄。在這種采集信息的工作方式下,其采集到的信息數(shù)據(jù)不僅跟環(huán)境靜態(tài)的結(jié)構(gòu)布局有關(guān),并且室內(nèi)環(huán)境中還存在動(dòng)態(tài)的物體如人等,因此對(duì)采集到的信息進(jìn)行建模時(shí)還應(yīng)該考慮到時(shí)間的因素。也就是說采集到的物體位置信息(X,Y)不僅應(yīng)該是二維平面的x和y的函數(shù),也是時(shí)間t的函數(shù)。3.4 本章小結(jié) 本章主要介紹了柵格法的原理及特點(diǎn)。講述了利用柵格法進(jìn)行環(huán)境建模的建模過程以及基于超聲波傳感器測距的柵格化方法。第四章 基于超聲波測距的沿邊走路徑規(guī)劃的導(dǎo)航算法4.1 坐標(biāo)系的建立在移動(dòng)機(jī)器人的環(huán)境信息(主要是環(huán)境結(jié)構(gòu)布局以及障礙物分布布局信息)進(jìn)行描述時(shí),必須建立兩個(gè)坐標(biāo)系:全局坐標(biāo)系和機(jī)載運(yùn)動(dòng)局部坐標(biāo)系。這兩者的關(guān)系如圖4-1: 圖4-1 全局坐標(biāo)與機(jī)載運(yùn)動(dòng)坐標(biāo)關(guān)系圖(1)全局坐標(biāo)系建立全局坐標(biāo)系的目的是用來描述整個(gè)環(huán)境的信息,標(biāo)識(shí)當(dāng)前機(jī)器人的位置。全局坐標(biāo)值描述了機(jī)器人當(dāng)前在整個(gè)工作環(huán)境中所處的位置,因此全局坐標(biāo)值可以用來對(duì)機(jī)器人定位。(2)車載坐標(biāo)系由于自主式移動(dòng)機(jī)器人是在運(yùn)動(dòng)過程中,探測當(dāng)前環(huán)境的信息的。每次探測的距離信息都是以當(dāng)前機(jī)器人的運(yùn)動(dòng)姿勢來定量測量的。建立車體局部坐標(biāo)系就是為了描述當(dāng)前探測到的局部信息,它主要用于控制機(jī)器人的當(dāng)前行走。全局坐標(biāo)系與車載坐標(biāo)系轉(zhuǎn)換全局坐標(biāo)系和機(jī)載運(yùn)動(dòng)坐標(biāo)系的轉(zhuǎn)換關(guān)系為: 其中為機(jī)載坐標(biāo)系繞全局坐標(biāo)系所轉(zhuǎn)過的角度。并定義為順時(shí)針方向?yàn)檎?,逆時(shí)針方向?yàn)樨?fù)。4.2 基于超聲波測距的沿邊走路徑規(guī)劃機(jī)器人的導(dǎo)航算法超聲波傳感器測距具有成本低廉,采集信息速率快,距離分辨率高,質(zhì)量輕、體積小、易于裝卸等優(yōu)點(diǎn),更加適合于家用的自主式移動(dòng)機(jī)器人。因此本文在充分考慮家用自主式移動(dòng)吸塵器的工作環(huán)境和設(shè)計(jì)時(shí)的相關(guān)因素的基礎(chǔ)上,提出了一種稱為沿邊走的路徑規(guī)劃算法。4.2.1 沿邊走算法簡介所謂沿邊走,顧名思義,是讓移動(dòng)機(jī)器人沿著墻邊移動(dòng),在移動(dòng)過程中,可以不斷根據(jù)與墻邊的距離調(diào)整所走方向,這樣對(duì)于在移動(dòng)中自身坐標(biāo)不是很確定的移動(dòng)機(jī)器人來說,可以輔助周邊的事物對(duì)其當(dāng)前位置進(jìn)行調(diào)整。這就是我們采用“沿邊走算法”的基本出發(fā)點(diǎn)。當(dāng)然,我們也考慮了效率的因素。首先,對(duì)于移動(dòng)機(jī)器人,轉(zhuǎn)彎是相當(dāng)費(fèi)時(shí)的,理論上,除了順次掃描,沿邊走能有效的減少轉(zhuǎn)彎的次數(shù)。另外,考慮到家用型吸塵器通常工作環(huán)境為不大的房間(一般不超過30 平米) ,而我們采用的超聲波傳感器有效測距范圍是2m ,這樣,采用“沿邊走算法”,我們能在沿墻邊2m 的空間中始終采用沿邊走的策略,也就是說,對(duì)于5 * 6 平米的房間,采用沿邊走的策略可以掃描28 平米的范圍(對(duì)于這樣的效率,我們認(rèn)為是可以接受的) 而對(duì)另外2 平米的空間可以采用掃描方法進(jìn)行處理。這就是說,沿邊走算法通常會(huì)分為兩個(gè)步驟來進(jìn)行,首先是沿著墻邊進(jìn)行有次序的掃描;另外是對(duì)于房間中間部分的掃描,當(dāng)然由于在這一部分區(qū)域中,機(jī)器人可能無法探測到墻壁或其他障礙物,可能會(huì)迷失方向,因此,并不需要采用沿邊走策略。這種路徑規(guī)劃行程較短,理論上減少了轉(zhuǎn)彎的次數(shù),可避免“外螺旋式”和“往復(fù)前進(jìn)式”的邊緣效應(yīng),易于實(shí)現(xiàn)較大的覆蓋率。同時(shí),“內(nèi)螺旋式”的終點(diǎn)位于區(qū)域中心附近,遠(yuǎn)離障礙物,從而在區(qū)域覆蓋問題上,有利于機(jī)器人在區(qū)域間的銜接行走,從而有效地提高了清潔效率。清潔機(jī)器人路徑規(guī)劃是根據(jù)所感知到的工作環(huán)境信息,按照某種優(yōu)化指標(biāo),從起始點(diǎn)到目標(biāo)點(diǎn)規(guī)劃出一條與環(huán)境障礙無碰撞的路徑,并實(shí)現(xiàn)封閉區(qū)域內(nèi)機(jī)器人行走路徑對(duì)工作區(qū)域的最大覆蓋率和最小重復(fù)率。清潔機(jī)器人的路徑規(guī)劃方法可以分為兩類:無環(huán)境模型的路徑規(guī)劃方法和基于靜態(tài)結(jié)構(gòu)化環(huán)境模型,在障礙物信息(位置和形狀)預(yù)先給定的情況下,采用沿邊走的路徑規(guī)劃算法,即讓機(jī)器人沿著墻邊或障礙物的邊界移動(dòng),進(jìn)行內(nèi)螺旋式“回”字型路徑規(guī)劃,如圖4-2所示。 圖4-2 內(nèi)螺旋式“回”字型路徑示意圖圖中箭頭表示行走方向,直線表示行走路線,虛線表示返回停放位置的可能路徑。清潔機(jī)器人工作開始時(shí)先繞房間行走一周,一熟悉環(huán)境,計(jì)算出清潔面積,限定以后的運(yùn)行路徑的范圍。4.2.2 沿邊走過程下面我們看一下,在“沿邊走算法”中的第一個(gè)步驟,我們稱之為沿邊走過程。在沿邊走過程中,我們會(huì)遇到以下幾種情況:(1) 墻邊的障礙物對(duì)于墻邊存在的障礙物,例如衣柜、沙發(fā)等,我們通??梢圆蝗ダ頃?huì),因?yàn)?,?duì)于移動(dòng)機(jī)器人來說,它會(huì)把這些障礙物當(dāng)作墻壁來處理,在這里,我們就不繼續(xù)討論了。(2) 不在墻邊,但在沿邊走過程中會(huì)碰到的障礙物對(duì)于此類障礙物,由于不在墻邊,因此,在走第一圈時(shí),是不會(huì)碰到的,但由于離墻邊的距離小于超聲波傳感器的測距范圍,因此會(huì)記錄到障礙物鏈中。因?yàn)?,我們關(guān)心的是沿著墻壁走以及離墻壁的距離,對(duì)這類障礙物并不需要進(jìn)行特別處理,而只需沿墻壁的方向繞開即可。(3) 機(jī)器人自身定位為了能夠提供機(jī)器人坐標(biāo)系與全局坐標(biāo)系的轉(zhuǎn)換,機(jī)器人自身的坐標(biāo)是相當(dāng)重要的。相對(duì)機(jī)器人轉(zhuǎn)彎的角度誤差,我們較為相信移動(dòng)機(jī)器人步進(jìn)機(jī)前進(jìn)時(shí)的距離信息。這也正是我們采用沿邊走算法的主要因素之一。因?yàn)?,我們認(rèn)為墻壁是直的,四周的墻壁應(yīng)該形成矩形,這樣在機(jī)器人沿墻邊走的同時(shí),我們可以讓機(jī)器人與墻壁的距離來進(jìn)行角度調(diào)整。另一方面,在沿邊走算法中,機(jī)器人每走完一圈就要將移動(dòng)時(shí)離墻壁的距離遞增,因此,我們需要對(duì)完成一圈的行走進(jìn)行判斷。我們是通過兩方面的信息進(jìn)行的:一是角度信息,當(dāng)
溫馨提示
- 1. 本站所有資源如無特殊說明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請(qǐng)下載最新的WinRAR軟件解壓。
- 2. 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請(qǐng)聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
- 3. 本站RAR壓縮包中若帶圖紙,網(wǎng)頁內(nèi)容里面會(huì)有圖紙預(yù)覽,若沒有圖紙預(yù)覽就沒有圖紙。
- 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
- 5. 人人文庫網(wǎng)僅提供信息存儲(chǔ)空間,僅對(duì)用戶上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理,對(duì)用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對(duì)任何下載內(nèi)容負(fù)責(zé)。
- 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請(qǐng)與我們聯(lián)系,我們立即糾正。
- 7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時(shí)也不承擔(dān)用戶因使用這些下載資源對(duì)自己和他人造成任何形式的傷害或損失。
最新文檔
- 酒店企業(yè)文化與運(yùn)營試題及答案
- 公司紅酒采購合同標(biāo)準(zhǔn)文本
- 值班個(gè)人勞務(wù)合同范例
- 紡織機(jī)械設(shè)備智能化趨勢試題及答案
- 入電合同范例
- 買賣店面定金合同范例
- 傳媒公司入股合同范例
- 重要質(zhì)量工程師考試試題及答案
- 兒童游樂設(shè)施合同范例
- 公司簡易注銷合同范例
- 基建招聘面試題及答案
- 華為測試面試題及答案
- 漂珠銷售合同協(xié)議
- 2025化學(xué)中考解題技巧 專題10 技巧性計(jì)算(解析版)
- 部門加班調(diào)休管理制度
- 考勤制度操作指南
- 人力核心指標(biāo) 行業(yè)報(bào)告系列 2025年Q1精細(xì)化工行業(yè)薪酬報(bào)告
- 垃圾焚燒發(fā)電廠應(yīng)急預(yù)案
- 動(dòng)柱龍門合格證書
- 超星爾雅學(xué)習(xí)通《歷史的三峽:近代中國的思潮與政治(華東師范大學(xué))》2025章節(jié)測試答案
- 村莊灣塘承包協(xié)議書8篇
評(píng)論
0/150
提交評(píng)論