國產(chǎn)化衛(wèi)星/MEMS組合導(dǎo)航模塊的設(shè)計(jì)實(shí)現(xiàn)
跑車實(shí)驗(yàn):沿著一小區(qū)跑車,該小區(qū)有高樓,有樹蔭,其具體的姿態(tài)角如下圖所示?! ?/p>本文引用地址:http://cafeforensic.com/article/134653.htm
衛(wèi)星/MEMS組合濾波
導(dǎo)航解算
由于MEMS陀螺不同于傳統(tǒng)高精度陀螺,其不能感測(cè)地球相對(duì)于慣性空間的旋轉(zhuǎn)速率,因而無法使用傳統(tǒng)的導(dǎo)航解算公式去實(shí)時(shí)推算速度和位置。如圖4所示,為捷聯(lián)解算算法流程。
組合濾波算法
衛(wèi)星/MEMS組合導(dǎo)航模塊實(shí)現(xiàn)方案如圖5所示,MEMS-SINS模塊與衛(wèi)星導(dǎo)航模塊是彼此獨(dú)立的兩個(gè)部分,此框圖顯示了以MEMS-SINS和衛(wèi)星導(dǎo)航接收機(jī)的速度/位置信息做差作為量測(cè)量。松耦合組合導(dǎo)航通常有兩種形式:開環(huán)與閉環(huán),如圖5所示,該技術(shù)方案采用閉環(huán)形式,將卡爾曼濾波估計(jì)出的各種誤差反饋至MEMS-SINS模塊,改善系統(tǒng)性能[5]。
組合導(dǎo)航路測(cè)試驗(yàn)
與傳統(tǒng)高精度捷聯(lián)慣性導(dǎo)航系統(tǒng)不同的是,MEMS-SINS模塊無法感測(cè)地球自轉(zhuǎn)角速率,地球的自轉(zhuǎn)角速率完全淹沒在MEMS陀螺的噪聲之中,當(dāng)載體處于靜止?fàn)顟B(tài)時(shí),認(rèn)為陀螺輸出角速率為0。MEMS-SINS誤差方程修正如下所示:
評(píng)論