遗传算法结合自适应阈值约束的ICP位姿定位技术

摘要

一种遗传算法结合自适应阈值约束优化的ICP位姿估计方法，可应用于箱体混乱工件的快速六自由度位姿定位。采用统计学滤波和区域增长分割算法对原始点云进行预处理，去除离群点并得到各混乱工件的点云集；利用遗传算法得到目标点集相对参考点云初始位姿的全局最优解，减少ICP算法迭代的次数；采用自适应阈值约束剔除局部大变形点，利用欧氏距离约束剔除大部分变形点，利用法向量夹角阈值进一步剔除满足距离条件但不满足夹角条件的误匹配点对，保证算法实时性的同时提高位姿定位的精度。