USV協(xié)同網絡中慣導系統(tǒng)的阻尼和校正.pdf

1、在艦艇編隊的協(xié)同作業(yè)中，主艇裝備有高精度慣導系統(tǒng)，為了節(jié)約成本，從艇上裝備低精度的MEMS慣導系統(tǒng)。從艇可以通過阻尼、綜合校正、非線性濾波和協(xié)同算法等手段共享主艇的高精度導航信息，從而提高自身的定位精度。
　　論文詳細論述了常速度反饋、超前、滯后超前和二階匹配水平速度阻尼網絡的設計方法，分析了外速度誤差、陀螺漂移和加表零偏對阻尼慣導系統(tǒng)的影響，進而將水平速度阻尼網絡加入捷聯慣導系統(tǒng)的機械編排中。在此基礎上，還討論了基于外定位誤差的

2、阻尼網絡和水平姿態(tài)阻尼網絡的設計。當外速度誤差較大時，需要運用卡爾曼濾波技術將從艇的慣導系統(tǒng)切換到無阻尼狀態(tài)。通過與水平阻尼網絡進行對比設計了阻尼比可調的方位阻尼網絡。其優(yōu)點是網絡的傳遞函數只和阻尼比有關，設計方法更有規(guī)律可循，避免了傳統(tǒng)試湊法需要根據波特圖進行設計的麻煩。
　　當從艇能從協(xié)同算法中同時獲得位置和航向時可以采用兩點校正法，如果只能獲得位置信息則采用三點校正法，它們都能計算從艇上 MEMS陀螺三個軸上的漂移。根據Ψ角

3、誤差模型和Φ角誤差模型對從艇慣導進行隨機校正，它們能實時給出姿態(tài)誤差角和陀螺漂移。
　　由于從艇航跡推算模型的非線性特征，可以采用不同的非線性濾波方法修正MEMS陀螺的誤差。擴展卡爾曼濾波（EKF）算法簡單，實時性好，在工程實際中得到了廣泛應用，但雅克比矩陣的求解不可避免地帶來一階近似誤差。相比而言，無跡濾波（UKF）和容積濾波（CKF）可以精確到非線性模型泰勒展開的三階或更高階項，所以無論估計精度還是速度都優(yōu)于EKF。非可加性噪