用于机器人定位的磁力计辅助惯性导航系统及方法

基本信息

申请号 CN201911309264.4 申请日 -
公开(公告)号 CN110954102A 公开(公告)日 2020-04-03
申请公布号 CN110954102A 申请公布日 2020-04-03
分类号 G01C21/18(2006.01)I;G01C21/04(2006.01)I 分类 测量;测试;
发明人 时广轶;柯谚泽;王春波 申请(专利权)人 无锡北微传感科技有限公司
代理机构 北京商专润文专利代理事务所(普通合伙) 代理人 邢若兰
地址 214000江苏省无锡市滨湖区绣溪路58-30
法律状态 -

摘要

摘要 本申请提供一种提供用于机器人定位的磁力计辅助惯性导航系统的方法,包括以下步骤:构建三轴加速度计、三轴陀螺仪以及三轴磁力计构成的导航系统;采集加速度计、陀螺仪以及磁力计输出的数据,透过加速度计解算姿态,通过磁力计解算航向;解算速度并对速度量进行误差补偿;解算位置并对位置进行误差补偿;利用扩展卡尔曼滤波对以上信息进行处理后输出最终的位置信息。由此,利用本申请的技术方案能够准确反映移动机器人姿态和位置信息。