复杂磁扰动场景MEMS电子罗盘的动态方位角解算方法
基本信息
申请号 | CN201911310478.3 | 申请日 | - |
公开(公告)号 | CN111272158A | 公开(公告)日 | 2020-06-12 |
申请公布号 | CN111272158A | 申请公布日 | 2020-06-12 |
分类号 | G01C17/38(2006.01)I | 分类 | - |
发明人 | 叶景成;时广轶;王春波;徐开明;吴志刚;金玉丰 | 申请(专利权)人 | 无锡北微传感科技有限公司 |
代理机构 | 北京商专润文专利代理事务所(普通合伙) | 代理人 | 无锡北微传感科技有限公司;北京大学深圳研究生院 |
地址 | 214000江苏省无锡市滨湖区绣溪路58-30 | ||
法律状态 | - |
摘要
摘要 | 本发明公开了复杂磁扰动场景MEMS电子罗盘的动态方位角解算方法,包括:获取多冗余传感器中加速度计、磁力计和陀螺仪的输出值;判断是否需要进行滤波;若需要进行滤波,构建扩展卡尔曼滤波器,输出加速度计、磁力计和陀螺仪的输出值的最优估值;若不需要进行滤波,直接输出多冗余传感器中加速度计、磁力计和陀螺仪的输出值;分别用倾角补偿算法、磁场比例角补偿算法和陀螺仪Z轴积分算法解算方位角;根据载体当前运动姿态进行数据融合,得到最优方位角。本发明提供的复杂磁扰动场景MEMS电子罗盘的动态方位角解算方法,使MEMS电子罗盘在磁扰动和动态条件下,自适应完成准确的方位角解算,提高定向精度;算法结构简单,收敛速度快。 |
