摘要
针对迭代最近点(ICP)算法容易造成局部最优和正态分布变换(NDT)算法在长距离导航中会出现较大转角偏差的问题,提出一种基于直线特征的ICP自主定位(CICP)方法.利用激光扫描点集与其拟合直线的协方差函数关系,以快速匹配扫描点间的直线特征,通过扫描匹配点集与拟合直线的闭环误差获得当前时刻全局环境中相邻匹配扫描点间的位姿,并通过室内环境下的自主定位实验验证其可靠性.结果表明,与传统的ICP算法和NDT算法相比,CICP算法具有较好实时性和较高的定位精度,能够降低ICP算法的矩阵运算量,提高机器人的自定位精度.
- 单位