[發明專利]基于非線性預測濾波與求容積卡爾曼濾波相結合的動基座初始對準方法

無效

• 申請號: 201210104322.1
• 申請日: 2012-04-11
• 公開（公告）號: CN102654406A
• 公開（公告）日: 2012-09-05
• 發明（設計）人: 郝燕玲;楊峻巍;高偉;奔粵陽;徐博;王根;陳亮;郝金會;劉彬;劉亞龍
• 申請（專利權）人: 哈爾濱工程大學
• 主分類號: G01C25/00
• 分類號: G01C25/00;G01C21/16;G01C21/20
• 代理公司: 暫無信息
• 代理人: 暫無信息

技術領域

本發明涉及的是一種捷聯慣導系統的對準方法。

背景技術

捷聯慣導系統是將慣性器件(陀螺儀及加速度計)直接固聯在載體上的系統。利用陀螺儀、加速度計測量運載體的角運動和線運動的信息。通過計算機進行積分運算得載體的姿態、速度及位置等導航參數。它與平臺式慣導系統相比具有體積小，重量輕，成本低，可靠性高，便于維護等優點，因此得到越來越廣泛的應用。初始對準的精度之間關系到慣導系統的工作精度，初始對準的時間是慣導系統的重要戰術技術指標。因此，初始對準是慣導系統最重要的關鍵技術之一。

當海況不佳時，船舶即使處于系泊靜止狀態下也會產生大幅晃動。從而使得捷聯慣導系統無法快速完成自主初始對準。因此在這種情況下需要在運動中借助其他輔助導航設備(如多普勒計程儀)，進行運動中對準。當艦船處于系泊靜止狀態若載體晃動十分嚴重時，粗略的獲得方位信息都很困難。故此時需要采用非線性濾波方法來實現多普勒計程儀輔助捷聯慣導系統的運動中對準。長期以來，擴展卡爾曼濾波器(EKF)因結構簡單、易于實現、快速收斂等優點得到廣泛的應用。然而EKF存在理論上的局限性：如當系統模型為強非線性時，EKF會導致很大的線性化誤差，造成濾波器精度降低，甚至發散；而且需要計算繁瑣的雅克比矩陣。針對EKF的不足，近年來人們基于近似一個高斯分布比近似一個非線性函數更加容易的觀點，提出了一套全新的非線性濾波方法，即Sigma-Point卡爾曼濾波器(SPKF)，其利用加權統計線性回歸技術，通過一組確定性采樣點來捕獲系統的相關統計參量。隨著研究的不斷深入，2009年Simon?Haykin等提出了一種新的非線性濾波器，即求容積卡爾曼濾波器。它是一種獨立于EKF、SPKF算法體系的新的濾波策略，相比與EKF、SPKF等傳統高斯域非線性濾波器具有更優的非線性逼近性能、數值精度以及濾波穩定性。然而，與EKF及SPKF類似，CKF的不足之處在于它對模型誤差比較敏感，并將其作為高斯白噪聲來處理。而非線性預測濾波器能夠實時的估計系統的模型誤差，可用于模型誤差較大的非線性系統的濾波，且不受系統噪聲高斯分布條件的限制。缺點是收斂速度慢，因此通過非線性預測濾波器與求容積卡爾曼濾波器相結合來提高大方位失準角條件下動基座初始對準的精度具有重要的意義。

發明內容

本發明的目的在于提供能夠有效提高大方位失準角下捷聯慣導系統動基座對準精度的基于非線性預測濾波與求容積卡爾曼濾波相結合的動基座初始對準方法。

本發明的目的是這樣實現的：

本發明基于非線性預測濾波與求容積卡爾曼濾波相結合的動基座初始對準方法，其特征是：

(1)在系泊狀態下，采集陀螺儀及加速度的輸出數據；

(2)采用解析法完成捷聯慣導系統的粗對準，初步確定載體的姿態矩陣；

(3)建立大方位失準角條件下捷聯慣導系統初始對準的非線性誤差模型；

(4)建立非線性預測濾波與求容積卡爾曼濾波相結合的非線性濾波器；

(5)載體先做勻加速直線運動，然后做勻速直線運動；

(6)進行捷聯解算，同時測量載體的運動速度；

(7)取捷聯解算的速度與測量的載體的運動速度作為量測量，利用步驟(4)建立的非線性濾波器對三個平臺誤差角進行估計；

(8)利用估計出的平臺誤差角對此時的姿態矩陣進行修正，從而完成初始對準。

本發明還可以包括：

1、所述的建立大方位失準角條件下捷聯慣導系統初始對準的非線性誤差模型的步驟為：

(1)建立捷聯慣導系統初始對準非線性誤差方程

使用一階非線性隨機微分方程來描述捷聯慣導系統非線性誤差方程如下：