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

    基于反步法的多移載工裝協(xié)同作業(yè)編隊控制策略

    2023-01-18 01:14:24劉禹銘董正建姬煜琦
    上海交通大學(xué)學(xué)報 2023年1期
    關(guān)鍵詞:領(lǐng)航者勢場位姿

    劉禹銘, 趙 勇, 董正建, 王 平, 姬煜琦

    (1. 上海交通大學(xué) 上海市復(fù)雜薄板結(jié)構(gòu)數(shù)字化制造重點實驗室,上海 200240;2. 上海飛機制造有限公司航空制造技術(shù)研究所,上海 201324)

    飛機大部件裝配作為飛機部裝的核心環(huán)節(jié),安全高效的部件運輸以及自動化高精度的工裝對接是整體工作完成的重要保障[1].但是傳統(tǒng)的固定平臺裝配導(dǎo)致工廠場地利用率低,整體裝配過程靈活性低,并且裝配設(shè)備的成本較高,若使用移載工裝進行協(xié)同裝配,則能讓工廠的場地利用率和裝配效率提高[2].目前大多采用物流作業(yè)小車作為作業(yè)的移載工裝,但是其運動精度較低.當各移載工裝由于誤差原因?qū)е聦嶋H運動位姿偏離期望運動位姿時,多移載工裝易使搬運件產(chǎn)生較大內(nèi)力進而影響裝配結(jié)果和產(chǎn)品最終的服役性能.

    合理的編隊控制器能夠有效降低隊列偏差所導(dǎo)致的作業(yè)過程中的內(nèi)力.由于作業(yè)環(huán)境的擾動和移載工裝的運動誤差影響,由多移載工裝組成的多智能體系統(tǒng)魯棒性和穩(wěn)定性較低,并且具有非線性的特點,而反步法適用于非線性不確定系統(tǒng)的控制,其采取分布式的控制器策略,對多智能體中的每個子系統(tǒng)設(shè)計運動控制器[3].Tian等[4]提出了干擾情況下二階多智能系統(tǒng)的反步法控制方法.Liu等[5]在經(jīng)典的反步法基礎(chǔ)之上,提出有限時間觸發(fā)方法,減小了通信負擔.Xue等[6]則利用滑??刂茖顟B(tài)觀測與反步法進行結(jié)合,設(shè)計了一種自適應(yīng)反步滑模控制方法.

    期望運動狀態(tài)和實際運動狀態(tài)是反步法控制策略下的核心變量.對于多智能體的期望運動狀態(tài)設(shè)計依賴于編隊方法的設(shè)計,目前常用的編隊方法主要包括領(lǐng)航跟隨法[7]、人工勢場法[8]、基于行為控制法[9]、虛擬結(jié)構(gòu)法[10]和虛擬領(lǐng)航者法[11].而其中能夠保持隊列剛性結(jié)構(gòu)的方法主要為領(lǐng)航跟隨法和虛擬結(jié)構(gòu)法.領(lǐng)航跟隨法將多機器人作業(yè)過程中的編隊問題轉(zhuǎn)化為領(lǐng)航機器人和跟隨機器人的期望角度與距離之間的關(guān)系問題.虛擬結(jié)構(gòu)法的主要理念是將多機器人的隊形假設(shè)為虛擬的剛性結(jié)構(gòu)進行控制規(guī)律設(shè)計.該編隊方法下整體隊形輕便,形成穩(wěn)定隊列的收斂時間快,但系統(tǒng)穩(wěn)定性難以保證,魯棒性和靈活性較差[12].基于多移載工裝進行協(xié)同裝配時的剛性隊列要求和不同工廠環(huán)境下模塊化裝配的需要,將虛擬結(jié)構(gòu)法和虛擬領(lǐng)航者法相結(jié)合,以虛擬結(jié)構(gòu)的參考點作為虛擬領(lǐng)航者進行作業(yè)運動規(guī)劃.常用的運動規(guī)劃算法有人工勢場法[13]、A*算法[14]、遺傳算法[15]、粒子群優(yōu)化算法[16]等.人工勢場法的運動規(guī)劃兼容編隊控制和避障規(guī)劃的要求,且具有計算量小、規(guī)劃路徑平滑易于設(shè)計軌跡追蹤器的優(yōu)點,被廣泛運用于工程實踐中.編隊控制的另一個重要環(huán)節(jié)是實際運動狀態(tài)的估計,通過測量設(shè)備的定位與濾波算法的結(jié)合,實時校正估計實際位置.而針對移動機器人的定位領(lǐng)域,基于粒子濾波算法進行定位最為廣泛.粒子濾波以其具有多模態(tài)、統(tǒng)計特征隨機分布的特性,適用于位姿估計和實時目標追蹤.但是粒子濾波過程中重采樣會導(dǎo)致粒子退化的問題,針對這一問題,趙國旗等[17]將模糊理論引入粒子濾波來防止重采樣中出現(xiàn)的多模態(tài)失效的問題.Li等[18]針對粒子濾波結(jié)合引入基于庫爾貝克-萊布勒散度(Kullback-Leibler Divergence, KLD)進行采樣的方法,有效解決了粒子退化問題.

    本文以反步法作為編隊控制策略的基礎(chǔ),將虛擬結(jié)構(gòu)法和虛擬領(lǐng)航者法相結(jié)合,通過改進的人工勢場法和純軌跡跟蹤法設(shè)計虛擬領(lǐng)航者的期望運動位姿,解決了路徑規(guī)劃陷入局部最優(yōu)的問題,進一步根據(jù)隊形幾何關(guān)系推導(dǎo)得到實際跟隨者的期望運動位姿.結(jié)合雷達測量設(shè)備和自適應(yīng)蒙特卡洛定位(Adaptive Monte Carlo Localization, AMCL)算法估計實際運動位姿,降低了每個移載工裝的定位誤差值,基于跟隨誤差設(shè)計了隊形控制器,完成了隊列的協(xié)同作業(yè)控制.

    1 基于反步法的編隊控制器設(shè)計

    1.1 結(jié)合虛擬結(jié)構(gòu)法和虛擬領(lǐng)航者法的隊形設(shè)計

    在協(xié)同搬運機翼的過程中,移載工裝需要保持編隊隊形的剛性結(jié)構(gòu),以減小隊形變形所產(chǎn)生的誤差進而降低內(nèi)力.編隊結(jié)構(gòu)的隊列模型如圖1所示.

    圖1 虛擬領(lǐng)航者引領(lǐng)下的剛性結(jié)構(gòu)隊形Fig.1 Rigid structure formation guided by virtual navigator

    考慮以期望隊形的幾何中心作為編隊參考點,在該位置添加一臺同類型的虛擬移載工裝,即虛擬領(lǐng)航者.實際的移載工裝作為跟隨者,進行整體的編隊控制,領(lǐng)航跟隨的關(guān)系如圖2所示.其中,C為小車質(zhì)心,w為角速度.

    圖2 領(lǐng)航者與跟隨者編隊位姿誤差分析Fig.2 Pose error analysis of leader and follower formation

    假設(shè)領(lǐng)航者機器人i在全局坐標系中對應(yīng)的坐標為(xi,yi),則由圖示的幾何關(guān)系可以得到全局坐標的變換關(guān)系:

    (1)

    (2)

    由式(1)與(2)可以得到移載工裝期望位姿以及實際位姿.將兩式相減,得到誤差的相應(yīng)關(guān)系式并將其對時間求導(dǎo),進一步獲得誤差關(guān)于時間的微分方程,從而根據(jù)隊列的運動誤差,設(shè)計隊形控制器.

    (3)

    (4)

    1.2 基于反步法的跟隨者隊形控制器設(shè)計

    針對編隊中各個跟隨者產(chǎn)生的運動誤差,設(shè)計基于反步法的分布式隊形控制器.反步法應(yīng)用于非線性系統(tǒng)的一般形式為

    (5)

    式中:fx(x)和gx(x)為與輸入變量x相關(guān)的函數(shù);ux(x)為輸入控制量.根據(jù)已得到的誤差動態(tài)微分方程,將xe、ye兩項誤差值看作隊形控制器的子系統(tǒng),并遞歸尋找對應(yīng)的虛擬控制,對于兩項輸入控制vj和wj,當選取vj作為虛擬控制輸入時:

    (6)

    (7)

    當ye=0時,V1≤0,則xe在有限時間收斂至0.對于下一個子系統(tǒng)微分方程的虛擬控制量wj,設(shè)計取值為

    (8)

    (9)

    2 移載工裝的運動軌跡規(guī)劃與運動狀態(tài)估計

    2.1 基于改進人工勢場法的避障路線設(shè)計

    從整體隊列控制器的設(shè)計過程可知,期望的運動狀態(tài)和實際的運動狀態(tài)的求取是控制的兩大關(guān)鍵.期望的運動狀態(tài)需要滿足避障、運動平滑、對不同作業(yè)環(huán)境規(guī)劃適應(yīng)性強的要求,而求取實際的運動狀態(tài)需要滿足實時性強、精度高的要求,通過兩者決定的運動誤差來設(shè)計可用的隊列控制器.整體的設(shè)計流程圖如圖3所示.

    圖3 整體編隊控制器設(shè)計流程圖Fig.3 Designed flow chart of overall formation controller

    根據(jù)編隊控制器的設(shè)計流程,首先進行虛擬領(lǐng)航者的期望運動路徑設(shè)計.基于實際工作環(huán)境掃描得到多移載工裝的作業(yè)空間,在作業(yè)空間中引入人工勢場,障礙物周圍分布斥力場,目標點周圍分布引力場,使得被控對象在合力作用下自主移動.設(shè)定移載工裝所在位置為q(x0,y0),目標點位置為g(xend,yend),定義目標距離函數(shù)為ρ(q,g),q為起始點,g為目標點.在傳統(tǒng)的人工勢場中常用的引力與斥力場函數(shù)為

    (10)

    (11)

    式中:η、ξ為選取的引力系數(shù)與斥力系數(shù);ρ(q)為移載工裝距離障礙物最近點的距離;q0為基于移載工裝自身尺寸以及隊形等要素所決定的安全距離.而斥力場僅在針對移載工裝定義的安全距離內(nèi)生效,以達到更短的避障路線規(guī)劃.由于虛擬領(lǐng)航者位于隊列幾何中心,所以選取幾何外接圓半徑為安全距離的參考基準,能簡潔地處理編隊避障的問題,路徑規(guī)劃的場地適應(yīng)性和實時性都能滿足要求.

    圖4 結(jié)合模擬退火法的人工勢場法算法流程圖Fig.4 Algorithm steps of APF method in combination with simulated annealing

    使用上述介紹的改進人工勢場法,當虛擬領(lǐng)航者陷入局部最優(yōu)導(dǎo)致運動震蕩時,通過搜索下一路徑點進行跳出,如圖5所示.

    圖5(c)與5(f)中的箭頭符號象征人工勢場中的勢場矢量,而圖5(d)中的U為合勢場的大小,沒有對應(yīng)的單位.可以看出,采用模擬退火法使得被控移載工裝在全局坐標系中跳出了局部最優(yōu)點,重新規(guī)劃路徑,最終到達了目標點.

    圖5 模擬退火法逃出局部最優(yōu)示意圖Fig.5 Diagram of escaping from local optimum by simulated annealing

    2.2 移載工裝預(yù)期軌跡的追蹤控制器設(shè)計

    使用改進人工勢場法規(guī)劃虛擬領(lǐng)航者的避障路徑之后,需要設(shè)計對應(yīng)的軌跡追蹤控制器保障移載工裝的循跡作業(yè).設(shè)計軌跡跟蹤器需要先構(gòu)建移載工裝的運動學(xué)模型.實際作業(yè)環(huán)境下的移載工裝的運動可忽略豎直方向上的運動,因此將被控對象的運動空間設(shè)計成二維平面.基于實際工況,在控制移載工裝的過程中,根據(jù)已有移載工裝的實際參數(shù)和控制變量,輸入對應(yīng)的移載工裝角速度和線速度,并將移載工裝簡化為圖6所示的差速輪驅(qū)動模型,圖中:XL和YL為小車以質(zhì)心C所建立的坐標系X軸與Y軸;r為小車差速輪半徑;2Ra為小車的寬度;p為小車車輪車軸的中心點,D為小車質(zhì)心C離輪軸中心的距離.

    根據(jù)圖6建立的運動學(xué)模型,假定移載工裝為差速輪,其對應(yīng)整體工裝的控制量為[vw]T,即運動速度v和決定方向的角速度w.而相對應(yīng)的狀態(tài)變量為[xyθ]T,即全局坐標系下的x和y以及行駛方向與X軸正半軸的夾角.在圖6中,移載工裝的質(zhì)心在平面坐標系下的速度為vc,其在X,Y上的分量為vxc與vyc,則通過速度分解:

    圖6 移載工裝簡化的運動學(xué)模型示意圖Fig.6 Schematic of simplified kinematic model of transfer tooling

    vxccosθ+vycsinθ=v

    (12)

    通過簡化模型幾何關(guān)系可以得到差速輪模型的移載工裝運動方程,寫作整體系統(tǒng)方程形式:

    (13)

    圖7 純軌跡跟蹤法的幾何關(guān)系示意圖Fig.7 Geometric relationship schematic of pure pursuit tracking method

    根據(jù)圖7的幾何關(guān)系可得距離方程:

    (14)

    并得到相關(guān)曲率的表達式和角速度控制方程:

    (15)

    通過選取較為平緩的速度和合適的預(yù)瞄距離來選取相關(guān)的輸入控制量,從而確保對運動軌跡較好的追蹤效果,并得到虛擬領(lǐng)航者的規(guī)劃運動狀態(tài),根據(jù)提出的隊形結(jié)構(gòu)的幾何關(guān)系變化,進一步計算跟隨者的期望運動狀態(tài).

    2.3 基于自適應(yīng)蒙特卡洛算法的位姿估計

    移載工裝的實際位姿是隊形偏差計算的另一個關(guān)鍵元素.若直接采用測量設(shè)備進行定位獲取實際位姿,傳感器的誤差會直接影響定位的結(jié)果,進而導(dǎo)致隊形偏差計算失準.而結(jié)合濾波算法修正觀測變量的定位方法可以提高實際運動狀態(tài)的觀測精度,解決定位精度不夠的問題.本文構(gòu)建移載工裝的實時定位框架,采用自適應(yīng)蒙特卡洛定位算法進行實際位姿估計.

    蒙特卡洛定位(Monte Carlo Localization, MCL)算法是一種適用于室內(nèi)較小地圖情況下的全局定位算法.該算法基于概率進行定位計算,使用粒子表征移載工裝所處位置的概率大小,初始時刻粒子平均分布在全局地圖上,在移載工裝運動作業(yè)時,粒子與移載工裝同步運動,并根據(jù)移載工裝的位姿篩選出與移載工裝運動狀態(tài)一致的粒子.在一段時間后粒子完成收斂時,當前粒子即表征移載工裝的真實位姿估計,若粒子收斂后表征的位姿是錯誤的,該算法無法做到糾偏和恢復(fù).當粒子數(shù)目較少時,丟失真實位姿附近的粒子的情況常有發(fā)生.而AMCL算法的引入有效地規(guī)避了這一問題.自適應(yīng)蒙特卡洛定位算法是蒙特卡洛定位算法的一種改進.AMCL通過KLD重采樣的方法注入了新的隨機粒子,減小粒子運算量的同時,避免移載工裝“綁架問題”的出現(xiàn).

    首先針對移載工裝的運動狀態(tài)和觀測狀態(tài)進行建模,其狀態(tài)方程為

    (16)

    (17)

    (18)

    而移載工裝的運動狀態(tài)的后驗可靠性估計為

    (19)

    (20)

    式中:Mχ為粒子集的數(shù)目閾值;k′為非空粒子狀態(tài)空間的個數(shù);ε與β分別為真實分布與預(yù)估分布的最大誤差與正態(tài)分布的分位數(shù).根據(jù)KLD采樣的流程可以看出,當粒子對整體地圖覆蓋程度高時,采樣的粒子集數(shù)目降低,可以減小實時定位過程中的運算量;而粒子對地圖覆蓋程度較低時,粒子數(shù)目提高,在誤差協(xié)方差較低的情況下通過隨機引入粒子的方法防止重采樣過程中粒子退化的問題.如圖8所示,AMCL算法運用于移載工裝全局定位并最終收斂,收斂粒子表征移載工裝的估計位姿.

    圖8 AMCL算法的定位收斂過程Fig.8 Location convergence process of AMCL algorithm

    本文通過融合移載工裝的里程計與激光雷達的傳感器信息,將移載工裝運動模型和觀測模型代入AMCL算法,提出合理的粒子提議分布來逼近移載工裝的位姿,其具體估計流程架構(gòu)如圖9所示.

    圖9 AMCL算法運用于移載工裝協(xié)同作業(yè)的定位流程Fig.9 Positioning process of AMCL algorithm applied to collaborative operation of mobile robot

    3 仿真驗證

    3.1 仿真環(huán)境搭建以及參數(shù)設(shè)計

    通過在ROS-Gazebo中建立與現(xiàn)場環(huán)境相關(guān)的實際地圖和差速輪移載工裝模型,并進一步將實際地圖二值化,得到如圖10所示的場景圖,將規(guī)劃的路徑點與控制信號發(fā)送給移載工裝進行編隊位移控制.并在ROS中構(gòu)建在該場景下多移載工裝的仿真模型.

    圖10 仿真作業(yè)空間建模Fig.10 Construction of workspace simulation environment

    根據(jù)搭建好的二值地圖,通過改進人工勢場法來規(guī)劃虛擬領(lǐng)航者和跟隨者的期望路徑.其中載工裝的具體參數(shù)以及隊列期望距離如表1所示,導(dǎo)航方式為激光定位與第一構(gòu)建,并得到相應(yīng)的虛擬結(jié)構(gòu)剛性隊列的幾何中心路徑圖.

    表1 移載工裝技術(shù)參數(shù)Tab.1 Technical parameter of transfer tooling

    在移載工裝的運動空間中建立引力、斥力場,選取的引力系數(shù)η=1/70,斥力系數(shù)ξ=8/7,虛擬領(lǐng)航者與作業(yè)空間中障礙物的安全距離根據(jù)隊列距離與自身尺寸設(shè)置為35 cm.作業(yè)空間內(nèi)的總體引力場、斥力場以及總勢場如圖11所示,圖中:Urep為作業(yè)空間內(nèi)的斥力;Uatt為作業(yè)空間內(nèi)的引力.

    圖11 移載工裝作業(yè)空間內(nèi)勢場變化圖Fig.11 Variation diagram of potential field in workspace of multiple mobile robots

    通過給定參數(shù)的移載工裝,在Simulink中建立符合標準的基于差速輪驅(qū)動的移載工裝運動模型,并對期望軌跡通過純跟蹤法進行追蹤,得到虛擬領(lǐng)航者相應(yīng)的期望速度與角速度如圖12所示,其中設(shè)定預(yù)瞄距離下限值為5 cm.

    圖12 差速輪移載工裝運動模型Fig.12 Motion model of differential wheel transfer tooling

    對于整體的測量系統(tǒng),采用車載激光雷達的出廠誤差作為測量誤差,結(jié)合實時控制的運動方程產(chǎn)生的誤差進行濾波從而對實際位姿與運動狀態(tài)進行估計與修正.其中距離測量誤差的初始提議分布為N(μ1,σ1) (μ1為均值,σ1為方差),角度測量誤差的初始提議分布為N(μ2,σ2) (μ2為均值,σ2為方差),均假設(shè)為高斯分布,協(xié)方差與均值由表1參考獲得.得到實際跟隨者移載工裝的狀態(tài)變量最優(yōu)值后,再通過反步法設(shè)定的控制策略,進行隊列的糾偏仿真.

    3.2 仿真結(jié)果分析

    在進行避障路徑規(guī)劃中使用傳統(tǒng)人工勢場法,即不引入模擬退火法逃離局部最優(yōu)點時,在目標點靠近障礙物的過程里,移載工裝會陷入勢場中的局部最優(yōu)點而小距離震蕩,最終無法到達目標點.移載工裝在勢場中停滯情況與整體路徑如圖13所示.

    圖13 傳統(tǒng)人工勢場法下失敗的路徑規(guī)劃Fig.13 Failed path planning in traditional artificial potential field method

    結(jié)合模擬退火法對陷入局部最優(yōu)的情況進行了改進.設(shè)定停滯震蕩的距離判定范圍為3 cm,并進行模擬退火法進行跳脫,其改進后路線如圖14所示.

    圖14 改進人工勢場法成功規(guī)劃目標路徑Fig.14 Target path planed by improved artificial potential field method

    設(shè)定預(yù)定路徑之后,使目標小車模型對路徑進行了軌跡追蹤,保持領(lǐng)航者速度10 cm/s勻速行駛進行編隊控制,通過計算得到的輸入控制量如圖15所示,圖中:T為控制時間.

    圖15 虛擬領(lǐng)航者輸入運動變量Fig.15 Input movement variables of virtual pilot

    確定系統(tǒng)輸入控制量后,使用Simulink搭建的移載工裝純軌跡跟蹤法模型進行軌跡追蹤仿真,得到圖16所示的追蹤效果和對應(yīng)誤差圖像,圖中E為移載工裝跟蹤運動誤差.仿真結(jié)果表明,輸入控制的角速度變化較平緩,追蹤偏差逐漸收斂于2.2 cm以內(nèi),滿足追蹤的需求.

    圖16 純軌跡跟蹤下的期望軌跡與誤差Fig.16 Desired trajectory and error in pure trajectory tracking

    在仿真環(huán)境中讀取移載工裝的實際位姿,以激光雷達作為測量設(shè)備.根據(jù)蒙特卡洛定位以及自適應(yīng)蒙特卡洛定位方法估計移載工裝的實際位姿,并與直接使用激光雷達測量的方法進行對比,結(jié)果如圖17所示,圖中:Eθ為角度追蹤誤差;Edis為距離跟蹤誤差.對比可得,使用自適應(yīng)蒙特卡洛定位的方法可以將角度誤差降低到0.01° 以下,比直接使用測量設(shè)備的0.5° 測量誤差有較大降低.距離方面也將誤差收斂在0.8 cm以內(nèi),兩者的誤差協(xié)方差系數(shù)也相較于MCL定位算法和直接使用測量設(shè)備進行定位的誤差協(xié)方差系數(shù)小.

    圖17 自適應(yīng)蒙特卡洛定位方法誤差與其他方法誤差對比Fig.17 Comparison of error of adaptive Monte Carlo localization method and other methods

    利用反步法設(shè)計的控制策略對整體隊形進行保持.對于反步法中k1和k2參數(shù)的選取,由于4臺實際跟隨者關(guān)于虛擬領(lǐng)航者幾何對稱,基于誤差的控制策略可選取相同參數(shù),所以k1和k2參數(shù)只需要對單臺跟隨者進行設(shè)計,引入表征控制效果的指標:

    (21)

    式中:Δx、Δy及Δθ為實際運動與期望運動的誤差值;α為比例系數(shù),取60,并將符合收斂的參數(shù)域中的指標進行歸一化:

    (22)

    式中:Si為第i臺移載工裝的評價指標歸一化結(jié)果;si為第i臺評價指標結(jié)果;S為多移載工裝評價指標之和.通過仿真得到不同參數(shù)變化情況下,移載工裝在跟隨過程中的評價指標變化情況,如圖18所示,并選取指標極大值位置的參數(shù)值為[1.02, 1.47],即反步法中的控制參數(shù)[k1,k2], 紅點為極大值.

    圖18 反步法控制效果與參數(shù)選取關(guān)系Fig.18 Relationship between backstepping control effect and parameter selection

    圖19 跟隨者理想運動軌跡設(shè)計Fig.19 Ideal movement trajectory design of follower

    表2 跟隨機器人三方向追蹤時間Tab.2 Track time in three directions of robot follower

    圖20 跟隨者誤差指標隨時間變化曲線Fig.20 Follower error metric versus time

    可以看出,在控制量有一定的擾動下,移載工裝依然能夠在6.2 s內(nèi)收斂到期望的位姿,達到整體的編隊要求.

    4 結(jié)語

    針對多移載工裝協(xié)同作業(yè)的控制問題,提出了一種基于反步法的多移載工裝協(xié)同作業(yè)編隊控制策略.建立了移載工裝的運動學(xué)模型,提出了基于改進人工勢場法和純軌跡追蹤法的期望運動狀態(tài)規(guī)劃方法,以及基于自適應(yīng)蒙特卡洛定位的實際運動狀態(tài)估計方法,與直接使用測量設(shè)備相比,角度誤差由 0.5° 降低至 0.01°,位置誤差由2 cm降低至 0.8 cm,精度提高.構(gòu)建了仿真模型進行驗證,隊形誤差在6.2 s內(nèi)達到收斂,滿足多移載工裝協(xié)同作業(yè)的條件.

    猜你喜歡
    領(lǐng)航者勢場位姿
    漁船的“領(lǐng)航者”和“安全衛(wèi)士”
    智慧少年(2022年8期)2022-05-30 10:48:04
    基于Frenet和改進人工勢場的在軌規(guī)避路徑自主規(guī)劃
    基于改進人工勢場方法的多無人機編隊避障算法
    “益源慶”打造中國高品質(zhì)食醋領(lǐng)航者
    IC訪談:“智慧政府”領(lǐng)航者——新華三集團
    智能城市(2018年8期)2018-07-06 01:11:00
    庫車坳陷南斜坡古流體勢場對陸相油氣運聚的控制
    做純棉數(shù)碼印花領(lǐng)航者
    基于共面直線迭代加權(quán)最小二乘的相機位姿估計
    基于CAD模型的單目六自由度位姿測量
    基于偶極勢場的自主水下航行器回塢導(dǎo)引算法
    国产亚洲欧美在线一区二区| 国产精品自产拍在线观看55亚洲| 国产有黄有色有爽视频| 久久午夜亚洲精品久久| 高清av免费在线| 亚洲国产欧美网| 不卡一级毛片| 国产精品香港三级国产av潘金莲| 亚洲av电影在线进入| 久久久久国内视频| 中出人妻视频一区二区| netflix在线观看网站| 国产欧美日韩一区二区三区在线| 午夜福利,免费看| 夜夜爽天天搞| 熟女少妇亚洲综合色aaa.| 亚洲一区二区三区不卡视频| 99久久人妻综合| 琪琪午夜伦伦电影理论片6080| 在线观看免费日韩欧美大片| 午夜久久久在线观看| 亚洲专区字幕在线| 亚洲精品在线观看二区| 成人免费观看视频高清| 亚洲人成电影免费在线| 免费观看精品视频网站| 999久久久精品免费观看国产| 丰满的人妻完整版| 中亚洲国语对白在线视频| 人妻久久中文字幕网| 中文字幕精品免费在线观看视频| 国产野战对白在线观看| 极品教师在线免费播放| 夜夜夜夜夜久久久久| 真人做人爱边吃奶动态| 18禁观看日本| 美女高潮到喷水免费观看| 欧美色视频一区免费| 久久人妻av系列| 女同久久另类99精品国产91| 国产欧美日韩一区二区三| 母亲3免费完整高清在线观看| 99久久综合精品五月天人人| 欧美性长视频在线观看| 啦啦啦免费观看视频1| 黄频高清免费视频| 大码成人一级视频| 欧美乱色亚洲激情| 在线视频色国产色| 精品免费久久久久久久清纯| 狂野欧美激情性xxxx| 搡老熟女国产l中国老女人| 嫩草影视91久久| 女生性感内裤真人,穿戴方法视频| 久久午夜亚洲精品久久| 国产精品电影一区二区三区| 女人被躁到高潮嗷嗷叫费观| 久久香蕉国产精品| 女警被强在线播放| 男男h啪啪无遮挡| 好男人电影高清在线观看| 国产三级黄色录像| 黄色片一级片一级黄色片| 可以在线观看毛片的网站| 色哟哟哟哟哟哟| 国产精品二区激情视频| 中文欧美无线码| 黄片播放在线免费| 久久婷婷成人综合色麻豆| 亚洲成av片中文字幕在线观看| 如日韩欧美国产精品一区二区三区| 91老司机精品| 免费在线观看影片大全网站| 女生性感内裤真人,穿戴方法视频| 99热国产这里只有精品6| 精品一区二区三区av网在线观看| 黄色 视频免费看| 免费高清视频大片| 国产欧美日韩综合在线一区二区| 一级毛片高清免费大全| 免费看a级黄色片| 俄罗斯特黄特色一大片| 久久久久国产一级毛片高清牌| 女性被躁到高潮视频| 啦啦啦免费观看视频1| 亚洲黑人精品在线| 黄色丝袜av网址大全| 亚洲五月色婷婷综合| 亚洲激情在线av| 十八禁人妻一区二区| 国产精品一区二区在线不卡| 亚洲成人免费电影在线观看| 亚洲精品美女久久久久99蜜臀| 一区在线观看完整版| 国产激情欧美一区二区| 波多野结衣高清无吗| 日韩视频一区二区在线观看| 女人被狂操c到高潮| 不卡av一区二区三区| 国产一区在线观看成人免费| 亚洲精华国产精华精| 国产片内射在线| 亚洲三区欧美一区| 麻豆一二三区av精品| 麻豆久久精品国产亚洲av | 久久草成人影院| 日韩国内少妇激情av| 在线观看免费视频网站a站| 一级片免费观看大全| av天堂久久9| 午夜激情av网站| 另类亚洲欧美激情| 麻豆国产av国片精品| 日日摸夜夜添夜夜添小说| 黑人巨大精品欧美一区二区蜜桃| 欧美激情高清一区二区三区| 欧美黄色淫秽网站| 亚洲色图av天堂| 免费av毛片视频| 国产色视频综合| 久久影院123| 丰满饥渴人妻一区二区三| www.999成人在线观看| 亚洲人成电影免费在线| 中文字幕精品免费在线观看视频| 国产精品久久久人人做人人爽| 91国产中文字幕| 人人澡人人妻人| 色哟哟哟哟哟哟| 午夜福利在线免费观看网站| 婷婷丁香在线五月| 国产视频一区二区在线看| 天堂动漫精品| 亚洲免费av在线视频| 色老头精品视频在线观看| 少妇被粗大的猛进出69影院| 国产熟女午夜一区二区三区| 欧美乱码精品一区二区三区| 国产主播在线观看一区二区| 两性夫妻黄色片| 亚洲中文日韩欧美视频| 在线视频色国产色| 久久精品成人免费网站| 免费一级毛片在线播放高清视频 | 免费高清在线观看日韩| 国产成人欧美在线观看| 女同久久另类99精品国产91| 视频区欧美日本亚洲| 国产97色在线日韩免费| 亚洲精品一卡2卡三卡4卡5卡| 99热只有精品国产| 精品国产一区二区久久| a级毛片黄视频| 午夜福利,免费看| 美女 人体艺术 gogo| 老司机深夜福利视频在线观看| 国产高清激情床上av| 久久精品亚洲av国产电影网| 看黄色毛片网站| 一级a爱片免费观看的视频| 中亚洲国语对白在线视频| 亚洲 欧美一区二区三区| 精品人妻1区二区| 久久亚洲真实| 窝窝影院91人妻| 韩国精品一区二区三区| 欧美成人性av电影在线观看| 成人影院久久| 日韩欧美国产一区二区入口| 久久亚洲真实| 麻豆一二三区av精品| 啦啦啦免费观看视频1| 嫁个100分男人电影在线观看| 日日夜夜操网爽| 亚洲美女黄片视频| 这个男人来自地球电影免费观看| 可以在线观看毛片的网站| 波多野结衣av一区二区av| 久久精品成人免费网站| netflix在线观看网站| 精品人妻在线不人妻| tocl精华| 国产精品乱码一区二三区的特点 | 嫁个100分男人电影在线观看| 国产成人精品久久二区二区免费| 在线观看免费视频网站a站| 欧美色视频一区免费| 又黄又粗又硬又大视频| 日韩欧美三级三区| 国产麻豆69| 手机成人av网站| 天堂√8在线中文| 性欧美人与动物交配| 一二三四在线观看免费中文在| 欧美日本中文国产一区发布| 成人亚洲精品av一区二区 | 狂野欧美激情性xxxx| 日本黄色视频三级网站网址| 久久人妻福利社区极品人妻图片| 伦理电影免费视频| 99国产极品粉嫩在线观看| 精品福利永久在线观看| 看黄色毛片网站| 精品人妻在线不人妻| 女警被强在线播放| 侵犯人妻中文字幕一二三四区| 亚洲中文av在线| 欧美另类亚洲清纯唯美| www.自偷自拍.com| www.www免费av| 黑人操中国人逼视频| 国产av一区二区精品久久| bbb黄色大片| 老熟妇乱子伦视频在线观看| 亚洲中文av在线| 法律面前人人平等表现在哪些方面| 老司机靠b影院| 18禁美女被吸乳视频| 人人澡人人妻人| 丁香欧美五月| 大香蕉久久成人网| 久久热在线av| 亚洲全国av大片| 久久久精品欧美日韩精品| 两性夫妻黄色片| 午夜免费激情av| 亚洲在线自拍视频| 欧美不卡视频在线免费观看 | videosex国产| 久久久久国产一级毛片高清牌| 亚洲欧美激情在线| 久久久久久久午夜电影 | 日本五十路高清| 国产成人精品久久二区二区91| 欧美大码av| 亚洲国产欧美日韩在线播放| 国产成人精品在线电影| 69精品国产乱码久久久| 99久久99久久久精品蜜桃| 亚洲精品在线观看二区| 国产亚洲精品久久久久5区| 国产单亲对白刺激| 久久国产精品影院| 亚洲人成电影观看| 久久人人爽av亚洲精品天堂| 一级黄色大片毛片| a级片在线免费高清观看视频| 一区在线观看完整版| 国产成人精品久久二区二区免费| 久久国产精品男人的天堂亚洲| 欧美成狂野欧美在线观看| 无限看片的www在线观看| 男女做爰动态图高潮gif福利片 | 视频在线观看一区二区三区| 99国产精品99久久久久| 国产真人三级小视频在线观看| 啦啦啦 在线观看视频| 高清av免费在线| 18禁观看日本| 欧美成人性av电影在线观看| 9色porny在线观看| 欧美av亚洲av综合av国产av| 欧美日韩亚洲综合一区二区三区_| 国产精品久久电影中文字幕| 久久婷婷成人综合色麻豆| 久久人妻福利社区极品人妻图片| 欧美另类亚洲清纯唯美| 少妇粗大呻吟视频| 满18在线观看网站| av天堂久久9| 午夜视频精品福利| 满18在线观看网站| 一级毛片女人18水好多| 女人高潮潮喷娇喘18禁视频| 男女下面插进去视频免费观看| 高潮久久久久久久久久久不卡| 最好的美女福利视频网| 在线观看午夜福利视频| 黄色毛片三级朝国网站| 男女午夜视频在线观看| 18禁美女被吸乳视频| 久久热在线av| 亚洲少妇的诱惑av| 欧美在线一区亚洲| 丰满迷人的少妇在线观看| 新久久久久国产一级毛片| 久久亚洲真实| 精品高清国产在线一区| 国产高清激情床上av| 麻豆国产av国片精品| 又黄又粗又硬又大视频| 丰满的人妻完整版| 国产熟女午夜一区二区三区| 久久精品国产综合久久久| 欧美在线黄色| 高清毛片免费观看视频网站 | 丁香欧美五月| 国产av又大| 黑人操中国人逼视频| 少妇被粗大的猛进出69影院| 亚洲欧美激情综合另类| 国产精品免费视频内射| 亚洲精品美女久久av网站| 免费不卡黄色视频| 两性午夜刺激爽爽歪歪视频在线观看 | 欧美精品啪啪一区二区三区| av视频免费观看在线观看| 后天国语完整版免费观看| 日韩免费高清中文字幕av| 亚洲第一青青草原| 精品熟女少妇八av免费久了| 精品福利观看| 女生性感内裤真人,穿戴方法视频| 黄色片一级片一级黄色片| 757午夜福利合集在线观看| 一a级毛片在线观看| 啪啪无遮挡十八禁网站| 高清在线国产一区| 一级黄色大片毛片| 国产三级黄色录像| 欧美丝袜亚洲另类 | 国产国语露脸激情在线看| 女人爽到高潮嗷嗷叫在线视频| 亚洲精品久久成人aⅴ小说| 在线观看午夜福利视频| 高潮久久久久久久久久久不卡| 亚洲精品国产区一区二| 亚洲精品美女久久久久99蜜臀| 夜夜夜夜夜久久久久| 又紧又爽又黄一区二区| 国产精品九九99| 一进一出抽搐动态| 日韩国内少妇激情av| 久久精品国产清高在天天线| 中文字幕人妻熟女乱码| 欧美人与性动交α欧美软件| 黄片小视频在线播放| 无人区码免费观看不卡| 757午夜福利合集在线观看| 在线天堂中文资源库| 自拍欧美九色日韩亚洲蝌蚪91| 精品电影一区二区在线| 18禁黄网站禁片午夜丰满| 99久久久亚洲精品蜜臀av| 亚洲五月婷婷丁香| 国产无遮挡羞羞视频在线观看| 国产黄色免费在线视频| 手机成人av网站| 高清黄色对白视频在线免费看| 老司机深夜福利视频在线观看| 欧美日韩亚洲综合一区二区三区_| 午夜日韩欧美国产| 极品教师在线免费播放| 成人永久免费在线观看视频| 天堂中文最新版在线下载| 韩国av一区二区三区四区| 亚洲av电影在线进入| 热re99久久国产66热| 视频区欧美日本亚洲| 久久 成人 亚洲| 88av欧美| 亚洲色图综合在线观看| 日本黄色日本黄色录像| 国产成人免费无遮挡视频| 久久香蕉国产精品| 午夜日韩欧美国产| 久久中文字幕一级| 老司机深夜福利视频在线观看| 欧美日韩乱码在线| 不卡av一区二区三区| 精品免费久久久久久久清纯| 欧美性长视频在线观看| 国产精品久久久久久人妻精品电影| 欧美性长视频在线观看| 一个人观看的视频www高清免费观看 | 在线观看免费高清a一片| 日韩三级视频一区二区三区| 丁香六月欧美| 成人亚洲精品一区在线观看| 可以在线观看毛片的网站| 19禁男女啪啪无遮挡网站| 日韩大尺度精品在线看网址 | 后天国语完整版免费观看| 色哟哟哟哟哟哟| 一级作爱视频免费观看| www.自偷自拍.com| 性欧美人与动物交配| 天天影视国产精品| 精品久久久久久成人av| 国产一卡二卡三卡精品| 淫妇啪啪啪对白视频| 欧美不卡视频在线免费观看 | 中文亚洲av片在线观看爽| a级毛片在线看网站| 水蜜桃什么品种好| 亚洲人成电影观看| 成人av一区二区三区在线看| 很黄的视频免费| 女人高潮潮喷娇喘18禁视频| 精品午夜福利视频在线观看一区| 两个人免费观看高清视频| 黑人猛操日本美女一级片| 精品国产美女av久久久久小说| 国产av一区在线观看免费| 在线永久观看黄色视频| 人人妻人人添人人爽欧美一区卜| 亚洲中文av在线| 亚洲午夜理论影院| 国产伦人伦偷精品视频| 欧美日韩av久久| 在线观看午夜福利视频| 老司机靠b影院| 18禁黄网站禁片午夜丰满| 黑人巨大精品欧美一区二区蜜桃| 亚洲成国产人片在线观看| 国产一区在线观看成人免费| 级片在线观看| 中文字幕人妻丝袜一区二区| 免费一级毛片在线播放高清视频 | 97超级碰碰碰精品色视频在线观看| 村上凉子中文字幕在线| 欧美中文综合在线视频| 欧美老熟妇乱子伦牲交| 国产激情欧美一区二区| 国产精品av久久久久免费| 亚洲自偷自拍图片 自拍| 日韩av在线大香蕉| 激情视频va一区二区三区| 亚洲一卡2卡3卡4卡5卡精品中文| 亚洲av成人不卡在线观看播放网| x7x7x7水蜜桃| 国产又爽黄色视频| 成人影院久久| 国产三级黄色录像| 超碰成人久久| 丝袜人妻中文字幕| 身体一侧抽搐| x7x7x7水蜜桃| 一a级毛片在线观看| 级片在线观看| 女生性感内裤真人,穿戴方法视频| 亚洲av成人一区二区三| 51午夜福利影视在线观看| 国产精品国产高清国产av| 丝袜人妻中文字幕| 天天躁夜夜躁狠狠躁躁| 在线av久久热| 久久精品aⅴ一区二区三区四区| 久久国产精品人妻蜜桃| 久久精品人人爽人人爽视色| 免费在线观看视频国产中文字幕亚洲| av超薄肉色丝袜交足视频| 国产亚洲av高清不卡| 午夜精品久久久久久毛片777| 99久久人妻综合| 亚洲欧美精品综合久久99| 精品人妻在线不人妻| 午夜精品国产一区二区电影| 国产极品粉嫩免费观看在线| 日本欧美视频一区| 丰满迷人的少妇在线观看| 国产三级黄色录像| 老司机亚洲免费影院| 视频在线观看一区二区三区| 黄色 视频免费看| 色婷婷av一区二区三区视频| 久热这里只有精品99| 精品国产乱子伦一区二区三区| 国产免费现黄频在线看| 免费日韩欧美在线观看| 亚洲人成电影观看| 国产精品影院久久| √禁漫天堂资源中文www| 91精品三级在线观看| 黑人操中国人逼视频| 日韩av在线大香蕉| 免费在线观看影片大全网站| 国产成人欧美在线观看| 国产精品免费一区二区三区在线| 91精品国产国语对白视频| 亚洲av第一区精品v没综合| 国产精品亚洲一级av第二区| 精品国产一区二区久久| 亚洲片人在线观看| 国产激情欧美一区二区| 亚洲av第一区精品v没综合| 亚洲人成网站在线播放欧美日韩| 精品国产一区二区久久| 一区二区日韩欧美中文字幕| 亚洲精品av麻豆狂野| 51午夜福利影视在线观看| 亚洲三区欧美一区| 99久久精品国产亚洲精品| 日韩欧美一区视频在线观看| 亚洲精品av麻豆狂野| 亚洲七黄色美女视频| 一边摸一边做爽爽视频免费| 亚洲人成伊人成综合网2020| 久久精品aⅴ一区二区三区四区| xxxhd国产人妻xxx| 一夜夜www| 国产亚洲av高清不卡| 99久久国产精品久久久| 久久狼人影院| 人妻丰满熟妇av一区二区三区| 国产精品自产拍在线观看55亚洲| 亚洲专区国产一区二区| 国产精品美女特级片免费视频播放器 | 一区福利在线观看| 日日夜夜操网爽| 日日干狠狠操夜夜爽| 久久精品91蜜桃| aaaaa片日本免费| 久热这里只有精品99| 亚洲精品久久午夜乱码| 天堂√8在线中文| 热re99久久国产66热| 久久人妻福利社区极品人妻图片| 午夜日韩欧美国产| 欧美精品亚洲一区二区| 免费观看人在逋| av电影中文网址| 国产成人精品在线电影| 中文字幕高清在线视频| 成人亚洲精品一区在线观看| 91精品国产国语对白视频| 午夜福利免费观看在线| 欧美日韩国产mv在线观看视频| 天天添夜夜摸| 又黄又粗又硬又大视频| 亚洲七黄色美女视频| 777久久人妻少妇嫩草av网站| 中亚洲国语对白在线视频| 麻豆成人av在线观看| www.www免费av| 热re99久久精品国产66热6| 久9热在线精品视频| 欧美+亚洲+日韩+国产| e午夜精品久久久久久久| 亚洲国产精品sss在线观看 | 欧美中文综合在线视频| 亚洲国产看品久久| 美女扒开内裤让男人捅视频| 国产免费av片在线观看野外av| 欧美大码av| 亚洲熟妇中文字幕五十中出 | 亚洲精品国产精品久久久不卡| 中文字幕高清在线视频| av在线天堂中文字幕 | 精品乱码久久久久久99久播| 黑人操中国人逼视频| 国产精品久久视频播放| 乱人伦中国视频| 国产片内射在线| 极品教师在线免费播放| 国产99白浆流出| 精品午夜福利视频在线观看一区| 亚洲精品国产精品久久久不卡| 国产精品一区二区精品视频观看| 精品无人区乱码1区二区| 国产欧美日韩一区二区三| 好看av亚洲va欧美ⅴa在| 男人的好看免费观看在线视频 | 国产在线精品亚洲第一网站| 少妇裸体淫交视频免费看高清 | 日韩大码丰满熟妇| 久久国产乱子伦精品免费另类| 怎么达到女性高潮| av网站免费在线观看视频| 波多野结衣高清无吗| 久久影院123| 一夜夜www| 三上悠亚av全集在线观看| 日本三级黄在线观看| 亚洲狠狠婷婷综合久久图片| 在线观看免费视频日本深夜| 国产成人欧美在线观看| 啦啦啦 在线观看视频| 水蜜桃什么品种好| 两人在一起打扑克的视频| 中文字幕人妻丝袜一区二区| 欧美不卡视频在线免费观看 | 国产蜜桃级精品一区二区三区| 亚洲av成人一区二区三| 久久性视频一级片| 一a级毛片在线观看| 色播在线永久视频| 超色免费av| 美女大奶头视频| 久久国产亚洲av麻豆专区| cao死你这个sao货| 日本五十路高清| 日日干狠狠操夜夜爽| 大型黄色视频在线免费观看| 欧美大码av| 满18在线观看网站| 久久欧美精品欧美久久欧美| 国产aⅴ精品一区二区三区波| 亚洲欧美一区二区三区黑人| 黄网站色视频无遮挡免费观看| 精品午夜福利视频在线观看一区| 成人亚洲精品一区在线观看| 精品国产超薄肉色丝袜足j| 成熟少妇高潮喷水视频| 日本黄色日本黄色录像| 久热爱精品视频在线9| 国产单亲对白刺激| 成人免费观看视频高清| 天堂俺去俺来也www色官网| 欧美日韩亚洲国产一区二区在线观看| 露出奶头的视频| 色哟哟哟哟哟哟| 国内久久婷婷六月综合欲色啪| 久久中文字幕人妻熟女| 欧美一区二区精品小视频在线|