• <tr id="yyy80"></tr>
  • <sup id="yyy80"></sup>
  • <tfoot id="yyy80"><noscript id="yyy80"></noscript></tfoot>
  • 99热精品在线国产_美女午夜性视频免费_国产精品国产高清国产av_av欧美777_自拍偷自拍亚洲精品老妇_亚洲熟女精品中文字幕_www日本黄色视频网_国产精品野战在线观看 ?

    多方向無(wú)人水面艇路徑規(guī)劃算法

    2020-11-30 05:48:22童心赤張華軍
    計(jì)算機(jī)應(yīng)用 2020年11期
    關(guān)鍵詞:柵格障礙物無(wú)人

    童心赤,張華軍,郭 航

    (武漢理工大學(xué)自動(dòng)化學(xué)院,武漢 430070)

    (?通信作者電子郵箱zhanghj@whut.edu.cn)

    0 引言

    近年來(lái),隨著無(wú)人平臺(tái)在軍事和民用等企業(yè)中的推廣,無(wú)人水面艇作為一種能夠在復(fù)雜海洋環(huán)境下自主航行并完成各項(xiàng)任務(wù)的水面平臺(tái)受到了極大關(guān)注[1-3]。路徑規(guī)劃是無(wú)人艇自主控制部分的關(guān)鍵要素,其任務(wù)是對(duì)當(dāng)前海洋環(huán)境信息進(jìn)行感知,對(duì)收集的信息進(jìn)行分析計(jì)算,實(shí)現(xiàn)有效且安全的路徑規(guī)劃。過(guò)去,最佳路徑通常與最短路徑相一致,隨著此問(wèn)題的定義不斷發(fā)展,最佳路徑的選取已與最小行進(jìn)距離、平均高度、燃油消耗、雷達(dá)輻射等諸多因素有關(guān),因此相關(guān)研究工作通常選擇啟發(fā)式搜索算法來(lái)實(shí)現(xiàn)路徑規(guī)劃[4]。目前對(duì)無(wú)人艇路徑規(guī)劃的方法主要有遺傳算法[5-6]、粒子群算法[7-8]、人工勢(shì)場(chǎng)算法[9-11]、A*算法[12-14]等,其中遺傳算法與粒子群算法等仿生進(jìn)化算法能有效利用已獲取的環(huán)境信息,同時(shí)又能不斷探索新路徑,避免了復(fù)雜的數(shù)學(xué)計(jì)算。另外人工勢(shì)場(chǎng)法通過(guò)產(chǎn)生包括排斥力和吸引力的勢(shì)場(chǎng)來(lái)描述障礙物和目標(biāo)點(diǎn)對(duì)路徑搜索的影響,但在解決大規(guī)模問(wèn)題時(shí)易陷入局部最優(yōu)解。A*算法是一類適用于全局環(huán)境信息已知的路徑規(guī)劃方法,它利用啟發(fā)函數(shù)值來(lái)估計(jì)任意點(diǎn)到目標(biāo)點(diǎn)的遠(yuǎn)近程度,從而減少搜索空間,提高搜索效率。

    目前普遍使用A*算法實(shí)現(xiàn)無(wú)人艇在不確定的海洋環(huán)境中的路徑規(guī)劃,但該算法生成的路徑只以路徑長(zhǎng)度為優(yōu)化目標(biāo),沒(méi)有考慮路徑的安全性與平滑度等因素。文獻(xiàn)[15]為避免障礙物與無(wú)人艇距離過(guò)近,對(duì)障礙物進(jìn)行一定的膨脹處理,結(jié)果顯示規(guī)劃的路徑具有較好的安全性,但該方法并不適用于復(fù)雜的海況環(huán)境;文獻(xiàn)[16]通過(guò)評(píng)估與障礙物間應(yīng)保持的最佳距離建立無(wú)人艇安全模型,并采用三次樣條插值算法擬合離散的路徑節(jié)點(diǎn)以獲得平滑連續(xù)的路徑;文獻(xiàn)[17]以三階貝塞爾曲線為基礎(chǔ)設(shè)計(jì)了滿足二階幾何連續(xù)的路徑平滑算法,并對(duì)平滑后的路徑進(jìn)行碰撞檢測(cè),仿真結(jié)果表明該算法能夠有效規(guī)劃出安全平滑的路徑。

    針對(duì)無(wú)人水面艇路徑規(guī)劃問(wèn)題,本文首先結(jié)合電子海圖生成柵格化環(huán)境信息,建立無(wú)人艇安全區(qū)域模型并以此作為生成最優(yōu)路徑點(diǎn)的安全距離約束;其次針對(duì)常規(guī)A*算法生成的路徑轉(zhuǎn)折次數(shù)多且轉(zhuǎn)折角大等問(wèn)題,設(shè)計(jì)一種多方向A*優(yōu)化算法與路徑平滑算法以規(guī)劃一條距離更短且更有效的受約束的全局最優(yōu)路徑;最后仿真結(jié)果驗(yàn)證了該改進(jìn)算法的有效性和可行性。

    1 模型建立

    1.1 無(wú)人水面艇安全區(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)的安全距離約束。半徑R 代表安全距離,安全距離約束下的路徑規(guī)劃應(yīng)保證無(wú)人艇與障礙物的最短距離大于安全距離,解決了無(wú)人艇在實(shí)際航行中的安全問(wèn)題。其搜索原理如圖1所示。

    圖1 基于安全區(qū)域的路徑搜索原理Fig.1 Principle of path search based on safe area

    1.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)格圖,建立柵格化地圖模型,并將以經(jīng)緯度表示的導(dǎo)航數(shù)據(jù)轉(zhuǎn)換到柵格地圖坐標(biāo)系中。在柵格圖中,定義每一單位柵格狀態(tài)為H(x,y),其中x、y分別代表柵格的橫向與縱向位置:白色部分H(x,y)=0表示可行區(qū)域;黑色部分H(x,y)=1 表示障礙物,這使得無(wú)人艇碰撞的風(fēng)險(xiǎn)度僅取決于柵格狀態(tài)值。對(duì)某一海域進(jìn)行柵格化處理,將環(huán)境信息離散化為一系列的二值化柵格,處理結(jié)果如圖2所示。

    圖2 環(huán)境信息柵格處理圖Fig.2 Rasterization processing chart of environment information

    為實(shí)現(xiàn)無(wú)人艇實(shí)時(shí)路徑導(dǎo)航,現(xiàn)將每一時(shí)刻的位置信息(經(jīng)度與緯度值)與柵格節(jié)點(diǎn)一一對(duì)應(yīng)。假設(shè)某一海圖內(nèi)的最大經(jīng)度為maxlon,最小經(jīng)度為minlon,最大緯度為maxlat,最小緯度為minlat,對(duì)應(yīng)的柵格地圖橫向劃分為a 個(gè)柵格,縱向劃分為b個(gè)柵格,則各經(jīng)緯度對(duì)應(yīng)的具體柵格位置為:

    其中:floor 操作為取整運(yùn)算;x,y 分別為對(duì)應(yīng)柵格的橫向與縱向位置;lon,lat分別為當(dāng)前位置的經(jīng)度與緯度信息。

    2 基于改進(jìn)A*算法的路徑規(guī)劃

    A*算法作為一種啟發(fā)式搜索算法,根據(jù)啟發(fā)函數(shù)以最小代價(jià)快速返回最優(yōu)路徑,保證了路徑完整性以及搜索高效性,但是常規(guī)A*算法僅以路徑長(zhǎng)度作為啟發(fā)函數(shù)值,規(guī)劃出的路徑并不能有效引導(dǎo)無(wú)人艇在復(fù)雜海洋環(huán)境下安全平滑的運(yùn)動(dòng)。

    針對(duì)該問(wèn)題,本文首先根據(jù)無(wú)人艇安全區(qū)域模型,建立安全距離約束下的A*啟發(fā)函數(shù)來(lái)搜索最短路徑。然后設(shè)計(jì)一種多方向A*搜索算法減少并修正不必要的路徑節(jié)點(diǎn),獲得多方向A*優(yōu)化路徑。最后建立平滑處理安全區(qū)域,在此區(qū)域約束下采用三次樣條插值算法擬合離散的關(guān)鍵路徑節(jié)點(diǎn)以獲得連續(xù)平滑的路徑。

    2.1 安全距離約束下的A*啟發(fā)函數(shù)

    基于上述構(gòu)建的柵格化地圖模型,采用具有安全距離約束的A*算法以實(shí)現(xiàn)路徑規(guī)劃。在柵格地圖中,A*算法采用啟發(fā)函數(shù)f(n)來(lái)估計(jì)地圖上任意柵格到目標(biāo)柵格的代價(jià),從而引導(dǎo)搜索方向。函數(shù)f(n)表達(dá)式如下:

    其中:g(n)為各單元柵格到起始柵格的距離,h(n)為各單元柵格到目標(biāo)柵格的啟發(fā)式代價(jià)。

    如圖3 所示,在柵格地圖中,無(wú)人艇運(yùn)動(dòng)位置可由某一具體柵格表示,將A*搜索方式設(shè)置為八方向搜索,即與當(dāng)前柵格相鄰的八個(gè)柵格作為無(wú)人艇下一時(shí)刻的可選位置。在安全距離約束下,使用八方向A*算法搜索各柵格節(jié)點(diǎn),設(shè)置各柵格對(duì)應(yīng)的啟發(fā)式代價(jià)為:

    式中:DE為柵格到目標(biāo)柵格E 的距離,l 為柵格到周圍障礙物的最短距離,R 為無(wú)人艇安全半徑。l ≥R 代表當(dāng)前位置無(wú)人艇安全區(qū)域內(nèi)不存在障礙物;相反,l <R 則代表安全區(qū)域內(nèi)存在障礙物。

    圖3 安全距離約束下的八方向搜索原理Fig.3 Principle of eight-directional search under safety distance constraint

    根據(jù)式(3),安全距離約束下各柵格的啟發(fā)函數(shù)可定義為:

    式中DS為柵格到起始柵格S的距離。

    2.2 多方向A*搜索算法

    八方向A*搜索算法只能以45°和90°方向作為路徑搜索選項(xiàng),就整體路徑而言,該搜索方式并不能保證最優(yōu)性。因此以路徑距離最短為優(yōu)化目標(biāo)對(duì)已規(guī)劃出的路徑節(jié)點(diǎn)進(jìn)行調(diào)整以實(shí)現(xiàn)多方向A*搜索,定義某一路徑起點(diǎn)為PS、終點(diǎn)為PE、中間節(jié)點(diǎn)為Pi(i=1,2,…,n),其具體步驟如下。

    步驟1 提取安全距離約束下八方向A*算法規(guī)劃的路徑PS→P1→P2→…→Pi→PE中所有節(jié)點(diǎn)。

    步驟2 從起點(diǎn)PS開(kāi)始判斷節(jié)點(diǎn)Pi(Pi=PS)與剩余節(jié)點(diǎn)的相連路徑Pi→Pi+1(Pi+1=P1,P2,…,PE)是否滿足安全距離約束,即判斷相連路徑上所有節(jié)點(diǎn)到障礙物的距離是否小于安全半徑。記錄滿足約束條件的最靠后節(jié)點(diǎn)Pj1。若Pj1=PE則執(zhí)行步驟4,若Pj1≠PE則執(zhí)行步驟3。

    步驟3 判斷節(jié)點(diǎn)Pjk(Pjk=Pj1)與剩余節(jié)點(diǎn)的相連路徑是否滿足安全距離約束,記錄滿足約束條件的最靠后節(jié)點(diǎn)Pj2。若Pj2=PE則執(zhí)行步驟4,若Pj2≠PE則重復(fù)執(zhí)行步驟3。

    步驟4 輸出節(jié)點(diǎn)Pi的最終優(yōu)化路徑Path_i 為:PS→…→Pi→Pj1→Pj2→…→PE。若Pi=PE則執(zhí)行步驟5,若Pi≠PE則令Pi=Pi+1并執(zhí)行步驟2。

    步驟5 比較所有節(jié)點(diǎn)優(yōu)化路徑長(zhǎng)度,選擇其中最短路徑作為多方向A*搜索算法優(yōu)化路徑。

    在柵格圖中,假設(shè)某一路徑的路徑節(jié)點(diǎn)為P1,P2,…,Pm,則該路徑長(zhǎng)度DP可計(jì)算為:其中:Pi(x)、Pi(y)表示節(jié)點(diǎn)的橫坐標(biāo)和縱坐標(biāo),m為路徑的節(jié)點(diǎn)數(shù)。

    其次在多方向優(yōu)化過(guò)程中,需判斷兩節(jié)點(diǎn)相連路徑是否安全,因此需計(jì)算路徑所經(jīng)過(guò)的所有柵格是否滿足安全距離約束。假設(shè)兩柵格P(i1,j1)和P(i2,j2)之間的坐標(biāo)位置差異為Δi、Δj,且i1<i2、j1<j2。若Δi <Δj 則路徑所有柵格坐標(biāo)位置計(jì)算方法如下:

    同理,若Δi >Δj 則被路徑所有柵格坐標(biāo)位置計(jì)算方法如下:

    如圖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í)際距離。

    圖4 多方向A*搜索算法示例圖Fig.4 Example of multi-directional A*search algorithm

    取出路徑所有節(jié)點(diǎn),從節(jié)點(diǎn)PS開(kāi)始依次判斷該點(diǎn)與節(jié)點(diǎn)P1,P2,P3,P4,P5,P6,P7,PE的相連路徑是否滿足安全距離約束,取出滿足約束條件的最靠后節(jié)點(diǎn)P4。然后依次判斷節(jié)點(diǎn)P4與節(jié)點(diǎn)P5,P6,P7,PE的相連路徑是否滿足約束條件,同樣取出滿足約束條件的最靠后節(jié)點(diǎn)PE,最后輸出節(jié)點(diǎn)PS的優(yōu)化路徑為Path_S:PS→P4→PE。

    路徑剩余節(jié)點(diǎn)P1,P2,P3,P4,P5,P6,P7的優(yōu)化步驟與節(jié)點(diǎn)PS一致,依次得到各節(jié)點(diǎn)的優(yōu)化路徑為:

    Path_1:PS→P1→P4→PE

    Path_2:PS→P1→P2→P4→PE

    Path_3:PS→P1→P2→P3→P6→P7→PE

    Path_4:PS→P4→PE

    Path_5:PS→P4→P5→P6→P7→PE

    Path_6:PS→P4→P5→P6→PE

    Path_7:PS→P4→P5→P6→P7→PE

    最后依次比較各優(yōu)化路徑長(zhǎng)度大小并取出其中較短路徑,得到最終優(yōu)化路徑2為PS→P4→PE,明顯相較于路徑1該路徑長(zhǎng)度大大減小且規(guī)劃更為合理。

    2.3 多方向A*搜索算法

    路徑由多方向A*算法優(yōu)化后,雖刪除并整合了不必要的節(jié)點(diǎn),但優(yōu)化路徑仍由許多剩余節(jié)點(diǎn)相連的短線段組成,導(dǎo)致路徑轉(zhuǎn)折角較大。針對(duì)該問(wèn)題,本文采用與原始路徑偏差較小的三次樣條插值算法進(jìn)一步改善路徑的平滑性。該算法的主要原理是使用由三階多項(xiàng)式組成的樣條來(lái)連接一組路徑節(jié)點(diǎn),通過(guò)求解此多項(xiàng)式以擬合原路徑。若給定n個(gè)路徑節(jié)點(diǎn),則存在n -1個(gè)節(jié)點(diǎn)區(qū)間,設(shè)每個(gè)區(qū)間[xk,xk+1]的三次樣條函數(shù)為:

    為保證生成的路徑光滑連續(xù),該多項(xiàng)式應(yīng)滿足以下約束條件:

    根據(jù)式(9),對(duì)所有路徑節(jié)點(diǎn)區(qū)間進(jìn)行平滑處理可獲得原路徑的擬合平滑曲線。而多方向A*搜索算法新生成的路徑相鄰節(jié)點(diǎn)距離較遠(yuǎn),導(dǎo)致平滑曲線與原路徑擬合程度較差。因此本研究?jī)H對(duì)路徑關(guān)鍵節(jié)點(diǎn)即航向改變節(jié)點(diǎn)進(jìn)行平滑處理,假設(shè)某一關(guān)鍵節(jié)點(diǎn)為Pi(xi,f(xi)),則取該節(jié)點(diǎn)前后相鄰四個(gè)節(jié)點(diǎn)Pi-2、Pi-1、Pi+1、Pi+2生成4 個(gè)節(jié)點(diǎn)區(qū)間以獲得關(guān)鍵節(jié)點(diǎn)平滑曲線。

    為保障路徑的安全性,消除平滑處理所造成的路徑變化影響,設(shè)計(jì)一半徑為RS的圓形區(qū)域包圍路徑關(guān)鍵節(jié)點(diǎn)作為平滑區(qū)域。如圖5 所示,結(jié)合安全半徑R,將關(guān)鍵節(jié)點(diǎn)的安全區(qū)域擴(kuò)大為半徑R+RS的圓形區(qū)域。因此對(duì)關(guān)鍵節(jié)點(diǎn)平滑處理應(yīng)滿足條件:

    式中l(wèi)為關(guān)鍵節(jié)點(diǎn)到障礙物的最短距離。

    圖5 關(guān)鍵節(jié)點(diǎn)平滑處理的安全區(qū)域示例圖Fig.5 Example diagram of safe area smoothed by key nodes

    3 基于改進(jìn)A*算法的路徑規(guī)劃

    本實(shí)驗(yàn)采用微軟Core i5-4200M 處理器,主頻為2.5 GHz,內(nèi)存為8 GB。在Python 3.7 環(huán)境下,為驗(yàn)證上述算法的可行性,現(xiàn)提取經(jīng)度范圍為112.513 926°E ~112.700 695°E、緯度范圍為21.570 176°N ~21.735 468°N 的實(shí)際海上環(huán)境信息,并對(duì)其進(jìn)行柵格化處理,設(shè)置每個(gè)柵格代表的橫向與縱向?qū)嶋H距離均為20 m,處理結(jié)果如圖2 所示。根據(jù)無(wú)人艇操縱特性與航行環(huán)境,將安全半徑R 設(shè)置為20 m、60 m 與100 m,分別對(duì)應(yīng)1個(gè)、3個(gè)、5個(gè)柵格距離。

    圖6 不同安全距離下的路徑規(guī)劃對(duì)比Fig.6 Comparison of path planning under different safety distances

    將所設(shè)置的三種不同安全半徑作為無(wú)人艇的安全距離約束,設(shè)置路徑起始點(diǎn)為(100,280),目標(biāo)點(diǎn)為(320,20),重復(fù)進(jìn)行20次路徑規(guī)劃。圖6顯示了不同安全距離約束下的路徑規(guī)劃結(jié)果,三種路徑存在明顯差別,其中安全半徑越大的路徑距障礙物越遠(yuǎn)。

    各路徑上的節(jié)點(diǎn)到周圍障礙物的最短距離如圖7 所示,橫坐標(biāo)代表路徑節(jié)點(diǎn)位置,縱坐標(biāo)代表各路徑節(jié)點(diǎn)到周圍障礙物的最短距離。其中所標(biāo)記的黑色節(jié)點(diǎn)為各路徑上距障礙物最近的節(jié)點(diǎn),該點(diǎn)縱坐標(biāo)值均等于所設(shè)置的安全半徑大小,可見(jiàn)路徑節(jié)點(diǎn)均符合安全距離約束。

    圖7 不同路徑節(jié)點(diǎn)與障礙物的最短距離對(duì)比Fig.7 Comparison of the shortest distances between different path nodes and obstacles

    因此由圖6、圖7 可知:安全距離約束下的A*啟發(fā)函數(shù)能夠準(zhǔn)確搜索到一條從起點(diǎn)到終點(diǎn)的安全路徑。

    在不同安全距離約束下,各路徑的總節(jié)點(diǎn)數(shù)、路徑長(zhǎng)度與規(guī)劃時(shí)間具體對(duì)比結(jié)果如表1 所示。隨著安全半徑的增加,路徑總節(jié)點(diǎn)數(shù)以及路徑長(zhǎng)度均小幅度地增加。另外安全半徑為R=60 m 與R=100 m 的規(guī)劃時(shí)間較R=20 m 分別增加了0.4 s 和1.77 s,這是由于路徑規(guī)劃過(guò)程中安全半徑設(shè)置得越大,需搜索的柵格節(jié)點(diǎn)增加得越多,所需的計(jì)算成本也更高。

    表1 不同安全距離下的路徑規(guī)劃結(jié)果Tab.1 Path planning results under different safety distances

    另外,為驗(yàn)證多方向A*搜索算法以及路徑平滑算法性能,本文在上述仿真的基礎(chǔ)上設(shè)置平滑區(qū)域半徑RS=40 m,并對(duì)R=60 m 的常規(guī)A*搜索路徑重復(fù)進(jìn)行20 次優(yōu)化平滑處理。常規(guī)A*搜索路徑經(jīng)多方向A*搜索算法優(yōu)化后,僅由起始點(diǎn)、目標(biāo)點(diǎn)以及三個(gè)關(guān)鍵節(jié)點(diǎn)相連而成。多方向優(yōu)化路徑上各節(jié)點(diǎn)到障礙物的最短距離如圖8 所示,其中橫坐標(biāo)代表節(jié)點(diǎn)位置,縱坐標(biāo)代表節(jié)點(diǎn)距障礙物的最短距離。另外所標(biāo)記的黑色實(shí)心節(jié)點(diǎn)代表優(yōu)化路徑上距離障礙物最近的節(jié)點(diǎn),黑色空心節(jié)點(diǎn)則為路徑上的三個(gè)關(guān)鍵節(jié)點(diǎn)。

    圖8 多方向優(yōu)化路徑節(jié)點(diǎn)與障礙物最短距離圖Fig.8 The shortest distance between nodes of multi-directional optimized path and obstacles

    由圖8 可知:多方向優(yōu)化路徑上距障礙物的最短距離為63.2 m,符合半徑R=60 m 的安全約束。另外路徑上關(guān)鍵節(jié)點(diǎn)距障礙物的最短距離分別為174.1 m、72.1 m、72.6 m,而關(guān)鍵節(jié)點(diǎn)平滑處理安全半徑為R+RS=100 m,可見(jiàn)僅第一個(gè)關(guān)鍵節(jié)點(diǎn)滿足平滑處理約束條件。對(duì)該關(guān)鍵節(jié)點(diǎn)進(jìn)行平滑處理后的最終優(yōu)化路徑及優(yōu)化結(jié)果如圖9以及表2所示。

    圖9 不同算法優(yōu)化的路徑Fig.9 Optimized paths of different algorithms

    由圖9、表2 可知:改進(jìn)A*多方向搜索算法可以有效地整合并去除傳統(tǒng)路徑中多余的節(jié)點(diǎn),減少路徑長(zhǎng)度,其中路徑節(jié)點(diǎn)數(shù)與路徑長(zhǎng)度均明顯小于其余三種算法。同樣改進(jìn)A*算法消除了路徑轉(zhuǎn)折次數(shù)多且轉(zhuǎn)折角較大的問(wèn)題,轉(zhuǎn)向次數(shù)減少至3 次,在一定程度上達(dá)到最優(yōu)。另外改進(jìn)A*算法與其余三種算法時(shí)間復(fù)雜度均為O(n2),雖然搜索節(jié)點(diǎn)數(shù)的增加導(dǎo)致路徑規(guī)劃時(shí)間小幅度地提高,但它始終提供一條距離成本更低且轉(zhuǎn)向次數(shù)更少的路徑,這更加符合無(wú)人艇路徑規(guī)劃時(shí)的實(shí)際需求。

    4 結(jié)語(yǔ)

    針對(duì)無(wú)人水面艇路徑規(guī)劃時(shí)的安全性、經(jīng)濟(jì)性及實(shí)用性要求,本研究改進(jìn)A*算法取得了較好的效果。通過(guò)建立無(wú)人艇安全區(qū)域模型,使該模型作為生成最優(yōu)路徑點(diǎn)的安全距離約束,并在八方向A*算法上設(shè)計(jì)一種多方向搜索算法以及路徑平滑算法以獲得更符合無(wú)人艇操縱特性的全局最優(yōu)路徑。所提出的改進(jìn)A*算法經(jīng)過(guò)對(duì)比分析,結(jié)果表明該方法可生成更安全、距離更短、平滑度更好的路徑,非常適用于復(fù)雜海洋環(huán)境下無(wú)人艇的實(shí)時(shí)路徑規(guī)劃。

    猜你喜歡
    柵格障礙物無(wú)人
    基于鄰域柵格篩選的點(diǎn)云邊緣點(diǎn)提取方法*
    高低翻越
    SelTrac?CBTC系統(tǒng)中非通信障礙物的設(shè)計(jì)和處理
    無(wú)人戰(zhàn)士無(wú)人車
    反擊無(wú)人機(jī)
    詩(shī)到無(wú)人愛(ài)處工
    無(wú)人超市會(huì)流行起來(lái)嗎?
    不同剖面形狀的柵格壁對(duì)柵格翼氣動(dòng)特性的影響
    基于CVT排布的非周期柵格密度加權(quán)陣設(shè)計(jì)
    土釘墻在近障礙物的地下車行通道工程中的應(yīng)用
    亚洲avbb在线观看| xxxwww97欧美| 在线观看美女被高潮喷水网站 | 亚洲av一区综合| 日韩av在线大香蕉| 18禁在线播放成人免费| 91麻豆精品激情在线观看国产| 亚洲自偷自拍三级| 精品人妻偷拍中文字幕| 人妻夜夜爽99麻豆av| 国产老妇女一区| 老司机深夜福利视频在线观看| 少妇人妻精品综合一区二区 | 欧洲精品卡2卡3卡4卡5卡区| 久久精品国产亚洲av天美| 精品99又大又爽又粗少妇毛片 | 亚洲av中文字字幕乱码综合| 中文资源天堂在线| 在线观看舔阴道视频| 精品一区二区三区视频在线| 男人和女人高潮做爰伦理| 日韩 亚洲 欧美在线| 一级作爱视频免费观看| 欧美xxxx性猛交bbbb| 女人被狂操c到高潮| 日韩 亚洲 欧美在线| 久久草成人影院| 久久久久精品国产欧美久久久| 精品日产1卡2卡| 黄色丝袜av网址大全| 国产精品亚洲av一区麻豆| 国产精品久久电影中文字幕| 国产aⅴ精品一区二区三区波| 可以在线观看毛片的网站| 精品人妻一区二区三区麻豆 | 成人特级黄色片久久久久久久| 国产日本99.免费观看| 亚洲,欧美,日韩| 高清日韩中文字幕在线| 人妻夜夜爽99麻豆av| 97碰自拍视频| 午夜福利18| 国产伦精品一区二区三区视频9| 国产一区二区在线av高清观看| 俄罗斯特黄特色一大片| 两个人视频免费观看高清| 91在线精品国自产拍蜜月| 欧美性猛交黑人性爽| 日本 av在线| 香蕉av资源在线| 国产毛片a区久久久久| 亚洲,欧美,日韩| 99热这里只有是精品50| 久久国产精品人妻蜜桃| 精品一区二区三区av网在线观看| 国产亚洲欧美98| 人妻久久中文字幕网| 亚洲国产精品久久男人天堂| 国产成人福利小说| 国产91精品成人一区二区三区| 久久精品国产清高在天天线| 丰满的人妻完整版| 亚洲美女视频黄频| 高清日韩中文字幕在线| 嫩草影院精品99| 一个人观看的视频www高清免费观看| 麻豆av噜噜一区二区三区| 成人一区二区视频在线观看| 12—13女人毛片做爰片一| 久久精品国产清高在天天线| 国产亚洲av嫩草精品影院| 亚洲美女搞黄在线观看 | 色哟哟·www| 国产精品嫩草影院av在线观看 | 真人做人爱边吃奶动态| 日韩人妻高清精品专区| 亚洲无线在线观看| 99热6这里只有精品| 成人一区二区视频在线观看| 亚洲av成人不卡在线观看播放网| 嫩草影院精品99| 狂野欧美白嫩少妇大欣赏| 人妻丰满熟妇av一区二区三区| 欧美日韩综合久久久久久 | 国产欧美日韩精品亚洲av| 午夜免费激情av| 高清在线国产一区| 夜夜看夜夜爽夜夜摸| 久久久久久久久大av| 色播亚洲综合网| 成人亚洲精品av一区二区| 成人永久免费在线观看视频| 欧美bdsm另类| 中国美女看黄片| 欧美国产日韩亚洲一区| 一区二区三区激情视频| 九色成人免费人妻av| 毛片女人毛片| 国产伦精品一区二区三区四那| 国内精品美女久久久久久| 日韩欧美一区二区三区在线观看| 午夜免费激情av| 久久人妻av系列| 国产亚洲精品久久久久久毛片| 久久婷婷人人爽人人干人人爱| 啪啪无遮挡十八禁网站| 亚洲天堂国产精品一区在线| 可以在线观看的亚洲视频| 国产久久久一区二区三区| 亚洲最大成人中文| 婷婷六月久久综合丁香| 日韩高清综合在线| 中文字幕久久专区| 又粗又爽又猛毛片免费看| 国产av不卡久久| 欧美色视频一区免费| 亚洲第一电影网av| 在线a可以看的网站| 久久婷婷人人爽人人干人人爱| 99久久无色码亚洲精品果冻| 九色国产91popny在线| 九九在线视频观看精品| 变态另类丝袜制服| 色视频www国产| 18+在线观看网站| 欧美+亚洲+日韩+国产| or卡值多少钱| 欧美成人免费av一区二区三区| 少妇熟女aⅴ在线视频| 国产真实伦视频高清在线观看 | 桃色一区二区三区在线观看| 伦理电影大哥的女人| 精品久久久久久,| 少妇裸体淫交视频免费看高清| 国产成人欧美在线观看| 国产精品乱码一区二三区的特点| 久久精品国产清高在天天线| 精品熟女少妇八av免费久了| 搡老熟女国产l中国老女人| 2021天堂中文幕一二区在线观| 极品教师在线免费播放| 亚洲不卡免费看| 婷婷亚洲欧美| 久久久久久久久久黄片| 九色成人免费人妻av| 给我免费播放毛片高清在线观看| 色av中文字幕| 免费一级毛片在线播放高清视频| 午夜日韩欧美国产| 九九在线视频观看精品| 国产av在哪里看| 亚洲美女视频黄频| 国内毛片毛片毛片毛片毛片| 1024手机看黄色片| 国产成人欧美在线观看| 成人美女网站在线观看视频| 欧美日韩国产亚洲二区| 国产精品亚洲一级av第二区| 成人三级黄色视频| 亚洲av成人av| 欧美成人a在线观看| 97超级碰碰碰精品色视频在线观看| 老女人水多毛片| 身体一侧抽搐| 亚洲,欧美精品.| 日韩亚洲欧美综合| 国产激情偷乱视频一区二区| 人人妻,人人澡人人爽秒播| 99久久精品热视频| 最后的刺客免费高清国语| 99热这里只有是精品50| 亚洲成人精品中文字幕电影| 99riav亚洲国产免费| 国内精品久久久久精免费| 99久久久亚洲精品蜜臀av| 综合色av麻豆| 国产中年淑女户外野战色| 91在线观看av| 特级一级黄色大片| 97人妻精品一区二区三区麻豆| 毛片一级片免费看久久久久 | 国产伦精品一区二区三区四那| 人人妻人人澡欧美一区二区| 中国美女看黄片| 人妻丰满熟妇av一区二区三区| 国产精品综合久久久久久久免费| 露出奶头的视频| 99久国产av精品| 一级黄色大片毛片| 一个人免费在线观看的高清视频| 欧美国产日韩亚洲一区| 97碰自拍视频| 日韩av在线大香蕉| 99久久精品一区二区三区| 国产三级在线视频| 男女视频在线观看网站免费| 真人做人爱边吃奶动态| 久久婷婷人人爽人人干人人爱| 精品欧美国产一区二区三| 午夜视频国产福利| 18禁黄网站禁片免费观看直播| 在线观看午夜福利视频| 男女那种视频在线观看| 久久欧美精品欧美久久欧美| 精品久久久久久久末码| 精品国内亚洲2022精品成人| 一a级毛片在线观看| 男插女下体视频免费在线播放| 成人精品一区二区免费| 久久这里只有精品中国| 一进一出抽搐动态| 欧美不卡视频在线免费观看| 欧美黑人欧美精品刺激| 色av中文字幕| 免费av不卡在线播放| 少妇的逼好多水| 国产成人欧美在线观看| 亚洲国产高清在线一区二区三| 久久久久久久午夜电影| 直男gayav资源| 国产精品一区二区性色av| 精品久久久久久久久av| 蜜桃久久精品国产亚洲av| 欧美日韩黄片免| 国产精品精品国产色婷婷| 蜜桃久久精品国产亚洲av| 我的老师免费观看完整版| 偷拍熟女少妇极品色| 别揉我奶头 嗯啊视频| 两个人的视频大全免费| 最近中文字幕高清免费大全6 | 久久久久久久久中文| www日本黄色视频网| 99riav亚洲国产免费| 日韩欧美在线乱码| 国产精品一及| 国产精品久久久久久久久免 | 一个人观看的视频www高清免费观看| 中出人妻视频一区二区| 变态另类成人亚洲欧美熟女| 99国产综合亚洲精品| www.熟女人妻精品国产| 无遮挡黄片免费观看| 国模一区二区三区四区视频| 午夜视频国产福利| 精品国产三级普通话版| 老司机午夜十八禁免费视频| 亚洲精品在线美女| 性色av乱码一区二区三区2| 亚洲avbb在线观看| 国内少妇人妻偷人精品xxx网站| 91在线精品国自产拍蜜月| 天堂网av新在线| 日韩成人在线观看一区二区三区| 麻豆成人午夜福利视频| 日韩精品中文字幕看吧| 露出奶头的视频| 丰满人妻熟妇乱又伦精品不卡| 日韩人妻高清精品专区| 男人的好看免费观看在线视频| 欧美潮喷喷水| 我的女老师完整版在线观看| 精品午夜福利视频在线观看一区| 又粗又爽又猛毛片免费看| 老鸭窝网址在线观看| 99久久精品一区二区三区| 国产主播在线观看一区二区| 两人在一起打扑克的视频| av福利片在线观看| 我要搜黄色片| 成人欧美大片| 国产精品,欧美在线| 日本撒尿小便嘘嘘汇集6| 亚洲专区国产一区二区| 观看美女的网站| 国产精品一区二区免费欧美| av欧美777| 国产成人av教育| 网址你懂的国产日韩在线| 国产亚洲欧美在线一区二区| 极品教师在线视频| h日本视频在线播放| 欧美午夜高清在线| 免费观看的影片在线观看| 国产综合懂色| 亚洲精品在线美女| 91麻豆精品激情在线观看国产| 夜夜爽天天搞| 亚洲人成伊人成综合网2020| 欧美zozozo另类| 99久国产av精品| 欧美乱色亚洲激情| 少妇丰满av| 性插视频无遮挡在线免费观看| 别揉我奶头 嗯啊视频| 亚洲经典国产精华液单 | 亚洲人成伊人成综合网2020| 亚洲国产高清在线一区二区三| 制服丝袜大香蕉在线| 啦啦啦观看免费观看视频高清| 欧美在线黄色| 成年免费大片在线观看| 日韩免费av在线播放| 久久久久国内视频| 国产精品国产高清国产av| 丰满乱子伦码专区| 夜夜躁狠狠躁天天躁| 精品久久久久久,| 麻豆成人午夜福利视频| 日韩中文字幕欧美一区二区| 久久6这里有精品| 中文字幕av在线有码专区| 欧美午夜高清在线| 观看美女的网站| 99热这里只有是精品50| 日韩欧美一区二区三区在线观看| 国产视频内射| 欧美+亚洲+日韩+国产| 亚洲欧美清纯卡通| 国产精品98久久久久久宅男小说| 国产精品女同一区二区软件 | 久久久久久九九精品二区国产| 欧美成人一区二区免费高清观看| 国产探花极品一区二区| 国产精品自产拍在线观看55亚洲| 欧美最黄视频在线播放免费| 久久精品国产清高在天天线| 国产久久久一区二区三区| 村上凉子中文字幕在线| 亚洲人成伊人成综合网2020| 亚洲专区中文字幕在线| 99在线视频只有这里精品首页| 免费av不卡在线播放| 露出奶头的视频| 日本三级黄在线观看| 熟女电影av网| 一个人免费在线观看的高清视频| 校园春色视频在线观看| 欧美日韩综合久久久久久 | 男女床上黄色一级片免费看| 嫩草影院新地址| 亚洲欧美激情综合另类| 国产伦在线观看视频一区| 日韩免费av在线播放| 国产欧美日韩精品亚洲av| 久久午夜亚洲精品久久| 波多野结衣巨乳人妻| 自拍偷自拍亚洲精品老妇| 最近中文字幕高清免费大全6 | 无人区码免费观看不卡| 欧美乱色亚洲激情| 亚洲片人在线观看| 毛片女人毛片| 免费人成在线观看视频色| 午夜影院日韩av| 亚洲黑人精品在线| 人妻丰满熟妇av一区二区三区| 久久久久亚洲av毛片大全| 久久6这里有精品| 好看av亚洲va欧美ⅴa在| 国产三级黄色录像| 看免费av毛片| 波多野结衣高清作品| 国产在视频线在精品| 一a级毛片在线观看| 最新在线观看一区二区三区| 国产精品久久久久久亚洲av鲁大| 狂野欧美白嫩少妇大欣赏| 身体一侧抽搐| 亚洲av免费高清在线观看| 精品不卡国产一区二区三区| 成人无遮挡网站| 看十八女毛片水多多多| 日韩av在线大香蕉| 激情在线观看视频在线高清| 日日干狠狠操夜夜爽| 国产伦在线观看视频一区| 90打野战视频偷拍视频| 天堂av国产一区二区熟女人妻| 亚洲自偷自拍三级| 亚洲在线观看片| 精品乱码久久久久久99久播| 最近最新中文字幕大全电影3| 黄色女人牲交| www.熟女人妻精品国产| 色综合亚洲欧美另类图片| 精品99又大又爽又粗少妇毛片 | 直男gayav资源| 亚洲人成网站高清观看| 久久久成人免费电影| 人妻久久中文字幕网| 亚洲国产精品999在线| 99久久精品国产亚洲精品| 精品人妻偷拍中文字幕| 熟女人妻精品中文字幕| 成人av一区二区三区在线看| 久9热在线精品视频| 国产午夜福利久久久久久| 一边摸一边抽搐一进一小说| 免费av不卡在线播放| 夜夜爽天天搞| av天堂中文字幕网| 精品久久久久久久末码| 久久精品国产亚洲av天美| 丁香欧美五月| 国产v大片淫在线免费观看| 无遮挡黄片免费观看| 夜夜夜夜夜久久久久| 成人国产一区最新在线观看| 真人一进一出gif抽搐免费| 亚洲中文字幕日韩| 亚洲精品久久国产高清桃花| 波野结衣二区三区在线| 日韩高清综合在线| 一区二区三区激情视频| 国产精品嫩草影院av在线观看 | 日韩精品青青久久久久久| 毛片女人毛片| 亚洲成人久久性| 亚洲国产色片| 国内精品美女久久久久久| 午夜老司机福利剧场| 亚洲专区国产一区二区| 高清毛片免费观看视频网站| 日本成人三级电影网站| 18禁裸乳无遮挡免费网站照片| 亚洲专区国产一区二区| 午夜免费激情av| 欧美区成人在线视频| 桃红色精品国产亚洲av| 国产熟女xx| 久久精品影院6| 男女视频在线观看网站免费| 日本免费a在线| 日本三级黄在线观看| 日本免费一区二区三区高清不卡| 两个人视频免费观看高清| 欧美最黄视频在线播放免费| 男女下面进入的视频免费午夜| av女优亚洲男人天堂| 日韩国内少妇激情av| 九色成人免费人妻av| 久久伊人香网站| 日本与韩国留学比较| 亚洲成av人片免费观看| 免费在线观看日本一区| 色综合婷婷激情| 国产精品av视频在线免费观看| 国产欧美日韩一区二区精品| 黄色配什么色好看| 十八禁网站免费在线| 精品99又大又爽又粗少妇毛片 | 我要搜黄色片| 色av中文字幕| 1000部很黄的大片| 最近最新免费中文字幕在线| 天堂网av新在线| 99热只有精品国产| 女人十人毛片免费观看3o分钟| 啦啦啦韩国在线观看视频| 精品久久久久久久久亚洲 | 好男人在线观看高清免费视频| 欧美+日韩+精品| 亚洲国产欧洲综合997久久,| 精品久久久久久成人av| 国产亚洲精品久久久久久毛片| 欧美性猛交黑人性爽| 又黄又爽又刺激的免费视频.| 人人妻人人澡欧美一区二区| 激情在线观看视频在线高清| 成人特级av手机在线观看| 老司机午夜福利在线观看视频| 精品国产亚洲在线| 免费搜索国产男女视频| 99热这里只有是精品50| 国产乱人视频| 欧美激情在线99| 中文资源天堂在线| АⅤ资源中文在线天堂| 国产精品久久久久久久久免 | 我的女老师完整版在线观看| 麻豆成人午夜福利视频| 熟女电影av网| 欧美黑人巨大hd| 国产伦在线观看视频一区| 亚洲18禁久久av| 精品99又大又爽又粗少妇毛片 | 最新中文字幕久久久久| 国产真实乱freesex| 亚洲人成网站在线播放欧美日韩| 欧美zozozo另类| 91九色精品人成在线观看| 亚洲av成人av| 特大巨黑吊av在线直播| 国产高潮美女av| 最近最新免费中文字幕在线| 亚洲一区二区三区不卡视频| 我的女老师完整版在线观看| 国产成人欧美在线观看| 亚洲成人久久性| 国产精品久久视频播放| 成人永久免费在线观看视频| 少妇的逼好多水| 国产单亲对白刺激| 成人特级黄色片久久久久久久| 九九热线精品视视频播放| 午夜福利成人在线免费观看| 国产午夜福利久久久久久| 美女xxoo啪啪120秒动态图 | 无遮挡黄片免费观看| 亚洲精品久久国产高清桃花| 脱女人内裤的视频| 成人三级黄色视频| 成年人黄色毛片网站| 成年版毛片免费区| 亚洲av一区综合| 在线观看舔阴道视频| 久久久久久久午夜电影| 亚洲不卡免费看| 深夜a级毛片| 免费在线观看亚洲国产| 一区二区三区激情视频| 天天躁日日操中文字幕| 亚洲最大成人中文| 亚洲最大成人av| 怎么达到女性高潮| 最新中文字幕久久久久| 国产69精品久久久久777片| 人妻夜夜爽99麻豆av| 高清毛片免费观看视频网站| 又紧又爽又黄一区二区| 国模一区二区三区四区视频| 国产精品98久久久久久宅男小说| 夜夜爽天天搞| 欧美精品啪啪一区二区三区| 在线观看美女被高潮喷水网站 | 成人特级黄色片久久久久久久| a级毛片免费高清观看在线播放| 亚洲成人免费电影在线观看| 啪啪无遮挡十八禁网站| 18+在线观看网站| 亚洲av成人av| 又爽又黄a免费视频| 欧美bdsm另类| 亚洲av不卡在线观看| 少妇被粗大猛烈的视频| 国产成人欧美在线观看| 神马国产精品三级电影在线观看| 国产在线精品亚洲第一网站| 欧美日本亚洲视频在线播放| 日韩亚洲欧美综合| 国产视频一区二区在线看| 日韩av在线大香蕉| 黄色配什么色好看| 观看美女的网站| 天天一区二区日本电影三级| 免费看美女性在线毛片视频| 精品久久久久久久人妻蜜臀av| 欧美性猛交黑人性爽| 国产激情偷乱视频一区二区| 日韩免费av在线播放| 日韩免费av在线播放| 97热精品久久久久久| 婷婷亚洲欧美| 天美传媒精品一区二区| 欧美精品啪啪一区二区三区| 亚洲精华国产精华精| 国产精品亚洲一级av第二区| 亚洲黑人精品在线| 国产伦在线观看视频一区| 亚洲狠狠婷婷综合久久图片| 国产一区二区亚洲精品在线观看| 国产v大片淫在线免费观看| 亚洲真实伦在线观看| 亚洲人与动物交配视频| 精品人妻偷拍中文字幕| 欧美日韩福利视频一区二区| 伦理电影大哥的女人| 欧美日韩综合久久久久久 | 男女那种视频在线观看| 高清日韩中文字幕在线| 亚洲精品乱码久久久v下载方式| 亚洲成人中文字幕在线播放| 亚洲成a人片在线一区二区| av中文乱码字幕在线| 亚洲电影在线观看av| 天美传媒精品一区二区| 国产亚洲精品av在线| 国产免费av片在线观看野外av| 国产真实乱freesex| 精品一区二区三区人妻视频| 亚洲av免费高清在线观看| 国产视频一区二区在线看| 欧美xxxx黑人xx丫x性爽| 日韩欧美在线乱码| 少妇的逼好多水| 国内精品久久久久精免费| 色吧在线观看| 99热这里只有精品一区| 人人妻人人澡欧美一区二区| 欧美日韩福利视频一区二区| 久久天躁狠狠躁夜夜2o2o| 亚洲av五月六月丁香网| 日本a在线网址| 亚洲最大成人中文| 制服丝袜大香蕉在线| 亚洲国产日韩欧美精品在线观看| 床上黄色一级片| 天堂av国产一区二区熟女人妻| 国产精品三级大全| 可以在线观看毛片的网站| АⅤ资源中文在线天堂| 国产色婷婷99| 一二三四社区在线视频社区8| 男女那种视频在线观看|