• <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)引算法
    欧美成人一区二区免费高清观看 | 两个人免费观看高清视频| 成人18禁在线播放| 99热只有精品国产| 神马国产精品三级电影在线观看 | 中文字幕人成人乱码亚洲影| 老司机深夜福利视频在线观看| 法律面前人人平等表现在哪些方面| 久久久久久久久久久久大奶| 99在线人妻在线中文字幕| 波多野结衣高清无吗| 777久久人妻少妇嫩草av网站| 丰满人妻熟妇乱又伦精品不卡| 国产精品美女特级片免费视频播放器 | 欧美日韩乱码在线| 精品久久久久久,| 国产熟女xx| 精品午夜福利视频在线观看一区| 午夜老司机福利片| 日本 欧美在线| 国产三级黄色录像| 精品国产超薄肉色丝袜足j| 国产亚洲欧美98| 日日干狠狠操夜夜爽| 91麻豆精品激情在线观看国产| 国产午夜福利久久久久久| 一级毛片精品| 99精品久久久久人妻精品| 亚洲五月天丁香| 亚洲片人在线观看| 午夜福利18| 欧美一区二区精品小视频在线| 中文字幕精品免费在线观看视频| 免费观看精品视频网站| 高清在线国产一区| 久久伊人香网站| 久久这里只有精品19| 成年人黄色毛片网站| 满18在线观看网站| 日本精品一区二区三区蜜桃| 久久久国产欧美日韩av| 亚洲国产高清在线一区二区三 | 久久精品国产99精品国产亚洲性色 | 人人妻人人爽人人添夜夜欢视频| 18禁国产床啪视频网站| 91字幕亚洲| 在线观看免费视频日本深夜| 色综合婷婷激情| 久久人妻av系列| 国产成人啪精品午夜网站| 国产极品粉嫩免费观看在线| 啪啪无遮挡十八禁网站| 嫩草影院精品99| 19禁男女啪啪无遮挡网站| 黑人巨大精品欧美一区二区蜜桃| 黑人操中国人逼视频| 多毛熟女@视频| 99在线视频只有这里精品首页| 露出奶头的视频| 在线观看免费视频网站a站| 午夜福利一区二区在线看| 国产av一区在线观看免费| 国产麻豆69| 亚洲精品久久国产高清桃花| 香蕉丝袜av| 美女午夜性视频免费| ponron亚洲| 中文亚洲av片在线观看爽| 国产亚洲av高清不卡| 精品卡一卡二卡四卡免费| 9色porny在线观看| 色综合欧美亚洲国产小说| 精品午夜福利视频在线观看一区| 欧美乱妇无乱码| 国产高清有码在线观看视频 | 午夜福利欧美成人| 精品国产乱子伦一区二区三区| 很黄的视频免费| 精品久久久久久久毛片微露脸| 91字幕亚洲| 日本在线视频免费播放| 午夜老司机福利片| 在线观看午夜福利视频| 久久精品人人爽人人爽视色| 日韩欧美一区视频在线观看| 亚洲全国av大片| 国产精品免费视频内射| 麻豆一二三区av精品| 美女扒开内裤让男人捅视频| 一区在线观看完整版| 亚洲七黄色美女视频| 日本精品一区二区三区蜜桃| 97人妻精品一区二区三区麻豆 | 国产成人一区二区三区免费视频网站| 欧美成人性av电影在线观看| 一二三四社区在线视频社区8| 亚洲av成人av| 99热只有精品国产| 久久精品影院6| 岛国视频午夜一区免费看| 欧美激情 高清一区二区三区| 亚洲第一av免费看| 男男h啪啪无遮挡| 国产在线精品亚洲第一网站| 高清在线国产一区| 国产aⅴ精品一区二区三区波| 欧美大码av| 成人18禁高潮啪啪吃奶动态图| 精品久久久久久成人av| 两人在一起打扑克的视频| av片东京热男人的天堂| 亚洲一区高清亚洲精品| 国产极品粉嫩免费观看在线| 午夜精品在线福利| 欧美成人性av电影在线观看| 电影成人av| 一夜夜www| 亚洲久久久国产精品| 国产三级在线视频| 日韩免费av在线播放| 亚洲专区中文字幕在线| 国产午夜福利久久久久久| 国产视频一区二区在线看| 成人国产综合亚洲| 一本大道久久a久久精品| 少妇 在线观看| 久久婷婷成人综合色麻豆| 男人舔女人下体高潮全视频| 亚洲av第一区精品v没综合| 桃色一区二区三区在线观看| 国产99久久九九免费精品| 国产精品1区2区在线观看.| 国产野战对白在线观看| 美女高潮到喷水免费观看| 日韩av在线大香蕉| 日韩有码中文字幕| 久久久国产成人精品二区| 天堂影院成人在线观看| 亚洲午夜理论影院| 老司机在亚洲福利影院| av中文乱码字幕在线| 国产精品一区二区三区四区久久 | 欧美日韩精品网址| 男人舔女人的私密视频| 婷婷六月久久综合丁香| 欧美日本中文国产一区发布| 国产亚洲精品久久久久5区| 青草久久国产| www.熟女人妻精品国产| 精品第一国产精品| 精品国产乱子伦一区二区三区| 久久精品国产综合久久久| 九色国产91popny在线| 脱女人内裤的视频| 精品久久久久久久人妻蜜臀av | 看片在线看免费视频| 亚洲 欧美一区二区三区| 一区二区三区国产精品乱码| 久久久久国产精品人妻aⅴ院| 国产视频一区二区在线看| 变态另类成人亚洲欧美熟女 | 一二三四社区在线视频社区8| 他把我摸到了高潮在线观看| 久热这里只有精品99| 亚洲国产精品999在线| 日本免费一区二区三区高清不卡 | 国产伦人伦偷精品视频| 久久久久久久午夜电影| 免费高清视频大片| 欧美午夜高清在线| 久久亚洲精品不卡| 国产精品久久久av美女十八| 久久人人97超碰香蕉20202| 每晚都被弄得嗷嗷叫到高潮| 亚洲欧美日韩另类电影网站| 99国产精品一区二区三区| 国产熟女xx| 色综合婷婷激情| 国产激情欧美一区二区| 国内精品久久久久精免费| 日韩欧美国产在线观看| 免费久久久久久久精品成人欧美视频| av片东京热男人的天堂| 99久久国产精品久久久| 日韩有码中文字幕| 精品无人区乱码1区二区| 午夜老司机福利片| 国产区一区二久久| 桃色一区二区三区在线观看| 国产精品秋霞免费鲁丝片| 黄色丝袜av网址大全| 制服人妻中文乱码| 黄色丝袜av网址大全| 国产成人精品久久二区二区免费| 国产伦一二天堂av在线观看| 国语自产精品视频在线第100页| 欧美日韩黄片免| 精品国产超薄肉色丝袜足j| 纯流量卡能插随身wifi吗| 老熟妇仑乱视频hdxx| 日本撒尿小便嘘嘘汇集6| 成人三级做爰电影| 亚洲天堂国产精品一区在线| 欧美大码av| 亚洲午夜精品一区,二区,三区| 老司机在亚洲福利影院| 亚洲精品在线美女| 动漫黄色视频在线观看| 亚洲一区二区三区色噜噜| 男人舔女人的私密视频| 美女午夜性视频免费| 国产三级黄色录像| 国产av又大| 亚洲精品国产色婷婷电影| 成人18禁高潮啪啪吃奶动态图| 99久久99久久久精品蜜桃| 欧美精品亚洲一区二区| 久久欧美精品欧美久久欧美| 老司机靠b影院| 波多野结衣av一区二区av| 欧美黄色片欧美黄色片| 99精品欧美一区二区三区四区| 亚洲,欧美精品.| 亚洲狠狠婷婷综合久久图片| 精品国产乱码久久久久久男人| 1024视频免费在线观看| 在线观看日韩欧美| 国产国语露脸激情在线看| 亚洲人成伊人成综合网2020| 亚洲精品av麻豆狂野| 老熟妇乱子伦视频在线观看| 亚洲电影在线观看av| 午夜免费成人在线视频| 亚洲精品久久成人aⅴ小说| 99热只有精品国产| 黄频高清免费视频| 免费搜索国产男女视频| 禁无遮挡网站| 精品一区二区三区四区五区乱码| 午夜久久久久精精品| 无限看片的www在线观看| 一边摸一边抽搐一进一出视频| 精品一区二区三区视频在线观看免费| 男人舔女人的私密视频| 丁香欧美五月| 日韩欧美三级三区| 国产亚洲欧美在线一区二区| 亚洲九九香蕉| 久久久久久久久久久久大奶| 国产亚洲av嫩草精品影院| 国产精华一区二区三区| 精品熟女少妇八av免费久了| 首页视频小说图片口味搜索| 国产成人啪精品午夜网站| 亚洲情色 制服丝袜| 无限看片的www在线观看| 悠悠久久av| 精品乱码久久久久久99久播| 亚洲中文av在线| 亚洲精华国产精华精| 久久草成人影院| 午夜免费鲁丝| 岛国在线观看网站| 每晚都被弄得嗷嗷叫到高潮| 免费高清视频大片| 亚洲人成77777在线视频| 亚洲精华国产精华精| 久久久国产成人精品二区| 免费观看精品视频网站| 国语自产精品视频在线第100页| 亚洲自拍偷在线| 欧美日本中文国产一区发布| 男人的好看免费观看在线视频 | 啦啦啦观看免费观看视频高清 | 99在线人妻在线中文字幕| 日日干狠狠操夜夜爽| 精品熟女少妇八av免费久了| 亚洲第一欧美日韩一区二区三区| 人妻丰满熟妇av一区二区三区| 国产成+人综合+亚洲专区| 不卡一级毛片| 欧美av亚洲av综合av国产av| 日韩欧美一区二区三区在线观看| 俄罗斯特黄特色一大片| 日韩高清综合在线| 两人在一起打扑克的视频| 最近最新中文字幕大全电影3 | 国产高清有码在线观看视频 | 午夜精品在线福利| 亚洲欧美精品综合久久99| 国产激情欧美一区二区| 亚洲中文字幕日韩| 亚洲专区中文字幕在线| av欧美777| 叶爱在线成人免费视频播放| 精品欧美国产一区二区三| 久久精品国产99精品国产亚洲性色 | 色播亚洲综合网| 可以免费在线观看a视频的电影网站| 久久影院123| 在线十欧美十亚洲十日本专区| 午夜福利高清视频| 精品人妻在线不人妻| 一级毛片高清免费大全| 曰老女人黄片| 亚洲全国av大片| 国产欧美日韩一区二区三| 成在线人永久免费视频| 黄片大片在线免费观看| 操美女的视频在线观看| 久久热在线av| 国产激情欧美一区二区| 麻豆成人av在线观看| av中文乱码字幕在线| 色综合亚洲欧美另类图片| 久久久久久大精品| 日韩大码丰满熟妇| 国产精品一区二区在线不卡| 久久精品亚洲熟妇少妇任你| 国产精品久久久久久亚洲av鲁大| 天堂动漫精品| 极品人妻少妇av视频| 91精品国产国语对白视频| 好男人电影高清在线观看| 欧美日韩中文字幕国产精品一区二区三区 | av在线播放免费不卡| 女生性感内裤真人,穿戴方法视频| 黄频高清免费视频| 男人操女人黄网站| 亚洲精品国产色婷婷电影| 日韩精品中文字幕看吧| 免费看a级黄色片| 久久人妻福利社区极品人妻图片| 国产成人一区二区三区免费视频网站| 一级毛片精品| 女人被躁到高潮嗷嗷叫费观| 国产成年人精品一区二区| 在线观看午夜福利视频| 午夜免费鲁丝| 亚洲一区二区三区色噜噜| 男女下面进入的视频免费午夜 | 黄色成人免费大全| 波多野结衣av一区二区av| 亚洲无线在线观看| 免费看十八禁软件| 国产高清videossex| 女人爽到高潮嗷嗷叫在线视频| 不卡一级毛片| 午夜福利,免费看| 久久精品成人免费网站| 国产精品 欧美亚洲| 亚洲中文字幕日韩| 久久亚洲精品不卡| 18禁美女被吸乳视频| 精品熟女少妇八av免费久了| xxx96com| 国产视频一区二区在线看| 国产在线观看jvid| 视频区欧美日本亚洲| 桃色一区二区三区在线观看| 欧美精品亚洲一区二区| 亚洲中文av在线| 美女 人体艺术 gogo| 国产精品国产高清国产av| 在线观看免费视频网站a站| 高清毛片免费观看视频网站| 色尼玛亚洲综合影院| 亚洲午夜精品一区,二区,三区| 日韩精品免费视频一区二区三区| 久久久久久久精品吃奶| 少妇裸体淫交视频免费看高清 | 国产一区二区三区综合在线观看| a级毛片在线看网站| 国产单亲对白刺激| 在线观看舔阴道视频| ponron亚洲| 国产av精品麻豆| 欧美中文日本在线观看视频| 91精品国产国语对白视频| 好男人电影高清在线观看| 亚洲中文av在线| 无人区码免费观看不卡| 两个人看的免费小视频| 777久久人妻少妇嫩草av网站| 搡老岳熟女国产| 国产亚洲精品久久久久5区| 首页视频小说图片口味搜索| netflix在线观看网站| 好男人电影高清在线观看| 女生性感内裤真人,穿戴方法视频| 亚洲色图 男人天堂 中文字幕| 精品一区二区三区av网在线观看| 免费在线观看影片大全网站| 18禁美女被吸乳视频| 日韩欧美国产在线观看| 老熟妇仑乱视频hdxx| 国产亚洲精品久久久久5区| 久久伊人香网站| 亚洲精品在线美女| 91精品三级在线观看| 精品少妇一区二区三区视频日本电影| 深夜精品福利| 免费在线观看亚洲国产| 在线十欧美十亚洲十日本专区| 久久亚洲精品不卡| 国产欧美日韩综合在线一区二区| 日韩精品中文字幕看吧| 日韩三级视频一区二区三区| 久久草成人影院| 成人特级黄色片久久久久久久| 露出奶头的视频| 精品午夜福利视频在线观看一区| 少妇 在线观看| 久久久久久国产a免费观看| 非洲黑人性xxxx精品又粗又长| 侵犯人妻中文字幕一二三四区| 在线天堂中文资源库| 在线av久久热| 国产成+人综合+亚洲专区| 男人舔女人下体高潮全视频| a级毛片在线看网站| 我的亚洲天堂| 嫩草影视91久久| 国产成+人综合+亚洲专区| 国产男靠女视频免费网站| 国产亚洲精品久久久久5区| 午夜成年电影在线免费观看| 在线观看www视频免费| 欧美日韩中文字幕国产精品一区二区三区 | 国产三级黄色录像| 在线av久久热| 亚洲专区字幕在线| avwww免费| 欧美成狂野欧美在线观看| 丁香六月欧美| 亚洲精品一区av在线观看| 国产高清有码在线观看视频 | 女人高潮潮喷娇喘18禁视频| 亚洲第一欧美日韩一区二区三区| 中文字幕另类日韩欧美亚洲嫩草| 欧美大码av| 嫩草影院精品99| 亚洲欧美一区二区三区黑人| 真人一进一出gif抽搐免费| 国产亚洲欧美精品永久| 香蕉久久夜色| 国产高清视频在线播放一区| 在线永久观看黄色视频| 一个人观看的视频www高清免费观看 | 午夜福利视频1000在线观看 | 大型黄色视频在线免费观看| АⅤ资源中文在线天堂| 成人手机av| 淫妇啪啪啪对白视频| 午夜福利高清视频| 日韩三级视频一区二区三区| 99在线视频只有这里精品首页| 久久 成人 亚洲| 18禁观看日本| 天堂√8在线中文| 69精品国产乱码久久久| 久久久久久久久免费视频了| 黄网站色视频无遮挡免费观看| 女人被躁到高潮嗷嗷叫费观| 国产精品一区二区三区四区久久 | 亚洲精品国产区一区二| av有码第一页| 视频在线观看一区二区三区| 亚洲一卡2卡3卡4卡5卡精品中文| 日本vs欧美在线观看视频| 欧美另类亚洲清纯唯美| 亚洲天堂国产精品一区在线| 91大片在线观看| 麻豆一二三区av精品| 在线观看66精品国产| 91字幕亚洲| 两个人免费观看高清视频| АⅤ资源中文在线天堂| 免费搜索国产男女视频| 如日韩欧美国产精品一区二区三区| 成年女人毛片免费观看观看9| 日日摸夜夜添夜夜添小说| 亚洲国产精品合色在线| 一级a爱片免费观看的视频| 国产精华一区二区三区| 在线国产一区二区在线| 精品国产一区二区三区四区第35| 亚洲五月天丁香| 亚洲一区中文字幕在线| 亚洲狠狠婷婷综合久久图片| 色av中文字幕| 一区二区三区激情视频| 国产精品九九99| 欧美日韩亚洲国产一区二区在线观看| 国产视频一区二区在线看| 亚洲片人在线观看| 欧美色视频一区免费| 欧美乱码精品一区二区三区| 国产精品久久久av美女十八| www.www免费av| 国产成人精品久久二区二区免费| 久久婷婷人人爽人人干人人爱 | 又黄又爽又免费观看的视频| 国产精品一区二区三区四区久久 | 久久久国产精品麻豆| 精品久久久久久成人av| 999精品在线视频| 极品教师在线免费播放| 午夜久久久久精精品| 日本五十路高清| 日韩高清综合在线| 咕卡用的链子| 亚洲视频免费观看视频| 日本撒尿小便嘘嘘汇集6| 黄网站色视频无遮挡免费观看| 香蕉丝袜av| 国产99久久九九免费精品| 日本欧美视频一区| 亚洲人成电影免费在线| 色婷婷久久久亚洲欧美| 久久久久久久午夜电影| 一卡2卡三卡四卡精品乱码亚洲| 亚洲中文字幕一区二区三区有码在线看 | www日本在线高清视频| 欧美黑人欧美精品刺激| 亚洲一区高清亚洲精品| 一区二区三区激情视频| 大型av网站在线播放| 日日爽夜夜爽网站| 国产精品香港三级国产av潘金莲| 禁无遮挡网站| 久久久久国产精品人妻aⅴ院| 免费高清视频大片| 午夜成年电影在线免费观看| 国产精品影院久久| 久久精品成人免费网站| 亚洲一区二区三区不卡视频| 久久精品影院6| 正在播放国产对白刺激| 丁香欧美五月| 别揉我奶头~嗯~啊~动态视频| 一级黄色大片毛片| 久久人妻福利社区极品人妻图片| 啦啦啦韩国在线观看视频| 国产高清激情床上av| 亚洲成国产人片在线观看| 日韩免费av在线播放| 国产av又大| 黄色成人免费大全| 搡老妇女老女人老熟妇| 男男h啪啪无遮挡| 国产精品免费一区二区三区在线| 欧美中文日本在线观看视频| 一区二区三区高清视频在线| 亚洲精华国产精华精| 成人国产综合亚洲| 中文字幕另类日韩欧美亚洲嫩草| 看黄色毛片网站| 国产精品免费一区二区三区在线| 成熟少妇高潮喷水视频| 久久久国产欧美日韩av| 国产精品秋霞免费鲁丝片| 动漫黄色视频在线观看| 亚洲五月天丁香| 欧美不卡视频在线免费观看 | 多毛熟女@视频| 美女免费视频网站| 97超级碰碰碰精品色视频在线观看| 纯流量卡能插随身wifi吗| 欧美成狂野欧美在线观看| 九色亚洲精品在线播放| 免费观看人在逋| 91九色精品人成在线观看| 啦啦啦 在线观看视频| 国产精品一区二区免费欧美| 91麻豆精品激情在线观看国产| 欧美成人免费av一区二区三区| 男女午夜视频在线观看| 99精品久久久久人妻精品| 精品不卡国产一区二区三区| 啪啪无遮挡十八禁网站| 亚洲中文日韩欧美视频| 国产一区二区在线av高清观看| 九色国产91popny在线| 欧美午夜高清在线| 久久影院123| 色综合亚洲欧美另类图片| 精品日产1卡2卡| 村上凉子中文字幕在线| 免费不卡黄色视频| www.自偷自拍.com| 午夜老司机福利片| 成人av一区二区三区在线看| 久久精品成人免费网站| 国产精品99久久99久久久不卡| 免费看美女性在线毛片视频| 精品国产国语对白av| 亚洲人成77777在线视频| 看片在线看免费视频| 国产午夜精品久久久久久| 成人国语在线视频| 亚洲少妇的诱惑av| 日韩一卡2卡3卡4卡2021年| 久久欧美精品欧美久久欧美| 很黄的视频免费| 精品人妻1区二区| 欧美色欧美亚洲另类二区 | 久久久久国内视频| 一二三四在线观看免费中文在| 51午夜福利影视在线观看| 搞女人的毛片| 久久人妻熟女aⅴ| 国产精品乱码一区二三区的特点 | 男男h啪啪无遮挡| 国产精品自产拍在线观看55亚洲|