[发明专利]一种光纤陀螺捷联惯导系统初始航向的姿态获取方法

说明书

(一)技术领域

本发明涉及的是一种测量技术，特别是涉及一种光纤陀螺捷联惯性系统获取初始航向角的方法。 

(二)背景技术

光纤陀螺捷联惯导系统是一种自主式导航系统，采用牛顿第二定律在初始信息的基础上进行积分运算，可以连续、实时提供姿态、速度和位置信息，具有隐蔽性好，不受干扰等优点，广泛应用于军事武器系统中，而初始姿态，尤其是初始航向角的取得是整个系统的关键环节。 

光纤陀螺捷联惯导系统初始姿态测量的过程包括粗对准和精对准两个阶段。传统的初始姿态测量的方法能实现快速获取高精度的水平姿态角，但是初始航向角精度不够理想，在某些军事应用领域上无法满足要求，因此如何获得高精度的初始航向角成为了某些武器导航系统发展的技术瓶颈。 

(三)发明内容

本发明的目的在于提供一种确保初始水平角满足精度要求的基础上，大大提高光纤陀螺捷联惯导系统初始航向角精度的方法。 

本发明的目的是这样实现的，它包括以下步骤： 

步骤1、光纤陀螺捷联惯性导航系统进行预热； 

步骤2、利用GPS信息将舰船的初始速度参数和初始位置参数装订至舰船光纤陀螺捷联惯性导航系统导航计算机中，所述的舰船初始位置参数包括舰船的初始经度、纬度； 

步骤3、采集光纤陀螺仪和石英加速度计输出的数据，粗略测量出舰船的初始姿态，建立初始方向余弦矩阵C_bⁱ′； 

步骤4、光纤陀螺捷联惯性导航系统利用步骤2和步骤3得到的初始值，利用光纤陀螺仪输出角速度和石英加速度计输出比例进行导航递推解算，测量舰船在惯性坐标系下的速度； 

步骤5、以光纤陀螺捷联惯导系统测量的速度与载体真实的速度做差，并将此差值作为观测向量，采用卡尔曼滤波技术估测出计算惯性坐标系与真实惯性坐标系之间的三个姿态误差角 和 

步骤6、利用步骤5估计出的三个姿态误差角，修正粗对准时的方向余弦矩阵C_bⁱ′，得到修正后的方向余弦矩阵C_bⁱ； 

步骤7、根据方向余弦矩阵的变换关系，得到载体坐标系b到导航坐标系n的捷联矩阵C_bⁿ，实现对准。 

本发明还可以包括这样一些特征： 

1.所述的步骤5根据分析光纤陀螺捷联惯性系统处于摇摆基座下的姿态误差方程和速度误差方程，建立系统的状态方程和量测方程，设系统的状态变量为 

由捷联惯导解算的速度和载体真实的速度之差构造的观测量为