一种基于融合多传感器的因子图室内定位方法
基本信息
申请号 | CN202210332425.7 | 申请日 | - |
公开(公告)号 | CN114674314A | 公开(公告)日 | 2022-06-28 |
申请公布号 | CN114674314A | 申请公布日 | 2022-06-28 |
分类号 | G01C21/16(2006.01)I;G01C21/20(2006.01)I | 分类 | 测量;测试; |
发明人 | 潘雷;武星宇;张立阳;高瑞 | 申请(专利权)人 | 天津城建大学 |
代理机构 | 北京酷爱智慧知识产权代理有限公司 | 代理人 | - |
地址 | 300384天津市西青区津静路26号 | ||
法律状态 | - |
摘要
摘要 | 本发明公开了一种基于融合多传感器的因子图室内定位方法,包括步骤:根据多传感器的测量模型制定传感器因子,将传感器因子输入至预设的因子动态适应函数作为因子节点、将机器人导航状态作为变量节点构建因子图框架;对获取的多传感器的测量数据进行非线性融合,得到机器人导航状态的最优状态增量估计;结合增量平滑算法计算机器人所有导航状态下的全导航解。本发明可有效融合多传感器的测量信息,提高实时性和定位精度。 |
