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

    基于改進(jìn)Bi-RRT的移動(dòng)機(jī)器人路徑規(guī)劃算法

    2022-06-01 13:17:28崔春雷陳詩(shī)豪沈超航
    關(guān)鍵詞:高斯分布障礙物概率

    崔春雷,陳詩(shī)豪,沈超航,李 鋒

    (廣東交通職業(yè)技術(shù)學(xué)院,廣州 510650)

    0 引言

    隨著科技水平的進(jìn)步,移動(dòng)機(jī)器人越來(lái)越多的被應(yīng)用到日常生活和工作的多種場(chǎng)景中,如目標(biāo)的移動(dòng)、探測(cè)和清潔等。 在移動(dòng)機(jī)器人的研究領(lǐng)域中,路徑規(guī)劃算法屬于重點(diǎn)研究方向。移動(dòng)機(jī)器人路徑規(guī)劃問(wèn)題可定義為: 在一個(gè)存在障礙物的空間里,給定移動(dòng)機(jī)器人的起點(diǎn)和終點(diǎn),在遵循時(shí)間最短、路徑最優(yōu)以及機(jī)器人運(yùn)動(dòng)學(xué)規(guī)律等一系列約束條件下,找到一條與障礙物無(wú)碰撞的路徑。其中環(huán)境完全已知的規(guī)劃問(wèn)題屬于全局路徑規(guī)劃,環(huán)境部分已知的規(guī)劃問(wèn)題為局部路徑規(guī)劃。常見(jiàn)的路徑規(guī)劃算法包括:A*算法、人工勢(shì)場(chǎng)法、可視圖法、概率路圖算法、模擬退火算法、粒子群算法、蟻群算法、遺傳算法等。以上算法往往需要事先對(duì)狀態(tài)空間內(nèi)的障礙物進(jìn)行環(huán)境建模,導(dǎo)致計(jì)算復(fù)雜高,收斂速度過(guò)于緩慢。

    LaValle等人在1998年提出了經(jīng)典的快速搜索隨機(jī)樹(shù) (RRT,rapid-exploring random tree)算法。RRT算法的搜索過(guò)程通過(guò)隨機(jī)采樣的方式把搜索樹(shù)導(dǎo)向空白區(qū),通過(guò)對(duì)空間中的采樣點(diǎn)進(jìn)行碰撞檢測(cè),從而避免了對(duì)空間的建模,該算法具有概率完備、計(jì)算量小、效率高等優(yōu)點(diǎn),能有效地解決高維空間以及復(fù)雜環(huán)境下的路徑規(guī)劃。然而 RRT 算法也存在一些不足,如需要在全圖進(jìn)行采樣與搜索,會(huì)產(chǎn)生較多不相關(guān)的節(jié)點(diǎn),從而增加了算法對(duì)內(nèi)存的需求,并且也增加了相應(yīng)的搜索時(shí)間,導(dǎo)致收斂速率較緩慢。針對(duì)RRT算法存在的缺陷,國(guó)內(nèi)外眾多學(xué)者紛紛進(jìn)行了研究,提出了多種改進(jìn)的RRT算法,如C.Urmson等在文獻(xiàn)[16]發(fā)表了一個(gè)基于啟發(fā)式的偏向算法,它將搜索樹(shù)向目標(biāo)點(diǎn)的位置進(jìn)行了偏移,引導(dǎo)搜索樹(shù)向目標(biāo)區(qū)域生長(zhǎng),使路徑搜索時(shí)間進(jìn)一步優(yōu)化。針對(duì)原始RRT算法中搜索得到的路徑并非最優(yōu)的問(wèn)題,Karaman等在文獻(xiàn)[17]中提出了具有漸進(jìn)最優(yōu)性的RRT*算法,該算法增加了父節(jié)點(diǎn)的重選和剪枝兩個(gè)優(yōu)化過(guò)程,但此算法也存在收斂速度較慢的缺點(diǎn)。為了提高搜索速度,Kuffne等人先后提出了RRT-connect算法和雙向搜索樹(shù)(Bi-RRT)算法。Bi-RRT算法從起點(diǎn)和終點(diǎn)同時(shí)出發(fā),并行生成兩棵RRT樹(shù),直至兩棵樹(shù)相遇,相較于RRT算法,Bi-RRT算法的收斂速度更快,但Bi-RRT算法采用的仍是RRT算法的隨機(jī)節(jié)點(diǎn)擴(kuò)展思想,導(dǎo)致路徑搜索過(guò)程存在無(wú)目標(biāo)導(dǎo)向性等缺點(diǎn)。

    為了解決雙向搜索樹(shù)(Bi-RRT)算法在路徑搜索時(shí)無(wú)目標(biāo)導(dǎo)向性所導(dǎo)致的搜索效率過(guò)低的問(wèn)題,本文提出了一種基于高斯采樣的改進(jìn)Bi-RRT算法。該算法在雙向搜索的基礎(chǔ)上,引入啟發(fā)式搜索思想,采樣點(diǎn)以一定概率以高斯分布的方式被約束在起點(diǎn)與終點(diǎn)周邊,從而降低搜索的盲目性,提高了搜索的效率。通過(guò)仿真實(shí)驗(yàn)表明:在多種類(lèi)型的復(fù)雜環(huán)境中,相對(duì)于基本的Bi-RRT算法,該算法搜索過(guò)程中擴(kuò)展節(jié)點(diǎn)更少、收斂速度更快、路徑相對(duì)更優(yōu)。

    1 Bi-RRT算法

    RRT算法中隨機(jī)樹(shù)的生長(zhǎng)缺乏目標(biāo)導(dǎo)向性,導(dǎo)致大量冗余節(jié)點(diǎn)出現(xiàn),算法的收斂速度較慢,Kuffner提出的雙向RRT算法(Bi-RRT)則較好的解決了這個(gè)問(wèn)題。Bi-RRT算法的主要過(guò)程為:以起始點(diǎn)

    q

    和目標(biāo)點(diǎn)

    q

    為根節(jié)點(diǎn)分別構(gòu)建兩棵隨機(jī)搜索樹(shù)

    T

    T

    ,樹(shù)

    T

    q

    為樹(shù)的根節(jié)點(diǎn)進(jìn)行擴(kuò)展,樹(shù)

    T

    q

    為樹(shù)的根節(jié)點(diǎn)進(jìn)行擴(kuò)展,直到兩棵樹(shù)相遇。具體過(guò)程如圖1所示,算法首先在整個(gè)搜索空間中生成隨機(jī)擴(kuò)展節(jié)點(diǎn)

    g

    ,然后遍歷隨機(jī)樹(shù)

    T

    T

    ,找出兩棵樹(shù)中距離

    q

    最近的節(jié)點(diǎn)并記為

    q

    ,接著由

    q

    出發(fā)向

    q

    延伸步長(zhǎng)

    δ

    得到新節(jié)點(diǎn)

    q

    ,之后對(duì)新生成的節(jié)點(diǎn)

    q

    進(jìn)行碰撞檢測(cè),若檢測(cè)到

    q

    與障礙物碰撞則舍棄該節(jié)點(diǎn),反之將

    q

    添加到樹(shù)中,此時(shí)

    q

    是的

    q

    父節(jié)點(diǎn);通過(guò)對(duì)上述過(guò)程進(jìn)行迭代,使兩棵搜索樹(shù)不斷向著對(duì)方擴(kuò)展,直到兩棵樹(shù)各自的

    q

    之間的距離小于設(shè)定的閾值,此時(shí)認(rèn)為兩棵樹(shù)相遇,路徑規(guī)劃成功。

    圖1 Bi-RRT算法節(jié)點(diǎn)擴(kuò)展過(guò)程

    相對(duì)于RRT算法,Bi-RRT算法效率更高搜索速度更快,但是Bi-RRT算法采用的仍然是 RRT算法的隨機(jī)擴(kuò)展節(jié)點(diǎn)思想,這也導(dǎo)致Bi-RRT算法和RRT算法一樣存在著構(gòu)型無(wú)目標(biāo)導(dǎo)向性的缺點(diǎn)。

    2 基于高斯采樣的改進(jìn)Bi-RRT算法

    由于RRT算法和Bi-RRT算法在路徑搜索過(guò)程中缺乏目標(biāo)導(dǎo)向性,導(dǎo)致搜索過(guò)程的隨機(jī)性較大,搜索樹(shù)往往會(huì)擴(kuò)展到遠(yuǎn)離我們所期待的目標(biāo)區(qū)域的‘無(wú)用區(qū)域’,浪費(fèi)了大量的計(jì)算資源,需要較長(zhǎng)時(shí)間才能找到可行路徑,且路徑的代價(jià)往往較大。為此,本文提出了一種基于高斯采樣的Bi-RRT算法,該算法的核心思想在于引入啟發(fā)式搜索思想,隨機(jī)擴(kuò)展節(jié)點(diǎn)

    q

    不再以均勻分布的形式在搜索空間內(nèi)隨機(jī)出現(xiàn),而是以一定概率以高斯分布的方式出現(xiàn)在目標(biāo)點(diǎn)周邊,這樣搜索過(guò)程不但可以引導(dǎo)搜索樹(shù)盡可能朝著目標(biāo)區(qū)域前進(jìn),同時(shí)也保留了RRT算法的空間搜索能力,算法不僅提高了搜索效率,得到的路徑也相對(duì)更優(yōu)。

    2.1 二維高斯分布性質(zhì)分析

    (1)

    其中:

    μ

    ,

    σ

    為分量

    X

    的期望值與標(biāo)準(zhǔn)差,

    μ

    ,

    σ

    為分量

    Y

    的期望值與標(biāo)準(zhǔn)差,

    ρ

    值決定了

    X

    Y

    的線(xiàn)性相關(guān)程度。這里假定

    μ

    =

    μ

    =0,

    σ

    =

    σ

    =5,來(lái)觀察

    ρ

    取不同值時(shí)二維隨機(jī)變量(

    X

    ,

    Y

    )概率密度函數(shù)的圖像。

    圖2 ρ值與二維高斯分布概率密度函數(shù)圖像關(guān)系

    利用二維高斯分布的上述特性,我們引入啟發(fā)式搜索策略,隨機(jī)擴(kuò)展采樣點(diǎn)

    q

    不再以均勻分布的形式出現(xiàn)搜索空間內(nèi),而是被二維高斯分布函數(shù)約束在起點(diǎn)與終點(diǎn)周邊區(qū)域,并引導(dǎo)搜索樹(shù)朝著該區(qū)域方向生長(zhǎng)。采用這種策略,在越接近目標(biāo)點(diǎn)的空間,采樣點(diǎn)

    q

    的出現(xiàn)概率越大,但是又不會(huì)把概率完全鎖死在目標(biāo)點(diǎn)本身,這樣不但可以啟發(fā)隨機(jī)搜索樹(shù)向著目標(biāo)區(qū)域生長(zhǎng),提高搜索的效率,同時(shí)又能以一定的概率繞過(guò)障礙物。

    2.2 高斯分布隨機(jī)采樣點(diǎn)的生成方法

    本文算法采用雙采樣點(diǎn)策略,即用采樣點(diǎn)

    q

    來(lái)引導(dǎo)隨機(jī)樹(shù)

    T

    的生長(zhǎng),用采樣點(diǎn)

    q

    來(lái)引導(dǎo)隨機(jī)樹(shù)

    T

    的生長(zhǎng),而

    q

    q

    則分別由以起點(diǎn)

    q

    和終點(diǎn)

    q

    為中心的兩個(gè)二維高斯分布函數(shù)來(lái)分別來(lái)約束其生成。

    圖3 坐標(biāo)系轉(zhuǎn)換示意圖

    (2)

    其中式(2)中的(

    x

    ,

    y

    )為

    q

    在坐標(biāo)系

    OXY

    中的坐標(biāo)。按相同方法,我們可以生成以

    q

    中心點(diǎn)隨機(jī)采樣點(diǎn)

    q

    (

    x

    ,

    y

    )。由圖4可以看出隨機(jī)采樣點(diǎn)

    q

    主要分布在起點(diǎn)附近區(qū)域,且越接近點(diǎn),其出現(xiàn)的概率越大,

    q

    則主要分布在終點(diǎn)

    q

    附近區(qū)域,越接近點(diǎn)

    q

    ,其出現(xiàn)的概率也越大。

    圖4 隨機(jī)采樣點(diǎn)的概率分布示意圖

    2.3 改進(jìn)Bi-RRT算法實(shí)現(xiàn)

    算法1給出了改進(jìn)Bi-RRT算法的偽代碼,算法過(guò)程如下:首先以起點(diǎn)

    q

    和終點(diǎn)

    q

    為根節(jié)點(diǎn)分別構(gòu)建隨機(jī)樹(shù)

    T

    T

    (第1-2行); 然后先以

    q

    為目標(biāo)通過(guò)算法2生成隨機(jī)點(diǎn)

    q

    用來(lái)引導(dǎo)

    T

    的生長(zhǎng),找到隨機(jī)樹(shù)

    T

    中離

    q

    最近的點(diǎn)

    q

    ,以

    q

    為起點(diǎn)向

    q

    方向延伸步長(zhǎng)

    δ

    生成葉子節(jié)點(diǎn)

    q

    ,判斷

    q

    q

    之間是否存在障礙物,若不存在障礙物則將

    q

    作為

    T

    的子節(jié)點(diǎn),并添加邊(

    q

    ,

    q

    )(第4-9行);接著以

    q

    為目標(biāo)通過(guò)算法2生成隨機(jī)點(diǎn)

    q

    用來(lái)引導(dǎo)

    T

    的生長(zhǎng),按照相同的規(guī)則生成葉子節(jié)點(diǎn)

    q

    和邊(

    q

    ,

    q

    )(第10~15行);最后如果

    q

    q

    之間的距離小于設(shè)定的閾值

    s

    ,且兩者之間沒(méi)有障礙物,則判定兩棵樹(shù)相互連接,路徑規(guī)劃完成(第16~17行)。

    算法1:改進(jìn)Bi-RRT算法偽代碼

    1)

    V

    ←{

    q

    };

    E

    Φ

    ;

    T

    ←(

    V

    ,

    E

    );2)

    V

    ←{

    q

    };

    E

    Φ

    ;

    T

    ←(

    V

    ,

    E

    );3)for

    i

    =1 to

    N

    do;4)

    q

    ←sanple(

    q

    );5)

    q

    ←Nearest(

    T

    ,

    q

    );6)

    q

    ←Steer(

    q

    ,

    q

    );7)if ObstacleFree(

    q

    ,

    q

    )then8)

    V

    V

    ∪{

    q

    };9)

    E

    E

    ∪{

    q

    ,

    q

    };10)

    q

    ←Sample(

    q

    );11)

    q

    ←Nearest(

    T

    ,

    q

    );12)

    q

    ←Steer(

    q

    ,

    q

    );13)if ObstacleFree(

    q

    ,

    q

    )then;14)

    V

    V

    ∪{

    q

    };15)

    E

    E

    ∪{

    q

    ,

    q

    };16)if (Dis tan ce(

    q

    ;

    q

    )q

    ,

    q

    )) then17)Return(

    T

    ,

    T

    )。為了平衡搜索過(guò)程中的隨機(jī)性與目標(biāo)導(dǎo)向性,隨機(jī)點(diǎn)

    q

    的產(chǎn)生由3種機(jī)制共同決定,見(jiàn)公式(3)。設(shè)置兩個(gè)目標(biāo)偏置概率

    p

    p

    ,且滿(mǎn)足0<

    p

    <

    p

    <1。

    (3)

    公式(3)中

    p

    為0~1之間的一個(gè)隨機(jī)數(shù);當(dāng)

    p

    p

    時(shí),

    q

    由2.2中的方法產(chǎn)生,即隨機(jī)點(diǎn)

    q

    滿(mǎn)足二維高斯分布特性;當(dāng)

    p

    p

    時(shí),隨機(jī)采樣點(diǎn)

    q

    為目標(biāo)點(diǎn)

    q

    q

    本身,這樣可以充分利用目標(biāo)點(diǎn)的信息,使得搜索樹(shù)以一定概率朝著目標(biāo)點(diǎn)方向快速前進(jìn);當(dāng)

    p

    <

    p

    <

    p

    時(shí),

    q

    符合均勻分布,這樣可以讓一部分隨機(jī)點(diǎn)保留采樣時(shí)的隨機(jī)性,確保搜索過(guò)程在概率上的完備性,保障搜索樹(shù)能跳出局部最優(yōu);算法2給出了公式(3)的偽代碼。

    算法2:隨機(jī)點(diǎn)生成的偽代碼

    P

    () //生成0~1之間的隨機(jī)數(shù)

    p

    if

    p

    p

    q

    =

    q

    . //

    q

    可取

    q

    q

    else if

    p

    >

    p

    q

    =

    q

    ;//此時(shí)

    q

    按均勻分布else

    q

    =

    q

    ;//此時(shí)

    q

    按二維高斯分布end if return(

    q

    )

    3 仿真與分析

    為了驗(yàn)證算法的有效性,在配置window10系統(tǒng),主頻3.40 GHz,內(nèi)存16 GB的PC機(jī)上,采用Matlab 2020a對(duì)算法進(jìn)行了編程仿真實(shí)驗(yàn)。仿真時(shí)設(shè)置的參數(shù)如下:仿真空間尺寸為500×500,起點(diǎn)

    q

    坐標(biāo)為[1,1],終點(diǎn)

    q

    坐標(biāo)為[500,500],步長(zhǎng)

    δ

    =15,兩樹(shù)之間的距離閾值

    s

    =30,目標(biāo)偏置概率

    p

    =0.6,

    p

    =0.9,二維高斯分布的參數(shù)為

    σ

    =

    σ

    =0

    .

    25

    d

    ,

    ρ

    =0

    .

    5。

    3.1 算法性能分析

    仿真時(shí)按照障礙物的分布類(lèi)型設(shè)置了3種有代表性的環(huán)境:簡(jiǎn)單環(huán)境、復(fù)雜環(huán)境、迷宮環(huán)境。分別在每一種環(huán)境下對(duì)Bi-RRT算法和基于高斯采樣的改進(jìn)Bi-RRT算法的性能進(jìn)行對(duì)比。具體過(guò)程為:在每一種環(huán)境下,分別對(duì)兩種算法各進(jìn)行50次仿真測(cè)試,并使用路徑長(zhǎng)度(

    L

    )、擴(kuò)展節(jié)點(diǎn)數(shù)目(

    n

    )、路徑規(guī)劃時(shí)間(

    t

    ) 這3個(gè)參數(shù)作為性能指標(biāo),并求得這3個(gè)指標(biāo)的50次仿真測(cè)試結(jié)果的均值,最后通過(guò)這3個(gè)指標(biāo)對(duì)算法性能進(jìn)行定量分析。

    圖5 環(huán)境1:簡(jiǎn)單環(huán)境

    圖6 環(huán)境2:復(fù)雜環(huán)境

    圖7 環(huán)境3:迷宮環(huán)境

    圖5為簡(jiǎn)單環(huán)境中兩種算法的表現(xiàn),圖6為充滿(mǎn)障礙物的復(fù)雜環(huán)境中兩種算法的表現(xiàn),圖7為通道狹窄曲折的迷宮環(huán)境下兩種算法的表現(xiàn)。從圖5~7可以明顯看出,基本Bi-RRT算法采樣過(guò)程因?yàn)槿狈δ繕?biāo)導(dǎo)向,采樣點(diǎn)分布過(guò)于隨機(jī),導(dǎo)致搜索樹(shù)往往會(huì)在“無(wú)用區(qū)域”浪費(fèi)過(guò)多資源,產(chǎn)生過(guò)多的無(wú)用節(jié)點(diǎn),而本文改進(jìn)算法引入啟發(fā)式搜索思想,充分利用了目標(biāo)點(diǎn)的位置信息,讓隨機(jī)點(diǎn)不再“盲目”出現(xiàn),而是以高斯分布的形式出現(xiàn)在目標(biāo)點(diǎn)附近的空間,搜索過(guò)程所需的隨機(jī)采樣點(diǎn)的數(shù)量更少,效率也更高。

    如表1所示,對(duì)圖5這種簡(jiǎn)單環(huán)境,本文算法的額外的擴(kuò)展節(jié)點(diǎn)更少,路徑也更平滑,路徑長(zhǎng)度也更小。對(duì)圖6這種充滿(mǎn)密集障礙物的復(fù)雜環(huán)境,本文算法的優(yōu)勢(shì)更加明顯,相對(duì)于基本Bi-RRT算法,平均規(guī)劃時(shí)間縮短了43.9%,平均擴(kuò)展節(jié)點(diǎn)數(shù)目減少了41.4%,路徑長(zhǎng)度優(yōu)化了8.1%。對(duì)圖7這種富有挑戰(zhàn)性的充滿(mǎn)狹窄通道的迷宮環(huán)境,相對(duì)于基本Bi-RRT算法,改進(jìn)算法的平均規(guī)劃時(shí)間縮短了30.9%,平均擴(kuò)展節(jié)點(diǎn)數(shù)目減少了27.2%,路徑長(zhǎng)度優(yōu)化了2%。通過(guò)定量分析可知,本文提出的改進(jìn)Bi-RRT算法的路徑搜索時(shí)間更短、擴(kuò)展節(jié)點(diǎn)更少、路徑更優(yōu)。

    表1 不同環(huán)境下算法性能對(duì)比

    3.2 目標(biāo)偏置概率對(duì)算法性能的影響

    改進(jìn)算法中目標(biāo)偏置概率

    p

    ,

    p

    對(duì)算法的運(yùn)行效率有著重要影響。由公式(3)可知采樣點(diǎn)由3種機(jī)制共同產(chǎn)生,分別在概率

    p

    =

    p

    下按二維高斯分布出現(xiàn),在概率

    p

    =

    p

    -

    p

    下按均勻分布出現(xiàn),以概率

    p

    =1-

    p

    把起點(diǎn)(或終點(diǎn))作為采樣點(diǎn),顯然

    p

    +

    p

    +

    p

    =1。為了簡(jiǎn)化問(wèn)題,保持

    p

    =0

    .

    1不變,此時(shí)

    p

    =0

    .

    9-

    p

    ,這里

    p

    顯然表示的是按高斯分布出現(xiàn)的采樣點(diǎn)占總的采樣點(diǎn)數(shù)的百分比。下面來(lái)分析概率

    p

    的值對(duì)算法性能的影響,這里仍然以圖6中的復(fù)雜環(huán)境作為測(cè)試環(huán)境,在保持其他仿真參數(shù)不變的情況下,測(cè)試

    p

    取不同值時(shí)算法性能的表現(xiàn)。圖8為仿真測(cè)試得到的平均節(jié)點(diǎn)數(shù)目隨概率

    p

    變化的曲線(xiàn),從圖中可以看出,平均節(jié)點(diǎn)數(shù)目隨著概率

    p

    的增加而減少,當(dāng)

    p

    =0

    .

    7附近時(shí)達(dá)到極小值。圖9則為平均規(guī)劃時(shí)間隨概率

    p

    變化的曲線(xiàn),與圖8的規(guī)律一致,這里規(guī)劃時(shí)間也隨著概率

    p

    的增加而減少,當(dāng)

    p

    =0

    .

    7時(shí)規(guī)劃時(shí)間達(dá)到最小值,之后隨著

    p

    的增加規(guī)劃時(shí)間又有所上升。可見(jiàn),概率

    p

    較小時(shí),即按照高斯分布出現(xiàn)的采樣點(diǎn)占比少時(shí),算法效率會(huì)降低;另一方面概率

    p

    如果取到0

    .

    9,即所有隨機(jī)點(diǎn)都按照高斯采樣時(shí),則又因?yàn)槿鄙倭俗杂刹蓸訋?lái)的隨機(jī)性,算法效率也會(huì)降低,只有當(dāng)

    p

    取到合適值時(shí),算法的效率才最高。

    圖8 平均節(jié)點(diǎn)數(shù)目隨概率變化曲線(xiàn)

    圖9 平均規(guī)劃時(shí)間隨概率變化曲線(xiàn)

    4 結(jié)束語(yǔ)

    為了改進(jìn)Bi-RRT算法的效率,本文提出了一種改進(jìn)Bi-RRT算法,該算法分別以機(jī)器人的起點(diǎn)和終點(diǎn)為概率分布的中心,構(gòu)建二維高斯分布概率密度函數(shù),并用該函數(shù)約束隨機(jī)采樣點(diǎn)的生成,同時(shí)也保留一部分均勻分布的采樣點(diǎn),通過(guò)這些具有目標(biāo)啟發(fā)性的采樣點(diǎn)來(lái)引導(dǎo)兩棵搜索樹(shù)快速向目標(biāo)點(diǎn)生長(zhǎng)并相遇。該算法在保證搜索過(guò)程概率完備性的前提下,提高了尋徑的效率和質(zhì)量,相對(duì)于基本的Bi-RRT算法,本文算法在應(yīng)對(duì)復(fù)雜環(huán)境、迷宮環(huán)境等環(huán)境時(shí)的表現(xiàn)更佳,如在復(fù)雜環(huán)境下規(guī)劃時(shí)間縮短了43.9%,擴(kuò)展節(jié)點(diǎn)數(shù)目減少了41.4%,路徑長(zhǎng)度優(yōu)化了8.1%,最后分析了目標(biāo)偏置概率對(duì)算法性能的影響,找到了使算法效果最優(yōu)時(shí)對(duì)應(yīng)的高斯分布采樣點(diǎn)的占比。未來(lái)可以考慮將本文算法結(jié)合RRT*算法,并應(yīng)用到3維以上的高維空間中的路徑規(guī)劃問(wèn)題。

    猜你喜歡
    高斯分布障礙物概率
    第6講 “統(tǒng)計(jì)與概率”復(fù)習(xí)精講
    深度學(xué)習(xí)在艦船前方障礙物圖像識(shí)別中的應(yīng)用
    第6講 “統(tǒng)計(jì)與概率”復(fù)習(xí)精講
    概率與統(tǒng)計(jì)(一)
    概率與統(tǒng)計(jì)(二)
    利用Box-Cox變換對(duì)移動(dòng)通信中小區(qū)級(jí)業(yè)務(wù)流量分布的研究
    2種非對(duì)稱(chēng)廣義高斯分布模型的構(gòu)造
    高低翻越
    SelTrac?CBTC系統(tǒng)中非通信障礙物的設(shè)計(jì)和處理
    一種基于改進(jìn)混合高斯模型的前景檢測(cè)
    精品久久蜜臀av无| 日韩一区二区视频免费看| 国产深夜福利视频在线观看| 男女午夜视频在线观看 | tube8黄色片| 国产精品一二三区在线看| 男人舔女人的私密视频| 国产又爽黄色视频| 国产一区二区激情短视频 | 中文乱码字字幕精品一区二区三区| 伦理电影免费视频| av国产精品久久久久影院| 免费大片18禁| 亚洲精品久久午夜乱码| 丰满迷人的少妇在线观看| 啦啦啦在线观看免费高清www| 久久这里只有精品19| 少妇的逼好多水| 欧美精品av麻豆av| 精品卡一卡二卡四卡免费| 婷婷色综合www| 午夜福利影视在线免费观看| 美女国产高潮福利片在线看| 晚上一个人看的免费电影| 国产在线一区二区三区精| 在现免费观看毛片| 999精品在线视频| 精品99又大又爽又粗少妇毛片| 又黄又爽又刺激的免费视频.| 日本91视频免费播放| 99re6热这里在线精品视频| 肉色欧美久久久久久久蜜桃| 日本午夜av视频| 男女边摸边吃奶| 26uuu在线亚洲综合色| 亚洲欧洲日产国产| 色哟哟·www| 色吧在线观看| 一本—道久久a久久精品蜜桃钙片| 免费不卡的大黄色大毛片视频在线观看| 国产精品人妻久久久影院| 有码 亚洲区| 国产亚洲欧美精品永久| √禁漫天堂资源中文www| 亚洲国产精品一区三区| 人人妻人人添人人爽欧美一区卜| 免费观看性生交大片5| 免费观看无遮挡的男女| 欧美 亚洲 国产 日韩一| 在线亚洲精品国产二区图片欧美| 欧美日本中文国产一区发布| av免费观看日本| 亚洲国产精品一区三区| 在线观看www视频免费| 国产成人午夜福利电影在线观看| 1024视频免费在线观看| 国产日韩一区二区三区精品不卡| 国产乱来视频区| 国产av一区二区精品久久| 最近最新中文字幕大全免费视频 | 青春草视频在线免费观看| 色网站视频免费| 成人国产麻豆网| av国产精品久久久久影院| 亚洲精品456在线播放app| 日韩欧美一区视频在线观看| www.色视频.com| 欧美性感艳星| 国产一级毛片在线| 亚洲在久久综合| 日韩av不卡免费在线播放| 边亲边吃奶的免费视频| 女性生殖器流出的白浆| 亚洲欧美成人精品一区二区| 男女啪啪激烈高潮av片| 日本午夜av视频| www.色视频.com| 精品午夜福利在线看| 亚洲欧洲国产日韩| 精品一区二区免费观看| av又黄又爽大尺度在线免费看| 777米奇影视久久| 久久久精品94久久精品| 综合色丁香网| 欧美日韩国产mv在线观看视频| 亚洲精品日本国产第一区| 麻豆乱淫一区二区| 天堂俺去俺来也www色官网| 亚洲av在线观看美女高潮| 国产精品麻豆人妻色哟哟久久| 午夜福利,免费看| 国产成人精品久久久久久| av片东京热男人的天堂| 我要看黄色一级片免费的| 丁香六月天网| 制服丝袜香蕉在线| 少妇的逼好多水| 亚洲精品av麻豆狂野| 国产精品久久久久成人av| 超碰97精品在线观看| 久久精品国产亚洲av天美| 90打野战视频偷拍视频| 草草在线视频免费看| 国产成人a∨麻豆精品| 亚洲av在线观看美女高潮| 精品国产一区二区三区久久久樱花| 99久久中文字幕三级久久日本| 高清欧美精品videossex| 午夜福利视频在线观看免费| 国产免费一级a男人的天堂| 午夜久久久在线观看| 97人妻天天添夜夜摸| h视频一区二区三区| 男女啪啪激烈高潮av片| 美女xxoo啪啪120秒动态图| 性色av一级| 99re6热这里在线精品视频| 美女主播在线视频| av电影中文网址| 亚洲伊人色综图| 精品国产露脸久久av麻豆| 亚洲国产欧美在线一区| 少妇 在线观看| 宅男免费午夜| 香蕉国产在线看| xxxhd国产人妻xxx| 亚洲图色成人| 国产免费一级a男人的天堂| 国国产精品蜜臀av免费| 成人二区视频| 久久精品人人爽人人爽视色| 日韩中文字幕视频在线看片| 日本爱情动作片www.在线观看| 中国国产av一级| 国产又色又爽无遮挡免| 男人添女人高潮全过程视频| 亚洲性久久影院| av.在线天堂| 日本午夜av视频| 国产精品免费大片| 黄色毛片三级朝国网站| 亚洲欧美中文字幕日韩二区| 国产爽快片一区二区三区| 亚洲国产看品久久| 91精品三级在线观看| 制服丝袜香蕉在线| 久久这里只有精品19| 欧美精品国产亚洲| 国产视频首页在线观看| 久久免费观看电影| 国产精品免费大片| 久久久久国产精品人妻一区二区| 国产免费又黄又爽又色| 精品熟女少妇av免费看| 日本wwww免费看| 亚洲精品久久午夜乱码| 国产精品一二三区在线看| 午夜视频国产福利| 亚洲精品视频女| 亚洲国产欧美在线一区| 春色校园在线视频观看| 丰满饥渴人妻一区二区三| 国产淫语在线视频| 18+在线观看网站| 亚洲人成77777在线视频| 婷婷色麻豆天堂久久| 桃花免费在线播放| 一区二区三区四区激情视频| 曰老女人黄片| 亚洲av在线观看美女高潮| 久久亚洲国产成人精品v| 大陆偷拍与自拍| 街头女战士在线观看网站| 大码成人一级视频| 国精品久久久久久国模美| 亚洲国产色片| 99re6热这里在线精品视频| 精品国产一区二区久久| 我要看黄色一级片免费的| 国产又色又爽无遮挡免| 草草在线视频免费看| 国产老妇伦熟女老妇高清| 久久亚洲国产成人精品v| 精品国产一区二区久久| 少妇 在线观看| 岛国毛片在线播放| 久久人人爽人人爽人人片va| 韩国高清视频一区二区三区| 国产精品久久久久久久电影| 欧美性感艳星| 精品国产露脸久久av麻豆| 大片电影免费在线观看免费| 国产精品久久久久久久久免| 99精国产麻豆久久婷婷| 久久热在线av| 老女人水多毛片| 男女啪啪激烈高潮av片| 久久午夜福利片| 精品一品国产午夜福利视频| 国产黄频视频在线观看| 国产免费一区二区三区四区乱码| 蜜桃在线观看..| 国产熟女午夜一区二区三区| 国产精品久久久久久精品电影小说| 色5月婷婷丁香| 日本wwww免费看| 黄色视频在线播放观看不卡| 日韩熟女老妇一区二区性免费视频| 一本色道久久久久久精品综合| 97精品久久久久久久久久精品| 日韩,欧美,国产一区二区三区| 亚洲综合色惰| 欧美成人午夜精品| 免费女性裸体啪啪无遮挡网站| 国产亚洲最大av| 丝瓜视频免费看黄片| 人成视频在线观看免费观看| av在线播放精品| 国产成人精品一,二区| 欧美日韩成人在线一区二区| 日韩免费高清中文字幕av| 久久精品熟女亚洲av麻豆精品| 91aial.com中文字幕在线观看| 日韩免费高清中文字幕av| 熟女av电影| 桃花免费在线播放| 国产成人欧美| 寂寞人妻少妇视频99o| 成人影院久久| 在线观看人妻少妇| 日本色播在线视频| 水蜜桃什么品种好| 大陆偷拍与自拍| 在线观看国产h片| 亚洲精品一区蜜桃| 在线观看免费日韩欧美大片| 国产亚洲精品久久久com| 国产毛片在线视频| 久久久国产一区二区| 黄色 视频免费看| 永久网站在线| 久久青草综合色| 精品视频人人做人人爽| 日本vs欧美在线观看视频| 亚洲精品第二区| 插逼视频在线观看| 看免费av毛片| av视频免费观看在线观看| 人人妻人人澡人人看| a 毛片基地| 久久久国产精品麻豆| 国产精品欧美亚洲77777| 97在线人人人人妻| 日本色播在线视频| 久久人人爽人人片av| 国产高清不卡午夜福利| 91在线精品国自产拍蜜月| 在线观看一区二区三区激情| 亚洲欧洲国产日韩| 欧美 日韩 精品 国产| 男的添女的下面高潮视频| 91在线精品国自产拍蜜月| 精品一品国产午夜福利视频| 精品国产一区二区久久| 国产成人欧美| 欧美精品人与动牲交sv欧美| 一区二区三区乱码不卡18| 久久亚洲国产成人精品v| 一本—道久久a久久精品蜜桃钙片| 亚洲成人一二三区av| 午夜福利网站1000一区二区三区| 最后的刺客免费高清国语| 欧美+日韩+精品| 免费久久久久久久精品成人欧美视频 | 黑人猛操日本美女一级片| 韩国精品一区二区三区 | 熟妇人妻不卡中文字幕| 国产精品无大码| 国产精品熟女久久久久浪| 国产成人精品福利久久| 国产精品一区二区在线不卡| 秋霞伦理黄片| 亚洲成国产人片在线观看| 丝袜在线中文字幕| 亚洲精品,欧美精品| 老司机影院成人| 90打野战视频偷拍视频| 亚洲色图综合在线观看| 久久av网站| 自拍欧美九色日韩亚洲蝌蚪91| 久久久久久久大尺度免费视频| 男女下面插进去视频免费观看 | 国产高清不卡午夜福利| 午夜免费鲁丝| 亚洲国产精品999| 高清av免费在线| 韩国精品一区二区三区 | 国产在线一区二区三区精| 欧美精品一区二区免费开放| 一二三四在线观看免费中文在 | 在线观看免费高清a一片| 欧美老熟妇乱子伦牲交| 一级毛片电影观看| 久久婷婷青草| 爱豆传媒免费全集在线观看| 国产亚洲精品第一综合不卡 | 久久久久久久亚洲中文字幕| 日本vs欧美在线观看视频| 久热久热在线精品观看| 亚洲av国产av综合av卡| 下体分泌物呈黄色| 国产免费福利视频在线观看| 国语对白做爰xxxⅹ性视频网站| 国产一区二区三区综合在线观看 | 国产一区二区三区综合在线观看 | 亚洲成色77777| 天美传媒精品一区二区| 亚洲欧美成人精品一区二区| 一级毛片电影观看| 国产午夜精品一二区理论片| 国产成人精品婷婷| 国产乱人偷精品视频| 免费观看a级毛片全部| 免费日韩欧美在线观看| 国产精品久久久久久久电影| 性色avwww在线观看| 国产一区二区三区综合在线观看 | 久久久国产精品麻豆| 黄色怎么调成土黄色| 18禁国产床啪视频网站| 亚洲欧洲精品一区二区精品久久久 | 日韩av免费高清视频| a级毛色黄片| 熟女av电影| 国产成人午夜福利电影在线观看| 观看av在线不卡| 中文乱码字字幕精品一区二区三区| 精品人妻熟女毛片av久久网站| 十分钟在线观看高清视频www| a级毛色黄片| 免费高清在线观看日韩| 一级片'在线观看视频| 狠狠精品人妻久久久久久综合| 亚洲国产精品一区二区三区在线| 免费大片18禁| 久久久久久久国产电影| 国产成人精品福利久久| 一级毛片黄色毛片免费观看视频| 丰满乱子伦码专区| 中文字幕制服av| 制服丝袜香蕉在线| 久久99热这里只频精品6学生| 免费少妇av软件| 91aial.com中文字幕在线观看| 久久国内精品自在自线图片| 欧美+日韩+精品| 成人国产av品久久久| 精品一区二区三区视频在线| 在线精品无人区一区二区三| 又粗又硬又长又爽又黄的视频| 国产一级毛片在线| 成人毛片a级毛片在线播放| 综合色丁香网| 少妇精品久久久久久久| 免费人妻精品一区二区三区视频| 最后的刺客免费高清国语| 18+在线观看网站| 精品久久久久久电影网| 中文乱码字字幕精品一区二区三区| 国产在线视频一区二区| 亚洲综合色网址| 国产无遮挡羞羞视频在线观看| 狠狠婷婷综合久久久久久88av| 日本av手机在线免费观看| 国产色爽女视频免费观看| 免费人妻精品一区二区三区视频| 午夜91福利影院| 久久av网站| xxx大片免费视频| 天堂俺去俺来也www色官网| 国产精品久久久久久久电影| 欧美日韩视频高清一区二区三区二| 亚洲少妇的诱惑av| 久久99精品国语久久久| 亚洲高清免费不卡视频| 欧美激情 高清一区二区三区| 亚洲国产精品专区欧美| 欧美成人午夜精品| 久久久久久久久久久免费av| 自拍欧美九色日韩亚洲蝌蚪91| 女的被弄到高潮叫床怎么办| 国产福利在线免费观看视频| 嫩草影院入口| 久久毛片免费看一区二区三区| 大香蕉久久成人网| 咕卡用的链子| 97超碰精品成人国产| 久久精品国产自在天天线| 欧美精品亚洲一区二区| 亚洲在久久综合| 久久人人爽人人爽人人片va| 水蜜桃什么品种好| 国产精品麻豆人妻色哟哟久久| 国产黄频视频在线观看| 丰满迷人的少妇在线观看| 妹子高潮喷水视频| 免费观看av网站的网址| 人人澡人人妻人| 欧美精品高潮呻吟av久久| 制服诱惑二区| 国产一级毛片在线| 搡女人真爽免费视频火全软件| 国产爽快片一区二区三区| 久久精品久久久久久噜噜老黄| 男人舔女人的私密视频| 99久久中文字幕三级久久日本| av在线老鸭窝| 多毛熟女@视频| 国产成人午夜福利电影在线观看| 在线观看美女被高潮喷水网站| 免费看光身美女| 久久 成人 亚洲| 国产精品.久久久| 精品卡一卡二卡四卡免费| 美女脱内裤让男人舔精品视频| 高清欧美精品videossex| 亚洲av日韩在线播放| 美女国产高潮福利片在线看| freevideosex欧美| 香蕉精品网在线| 人人妻人人澡人人看| 国产在线一区二区三区精| 最近最新中文字幕免费大全7| 免费黄频网站在线观看国产| 又粗又硬又长又爽又黄的视频| 少妇被粗大的猛进出69影院 | 婷婷色av中文字幕| 一区二区av电影网| 青春草视频在线免费观看| 97在线视频观看| 日韩成人伦理影院| 毛片一级片免费看久久久久| 久久人妻熟女aⅴ| 国产精品熟女久久久久浪| 男的添女的下面高潮视频| 亚洲精品第二区| av免费观看日本| 九九爱精品视频在线观看| av免费在线看不卡| 久久精品aⅴ一区二区三区四区 | 亚洲精品国产av成人精品| 一级毛片黄色毛片免费观看视频| 久久久久精品性色| 欧美日韩成人在线一区二区| 久久久久久久国产电影| 色婷婷av一区二区三区视频| 成年女人在线观看亚洲视频| 亚洲av电影在线观看一区二区三区| 亚洲精品美女久久久久99蜜臀 | 天天操日日干夜夜撸| 亚洲欧美日韩另类电影网站| 免费大片黄手机在线观看| 亚洲av男天堂| 亚洲美女搞黄在线观看| 国产一区亚洲一区在线观看| 精品视频人人做人人爽| 国产成人精品婷婷| 亚洲国产精品999| 亚洲第一区二区三区不卡| 国产精品久久久久久精品电影小说| 国产男女超爽视频在线观看| 国产在视频线精品| 亚洲精品aⅴ在线观看| 久久韩国三级中文字幕| 亚洲欧美一区二区三区黑人 | 亚洲图色成人| 2018国产大陆天天弄谢| 亚洲,欧美,日韩| 免费久久久久久久精品成人欧美视频 | av国产久精品久网站免费入址| 寂寞人妻少妇视频99o| 少妇 在线观看| 男女边摸边吃奶| 国产成人欧美| 99re6热这里在线精品视频| 黄色毛片三级朝国网站| 国产成人精品久久久久久| 99久久精品国产国产毛片| 最近中文字幕2019免费版| 国产精品久久久久久精品电影小说| av在线观看视频网站免费| 午夜激情久久久久久久| 18禁国产床啪视频网站| 91精品国产国语对白视频| 国产高清不卡午夜福利| 日韩 亚洲 欧美在线| 欧美精品一区二区大全| 美女视频免费永久观看网站| 久久这里只有精品19| 成人综合一区亚洲| 久久99热这里只频精品6学生| 99视频精品全部免费 在线| 亚洲精品日本国产第一区| 国产黄频视频在线观看| 老女人水多毛片| 精品一区在线观看国产| 女人久久www免费人成看片| 亚洲av免费高清在线观看| 日产精品乱码卡一卡2卡三| 免费黄网站久久成人精品| 亚洲内射少妇av| 亚洲成av片中文字幕在线观看 | 夜夜骑夜夜射夜夜干| 性高湖久久久久久久久免费观看| 国产片特级美女逼逼视频| 欧美日韩成人在线一区二区| 国产亚洲精品第一综合不卡 | 成人免费观看视频高清| 亚洲婷婷狠狠爱综合网| 成人免费观看视频高清| 99久久综合免费| 22中文网久久字幕| 国产欧美日韩一区二区三区在线| 一本色道久久久久久精品综合| av在线老鸭窝| 丰满迷人的少妇在线观看| 国产男女超爽视频在线观看| 51国产日韩欧美| 日韩人妻精品一区2区三区| 午夜精品国产一区二区电影| 一级片'在线观看视频| 91精品三级在线观看| 国产精品熟女久久久久浪| 欧美日韩视频精品一区| 国产精品麻豆人妻色哟哟久久| 黄片播放在线免费| 国产精品久久久久久久电影| 免费看av在线观看网站| 日韩大片免费观看网站| 免费看不卡的av| 国产片内射在线| 99re6热这里在线精品视频| 亚洲av免费高清在线观看| 波多野结衣一区麻豆| 婷婷色av中文字幕| 久久人人爽人人爽人人片va| 国产一区二区激情短视频 | 国产精品三级大全| 久久精品国产鲁丝片午夜精品| 国产视频首页在线观看| 99精国产麻豆久久婷婷| 欧美国产精品va在线观看不卡| 日本色播在线视频| 成年动漫av网址| 色哟哟·www| 国产精品一区二区在线观看99| 精品一区二区三卡| 国国产精品蜜臀av免费| 国产高清不卡午夜福利| 在线观看www视频免费| 一本色道久久久久久精品综合| 美女中出高潮动态图| 在线观看免费高清a一片| 1024视频免费在线观看| 亚洲欧美一区二区三区国产| 亚洲国产精品专区欧美| 人妻一区二区av| 国精品久久久久久国模美| a级毛片在线看网站| 97人妻天天添夜夜摸| 国产精品成人在线| 夜夜爽夜夜爽视频| 一级毛片电影观看| 插逼视频在线观看| 丝袜在线中文字幕| 免费播放大片免费观看视频在线观看| 午夜福利乱码中文字幕| 91在线精品国自产拍蜜月| 大陆偷拍与自拍| 亚洲av综合色区一区| 亚洲精品日韩在线中文字幕| 久久久a久久爽久久v久久| 最近中文字幕高清免费大全6| 亚洲在久久综合| 97人妻天天添夜夜摸| 99热网站在线观看| 精品人妻熟女毛片av久久网站| 人妻少妇偷人精品九色| 国产成人91sexporn| 尾随美女入室| 久久久久网色| 精品久久久久久电影网| 亚洲成av片中文字幕在线观看 | 黄色视频在线播放观看不卡| 色婷婷av一区二区三区视频| 久久av网站| 久久久久精品性色| 99热网站在线观看| 日本黄色日本黄色录像| 黄色视频在线播放观看不卡| 亚洲av.av天堂| 在线精品无人区一区二区三| 欧美精品亚洲一区二区| 最近最新中文字幕免费大全7| 成年人免费黄色播放视频| 亚洲精品第二区| 日韩中文字幕视频在线看片| 日韩熟女老妇一区二区性免费视频| 麻豆精品久久久久久蜜桃| 午夜激情久久久久久久| 久久久久久久久久人人人人人人| 亚洲精品456在线播放app| 丰满乱子伦码专区| 日本-黄色视频高清免费观看| 熟妇人妻不卡中文字幕|