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

    改進(jìn)ARA*算法的移動機(jī)器人路徑規(guī)劃

    2022-12-22 11:47:48黃夢濤李智偉
    計算機(jī)工程與應(yīng)用 2022年24期
    關(guān)鍵詞:柵格列表障礙物

    黃夢濤,李智偉

    西安科技大學(xué) 電氣與控制工程學(xué)院,西安 710600

    路徑規(guī)劃是實現(xiàn)移動機(jī)器人自動導(dǎo)航的一個關(guān)鍵環(huán)節(jié)。路徑規(guī)劃是按照給定的地圖和目標(biāo)位置,規(guī)劃出一條使機(jī)器人抵達(dá)目標(biāo)位置的路徑,它通過統(tǒng)籌全局信息,制定高效、安全的移動策略[1]。

    路徑規(guī)劃可以按照規(guī)劃范圍劃分為全局、局部路徑規(guī)劃,環(huán)境信息完全已知時,才能實現(xiàn)全局路徑規(guī)劃[2]。全局路徑規(guī)劃算法可以分為傳統(tǒng)方法和仿生智能方法,傳統(tǒng)方法中最典型的有A*算法、快速擴(kuò)展隨機(jī)樹(rapidexploration random tree,RRT)算法等;仿生智能方法有遺傳算法(genetic algorithm,GA)、蟻群算法(ant colony algorithm,ACA)、粒子群算法(particle swarm algorithm,PSO)等[3]。

    傳統(tǒng)方法中,A*算法因為能在較短時間里有效地求解出最短路徑,被廣泛應(yīng)用于各個領(lǐng)域,然而,A*算法的啟發(fā)式函數(shù)構(gòu)造簡單,算法在執(zhí)行過程中會出現(xiàn)較多冗余節(jié)點,耗費時間較長[4-5]。RRT算法普適性強(qiáng),不僅可以工作在二維地圖,也適用于高維空間,因此更多地應(yīng)用于機(jī)械臂的路徑規(guī)劃,但是RRT算法得到的路徑質(zhì)量不高,折轉(zhuǎn)次數(shù)多,解的最優(yōu)性較差,工程應(yīng)用時往往使用的是與勢場法結(jié)合后的改進(jìn)RRT算法。

    仿生智能方法中,遺傳算法從多個初始點開始操作,而不是從某一個單獨點開始,很大程度上避免了搜索過程中過早收斂于局部極值,因此更有可能求得全局極值,但同時也使得計算速度較慢全局路徑搜索的效率相對較低,算法迭代進(jìn)化時會產(chǎn)生一些沒有意義的種群,不適合實時路徑規(guī)劃。蟻群算法采用正反饋機(jī)制,使搜索過程不斷收斂,而且蟻群算法具有分布式計算能力,可以在全局多點同時搜索最優(yōu)路徑,因此計算效率較高,但是由于蟻群算法初期信息素的缺乏,容易陷入局部最優(yōu),雖然蟻群算法初期收斂速度快,但在后續(xù)容易發(fā)生路徑迂回和死鎖[6]。粒子群算法的收斂速度快,需要設(shè)置的參數(shù)較少,簡單易行,但也容易陷入局部最優(yōu)。

    1 文獻(xiàn)綜述

    針對上述幾種路徑規(guī)劃算法的缺陷,當(dāng)前有眾多科研工作者提出了改進(jìn)方法。文獻(xiàn)[7]提出了一種改進(jìn)的A*算法,通過引入環(huán)境障礙物比率K,量化了環(huán)境中的障礙物信息,根據(jù)K值調(diào)節(jié)啟發(fā)函數(shù)的權(quán)重,提高了算法效率和靈活性,另外,基于Floyd算法思想設(shè)計了一種路徑節(jié)點優(yōu)化算法,剔除了冗余節(jié)點,提高了路徑平滑度,但是隨著啟發(fā)函數(shù)的權(quán)重變化,路徑的最優(yōu)性會受到影響,K值越大,搜索速度越快,路徑的最優(yōu)性就越差,所以應(yīng)該加入約束條件來限制K值的增長;文獻(xiàn)[8]針對傳統(tǒng)RRT算法內(nèi)存消耗大的問題提出了一種基于簡化地圖的區(qū)域采樣RRT*(simplified map-based regional sampling RRT*,SMRS-RRT*)算法,首先簡化柵格地圖,再用PRM算法尋找最優(yōu)路徑作為引導(dǎo)路徑,通過智能采樣因子擴(kuò)大引導(dǎo)路徑得到智能采樣區(qū)域,在其中迭代搜索找到一條代價小且無碰撞的路徑,最后結(jié)合最小轉(zhuǎn)彎半徑約束和B樣條曲線優(yōu)化路徑,但是這種簡化地圖的方法比較簡單,僅通過障礙物占用的柵格數(shù)量與設(shè)定的閾值比較,剔除占用柵格少的一部分障礙物,因此無法保證最終生成路徑的安全性;文獻(xiàn)[9]針對遺傳算法在初始化種群時計算方法的不足,提出利用SPS(surrounding point set)算法在障礙物周圍生成點來產(chǎn)生初始路徑,提高算法快速生成初始種群的能力,增加平滑、刪除算子,刪除不必要的路徑節(jié)點,使路徑更平滑,最后結(jié)合小生境法保持種群多樣性,避免出現(xiàn)早熟現(xiàn)象,但是刪除算子只能作用于路徑節(jié)點初次與障礙物連接的地方,每處障礙物至多刪除一個多余節(jié)點,因此對路徑的收斂速度和平滑性提升不大;文獻(xiàn)[10]提出了一種改進(jìn)的蟻群算法,將螞蟻搜索方向擴(kuò)展為16方向24鄰域,結(jié)合向量夾角的思想設(shè)計出新的啟發(fā)信息計算方法,引入轉(zhuǎn)移概率控制參數(shù)δ調(diào)控算法搜索范圍,提高了路徑尋優(yōu)效果和搜索效率,雖然文中說明了δ=0時算法類似于貪心算法,δ=1時算法采用輪盤賭策略,但是沒有說明δ的具體取值方法,而且蟻群算法容易陷入局部最優(yōu)的問題沒有解決;文獻(xiàn)[11]提出了一種任意時刻啟發(fā)式搜索ARA*算法,它首先在一個較短時間內(nèi)找到一條非最優(yōu)可行路徑,然后在接下來的時間中盡可能地優(yōu)化,如果時間足夠多的話,可以找到一條最優(yōu)的可行路徑,ARA*算法會重復(fù)使用之前的搜索結(jié)果,這使得它比其他的任意時間規(guī)劃算法更加高效,但是算法效率提升不明顯[11]。

    現(xiàn)階段針對路徑規(guī)劃算法的改進(jìn)集中于執(zhí)行效率和路徑的平滑程度這兩方面,也就是說,在路徑規(guī)劃算法應(yīng)用于實際工程之前,需要著力于提升算法的實時性和安全性。因此,本文在ARA*算法的基礎(chǔ)上做出了改良,使路徑規(guī)劃的效率提升更顯著,另外還提出了一種自適應(yīng)選擇節(jié)點間連接方式的策略,兼顧了4連接和8連接的優(yōu)點,降低了安全風(fēng)險的同時,縮短了路徑長度。

    2 ARA*路徑規(guī)劃算法介紹及分析

    ARA*(anytime repairing A*)算法是A*算法的一種改進(jìn)算法:是在WA*(weighted A*)算法[12]基礎(chǔ)上做了進(jìn)一步改動,著重于解決實際的工程問題,優(yōu)先考慮算法的執(zhí)行速度,并且算法的可移植性也得到了明顯的改善,本章對ARA*算法做簡要介紹。

    ARA*算法在代價估計函數(shù)f(s)中加入膨脹因子ε。

    其中,s表示當(dāng)前節(jié)點,g(s)是從起點到當(dāng)前節(jié)點的實際代價,h(s)是從當(dāng)前節(jié)點到終點的代價估計值,f(s)則是從起點到終點的代價。算法運行時,膨脹因子ε從設(shè)定初值開始逐漸減小,在時間允許的范圍內(nèi)εmin=1,如果時間不夠充足ε會盡可能地接近1,那么最后只能求得路徑的次優(yōu)解,也就是說路徑的次優(yōu)性由ε決定,且路徑的長度不大于最優(yōu)路徑的ε倍[13]。

    圖1是A*算法得到的路徑,圖2是在同樣的柵格地圖中ε值不同時ARA*算法規(guī)劃出的路徑。通過對比圖1和圖2(c)得出結(jié)論,ε=1時路徑長度最短,而且此時ARA*算法等價于A*算法,路徑是最優(yōu)的。

    圖1 A*算法得到的路徑Fig.1 Path obtained by A*algorithm

    圖2 ε值不同時ARA*算法得到的路徑Fig.2 Path obtained by ARA*algorithm with different ε

    ARA*算法用三種列表存放不同狀態(tài)的節(jié)點:

    (1)OPEN列表:存儲具有局部不一致狀態(tài)的節(jié)點。

    (2)CLOSED列表:存儲已經(jīng)擴(kuò)展過的節(jié)點。

    (3)INCONS列表:當(dāng)存儲在CLOSED列表的節(jié)點g(s)值又降低時放入該列表中。

    ARA*算法的局部不一致狀態(tài)[14]:如果一個節(jié)點的g(s)值在它下一次被擴(kuò)展之前降低,就認(rèn)為該節(jié)點處于局部不一致狀態(tài),針對任意節(jié)點s',假設(shè)節(jié)點s是它的最優(yōu)前繼節(jié)點,則它們應(yīng)滿足公式(2):

    公式(2)中c(s,s')是從節(jié)點s到s'的代價,假如等式右側(cè)值減小,如公式(3)所示:

    g(s)值的降低意味著節(jié)點s的g(s)值和其后繼若干節(jié)點s'的g(s')值之間并不滿足公式(2)的等價關(guān)系,這就是當(dāng)前節(jié)點與它的前繼節(jié)點之間存在的局部不一致。

    在已經(jīng)構(gòu)建好柵格地圖中,ARA*算法會從起點Sstart開始擴(kuò)展,把與Sstart相鄰的8個子節(jié)點加入OPEN列表,再根據(jù)公式(1)規(guī)定的啟發(fā)式搜索規(guī)則從OPEN列表里搜索f(s)最小的節(jié)點作為下一個被擴(kuò)展的節(jié)點,然后對下一個被擴(kuò)展的節(jié)點執(zhí)行同樣的步驟,以此類推。隨著路徑的推進(jìn),有些節(jié)點的g(s)會降低,如果該節(jié)點已經(jīng)存儲在OPEN列表里,而且它是當(dāng)前被擴(kuò)展節(jié)點的子節(jié)點,則需要對它的g(s)重新計算。ARA*算法的執(zhí)行流程如圖3所示。

    圖3 ARA*主流程Fig.3 Mainstream of ARA*algorithm

    圖4表示主流程中節(jié)點的更新過程。首先,從OPEN列表中檢索f(s)值最小的節(jié)點s,把s從OPEN列表中移除,再將它存儲到CLOSED列表中,表示s已經(jīng)被擴(kuò)展過,如果s的子節(jié)點s'中某些節(jié)點的g(s')值比擴(kuò)展前更低,當(dāng)這些節(jié)點s'不在CLOSED列表里,則將它們存儲到OPEN列表;否則,將它們存儲到INCONS列表。

    圖4 ImprovePath()流程Fig.4 ImporvePath()process

    在ARA*算法的運行過程中,隨著路徑從起點到終點的推進(jìn),會不斷地在OPEN列表中搜索f(s)值最小的節(jié)點作為下一個被擴(kuò)展的節(jié)點,每向前推進(jìn)一個節(jié)點,就要從當(dāng)前被擴(kuò)展節(jié)點的周圍至多8個子節(jié)點中搜索f(s)最小值,因此,加快搜索f(s)最小值的速度,ARA*路徑規(guī)劃的效率就會提高。

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

    本文在ARA*算法中引入二叉排序樹存儲代價估計函數(shù)f(s)的計算結(jié)果,提高ARA*算法的執(zhí)行效率;通過制定自適應(yīng)節(jié)點選擇策略,降低機(jī)器人與障礙物碰撞風(fēng)險。

    3.1 在ARA*算法中引入二叉排序樹

    傳統(tǒng)ARA*算法的OPEN列表采用的是順序存儲結(jié)構(gòu),如圖5所示。順序存儲結(jié)構(gòu)的優(yōu)點是:邏輯上緊鄰的存儲單元在物理位置上也是緊鄰的,可以節(jié)省內(nèi)存空間,并且可以實現(xiàn)隨機(jī)存取[15]。但是,順序存儲結(jié)構(gòu)的插入或刪除運算不方便,除了結(jié)尾位置,在其余任何位置上實現(xiàn)插入或刪除都不得不移動大量的數(shù)據(jù)元素,效率較低。為了加快在OPEN列表中搜索f(s)最小值的速度,需要找到一種數(shù)據(jù)結(jié)構(gòu),它既可以有較高的插入和刪除效率,并且具備較高的查找效率。

    圖5 OPEN列表的改進(jìn)Fig.5 Improvement of OPEN list

    樹是一種應(yīng)用廣泛的非線性數(shù)據(jù)結(jié)構(gòu)。二叉樹是每個節(jié)點最多有兩個子樹的有序樹,它結(jié)合了數(shù)組和鏈表的優(yōu)點,插入、刪除和查找的速度很快[16]。二叉排序樹是二叉樹的一種特殊情況,如圖5所示。

    數(shù)據(jù)的最小值存放在整棵樹最后一層的最左端,搜索最小值時,只需要遍歷整棵樹的左子樹,也就是說遍歷全部節(jié)點的一半就能找到最小值。因此,二叉排序樹更適合存儲ARA*算法中的路徑節(jié)點數(shù)據(jù)。

    傳統(tǒng)ARA*算法在OPEN列表中查找最小值時,用需要查找的數(shù)據(jù)與線性表中各個數(shù)據(jù)元素逐個比較,直到成功或遍歷結(jié)束。假設(shè)OPEN列表數(shù)據(jù)長度為n,那么查找第i個數(shù)據(jù)元素時需要進(jìn)行n-i+1次比較,即Ci=n-i+1。又假設(shè)查找任意一個數(shù)據(jù)元素的概率都相同,即Pi=1/n,那么順序查找算法的平均查找長度表示為公式(4):

    假設(shè)一棵滿二叉排序樹的總節(jié)點數(shù)是n,高度是h,根節(jié)點的高度是1,n與h的關(guān)系滿足n=2h-1。那么對于高度為h,總節(jié)點數(shù)是n的滿二叉排序樹,查找成功時的平均查找長度為公式(5):

    將n=2h-1代入公式(5)計算得到公式(6):

    公式(4)和公式(6)的曲線如圖6所示,順序存儲結(jié)構(gòu)的平均查找長度隨著數(shù)據(jù)元素的個數(shù)呈線性增長,而二叉排序樹的平均查找長度按照對數(shù)函數(shù)的規(guī)律增長,其增長速率遠(yuǎn)遠(yuǎn)小于順序存儲結(jié)構(gòu)。因此,二叉排序樹更適合存儲ARA*算法的OPEN列表中的數(shù)據(jù)。

    圖6 平均查找長度Fig.6 Average search length

    3.2 自適應(yīng)節(jié)點連接方式選擇策略

    環(huán)境地圖一般有三種描述方式:柵格地圖、幾何地圖和拓?fù)涞貓D[17]。在柵格地圖中,為了將不同的柵格節(jié)點聯(lián)系起來,需要制定節(jié)點間的連接規(guī)則,有兩種典型的連接方式:4連接和8連接,8連接可能使移動機(jī)器人恰巧途經(jīng)障礙物柵格的頂點,這在實際情況中很危險,但如果只使用4連接,在沒有障礙的區(qū)域中,過多的折轉(zhuǎn)會增加路徑的距離。本文提出了一種自適應(yīng)的節(jié)點間連接方式選擇策略,在地圖中的不同區(qū)域采取更適用于當(dāng)前局部環(huán)境的連接方式。

    在啟發(fā)式函數(shù)中,為了計算當(dāng)前節(jié)點到目標(biāo)節(jié)點的距離,首先需要確定節(jié)點間的連接方式。本文提出的自適應(yīng)節(jié)點間連接方式選擇策略,兼顧了4連接和8連接的優(yōu)點,當(dāng)路徑經(jīng)過障礙物的相鄰節(jié)點發(fā)生折轉(zhuǎn)時,為了不穿過障礙物柵格的頂點,采用4連接;當(dāng)路徑的鄰域內(nèi)沒有障礙物時切換為8連接,因為沒有障礙物時8連接的路徑長度更短,折轉(zhuǎn)次數(shù)少,路徑更平滑。

    在改進(jìn)后的ARA*算法中,計算柵格地圖中任意兩個節(jié)點(ai,aj)和(bi,bj)的h(s)值時,忽略節(jié)點之間的障礙物,結(jié)合使用兩種距離估計的方法:曼哈頓距離和對角距離。曼哈頓距離的計算方法如公式(7)所示:

    對角距離的計算方法如公式(8)所示:

    4 仿真實現(xiàn)與結(jié)果分析

    本章設(shè)計了兩組仿真對比實驗,驗證改進(jìn)ARA*算法的快速性和有效性:

    實驗1對比傳統(tǒng)ARA*算法和改進(jìn)ARA*算法。

    實驗2對比蟻群算法、粒子群算法和改進(jìn)ARA*算法。

    為了探究地圖規(guī)模對算法結(jié)果的影響程度,對三種規(guī)模的柵格地圖進(jìn)行仿真:50 m×50 m、100 m×100 m和200 m×200 m。柵格地圖中的柵格節(jié)點有兩種形式:有障礙物柵格和無障礙物柵格,機(jī)器人經(jīng)過無障礙物柵格的代價權(quán)值為1,柵格地圖中的障礙物柵格隨機(jī)分布。實驗平臺參數(shù):Win10操作系統(tǒng);Intel i5-8300H CPU;16 GB DDR4,仿真程序用Python3.7和MATLAB2015b實現(xiàn)。

    4.1 傳統(tǒng)ARA*算法和改進(jìn)ARA*算法對比

    改進(jìn)前后的ARA*算法在50 m×50 m、100 m×100 m和200 m×200 m三種規(guī)模地圖上的仿真結(jié)果分別如圖7、圖8、圖9所示。

    圖7 50 m×50 m仿真結(jié)果Fig.7 50 m×50 m simulation results

    圖8 100 m×100 m仿真結(jié)果Fig.8 100 m×100 m simulation results

    圖9 200 m×200 m仿真結(jié)果Fig.9 200 m×200 m simulation results

    在圖7、圖8、圖9中(a)是改進(jìn)前4連接ARA*算法的結(jié)果,(b)是改進(jìn)前8連接ARA*算法的結(jié)果,(c)是改進(jìn)后的算法結(jié)果。比較(a)、(b)可以看出,傳統(tǒng)的4連接ARA*算法的轉(zhuǎn)折次數(shù)明顯多于8連接,路徑長度更長,但是4連接的路徑不會從障礙物柵格的頂點穿過,保持了機(jī)器人與障礙物之間的距離,因此比8連接更安全。(c)相比(a)和(b)折轉(zhuǎn)次數(shù)更少,而且在障礙物處折轉(zhuǎn)時避開了障礙物節(jié)點的頂點,兼顧了4連接和8連接的優(yōu)點,既降低了安全風(fēng)險,又不會明顯增加路徑長度。改進(jìn)前后ARA*算法的搜索時間、路徑長度和折轉(zhuǎn)次數(shù)如表1所示。

    表1 ARA*與改進(jìn)的ARA*仿真結(jié)果Table 1 Simulation results of ARA*and improved ARA*algorithm

    從表1中可以看出,在保證柵格地圖規(guī)模與障礙物設(shè)置完全相同的情況下,改進(jìn)的ARA*算法搜索時間相比于傳統(tǒng)的ARA*算法有了明顯的縮短;路徑長度介于4連接和8連接之間,但明顯小于4連接的路徑長度;折轉(zhuǎn)次數(shù)與8連接相近,遠(yuǎn)遠(yuǎn)小于4連接。

    根據(jù)表2,ARA*算法改進(jìn)前后的數(shù)據(jù)對比結(jié)果可知,改進(jìn)的ARA*算法對地圖規(guī)模不敏感,搜索時間相比改進(jìn)前平均縮短了43.62%;路徑長度相比4連接平均縮短了18%,與8連接的路徑長度相近;折轉(zhuǎn)次數(shù)相比4連接平均減少了75.2%,相比8連接平均增加了25.4%,對路徑平滑性影響不大。結(jié)合以上分析得出結(jié)論,改進(jìn)的ARA*算法大幅縮短了搜索時間,并且算法規(guī)劃出的路徑更安全可靠。

    表2 改進(jìn)前后結(jié)果對比Table 2 Comparison of results before and after improvement

    改進(jìn)ARA*算法用來存放具有局部不一致狀態(tài)節(jié)點的OPEN列表,從傳統(tǒng)的順序存儲結(jié)構(gòu)改為二叉排序樹存儲,加快了路徑節(jié)點更新時從OPEN列表中搜索f(s)最小值的速度。為了證明上述理論的正確性,在50 m×50 m的柵格地圖中,記錄隨著路徑節(jié)點數(shù)量累積單次搜索f(s)最小值的時間,結(jié)果如圖10所示。

    圖10 單次搜索時間Fig.10 Single search time

    對比圖6和圖10,因為平均查找長度與單次搜索時間呈正相關(guān),所以單次搜索時間與平均查找長度變化規(guī)律相似,增長率數(shù)據(jù)如表3所示。

    表3 單次搜索時間增長率Table 3 Single search time growth rate

    由表3可知,改進(jìn)后時間增長率明顯小于改進(jìn)前,搜索OPEN列表中f(s)最小值的速度大幅提高,證實了用二叉排序樹代替順序存儲結(jié)構(gòu)可以提高算法執(zhí)行效率。效率提升的根本原因是,在數(shù)據(jù)個數(shù)相同的情況下,二叉排序樹搜索最值的平均查找長度小于順序存儲結(jié)構(gòu),比如根據(jù)圖6,有100個數(shù)據(jù)元素時,順序存儲結(jié)構(gòu)需要查詢50個數(shù)據(jù)元素,而二叉排序樹只需要查詢不到10個。

    隨著數(shù)據(jù)個數(shù)越來越多,改進(jìn)前平均查找長度呈線性增長,增長率不變,而改進(jìn)后的曲線呈對數(shù)規(guī)律增長,增長率越來越小,可見地圖規(guī)模越大,改進(jìn)ARA*算法執(zhí)行效率高的優(yōu)勢越明顯。

    4.2 蟻群、粒子群算法和改進(jìn)ARA*算法對比

    本節(jié)通過仿真實驗,對比改進(jìn)ARA*算法與蟻群算法、粒子群算法,進(jìn)一步驗證改進(jìn)ARA*算法的快速性和有效性。蟻群算法的參數(shù)設(shè)置如表4所示,粒子群算法的參數(shù)設(shè)置如表5所示,三種路徑規(guī)劃算法的仿真結(jié)果如圖11和表6所示。

    表4 蟻群算法參數(shù)設(shè)置Table 4 Parameter setting of ACA

    表5 粒子群算法參數(shù)設(shè)置Table 5 Parameter setting of PSO

    圖11 50 m×50 m地圖三種算法的路徑Fig.11 Path of 3 algorithms on 50 m×50 m map

    圖11和表6的仿真結(jié)果反映出,相比仿生智能算法,改進(jìn)ARA*算法執(zhí)行速度更快。改進(jìn)算法的路徑長度比粒子群算法多出11%,這是因為改進(jìn)的ARA*算法為了保證算法的快速性,啟發(fā)函數(shù)中的膨脹因子ε>1,因此沒有計算出路徑的最優(yōu)解,但是多出的路徑長度仍可以接受。對于傳統(tǒng)蟻群算法,它的啟發(fā)信息較弱,在路徑搜索時轉(zhuǎn)折點較多,有時出現(xiàn)回環(huán)交叉,遠(yuǎn)離目標(biāo)行走,導(dǎo)致路徑長度增加。粒子群算法的路徑最短,折轉(zhuǎn)次數(shù)僅有1次,路徑最平滑,因為粒子群算法是概率型的全局路徑規(guī)劃算法,在迭代的過程中充滿更多可能性,搜索路徑過程中能覆蓋全局地圖的機(jī)會更大,因此更能夠得到全局最優(yōu)解[18],但是算法運行時間過長,不適合解決實際工程問題。

    表6 三種算法的仿真結(jié)果Table 6 Simulation results of 3 algorithms

    5 結(jié)束語

    由于傳統(tǒng)的ARA*算法不能滿足移動機(jī)器人對實時性和安全性的要求,本文利用二叉排序樹代替順序存儲結(jié)構(gòu),降低了節(jié)點更新時每次從OPEN列表中搜索最值的時間,優(yōu)化了路徑規(guī)劃時數(shù)據(jù)查找的效率,搜索時間縮短了43%;另外,提出了自適應(yīng)的連接方式選擇方法,改善了了機(jī)器人移動的安全性。實驗結(jié)果證明,改進(jìn)的ARA*算法為移動機(jī)器人路徑規(guī)劃問題提供了一種可行的解決方案,一定程度上推動了路徑規(guī)劃算法的發(fā)展。

    猜你喜歡
    柵格列表障礙物
    巧用列表來推理
    基于鄰域柵格篩選的點云邊緣點提取方法*
    學(xué)習(xí)運用列表法
    擴(kuò)列吧
    高低翻越
    SelTrac?CBTC系統(tǒng)中非通信障礙物的設(shè)計和處理
    不同剖面形狀的柵格壁對柵格翼氣動特性的影響
    基于CVT排布的非周期柵格密度加權(quán)陣設(shè)計
    不含3-圈的1-平面圖的列表邊染色與列表全染色
    土釘墻在近障礙物的地下車行通道工程中的應(yīng)用
    麻豆成人av视频| 国产一区二区三区在线臀色熟女| 国产精品一区二区性色av| 国产高清不卡午夜福利| 免费av不卡在线播放| 搞女人的毛片| 成人特级黄色片久久久久久久| 插逼视频在线观看| 亚洲在线自拍视频| 国内精品久久久久精免费| 校园春色视频在线观看| 国产日本99.免费观看| 国产中年淑女户外野战色| 久久精品久久久久久久性| 午夜激情福利司机影院| 欧美激情国产日韩精品一区| 美女内射精品一级片tv| 亚洲精品日韩在线中文字幕 | 非洲黑人性xxxx精品又粗又长| 日韩欧美一区二区三区在线观看| 尾随美女入室| 一级毛片我不卡| eeuss影院久久| 精品久久久噜噜| 日本爱情动作片www.在线观看| 国产免费男女视频| 禁无遮挡网站| 精华霜和精华液先用哪个| 欧美+日韩+精品| 亚洲国产色片| 国产成人福利小说| 亚洲欧美精品自产自拍| 国产探花极品一区二区| 真实男女啪啪啪动态图| 成年av动漫网址| 亚洲在线观看片| 中文字幕久久专区| 成年免费大片在线观看| 久久久久网色| av视频在线观看入口| 岛国在线免费视频观看| 热99在线观看视频| 九九久久精品国产亚洲av麻豆| 免费av毛片视频| 日本与韩国留学比较| 午夜福利高清视频| 久久精品91蜜桃| 在线观看免费视频日本深夜| 麻豆成人av视频| 天堂网av新在线| 亚洲欧美精品综合久久99| 国产亚洲精品久久久com| 日韩成人av中文字幕在线观看| 成年女人永久免费观看视频| 美女黄网站色视频| 哪个播放器可以免费观看大片| 国产精品久久久久久久电影| 欧美人与善性xxx| 看片在线看免费视频| 亚洲不卡免费看| 成人鲁丝片一二三区免费| 最后的刺客免费高清国语| 少妇裸体淫交视频免费看高清| 免费不卡的大黄色大毛片视频在线观看 | 国产精品一区二区三区四区免费观看| 麻豆成人av视频| 高清毛片免费看| 色视频www国产| 中文在线观看免费www的网站| 国产精品人妻久久久久久| 精品久久久久久久人妻蜜臀av| 成年av动漫网址| 日本黄色片子视频| 男人和女人高潮做爰伦理| 亚洲av熟女| a级毛片a级免费在线| 99热只有精品国产| 五月伊人婷婷丁香| 男女啪啪激烈高潮av片| 91久久精品电影网| 少妇熟女aⅴ在线视频| 啦啦啦韩国在线观看视频| 日本三级黄在线观看| 国产精品一二三区在线看| 久久九九热精品免费| 听说在线观看完整版免费高清| 色综合亚洲欧美另类图片| 日产精品乱码卡一卡2卡三| 在线天堂最新版资源| 国语自产精品视频在线第100页| 天堂av国产一区二区熟女人妻| 高清在线视频一区二区三区 | 欧美日韩精品成人综合77777| ponron亚洲| .国产精品久久| 成人永久免费在线观看视频| 成人一区二区视频在线观看| 亚洲精品乱码久久久v下载方式| 超碰av人人做人人爽久久| 日韩成人av中文字幕在线观看| 精品久久国产蜜桃| 99久久中文字幕三级久久日本| 国产真实伦视频高清在线观看| 男女啪啪激烈高潮av片| 色哟哟哟哟哟哟| 欧美日韩综合久久久久久| 白带黄色成豆腐渣| 欧美日本视频| 99热这里只有是精品50| 尤物成人国产欧美一区二区三区| 99久国产av精品| 免费看日本二区| 啦啦啦啦在线视频资源| 美女 人体艺术 gogo| 最近中文字幕高清免费大全6| 黄色视频,在线免费观看| 成年女人永久免费观看视频| 又粗又硬又长又爽又黄的视频 | 久久6这里有精品| 免费看美女性在线毛片视频| 亚洲无线在线观看| 日韩强制内射视频| 亚洲国产欧美在线一区| 免费电影在线观看免费观看| 亚洲欧美成人综合另类久久久 | 国产高潮美女av| 你懂的网址亚洲精品在线观看 | 亚洲欧美成人精品一区二区| 国产午夜精品一二区理论片| 国产欧美日韩精品一区二区| 免费观看精品视频网站| 国产精品麻豆人妻色哟哟久久 | 国产亚洲5aaaaa淫片| 日日啪夜夜撸| 中文欧美无线码| 五月玫瑰六月丁香| 97热精品久久久久久| 哪里可以看免费的av片| 国产亚洲精品久久久com| 免费黄网站久久成人精品| 中文字幕av在线有码专区| 一个人看的www免费观看视频| 边亲边吃奶的免费视频| 18禁黄网站禁片免费观看直播| 99久久精品热视频| 丰满人妻一区二区三区视频av| 亚洲18禁久久av| 一边亲一边摸免费视频| 国产国拍精品亚洲av在线观看| 国产一区二区在线av高清观看| 麻豆国产97在线/欧美| 黄色配什么色好看| 亚洲国产日韩欧美精品在线观看| 高清午夜精品一区二区三区 | 毛片女人毛片| 人妻少妇偷人精品九色| 人妻少妇偷人精品九色| 国产精品一二三区在线看| 国产91av在线免费观看| 久久久欧美国产精品| 白带黄色成豆腐渣| 国内精品美女久久久久久| 2022亚洲国产成人精品| 亚洲欧美日韩无卡精品| 欧美日韩精品成人综合77777| 99久久精品热视频| 长腿黑丝高跟| 九九热线精品视视频播放| 亚洲最大成人av| 校园人妻丝袜中文字幕| 性插视频无遮挡在线免费观看| 免费观看人在逋| 一区二区三区免费毛片| 一本久久中文字幕| 亚洲欧美日韩高清专用| 免费看av在线观看网站| 日本在线视频免费播放| 老师上课跳d突然被开到最大视频| 精品国内亚洲2022精品成人| 美女被艹到高潮喷水动态| 国产亚洲精品av在线| 国产成人一区二区在线| 精品不卡国产一区二区三区| 2022亚洲国产成人精品| 免费大片18禁| 亚洲av第一区精品v没综合| 日日摸夜夜添夜夜爱| 欧美xxxx性猛交bbbb| 国产伦精品一区二区三区四那| 亚洲国产高清在线一区二区三| 婷婷六月久久综合丁香| 一个人免费在线观看电影| 性插视频无遮挡在线免费观看| 免费观看的影片在线观看| 亚洲欧美中文字幕日韩二区| 成人二区视频| 又爽又黄a免费视频| 国产av麻豆久久久久久久| 国产免费男女视频| 人人妻人人澡人人爽人人夜夜 | 美女大奶头视频| 久久久久久伊人网av| 淫秽高清视频在线观看| 国模一区二区三区四区视频| 精品人妻熟女av久视频| 成人亚洲精品av一区二区| 亚洲天堂国产精品一区在线| 亚洲人成网站在线观看播放| 一级黄色大片毛片| 日日啪夜夜撸| 亚洲熟妇中文字幕五十中出| 超碰av人人做人人爽久久| 春色校园在线视频观看| 国产精品一二三区在线看| 免费黄网站久久成人精品| 少妇的逼水好多| 国产老妇女一区| 亚洲美女视频黄频| 国国产精品蜜臀av免费| 69人妻影院| 麻豆国产av国片精品| 极品教师在线视频| 成人美女网站在线观看视频| 久久亚洲国产成人精品v| 欧美不卡视频在线免费观看| 边亲边吃奶的免费视频| 日韩中字成人| 男女边吃奶边做爰视频| 可以在线观看的亚洲视频| 国产色婷婷99| 99久久久亚洲精品蜜臀av| 亚洲无线在线观看| 嘟嘟电影网在线观看| 中文资源天堂在线| 日韩精品青青久久久久久| av免费观看日本| 日韩强制内射视频| 夜夜爽天天搞| 麻豆国产av国片精品| 男人狂女人下面高潮的视频| 日韩欧美国产在线观看| 亚洲欧美日韩东京热| 亚洲成人久久性| 欧美bdsm另类| 丰满乱子伦码专区| 亚洲最大成人手机在线| 免费看av在线观看网站| a级一级毛片免费在线观看| 国产伦一二天堂av在线观看| 中文亚洲av片在线观看爽| 只有这里有精品99| 爱豆传媒免费全集在线观看| 好男人在线观看高清免费视频| 成人二区视频| 联通29元200g的流量卡| 日韩国内少妇激情av| 亚洲电影在线观看av| 日韩欧美精品v在线| 又粗又硬又长又爽又黄的视频 | 99久国产av精品国产电影| 女人被狂操c到高潮| 国产极品天堂在线| 91午夜精品亚洲一区二区三区| av国产免费在线观看| АⅤ资源中文在线天堂| 日本爱情动作片www.在线观看| 夜夜爽天天搞| 国产精品麻豆人妻色哟哟久久 | 美女被艹到高潮喷水动态| 日日摸夜夜添夜夜添av毛片| 国产高清不卡午夜福利| 亚洲激情五月婷婷啪啪| 国产精品无大码| 变态另类丝袜制服| 夜夜爽天天搞| 99热全是精品| 最近最新中文字幕大全电影3| 久久久久久久久久成人| 国产午夜福利久久久久久| 国产真实伦视频高清在线观看| 国产私拍福利视频在线观看| 国产黄片视频在线免费观看| 麻豆国产av国片精品| 高清毛片免费看| 欧美+日韩+精品| av在线蜜桃| 久久精品久久久久久噜噜老黄 | 黄片无遮挡物在线观看| 亚洲成人久久性| 亚洲欧洲国产日韩| 亚洲精品国产成人久久av| 成人无遮挡网站| 麻豆av噜噜一区二区三区| 国产日韩欧美在线精品| 看免费成人av毛片| ponron亚洲| www.色视频.com| 最近中文字幕高清免费大全6| 国产真实乱freesex| 色5月婷婷丁香| 国产高清激情床上av| 在线观看午夜福利视频| 欧美最黄视频在线播放免费| 亚洲精品自拍成人| 卡戴珊不雅视频在线播放| 亚洲天堂国产精品一区在线| 日韩精品青青久久久久久| 亚洲aⅴ乱码一区二区在线播放| 最近2019中文字幕mv第一页| 精品少妇黑人巨大在线播放 | 国产精品久久久久久亚洲av鲁大| 五月玫瑰六月丁香| 国产黄色视频一区二区在线观看 | 麻豆久久精品国产亚洲av| 亚洲七黄色美女视频| 久久久a久久爽久久v久久| 国产高清不卡午夜福利| 欧美精品国产亚洲| 国产日本99.免费观看| 久久精品国产亚洲av涩爱 | 一区二区三区免费毛片| 精品久久久久久成人av| 欧美激情久久久久久爽电影| 国产三级中文精品| 校园人妻丝袜中文字幕| 亚洲美女搞黄在线观看| 国内精品一区二区在线观看| 色噜噜av男人的天堂激情| 卡戴珊不雅视频在线播放| 亚洲久久久久久中文字幕| 亚洲国产精品合色在线| 3wmmmm亚洲av在线观看| 一级二级三级毛片免费看| 啦啦啦啦在线视频资源| 欧美激情国产日韩精品一区| eeuss影院久久| 日韩av在线大香蕉| 直男gayav资源| 高清午夜精品一区二区三区 | 久久久a久久爽久久v久久| 永久网站在线| 国国产精品蜜臀av免费| 久久人人爽人人片av| 亚洲色图av天堂| 亚洲内射少妇av| 特大巨黑吊av在线直播| 波野结衣二区三区在线| 中文字幕熟女人妻在线| 亚洲久久久久久中文字幕| 亚洲一区二区三区色噜噜| 亚洲av免费在线观看| 在线免费十八禁| 午夜精品一区二区三区免费看| 寂寞人妻少妇视频99o| 亚洲精品色激情综合| 禁无遮挡网站| 99热这里只有是精品50| 欧美三级亚洲精品| 欧美性猛交黑人性爽| 亚洲久久久久久中文字幕| 国产午夜福利久久久久久| 国产高清视频在线观看网站| 老司机影院成人| 欧美变态另类bdsm刘玥| 亚洲欧美成人综合另类久久久 | 亚洲无线在线观看| 亚洲国产精品久久男人天堂| 我的老师免费观看完整版| 听说在线观看完整版免费高清| 成人鲁丝片一二三区免费| 国产老妇女一区| 成人漫画全彩无遮挡| 亚洲不卡免费看| 天天躁夜夜躁狠狠久久av| 少妇猛男粗大的猛烈进出视频 | 国产精品一二三区在线看| 国产午夜精品一二区理论片| 久久热精品热| 又粗又硬又长又爽又黄的视频 | 99久久精品一区二区三区| 一区福利在线观看| 一进一出抽搐动态| 91精品一卡2卡3卡4卡| 亚洲综合色惰| 国产精品伦人一区二区| 国产极品精品免费视频能看的| 国产精品精品国产色婷婷| 十八禁国产超污无遮挡网站| 欧美日本亚洲视频在线播放| 美女内射精品一级片tv| 国产成人午夜福利电影在线观看| 久久99精品国语久久久| 欧美性猛交╳xxx乱大交人| 久久99热6这里只有精品| 久久久久免费精品人妻一区二区| 日产精品乱码卡一卡2卡三| 乱人视频在线观看| 成人av在线播放网站| 欧美激情国产日韩精品一区| 中文精品一卡2卡3卡4更新| 99热这里只有是精品在线观看| 欧美最新免费一区二区三区| 亚洲最大成人av| 亚洲国产精品久久男人天堂| 精品一区二区三区人妻视频| 国产精品精品国产色婷婷| 国产乱人偷精品视频| 精品人妻偷拍中文字幕| 少妇猛男粗大的猛烈进出视频 | 免费观看精品视频网站| 97人妻精品一区二区三区麻豆| 久久国内精品自在自线图片| 亚洲精华国产精华液的使用体验 | av在线老鸭窝| 只有这里有精品99| 麻豆成人午夜福利视频| 免费无遮挡裸体视频| 我要看日韩黄色一级片| 人人妻人人看人人澡| 国产一区二区亚洲精品在线观看| 一进一出抽搐动态| av福利片在线观看| 有码 亚洲区| 亚洲美女搞黄在线观看| 此物有八面人人有两片| 一级毛片我不卡| 国产伦一二天堂av在线观看| 久久人人爽人人爽人人片va| 高清毛片免费看| 欧美又色又爽又黄视频| 午夜老司机福利剧场| 91狼人影院| 国产成人精品婷婷| 晚上一个人看的免费电影| 久久久久久九九精品二区国产| 一本久久中文字幕| 大又大粗又爽又黄少妇毛片口| 蜜臀久久99精品久久宅男| 免费观看人在逋| 级片在线观看| 亚洲激情五月婷婷啪啪| 久久6这里有精品| 午夜精品一区二区三区免费看| 九九久久精品国产亚洲av麻豆| 久久久色成人| 国产精品99久久久久久久久| 99久久精品热视频| 可以在线观看的亚洲视频| 人人妻人人澡人人爽人人夜夜 | 久久久色成人| 亚洲欧美日韩东京热| 国产精品免费一区二区三区在线| 简卡轻食公司| 天天一区二区日本电影三级| 丰满人妻一区二区三区视频av| 一级黄片播放器| 变态另类成人亚洲欧美熟女| 一级二级三级毛片免费看| 最近最新中文字幕大全电影3| 国产av在哪里看| 亚洲国产精品成人综合色| 欧洲精品卡2卡3卡4卡5卡区| 六月丁香七月| 国产一区二区三区在线臀色熟女| 亚洲av不卡在线观看| av天堂中文字幕网| 丰满乱子伦码专区| 免费黄网站久久成人精品| 国产精品综合久久久久久久免费| 嫩草影院新地址| 国产高清三级在线| 2021天堂中文幕一二区在线观| 成人性生交大片免费视频hd| 亚洲经典国产精华液单| 日本免费一区二区三区高清不卡| 一夜夜www| 免费观看精品视频网站| 精华霜和精华液先用哪个| 国内精品宾馆在线| av在线亚洲专区| 亚洲va在线va天堂va国产| 看黄色毛片网站| 爱豆传媒免费全集在线观看| 欧美成人精品欧美一级黄| 91午夜精品亚洲一区二区三区| 成人无遮挡网站| 色5月婷婷丁香| 99在线人妻在线中文字幕| 国产精品蜜桃在线观看 | 国产精品,欧美在线| 久久草成人影院| 91aial.com中文字幕在线观看| 国产麻豆成人av免费视频| 亚洲电影在线观看av| 成人午夜高清在线视频| 午夜精品一区二区三区免费看| 欧美bdsm另类| 国产中年淑女户外野战色| 亚洲第一区二区三区不卡| 在线观看午夜福利视频| 亚洲欧美日韩东京热| 国产成人精品婷婷| 日本在线视频免费播放| 神马国产精品三级电影在线观看| 日韩欧美精品免费久久| 精品少妇黑人巨大在线播放 | 成人国产麻豆网| 久久人人爽人人片av| 亚洲国产高清在线一区二区三| 综合色丁香网| 日韩欧美在线乱码| 国产一区亚洲一区在线观看| 午夜福利成人在线免费观看| 2021天堂中文幕一二区在线观| 午夜爱爱视频在线播放| 三级国产精品欧美在线观看| 99riav亚洲国产免费| 黄色日韩在线| 美女xxoo啪啪120秒动态图| 一级毛片aaaaaa免费看小| 亚洲综合色惰| 校园春色视频在线观看| 国产精品福利在线免费观看| 能在线免费观看的黄片| 亚洲成人av在线免费| 欧美性猛交╳xxx乱大交人| 久久这里有精品视频免费| 亚洲国产欧洲综合997久久,| 色尼玛亚洲综合影院| 看非洲黑人一级黄片| 成人鲁丝片一二三区免费| 亚洲精品日韩在线中文字幕 | 国产午夜福利久久久久久| 99riav亚洲国产免费| 在线观看免费视频日本深夜| 天天躁日日操中文字幕| 成人高潮视频无遮挡免费网站| 免费大片18禁| 岛国毛片在线播放| 青青草视频在线视频观看| 国产成人一区二区在线| 听说在线观看完整版免费高清| 国产精品电影一区二区三区| 亚洲一级一片aⅴ在线观看| 少妇人妻精品综合一区二区 | 99国产极品粉嫩在线观看| 毛片女人毛片| 黄色日韩在线| 亚洲av熟女| 国产精品99久久久久久久久| 欧美性猛交黑人性爽| 中文字幕久久专区| 99热只有精品国产| 久久人妻av系列| 我的女老师完整版在线观看| 日本三级黄在线观看| 精品久久久久久久久亚洲| 国产一级毛片在线| 亚洲欧美精品专区久久| 久久人人爽人人片av| 亚洲精品自拍成人| 国产黄色视频一区二区在线观看 | 亚洲色图av天堂| 欧美激情在线99| 网址你懂的国产日韩在线| av卡一久久| 伦理电影大哥的女人| 最近中文字幕高清免费大全6| 亚洲精品一二三| 精品一区在线观看国产| 男女无遮挡免费网站观看| 久久久久视频综合| 久久久国产欧美日韩av| 少妇人妻久久综合中文| 成年av动漫网址| 欧美日韩精品成人综合77777| 婷婷成人精品国产| 久久99蜜桃精品久久| 久久久久国产精品人妻一区二区| 91久久精品电影网| 一级毛片我不卡| 国产免费福利视频在线观看| a 毛片基地| 日产精品乱码卡一卡2卡三| 三级国产精品片| 一区在线观看完整版| 欧美成人午夜免费资源| 女人精品久久久久毛片| 久久久久久久亚洲中文字幕| 精品久久久久久久久av| 国产成人午夜福利电影在线观看| 国产日韩一区二区三区精品不卡 | av播播在线观看一区| 亚洲国产欧美日韩在线播放| 一区二区av电影网| 日本91视频免费播放| 九九久久精品国产亚洲av麻豆| 纯流量卡能插随身wifi吗| 日本色播在线视频| 女的被弄到高潮叫床怎么办| 午夜av观看不卡| 欧美成人精品欧美一级黄| 少妇丰满av| av黄色大香蕉| xxx大片免费视频| 午夜免费观看性视频| 亚洲精品国产色婷婷电影| 亚洲性久久影院| 亚洲欧美日韩卡通动漫| 亚洲av二区三区四区| 夜夜骑夜夜射夜夜干| 成人毛片60女人毛片免费| 久久久久国产精品人妻一区二区| 在线观看免费日韩欧美大片 | 91aial.com中文字幕在线观看|