[发明专利]一种基于反向导航的Kalman滤波算法

权利要求书

1.一种基于反向导航的Kalman滤波算法，是一种对导航信息数据进行后处理Kalman滤波算法，其特征在于：在滤波过程中，使用如下所述的方程式：

反向惯导系统的姿态矩阵和速度、位置的更新方程为：

Cbk-1n=Cbkn-TCbkn[ωibkb-(Cbkn)T(ωiekn+ωenkn)]×---(1a)]]>

式中：

k表示计算的当前时刻，真实的当前时刻；

k-1表示计算的前一时刻，真实的当前时刻；

T为反向惯导系统的解算周期，单位：秒，确定后为常量；

为载体系b系向导航系n系，即北天东地理坐标系，转化的姿态转移矩阵，3×3维；

其中ω_ie为地球自转角速率，单位：弧度/秒，

为反向惯导系统的纬度，单位：弧度；

其中v_N、v_E分别为反向惯导系统的北向速度、东向速度，单位：米/秒，R_M、R_N分别为地球子午圈、卯酉圈半径，单位：米，h为反向惯导系统的高度，单位：米；

ωibb=-ωibxb-ωibyb-ωibzbT,]]>分别为载体系x轴陀螺测量值、y轴陀螺测量值、z轴陀螺测量值，单位：弧度/秒；

表示的反对称矩阵；

venk-1n=venkn-T[Cbknfk-1b-(2ωiekn+ωenkn)×venkn+gkn]---(1b)]]>

式中：

venn=vNvUvET,]]>其中v_U为反向惯导系统的垂向速度，单位：米/秒；

在第一次进行反向导航解算的时候，使速度初值反向，即此速度初值为真实导航过程中速度最后一个值；

fb=fxbfybfzbT,]]>分别为载体系x轴加速度计测量值、y轴加速度计测量值、z轴加速度计测量值，单位：米/秒²；

gⁿ＝[0-g 0]^T，其中g为地球的重力加速度，单位：米/秒²；

式中：

λ为反向惯导系统的经度，单位：弧度；

反向惯导系统的速度、位置和姿态角误差方程为：

式中：

δλ分别为反向惯导系统的纬度、经度误差，单位：弧度；

δh为反向惯导系统的高度误差，单位：米；

fⁿ＝[f_N f_U f_E]^T，其中f_N、f_U、f_E分别为北向加速度、垂向加速度、东向加速度，单位：米/秒²；

δfn=Cbn▿xb▿yb▿zbT,]]>其中分别为载体系x轴加速度计零偏误差、y轴加速度计零偏误差、z轴加速度计零偏误差，单位：米/秒²；

φ＝[φ_N φ_U φ_E]^T，其中φ_N、φ_U、φ_E分别为反向惯导系统的北向失调角、垂向失调角、东向失调角，单位：弧度；

δvenn=δvNδvUδvET,]]>其中δv_N、δv_U、δv_E分别表示反向惯导系统的北向速度误差、垂向速度误差和东向速度误差，单位：米/秒；

δgⁿ＝[0-δg 0]^T；

δωibb=-ϵxb-ϵyb-ϵzbT,]]>其中分别为处理成一阶马尔可夫过程的载体系x轴陀螺漂移误差、y轴陀螺漂移误差、z轴陀螺漂移误差，单位：弧度/秒。