發(fā)布時(shí)間:2018-07-18所屬分類:管理論文瀏覽:1次
摘 要: 針對(duì)多采摘機(jī)器人聯(lián)合作業(yè)容易出現(xiàn)路徑?jīng)_突和碰撞的問(wèn)題,基于蟻群算法,通過(guò)建立地圖信息數(shù)據(jù)庫(kù)和拓?fù)鋱D,并結(jié)合先全局后局部的路徑規(guī)劃方法,設(shè)計(jì)了多采摘機(jī)器人路徑規(guī)劃和導(dǎo)航系統(tǒng),實(shí)現(xiàn)了多采摘機(jī)器人移動(dòng)路徑的實(shí)時(shí)動(dòng)態(tài)規(guī)劃和自主導(dǎo)航功能,并利用 MatL
針對(duì)多采摘機(jī)器人聯(lián)合作業(yè)容易出現(xiàn)路徑?jīng)_突和碰撞的問(wèn)題,基于蟻群算法,通過(guò)建立地圖信息數(shù)據(jù)庫(kù)和拓?fù)鋱D,并結(jié)合先全局后局部的路徑規(guī)劃方法,設(shè)計(jì)了多采摘機(jī)器人路徑規(guī)劃和導(dǎo)航系統(tǒng),實(shí)現(xiàn)了多采摘機(jī)器人移動(dòng)路徑的實(shí)時(shí)動(dòng)態(tài)規(guī)劃和自主導(dǎo)航功能,并利用 MatLab進(jìn)行了驗(yàn)證仿真 。
關(guān)鍵詞 : 采摘機(jī)器人,蟻群算法,拓?fù)鋱D,路徑規(guī)劃,Matlab
近年來(lái),人工智能已成為新一輪工業(yè)革命的基石,不僅廣泛應(yīng)用于工業(yè)控制領(lǐng)域,在農(nóng)業(yè)生產(chǎn)中的應(yīng)用越來(lái)越普及。在農(nóng)忙時(shí)節(jié),農(nóng)場(chǎng)往往會(huì)出現(xiàn)勞動(dòng)力大量匱乏的現(xiàn)象,因此機(jī)器人在農(nóng)業(yè)上的應(yīng)用需求越來(lái)越明顯。研發(fā)出一種能進(jìn)行遠(yuǎn)程控制的采摘機(jī)器人,代替?zhèn)鹘y(tǒng)人力的作業(yè)操作,對(duì)提高農(nóng)業(yè)生產(chǎn)水平及種植效率具有重要意義,也是現(xiàn)代化農(nóng)業(yè)的發(fā)展趨勢(shì)。為此,根據(jù)采摘機(jī)器人作業(yè)環(huán)境,采用蟻群算法,結(jié)合先全局后局部的路徑規(guī)劃方法,設(shè)計(jì)了一種多采摘機(jī)器人路徑規(guī)劃和導(dǎo)航系統(tǒng)。
1蟻群算法簡(jiǎn)述
蟻群算法是意大利學(xué)者 Dorigo 在 20 世紀(jì) 90 年代模擬和總結(jié)螞蟻尋找食物的一系列行為過(guò)程,得出的一種解決復(fù)雜組合優(yōu)化問(wèn)題的方法。該方法從螞蟻、蜜蜂這些昆蟲尋找食物的行為入手,其實(shí)對(duì)于一個(gè)個(gè)體而言,它們的行為非常容易分析,但當(dāng)它們組合成一個(gè)龐大的群體后,群體行為分析難度就大大增加了。
其原因是因?yàn)槲浵亗(gè)體間是由一種分泌物作為信息素進(jìn)行交流通信,螞蟻在行走的路線上會(huì)留下這些物質(zhì),而所有的螞蟻都能夠感知這些物質(zhì)的濃度,并根據(jù)該物質(zhì)濃度的強(qiáng)弱選擇自己的運(yùn)動(dòng)方向。因此,蟻群的集體行為會(huì)形成一種特定的信息正反饋場(chǎng)景,即某路線上經(jīng)過(guò)的螞蟻數(shù)量越大,則后面選擇該路線的螞蟻就會(huì)越多。螞蟻間根據(jù)感知這種信息素物質(zhì)的強(qiáng)弱實(shí)現(xiàn)搜索食物的整個(gè)過(guò)程,這也就是蟻群算法的緣由 。
2多采摘機(jī)器人路徑規(guī)劃
在多采摘機(jī)器人作業(yè)過(guò)程中,障礙物較多,機(jī)器人間相互影響,成為彼此的障礙物,因此多機(jī)器人路徑規(guī)劃難度較大。在實(shí)際研究中,多個(gè)采摘機(jī)器人在同一種植區(qū)作業(yè),需要規(guī)劃多條最優(yōu)路徑,但在具體的作業(yè)過(guò)程中,由于障礙物的存在,最優(yōu)路徑會(huì)發(fā)生變化,也會(huì)影響其他機(jī)器人的移動(dòng)路徑。基于上述問(wèn)題,為了保證多采摘機(jī)器人實(shí)現(xiàn)無(wú)碰撞作業(yè),該系統(tǒng)需要實(shí)時(shí)規(guī)劃路線,防止機(jī)器人間、機(jī)器人與障礙物間的碰撞。
2. 1 多采摘機(jī)器人路徑規(guī)劃整體設(shè)計(jì)
由于產(chǎn)業(yè)種植園區(qū)環(huán)境不確定性因素較大,如種植人員園區(qū)工作以及其他機(jī)械的隨機(jī)移動(dòng),且傳感器探測(cè)具有一定的局限性,機(jī)器人在最初規(guī)劃時(shí)往往很難獲取全部的信息,采用簡(jiǎn)單的規(guī)劃往往難以獲得理想的最優(yōu)路徑。因此,可在獲得一定園區(qū)環(huán)境信息的基礎(chǔ)上,進(jìn)行作業(yè)前的全局規(guī)劃,并將其作為理想的最優(yōu)路線。在采摘機(jī)器人群的實(shí)際運(yùn)動(dòng)作業(yè)中,根據(jù)后續(xù)探測(cè)的環(huán)境信息,規(guī)劃出局部的最優(yōu)路徑,進(jìn)行簡(jiǎn)單的微調(diào),使機(jī)器人避開所有碰撞物,并最快地到達(dá)目的地。基于以上問(wèn)題,該系統(tǒng)采用全局和局部的規(guī)劃方法,實(shí)現(xiàn)多采摘機(jī)器人的路徑規(guī)劃。
1 ) 全局路徑規(guī)劃 。本章研究的是多采摘機(jī)器人在實(shí)際園區(qū)作業(yè)過(guò)程中的路徑規(guī)劃算法,對(duì)于其全局路徑規(guī)劃,首先要做到的是按照具體作業(yè)要求,根據(jù)已知環(huán)境信息,給每個(gè)機(jī)器人分配任務(wù),并確定每個(gè)機(jī)器人作業(yè)的起始點(diǎn)和終點(diǎn),然后結(jié)合多機(jī)器人間的合作機(jī)制,在兩點(diǎn)之間規(guī)劃一條無(wú)碰撞的優(yōu)化路線。
在整個(gè)算法中,最重要的是提高路線規(guī)劃速度和實(shí)現(xiàn)路徑規(guī)劃的最優(yōu)性。由于螞蟻算法路徑規(guī)劃效率比較高,且其對(duì)于障礙物變化的適應(yīng)性較強(qiáng),因此本文將采用蟻群算法對(duì)多采摘機(jī)器人進(jìn)行全局路徑規(guī)劃。
2 ) 局部路徑規(guī)劃 。有了全局路徑規(guī)劃之后,采摘機(jī)器人群就可以開始各自的作業(yè)任務(wù)。開始階段,采摘機(jī)器人將按照各自的規(guī)劃路徑進(jìn)行作業(yè),并實(shí)時(shí)采集周邊環(huán)境信息,根據(jù)采集到的動(dòng)態(tài)信息,進(jìn)行分析處理,根據(jù)碰撞檢測(cè)、決策算法和行為檢測(cè)等進(jìn)行局部的路徑修改,從而使自身具有更強(qiáng)的環(huán)境適應(yīng)能力。
本系統(tǒng)采用的局部規(guī)劃算法是利用機(jī)器人的車載傳感器對(duì)周邊環(huán)境信息進(jìn)行實(shí)時(shí)檢測(cè),并與全局規(guī)劃時(shí)的信息進(jìn)行對(duì)比分析,根據(jù)碰撞檢測(cè)子系統(tǒng)對(duì)是否存在碰撞風(fēng)險(xiǎn)進(jìn)行評(píng)估。若存在撞機(jī)危險(xiǎn),則對(duì)局部路徑進(jìn)行一定的調(diào)整,在調(diào)整過(guò)程中,始終以作業(yè)終點(diǎn)為最終目標(biāo),避免出現(xiàn)局部的極值點(diǎn)而忽略機(jī)器人整體規(guī)劃。
另外,在局部規(guī)劃過(guò)程中,行為檢測(cè)子系統(tǒng)需要實(shí)時(shí)對(duì)采摘機(jī)器人規(guī)劃的路徑進(jìn)行判斷,確定其是否符合全局規(guī)劃的目標(biāo),若符合,則執(zhí)行。在機(jī)器人成功避開障礙物后,則可以按照全局規(guī)劃的路線繼續(xù)進(jìn)行作業(yè)操作,在執(zhí)行期望路徑的過(guò)程中,向最近的子路徑節(jié)點(diǎn)移動(dòng)。如此反復(fù),不管局部規(guī)劃路徑怎么實(shí)施,采摘機(jī)器人最終的目標(biāo)終點(diǎn)不會(huì)發(fā)生改變,直到其成功到達(dá)終點(diǎn)。
2. 2 路徑規(guī)劃的適應(yīng)度函數(shù)
在進(jìn)行路徑規(guī)劃中,除保證各機(jī)器人前進(jìn)路徑最優(yōu)外,還需要各機(jī)器人間協(xié)調(diào),以避免出現(xiàn)兩采摘機(jī)器人發(fā)生碰撞。路徑規(guī)劃的適應(yīng)度函數(shù)是影響蟻群算法能否高效的計(jì)算出最優(yōu)解的主要原因,多采摘機(jī)器人路徑規(guī)劃要求包含避障和距離最短。因此,適應(yīng)度函數(shù)重點(diǎn)要考慮路徑長(zhǎng)度、路徑平滑度及可行性。
躲障是采摘機(jī)器人工作的首要條件,是其正常作業(yè)的保證,因此可行性是指采摘機(jī)器人群是否能夠安全地避開障礙物并得到終點(diǎn)。
3多采摘機(jī)器人導(dǎo)航系統(tǒng)
3. 1 導(dǎo)航系統(tǒng)整體方案
多采摘機(jī)器人導(dǎo)航系統(tǒng)是指在執(zhí)行任務(wù)期間,對(duì)各采摘機(jī)器人的作業(yè)路線進(jìn)行導(dǎo)航,即根據(jù)空間位置的做出全局規(guī)劃,結(jié)合在前進(jìn)過(guò)程中感知到的部分環(huán)境信息,實(shí)時(shí)對(duì)路線進(jìn)行恰當(dāng)?shù)男薷模龑?dǎo)各機(jī)器人安全前進(jìn)到指定位置。該方案主要包括環(huán)境建模、自主定位和路徑規(guī)劃 3 部分。由于路徑規(guī)劃已在前一章詳細(xì)的闡述,這里不再重復(fù)。
1 ) 環(huán)境建模 。環(huán)境建模是指采用數(shù)學(xué)模型的方法,對(duì)采摘作業(yè)區(qū)域進(jìn)行詳細(xì)描述,并將其抽象成計(jì)算機(jī)系統(tǒng)能夠直接識(shí)別的數(shù)據(jù)信息。本文所采取的導(dǎo)航系統(tǒng)數(shù)據(jù)信息存在于后臺(tái)服務(wù)器中,并由該信息抽象出拓?fù)鋱D,對(duì)路線信息進(jìn)行簡(jiǎn)單的描述。另外,也方便各采摘機(jī)器人識(shí)別道路之間的聯(lián)系,準(zhǔn)確實(shí)現(xiàn)全局、局部路徑規(guī)劃和實(shí)時(shí)導(dǎo)航。
2 ) 采摘機(jī)器人定位 。采摘機(jī)器人定位是指根據(jù)周邊環(huán)境信息和 GPS 確定其在作業(yè)區(qū)域相對(duì)于全局坐標(biāo)的具體位置。
3. 2 環(huán)境建模的具體實(shí)現(xiàn)
環(huán)境建模的空間信息對(duì)實(shí)現(xiàn)多采摘機(jī)器人的導(dǎo)航具有決定性的意義,本文所采用的方法是將地圖信息存在后臺(tái)服務(wù)器,通過(guò)后臺(tái)服務(wù)器的數(shù)據(jù)庫(kù)進(jìn)行拓?fù)鋱D的繪制,并采用循環(huán)鏈表的方式將數(shù)據(jù)信息進(jìn)行保存。因此,后臺(tái)服務(wù)器中的數(shù)據(jù)庫(kù)存放有地圖的全部信息,可用于多采摘機(jī)器人的實(shí)時(shí)定位與導(dǎo)航,而拓?fù)鋱D則可以用于結(jié)合螞蟻算法實(shí)現(xiàn)路徑的最優(yōu)規(guī)劃。
1 ) 地圖信息數(shù)據(jù)庫(kù) 。先將地圖信息分為站和道路兩種,其中站面積比較大,占地較多,可以用來(lái)讓機(jī)器人進(jìn)行短暫的停留 ; 而道路則是機(jī)器人前進(jìn)的路線,用來(lái)連接各個(gè)站。其次,在策略算法進(jìn)行規(guī)劃的過(guò)程中,可以將站和道路看成一段段或者一塊塊的矩陣,將其連接起來(lái)就可以用來(lái)表示地圖。
2 ) 建立拓?fù)鋱D 。建立拓?fù)鋱D需要以服務(wù)器中的數(shù)據(jù)信息為依據(jù),其主要是用來(lái)描述各站點(diǎn)與道路之間的連接狀態(tài),在內(nèi)存中以循環(huán)鏈表的方式進(jìn)行儲(chǔ)存。
循環(huán)鏈表是數(shù)據(jù)結(jié)構(gòu)中一種常用的保存數(shù)據(jù)信息的方法,可以靈活地表示數(shù)據(jù)間的前后關(guān)系,找到其中一個(gè)信息,便可以知道其前后內(nèi)存里面的信息。在導(dǎo)航過(guò)程中,需要經(jīng)常訪問(wèn)節(jié)點(diǎn)間的連接信息,因此采用該方法可以大大提高數(shù)據(jù)讀取信息。
4實(shí)驗(yàn)結(jié)果與分析
為了驗(yàn)證多采摘機(jī)器人路徑規(guī)劃與導(dǎo)航系統(tǒng)的準(zhǔn)確性可靠性,本文利用 MatLab 仿真軟件對(duì)其進(jìn)行了仿真實(shí)驗(yàn) 。其中,蟻群迭代步長(zhǎng)設(shè)置為 0 . 02 ,迭代次數(shù)為 100 次,運(yùn)行環(huán)境為 200m × 200m 的區(qū)域,本實(shí)驗(yàn)中采摘機(jī)器人數(shù)量為 3 個(gè)。實(shí)驗(yàn)?zāi)康?: 在采摘作業(yè)區(qū)域,該系統(tǒng)經(jīng)過(guò)改變執(zhí)行和迭代次數(shù),判斷多采摘機(jī)器人群是否能夠成功避開障礙物,并且安全達(dá)到目的由圖 6 可以看出 : 實(shí)驗(yàn)中各采摘機(jī)器人均安全從起點(diǎn)到達(dá)終點(diǎn),當(dāng)一條線路只能允許一臺(tái)機(jī)器人通過(guò)時(shí),其他機(jī)器人能夠避讓到站點(diǎn)休息,然后再進(jìn)行前進(jìn)操作,成功解決了路徑?jīng)_突的問(wèn)題。從路徑長(zhǎng)度和光滑度可以看出,該系統(tǒng)優(yōu)化效果明顯,具有很強(qiáng)的避障、路徑規(guī)劃和導(dǎo)航能力,且可行性高。
5結(jié)論
1 ) 針對(duì)多采摘機(jī)器人聯(lián)合作業(yè)容易出現(xiàn)路徑?jīng)_突和碰撞的問(wèn)題,采用蟻群算法,設(shè)計(jì)了多采摘機(jī)器人路徑規(guī)劃和導(dǎo)航系統(tǒng)。
2 ) 針對(duì)產(chǎn)業(yè)種植園區(qū)環(huán)境不確定性因素較大及機(jī)器人在最初規(guī)劃的時(shí)候往往很難獲取全部的信息的問(wèn)題,提出了先全局后局部的路徑規(guī)劃方法,實(shí)現(xiàn)了多采摘機(jī)器人移動(dòng)路徑的實(shí)時(shí)動(dòng)態(tài)規(guī)劃。
3 ) 提出了多采摘機(jī)器人環(huán)境下,各機(jī)器人利用環(huán)境建模和自主定位進(jìn)行自主導(dǎo)航的方法,通過(guò)建立地圖信息數(shù)據(jù)庫(kù)和拓?fù)鋱D,實(shí)現(xiàn)了對(duì)多采摘機(jī)器人的安全引導(dǎo) 。最后,運(yùn)用 MatLab 軟件仿真對(duì)路徑規(guī)劃和導(dǎo)航成功進(jìn)行了驗(yàn)證。
相關(guān)期刊推薦:《機(jī)器人》1979年創(chuàng)刊,是中國(guó)自動(dòng)化學(xué)會(huì)與中國(guó)科學(xué)院沈陽(yáng)自動(dòng)化研究所聯(lián)合主辦的全國(guó)性學(xué)術(shù)期刊,1979年成為國(guó)內(nèi)外公開發(fā)行期刊,1986年更名為《機(jī)器人》。《機(jī)器人》主管單位:中國(guó)科學(xué)院,主辦單位:中國(guó)自動(dòng)化學(xué)會(huì);中國(guó)科學(xué)院沈陽(yáng)自動(dòng)化研究所,國(guó)內(nèi)統(tǒng)一刊號(hào):21-1137/TP,國(guó)際標(biāo)準(zhǔn)刊號(hào):1002-0446等。