主权项 |
一种基于阻尼捷联惯性导航重力异常滤波匹配的方法,其特征是包括如下步骤:步骤一:启动捷联惯性导航设备,并且使导航设备工作于阻尼状态,对导航设备进行冷启动;步骤二:在导航系统开始工作之后,利用重力仪检测重力异常,当重力仪有重力异常值输出时,进入步骤三,否则导航系统处于自主的阻尼导航状态;步骤三:选取状态变量为<img file="FDA0000735808650000011.GIF" wi="576" he="90" />其中δλ为东向位置误差、<img file="FDA0000735808650000013.GIF" wi="74" he="69" />为北向位置误差、δV<sub>e</sub>为东向速度误差、δV<sub>n</sub>为北向速度误差;观测变量Z<sub>k</sub>为重力异常值,当检测到重力异常值输出时,按照如下的状态方程和量测方程进行重力异常卡尔曼滤波匹配:状态方程:X<sub>k,k‑1</sub>=Φ<sub>k,k‑1</sub>X<sub>k‑1</sub>+Γ<sub>k,k‑1</sub>W<sub>k‑1</sub>量测方程:Z<sub>k</sub>=H<sub>k</sub>X<sub>k</sub>+γ<sub>k</sub>其中,X<sub>k‑1</sub>和X<sub>k,k‑1</sub>是状态变量在k‑1时刻的导航解算值和利用k‑1时刻的导航解算值预测k时刻的预测;状态转移矩阵Φ<sub>k,k‑1</sub>是将连续的状态转移矩阵<img file="FDA0000735808650000014.GIF" wi="663" he="359" />离散化得到的离散状态转移矩阵,其中H<sub>x</sub>,H<sub>y</sub>为水平阻尼网络的东向和北向的传递函数,<img file="FDA0000735808650000015.GIF" wi="44" he="57" />为由阻尼捷联惯性导航系统解算得到的纬度位置,R为地球半径;观测矩阵为H<sub>k</sub>=[h<sub>x</sub> h<sub>y</sub> 0 0],其中h<sub>x</sub>,h<sub>y</sub>为阻尼导航系统解算位置处的局部重力异常经纬度梯度,是利用导航系统解算出的位置在重力异常数据库的进行局部全平面线性拟合得到的;Γ<sub>k,k‑1</sub>为噪声输入矩阵;W<sub>k‑1</sub>,γ<sub>k</sub>分别为系统噪声和观测噪声;步骤四:将重力异常值滤波匹配得到的经纬度误差和速度误差带入到捷联惯性导航的结算中对捷联惯性导航的结算进行修正,以提高系统的精度。 |