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

    帶機(jī)械臂的月面巡視探測(cè)器的路徑規(guī)劃方法研究

    2010-01-08 08:32:32李群智申振榮
    航天器工程 2010年5期
    關(guān)鍵詞:柵格機(jī)械關(guān)節(jié)

    李群智 申振榮 張 伍 賈 陽(yáng)

    (北京空間飛行器總體設(shè)計(jì)部,北京 100094)

    1 引言

    月球是人類向外層空間發(fā)展的理想中轉(zhuǎn)基地和前哨站。目前,包括中國(guó)在內(nèi)的世界多個(gè)國(guó)家的研究機(jī)構(gòu)均開展了對(duì)月探測(cè)的研發(fā)工作[1-2]。其中,路徑規(guī)劃的研究[3],作為月面巡視探測(cè)器(簡(jiǎn)稱巡視器)進(jìn)行巡視探測(cè)的前提和基礎(chǔ),直接影響巡視探測(cè)的效率,即影響地面遙操作和巡視器自主運(yùn)行的工作效率,同時(shí),會(huì)影響巡視器的生存安全。因此,開展巡視器路徑規(guī)劃的研究,具有重要的意義和工程實(shí)用價(jià)值。

    經(jīng)研究發(fā)現(xiàn),巡視器在月面進(jìn)行巡視探測(cè),其運(yùn)動(dòng)主要包括移動(dòng)和機(jī)械臂攜帶有效載荷運(yùn)動(dòng)兩個(gè)方面的內(nèi)容[4]。針對(duì)這兩個(gè)方面,本文開展了帶機(jī)械臂的月面巡視探測(cè)器的路徑規(guī)劃方法研究,主要內(nèi)容包括:巡視器移動(dòng)的路徑規(guī)劃(簡(jiǎn)稱巡視器的路徑規(guī)劃)、巡視器機(jī)械臂的路徑規(guī)劃(簡(jiǎn)稱機(jī)械臂的路徑規(guī)劃)、巡視器攜帶機(jī)械臂就位探測(cè)時(shí)巡視器與機(jī)械臂的路徑規(guī)劃(簡(jiǎn)稱器臂動(dòng)態(tài)聯(lián)合的路徑規(guī)劃)。

    2 巡視器的路徑規(guī)劃方法

    巡視器的路徑規(guī)劃方法(Lunar Rover Path Planning M ethod, LRPPM)是指在一個(gè)可視區(qū)域內(nèi),巡視器以某一個(gè)或幾個(gè)因素作為優(yōu)化條件,發(fā)現(xiàn)較優(yōu)行進(jìn)路線的過(guò)程。與地面的自主移動(dòng)機(jī)器人不同,巡視器在完成路徑規(guī)劃的過(guò)程中,只能靠自身的環(huán)境建模和航位推算,而不能借助外部的導(dǎo)航和標(biāo)定系統(tǒng),路徑規(guī)劃過(guò)程具有動(dòng)態(tài)性和不完整性。此外,路徑規(guī)劃還需要考慮能量的限制、巡視器運(yùn)行的安全性和平穩(wěn)性、車體的最小轉(zhuǎn)彎半徑、適宜弧線、越障通過(guò)能力等特殊要求。本文巡視器的路徑規(guī)劃方法涉及到環(huán)境表達(dá)、路徑評(píng)估和路徑搜索。

    針對(duì)月面環(huán)境以非結(jié)構(gòu)化為顯著特征,巡視器的路徑規(guī)劃基于三維數(shù)字高程圖(DEM),采用改進(jìn)的A*算法完成路徑的搜索與擇優(yōu)。

    2.1 環(huán)境表達(dá)

    月面巡視探測(cè)器所在環(huán)境是實(shí)際的物理環(huán)境,而進(jìn)行路徑規(guī)劃需要將物理環(huán)境抽象成為能被計(jì)算機(jī)理解和表達(dá)的環(huán)境模型,稱為環(huán)境建模,即地圖創(chuàng)建(M ap-building)[5]。地圖創(chuàng)建首先要確定環(huán)境地圖的描述方法,即數(shù)字地圖的表示方法,必須便于計(jì)算機(jī)存儲(chǔ)和處理。目前各國(guó)研究者已經(jīng)提出了多種表示方法,常用的環(huán)境建模方法有柵格法、幾何法、C 空間(C-space)法和拓?fù)鋱D等。每種數(shù)字地圖的表示方法都有自己的優(yōu)點(diǎn)和缺點(diǎn),根據(jù)月面巡視探測(cè)器環(huán)境感知的特點(diǎn),一般采用柵格法。

    基于柵格的環(huán)境表示方法最早由Elfes 和M orave 提出[6]。所謂柵格法就是將地形環(huán)境用柵格進(jìn)行覆蓋,每個(gè)柵格的屬性值代表所覆蓋地形的屬性,如高度屬性或區(qū)域?qū)傩?自由空間或障礙物等)。最簡(jiǎn)單的柵格法是將地圖分成大小相同的柵格,這樣地圖就可以用數(shù)組或矩陣表示,數(shù)組的索引號(hào)與柵格在地圖中的位置對(duì)應(yīng),而元素值則與柵格屬性對(duì)應(yīng),形成數(shù)字高程圖(DEM)。

    利用柵格法進(jìn)行環(huán)境建模時(shí),一般規(guī)定只能向其水平和豎直方向的相鄰柵格中心移動(dòng)(稱為4-鄰域移動(dòng))或向其周圍相鄰的八個(gè)柵格中心移動(dòng)(稱為8-鄰域移動(dòng))。柵格法的優(yōu)點(diǎn)包括:柵格法容易創(chuàng)建和維護(hù),便于計(jì)算機(jī)存儲(chǔ)、處理和使用;在路徑搜索時(shí),柵格對(duì)應(yīng)圖的節(jié)點(diǎn),節(jié)點(diǎn)間連通性已經(jīng)暗含在柵格的相鄰性當(dāng)中,便于算法搜索。柵格法的缺點(diǎn)包括:空間效率不高;柵格的大小影響搜索路徑的完備性;4-鄰域或8-鄰域移動(dòng)準(zhǔn)則限制搜索路徑的最優(yōu)性。但是,柵格法的這些缺點(diǎn)可以通過(guò)改進(jìn)搜索算法和進(jìn)行規(guī)劃路徑的后續(xù)處理來(lái)克服。

    因此,本文采用柵格的描述方法來(lái)對(duì)月面環(huán)境進(jìn)行描述,充分考慮巡視器的可通過(guò)性,給不同地形對(duì)應(yīng)的柵格賦予不同的值,并在此基礎(chǔ)上進(jìn)行路徑評(píng)估與路徑搜索。

    2.2 改進(jìn)的A*算法

    路徑規(guī)劃的評(píng)估與搜索是路徑規(guī)劃的核心內(nèi)容。國(guó)外應(yīng)用過(guò)的路徑規(guī)劃搜索算法包括啟發(fā)式搜索(A*)算法研究、幾何搜索算法研究和統(tǒng)計(jì)搜索算法研究等。巡視器路徑規(guī)劃方法根據(jù)不同的原則可以有不同的分類方法,按是否使用智能算法大致可以分為傳統(tǒng)方法和智能方法[7]。根據(jù)工作環(huán)境,路徑規(guī)劃模型可分為全局路徑規(guī)劃和局部路徑規(guī)劃[8]。在巡視探測(cè)器中,使用得比較多的是人工勢(shì)場(chǎng)法、A*算法和動(dòng)態(tài)啟發(fā)式搜索(D*)算法[3]、廣度優(yōu)先(Bug)算法、深度優(yōu)先(ISE)算法等。本文路徑規(guī)劃的方法采用了具有啟發(fā)、智能和全局特性的改進(jìn)的A*算法。

    A*算法使用了啟發(fā)式方法,這種方法通過(guò)充分利用圖給出的信息來(lái)動(dòng)態(tài)地做出決定,使搜索次數(shù)大大降低。它通過(guò)一個(gè)評(píng)估函數(shù)(Heuristic Function)f(n)來(lái)估計(jì)圖中的當(dāng)前點(diǎn)到終點(diǎn)的距離(帶權(quán)值),并由此決定它的搜索方向,當(dāng)這條路徑失敗時(shí),它會(huì)嘗試其它路徑。A*算法成功與否的關(guān)鍵在于評(píng)估函數(shù)的正確選擇。

    A*算法的評(píng)估函數(shù)為

    式中,n 為搜索路徑, f(n)為預(yù)測(cè)的全程移動(dòng)消耗,g(n)為從起點(diǎn)到當(dāng)前點(diǎn)的實(shí)際移動(dòng)消耗,h(n)為當(dāng)前點(diǎn)到終點(diǎn)的移動(dòng)消耗估計(jì)值。

    本文選取只對(duì)目標(biāo)點(diǎn)感興趣的Manhattan 估算函數(shù)作為啟發(fā)因子,以達(dá)到最佳運(yùn)算效率。M anhattan 距離為

    式中,A.x 為當(dāng)前點(diǎn)的x 坐標(biāo)值,A.y 為當(dāng)前點(diǎn)的y 坐標(biāo)值;goal.x 為目標(biāo)點(diǎn)的x 坐標(biāo)值,goal.y為目標(biāo)點(diǎn)的y 坐標(biāo)值;h(A)為當(dāng)前點(diǎn)的Manhattan估計(jì)值。

    由上式可知,M anhattan 估算函數(shù)與當(dāng)前點(diǎn)到目標(biāo)點(diǎn)的x 方向距離絕對(duì)值及y 方向距離絕對(duì)值的和成正比,即具有估算因子的功能,又擁有較高的運(yùn)算效率。然而,巡視器可以在地圖上作斜線方向的運(yùn)動(dòng),故將M ahattan 距離修正為

    此時(shí),路徑會(huì)明顯分為兩個(gè)階段:第一階段,路徑點(diǎn)首先向著靠近目標(biāo)點(diǎn)斜對(duì)角線的方向延伸,當(dāng)規(guī)劃的路徑走到與目標(biāo)點(diǎn)斜對(duì)角時(shí),路徑走向進(jìn)入第二階段;第二階段,路徑點(diǎn)以斜向移動(dòng)快速靠近目標(biāo)點(diǎn),這種方法相對(duì)于鋸齒狀移動(dòng)的路徑,消耗大為減少。

    此外,本文在A*算法的處理上還做了兩個(gè)方面的修正。首先,對(duì)自排序鏈表的構(gòu)建進(jìn)行了優(yōu)化,即open 列表在組建時(shí)根據(jù)f 值大小進(jìn)行排序, f 值小的排在表頭處,使得插入點(diǎn)的排序工作僅在表尾幾個(gè)節(jié)點(diǎn)進(jìn)行,甚至可能不需要移動(dòng)任何節(jié)點(diǎn)直接將新節(jié)點(diǎn)排在表頭,不僅節(jié)省了運(yùn)算時(shí)間,還有利于保留曾經(jīng)走過(guò)的路徑信息。其次,在尋路結(jié)束之后,在返回規(guī)劃路徑之前對(duì)路徑鏈表進(jìn)行了優(yōu)化處理,通過(guò)兩個(gè)指針從路徑鏈表的兩端向另一端遍歷,尋找出路徑鏈表中的迂回路徑,并切除多余部分的路徑節(jié)點(diǎn)。算法的流程圖如圖1 所示??傊?改進(jìn)的A*算法不僅考慮了距離和柵格的可通過(guò)性,還提高了路徑規(guī)劃的效率,適合用于非結(jié)構(gòu)化月面柵格地圖上的路徑規(guī)劃。

    2.3 仿真驗(yàn)證

    圖1 算法流程圖Fig.1 Flow chart of arithmetic

    采用改進(jìn)的A*算法,在構(gòu)建的柵格月面地圖上進(jìn)行路徑規(guī)劃, 如圖2 所示。已知單位柵格為10mm ×10mm, 路徑的起始點(diǎn)坐標(biāo)為(140mm,930mm),目標(biāo)點(diǎn)坐標(biāo)為(910mm ,150mm),則路徑搜索過(guò)程耗時(shí)1.293s,路徑長(zhǎng)度為1 381.5mm,滿足巡視器的路徑規(guī)劃的需求。

    圖2 采用改進(jìn)A*算法的路徑規(guī)劃Fig.2 Path planning using improved A*arithmetic

    3 機(jī)械臂的路徑規(guī)劃方法

    機(jī)械臂的路徑規(guī)劃方法(Manipulator Path Planning Method,MPPM)與巡視器的路徑規(guī)劃方法有著本質(zhì)的不同,巡視器的路徑規(guī)劃受限于地形地貌和巡視器的行駛性能;而機(jī)械臂的規(guī)劃過(guò)程受外界的影響一般僅是碰撞檢測(cè)方面,其余則受限于自身的特性,如工作空間、臂長(zhǎng)和構(gòu)型設(shè)計(jì)的影響等。

    機(jī)械臂的路徑規(guī)劃M PPM,首先在機(jī)械臂Denavit-Harterberg(D-H)建模的基礎(chǔ)上,采用蒙特卡羅法求得機(jī)械臂的可達(dá)工作空間,然后規(guī)劃得出機(jī)械臂工作空間內(nèi)的路徑點(diǎn),最后通過(guò)運(yùn)動(dòng)學(xué)逆解計(jì)算和關(guān)節(jié)插值,得到機(jī)械臂的運(yùn)動(dòng)路徑。

    3.1 機(jī)械臂D-H 建模

    巡視器機(jī)械臂簡(jiǎn)化模型如圖3a 所示,由三個(gè)關(guān)節(jié)組成。其中,a1=110mm ,指關(guān)節(jié)1 與關(guān)節(jié)2 軸線之間的距離;a2=350mm,指關(guān)節(jié)2 與關(guān)節(jié)3 軸線之間的距離;a3=110mm,指有效載荷末端到關(guān)節(jié)3 軸線的距離。

    圖3 機(jī)械臂建模Fig.3 Model of the manipulato r

    根據(jù)D-H 坐標(biāo)系建立法則,建立機(jī)械臂的DH 模型,如圖3b 所示。其中,Z1指關(guān)節(jié)1 的轉(zhuǎn)動(dòng)軸線,Z2指關(guān)節(jié)2 的轉(zhuǎn)動(dòng)軸線,Z3指關(guān)節(jié)3 的轉(zhuǎn)動(dòng)軸線,Z 4 的坐標(biāo)原點(diǎn)位于有效載荷末端面的中心。機(jī)械臂模型的D-H 參數(shù)如表1 所示。

    表1 D-H參數(shù)表Table 1 D-H parameter

    由機(jī)械臂模型的D-H 參數(shù),求機(jī)械臂末端點(diǎn)在x,y,z 坐標(biāo)系下的位置參數(shù)方程為

    3.2 機(jī)械臂可達(dá)工作空間分析

    機(jī)械臂工作空間的求解采用蒙特卡羅法[9]。蒙特卡羅法是一種基于“隨機(jī)數(shù)”的計(jì)算方法,屬于概率統(tǒng)計(jì)方法的一種,同時(shí)也具有一般數(shù)值方法的優(yōu)越性。求解機(jī)械臂的工作空間時(shí),對(duì)關(guān)節(jié)變量通過(guò)均勻分布,賦予一定數(shù)量的、符合關(guān)節(jié)變化要求的隨機(jī)量,從而得到工作空間由隨機(jī)點(diǎn)構(gòu)成的圖形,稱之為“云圖”,這樣就構(gòu)成了機(jī)械臂的可達(dá)工作空間。求解方法的程序流程圖,如圖4 所示。

    圖4 蒙特卡羅方法求解工作空間的程序流程圖Fig.4 Flow chart of finding workspace using Monte Carlo method

    根據(jù)D-H 參數(shù),考慮機(jī)械臂的關(guān)節(jié)空間約束,使用式(4)~(6),采用蒙特卡羅法,對(duì)機(jī)械臂進(jìn)行工作空間分析,確定機(jī)械臂的可達(dá)工作空間如圖5 所示。由圖5 可以看出,三自由度機(jī)械臂的構(gòu)型對(duì)應(yīng)的可達(dá)工作空間為一個(gè)帶半球空腔的半球體,機(jī)械臂與其可達(dá)工作空間的關(guān)系如圖5 a 所示,可達(dá)工作空間的兩個(gè)方向的視圖如圖5 b、c 所示。

    圖5 機(jī)械臂的可達(dá)工作空間Fig.5 Reachable w orkspace of the manipulator

    3.3 機(jī)械臂的路徑規(guī)劃

    在機(jī)械臂的工作空間內(nèi),根據(jù)機(jī)械臂的起始點(diǎn)和目標(biāo)點(diǎn),確定多個(gè)路徑段,每個(gè)路徑段用小直線段表示。

    首先,通過(guò)運(yùn)動(dòng)學(xué)反解計(jì)算,得出每個(gè)路徑段內(nèi)每個(gè)關(guān)節(jié)需要運(yùn)動(dòng)的范圍,設(shè)起始關(guān)節(jié)角度為θ0,終止關(guān)節(jié)角度為θf(wàn)。

    然后,使用關(guān)節(jié)插值計(jì)算,本文采用三次多項(xiàng)式插值,可以得出機(jī)械臂的運(yùn)動(dòng)路徑(軌跡)。

    每個(gè)關(guān)節(jié)的運(yùn)動(dòng)軌跡為

    運(yùn)動(dòng)軌跡上關(guān)節(jié)的角速度為

    運(yùn)動(dòng)軌跡上關(guān)節(jié)的角加速度為

    其中,t 為運(yùn)動(dòng)軌道的時(shí)間變量, a0=θ0,a1=

    這種機(jī)械臂的路徑規(guī)劃的方法比較簡(jiǎn)單、直觀,是在計(jì)算出機(jī)械臂的工作空間的基礎(chǔ)上,人為確定路徑點(diǎn),然后通過(guò)機(jī)械臂運(yùn)動(dòng)學(xué)計(jì)算最終得出其運(yùn)動(dòng)路徑。此外,可以通過(guò)碰撞檢測(cè),由機(jī)械臂自主確定路徑點(diǎn),完成整個(gè)路徑規(guī)劃過(guò)程。但是,碰撞檢測(cè)的設(shè)置需要機(jī)械臂所處外部環(huán)境的精確建模和機(jī)械臂本體與外部環(huán)境的接觸判斷,受多方面因素的限制,相對(duì)復(fù)雜,在一定程度上會(huì)影響機(jī)械臂的探測(cè)效率,故暫不采用。

    4 器臂動(dòng)態(tài)聯(lián)合的路徑規(guī)劃方法

    巡視器攜帶機(jī)械臂就位探測(cè)時(shí)器臂動(dòng)態(tài)聯(lián)合的路徑規(guī)劃方法(Rover-M anipulator Path Planning M ethod,RM PPM),將上述巡視器和機(jī)械臂的路徑規(guī)劃結(jié)合起來(lái),巡視器路徑規(guī)劃的目標(biāo)點(diǎn)和巡視器于目標(biāo)點(diǎn)的探測(cè)姿態(tài),將作為機(jī)械臂路徑規(guī)劃的初始點(diǎn)和初始姿態(tài),如圖6 所示。整個(gè)規(guī)劃過(guò)程描述如下:

    首先,確定巡視器路徑規(guī)劃的目標(biāo)點(diǎn)和巡視器于目標(biāo)點(diǎn)的探測(cè)姿態(tài),使機(jī)械臂末端點(diǎn)和探測(cè)目標(biāo)點(diǎn)均處于機(jī)械臂的工作空間范圍內(nèi),如圖6 中石塊6 處的放大圖部分所示;

    其次,采用改進(jìn)的A*算法,在三維柵格數(shù)字高程地形圖上,進(jìn)行巡視器路徑規(guī)劃,得出較優(yōu)的巡視器規(guī)劃路徑,其中,巡視器初始點(diǎn)根據(jù)柵格地形確定,目標(biāo)點(diǎn)為上一步確定的巡視器路徑規(guī)劃的目標(biāo)點(diǎn);

    再次,于目標(biāo)點(diǎn)調(diào)整巡視器到探測(cè)姿態(tài),在調(diào)整過(guò)程中,有巡視器最佳探測(cè)方向的判斷,需要精確的求解機(jī)械臂的可達(dá)工作空間,使機(jī)械臂末端點(diǎn)和探測(cè)目標(biāo)點(diǎn)均處于機(jī)械臂的工作空間范圍內(nèi),同時(shí)保證巡視器處于最穩(wěn)定的狀態(tài),以免機(jī)械臂探測(cè)時(shí)巡視器出現(xiàn)滑動(dòng)、傾斜等問(wèn)題;

    最后,在機(jī)械臂的工作空間內(nèi),確定機(jī)械臂的路徑點(diǎn),用小直線段連接,通過(guò)運(yùn)動(dòng)學(xué)反解計(jì)算和三次多項(xiàng)式插值計(jì)算,得出機(jī)械臂的規(guī)劃路徑。

    整個(gè)路徑規(guī)劃過(guò)程之所以稱為動(dòng)態(tài)聯(lián)合,是因?yàn)槭芊墙Y(jié)構(gòu)化月面地形的影響,巡視器于目標(biāo)點(diǎn)的位姿與初始規(guī)劃的位姿一般會(huì)有較大的偏差,需要根據(jù)遙測(cè)信息進(jìn)行修正,才能作為機(jī)械臂路徑規(guī)劃的輸入。

    圖6 器臂動(dòng)態(tài)聯(lián)合的路徑規(guī)劃示意圖Fig.6 Sketch map of Rover-Manipulator Path Planning

    5 結(jié)論

    綜上所述,巡視器的路徑規(guī)劃有兩種:一種是針對(duì)移動(dòng)的巡視器的路徑規(guī)劃方法(LRPPM),一種是針對(duì)機(jī)械臂的路徑規(guī)劃方法(M PPM),兩種結(jié)合起來(lái)(RMPPM),才能夠完成就位探測(cè)。因此,帶機(jī)械臂的月面巡視探測(cè)器的路徑規(guī)劃方法的研究?jī)?nèi)容,不僅包括巡視器的路徑規(guī)劃和機(jī)械臂的路徑規(guī)劃,還需要完成巡視器攜帶機(jī)械臂就位探測(cè)時(shí)器臂動(dòng)態(tài)聯(lián)合的路徑規(guī)劃。

    帶機(jī)械臂的月面巡視探測(cè)器的路徑規(guī)劃方法的特點(diǎn)歸納總結(jié)如下:

    1)巡視器的路徑規(guī)劃過(guò)程具有動(dòng)態(tài)性和不完整性。規(guī)劃方法基于月面三維數(shù)字高程圖(DEM),采用改進(jìn)的A*算法完成路徑的搜索與擇優(yōu)。

    2)機(jī)械臂的路徑規(guī)劃僅在自己的可達(dá)工作空間內(nèi)進(jìn)行,需要針對(duì)障礙進(jìn)行碰撞檢測(cè)。規(guī)劃方法基于D-H 建模,采用蒙特卡羅法求得機(jī)械臂的可達(dá)工作空間,然后人為輔助通過(guò)運(yùn)動(dòng)學(xué)反解計(jì)算和三次多項(xiàng)式插值計(jì)算,規(guī)劃得出機(jī)械臂工作空間內(nèi)的運(yùn)動(dòng)路徑。

    3)巡視器攜帶機(jī)械臂完成就位探測(cè)的過(guò)程,需要上述兩種規(guī)劃的動(dòng)態(tài)聯(lián)合。實(shí)際過(guò)程中,還需要地面操作人員的參與,尤其是機(jī)械臂初始方位的輸入和機(jī)械臂到位的判斷。

    )

    [1]葉培建,孫澤洲,饒煒.嫦娥一號(hào)月球探測(cè)衛(wèi)星研制綜述[J].航天器工程, 2007, 16(6):9-15

    [2]Huntsville, Alabama.A brief history of the lunar roving vehicle[R].NASA Marshall Space Flght Center, 2002:3

    [3]Joseph Carsten, Arturo Rankin, et al.Global path planning on board the Mars exploration rovers[C]//Aerospace Conference 2007, IEEE, Big sky, MT,2007:1-11

    [4]Tunstel E, M aimone M, Trebi O A, et al.Mars exploration rover mobility and robotic arm operational performance[C]// System, M an and Cybernetics, 2005 Internationl Conference on IEEE, 2005:1807 -1814

    [5]席裕庚, 陳衛(wèi)東, 王衛(wèi)華.基于不確定信息的移動(dòng)機(jī)器人地圖創(chuàng)建研究進(jìn)展[J].機(jī)器人, 2001,23(6):563-568

    [6]Kambhampati S, Davis L S.M ultiresolution path planning for mobile robot[J].IEEE Journal of Robotics and Automation, 1986, RA2(3):135-145

    [7]張穎,吳成東, 原寶龍.機(jī)器人路徑規(guī)劃方法綜述[J].控制工程, 2003, 5(10):152-155

    [8]Sanjiv Singh, Reid Simmons, T rey Smith, et al.Recent progress in local and global traversability for planetary rovers[C]// IEEE International Conference on Robotics and Automation.San Francisco, 2000, 4:1-7

    [9]Denavit J, Hartenberg R S.A kinematic notation for lower-pair mechanism s based on matices[J].T rans.ASME, J of Applied Mechanics, 1955, 77(6):215-221

    [10]張孝澤.蒙特卡羅方法在統(tǒng)計(jì)物理中的應(yīng)用[M].鄭州:河南科學(xué)技術(shù)出版社,1991

    猜你喜歡
    柵格機(jī)械關(guān)節(jié)
    基于鄰域柵格篩選的點(diǎn)云邊緣點(diǎn)提取方法*
    調(diào)試機(jī)械臂
    簡(jiǎn)單機(jī)械
    用跟骨解剖鋼板內(nèi)固定術(shù)治療跟骨骨折合并跟距關(guān)節(jié)及跟骰關(guān)節(jié)損傷的效果探討
    機(jī)械班長(zhǎng)
    按摩機(jī)械臂
    miRNA-140、MMP-3在OA關(guān)節(jié)滑液中的表達(dá)及相關(guān)性研究
    不同剖面形狀的柵格壁對(duì)柵格翼氣動(dòng)特性的影響
    給手指“松關(guān)節(jié)”為何會(huì)發(fā)出聲響
    骨折后關(guān)節(jié)僵硬的護(hù)理
    少妇熟女欧美另类| 一区二区三区高清视频在线| 日日撸夜夜添| 99国产精品一区二区蜜桃av| 久久久国产成人精品二区| 中文字幕久久专区| 九草在线视频观看| 婷婷色综合大香蕉| 91在线精品国自产拍蜜月| 人妻系列 视频| 夜夜爽夜夜爽视频| 人妻夜夜爽99麻豆av| 美女国产视频在线观看| 插阴视频在线观看视频| 午夜久久久久精精品| 亚洲av二区三区四区| 黄片wwwwww| 少妇裸体淫交视频免费看高清| 卡戴珊不雅视频在线播放| 男人狂女人下面高潮的视频| 人妻制服诱惑在线中文字幕| 欧美bdsm另类| 91久久精品国产一区二区成人| 国产精品嫩草影院av在线观看| 晚上一个人看的免费电影| 国产午夜精品论理片| 婷婷色麻豆天堂久久 | 亚洲人成网站高清观看| 日本黄色视频三级网站网址| 精品午夜福利在线看| 久久久久九九精品影院| 天堂网av新在线| 九九在线视频观看精品| 国产私拍福利视频在线观看| 大香蕉97超碰在线| 国产日韩欧美在线精品| 午夜福利在线在线| 国产不卡一卡二| 一个人免费在线观看电影| 人妻系列 视频| 国产亚洲精品av在线| 在线观看av片永久免费下载| 成人特级av手机在线观看| 简卡轻食公司| 91精品一卡2卡3卡4卡| 国产乱人视频| 欧美一区二区亚洲| 国产视频内射| 免费看光身美女| 美女大奶头视频| 视频中文字幕在线观看| 国产精品伦人一区二区| 99久久九九国产精品国产免费| 婷婷色麻豆天堂久久 | 亚洲精华国产精华液的使用体验| 日日啪夜夜撸| 日本av手机在线免费观看| 婷婷色av中文字幕| 欧美不卡视频在线免费观看| 久久久久久久久大av| 97热精品久久久久久| 久久精品国产亚洲av天美| 免费无遮挡裸体视频| 午夜a级毛片| 91精品伊人久久大香线蕉| 内地一区二区视频在线| 国产av码专区亚洲av| 国产精品,欧美在线| 一区二区三区免费毛片| 亚洲人成网站高清观看| 麻豆久久精品国产亚洲av| 长腿黑丝高跟| 国产视频内射| 亚洲成色77777| 亚洲国产精品专区欧美| 国产片特级美女逼逼视频| 啦啦啦观看免费观看视频高清| 欧美日韩一区二区视频在线观看视频在线 | 亚洲一区高清亚洲精品| 伦精品一区二区三区| 国产真实伦视频高清在线观看| 舔av片在线| 色视频www国产| 亚洲无线观看免费| 午夜a级毛片| videossex国产| videos熟女内射| av.在线天堂| 国产成年人精品一区二区| 国产精品嫩草影院av在线观看| 男女那种视频在线观看| 亚洲激情五月婷婷啪啪| 亚洲欧美日韩卡通动漫| 国产乱人偷精品视频| 亚洲中文字幕日韩| 久久久精品94久久精品| 晚上一个人看的免费电影| 看十八女毛片水多多多| 色吧在线观看| 三级毛片av免费| 久久久久免费精品人妻一区二区| 哪个播放器可以免费观看大片| 听说在线观看完整版免费高清| 免费黄色在线免费观看| 精品酒店卫生间| 久久婷婷人人爽人人干人人爱| 91久久精品国产一区二区成人| 一卡2卡三卡四卡精品乱码亚洲| 国产伦理片在线播放av一区| 国产精品av视频在线免费观看| 亚洲国产精品成人综合色| 国产精品永久免费网站| 男的添女的下面高潮视频| 久久久精品94久久精品| 九九爱精品视频在线观看| 高清午夜精品一区二区三区| 舔av片在线| 国产精品久久久久久久久免| 久久精品91蜜桃| 久久人人爽人人爽人人片va| 久久精品夜色国产| 白带黄色成豆腐渣| 精品久久久久久久久av| 女的被弄到高潮叫床怎么办| 亚洲中文字幕一区二区三区有码在线看| 国产私拍福利视频在线观看| 非洲黑人性xxxx精品又粗又长| 97超碰精品成人国产| 日韩欧美精品v在线| 卡戴珊不雅视频在线播放| 国产又黄又爽又无遮挡在线| 日日啪夜夜撸| 午夜老司机福利剧场| 欧美97在线视频| 久久欧美精品欧美久久欧美| 国产精品久久视频播放| 99久久精品一区二区三区| 国产精品福利在线免费观看| 久久久久九九精品影院| 高清视频免费观看一区二区 | 岛国在线免费视频观看| 夜夜爽夜夜爽视频| 婷婷色综合大香蕉| 国产人妻一区二区三区在| 国产午夜精品论理片| 日韩精品有码人妻一区| 国产精品美女特级片免费视频播放器| 久久久久久久久久成人| 国产成人免费观看mmmm| 久99久视频精品免费| 亚洲国产日韩欧美精品在线观看| 午夜a级毛片| 久久国内精品自在自线图片| 搞女人的毛片| 国产男人的电影天堂91| 特大巨黑吊av在线直播| 久久久久久九九精品二区国产| 噜噜噜噜噜久久久久久91| 18禁动态无遮挡网站| 熟女电影av网| 日本免费a在线| 久久精品国产亚洲av天美| 我的老师免费观看完整版| av在线天堂中文字幕| 国产91av在线免费观看| 日韩精品青青久久久久久| 精品免费久久久久久久清纯| 免费观看精品视频网站| 日日啪夜夜撸| 18禁裸乳无遮挡免费网站照片| 国产精品麻豆人妻色哟哟久久 | 色哟哟·www| 国产一级毛片在线| 一区二区三区高清视频在线| 免费搜索国产男女视频| 精品国内亚洲2022精品成人| 黄片无遮挡物在线观看| 99在线视频只有这里精品首页| a级一级毛片免费在线观看| 黄片wwwwww| 国产精品嫩草影院av在线观看| 国产在线男女| 男人舔女人下体高潮全视频| 三级毛片av免费| 亚洲色图av天堂| 又粗又硬又长又爽又黄的视频| 非洲黑人性xxxx精品又粗又长| 国产精品人妻久久久久久| 夜夜看夜夜爽夜夜摸| 亚洲欧美一区二区三区国产| 国产日韩欧美在线精品| 大话2 男鬼变身卡| 中文亚洲av片在线观看爽| 97超视频在线观看视频| 两个人视频免费观看高清| 精品人妻熟女av久视频| 看片在线看免费视频| 男女啪啪激烈高潮av片| 国产视频首页在线观看| 水蜜桃什么品种好| 又爽又黄a免费视频| 99视频精品全部免费 在线| 日本午夜av视频| 免费搜索国产男女视频| 久久韩国三级中文字幕| 免费看av在线观看网站| 黄色配什么色好看| 亚洲中文字幕一区二区三区有码在线看| 少妇被粗大猛烈的视频| 91在线精品国自产拍蜜月| 亚洲欧美一区二区三区国产| 国产激情偷乱视频一区二区| 男女啪啪激烈高潮av片| 色综合站精品国产| 久99久视频精品免费| 成人欧美大片| 成人毛片60女人毛片免费| 欧美精品国产亚洲| 亚洲四区av| 久久久a久久爽久久v久久| .国产精品久久| 亚洲美女视频黄频| 欧美成人a在线观看| 国产精品一二三区在线看| 伦精品一区二区三区| 五月伊人婷婷丁香| 免费观看性生交大片5| 久热久热在线精品观看| 国产精品人妻久久久久久| 国产三级在线视频| 人妻少妇偷人精品九色| 全区人妻精品视频| 国产成人a∨麻豆精品| 亚洲av中文字字幕乱码综合| 亚洲精品色激情综合| 国产精品蜜桃在线观看| av在线观看视频网站免费| 丝袜美腿在线中文| 中文在线观看免费www的网站| 国产免费福利视频在线观看| 综合色丁香网| 非洲黑人性xxxx精品又粗又长| 欧美成人精品欧美一级黄| 国产精品女同一区二区软件| 欧美另类亚洲清纯唯美| 国产精品国产高清国产av| 亚洲av男天堂| av女优亚洲男人天堂| 中文字幕av在线有码专区| 少妇人妻一区二区三区视频| 18禁裸乳无遮挡免费网站照片| 免费黄网站久久成人精品| 欧美不卡视频在线免费观看| 99热网站在线观看| 亚洲成人久久爱视频| 国产成人午夜福利电影在线观看| 2021天堂中文幕一二区在线观| 嫩草影院新地址| 日本三级黄在线观看| 老司机影院毛片| 草草在线视频免费看| 国模一区二区三区四区视频| 成人美女网站在线观看视频| 国内少妇人妻偷人精品xxx网站| 中文精品一卡2卡3卡4更新| 2021少妇久久久久久久久久久| 国产久久久一区二区三区| 亚洲经典国产精华液单| www.色视频.com| 国产在视频线精品| 欧美一级a爱片免费观看看| 国产免费一级a男人的天堂| 99在线人妻在线中文字幕| 非洲黑人性xxxx精品又粗又长| 久久久欧美国产精品| 少妇人妻一区二区三区视频| 亚洲五月天丁香| 精品人妻一区二区三区麻豆| 国产精品一区二区性色av| 中国国产av一级| 中文字幕免费在线视频6| 一级黄色大片毛片| 国产欧美另类精品又又久久亚洲欧美| 麻豆av噜噜一区二区三区| 国产免费福利视频在线观看| 一个人免费在线观看电影| a级一级毛片免费在线观看| 美女黄网站色视频| 中文字幕免费在线视频6| 只有这里有精品99| 免费在线观看成人毛片| 亚洲激情五月婷婷啪啪| 最近2019中文字幕mv第一页| 亚洲精品aⅴ在线观看| 一边摸一边抽搐一进一小说| 波野结衣二区三区在线| 搡老妇女老女人老熟妇| 伦精品一区二区三区| 淫秽高清视频在线观看| 亚洲人成网站在线观看播放| 国产亚洲午夜精品一区二区久久 | 观看美女的网站| 看片在线看免费视频| 99久久中文字幕三级久久日本| 免费看日本二区| 国产乱人视频| 国产片特级美女逼逼视频| 中文亚洲av片在线观看爽| 久久韩国三级中文字幕| 99热这里只有是精品在线观看| 寂寞人妻少妇视频99o| 最后的刺客免费高清国语| 看免费成人av毛片| or卡值多少钱| 亚洲丝袜综合中文字幕| 美女黄网站色视频| 国产91av在线免费观看| 九九在线视频观看精品| av免费观看日本| 自拍偷自拍亚洲精品老妇| 91在线精品国自产拍蜜月| 尤物成人国产欧美一区二区三区| 女人久久www免费人成看片 | 美女cb高潮喷水在线观看| 成人午夜精彩视频在线观看| 又粗又爽又猛毛片免费看| 精品免费久久久久久久清纯| 亚洲美女搞黄在线观看| 欧美三级亚洲精品| 男女国产视频网站| 欧美高清性xxxxhd video| 国产精品久久久久久久电影| 国产精品日韩av在线免费观看| 国产精品美女特级片免费视频播放器| 97超碰精品成人国产| 亚洲怡红院男人天堂| 最近2019中文字幕mv第一页| 欧美不卡视频在线免费观看| 亚洲国产欧美在线一区| 国产精品国产三级国产专区5o | 两个人视频免费观看高清| 日韩在线高清观看一区二区三区| 又粗又硬又长又爽又黄的视频| 国产乱人偷精品视频| 免费播放大片免费观看视频在线观看 | 国产精品麻豆人妻色哟哟久久 | 六月丁香七月| 一个人看的www免费观看视频| 久久综合国产亚洲精品| 亚洲,欧美,日韩| 久久久精品欧美日韩精品| 成人欧美大片| 男女边吃奶边做爰视频| 中文字幕av在线有码专区| 一级毛片电影观看 | 亚洲国产精品专区欧美| videos熟女内射| 亚洲av.av天堂| 在线播放国产精品三级| 亚洲av.av天堂| av黄色大香蕉| 亚洲18禁久久av| 日本一本二区三区精品| 亚洲一级一片aⅴ在线观看| 国产亚洲一区二区精品| 国产高清不卡午夜福利| 精品少妇黑人巨大在线播放 | 日本免费a在线| 午夜精品国产一区二区电影 | 日日撸夜夜添| 国产老妇伦熟女老妇高清| 亚洲在久久综合| 国产成人精品婷婷| 午夜福利成人在线免费观看| 午夜福利网站1000一区二区三区| 亚洲av电影在线观看一区二区三区 | 亚洲中文字幕一区二区三区有码在线看| 国产成人精品婷婷| 老司机福利观看| 91午夜精品亚洲一区二区三区| 免费观看性生交大片5| 成人欧美大片| 精品一区二区免费观看| 免费看av在线观看网站| 成人毛片60女人毛片免费| 欧美xxxx黑人xx丫x性爽| 亚洲国产日韩欧美精品在线观看| 菩萨蛮人人尽说江南好唐韦庄 | 亚洲av中文字字幕乱码综合| or卡值多少钱| 精品少妇黑人巨大在线播放 | 欧美区成人在线视频| 成人无遮挡网站| 日本免费在线观看一区| 麻豆成人午夜福利视频| 久久久亚洲精品成人影院| 午夜激情福利司机影院| 精品人妻视频免费看| 免费看日本二区| 久久精品国产自在天天线| 亚洲国产成人一精品久久久| 免费av毛片视频| 男女那种视频在线观看| 国产亚洲午夜精品一区二区久久 | 天堂影院成人在线观看| 97超视频在线观看视频| 啦啦啦韩国在线观看视频| 国产国拍精品亚洲av在线观看| 亚洲人成网站高清观看| 一边亲一边摸免费视频| 欧美高清成人免费视频www| 超碰av人人做人人爽久久| 内射极品少妇av片p| 日日摸夜夜添夜夜爱| 国产精品一区二区在线观看99 | 午夜爱爱视频在线播放| 精品人妻偷拍中文字幕| 青春草国产在线视频| av在线观看视频网站免费| 干丝袜人妻中文字幕| 黄片wwwwww| 别揉我奶头 嗯啊视频| 日韩制服骚丝袜av| 夜夜爽夜夜爽视频| 成人特级av手机在线观看| 国产伦在线观看视频一区| 狠狠狠狠99中文字幕| 人妻制服诱惑在线中文字幕| 丰满少妇做爰视频| 亚洲av日韩在线播放| av女优亚洲男人天堂| 波多野结衣高清无吗| 女人被狂操c到高潮| 日本午夜av视频| 久久久久久久久久久丰满| 亚州av有码| av专区在线播放| 国产高清国产精品国产三级 | 成人午夜高清在线视频| 在线观看66精品国产| 毛片女人毛片| 日产精品乱码卡一卡2卡三| 久热久热在线精品观看| 国产成人免费观看mmmm| 99热精品在线国产| 久久久精品欧美日韩精品| 内射极品少妇av片p| av卡一久久| 午夜福利在线观看免费完整高清在| 成年版毛片免费区| 午夜老司机福利剧场| 精品一区二区三区人妻视频| 国产视频内射| 成人国产麻豆网| 亚洲人成网站高清观看| 国产精品爽爽va在线观看网站| 色5月婷婷丁香| 色播亚洲综合网| 九九在线视频观看精品| 亚洲人与动物交配视频| 黄片wwwwww| 国产综合懂色| 丰满乱子伦码专区| 国产精品国产高清国产av| 性色avwww在线观看| 最近视频中文字幕2019在线8| 国产亚洲精品av在线| 欧美zozozo另类| 日本免费在线观看一区| 99热全是精品| 搡女人真爽免费视频火全软件| 乱码一卡2卡4卡精品| 有码 亚洲区| 精品少妇黑人巨大在线播放 | 欧美变态另类bdsm刘玥| 成人国产麻豆网| 少妇的逼好多水| 国产久久久一区二区三区| 欧美又色又爽又黄视频| 国产精品熟女久久久久浪| 伦理电影大哥的女人| 一夜夜www| 欧美+日韩+精品| 久久久久久大精品| 精品久久久久久久人妻蜜臀av| 久久婷婷人人爽人人干人人爱| 啦啦啦啦在线视频资源| 久久欧美精品欧美久久欧美| 日韩 亚洲 欧美在线| 亚洲精品aⅴ在线观看| 老司机影院成人| 在线天堂最新版资源| 18禁裸乳无遮挡免费网站照片| 亚洲欧美日韩东京热| 观看美女的网站| 国产成人freesex在线| 国产黄色小视频在线观看| 日韩成人伦理影院| 国产精品女同一区二区软件| 尾随美女入室| 天美传媒精品一区二区| 亚洲无线观看免费| 99九九线精品视频在线观看视频| 亚洲三级黄色毛片| 91久久精品国产一区二区三区| 欧美+日韩+精品| 一区二区三区乱码不卡18| 日韩精品青青久久久久久| 午夜福利成人在线免费观看| 天堂√8在线中文| 国产探花极品一区二区| 国产精品嫩草影院av在线观看| 午夜福利在线在线| 日本三级黄在线观看| 久久久久久国产a免费观看| 九草在线视频观看| 1024手机看黄色片| 久久国产乱子免费精品| 日韩视频在线欧美| 久久精品久久精品一区二区三区| 亚洲国产高清在线一区二区三| 国产精品美女特级片免费视频播放器| 国产 一区精品| 久久久a久久爽久久v久久| 18禁在线播放成人免费| 插逼视频在线观看| 狂野欧美白嫩少妇大欣赏| 热99在线观看视频| 国产午夜精品一二区理论片| 毛片一级片免费看久久久久| 久久精品人妻少妇| 直男gayav资源| 九九热线精品视视频播放| 免费无遮挡裸体视频| 乱系列少妇在线播放| 热99在线观看视频| 欧美高清成人免费视频www| 一区二区三区免费毛片| 亚洲真实伦在线观看| 天堂影院成人在线观看| 深爱激情五月婷婷| 日本-黄色视频高清免费观看| 人妻系列 视频| 99久久中文字幕三级久久日本| a级一级毛片免费在线观看| 天天躁日日操中文字幕| 亚洲精品亚洲一区二区| 精品久久久久久久久久久久久| 麻豆国产97在线/欧美| 三级经典国产精品| 国产中年淑女户外野战色| 亚洲av.av天堂| 亚洲国产日韩欧美精品在线观看| 国产精品久久视频播放| 蜜臀久久99精品久久宅男| videos熟女内射| 少妇裸体淫交视频免费看高清| 欧美区成人在线视频| 啦啦啦啦在线视频资源| 国产精品一区二区三区四区久久| 久久久久久久久久成人| 亚洲国产色片| 久久这里只有精品中国| 在线播放无遮挡| 国产精华一区二区三区| 日本午夜av视频| 国产精品野战在线观看| 亚洲五月天丁香| 日本与韩国留学比较| 久久久精品大字幕| 少妇猛男粗大的猛烈进出视频 | 久久这里有精品视频免费| 18禁在线无遮挡免费观看视频| 亚洲精品aⅴ在线观看| 亚洲美女搞黄在线观看| 狂野欧美激情性xxxx在线观看| 网址你懂的国产日韩在线| 一级黄片播放器| 免费电影在线观看免费观看| 赤兔流量卡办理| 亚洲欧美清纯卡通| 精品久久久久久久久亚洲| 免费一级毛片在线播放高清视频| 一个人免费在线观看电影| 黄色日韩在线| 国产精品久久久久久精品电影小说 | 男女下面进入的视频免费午夜| 国产色婷婷99| 亚洲五月天丁香| 人人妻人人澡欧美一区二区| 午夜精品一区二区三区免费看| 天美传媒精品一区二区| 在线观看av片永久免费下载| 久久精品国产鲁丝片午夜精品| 九九热线精品视视频播放| 中文亚洲av片在线观看爽| 成人二区视频| 欧美一区二区国产精品久久精品| 一个人看的www免费观看视频| 最近的中文字幕免费完整| 99久久精品热视频| 欧美人与善性xxx| 国产美女午夜福利| 国产私拍福利视频在线观看| 亚洲欧美日韩东京热| 精品人妻熟女av久视频| 国产私拍福利视频在线观看| 久久鲁丝午夜福利片| 在线免费观看不下载黄p国产| 久久久久久久久大av| 久久久久久久久久成人| 久99久视频精品免费| 七月丁香在线播放| 国内精品一区二区在线观看| 久久久久性生活片|