[发明专利]一种MEMS惯性组件及姿态修正方法

权利要求书

1.一种MEMS惯性组件，其特征在于，包括：

MEMS惯性测量单元，所述MEMS惯性测量单元上设有转接板；

磁罗盘，所述磁罗盘通过所述转接板设于所述MEMS惯性测量单元上；

电路板，所述电路板与所述MEMS惯性测量单元以及所述磁罗盘均电连接。

2.根据权利要求1所述的MEMS惯性组件，其特征在于，还包括：

至少一个支柱，每一所述支柱均包括螺纹段和支撑连接段，所述螺纹段上设有螺母，所述MEMS惯性测量单元上设有供所述螺纹段穿过的第一连接孔，所述螺纹段穿过所述第一连接孔后通过所述螺母被锁紧在所述MEMS惯性测量单元上；

至少一个第一螺栓，所述转接板上设有供所述第一螺栓穿过的第二连接孔，所述第一螺栓穿过所述第二连接孔后与所述支撑连接段螺纹连接。

3.根据权利要求1所述的MEMS惯性组件，其特征在于还包括：

至少一个第二螺栓，所述磁罗盘上设有供所述第二螺栓穿过的第三连接孔；

至少一个连接凸起，所述连接凸起设于所述转接板上，所述磁罗盘上设有与所述连接凸起适配的连接凹槽，所述连接凸起位于所述连接凹槽内，所述第二螺栓穿过所述第三连接孔后与所述连接凸起螺纹连接。

4.根据权利要求1所述的MEMS惯性组件，其特征在于，所述电路板通过第一插头与所述MEMS惯性测量单元相连；所述电路板通过第二插头与所述磁罗盘相连；所述电路板通过第三插头连接对外接口。

5.一种利用如权利要求1-4任一项所述的MEMS惯性组件进行姿态修正的方法，其特征在于，包括如下步骤：

判断是否接收到磁航向，若是，进入下一步，其中，所述磁航向由所述磁罗盘测得；

判断修正周期1s是否有效，若是，进入下一步；

计算当前时刻与上一秒的系统航向变化率、当前时刻与上一秒的磁航向变化率以及航向变化率差值，并保存所述航向变化率和磁航向变化率；

判断所述航向变化率差值是否小于0.5°/s，且是否有姿态角小于5°、三轴角速率小于0.5°/s以及三轴加速度小于0.15m/s²；

若是，则对有效次数进行累计加1；

判断累计后的有效次数是否到达预定值T次；

若是则计算系统航向与磁航向差值；

利用所述系统航向与磁航向的差值修正航向。

6.根据权利要求5所述的姿态修正方法，其特征在于：所述预定值T为3。

7.一种利用如权利要求1-4任一项所述的MEMS惯性组件进行姿态修正的方法，其特征在于，包括如下步骤：

接收输入的空速和高度参数，其中，所述空速是指飞行器飞行时相对空气的速度，所述高度参数经补偿后用于高度阻尼；

以修正后空速的地理系分量和导航解算的地理系速度分量的差值作为量测量，构成卡尔曼滤波器的观测量，利用卡尔曼滤波技术进行估计和校正；

通过所述空速和高度阻尼不断修正滤波状态矩阵。