首页/ 无锡北微传感科技有限公司/ 专利详情

复杂磁扰动场景MEMS电子罗盘的动态方位角解算方法

基本信息

申请号 CN201911310478.3 申请日 -
公开（公告）号 CN111272158B 公开（公告）日 2021-12-31
申请公布号 CN111272158B 申请公布日 2021-12-31
分类号 G01C17/38 分类 测量；测试;
发明人 叶景成;时广轶;王春波;徐开明;吴志刚;金玉丰 申请（专利权）人 无锡北微传感科技有限公司
代理机构 北京商专润文专利代理事务所（普通合伙） 代理人 邢若兰
地址 214000 江苏省无锡市滨湖区绣溪路58-30
法律状态 -

摘要

摘要 本发明公开了复杂磁扰动场景MEMS电子罗盘的动态方位角解算方法，包括：获取多冗余传感器中加速度计、磁力计和陀螺仪的输出值；判断是否需要进行滤波；若需要进行滤波，构建扩展卡尔曼滤波器，输出加速度计、磁力计和陀螺仪的输出值的最优估值；若不需要进行滤波，直接输出多冗余传感器中加速度计、磁力计和陀螺仪的输出值；分别用倾角补偿算法、磁场比例角补偿算法和陀螺仪Z轴积分算法解算方位角；根据载体当前运动姿态进行数据融合，得到最优方位角。本发明提供的复杂磁扰动场景MEMS电子罗盘的动态方位角解算方法，使MEMS电子罗盘在磁扰动和动态条件下，自适应完成准确的方位角解算，提高定向精度；算法结构简单，收敛速度快。