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

    基于AHMRRT的移動(dòng)機(jī)器人路徑規(guī)劃算法

    2022-02-23 00:12:02阮曉鋼劉少達(dá)朱曉慶
    關(guān)鍵詞:偏置障礙物規(guī)劃

    阮曉鋼, 劉少達(dá), 朱曉慶

    (1.北京工業(yè)大學(xué)信息學(xué)部, 北京 100124; 2.計(jì)算智能與智能系統(tǒng)北京市重點(diǎn)實(shí)驗(yàn)室, 北京 100124)

    路徑規(guī)劃是機(jī)器人自主導(dǎo)航技術(shù)中一個(gè)關(guān)鍵性難題,本質(zhì)上是指在當(dāng)前環(huán)境空間中移動(dòng)機(jī)器人依據(jù)一定的性能指標(biāo),如路徑長(zhǎng)度、收斂時(shí)間、消耗能量等,找到從起始點(diǎn)到目標(biāo)點(diǎn)的最佳或次佳的無(wú)障礙通路[1-2]. 機(jī)器人可沿規(guī)劃路徑運(yùn)動(dòng)至目標(biāo)點(diǎn). 傳統(tǒng)的路徑規(guī)劃算法,如圖搜索算法、人工勢(shì)場(chǎng)法、動(dòng)態(tài)窗口法(dynamic window approach,DWA)、蟻群優(yōu)化算法等,在低維度空間中具有一定的優(yōu)勢(shì)[3-7],但都須事先對(duì)環(huán)境空間進(jìn)行建模且計(jì)算復(fù)雜度與機(jī)器人自由度和環(huán)境維度呈指數(shù)關(guān)系:因此,不適合解決多自由度機(jī)器人在高維空間中的路徑規(guī)劃問(wèn)題.

    快速探索隨機(jī)樹(rapid exploring random tree,RRT)是解決高維空間中路徑規(guī)劃問(wèn)題的一種流行且行之有效的方法[8]. 該算法通過(guò)對(duì)隨機(jī)采樣點(diǎn)進(jìn)行碰撞檢測(cè)的方式搜索整個(gè)環(huán)境空間,避免了對(duì)空間中障礙物的建模,因此,計(jì)算復(fù)雜度較低,適合解決高維動(dòng)態(tài)多障礙物環(huán)境空間中路徑規(guī)劃問(wèn)題[9]. RRT算法計(jì)算成本低且搜索速度快,自從提出以來(lái)就引起了眾多學(xué)者的關(guān)注. 但是,該算法仍存在以下缺點(diǎn)[10]:1) 采樣點(diǎn)的隨機(jī)性導(dǎo)致算法的收斂速度較慢,路徑規(guī)劃效率較低. 2) 在具有狹窄通道的U形環(huán)境中算法容易陷入局部極小點(diǎn). 3) 該算法是概率完備性算法,生成的路徑一般不是最優(yōu)且較為曲折.

    為了解決上述問(wèn)題,研究者提出了許多改進(jìn)算法以改進(jìn)路徑搜索過(guò)程[10-14]. 其中隨機(jī)概率目標(biāo)快速探索隨機(jī)樹(probability goal RRT,PGRRT)算法和雙向快速探索隨機(jī)樹(bidirectional RRT,BRRT)算法在路徑生成效率上取得了顯著進(jìn)步. PGRRT算法中隨機(jī)樹以一定概率向目標(biāo)點(diǎn)方向生長(zhǎng)以提高路徑規(guī)劃效率. BRRT算法[13]可在起始點(diǎn)和目標(biāo)點(diǎn)生成2棵隨機(jī)樹,同時(shí)進(jìn)行路徑搜索,加快了算法的收斂速度,提高了機(jī)器人在具有狹窄通道的環(huán)境中逃離局部極小點(diǎn)的概率.

    為了進(jìn)一步提高路徑的生成效率和算法逃離局部極小點(diǎn)的概率,本文提出一種改進(jìn)的基于BRRT的簡(jiǎn)單高效的自適應(yīng)啟發(fā)式多快速探索隨機(jī)樹(adaptive heuristic multiple rapid exploring random tree,AHMRRT)路徑規(guī)劃算法. 該算法在原有BRRT算法的基礎(chǔ)上引入了多隨機(jī)樹構(gòu)建策略和自適應(yīng)啟發(fā)式目標(biāo)偏置因子. 多隨機(jī)樹構(gòu)建策略使算法可在起始點(diǎn)、目標(biāo)點(diǎn)和子目標(biāo)點(diǎn)生成4棵隨機(jī)樹,并同時(shí)進(jìn)行擴(kuò)展搜索,相較于BRRT算法進(jìn)一步提高了路徑生成效率和算法逃離局部極小點(diǎn)的概率. 同時(shí),AHMRRT算法在自適應(yīng)啟發(fā)式目標(biāo)偏置因子的作用下可根據(jù)環(huán)境中障礙物分布情況自適應(yīng)地改變單棵隨機(jī)樹新節(jié)點(diǎn)的生成策略,提高了機(jī)器人執(zhí)行路徑規(guī)劃任務(wù)中的智能性. 在自由空間,該算法可以迅速向目標(biāo)節(jié)點(diǎn)擴(kuò)展以提高搜索效率;在多障礙物空間,AHMRRT算法將調(diào)用隨機(jī)采樣函數(shù)增加隨機(jī)樹生長(zhǎng)的隨機(jī)性以防止機(jī)器人陷入局部最優(yōu)點(diǎn).

    1 術(shù)語(yǔ)定義

    為了更加方便、準(zhǔn)確地描述PGRRT、BRRT、AHMRRT算法,做出以下定義[15].

    S=xsource,G=xgoal,M=xsub:S是路徑規(guī)劃任務(wù)的起始點(diǎn),G為全局目標(biāo)點(diǎn),M為基于多隨機(jī)樹構(gòu)建策略選擇的處于空閑空間中的子目標(biāo)點(diǎn).

    T=(V,E):T代表算法生成的擴(kuò)展隨機(jī)樹;隨機(jī)樹T中的頂點(diǎn)存儲(chǔ)于集合V中;連接頂點(diǎn)的邊關(guān)系存儲(chǔ)于集合E中.

    xs=SampleFree(i):該函數(shù)可以在當(dāng)前地圖空間中生成獨(dú)立均勻分布的隨機(jī)采樣點(diǎn).

    xnew=Steer(xnear,xs,ρ):該函數(shù)為新節(jié)點(diǎn)生成函數(shù),以xnear、xs和擴(kuò)展步長(zhǎng)ρ作為輸入,返回樹T的一個(gè)新節(jié)點(diǎn)xnew,其中‖xnew-xnear‖≤ρ.ρ表示隨機(jī)樹的增長(zhǎng)率,ρ較大時(shí)隨機(jī)樹擴(kuò)展更快.

    FreeCheck(X,x,y):該函數(shù)以地圖空間集合和2個(gè)節(jié)點(diǎn)作為輸入,返回1則表示節(jié)點(diǎn)及其連線處于空閑空間,返回0則表示節(jié)點(diǎn)或其連線處于障礙物中.

    2 PGRRT算法和BRRT算法

    2.1 PGRRT算法

    RRT算法是一種單查詢路徑規(guī)劃算法,以起始點(diǎn)作為根節(jié)點(diǎn),通過(guò)迭代生成子節(jié)點(diǎn)的方式生成一棵探索隨機(jī)樹,當(dāng)子節(jié)點(diǎn)進(jìn)入目標(biāo)點(diǎn)區(qū)域即可規(guī)劃出從起始點(diǎn)到目標(biāo)點(diǎn)的連續(xù)無(wú)障礙路徑.

    RRT算法偽代碼如下.

    算法1RRT算法

    1:V←S;E←?;

    2: while True do

    3:xs←Sample(i),i=i+1;

    4:xnear←Nearst(T,xs);

    5:xnew←Steer(xnear,xs,ρ);

    6: if FreeCheck(X,xnear,xnew)=1 then

    7:V←{xnew}∪V;E←{xnear,xnew}∪E;

    8: if dist(xnew,G)≤εthen

    break;

    8: end if

    10:returnT=(V,E);

    初始時(shí)刻V={S},E=?,在每次迭代過(guò)程中,SampleFree函數(shù)生成一個(gè)隨機(jī)采樣點(diǎn),Nearst函數(shù)找到當(dāng)前隨機(jī)樹中距離采樣點(diǎn)歐氏距離最近的頂點(diǎn)xnear. 然后,通過(guò)Steer函數(shù)生成新節(jié)點(diǎn)xnew,判斷該節(jié)點(diǎn)是否有效,若有效則添加到隨機(jī)擴(kuò)展樹中,同時(shí)判斷該節(jié)點(diǎn)是否進(jìn)入目標(biāo)區(qū)域. 若到達(dá)目標(biāo)區(qū)域,則路徑規(guī)劃成功;否則繼續(xù)迭代執(zhí)行[16].

    新節(jié)點(diǎn)的生成策略是RRT算法中的關(guān)鍵步驟. 傳統(tǒng)RRT算法中新節(jié)點(diǎn)的位置由采樣節(jié)點(diǎn)唯一確定. 新節(jié)點(diǎn)的位置為

    (1)

    式中:xnew.posX、xnew.posY、xnear.posX、xnear.posY分別為新節(jié)點(diǎn)和最近節(jié)點(diǎn)的橫縱坐標(biāo);θ為xnear與xs連線與X軸的夾角. 隨機(jī)樹擴(kuò)展過(guò)程如圖1所示.

    圖1 RRT算法的新節(jié)點(diǎn)生成Fig.1 New node generation of RRT algorithm

    為了提高RRT的路徑規(guī)劃效率,PGRRT在SampleFree函數(shù)中引入?yún)?shù)概率閾值p,在每次迭代過(guò)程中得到一個(gè)0~1.0的隨機(jī)概率q.當(dāng)0

    2.2 BRRT算法

    其實(shí)他們潛意識(shí)里早就知道,從許多許多年前開始,他們就注定了是要互相陪伴的人,不然為什么這么多年來(lái)誰(shuí)也沒(méi)有跟其他人戀愛(ài)過(guò),誰(shuí)也沒(méi)有遺忘過(guò)誰(shuí)。

    BRRT算法在路徑搜索速度和效率方面有了大幅度提高. 相較于RRT算法,BRRT算法具有以下優(yōu)勢(shì)[17-18]:首先,BRRT算法的擴(kuò)展步長(zhǎng)更長(zhǎng),使得隨機(jī)樹長(zhǎng)得更快. 其次,T1、T2兩棵樹彼此向?qū)Ψ浇惶鏀U(kuò)展,而不是采用隨機(jī)擴(kuò)展的方式,在一定程度上降低了搜索的盲目性. 但是,BRRT仍存在一定的問(wèn)題,當(dāng)起始點(diǎn)與目標(biāo)點(diǎn)處于具有U形障礙物的環(huán)境中時(shí),因?yàn)門1、T2不斷向?qū)Ψ竭M(jìn)行擴(kuò)展,所以,可能造成算法陷入局部極小點(diǎn),增加路徑規(guī)劃時(shí)間,降低算法的路徑規(guī)劃效率,甚至導(dǎo)致算法失敗.

    3 AHMRRT算法

    為了進(jìn)一步提高BRRT算法的搜索速度和效率以及機(jī)器人逃離局部極小點(diǎn)的概率. 本文提出基于BRRT算法的AHMRRT算法.

    3.1 新節(jié)點(diǎn)生成策略

    通過(guò)在單棵隨機(jī)樹中引入自適應(yīng)啟發(fā)式目標(biāo)偏置因子,AHMRRT算法中新節(jié)點(diǎn)的位置將不再僅由隨機(jī)采樣點(diǎn)唯一確定. 新節(jié)點(diǎn)位置公式為

    (2)

    式中:σ為自適應(yīng)啟發(fā)式目標(biāo)偏置因子;α為目標(biāo)點(diǎn)G和最近節(jié)點(diǎn)xnear的連線與X軸的夾角. AHMRRT算法中單棵隨機(jī)樹擴(kuò)展過(guò)程如圖2所示. 通過(guò)改變偏置因子σ的值可以在隨機(jī)樹生長(zhǎng)過(guò)程中改變新節(jié)點(diǎn)的生成策略.

    圖2 AHMRRT算法的新節(jié)點(diǎn)生成Fig.2 New node generation of AHMRRT algorithm

    3.2 自適應(yīng)調(diào)整策略

    自適應(yīng)調(diào)整策略具體為:偏置因子σ的值可根據(jù)環(huán)境中障礙物的分布情況自適應(yīng)進(jìn)行改變. 在隨機(jī)樹生長(zhǎng)的初始時(shí)刻,自適應(yīng)啟發(fā)式偏置因子σ為0.1,首先通過(guò)擴(kuò)展第一步得到xnew,新節(jié)點(diǎn)在隨機(jī)采樣點(diǎn)和目標(biāo)點(diǎn)的作用下向目標(biāo)點(diǎn)方向快速擴(kuò)展. 如果新節(jié)點(diǎn)沒(méi)有與障礙物發(fā)生碰撞并且未連接到其他樹,則隨機(jī)樹將繼續(xù)使用目標(biāo)偏置策略擴(kuò)展新節(jié)點(diǎn). 因此,在探索自由空間Xfree時(shí)隨機(jī)樹的擴(kuò)展更具有目標(biāo)導(dǎo)向性,提高了算法的搜索速度和效率. 當(dāng)新節(jié)點(diǎn)與障礙物發(fā)生碰撞新節(jié)點(diǎn)無(wú)效時(shí),將σ設(shè)置為0,此時(shí)采用隨機(jī)擴(kuò)展的方式生成新節(jié)點(diǎn),即在多障礙空間中提高新節(jié)點(diǎn)生成的隨機(jī)性以防止機(jī)器人陷入局部極小點(diǎn)而降低算法收斂時(shí)間. 添加自適應(yīng)啟發(fā)式目標(biāo)偏置因子既避免了新節(jié)點(diǎn)陷入局部極小點(diǎn),又提高了隨機(jī)樹的搜索效率,減少了冗余搜索.

    3.3 多隨機(jī)樹構(gòu)建策略

    為了實(shí)現(xiàn)4棵隨機(jī)樹同時(shí)生長(zhǎng)以提高搜索效率,需要在當(dāng)前空間中選擇子目標(biāo)點(diǎn)作為第3、4棵樹的根節(jié)點(diǎn).

    子目標(biāo)點(diǎn)選擇策略具體為:為降低算法復(fù)雜度,首先將起始點(diǎn)與目標(biāo)點(diǎn)的中點(diǎn)及其鄰域點(diǎn)作為子目標(biāo)點(diǎn)的候選點(diǎn),計(jì)算公式為

    (3)

    (4)

    然后依次檢測(cè)xmed、xmed1、xmed2、xmed3、xmed4是否與障礙物發(fā)生碰撞,選擇第1個(gè)有效候選點(diǎn)作為子目標(biāo)點(diǎn)構(gòu)建第3、4棵快速擴(kuò)展隨機(jī)樹. 式(4)中δ為鄰域半徑,依據(jù)地圖尺寸大小設(shè)置δ值. 本文中地圖尺寸為500×500像素,δ=80.

    如果以上5個(gè)候選節(jié)點(diǎn)均與障礙物發(fā)生碰撞,則AHMRRT算法舍棄子目標(biāo)點(diǎn)的選取,僅在起始點(diǎn)和目標(biāo)點(diǎn)區(qū)域構(gòu)建2棵隨機(jī)樹. 候選點(diǎn)示意圖如圖3所示.

    圖3 候選節(jié)點(diǎn)示意圖Fig.3 Diagram of candidate node

    圖4為AHMRRT算法擴(kuò)展示意圖. 圖中:紅色實(shí)心圓點(diǎn)是起始點(diǎn)S;黑色實(shí)心圓點(diǎn)是目標(biāo)點(diǎn)G.T1和T2相向生長(zhǎng),T3和T4相向生長(zhǎng),4棵樹同時(shí)進(jìn)行擴(kuò)展搜索. 4棵樹相連后,路徑規(guī)劃成功. 紅色折線為規(guī)劃出的路徑. 綠色實(shí)心圓點(diǎn)為子目標(biāo)點(diǎn)M.

    圖4 AHMRRT算法擴(kuò)展示意圖Fig.4 Expansion diagram of AHMRRT algorithm

    4 仿真實(shí)驗(yàn)

    4.1 仿真實(shí)驗(yàn)場(chǎng)景

    為了驗(yàn)證AHMRRT算法的高效性且可以有效逃離路徑規(guī)劃過(guò)程中極易出現(xiàn)的局部極小點(diǎn)問(wèn)題,在圖5所示的500×500像素的簡(jiǎn)單、標(biāo)準(zhǔn)、復(fù)雜、U形環(huán)境中將AHMRRT算法與PGRRT、BRRT算法進(jìn)行了比較. 仿真實(shí)驗(yàn)中使用的硬件平臺(tái)是ThinkPad T460,Intel Core(TM)i5-6200U 2.4 GHz CPU,RAM 8GB,軟件平臺(tái)是matlab2015.

    圖5 實(shí)驗(yàn)場(chǎng)景Fig.5 Experimental scene

    4.2 簡(jiǎn)單、標(biāo)準(zhǔn)、復(fù)雜環(huán)境下的對(duì)比實(shí)驗(yàn)

    實(shí)驗(yàn)參數(shù):擴(kuò)展步長(zhǎng)ρ=15;概率閾值p=0.1;自適應(yīng)啟發(fā)式偏置因子的初始值σ=0.1;起始點(diǎn)S=(20,20),目標(biāo)點(diǎn)G=(480,480). 在仿真實(shí)驗(yàn)過(guò)程中,針對(duì)每種環(huán)境用PGRRT、BRRT算法和AHMRRT算法各進(jìn)行50次實(shí)驗(yàn).

    圖6是AHMRRT算法與PGRRT、BRRT算法在簡(jiǎn)單、標(biāo)準(zhǔn)、復(fù)雜環(huán)境下的仿真實(shí)驗(yàn)結(jié)果圖.

    圖6 實(shí)驗(yàn)結(jié)果對(duì)比Fig.6 Comparison of experimental results

    從圖6可以直觀地看出:在簡(jiǎn)單和標(biāo)準(zhǔn)環(huán)境中,AHMRRT算法相較于PGRRT算法和BRRT算法搜索冗余度大幅度降低,搜索效率顯著提高;在復(fù)雜環(huán)境中,AHMRRT算法相較于PGRRT算法搜索冗余度大大降低,搜索效率顯著提升,但是與BRRT算法相比搜索效率提升并不明顯.

    除了以圖6的形式對(duì)實(shí)驗(yàn)結(jié)果進(jìn)行了直觀的可視化比較,本文還對(duì)AHMRRT、PGRRT、BRRT三種算法在簡(jiǎn)單、標(biāo)準(zhǔn)、復(fù)雜環(huán)境下的實(shí)驗(yàn)結(jié)果進(jìn)行了定量分析. 定量分析指標(biāo)為算法中隨機(jī)樹搜索總分支數(shù),路徑規(guī)劃消耗時(shí)間即算法收斂時(shí)間. 50次實(shí)驗(yàn)中各種算法搜索的平均分支數(shù)和算法平均收斂時(shí)間如表1所示. 從定量分析數(shù)據(jù)可以看出,AHMRRT算法相較于PGRRT、BRRT算法在簡(jiǎn)單、標(biāo)準(zhǔn)環(huán)境下執(zhí)行路徑規(guī)劃任務(wù)具有顯著優(yōu)勢(shì),搜索冗余度更低,搜索速度更快,搜索效率更高. 在簡(jiǎn)單、標(biāo)準(zhǔn)環(huán)境下AHMRRT算法在50次仿真實(shí)驗(yàn)中搜索的平均分支數(shù)和路徑搜索耗時(shí)遠(yuǎn)低于PGRRT、BRRT算法,相較于PGRRT算法搜索冗余度降低67.71%,算法規(guī)劃時(shí)間僅需PGRRT算法的36.76%;相較于BRRT算法搜索冗余度降低37.67%,算法規(guī)劃時(shí)間僅需BRRT算法的55.93%. 搜索冗余度大幅度降低,路徑規(guī)劃效率顯著提高. 在復(fù)雜環(huán)境中,AHMRRT算法相較于PGRRT算法搜索冗余度降低36.32%;算法規(guī)劃時(shí)間僅需PGRRT算法的54.39%;搜索冗余度大幅度降低,路徑規(guī)劃效率顯著提高. 然而在復(fù)雜環(huán)境中,AHMRRT算法相較于BRRT算法并無(wú)優(yōu)勢(shì),造成該結(jié)果的原因?qū)⒃?.4節(jié)進(jìn)行分析.

    表1 量化分析Table 1 Quantitative analysis

    4.3 局部極小點(diǎn)逃離實(shí)驗(yàn)

    為驗(yàn)證AHMRRT算法在具有狹窄通道的環(huán)境中的有效性和高效性,本文設(shè)計(jì)了局部極小點(diǎn)逃離實(shí)驗(yàn). 實(shí)驗(yàn)場(chǎng)景如圖5(d)所示. 起點(diǎn)為S=(160,160),目標(biāo)點(diǎn)為G=(360,360);實(shí)驗(yàn)中對(duì)RRT、BRRT算法和AHMRRT算法各進(jìn)行50次仿真實(shí)驗(yàn).

    實(shí)驗(yàn)結(jié)果如圖7所示. PGRRT、BRRT、AHMRRT算法的平均消耗時(shí)間分別為39.69、30.39、14.74 s. AHMRRT算法的路徑規(guī)劃時(shí)間僅需PGRRT算法的37.13%,僅需BRRT算法的48.50%,算法搜索效率大幅度提高;PGRRT、BRRT、AHMRRT算法搜索的平均分支數(shù)分別為573、482、310. AHMRRT算法的搜索冗余度相較于PGRRT算法降低45.90%,相較于BRRT算法降低35.68%. 實(shí)驗(yàn)結(jié)果表明,AHMRRT算法可有效逃離路徑規(guī)劃任務(wù)中易出現(xiàn)的局部極小點(diǎn)問(wèn)題.

    圖7 U形障礙逃離實(shí)驗(yàn)Fig.7 Experiments of U-shaped obstacle escape

    4.4 實(shí)驗(yàn)分析

    從以上仿真實(shí)驗(yàn)結(jié)果可以看出,在簡(jiǎn)單和標(biāo)準(zhǔn)場(chǎng)景中的AHMRRT算法明顯優(yōu)于PGRRT、BRRT算法. 此外,該算法可有效地避免在路徑規(guī)劃過(guò)程中容易出現(xiàn)的局部極小點(diǎn)問(wèn)題.

    AHMRRT算法搜索冗余度降低的原因是算法中引入了自適應(yīng)啟發(fā)式目標(biāo)偏置因子. 該因子使算法可根據(jù)空間中的障礙物分布情況自適應(yīng)地改變新節(jié)點(diǎn)的生成策略. 在空閑區(qū)域中生成新節(jié)點(diǎn)將更具有方向性. 當(dāng)遇到障礙物時(shí),將增加新節(jié)點(diǎn)生成的隨機(jī)性,以避免陷入局部最優(yōu). 動(dòng)態(tài)變化的偏置因子不僅降低了搜索的分支數(shù),而且確保了AHMRRT算法的概率完整性.

    AHMRRT算法的收斂速度大幅度提高的原因是該算法基于多隨機(jī)樹構(gòu)建策略可構(gòu)造出4棵隨機(jī)樹進(jìn)行同時(shí)搜索,大大提高了路徑生成的效率,也提高了算法逃離局部極小點(diǎn)的概率.

    在復(fù)雜環(huán)境中,AHMRRT算法搜索效率相較于BRRT算法提升并不明顯,原因在于本文中的隨機(jī)樹構(gòu)建策略為了降低算法復(fù)雜度,直接將起始點(diǎn)與目標(biāo)點(diǎn)的中點(diǎn)及其鄰域選為第3節(jié)點(diǎn)的候選區(qū)域,該方法適用于地圖中間無(wú)障礙物的簡(jiǎn)單、標(biāo)準(zhǔn)環(huán)境. 然而在復(fù)雜環(huán)境中通過(guò)本文的隨機(jī)樹構(gòu)建策略選擇的第3節(jié)點(diǎn)易處于具有狹窄通道的約束區(qū)域,算法在逃離約束區(qū)域的過(guò)程中反而增加了算法的收斂時(shí)間和隨機(jī)樹總分支數(shù).

    5 結(jié)論

    1) 本文提出了一種基于BRRT算法的改進(jìn)路徑規(guī)劃算法——AHMRRT算法. AHMRRT算法基于多隨機(jī)樹構(gòu)建策略可以同時(shí)構(gòu)建4棵隨機(jī)樹,并通過(guò)引入自適應(yīng)啟發(fā)式目標(biāo)偏置因子使算法可自適應(yīng)地調(diào)整新節(jié)點(diǎn)的生成策略. 實(shí)驗(yàn)結(jié)果表明,AHMRRT算法在簡(jiǎn)單、標(biāo)準(zhǔn)環(huán)境中具有更高的搜索效率和更低的冗余搜索且可避免在路徑規(guī)劃過(guò)程中容易出現(xiàn)的局部極小點(diǎn)問(wèn)題.

    2) 在多隨機(jī)樹構(gòu)建策略中為降低算法復(fù)雜度,選取起始點(diǎn)與目標(biāo)點(diǎn)的中點(diǎn)及其鄰域作為子目標(biāo)點(diǎn)的候選區(qū)域,在復(fù)雜環(huán)境中可能并不適用. 針對(duì)復(fù)雜環(huán)境中子目標(biāo)點(diǎn)的選取還需要進(jìn)一步研究,以提高AHMRRT算法的泛化能力.

    猜你喜歡
    偏置障礙物規(guī)劃
    基于40%正面偏置碰撞的某車型仿真及結(jié)構(gòu)優(yōu)化
    基于雙向線性插值的車道輔助系統(tǒng)障礙避讓研究
    高低翻越
    SelTrac?CBTC系統(tǒng)中非通信障礙物的設(shè)計(jì)和處理
    規(guī)劃引領(lǐng)把握未來(lái)
    快遞業(yè)十三五規(guī)劃發(fā)布
    商周刊(2017年5期)2017-08-22 03:35:26
    一級(jí)旋流偏置對(duì)雙旋流杯下游流場(chǎng)的影響
    多管齊下落實(shí)規(guī)劃
    迎接“十三五”規(guī)劃
    面向TIA和緩沖器應(yīng)用的毫微微安偏置電流運(yùn)放可實(shí)現(xiàn)500MHz增益帶寬
    国产伦精品一区二区三区视频9| 免费黄频网站在线观看国产| 国产在线免费精品| 国产熟女午夜一区二区三区 | 99久久综合免费| 天堂俺去俺来也www色官网| 人妻 亚洲 视频| 免费观看在线日韩| av免费在线看不卡| 2021少妇久久久久久久久久久| 亚洲不卡免费看| 亚洲在久久综合| 久久久午夜欧美精品| 国产精品国产三级国产av玫瑰| 哪个播放器可以免费观看大片| 亚洲精品一二三| 久久99热6这里只有精品| 超碰97精品在线观看| 一级黄片播放器| 晚上一个人看的免费电影| 乱人伦中国视频| 丝瓜视频免费看黄片| 乱码一卡2卡4卡精品| 大香蕉久久网| 极品人妻少妇av视频| 色视频在线一区二区三区| a级毛色黄片| 久热这里只有精品99| 亚洲国产精品一区二区三区在线| 桃花免费在线播放| 国产精品久久久久成人av| 免费黄网站久久成人精品| 国产成人freesex在线| 中文欧美无线码| 中国国产av一级| 久久久久国产精品人妻一区二区| 熟女av电影| 日韩av在线免费看完整版不卡| 一边亲一边摸免费视频| 麻豆成人午夜福利视频| kizo精华| 日韩av在线免费看完整版不卡| 精品久久国产蜜桃| 51国产日韩欧美| 夜夜爽夜夜爽视频| 精品人妻偷拍中文字幕| 国产精品三级大全| 黄色视频在线播放观看不卡| 亚洲精品一二三| www.av在线官网国产| 国内少妇人妻偷人精品xxx网站| 国产真实伦视频高清在线观看| 国产精品国产三级国产av玫瑰| 插阴视频在线观看视频| 丝袜喷水一区| 在线观看av片永久免费下载| 国国产精品蜜臀av免费| 色视频www国产| 91精品一卡2卡3卡4卡| 亚洲一区二区三区欧美精品| 国产黄片视频在线免费观看| 乱人伦中国视频| 老司机影院毛片| 国产一区二区在线观看av| 大片免费播放器 马上看| 免费黄网站久久成人精品| 国产精品.久久久| 成人国产麻豆网| 嫩草影院入口| av在线app专区| av有码第一页| 精品熟女少妇av免费看| 国产欧美日韩一区二区三区在线 | 啦啦啦视频在线资源免费观看| 国产精品欧美亚洲77777| 一级毛片电影观看| 亚洲精品久久午夜乱码| 99久久综合免费| 丝袜脚勾引网站| 久久人人爽人人片av| 内地一区二区视频在线| 99久久精品一区二区三区| 欧美激情国产日韩精品一区| 99视频精品全部免费 在线| av在线观看视频网站免费| 大片电影免费在线观看免费| 青春草国产在线视频| 久久av网站| 午夜av观看不卡| 久久久久久久精品精品| 精品亚洲乱码少妇综合久久| 亚洲av欧美aⅴ国产| 一级毛片电影观看| 国产91av在线免费观看| 99精国产麻豆久久婷婷| 黑人猛操日本美女一级片| 亚洲精品成人av观看孕妇| 中文资源天堂在线| 日韩中字成人| 成人无遮挡网站| 精品亚洲成国产av| 久久久久久久久久久久大奶| 精品一区在线观看国产| 99热这里只有精品一区| 国产精品一区二区性色av| 国产精品三级大全| 丰满饥渴人妻一区二区三| 欧美激情国产日韩精品一区| 精品久久久久久电影网| 热99国产精品久久久久久7| 99久久精品一区二区三区| 国产亚洲5aaaaa淫片| 视频中文字幕在线观看| 日本91视频免费播放| 亚洲欧美一区二区三区黑人 | 亚洲欧美成人精品一区二区| 亚洲欧洲国产日韩| 水蜜桃什么品种好| 国产在线免费精品| 亚洲内射少妇av| 亚洲精品第二区| 人妻一区二区av| 久久99精品国语久久久| 六月丁香七月| 久久久精品免费免费高清| 最新的欧美精品一区二区| 在线观看美女被高潮喷水网站| 成年av动漫网址| 精品国产露脸久久av麻豆| 777米奇影视久久| 久久精品夜色国产| 久久久国产精品麻豆| 亚洲一级一片aⅴ在线观看| av女优亚洲男人天堂| 久久久欧美国产精品| 国产精品无大码| 亚洲高清免费不卡视频| 国产av一区二区精品久久| 国产精品福利在线免费观看| 在线观看美女被高潮喷水网站| 欧美日韩av久久| 久久久久久久精品精品| 欧美激情极品国产一区二区三区 | 成人漫画全彩无遮挡| 精品国产国语对白av| 免费看av在线观看网站| 99久久精品一区二区三区| 国产成人精品福利久久| 亚洲精品亚洲一区二区| 十分钟在线观看高清视频www | 欧美 日韩 精品 国产| 成年女人在线观看亚洲视频| 久久久久久久久久人人人人人人| 欧美日韩视频精品一区| 亚洲情色 制服丝袜| 少妇 在线观看| 99久久精品一区二区三区| 熟女电影av网| 欧美精品人与动牲交sv欧美| 乱码一卡2卡4卡精品| 国产成人精品久久久久久| 日韩中文字幕视频在线看片| 一本大道久久a久久精品| 亚洲成人一二三区av| 内射极品少妇av片p| 欧美日韩精品成人综合77777| 偷拍熟女少妇极品色| 久久久久国产精品人妻一区二区| 男人添女人高潮全过程视频| 亚洲第一区二区三区不卡| 一区在线观看完整版| 99九九线精品视频在线观看视频| 日韩 亚洲 欧美在线| 精品视频人人做人人爽| 日本-黄色视频高清免费观看| 99久久精品热视频| 91久久精品国产一区二区成人| 妹子高潮喷水视频| 中文资源天堂在线| 日产精品乱码卡一卡2卡三| 91久久精品国产一区二区三区| 亚洲国产精品成人久久小说| 国产淫语在线视频| 最近中文字幕2019免费版| 亚洲欧美成人综合另类久久久| 狂野欧美激情性xxxx在线观看| 能在线免费看毛片的网站| 亚洲国产色片| 丁香六月天网| av有码第一页| av免费观看日本| 免费av中文字幕在线| 好男人视频免费观看在线| 香蕉精品网在线| 国产精品国产av在线观看| 欧美精品一区二区大全| 一本—道久久a久久精品蜜桃钙片| 高清不卡的av网站| 如何舔出高潮| 亚洲成人av在线免费| 日韩不卡一区二区三区视频在线| 国产精品一区www在线观看| 国产欧美亚洲国产| 成人特级av手机在线观看| 中文字幕免费在线视频6| 交换朋友夫妻互换小说| 美女内射精品一级片tv| 色5月婷婷丁香| 最近最新中文字幕免费大全7| 麻豆乱淫一区二区| 人体艺术视频欧美日本| 久久6这里有精品| 一级毛片aaaaaa免费看小| 最黄视频免费看| 丝袜脚勾引网站| 久久久久久久久久久免费av| 人人澡人人妻人| 91成人精品电影| 欧美精品一区二区免费开放| 熟女人妻精品中文字幕| 国产有黄有色有爽视频| 亚洲,一卡二卡三卡| 欧美97在线视频| 精品国产乱码久久久久久小说| 国产 精品1| 久久女婷五月综合色啪小说| 人人妻人人添人人爽欧美一区卜| 99热这里只有是精品50| 成人国产麻豆网| 97精品久久久久久久久久精品| 国产男女超爽视频在线观看| 久久97久久精品| 人妻 亚洲 视频| 精品一区二区免费观看| 国产一级毛片在线| 少妇高潮的动态图| 搡女人真爽免费视频火全软件| 18禁在线播放成人免费| 国产 精品1| 在线播放无遮挡| 在线观看免费日韩欧美大片 | 只有这里有精品99| 国产精品免费大片| 国产淫片久久久久久久久| 99热这里只有是精品50| 成年美女黄网站色视频大全免费 | 久久ye,这里只有精品| 人妻少妇偷人精品九色| 男女无遮挡免费网站观看| 22中文网久久字幕| 日本猛色少妇xxxxx猛交久久| 国产老妇伦熟女老妇高清| 成人综合一区亚洲| 在线观看av片永久免费下载| 久久午夜福利片| 91精品一卡2卡3卡4卡| 亚洲精品乱久久久久久| 精品人妻一区二区三区麻豆| 69精品国产乱码久久久| 性色av一级| 午夜福利网站1000一区二区三区| 一区二区三区乱码不卡18| 欧美人与善性xxx| 国产男人的电影天堂91| av在线老鸭窝| 久久久久久久久大av| 免费看av在线观看网站| 亚洲真实伦在线观看| 亚洲av免费高清在线观看| 国产精品.久久久| 丰满迷人的少妇在线观看| 女的被弄到高潮叫床怎么办| 亚洲国产日韩一区二区| 一区二区三区精品91| 丰满乱子伦码专区| 男的添女的下面高潮视频| 成人影院久久| 国产精品久久久久久精品古装| 久久久欧美国产精品| av在线观看视频网站免费| 久久久久久久精品精品| 丝袜在线中文字幕| 国产成人精品福利久久| 日韩大片免费观看网站| 99热6这里只有精品| 插逼视频在线观看| 午夜91福利影院| 成年人免费黄色播放视频 | 伊人久久国产一区二区| 免费播放大片免费观看视频在线观看| 免费看日本二区| 婷婷色麻豆天堂久久| 在线 av 中文字幕| 九九在线视频观看精品| 精品卡一卡二卡四卡免费| 精品人妻熟女毛片av久久网站| 女人精品久久久久毛片| 美女视频免费永久观看网站| 国产真实伦视频高清在线观看| 国产黄色视频一区二区在线观看| 永久免费av网站大全| 插阴视频在线观看视频| 插逼视频在线观看| 亚洲va在线va天堂va国产| 国产在线视频一区二区| 久久99热这里只频精品6学生| 国产精品人妻久久久久久| 国产国拍精品亚洲av在线观看| 蜜桃久久精品国产亚洲av| 91久久精品电影网| 日产精品乱码卡一卡2卡三| 久久久久国产网址| 国内揄拍国产精品人妻在线| 亚洲综合精品二区| 免费看不卡的av| 极品人妻少妇av视频| 久久国内精品自在自线图片| 观看免费一级毛片| 亚洲欧美一区二区三区黑人 | 国国产精品蜜臀av免费| 日韩一区二区三区影片| 99re6热这里在线精品视频| 精品国产乱码久久久久久小说| 成年人午夜在线观看视频| 一个人看视频在线观看www免费| 中文字幕制服av| 日韩熟女老妇一区二区性免费视频| 久久精品国产自在天天线| 日本爱情动作片www.在线观看| 欧美 日韩 精品 国产| 色94色欧美一区二区| 一级毛片 在线播放| 亚洲国产色片| 国产欧美日韩精品一区二区| 黄片无遮挡物在线观看| 亚洲成人手机| 免费看不卡的av| www.色视频.com| 亚洲欧美日韩另类电影网站| .国产精品久久| 人妻制服诱惑在线中文字幕| 亚洲成人av在线免费| 欧美精品国产亚洲| 国产精品久久久久久精品古装| 久久鲁丝午夜福利片| 一本—道久久a久久精品蜜桃钙片| 简卡轻食公司| 99re6热这里在线精品视频| 国产极品粉嫩免费观看在线 | 亚洲综合色惰| 狂野欧美白嫩少妇大欣赏| 我的老师免费观看完整版| 婷婷色综合www| 最近中文字幕2019免费版| 18禁在线无遮挡免费观看视频| 看十八女毛片水多多多| 精品国产国语对白av| 亚洲av二区三区四区| 男男h啪啪无遮挡| 看十八女毛片水多多多| 亚洲国产最新在线播放| 欧美三级亚洲精品| 日韩亚洲欧美综合| 交换朋友夫妻互换小说| 国产美女午夜福利| 最新的欧美精品一区二区| 秋霞在线观看毛片| 欧美精品一区二区免费开放| 成人二区视频| 观看av在线不卡| 久久久久久久大尺度免费视频| 中文欧美无线码| 免费看av在线观看网站| 少妇被粗大猛烈的视频| 国产深夜福利视频在线观看| 最近最新中文字幕免费大全7| 丁香六月天网| 黑人高潮一二区| 极品少妇高潮喷水抽搐| 少妇人妻一区二区三区视频| 精品国产国语对白av| 午夜免费鲁丝| 久久久国产欧美日韩av| 国产熟女欧美一区二区| 男女国产视频网站| 熟妇人妻不卡中文字幕| 又粗又硬又长又爽又黄的视频| 精品国产国语对白av| av国产久精品久网站免费入址| 自线自在国产av| 亚洲精品日韩在线中文字幕| 99九九在线精品视频 | 嫩草影院新地址| 国产成人一区二区在线| 国产成人精品无人区| 成人毛片a级毛片在线播放| 亚洲精品国产av蜜桃| 午夜福利,免费看| 成人黄色视频免费在线看| 亚洲av电影在线观看一区二区三区| 午夜老司机福利剧场| 国产精品国产三级国产专区5o| 日韩视频在线欧美| 国产成人精品无人区| 黑人高潮一二区| 一本久久精品| 中文字幕制服av| 免费看光身美女| 精品国产一区二区久久| 色婷婷久久久亚洲欧美| 国内少妇人妻偷人精品xxx网站| 男人爽女人下面视频在线观看| 高清黄色对白视频在线免费看 | 免费av不卡在线播放| 亚洲成人手机| 国产有黄有色有爽视频| av不卡在线播放| 大话2 男鬼变身卡| 国产 精品1| 边亲边吃奶的免费视频| 国产老妇伦熟女老妇高清| 纵有疾风起免费观看全集完整版| 99九九在线精品视频 | 69精品国产乱码久久久| 免费观看av网站的网址| 日本wwww免费看| 黄色怎么调成土黄色| 国产视频内射| 亚洲成色77777| 精华霜和精华液先用哪个| 一区二区三区免费毛片| 国产免费又黄又爽又色| 日产精品乱码卡一卡2卡三| 嫩草影院新地址| av女优亚洲男人天堂| 少妇被粗大的猛进出69影院 | 一级,二级,三级黄色视频| 亚洲av电影在线观看一区二区三区| 久久精品国产a三级三级三级| 日本wwww免费看| 又黄又爽又刺激的免费视频.| xxx大片免费视频| 欧美精品高潮呻吟av久久| 啦啦啦在线观看免费高清www| 一级毛片aaaaaa免费看小| 久久久精品94久久精品| 麻豆成人av视频| 啦啦啦中文免费视频观看日本| 少妇高潮的动态图| 国语对白做爰xxxⅹ性视频网站| 在线看a的网站| 亚洲欧美日韩另类电影网站| 深夜a级毛片| 纯流量卡能插随身wifi吗| 日韩不卡一区二区三区视频在线| 日本91视频免费播放| 在线观看三级黄色| 人人妻人人看人人澡| 欧美日韩视频高清一区二区三区二| 日韩,欧美,国产一区二区三区| 在线观看免费高清a一片| 黑丝袜美女国产一区| 国产精品久久久久成人av| 在线观看av片永久免费下载| 欧美3d第一页| 国产精品秋霞免费鲁丝片| 在线观看人妻少妇| 91久久精品国产一区二区三区| 色5月婷婷丁香| 国产av国产精品国产| 国产高清不卡午夜福利| 99久久精品国产国产毛片| 欧美精品人与动牲交sv欧美| 啦啦啦啦在线视频资源| 一区二区av电影网| 黄色欧美视频在线观看| 国产女主播在线喷水免费视频网站| 老司机影院成人| 亚洲激情五月婷婷啪啪| 亚洲精品456在线播放app| 日韩不卡一区二区三区视频在线| 精品久久久噜噜| 国产高清国产精品国产三级| 免费大片黄手机在线观看| 国产免费一区二区三区四区乱码| 三级国产精品欧美在线观看| 国产日韩欧美视频二区| 日韩伦理黄色片| 在线观看人妻少妇| 国产视频首页在线观看| 欧美激情极品国产一区二区三区 | 美女xxoo啪啪120秒动态图| 九草在线视频观看| 在现免费观看毛片| 欧美精品一区二区免费开放| 久久精品国产亚洲av天美| 久久久久视频综合| 国产精品人妻久久久久久| 日本爱情动作片www.在线观看| 插逼视频在线观看| 人妻系列 视频| 精品国产乱码久久久久久小说| 91成人精品电影| 激情五月婷婷亚洲| 免费大片黄手机在线观看| 99久久精品国产国产毛片| 2022亚洲国产成人精品| 99热这里只有精品一区| 亚洲国产欧美在线一区| 在线精品无人区一区二区三| 国产免费视频播放在线视频| 边亲边吃奶的免费视频| 国产精品蜜桃在线观看| 亚洲国产欧美在线一区| 国产探花极品一区二区| 国产在视频线精品| 这个男人来自地球电影免费观看 | 国产成人freesex在线| 午夜91福利影院| 亚洲av欧美aⅴ国产| 国产精品久久久久久久久免| 亚洲一级一片aⅴ在线观看| 久久久欧美国产精品| 国产av国产精品国产| 亚洲欧美一区二区三区黑人 | 亚洲伊人久久精品综合| 久久婷婷青草| 啦啦啦视频在线资源免费观看| 免费观看av网站的网址| 欧美丝袜亚洲另类| 日日撸夜夜添| 人人妻人人看人人澡| 大片免费播放器 马上看| 日韩欧美 国产精品| 婷婷色av中文字幕| 99久久中文字幕三级久久日本| 成人午夜精彩视频在线观看| 中国国产av一级| 国产黄片美女视频| 97精品久久久久久久久久精品| 少妇被粗大猛烈的视频| 一级毛片aaaaaa免费看小| 高清不卡的av网站| 国产免费一级a男人的天堂| 啦啦啦啦在线视频资源| 黑人高潮一二区| 内射极品少妇av片p| 亚洲欧美清纯卡通| 一区二区三区精品91| 高清在线视频一区二区三区| a级毛片免费高清观看在线播放| 国产成人精品福利久久| 女性被躁到高潮视频| 国产一区二区三区av在线| 亚洲av在线观看美女高潮| 亚洲欧洲日产国产| 九草在线视频观看| 精品人妻熟女av久视频| 久久精品久久久久久噜噜老黄| 欧美97在线视频| 日本av手机在线免费观看| 国产精品一区二区性色av| 亚洲av不卡在线观看| 国产成人精品婷婷| 伦理电影大哥的女人| 亚洲欧美中文字幕日韩二区| 欧美日韩精品成人综合77777| 日本欧美视频一区| 日日爽夜夜爽网站| 91午夜精品亚洲一区二区三区| 熟妇人妻不卡中文字幕| 精品一区在线观看国产| av福利片在线观看| 在线免费观看不下载黄p国产| 一区二区av电影网| a级片在线免费高清观看视频| 成人无遮挡网站| 国产午夜精品久久久久久一区二区三区| av在线老鸭窝| 日韩成人av中文字幕在线观看| 国产成人精品无人区| 成年av动漫网址| 欧美少妇被猛烈插入视频| 欧美日韩综合久久久久久| 久久精品久久久久久久性| 日韩不卡一区二区三区视频在线| 极品教师在线视频| 天天操日日干夜夜撸| 深夜a级毛片| 在线免费观看不下载黄p国产| 久久久国产精品麻豆| 久久久久人妻精品一区果冻| 亚洲图色成人| 国产极品粉嫩免费观看在线 | 亚洲伊人久久精品综合| 国产一区有黄有色的免费视频| av免费在线看不卡| 韩国高清视频一区二区三区| 亚洲欧美精品自产自拍| 久久 成人 亚洲| 免费看不卡的av| 99热网站在线观看| 九九爱精品视频在线观看| 视频区图区小说| 国产一级毛片在线| 精华霜和精华液先用哪个| 国产欧美日韩一区二区三区在线 | 少妇被粗大猛烈的视频| 九九爱精品视频在线观看| www.色视频.com| 午夜影院在线不卡| 少妇的逼好多水| 日韩欧美一区视频在线观看 | 精品视频人人做人人爽| 啦啦啦视频在线资源免费观看|