一种适用于极区的惯导系统综合校正方法

摘要

本发明公开了能够实现极区航行运载器在无阻尼条件下进行综合校正的一种适用于极区的惯导系统综合校正方法。本方法通过以横地理坐标系作为导航坐标系，在极区范围内通过横坐标系转换，将导航参数转换到横地理坐标系下。以横地理坐标系下的惯导输出误差量作为状态量，速度作为外部观测量，建立卡尔曼滤波模型，估测出水平误差角并引入到传统两点校正算法中，在无阻尼状态条件下完成极区惯导系统综合校正过程。本发明在无阻尼条件下实现极区航行运载器综合校正，解除了传统综合校正方案对运载器航行方式的限制，提高了极区惯导系统工作的灵活性。

主权项

一种适用于极区的惯导系统综合校正方法，其特征在于，包括以下几个步骤：步骤一：将船用惯导系统输出的导航参数量转换到横地理坐标系下，导航参数包括：经纬度值、航向、速度和姿态信息；地理坐标系与横地理坐标系的转换矩阵为：$C_n^{\bar{n}}=C_i^{\bar{n}}·C_n^i$$C_i^{\bar{n}}=\left[\begin{array}{ccc}\cos \bar{\lambda }\cos \mathrm{\Omega t}& \cos \bar{\lambda }\sin \mathrm{\Omega t}& -\sin \stackrel{-}{\lambda }\\ -\sin \bar{L}\sin \bar{\lambda }\cos \mathrm{\Omega t}-\cos \bar{L}\sin \mathrm{\Omega t}& \cos \bar{L}\cos \mathrm{\Omega t}-\sin \bar{L}\sin \bar{\lambda }\sin \mathrm{\Omega t}& -\sin \bar{L}\cos \bar{\lambda }\\ \cos \bar{L}\sin \bar{\lambda }\cos \mathrm{\Omega t}-\sin \bar{L}\sin \mathrm{\Omega t}& \cos \bar{L}\sin \bar{\lambda }\sin \mathrm{\Omega t}+\sin \bar{L}\cos \mathrm{\Omega t}& \cos \stackrel{-}{L}\cos \bar{\lambda }\end{array}\right]$$C_n^i=\left[\begin{array}{ccc}-\sin (\lambda +\mathrm{\Omega t})& -\sin L\cos (\lambda +\mathrm{\Omega t})& \cos L\cos (\lambda +\mathrm{\Omega t})\\ \cos (\lambda +\mathrm{\Omega t})& -\sin L\sin (\lambda +\mathrm{\Omega t})& \cos L\sin (\lambda +\mathrm{\Omega t})\\ 0& \cos L& \sin L\end{array}\right]$表示惯性坐标系到横地理坐标系的转换矩阵，表示地理坐标系到惯性坐标系的转换矩阵，Ω为地球自转角速度，t为时间，λ为地理坐标系下的经度值，横地理坐标系下的经纬度值为：$\bar{L}=\arcsin \left(\cos L\sin \lambda \right)$$\bar{\lambda }=\arctan \left(\frac{\cos L\cos \lambda }{\sin L}\right)$L为地理坐标系下的纬度值，为横地理坐标系下的纬度值，为横地理坐标系下的经度值，横地理坐标系下航向与速度为：$\bar{K}=K+\arctan \frac{\sin \lambda }{\sin L\cos \lambda }-\pi$$\bar{V}=\left[\begin{array}{c}{\bar{V}}_x\\ {\bar{V}}_y\end{array}\right]=\left[\begin{array}{c}V\sin \bar{K}\\ V\cos \bar{K}\end{array}\right]$K表示地理坐标系下的航向，为横地理坐标系下的航向，π为圆周率，V为地理坐标系下的速度，为横地理坐标系下的速度，为横坐标系下的东向速度，为横坐标系下的北向速度；步骤二：利用得到的横坐标系下的导航参数进行横坐标系下的导航机械编排，确定系统的状态变量和量测量；步骤三：根据系统的状态变量和量测量建立卡尔曼滤波器，由卡尔曼滤波方法得到横坐标系下的导航系统的x轴姿态误差角和y轴姿态误差角步骤四：将得到的x轴姿态误差角和y轴姿态误差角引入到导航系统的两点校正中，完成极区两点校正。