多方向無(wú)人水面艇路徑規(guī)劃算法
【文章頁(yè)數(shù)】:6 頁(yè)
【部分圖文】:
圖1 基于安全區(qū)域的路徑搜索原理
為精確描述無(wú)人水面艇路徑規(guī)劃時(shí)的位置與狀態(tài),本文所研究的無(wú)人艇均為六自由度運(yùn)動(dòng)學(xué)模型,在航行過(guò)程中可產(chǎn)生6個(gè)自由度的運(yùn)動(dòng)信息。考慮到無(wú)人艇在航行過(guò)程中需要較大的運(yùn)動(dòng)空間,在路徑規(guī)劃時(shí)不能簡(jiǎn)單地當(dāng)作一個(gè)質(zhì)點(diǎn)處理,因此設(shè)計(jì)一半徑為R的圓形區(qū)域包圍無(wú)人艇作為生成最佳航路點(diǎn)的安全距離約束....
圖2 環(huán)境信息柵格處理圖
為便于實(shí)現(xiàn)路徑規(guī)劃,首先應(yīng)建立無(wú)人艇的航行環(huán)境模型,將實(shí)際的海洋環(huán)境預(yù)處理為便于在計(jì)算機(jī)中表示的連接圖,同時(shí)保留必要的原始信息。目前常用的環(huán)境建模方法有可視圖法[18]、柵格法[19]、拓?fù)鋱D法[20]等,本文采用柵格法將實(shí)際電子海圖轉(zhuǎn)化為二進(jìn)制網(wǎng)格圖,建立柵格化地圖模型,并將以....
圖3 安全距離約束下的八方向搜索原理
式中:DE為柵格到目標(biāo)柵格E的距離,l為柵格到周圍障礙物的最短距離,R為無(wú)人艇安全半徑。l≥R代表當(dāng)前位置無(wú)人艇安全區(qū)域內(nèi)不存在障礙物;相反,l<R則代表安全區(qū)域內(nèi)存在障礙物。根據(jù)式(3),安全距離約束下各柵格的啟發(fā)函數(shù)可定義為:
圖4 多方向A*搜索算法示例圖
如圖4所示,現(xiàn)基于傳統(tǒng)八方向A*算法得到路徑1為PS→P1→P2→P3→P4→P5→P6→P7→PE,對(duì)該路徑進(jìn)行多方向搜索優(yōu)化處理,其具體優(yōu)化步驟如下。為便于描述優(yōu)化過(guò)程,圖中柵格為實(shí)際柵格放大所得,并不代表相連路徑與障礙物間的實(shí)際距離。取出路徑所有節(jié)點(diǎn),從節(jié)點(diǎn)PS開(kāi)始依次判斷....
本文編號(hào):4039203
本文鏈接:http://www.lk138.cn/kejilunwen/sousuoyinqinglunwen/4039203.html