[发明专利]MEMS捷联惯导自适应SCKF滤波的初始对准方法

说明书

技术领域

本发明涉及一种MEMS捷联惯导系统方法，尤其涉及一种MEMS捷联惯导自适应SCKF滤波的初始对准方法。

背景技术

微机械电子(MEMS)技术，在近几年随着器件结构、加工工艺、读出电路和接口电路、集成及封装等技术的快速进步，而逐渐完善成熟。基于MEMS技术的惯性测量单元(IMUs)集成了微机械加速度计和微机械陀螺，因而，MEMS具有体积小、集成化、成本低、功耗低、可靠性高等特点。MEMS的突出特点使其在众多的民用和军用领域具有广阔的应用前景。

初始对准是捷联惯导系统中的关键技术之一，其对准时间和精度直接影响惯导系统的工作性能。而初始对准通常分为粗对准和精对准两个阶段。由于MEMS陀螺仪的精度不高，地球自转角速率会被陀螺噪声所淹没，不能正确敏感地球角速率。所以初始航向由集成的MEMS磁强计的测量值经过计算得到。但是在恶劣的工作环境下磁强计会受到干扰，在精对准开始时就存在两个较小的水平误差角，和一个较大的航向误差角。因此基于MEMS捷联惯导系统的初始对准是大失准角初始对准，这导致传统的卡尔曼滤波失去作用,因此在这种情况下应采用非线性滤波。

传统的非线性滤波EKF在处理非线性较强的系统时，由于高阶项截断误差，会导致滤波数值不稳定性且有可能发散。而最近提出的基于三阶spherical-radialcubature准则的cubaturekalman filter则克服了EKF缺点。CKF类似于UKF都避免了对非线性模型的线性化处理，不依赖于具体系统模型的非线性方程，算法相对独立，适用于任何形式的非线性模型。而平方根CKF通过传播状态的方差平方根，确保了方差矩阵的对称性和正定性，一定程度上缓解了滤波过程中舍入误差导致的滤波发散和数值精度降低的问题，具有比CKF更好的滤波性能。

发明内容

本发明的目的就在于为了解决上述问题而提供一种MEMS捷联惯导自适应SCKF滤波的初始对准方法。

本发明通过以下技术方案来实现上述目的，包括以下步骤：

（1）利用GPS确定载体的初始精度、纬度参数；

（2）采集MEMS加速度计和磁强计输出的数据；

（3）采用解析法来进行系统的粗对准，粗略的得到载体坐标系到计算地理坐标系的姿态矩阵

Cbc(0)=cosβ0cosγ0-sinβ0sinα0sinγ0-cosα0sinγ0sinβ0cosγ0+cosβ0sinα0sinγ0cosβ0sinγ0+sinβ0sinα0cosγ0cosα0cosγ0sinβ0sinγ0-cosβ0sinα0cosγ0-sinβ0cosα0sinα0cosβ0cosα0]]>