[发明专利]基于萤火虫优化粒子滤波的机器人定位与建图方法及装置有效
申请号: | 201910473312.7 | 申请日: | 2019-05-31 |
公开(公告)号: | CN110263905B | 公开(公告)日: | 2021-03-02 |
发明(设计)人: | 崔昊杨;张宇;刘昊;秦伦明;杨强强;卞正兰;唐忠 | 申请(专利权)人: | 上海电力学院 |
主分类号: | G06N3/00 | 分类号: | G06N3/00;G06T7/70 |
代理公司: | 上海科盛知识产权代理有限公司 31225 | 代理人: | 蔡彭君 |
地址: | 200090 *** | 国省代码: | 上海;31 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明涉及一种基于萤火虫优化粒子滤波的机器人定位与建图方法及装置,其中方法包括:步骤S1:获得采样初始时刻粒子;步骤S2:通过机器人运动模型和观测模型得到t时刻的目标值,并通过重要性采样得到t时刻的粒子集合;步骤S3:利用改进后的萤火虫算法优化采样粒子的位置,分别得到所有粒子t+1时刻优化后的位置;步骤S4:计算优化后的粒子权重并进行归一化,筛选有效粒子,并基于有效粒子进行重采样,直至粒子总数达到设定数目;步骤S5:根据步骤S4得到的粒子群进行机器人位姿与环境估计。与现有技术相比,本发明解决了固定步长因子导致的收敛速度慢、在极值点附近易“振荡”等问题,提高了粒子全局寻优和局部寻优的精度与效率。 | ||
搜索关键词: | 基于 萤火虫 优化 粒子 滤波 机器人 定位 方法 装置 | ||
【主权项】:
1.一种基于萤火虫优化粒子滤波的机器人定位与建图方法,其特征在于,包括:步骤S1:获得采样初始时刻粒子;步骤S2:通过机器人运动模型和观测模型得到t时刻的目标值,并通过重要性采样得到t时刻的粒子集合;步骤S3:利用改进后的萤火虫算法优化采样粒子的位置,分别得到所有粒子t+1时刻优化后的位置;步骤S4:计算优化后的粒子权重并进行归一化,筛选有效粒子,并基于有效粒子进行重采样,直至粒子总数达到设定数目;步骤S5:根据步骤S4得到的粒子群进行机器人位姿与环境估计。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于上海电力学院,未经上海电力学院许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201910473312.7/,转载请声明来源钻瓜专利网。
- 上一篇:使第三方机器系统获得生存性情感的方法
- 下一篇:非对称负相关搜索方法