移动机器人的陀螺仪数据校正方法、装置和设备
摘要:
本发明提供一种移动机器人的陀螺仪数据校正方法、装置和设备。该方法包括:对当前帧的激光雷达数据进行回环检测;若回环检测成功,则采用迭代最近点ICP算法,根据移动机器人的Y个关键帧的初始估计位置、Y个所述关键帧的激光雷达点集、Y个所述关键帧的初始估计角度、所述移动机器人的当前帧的激光雷达点集,确定所述当前帧的Y个待选估计位姿信息;根据每个所述关键帧的激光雷达点集和所述当前帧的激光雷达点集,确定所述当前帧的每个待选估计位姿的量化值;根据Y个所述量化值中的最大量化值对应的待选估计位姿信息,对所述移动机器人的陀螺仪数据进行校正。该方法能够对陀螺仪数据进行更快速、更准确的校正,提高了系统工作的鲁棒性。
0/0