一种基于改进的粒子滤波的移动机器人同时定位与地图构建的方法与流程

文档序号:11321813阅读:来源:国知局

技术特征:

技术总结
本发明公开了一种基于改进的粒子滤波的移动机器人同时定位与地图构建的方法,初始化机器人初始时刻位姿;根据t‑1时刻的位姿信息,得到t时刻先验概率密度函数,生成采样粒子集p;对粒子的权值进行初始化处理;选取重要性概率密度函数,生成新采样粒子集q,计算粒子权重,更新粒子权值,进行权值的归一化处理;计算当前时刻t随机样本粒子的加权和来表示后验概率密度,得到移动位姿和环境地图信息;判断是否有新观测值输入,如果有则返回,如果没有则结束循环,在返回之前,判断是否需要进行重采样。根据系统状态的不同,设定动态的阈值进行判断,并结合了遗传算法。本发明减小了粒子退化问题对SLAM的影响,减小了SLAM问题的计算量。

技术研发人员:朱齐丹;王靖淇;纪勋;张欣
受保护的技术使用者:哈尔滨工程大学
技术研发日:2017.07.03
技术公布日:2017.10.13
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1