[发明专利]一种消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法

说明书

技术领域

本发明属于惯性导航技术领域，涉及一种可用于提高惯性导航系统的精度的消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法。

背景技术

在船用惯性导航系统中，对陀螺仪和加速度计的精度以及系统持续工作时间的要求都比较高，高精度的惯性导航系统要采用高性能的惯性传感器与先进的系统技术，由于工艺制造水平的限制，制造高性能的惯性传感器不仅难度大，还将提高整个惯性导航的成本，因此先进的系统技术一直以来都是高精度惯性导航的研究热点。

随着惯性导航精度要求的不断提高，惯性传感器技术的相对落后，采用先进的旋转调制技术对系统器件误差进行自补偿是近年来系统技术研究的重点。单轴旋转调制可以完全平均与转轴垂直平面内的常值器件误差，为了获得更高精度的惯性导航系统，研究人员又设计了双轴旋转方案，以达到消除所有惯性器件的常值误差的目的。但是在传统的双轴旋转调制方案中，地球自转角速率与器件标度因数误差以及安装误差的耦合项不能被完全调制平均，这对长时间工作在自主导航状态下的惯性导航来说将形成随时间发散的误差。

发明内容

本发明的目的在于提出一种避免在导航解算的过程中地球自转角速度引起累积误差，从而提高系统的导航精度的消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法，。

本发明的目的是这样实现的：

步骤一：建立一个旋转机构，将IMU安装在转台上，并且使IMU坐标系的三根轴与载体系的三轴平行，系统开机后预热1小时；

步骤二：对系统进行初始对准，获得初始捷联姿态矩阵

步骤三：测量当地的经纬度值λ和获得初始时刻地心惯性坐标系与导航坐标系之间的方向余弦矩阵：

步骤四：根据步骤三获得的地心惯性坐标系与导航坐标系之间的方向余弦矩阵，可测量出IMU坐标系与惯性系之间的姿态角θ₁、θ₂和θ₃，其测量公式为：

θ1=arctan(-C32C33)]]>

θ₂＝arcsin(C₃₁)   (2)

θ3=arctan(-C21C31)]]>

式(2)中，C_ij,i,j＝1,2,3是IMU坐标系与地心惯性坐标系之间的转换矩阵中的各个元素，由步骤二和步骤三获得。

步骤五：控制转位机构依次绕IMU坐标系的z_s轴、y_s轴和x_s轴分别转动θ₃、θ₂和θ₁，使IMU坐标系与地心惯性系重合，同时控制IMU绕z_s轴顺时针以大小为ω_ie的旋转角速度转动；

步骤六：控制IMU绕着地心惯性坐标系的z_i轴和y_i轴按系统旋转方案转动；

步骤七：将陀螺仪和加速度计采集的信息实时的输入导航计算机中进行导航解算，最终给出载体的导航参数信息。

所述的步骤六中，IMU绕着地心惯性坐标系的z_i轴和y_i轴按系统旋转方案依次旋转时，陀螺仪输出角速度的误差形式为：