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

    履帶式移動機(jī)器人自主跟隨算法研究

    2017-07-03 14:58:24蔣建東李聰聰章恩光
    關(guān)鍵詞:折線移動機(jī)器人航向

    蔣建東,張 鈞,李聰聰,章恩光

    (浙江工業(yè)大學(xué) 特種裝備制造與先進(jìn)加工技術(shù)教育部重點實驗室,浙江 杭州 310014)

    履帶式移動機(jī)器人自主跟隨算法研究

    蔣建東,張 鈞,李聰聰,章恩光

    (浙江工業(yè)大學(xué) 特種裝備制造與先進(jìn)加工技術(shù)教育部重點實驗室,浙江 杭州 310014)

    基于履帶式移動機(jī)器人自主跟隨控制平臺,研究并設(shè)計了一種履帶式農(nóng)業(yè)機(jī)械自主跟隨控制系統(tǒng).結(jié)合神經(jīng)模糊控制(ANFIS)思想,提出一種自適應(yīng)前視距離自主跟隨算法,并進(jìn)行了履帶式移動機(jī)器人的運動學(xué)求解并建立其純追蹤模型,在純追蹤算法中對前視距離參數(shù)進(jìn)行動態(tài)調(diào)節(jié).通過將引導(dǎo)車行駛路徑劃分成多段直線路徑組合成的折線路徑,使跟隨車自主跟隨的本質(zhì)轉(zhuǎn)化為對折線路徑的快速跟蹤,實現(xiàn)跟隨車對引導(dǎo)車的自主跟隨.仿真及試驗結(jié)果表明:折線路徑平均橫向偏差由0.092 m減少為0.022 m,調(diào)節(jié)時間縮短約50%,該算法對折線路徑的跟蹤精度較高,響應(yīng)時間短,滿足自主跟隨需求.

    履帶式;自主跟隨;前視距離;模糊神經(jīng);路徑跟蹤

    當(dāng)前由于農(nóng)業(yè)機(jī)械自主導(dǎo)航控制系統(tǒng)成本高昂[1],其研究多局限于實驗室環(huán)境,對于應(yīng)付道路行駛與農(nóng)田耕作的惡劣環(huán)境及突發(fā)情況的能力還有待提高,無法大規(guī)模應(yīng)用.由此尋找一種既能提高農(nóng)業(yè)機(jī)械自動化、智能化,同時又能兼顧其成本,可靠性與穩(wěn)定性的新型農(nóng)機(jī)智能化控制系統(tǒng)已成為各國研究的重點.為了兼顧上述特點,歐美日開展了農(nóng)業(yè)機(jī)械自主跟隨控制系統(tǒng)的研究[2],該系統(tǒng)由引導(dǎo)車與跟隨車組成,引導(dǎo)車由駕駛員駕駛,跟隨車在其后自主跟隨.由于該系統(tǒng)中包含了駕駛?cè)藛T,有效提高了該系統(tǒng)的智能化程度,使得其應(yīng)對道路行駛,惡劣耕作環(huán)境和突發(fā)情況的能力有了較大提高.

    當(dāng)前農(nóng)用車輛自主跟隨控制系統(tǒng)研究多集中于輪式車輛直線路徑跟隨前進(jìn),既有采用固定前視距離純追蹤算法進(jìn)行農(nóng)業(yè)機(jī)械導(dǎo)航控制[3],但存在超調(diào),也有采用模糊控制進(jìn)行導(dǎo)航控制[4],橫向偏差與航向偏差為輸入,前輪轉(zhuǎn)角為期望輸出,同時模糊規(guī)則由駕駛?cè)藛T主觀提出,跟蹤誤差大,無法快速修正.上述跟蹤算法對于復(fù)雜多變路徑的跟蹤精度均不能滿足農(nóng)業(yè)精確作業(yè)要求,即使有些系統(tǒng)可以沿曲線路徑跟隨行駛,但由于算法過于復(fù)雜,成本過高,不適合大規(guī)模推廣[5-6].針對提高復(fù)雜路徑的跟隨響應(yīng)和跟蹤精度,筆者通過研究兩車協(xié)同作業(yè)的路徑跟隨方法,提出了一種基于ANFIS的自適應(yīng)前視距離自主跟隨算法.通過這種路徑跟隨方式,有效提高了模糊規(guī)則的客觀性和準(zhǔn)確性,較好地改善了履帶式移動機(jī)器人的自主跟隨效果.

    1 履帶式移動機(jī)器人平臺及其硬件架構(gòu)

    履帶式移動機(jī)器人平臺自主跟隨控制系統(tǒng)硬件框圖如圖1所示,主要包括PC端上位機(jī)系統(tǒng),MCU主控單元,GPS/DR(Global positioning system/dead reckoning)導(dǎo)航控制單元,視頻處理單元、無線收發(fā)單元,速度測量單元,電機(jī)驅(qū)動單元,其中STM32F103ZET6作為MCU主控芯片.履帶式移動機(jī)器人自主跟隨控制系統(tǒng)實物圖如圖2所示.

    圖1 履帶式移動機(jī)器人硬件系統(tǒng)框圖Fig.1 Block diagram of hardware system

    圖2 履帶式移動機(jī)器人自主跟隨系統(tǒng)Fig.2 Autonomous following control system

    2 自主跟隨軟件流程及其算法

    2.1 自主跟隨軟件流程

    履帶式移動機(jī)器人自主跟隨控制系統(tǒng)采用兩種模式,分別是遙控模式,自主跟隨模式.遙控模式下操控人員通過PC端上位機(jī)軟件直接發(fā)送指令控制履帶式移動機(jī)器人行駛.自主跟隨模式流程圖如圖3所示,設(shè)置路徑更新周期T與傳感器采樣周期t,令T=nt,每隔一個采樣周期讀取引導(dǎo)車、跟隨車坐標(biāo)和速度信息,每隔一個路徑更新周期更新一次跟蹤路徑,不斷循環(huán),實現(xiàn)跟隨車自主跟隨引導(dǎo)車.

    圖3 自主跟隨模式軟件流程圖Fig.3 Software flow chart of autonomous following mode

    2.2 兩車協(xié)同作業(yè)的路徑跟隨方法

    路徑規(guī)劃是移動機(jī)器人自主跟隨控制系統(tǒng)的重要組成部分[7].自主跟隨控制系統(tǒng)通過引導(dǎo)車與跟隨車信息互聯(lián)的方式獲取周圍環(huán)境信息進(jìn)行局部路徑規(guī)劃[8-9].通過確定起始點為A,終止點為B來確定一條導(dǎo)航直線AB進(jìn)行直線路徑跟蹤,取履帶式移動機(jī)器人行駛時的一段轉(zhuǎn)彎路徑進(jìn)行分析,如圖4所示,黑色虛線矩形代表引導(dǎo)車,黑色實線矩形代表跟隨車,A,B,C,D,E所在點代表引導(dǎo)車重心位置.自主跟隨模式下,令間距等于規(guī)定行使速度與路徑更新周期的乘積,使得引導(dǎo)車行駛完一個路徑更新周期時跟隨車恰好能到達(dá)引導(dǎo)車之前一段路徑的起始點附近,有利于跟隨車快速準(zhǔn)確地跟隨下一段路徑.引導(dǎo)車以一定速度行駛,每隔一個路徑更新周期生成一條直線跟蹤路徑,跟隨車實時跟蹤引導(dǎo)車生成的最新跟蹤路徑,實現(xiàn)自主跟隨.以這種方式進(jìn)行的自主跟隨系統(tǒng),將轉(zhuǎn)彎路徑中的曲線路徑分為幾段直線路徑進(jìn)行路徑跟蹤,即AB,BC,CD,DE段,使得引導(dǎo)車行駛路徑成為多段直線路徑組合成的折線路徑,跟隨車自主跟隨的本質(zhì)便轉(zhuǎn)換為對折線路徑的快速跟蹤.該方法不但減少了計算量,還便易工程實現(xiàn).

    圖4 轉(zhuǎn)彎路徑規(guī)劃Fig.4 Turning path planning

    2.3 履帶式移動機(jī)器人運動學(xué)求解與自主跟隨算法

    純追蹤算法作為一種路徑跟蹤算法已有許多年的歷史[10],該算法是一種幾何算法,用來計算車輛到達(dá)目標(biāo)位置的軌跡弧長,其核心在于確定一個合適的前視距離.該算法模擬車內(nèi)駕駛員的視覺,具有簡單、直觀且兼具仿生學(xué)的特點,被廣泛應(yīng)用在路徑跟蹤領(lǐng)域上.

    如圖5所示建立導(dǎo)航坐標(biāo)系(X—O—Y)和車體坐標(biāo)系(vX—p—vY),設(shè)履帶式移動機(jī)器人轉(zhuǎn)彎曲率為γ,γ為有符號數(shù),機(jī)器人逆時針旋轉(zhuǎn)時為正,順時針旋轉(zhuǎn)時為負(fù),圖5以順時針旋轉(zhuǎn)為例,故γ<0;R為移動機(jī)器人此刻的瞬時轉(zhuǎn)彎半徑,為有符號數(shù);d為移動機(jī)器人相對于跟蹤路徑l的橫向偏差,為有符號數(shù),同時規(guī)定機(jī)器人在沿期望路徑前進(jìn)方向左側(cè)時d<0,反之,d>0,圖5所示d<0;φ為移動機(jī)器人相對于跟蹤路徑l的航向偏差,航向偏差等于當(dāng)前航向角度與跟蹤直線相對于X軸正向角度之差,規(guī)定車體坐標(biāo)系vY軸偏向期望路徑左側(cè)時為正,右側(cè)時為負(fù);Ld為前視距離;ψ為移動機(jī)器人沿著轉(zhuǎn)向弧線到達(dá)目標(biāo)點T(vXt,vYt)時的航向變化角度;(vXt,vYt)為T點在車體坐標(biāo)系下的坐標(biāo);α為跟蹤路徑l與大地坐標(biāo)系X軸正向的角度差;θ為機(jī)器人前進(jìn)方向與大地坐標(biāo)系X軸正向的角度差.

    圖5 運動學(xué)、純追蹤模型幾何示意圖Fig.5 Geometry sketch map of kinematics and pure pursuit models

    由履帶式移動機(jī)器人運動學(xué)模型可得

    (1)

    式中:L為履帶式移動機(jī)器人雙側(cè)履帶中心間距;iL和iR分別為履帶式移動機(jī)器人左右兩側(cè)履帶的滑轉(zhuǎn)率,可表示為

    (2)

    vl,vr分別為履帶式移動機(jī)器人左右兩側(cè)履帶的實際速度,在不考慮履帶滑轉(zhuǎn)率的情況下,履帶的理論速度等于實際速度,即

    vL=vl,vR=vr

    (3)

    由于實際行駛過程中,履帶滑轉(zhuǎn)率由多方因素決定,很難測定,假設(shè)履帶式移動機(jī)器人在行駛過程中雙側(cè)履帶沒有產(chǎn)生滑動,結(jié)合式(1~3)可得履帶式移動機(jī)器人運動學(xué)方程為

    (4)

    式中P為履帶式移動機(jī)器人當(dāng)前的位姿矩陣.對式(4)積分后得

    (5)其中:(xp0,yp0,θ0)為履帶式移動機(jī)器人在t=0時的位置和方向;(xp,yp,θ)為機(jī)器人當(dāng)前位置和方向.

    履帶式移動機(jī)器人在P點的線速度和角速度可分別表示為

    (6)

    假設(shè)履帶式移動機(jī)器人的轉(zhuǎn)彎半徑為R,由式vP=RωP可得機(jī)器人當(dāng)前轉(zhuǎn)彎半徑為

    (7)

    由圖5可得履帶式移動機(jī)器人純追蹤方程為

    (8)

    已知R=1/γ,結(jié)合式(8)得

    (9)

    由圖5可得

    (10)

    (11)

    由式(11)可得

    (12)

    2.4 基于ANFIS的前視距離仿真

    2.4.1 前視距離控制策略

    由于前視距離是純追蹤算法中的一個關(guān)鍵參數(shù)[11],如何確定一個合適的前視距離是本節(jié)研究的重點.前視距離的大小與農(nóng)業(yè)機(jī)械的橫向偏差、航向偏差和車速有直接關(guān)系.路徑跟蹤的主要目的便是使跟蹤車輛的橫向偏差與航向偏差都趨于零.當(dāng)橫向偏差與航向偏差過大時,農(nóng)機(jī)需要較小的前視距離快速減小偏差,提高系統(tǒng)響應(yīng)速度;當(dāng)橫向偏差與航向偏差較小時,需要增大前視距離防止系統(tǒng)響應(yīng)超調(diào),提高系統(tǒng)穩(wěn)定性.當(dāng)車速過大時,需要適當(dāng)增大前視距離,防止系統(tǒng)響應(yīng)超調(diào),當(dāng)車速較小時,適當(dāng)減小前視距離有利于提高路徑跟蹤精度.由于農(nóng)機(jī)行駛速度較低且基本無變化,可認(rèn)為是恒速,故筆者不考慮速度對前視距離的影響.

    目前,一般通過仿真與實驗確定一個合理的前視距離,但該方法由于前視距離固定,無法根據(jù)農(nóng)機(jī)當(dāng)前位置誤差實時調(diào)整前視距離,并非是最優(yōu)解.除此之外,也有采用模糊算法,通過歸納專家的操作經(jīng)驗來制定模糊規(guī)則表,從而在跟蹤過程中對前視距離進(jìn)行實時調(diào)節(jié).由于農(nóng)業(yè)機(jī)械駕駛?cè)藛T的主觀性導(dǎo)致利用直覺操作經(jīng)驗或直觀感知來制定模糊規(guī)則的準(zhǔn)確性大大降低,極大地提高了后期調(diào)試的工作量.因此將神經(jīng)網(wǎng)絡(luò)引入模糊系統(tǒng),采用MATLAB中的ANFIS[12],根據(jù)大量數(shù)據(jù),通過自適應(yīng)建模方法建立起模糊推理系統(tǒng).由于用神經(jīng)網(wǎng)絡(luò)建立FIS是對數(shù)據(jù)進(jìn)行處理的結(jié)果,更具客觀性,同時采用輸出量是數(shù)值函數(shù)的Sugeno型模糊模型,便于軟件編程實現(xiàn).

    2.4.2 ANFIS訓(xùn)練樣本采集

    首先確定橫向偏差的模糊論域為[-0.3,0.3](單位為m),航向偏差的模糊論域為[-π/2,π/2](單位為弧度),其中橫向偏差以0.07 m為一檔,航向偏差以15度為一檔進(jìn)行等比例劃分仿真.通過對不同分檔下不同大小的固定前視距離Matlab/Simulink仿真,確定行駛速度為0.3 m/s時各分檔下的最佳前視距離.將這一系列仿真所得數(shù)據(jù)采集得到ANFIS訓(xùn)練樣本,由于樣本數(shù)據(jù)較多,只列出部分?jǐn)?shù)據(jù),如表1所示.

    2.4.3 生成初始FIS

    首先建立T-S型模糊模型,選擇“And method”為“prod”, “Defuzzification”為“wtaver”,將上表所得訓(xùn)練樣本裝入ANFIS,選擇網(wǎng)格分割法,網(wǎng)格分割法是將已裝入ANFIS的數(shù)據(jù)用“網(wǎng)格”加以分割,然后按照設(shè)定的參數(shù),依據(jù)模糊C-均值聚類方法建立起模糊系統(tǒng).橫向偏差與航向偏差均用7個模糊子集來覆蓋輸入變量,模糊語言值分別為橫向偏差:{左大,左中,左小,零,右小,右中,右大}={LB,LM,LS,Z,RS,RM,RB},航向偏差:{負(fù)大,負(fù)中,負(fù)小,零,正小,正中,正大}={FB,FM,FS,Z,ZS,ZM,ZB}.選擇高斯型函數(shù)作為兩個輸入變量的隸屬度函數(shù),在輸出量隸屬函數(shù)類型中選則“l(fā)inear”,表示選定輸出量為輸入量的線性函數(shù).圖6所示為ANFIS模型結(jié)構(gòu)圖,其中x1為橫向偏差d,x2為航向偏差φ,y為前視距離Ld.

    表1 自適應(yīng)神經(jīng)模糊系統(tǒng)訓(xùn)練樣本

    圖6 ANFIS模型結(jié)構(gòu)圖Fig.6 ANFIS model structure diagram

    2.4.4 生成隸屬函數(shù)圖及模糊規(guī)則

    選用“hybrid”方法對樣本數(shù)據(jù)進(jìn)行訓(xùn)練,設(shè)置“Error Tolerance”為0,訓(xùn)練次數(shù)為500次,訓(xùn)練結(jié)束后得到誤差為0.004 3,訓(xùn)練后得到橫向偏差隸屬度函數(shù)圖、航向偏差隸屬度函數(shù)圖如圖7所示.

    由高斯型隸屬函數(shù)公式與各隸屬函數(shù)參數(shù)可得

    覆蓋輸入量的各模糊子集隸屬度函數(shù)表達(dá)式.整理輸出函數(shù)參數(shù)可得出49個輸出函數(shù)表達(dá)式.由此便可得出ANFIS根據(jù)訓(xùn)練樣本建立的關(guān)于前視距離的2階Sugeno型FIS的模糊規(guī)則,由于控制規(guī)則較多,所以只列出了部分規(guī)則:

    R1:ifdis LB andφis FB thenLd=-0.567 6d-0.152 4φ-0.055 34

    R2:ifdis LB andφis FM thenLd=-0.446 7d-0.154 7φ+0.078 13

    R3:ifdis LB andφis FS thenLd=-0.472 7d-0.148 8φ+0.152 1

    ?

    R47:ifdis RB andφis ZS thenLd=1.005d+0.188 1φ-0.095 37

    R48:ifdis RB andφis ZM thenLd=0.993 4d+0.196 7φ-0.198 7

    R49:ifdis RB andφis ZB thenLd=1.003d+0.173 5φ-0.274 1

    圖7 兩種偏差隸屬度函數(shù)圖Fig.7 Two kinds of membership function diagram

    3 自主跟隨算法對比試驗

    設(shè)定履帶式移動機(jī)器人初始位置在(0,0)(單位為米)處,,初始航向角為45°,行駛速度為0.3 m/s,固定前視距離取車速為2~3 s走過的距離時與人的駕駛行為接近[13],故取0.6 m,圖8黑色軌跡(農(nóng)田作業(yè)邊界和作業(yè)路徑為典型折線段)為引導(dǎo)車行駛時傳遞給跟隨車的期望跟蹤路徑,即

    圖8 折線路徑試驗場景Fig.8 Experiments of poly line path

    兩種路徑跟蹤算法對比如圖9所示,其中實線代表動態(tài)前視距離算法,虛線代表固定前視距離算法.可知在y=x段時,兩種算法效果相當(dāng),當(dāng)x=

    0.5進(jìn)入折線路徑時,動態(tài)Ld算法能快速跟蹤期望路徑,并將誤差控制在較小范圍內(nèi),其橫向偏差最大為0.065 m,平均為0.024 m,需要時間2.17 s,固定Ld算法橫向偏差快速增大且長期維持較大誤差直至進(jìn)入第三條直線路徑,其最大橫向偏差為0.153 m,平均橫向偏差為0.103 m.進(jìn)入y=x-1直線段后,動態(tài)Ld算法依舊能快速跟蹤期望路徑,橫向偏差最大為0.065 m,平均為0.022 m,需要時間2.13 s,而固定Ld算法由于在y=0.5段積累的誤差導(dǎo)致其無法及時跟蹤期望路徑,其橫向偏差仍舊維持在較大水平,最大橫向偏差為0.152 m,平均橫向偏差為0.092 m.綜上所述可知動態(tài)Ld算法在跟蹤折線路徑時的調(diào)節(jié)時間,最大橫向偏差,平均橫向偏差均明顯小于固定Ld算法,滿足自主跟隨模式下跟蹤路徑的連續(xù)變化.

    圖9 兩種算法對比圖Fig.9 Comparison of two algorithms

    4 結(jié) 論

    以履帶式移動機(jī)器人為平臺,針對履帶式移動機(jī)器人兩車協(xié)同跟隨作業(yè),進(jìn)行了自主跟隨控制平臺及控制系統(tǒng)設(shè)計,以及兩車協(xié)同作業(yè)的路徑跟隨模型及算法研究,提出了一種動態(tài)最優(yōu)前視距離的農(nóng)業(yè)履帶移動機(jī)器人自主跟隨算法,其核心在于通過跟隨過程中不同橫向偏差與航向偏差信息采集,通過自適應(yīng)神經(jīng)模糊算法確定出跟隨模型的最佳前視距離,從而提高路徑跟隨精度,最后進(jìn)行了典型折線路徑跟隨仿真及試驗.結(jié)果表明:采用動態(tài)最優(yōu)前視距離自主跟隨算法的調(diào)節(jié)時間縮短約50%,折線路徑平均橫向偏差由0.092 m減少為0.022 m.因此該算法具有良好的實時調(diào)節(jié)性能,滿足農(nóng)機(jī)裝備在農(nóng)田作業(yè)復(fù)雜路徑下的自主跟隨需求.

    [1] 張立彬,計時鳴,胥芳,等.農(nóng)業(yè)機(jī)器人的主要應(yīng)用領(lǐng)域和關(guān)鍵技術(shù)[J].浙江工業(yè)大學(xué)學(xué)報,2002,30(1):36-41.

    [2] TORII T. Research in autonomous agriculture vehicles in Japan[J]. Computers and electronics in agriculture,2000,25(1/2):133-133.

    [3] 張智剛,羅淆文,趙祚喜,等.基于Kalman濾波和純追蹤模型的農(nóng)業(yè)機(jī)械導(dǎo)航控制[J].農(nóng)業(yè)機(jī)械學(xué)報,2009,40(增):6-12.

    [4] 陳軍,蔣浩然,劉沛,等.果園移動機(jī)器人曲線路徑導(dǎo)航控制[J].農(nóng)業(yè)機(jī)械學(xué)報,2012,43(4):179-187.

    [5] 陳軍,朱忠祥,鳥巢諒,等.拖拉機(jī)沿曲線路徑的跟蹤控制[J].農(nóng)業(yè)工程學(xué)報,2006,22(11):108-111.

    [6] 朱忠祥,松正河,謝斌,等.拖拉機(jī)隊列自動控制系統(tǒng)[J].農(nóng)業(yè)機(jī)械學(xué)報,2008,40(8):149-154.

    [7] 王燕,張立彬,楊慶華.黃瓜采摘機(jī)器人運動規(guī)劃與控制系統(tǒng)研究[D].杭州:浙江工業(yè)大學(xué),2010.

    [8] 王宇,董輝,徐建明,等.一種新的智能小車控制策略[J].浙江工業(yè)大學(xué)學(xué)報,2012,40(2):217-221.

    [9] 陳曉瞇,孟志青,徐杰.基于混合禁忌搜索算法的動態(tài)車輛路徑研究[J].浙江工業(yè)大學(xué)學(xué)報,2009,37(5):580-585.

    [10] 陳軍,鳥巢諒,朱忠祥,等.拖拉機(jī)在牧草地上自動引導(dǎo)行走的控制[J].農(nóng)業(yè)機(jī)械學(xué)報,2005,36(7):104-107.

    [11] LI C H, ZHU X J, CAO G Y, et al. Identification of the Hammerstein model of a PEMFC stack based on least squares support vector machines[J]. Journal of power sources,2008,175(1):303-316.

    [12] 劉懷國,孫建華,張冰,等.ANFIS及其在控制系統(tǒng)中的應(yīng)用[J].華東船舶工業(yè)學(xué)院學(xué)報(自然科學(xué)版),2001,15(5):27-31.

    [13] POMERLEAU D A. Neural network perception for mobile robot guidance[M]. Massachusetts: Kluwer Academic Publishers Norwell,1993.

    (責(zé)任編輯:劉 巖)

    Study on autonomous following algorithm of crawler-type mobile robot

    JIANG Jiandong, ZHANG Jun, LI Congcong, ZHANG Enguang

    (Key Laboratory of Special Purpose Equipment and Advanced Manufacturing Technology, Ministry of Education, Zhejiang University of Technology, Hangzhou 310014, China)

    An autonomous tracking control system for agricultural machinery is studied and designed based on the autonomous tracking control platform of crawler-type mobile robot. An algorithm for adaptive look-ahead distance is proposed combined with neural fuzzy control (ANFIS). The kinematic model and the pure pursuit model for crawler-type mobile robot ate established and the parameters of look-ahead distance are adjusted dynamically. By dividing the driving path of the guided vehicle into a poly line path combined with multiple linear paths, the essence of the following vehicle is transformed into the fast track of the poly line path, and the guided vehicle is autonomously tracked by the following vehicle. The experimental results indicated that the average lateral deviation of the line path is reduced from 0.092 m to 0.022 m, and the adjust time is reduced by about 50%. This algorithm can meet the demands of autonomous tracking.

    crawler-type; autonomous following; look-ahead distance; fuzzy neural; path following

    2016-11-02

    國家自然科學(xué)基金資助項目(51375456);浙江省重大專項項目(2013C01048)

    蔣建東(1974—),男,四川廣安人,教授,博士,主要從事機(jī)電系統(tǒng)設(shè)計與分析方面的研究,E-mail:jiangjd@zjut.edu.cn.

    S232;TP242

    A

    1006-4303(2017)04-0355-06

    猜你喜歡
    折線移動機(jī)器人航向
    折線統(tǒng)計圖
    移動機(jī)器人自主動態(tài)避障方法
    知坐標(biāo),明航向
    考慮幾何限制的航向道模式設(shè)計
    折線的舞臺——談含絕對值的一次函數(shù)的圖象
    折線
    基于Twincat的移動機(jī)器人制孔系統(tǒng)
    基于干擾觀測器的船舶系統(tǒng)航向Backstepping 控制
    電子制作(2017年24期)2017-02-02 07:14:16
    使命:引領(lǐng)航向與保持穩(wěn)定
    法大研究生(2015年2期)2015-02-27 10:13:55
    極坐標(biāo)系下移動機(jī)器人的點鎮(zhèn)定
    欧美成人性av电影在线观看| 亚洲一区高清亚洲精品| 非洲黑人性xxxx精品又粗又长| 亚洲国产精品久久男人天堂| 免费在线观看日本一区| 国产探花极品一区二区| 亚洲精品一卡2卡三卡4卡5卡| 小说图片视频综合网站| 全区人妻精品视频| 老汉色∧v一级毛片| 日韩欧美精品v在线| 国产私拍福利视频在线观看| 国产亚洲av嫩草精品影院| 丰满人妻熟妇乱又伦精品不卡| 757午夜福利合集在线观看| 国产野战对白在线观看| 51午夜福利影视在线观看| 桃色一区二区三区在线观看| 一个人看视频在线观看www免费 | 一级作爱视频免费观看| 国产激情偷乱视频一区二区| 好男人电影高清在线观看| 免费高清视频大片| 女警被强在线播放| 人人妻人人看人人澡| 波野结衣二区三区在线 | 嫩草影院精品99| 18禁在线播放成人免费| 一本综合久久免费| 国产乱人视频| 亚洲狠狠婷婷综合久久图片| 又爽又黄无遮挡网站| 好看av亚洲va欧美ⅴa在| 伊人久久大香线蕉亚洲五| 19禁男女啪啪无遮挡网站| a在线观看视频网站| 狂野欧美激情性xxxx| 午夜免费男女啪啪视频观看 | 亚洲真实伦在线观看| 亚洲精品色激情综合| 69av精品久久久久久| 午夜激情福利司机影院| 一本精品99久久精品77| 搞女人的毛片| 99视频精品全部免费 在线| 熟女人妻精品中文字幕| 成人鲁丝片一二三区免费| 一级毛片高清免费大全| 色视频www国产| 黑人欧美特级aaaaaa片| 啦啦啦观看免费观看视频高清| 国产亚洲精品综合一区在线观看| 欧美不卡视频在线免费观看| 国产高潮美女av| 久久人人精品亚洲av| 99久久精品热视频| 午夜福利免费观看在线| а√天堂www在线а√下载| 免费人成视频x8x8入口观看| 日本一二三区视频观看| 女人被狂操c到高潮| 久久人妻av系列| 91在线观看av| 中文字幕人成人乱码亚洲影| 亚洲黑人精品在线| 99热这里只有是精品50| 成人国产一区最新在线观看| 日本免费a在线| 少妇的丰满在线观看| 欧美绝顶高潮抽搐喷水| 国产蜜桃级精品一区二区三区| 午夜福利在线观看吧| 午夜久久久久精精品| 亚洲国产高清在线一区二区三| 岛国视频午夜一区免费看| 给我免费播放毛片高清在线观看| 少妇的逼水好多| 午夜免费成人在线视频| 极品教师在线免费播放| 精品99又大又爽又粗少妇毛片 | netflix在线观看网站| 亚洲美女黄片视频| 日本a在线网址| 色综合欧美亚洲国产小说| 手机成人av网站| 男女下面进入的视频免费午夜| 天天躁日日操中文字幕| 国产探花在线观看一区二区| 国产乱人视频| 久久6这里有精品| 蜜桃久久精品国产亚洲av| h日本视频在线播放| 亚洲激情在线av| 亚洲最大成人手机在线| 91在线观看av| 国产一区二区在线观看日韩 | 两性午夜刺激爽爽歪歪视频在线观看| 日韩 欧美 亚洲 中文字幕| 女人十人毛片免费观看3o分钟| 日韩欧美在线二视频| 99视频精品全部免费 在线| 亚洲激情在线av| tocl精华| 亚洲久久久久久中文字幕| 99精品在免费线老司机午夜| 亚洲真实伦在线观看| 午夜亚洲福利在线播放| 最近最新中文字幕大全电影3| 国产一区二区三区视频了| 久久香蕉国产精品| 成熟少妇高潮喷水视频| 日本黄大片高清| 欧美一区二区国产精品久久精品| 欧美极品一区二区三区四区| 日本成人三级电影网站| 99在线人妻在线中文字幕| 国产中年淑女户外野战色| 国产精品亚洲美女久久久| 国产精品香港三级国产av潘金莲| 午夜福利视频1000在线观看| 国产午夜精品论理片| 色综合亚洲欧美另类图片| 亚洲av免费高清在线观看| 麻豆一二三区av精品| 国产野战对白在线观看| 十八禁人妻一区二区| 国产精品电影一区二区三区| eeuss影院久久| 99riav亚洲国产免费| 99精品在免费线老司机午夜| www日本黄色视频网| 在线观看午夜福利视频| 午夜日韩欧美国产| 男人舔女人下体高潮全视频| 成人性生交大片免费视频hd| 婷婷亚洲欧美| 免费电影在线观看免费观看| 亚洲五月天丁香| 成年人黄色毛片网站| 桃色一区二区三区在线观看| 日日摸夜夜添夜夜添小说| 手机成人av网站| 精品人妻1区二区| 香蕉av资源在线| 少妇裸体淫交视频免费看高清| 91在线观看av| 天天一区二区日本电影三级| 亚洲一区二区三区不卡视频| 国产极品精品免费视频能看的| 在线观看一区二区三区| 国产精品三级大全| 亚洲最大成人手机在线| 亚洲男人的天堂狠狠| 中文资源天堂在线| 欧美三级亚洲精品| 国产三级在线视频| 日本精品一区二区三区蜜桃| 亚洲精品影视一区二区三区av| 国产日本99.免费观看| 亚洲中文日韩欧美视频| 两个人的视频大全免费| 国产精品av视频在线免费观看| 亚洲狠狠婷婷综合久久图片| 禁无遮挡网站| 最新美女视频免费是黄的| 老司机深夜福利视频在线观看| 九九在线视频观看精品| 男人舔奶头视频| 国内少妇人妻偷人精品xxx网站| 亚洲18禁久久av| 极品教师在线免费播放| 桃色一区二区三区在线观看| 在线国产一区二区在线| 日韩人妻高清精品专区| 美女大奶头视频| 色综合亚洲欧美另类图片| 欧美zozozo另类| 少妇的丰满在线观看| 又黄又爽又免费观看的视频| 精品久久久久久,| 午夜福利免费观看在线| 午夜老司机福利剧场| 性色avwww在线观看| 免费观看的影片在线观看| 欧美极品一区二区三区四区| 小蜜桃在线观看免费完整版高清| 韩国av一区二区三区四区| 亚洲 欧美 日韩 在线 免费| 亚洲 欧美 日韩 在线 免费| 亚洲精品日韩av片在线观看 | 变态另类丝袜制服| 久久香蕉国产精品| 欧美性猛交╳xxx乱大交人| 男人的好看免费观看在线视频| 日本三级黄在线观看| 日韩欧美在线二视频| av黄色大香蕉| 精品久久久久久久人妻蜜臀av| 精品国内亚洲2022精品成人| 亚洲第一电影网av| 国产精品 欧美亚洲| www国产在线视频色| 一级黄片播放器| 午夜激情欧美在线| 午夜精品久久久久久毛片777| 免费观看人在逋| 最新在线观看一区二区三区| 国产精品久久久久久久久免 | 99热6这里只有精品| 嫁个100分男人电影在线观看| 美女 人体艺术 gogo| 精品欧美国产一区二区三| 美女 人体艺术 gogo| 成人18禁在线播放| 久久久久精品国产欧美久久久| 欧美日本视频| 一个人看视频在线观看www免费 | 一a级毛片在线观看| 亚洲精品在线美女| 在线十欧美十亚洲十日本专区| 99久久九九国产精品国产免费| 18+在线观看网站| 久久久久亚洲av毛片大全| 日韩中文字幕欧美一区二区| 亚洲在线观看片| 一个人看视频在线观看www免费 | 男人舔奶头视频| 亚洲一区二区三区色噜噜| 两性午夜刺激爽爽歪歪视频在线观看| 午夜福利在线在线| 91在线精品国自产拍蜜月 | 婷婷六月久久综合丁香| 久久午夜亚洲精品久久| 国内精品久久久久精免费| 亚洲中文字幕一区二区三区有码在线看| 亚洲精品美女久久久久99蜜臀| 欧美日韩一级在线毛片| 一区二区三区国产精品乱码| 国产三级在线视频| 搡女人真爽免费视频火全软件 | 男人舔奶头视频| 免费av毛片视频| 国产一区二区亚洲精品在线观看| 久久久久久久久久黄片| 亚洲,欧美精品.| 国产成人福利小说| 嫁个100分男人电影在线观看| 欧美极品一区二区三区四区| 欧美日韩国产亚洲二区| 嫩草影视91久久| 亚洲18禁久久av| 嫁个100分男人电影在线观看| av女优亚洲男人天堂| 亚洲欧美激情综合另类| 国产中年淑女户外野战色| 国产成人欧美在线观看| 国产成人啪精品午夜网站| 国产精品久久电影中文字幕| 女人被狂操c到高潮| 国产单亲对白刺激| 99久久九九国产精品国产免费| 中文亚洲av片在线观看爽| 91久久精品电影网| 国产乱人视频| 国产精品日韩av在线免费观看| 欧美黑人巨大hd| 中文字幕精品亚洲无线码一区| 中出人妻视频一区二区| 亚洲人成网站高清观看| 精品国产超薄肉色丝袜足j| 国产精品,欧美在线| 99riav亚洲国产免费| 99久久精品一区二区三区| 一a级毛片在线观看| 成人av在线播放网站| 老司机深夜福利视频在线观看| 麻豆久久精品国产亚洲av| 啦啦啦免费观看视频1| 色综合站精品国产| 嫁个100分男人电影在线观看| 成年女人毛片免费观看观看9| 免费人成在线观看视频色| 免费av不卡在线播放| 人人妻人人澡欧美一区二区| 在线观看一区二区三区| 日本五十路高清| 午夜影院日韩av| 天美传媒精品一区二区| 久久久久性生活片| 在线国产一区二区在线| 久久久久久人人人人人| 少妇人妻一区二区三区视频| 99精品欧美一区二区三区四区| 国产精品久久久久久人妻精品电影| 亚洲欧美精品综合久久99| 国产精品国产高清国产av| 他把我摸到了高潮在线观看| 国产精品久久久久久人妻精品电影| 亚洲天堂国产精品一区在线| 人妻夜夜爽99麻豆av| 亚洲精品国产精品久久久不卡| 热99re8久久精品国产| 亚洲最大成人中文| 一夜夜www| 91在线观看av| 久久精品综合一区二区三区| 麻豆一二三区av精品| 天堂动漫精品| 国产在视频线在精品| avwww免费| 国产单亲对白刺激| 午夜福利18| 少妇人妻精品综合一区二区 | 午夜影院日韩av| 国产成人av教育| 亚洲中文字幕一区二区三区有码在线看| 精品久久久久久久末码| 国产精品98久久久久久宅男小说| 日本 欧美在线| 国产精品一区二区三区四区免费观看 | 日本黄色片子视频| 午夜福利18| x7x7x7水蜜桃| av天堂在线播放| 18禁黄网站禁片午夜丰满| 人妻夜夜爽99麻豆av| 美女cb高潮喷水在线观看| 三级男女做爰猛烈吃奶摸视频| 亚洲aⅴ乱码一区二区在线播放| 熟妇人妻久久中文字幕3abv| а√天堂www在线а√下载| 欧美日韩国产亚洲二区| 国产伦人伦偷精品视频| 国产精品亚洲美女久久久| 国产一区二区三区在线臀色熟女| netflix在线观看网站| 久久久国产精品麻豆| av专区在线播放| АⅤ资源中文在线天堂| 看免费av毛片| 有码 亚洲区| 99热精品在线国产| 国产精品日韩av在线免费观看| 欧美最黄视频在线播放免费| 少妇的逼好多水| 99热这里只有是精品50| 精品人妻1区二区| 日韩高清综合在线| 内射极品少妇av片p| 亚洲,欧美精品.| av片东京热男人的天堂| 又紧又爽又黄一区二区| 俄罗斯特黄特色一大片| 黑人欧美特级aaaaaa片| 亚洲国产欧洲综合997久久,| 中文字幕久久专区| 免费高清视频大片| 国产激情偷乱视频一区二区| 亚洲av日韩精品久久久久久密| 日日摸夜夜添夜夜添小说| 亚洲精品粉嫩美女一区| 亚洲国产欧美网| 噜噜噜噜噜久久久久久91| 日韩欧美在线乱码| 黄色视频,在线免费观看| 亚洲国产日韩欧美精品在线观看 | 少妇高潮的动态图| 一区二区三区免费毛片| 夜夜看夜夜爽夜夜摸| 国产精华一区二区三区| 悠悠久久av| 成人av在线播放网站| 国产精品综合久久久久久久免费| 国产中年淑女户外野战色| 国产精品久久久久久亚洲av鲁大| 欧美黄色淫秽网站| 男人舔女人下体高潮全视频| av黄色大香蕉| 亚洲精品美女久久久久99蜜臀| 中文字幕久久专区| 欧美日韩中文字幕国产精品一区二区三区| 亚洲av中文字字幕乱码综合| 极品教师在线免费播放| 欧美乱色亚洲激情| 91久久精品国产一区二区成人 | 国产精品精品国产色婷婷| 韩国av一区二区三区四区| 香蕉丝袜av| 天天一区二区日本电影三级| 中亚洲国语对白在线视频| 精品不卡国产一区二区三区| 男人和女人高潮做爰伦理| 身体一侧抽搐| 国产中年淑女户外野战色| 男女午夜视频在线观看| 一卡2卡三卡四卡精品乱码亚洲| 久久精品夜夜夜夜夜久久蜜豆| 日本在线视频免费播放| 99精品欧美一区二区三区四区| 免费无遮挡裸体视频| 久久天躁狠狠躁夜夜2o2o| 女同久久另类99精品国产91| 国产欧美日韩一区二区精品| 男人舔奶头视频| 两人在一起打扑克的视频| 成人三级黄色视频| www.熟女人妻精品国产| 十八禁网站免费在线| 看片在线看免费视频| 天天添夜夜摸| 国产精品乱码一区二三区的特点| 18美女黄网站色大片免费观看| 在线天堂最新版资源| 1024手机看黄色片| av中文乱码字幕在线| 又爽又黄无遮挡网站| 在线观看一区二区三区| 观看免费一级毛片| 琪琪午夜伦伦电影理论片6080| 在线播放无遮挡| 搡老妇女老女人老熟妇| 一级黄色大片毛片| 一级作爱视频免费观看| 亚洲乱码一区二区免费版| 在线免费观看不下载黄p国产 | 日韩免费av在线播放| 免费在线观看亚洲国产| 久久精品国产自在天天线| 国产精品永久免费网站| www.999成人在线观看| 波多野结衣巨乳人妻| 香蕉丝袜av| 老熟妇乱子伦视频在线观看| 久久九九热精品免费| 精品电影一区二区在线| 亚洲精品456在线播放app | 亚洲精品成人久久久久久| 国产久久久一区二区三区| 日韩欧美三级三区| 看片在线看免费视频| 偷拍熟女少妇极品色| 99久久九九国产精品国产免费| 十八禁人妻一区二区| 日韩欧美 国产精品| 午夜激情福利司机影院| 一a级毛片在线观看| 日韩亚洲欧美综合| 日本成人三级电影网站| 在线观看免费午夜福利视频| 色在线成人网| 精品人妻一区二区三区麻豆 | 亚洲人成网站高清观看| 淫秽高清视频在线观看| 国产精品一区二区三区四区免费观看 | 一本综合久久免费| 色精品久久人妻99蜜桃| 日韩欧美 国产精品| 桃色一区二区三区在线观看| 久久精品国产亚洲av香蕉五月| 淫妇啪啪啪对白视频| a级毛片a级免费在线| 少妇熟女aⅴ在线视频| 日韩高清综合在线| 日韩精品青青久久久久久| 99久国产av精品| 精品国产美女av久久久久小说| 精品国内亚洲2022精品成人| 在线观看美女被高潮喷水网站 | 日本免费一区二区三区高清不卡| 首页视频小说图片口味搜索| 午夜免费观看网址| 午夜免费男女啪啪视频观看 | 国产高潮美女av| 亚洲一区高清亚洲精品| 91麻豆精品激情在线观看国产| 日日夜夜操网爽| 少妇裸体淫交视频免费看高清| av福利片在线观看| av女优亚洲男人天堂| 精品久久久久久,| 欧美另类亚洲清纯唯美| 天堂√8在线中文| 在线播放无遮挡| 99久久无色码亚洲精品果冻| 成人av一区二区三区在线看| 国产单亲对白刺激| 97超视频在线观看视频| 搡老熟女国产l中国老女人| 母亲3免费完整高清在线观看| 老汉色∧v一级毛片| 日本黄色片子视频| 国产精品,欧美在线| 人人妻人人看人人澡| 日韩av在线大香蕉| 国产高潮美女av| 蜜桃亚洲精品一区二区三区| 宅男免费午夜| 国产熟女xx| 精品久久久久久久末码| 成人国产一区最新在线观看| 欧美中文综合在线视频| 国产一区二区亚洲精品在线观看| 国产精品国产高清国产av| 久久久色成人| 搡老岳熟女国产| 国产色爽女视频免费观看| 露出奶头的视频| 婷婷精品国产亚洲av| 欧美色视频一区免费| 少妇人妻一区二区三区视频| 亚洲在线自拍视频| 男女之事视频高清在线观看| 欧美日韩黄片免| 最新在线观看一区二区三区| 免费电影在线观看免费观看| 国产亚洲精品一区二区www| 在线观看午夜福利视频| 日本五十路高清| 精品人妻一区二区三区麻豆 | 精品国内亚洲2022精品成人| 亚洲七黄色美女视频| 不卡一级毛片| 婷婷丁香在线五月| 哪里可以看免费的av片| 国产精品国产高清国产av| 久久久国产成人免费| www日本黄色视频网| 啦啦啦观看免费观看视频高清| 国产伦人伦偷精品视频| 三级国产精品欧美在线观看| 国产精品久久久久久久久免 | 欧美一区二区亚洲| 日韩中文字幕欧美一区二区| 首页视频小说图片口味搜索| 99精品欧美一区二区三区四区| 熟妇人妻久久中文字幕3abv| 一本一本综合久久| eeuss影院久久| 国产精品电影一区二区三区| 国产精品久久久久久人妻精品电影| 国产精品综合久久久久久久免费| 亚洲男人的天堂狠狠| 国产一区二区亚洲精品在线观看| 国产精品98久久久久久宅男小说| 99热6这里只有精品| 一进一出好大好爽视频| 国产亚洲精品一区二区www| 亚洲五月婷婷丁香| 亚洲精品日韩av片在线观看 | 香蕉av资源在线| 久久久久免费精品人妻一区二区| 美女cb高潮喷水在线观看| 亚洲欧美日韩无卡精品| 免费观看精品视频网站| 欧美在线一区亚洲| 91字幕亚洲| 精品久久久久久久久久久久久| 乱人视频在线观看| 国产99白浆流出| 成熟少妇高潮喷水视频| 色综合站精品国产| 国产精品亚洲一级av第二区| 欧美中文日本在线观看视频| 国产国拍精品亚洲av在线观看 | 亚洲av一区综合| av在线蜜桃| 亚洲久久久久久中文字幕| a级毛片a级免费在线| 久久香蕉精品热| 久久精品国产99精品国产亚洲性色| 亚洲av成人av| 婷婷精品国产亚洲av| 日本撒尿小便嘘嘘汇集6| 亚洲av美国av| 又黄又爽又免费观看的视频| 美女 人体艺术 gogo| 久久中文看片网| 亚洲欧美日韩东京热| 一进一出抽搐动态| 宅男免费午夜| 亚洲最大成人中文| 国产麻豆成人av免费视频| 国产欧美日韩一区二区三| 国产免费男女视频| 日韩有码中文字幕| 高清日韩中文字幕在线| 国产亚洲精品一区二区www| 1024手机看黄色片| 国产伦精品一区二区三区视频9 | 琪琪午夜伦伦电影理论片6080| 精品不卡国产一区二区三区| 久久精品国产99精品国产亚洲性色| 国产黄a三级三级三级人| 三级男女做爰猛烈吃奶摸视频| 欧美3d第一页| 久久香蕉国产精品| 国产亚洲精品久久久久久毛片| 中出人妻视频一区二区| 欧美日韩中文字幕国产精品一区二区三区| 欧美区成人在线视频| 亚洲第一欧美日韩一区二区三区| 床上黄色一级片| 欧美区成人在线视频| 91麻豆av在线| 露出奶头的视频| 日本黄大片高清| 亚洲第一电影网av| 男女之事视频高清在线观看| 成人国产一区最新在线观看| 国产在线精品亚洲第一网站| 夜夜爽天天搞| 亚洲精品一区av在线观看| 免费人成在线观看视频色| www.www免费av| 欧美av亚洲av综合av国产av|