一種基于移動輔助節(jié)點的單兵導航系統(tǒng)協(xié)同初始化算法
【文章頁數(shù)】:7 頁
【部分圖文】:
圖1 粒子傳播模型
如圖1所示,在(t-1)時刻,已知具有正常導航能力的輔助節(jié)點2的位置坐標為:p2(t-1)=[x2(t-1),y2(t-1),ψ(t-1)]T;此時位置精度較差或異常的目標節(jié)點1的實際坐標為p*1(t-1)=[x*1(t-1),y*1(t-1),ψ*1(t-1)]T。利用測距傳感....
圖2 航位推算模型
本文所提出的快速協(xié)同初始化算法是建立在具備相對航位推算能力的單兵慣性導航系統(tǒng)基礎(chǔ)之上,采用基于零速修正的行人航跡推算(PedestrianDeadReckoning,PDR)算法實現(xiàn)的單兵系統(tǒng)航位推算,具體算法參見文獻[10]。如圖2所示,假設(shè)在(t-1)時刻士兵的位置為(....
圖3 協(xié)同初始化試驗場景設(shè)置
實驗設(shè)備包括1套單兵導航系統(tǒng)及1個輔助導航節(jié)點,如圖3所示。其中單兵導航系統(tǒng)包含3個模塊,分別是團隊自主研制的足綁式導航鞋,選用Xsens公司的MTi-G710慣性測量裝置和UWB測距天線,以及差分GPS(用于記錄真實運動軌跡)。輔助導航節(jié)點安裝于試驗越野車上,包含2個主要模塊:....
圖4 協(xié)同定位軌跡圖
輔助導航節(jié)點安裝于試驗越野車上,包含2個主要模塊:1)基于DW1000的UWB無線測距單元,測量精度約為10cm,雙向測距精度為20~30cm,模塊間具備實時共享測距信息的能力;2)雙天線差分GPS,用于模擬具備定位能力的有人/無人協(xié)同作戰(zhàn)平臺導航系統(tǒng)。實驗時,行人穿著足綁式導航....
本文編號:4024590
本文鏈接:http://www.lk138.cn/kejilunwen/jingguansheji/4024590.html