有效

一种室内机器人定位与建图方法及装置

李冰、苏聪、王刚、张林、王亚洲、刘勇、董乾、赵霞
东南大学

摘要

本发明公开了一种室内机器人定位与建图方法及装置,包括:进行粒子采样,获取k时刻每个粒子的位姿,并且根据粒子个数平均分配各粒子的权值;获取k时刻的实际观测值,结合每个粒子的位姿对每个粒子的权值进行更新并归一化处理;根据更新后的每个粒子权值,计算得到有效粒子数;判断有效粒子数小于设定的阈值时,对粒子进行重采样及计算更新重采样粒子权值,否则大于时保持原采样粒子和其权值;根据更新后重采样或原采样粒子权值,利用当前状态的期望值对k时刻的机器人的实际位姿更新;利用卡尔曼滤波算法更新地图的均值和方差,以得全部粒子的地图信息,根据实际位姿建立机器人地图。本发明可在保证地图精度的同时大大提高了建图的实时性。

暂无引用专利