一种融合RGBD深度传感器与编码器的机器人定位方法
摘要:
本发明公开了一种融合RGBD深度传感器与编码器的机器人定位方法,首先建立得到机器人运动区域内的路标数据库,路标数据库中包括路标图像和对应的机器人位置坐标,机器人运动过程中基于编码器定位得到机器人位姿矩阵Twe(t),同时基于RGBD深度传感器定位,如果基于RGBD深度传感器定位成功,则根据当前时刻基于编码器定位得到的机器人位姿矩阵Twe(t)和基于RGBD深度传感器定位得到的位姿矩阵Twv(t)计算变换矩阵,并令机器人当前位姿矩阵为Twv(t),如果不成功则通过变换矩阵对Twe(t)进行定位误差矫正,得到机器人当前位姿矩阵。本发明基于RGBD深度传感器定位对编码器定位误差进行矫正,提高机器人定位精度和鲁棒性。
0/0