基于粒子滤波的定位方法、系统、设备及存储介质
基本信息
| 申请号 | CN202210224066.3 | 申请日 | - |
| 公开（公告）号 | CN114674320A | 公开（公告）日 | 2022-06-28 |
| 申请公布号 | CN114674320A | 申请公布日 | 2022-06-28 |
| 分类号 | G01C21/20（2006.01）I;G01C21/00（2006.01）I | 分类 | 测量；测试; |
| 发明人 | 张景利;古克起;李钊;卢玉川;张昭;靳庆义;郑贵宇;王俊;张铸;马昆;吴明辉;王运志;温宇航;任洪泉;王玉宝 | 申请（专利权）人 | 中科南京软件技术研究院 |
| 代理机构 | 深圳泛航知识产权代理事务所（普通合伙） | 代理人 | - |
| 地址 | 100000北京市海淀区复兴路6号 | ||
| 法律状态 | - | ||
摘要
| 摘要 | 本发明提供了一种基于粒子滤波的定位方法，定位方法包括：获取粒子集合中各个粒子的权重系数；根据各个粒子的权重系数对各个粒子进行N次重采样，以生成目标粒子集合；将目标粒子集合形成的位姿与预设激光模板匹配，以生成机器人的初始位姿；根据机器人的轮子码盘的读数更新机器人的初始位姿；根据更新后的初始位姿以及激光雷达实时采集的数据，更新动态地图层；在动态地图层与当前区域内的静态地图层的形状以及朝向相同的情形下，将动态地图层与静态地图层进行融合，以生成室内场景地图；本发明实施例提供的基于粒子滤波的定位方法，使用激光模板匹配的方法来帮助粒子滤波进行收敛，能够有效解决定位模式中的动态与长期稳定定位的问题。 |
