[发明专利]一种利用激光点云数据的移动机器人轨迹确定方法及装置

摘要

本发明涉及一种利用激光点云数据的移动机器人轨迹确定方法及装置，属于定位技术领域。方法包括：获取每帧的扫描点云数据；提取点特征和平面特征；根据相邻两帧的点特征确定点特征关联，平面特征确定相邻两帧是否存在平面特征关联；若存在平面特征关联，则根据这两帧中关联的平面对的法向量确定相关矩阵；若相关矩阵的秩小于满秩，或者秩等于满秩、且条件数大于条件数设定阈值，则结合平面特征关联和点特征关联确定帧间位姿变换矩阵；若秩等于满秩、且条件数小于等于条件数设定阈值，则根据相关矩阵确定帧间位姿变换矩阵。本发明通过对平面特征的系统约束进行判断，进而选择不同的方法确定移动机器人的帧间位姿变换矩阵，提高了定位的精度。