[发明专利]一种单轴旋转的捷联惯导系统初始对准方法

权利要求书

1.一种单轴旋转的捷联惯导系统初始对准方法，其特征在于包括以下步骤：

(1)利用全球定位系统GPS确定载体的初始位置参数，并装订至导航计算机中；

(2)采集光纤陀螺捷联惯性导航系统的光纤陀螺仪和石英加速度计输出的数据；

(3)对采集到的光纤陀螺仪和石英加速度计的数据进行处理，采用解析法来完成系统的粗对准，初步确定载体的姿态信息；具体方法为：根据加速度计输出的重力矢量 以及陀螺仪输出与地球自转角速率 的测量值初步确定此时载体的姿态信息完成系统的粗对准，建立载体坐标系b和计算地理坐标系n′之间的转换矩阵 

对于某一小于纬度为90°的角度 有：

用 和 构成一个新的矢量 即： 再根据导航系与载体系之间的方向余弦矩阵得：

考虑捷联矩阵的正交性，即：

其中g^b、 用陀螺和加速度的输出近似代替；

(4)惯性测量单元绕载体坐标系oy_b轴正向旋转45度，确定惯性测量单元坐标系与载体坐标系之间的初始相对位置；

(5)确定两坐标系相对初始位置关系后，惯性测量单元绕载体坐标系方位轴oz_b正向以角速度ω＝6°/s连续转动；

(6)建立以速度误差为状态变量的卡尔曼滤波状态方程及速度误差为量测量的量测方程；

1)建立卡尔曼滤波的状态方程：

用一阶线性微分方程来描述旋转捷联惯导系统的状态误差：

其中X(t)为t时刻系统的状态向量；A(t)和B(t)分别为系统的状态矩阵和噪声矩阵；W(t)为系统噪声向量；

系统的状态向量为：

系统的白噪声向量为：

W＝[a_xa_yω_xω_yω_z00000]^T

其中δV_e、δV_n分别表示东向、北向的速度误差；▽_x、▽_y分别为惯性测量单元坐标系ox_s、oy_s轴加速度计零偏；ε_x、ε_y、δ_z分别为惯性测量单元坐标系ox_s、oy_s、oz_s轴陀螺的常值漂移；a_x、a_y分别为惯性测量单元坐标系ox_s、oy_s轴加速度计的白噪声误差；ω_x、ω_y、ω_z分别为惯性测量单元坐标系ox_s、oy_s、oz_s轴陀螺的白噪声误差；

系统的状态转移矩阵为：

其中： 

V_e、V_n分别表示东向、北向的速度；ω_ie表示地球自转角速度；R_m、R_n分别表示地球子午、卯酉曲率半径；L表示当地纬度；f_e、f_n、f_u分别表示为导航坐标系下东向、北向、天向的比力；

令捷联矩阵 为：

则

2)建立卡尔曼滤波的量测方程： 

用一阶线性微分方程来描述旋转捷联惯导系统的量测方程如下：

Z(t)＝H(t)X(t)+v(t)

其中：Z(t)表示t时刻系统的量测向量；H(t)表示系统的量测矩阵；v(t)表示系统的量测噪声；

系统量测矩阵为：

量测量为水平速度误差：

v(t)＝[v_ev_n]^T；

(7)利用步骤(6)估计出平台失准角，并在精对准结束时用它来修正系统的捷联姿态矩阵，完成精确的初始对准。