SINS 慣導(dǎo)算法簡介

在慣導(dǎo)系統(tǒng)中慣性傳感器（陀螺和加速度計）直接與運載體固連，通過導(dǎo)航計算機采集慣性器件的輸出信息并進行數(shù)值積分求解運載體的姿態(tài)、速度和位置等導(dǎo)航參數(shù)，這三組參數(shù)的求解過程即所謂的姿態(tài)更新算法、速度更新算法和位置更新算法。

傳統(tǒng)的姿態(tài)更新算法有歐拉角法、方向余弦陣法和四元數(shù)法等，這些方法直接以陀螺采樣輸出作為輸入，使用泰勒級數(shù)展開或龍格–庫塔等方法求解姿態(tài)微分方程，未充分考慮轉(zhuǎn)動的不可交換性誤差問題。傳統(tǒng)姿態(tài)更新算法在理論上可以通過提高采樣和更新頻率來提高解算精度，但實際陀螺采樣頻率又受限于傳感器的帶寬和噪聲水平，因此傳統(tǒng)算法的精度提升空間相對有限，僅適用于對解算精度要求不太高的場合。

至此， 從理論上看，在理想的圓錐運動條件下的不可交換性誤差補償問題似乎得到了比較完美的解決。但應(yīng)當注意到，上述算法都是在Bortz方程二階近似的基礎(chǔ)上推導(dǎo)的，不可避免地存在原理性誤差，在大錐角情形下會出現(xiàn)高子樣數(shù)的圓錐誤差補償精度反而不如低子樣數(shù)的反?，F(xiàn)象。

審核編輯 ：李倩