• <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)用
    九九爱精品视频在线观看| 日韩国内少妇激情av| 久久精品国产鲁丝片午夜精品| av.在线天堂| 日韩一区二区视频免费看| 熟妇人妻久久中文字幕3abv| 国产亚洲5aaaaa淫片| 国产成年人精品一区二区| 日日摸夜夜添夜夜爱| 久久精品久久久久久久性| 亚洲天堂国产精品一区在线| 插逼视频在线观看| 男女做爰动态图高潮gif福利片| 久久精品国产清高在天天线| 一边摸一边抽搐一进一小说| 蜜桃久久精品国产亚洲av| 不卡视频在线观看欧美| 大型黄色视频在线免费观看| 在线观看一区二区三区| 精品久久久久久久末码| 观看免费一级毛片| 人妻夜夜爽99麻豆av| 丰满人妻一区二区三区视频av| 国产成人a∨麻豆精品| 精品日产1卡2卡| 麻豆成人av视频| 亚洲精品久久久久久婷婷小说 | 亚洲av免费在线观看| 成人无遮挡网站| 欧洲精品卡2卡3卡4卡5卡区| 人体艺术视频欧美日本| 99久久中文字幕三级久久日本| 中国美女看黄片| 如何舔出高潮| 岛国毛片在线播放| 美女国产视频在线观看| 一本一本综合久久| 免费一级毛片在线播放高清视频| av在线蜜桃| 日韩三级伦理在线观看| 久99久视频精品免费| 日韩视频在线欧美| 天天躁夜夜躁狠狠久久av| 床上黄色一级片| 亚洲国产色片| 国产亚洲精品av在线| 2022亚洲国产成人精品| 听说在线观看完整版免费高清| 国产美女午夜福利| 日韩视频在线欧美| ponron亚洲| 国产成人福利小说| 亚洲成a人片在线一区二区| 亚洲国产日韩欧美精品在线观看| 久久欧美精品欧美久久欧美| 精品免费久久久久久久清纯| 高清毛片免费看| 久久久久久久久久久免费av| 日韩欧美三级三区| 国产亚洲av嫩草精品影院| 久久草成人影院| 可以在线观看毛片的网站| 人妻夜夜爽99麻豆av| 天堂√8在线中文| 麻豆国产av国片精品| 国产日韩欧美在线精品| 亚洲av中文av极速乱| 听说在线观看完整版免费高清| 亚洲成a人片在线一区二区| av在线亚洲专区| 日韩欧美 国产精品| 国产精品一区二区三区四区久久| 日韩 亚洲 欧美在线| av专区在线播放| 久久久久久九九精品二区国产| 有码 亚洲区| 日韩 亚洲 欧美在线| 国产伦精品一区二区三区四那| 边亲边吃奶的免费视频| 天堂√8在线中文| 乱系列少妇在线播放| 美女被艹到高潮喷水动态| 国产极品精品免费视频能看的| 黑人高潮一二区| 在现免费观看毛片| 久久久久久久久中文| 久久欧美精品欧美久久欧美| 69av精品久久久久久| 亚洲人成网站在线播| h日本视频在线播放| 菩萨蛮人人尽说江南好唐韦庄 | 狂野欧美白嫩少妇大欣赏| 小蜜桃在线观看免费完整版高清| 亚洲国产精品sss在线观看| 亚洲av第一区精品v没综合| 老司机福利观看| 不卡视频在线观看欧美| 丰满人妻一区二区三区视频av| 一本一本综合久久| 国产成人一区二区在线| 久久久久久伊人网av| 免费观看的影片在线观看| 久久久精品大字幕| 国产三级在线视频| 精品久久久久久久末码| 99久久精品一区二区三区| 久久精品人妻少妇| 亚洲七黄色美女视频| 欧洲精品卡2卡3卡4卡5卡区| ponron亚洲| 国产精品精品国产色婷婷| 国产69精品久久久久777片| 天天一区二区日本电影三级| 99热只有精品国产| 麻豆乱淫一区二区| 亚洲国产精品合色在线| 97超视频在线观看视频| 99热全是精品| 夫妻性生交免费视频一级片| 国产黄a三级三级三级人| 三级毛片av免费| 午夜视频国产福利| 五月伊人婷婷丁香| 久久久色成人| 国产精品不卡视频一区二区| 久久久成人免费电影| 国产精品久久久久久av不卡| 99热这里只有是精品在线观看| 99热这里只有是精品50| 成人永久免费在线观看视频| 成人午夜精彩视频在线观看| 寂寞人妻少妇视频99o| 亚洲乱码一区二区免费版| 欧美性感艳星| 久久精品夜色国产| 国产成人精品一,二区 | 好男人视频免费观看在线| 亚洲欧美中文字幕日韩二区| 免费观看精品视频网站| 国内精品美女久久久久久| 中文精品一卡2卡3卡4更新| 亚洲av一区综合| 麻豆精品久久久久久蜜桃| 亚洲三级黄色毛片| 色5月婷婷丁香| 在线a可以看的网站| 一本—道久久a久久精品蜜桃钙片 精品乱码久久久久久99久播 | 国语自产精品视频在线第100页| 国产精品,欧美在线| 久99久视频精品免费| 麻豆成人av视频| 99久久精品热视频| 午夜激情福利司机影院| 国产老妇女一区| 少妇的逼好多水| 青春草国产在线视频 | av在线天堂中文字幕| 一卡2卡三卡四卡精品乱码亚洲| 女同久久另类99精品国产91| av在线天堂中文字幕| 蜜桃久久精品国产亚洲av| 国产成人精品久久久久久| 久久精品综合一区二区三区| 亚洲图色成人| 午夜福利在线在线| 久久久久九九精品影院| 欧美人与善性xxx| 搡女人真爽免费视频火全软件| 午夜福利视频1000在线观看| 国产免费男女视频| 国产黄a三级三级三级人| 成人鲁丝片一二三区免费| 欧美日韩综合久久久久久| 久久精品影院6| 亚洲一区高清亚洲精品| 亚洲中文字幕一区二区三区有码在线看| a级毛片a级免费在线| 老司机福利观看| 亚洲欧美精品自产自拍| 成人午夜高清在线视频| 成人综合一区亚洲| avwww免费| 国产淫片久久久久久久久| 麻豆成人av视频| 久久久久久久久大av| 狂野欧美白嫩少妇大欣赏| 少妇高潮的动态图| 国产一区二区在线av高清观看| 如何舔出高潮| 日韩精品青青久久久久久| 亚洲国产精品成人综合色| 亚洲人成网站高清观看| 婷婷色综合大香蕉| 最近的中文字幕免费完整| 久久久久国产网址| 91久久精品国产一区二区三区| 老女人水多毛片| 国产精品乱码一区二三区的特点| 亚洲精品粉嫩美女一区| 尤物成人国产欧美一区二区三区| 亚洲真实伦在线观看| 亚洲精品影视一区二区三区av| 成人欧美大片| 久久久成人免费电影| 一进一出抽搐动态| 亚洲电影在线观看av| 黄色视频,在线免费观看| 九九爱精品视频在线观看| 天天躁夜夜躁狠狠久久av| 一个人观看的视频www高清免费观看| 免费观看精品视频网站| 久久久久久久久大av| 久久久久性生活片| 九九在线视频观看精品| 91在线精品国自产拍蜜月| 午夜精品一区二区三区免费看| 国产一区二区三区av在线 | av在线观看视频网站免费| 在线观看午夜福利视频| 国产成人freesex在线| 国产成年人精品一区二区| 国产单亲对白刺激| 亚洲精品自拍成人| 久久久色成人| 在线观看免费视频日本深夜| 一区二区三区四区激情视频 | 校园人妻丝袜中文字幕| 成人午夜精彩视频在线观看| 国产一区亚洲一区在线观看| 亚洲美女搞黄在线观看| 国产真实伦视频高清在线观看| 国产精华一区二区三区| 波野结衣二区三区在线| 天美传媒精品一区二区| 久久久欧美国产精品| 日日撸夜夜添| 蜜桃久久精品国产亚洲av| 亚洲精品乱码久久久久久按摩| 国产精品久久视频播放| 日韩,欧美,国产一区二区三区 | 能在线免费观看的黄片| 久久精品91蜜桃| 一夜夜www| 欧美最黄视频在线播放免费| 高清日韩中文字幕在线| 精品久久久久久成人av| 美女大奶头视频| 免费观看的影片在线观看| 伊人久久精品亚洲午夜| 舔av片在线| 丝袜喷水一区| 国产蜜桃级精品一区二区三区| 99热这里只有是精品在线观看| 天堂中文最新版在线下载 | 久久亚洲国产成人精品v| 黑人高潮一二区| 一卡2卡三卡四卡精品乱码亚洲| 亚洲激情五月婷婷啪啪| 99在线视频只有这里精品首页| 网址你懂的国产日韩在线| 中国国产av一级| 丝袜喷水一区| 欧美bdsm另类| a级毛色黄片| 我的老师免费观看完整版| 女人十人毛片免费观看3o分钟| 美女被艹到高潮喷水动态| 国产精品一及| 国产精品永久免费网站| 男人舔女人下体高潮全视频| 成人二区视频| 亚洲真实伦在线观看| 麻豆国产av国片精品| 国产精品1区2区在线观看.| 青春草亚洲视频在线观看| av在线老鸭窝| av免费在线看不卡| 国产精品永久免费网站| 搡女人真爽免费视频火全软件| 美女高潮的动态| 日韩欧美 国产精品| 能在线免费看毛片的网站| 亚洲最大成人中文| 偷拍熟女少妇极品色| 国产伦精品一区二区三区四那| 丰满人妻一区二区三区视频av| 国产91av在线免费观看| 97人妻精品一区二区三区麻豆| 日韩 亚洲 欧美在线| 亚洲第一区二区三区不卡| 天天躁日日操中文字幕| 岛国毛片在线播放| 超碰av人人做人人爽久久| 欧美潮喷喷水| 中文精品一卡2卡3卡4更新| 99久久成人亚洲精品观看| 亚洲成人中文字幕在线播放| 婷婷色av中文字幕| 深夜a级毛片| 精品无人区乱码1区二区| 在线天堂最新版资源| 色播亚洲综合网| 尾随美女入室| 黄色视频,在线免费观看| 国产精品野战在线观看| 99热只有精品国产| 日本一本二区三区精品| 色吧在线观看| 真实男女啪啪啪动态图| 美女黄网站色视频| 一本精品99久久精品77| 亚洲综合色惰| 国产综合懂色| 高清日韩中文字幕在线| 观看免费一级毛片| 亚洲精品色激情综合| 精品人妻一区二区三区麻豆| 日韩制服骚丝袜av| 高清在线视频一区二区三区 | 国产av不卡久久| 中文字幕人妻熟人妻熟丝袜美| 欧美bdsm另类| 内地一区二区视频在线| 婷婷六月久久综合丁香| 亚洲av不卡在线观看| 久久久午夜欧美精品| 久99久视频精品免费| 三级国产精品欧美在线观看| 国产淫片久久久久久久久| 亚洲第一区二区三区不卡| 日韩欧美精品免费久久| 在线观看免费视频日本深夜| 高清毛片免费观看视频网站| 九九在线视频观看精品| 久久国内精品自在自线图片| 亚洲国产高清在线一区二区三| 好男人视频免费观看在线| 看免费成人av毛片| 99国产精品一区二区蜜桃av| 国产精品国产高清国产av| 最近中文字幕高清免费大全6| 伦精品一区二区三区| 日韩强制内射视频| 亚洲欧美成人精品一区二区| 超碰av人人做人人爽久久| 中文资源天堂在线| 日韩成人av中文字幕在线观看| 国产亚洲精品av在线| or卡值多少钱| 麻豆一二三区av精品| 九色成人免费人妻av| 黄色欧美视频在线观看| 亚洲精品粉嫩美女一区| 18+在线观看网站| 淫秽高清视频在线观看| 中文资源天堂在线| 精品免费久久久久久久清纯| 少妇高潮的动态图| 18禁在线无遮挡免费观看视频| 白带黄色成豆腐渣| 亚洲婷婷狠狠爱综合网| 国产亚洲精品久久久久久毛片| 六月丁香七月| av福利片在线观看| 18禁裸乳无遮挡免费网站照片| 欧美最新免费一区二区三区| 在现免费观看毛片| 身体一侧抽搐| 国产精品美女特级片免费视频播放器| 男人舔奶头视频| 午夜激情福利司机影院| 国产午夜精品久久久久久一区二区三区| 久久99热6这里只有精品| 久久99精品国语久久久| 中出人妻视频一区二区| 亚洲欧美成人综合另类久久久 | 网址你懂的国产日韩在线| 99久久无色码亚洲精品果冻| 小说图片视频综合网站| 一本一本综合久久| 久久精品人妻少妇| 精品无人区乱码1区二区| 日产精品乱码卡一卡2卡三| 久久精品夜色国产| 国产真实伦视频高清在线观看| 久久精品国产99精品国产亚洲性色| 国产一区二区三区av在线 | 国产成年人精品一区二区| 久久久精品大字幕| 久久久精品94久久精品| 91狼人影院| 日本免费a在线| 不卡视频在线观看欧美| 性插视频无遮挡在线免费观看| 三级男女做爰猛烈吃奶摸视频| 毛片一级片免费看久久久久| 国产老妇女一区| 99久久精品国产国产毛片| 人妻夜夜爽99麻豆av| 人妻少妇偷人精品九色| 国产av在哪里看| 性欧美人与动物交配| 自拍偷自拍亚洲精品老妇| 久久精品久久久久久久性| 哪个播放器可以免费观看大片| 欧美另类亚洲清纯唯美| 亚洲欧洲国产日韩| 国产又黄又爽又无遮挡在线| 美女黄网站色视频| a级一级毛片免费在线观看| 国产成人精品婷婷| 少妇的逼水好多| 深爱激情五月婷婷| 欧美激情久久久久久爽电影| 99riav亚洲国产免费| 国产成人精品久久久久久| 国产精品美女特级片免费视频播放器| 久久人人精品亚洲av| 亚洲欧美精品综合久久99| 少妇丰满av| 亚洲国产精品国产精品| 国产高清视频在线观看网站| 成人午夜精彩视频在线观看| 国产黄色小视频在线观看| 黄色一级大片看看| 亚洲精品国产av成人精品| 两个人的视频大全免费| 韩国av在线不卡| 哪个播放器可以免费观看大片| 蜜桃久久精品国产亚洲av| 久久中文看片网| 99精品在免费线老司机午夜| 国产精品精品国产色婷婷| 天天一区二区日本电影三级| 日韩高清综合在线| 欧美精品一区二区大全| 三级毛片av免费| 亚洲国产精品sss在线观看| 欧洲精品卡2卡3卡4卡5卡区| 亚洲国产欧美在线一区| 国产成人午夜福利电影在线观看| 嫩草影院新地址| 三级经典国产精品| 在现免费观看毛片| 2021天堂中文幕一二区在线观| 嘟嘟电影网在线观看| 久久99热这里只有精品18| 亚洲av成人精品一区久久| 久久精品综合一区二区三区| 欧美+日韩+精品| 99国产精品一区二区蜜桃av| 欧美三级亚洲精品| 男人和女人高潮做爰伦理| 国产女主播在线喷水免费视频网站 | 中文字幕av成人在线电影| 成年免费大片在线观看| 日韩欧美一区二区三区在线观看| 成人一区二区视频在线观看| 免费观看人在逋| 婷婷精品国产亚洲av| 久久九九热精品免费| 国产爱豆传媒在线观看| 男人狂女人下面高潮的视频| av免费在线看不卡| 中文字幕av在线有码专区| 91在线精品国自产拍蜜月| 99视频精品全部免费 在线| 国产老妇伦熟女老妇高清| 日产精品乱码卡一卡2卡三| 中文字幕免费在线视频6| 久久中文看片网| 午夜视频国产福利| 欧美在线一区亚洲| 国产成人精品久久久久久| 免费在线观看成人毛片| 日韩精品有码人妻一区| 大又大粗又爽又黄少妇毛片口| 舔av片在线| 看十八女毛片水多多多| 亚洲国产色片| 精华霜和精华液先用哪个| 国产又黄又爽又无遮挡在线| 中文字幕熟女人妻在线| 国产精品1区2区在线观看.| 麻豆成人午夜福利视频| 国产 一区精品| 在线播放国产精品三级| 成年女人永久免费观看视频| 国内精品一区二区在线观看| 久久久色成人| 少妇人妻一区二区三区视频| 一本精品99久久精品77| 国产一区二区三区在线臀色熟女| 一个人看的www免费观看视频| 在现免费观看毛片| 久久国产乱子免费精品| 国产高清三级在线| 一级毛片久久久久久久久女| 熟女电影av网| 少妇熟女欧美另类| 久久99热这里只有精品18| 国产激情偷乱视频一区二区| 91在线精品国自产拍蜜月| 亚洲第一区二区三区不卡| 亚洲成a人片在线一区二区| 色综合亚洲欧美另类图片| 国产在线男女| 美女内射精品一级片tv| 国产乱人视频| 高清毛片免费看| 色哟哟·www| 国产毛片a区久久久久| 久久久久网色| 婷婷色综合大香蕉| 国产探花在线观看一区二区| 69人妻影院| 身体一侧抽搐| 精品日产1卡2卡| 又粗又硬又长又爽又黄的视频 | 欧美性猛交黑人性爽| 国产精品.久久久| 国产片特级美女逼逼视频| 97人妻精品一区二区三区麻豆| 又黄又爽又刺激的免费视频.| 国产精品精品国产色婷婷| 九九在线视频观看精品| 色视频www国产| 我的女老师完整版在线观看| 色5月婷婷丁香| 最近手机中文字幕大全| 91aial.com中文字幕在线观看| 国产大屁股一区二区在线视频| 青春草亚洲视频在线观看| 九九在线视频观看精品| 久久精品久久久久久久性| 亚洲一级一片aⅴ在线观看| 中文资源天堂在线| 久久国内精品自在自线图片| 成人三级黄色视频| 国产色婷婷99| 成人午夜高清在线视频| 边亲边吃奶的免费视频| 午夜精品国产一区二区电影 | 观看免费一级毛片| 综合色丁香网| 永久网站在线| 嘟嘟电影网在线观看| 久久人人爽人人爽人人片va| 欧美激情久久久久久爽电影| 一进一出抽搐动态| 国产精品久久久久久精品电影| 看黄色毛片网站| 美女内射精品一级片tv| 只有这里有精品99| 国产大屁股一区二区在线视频| 欧美一区二区亚洲| 日本黄大片高清| 成熟少妇高潮喷水视频| 色哟哟·www| av福利片在线观看| 色视频www国产| 亚洲熟妇中文字幕五十中出| 99久久九九国产精品国产免费| 熟女人妻精品中文字幕| 色综合亚洲欧美另类图片| 久久久久免费精品人妻一区二区| 久久九九热精品免费| eeuss影院久久| 可以在线观看毛片的网站| 亚洲高清免费不卡视频| 国产三级在线视频| 国产色婷婷99| 一个人观看的视频www高清免费观看| 亚洲精品自拍成人| 久久人妻av系列| 日本爱情动作片www.在线观看| 一进一出抽搐gif免费好疼| 欧洲精品卡2卡3卡4卡5卡区| 听说在线观看完整版免费高清| av女优亚洲男人天堂| 亚洲欧美成人综合另类久久久 | 国产真实伦视频高清在线观看| 中文字幕久久专区| 亚洲国产精品成人综合色| 国产精品久久久久久亚洲av鲁大| 久久久a久久爽久久v久久| 国产高清有码在线观看视频| 天天躁夜夜躁狠狠久久av| 国产在视频线在精品| 国产一区二区三区在线臀色熟女| 国产午夜福利久久久久久| 中文字幕免费在线视频6| 久久久精品欧美日韩精品| 日本黄色视频三级网站网址| 老司机福利观看| 亚洲最大成人av| 久久精品91蜜桃| 中文字幕免费在线视频6| 舔av片在线| 三级国产精品欧美在线观看| 久久精品国产亚洲av天美| 美女xxoo啪啪120秒动态图| 两个人的视频大全免费| 精品久久久久久久久久久久久| 一个人免费在线观看电影| 日韩人妻高清精品专区| 真实男女啪啪啪动态图| 日日摸夜夜添夜夜爱| 国产亚洲5aaaaa淫片| 大又大粗又爽又黄少妇毛片口| 一区二区三区免费毛片| 日本色播在线视频| 国产在线男女| 亚洲四区av| 九九久久精品国产亚洲av麻豆|