雙天線GPS/SINS組合導航系統(tǒng)設計
——
加入技術交流群
編者按：本系統(tǒng)作為淺組合導航系統(tǒng)的一種，利用了雙天線定向GPS與光纖陀螺的組合，以基于DSP+FPGA多處理器結構作為導航計算機平臺，在原有的位置與速度基礎上加入了姿態(tài)作為第三個量測量，應用卡爾曼濾波算法將GPS姿態(tài)信息作為對慣性導航系統(tǒng)數(shù)據(jù)的初始值和修正。設計的系統(tǒng)通過跑車實驗驗證后表明達到了設計要求，具有實時性好，運算精度高等優(yōu)點。
其中F(t)是18*18階的狀態(tài)轉移矩陣;W(t)為18維的狀態(tài)噪聲向量;下列各式給出了狀態(tài)方程的系統(tǒng)噪聲性質：
本文引用地址：http://cafeforensic.com/article/203227.htm??????? 
而其中失準角誤差方程為：
??????? 
(2)組合導航系統(tǒng)的量測方程
由于系統(tǒng)將定向GPS給出的數(shù)據(jù)作為修正數(shù)據(jù)，系統(tǒng)量測值在位置和速度值的基礎上加入了姿態(tài)信息。位置量測值為慣導系統(tǒng)與GPS給出的緯度、經(jīng)度和高度差，相應的速度量測值為慣導系統(tǒng)與GPS給出的在慣性系統(tǒng)中各坐標下的差值，而慣導系統(tǒng)與雙天線GPS給出的姿態(tài)差值作為第三組量測值。
慣導系統(tǒng)與GPS位置量測信息在地理坐標系以真值和誤差表示如下[4]：
??????? 
與位置量測方程形式相似，速度量測方程表示如下：
??????? 
評論