位姿估计方法、位姿估计系统、终端、存储介质及应用

摘要

本发明属于物体空间位姿估计技术领域，公开一种位姿估计方法、位姿估计系统、终端、存储介质及应用，采用高精度的结构光全局式三维扫描仪来制作物体的点云模板，解决了直接由CAD模型生成模板导致与实际零件存在差异性大的问题。基于两步分割法的分割方式有效的提高目标物体分割提取的效率与准确度。结合法向量约束与邻域数约束的关键点提取算法有效提取模板与场景点云中具有大曲率特征且非噪声的关键点。在关键点处构建FPFH特征描述并利用随机采样一致性，能够有效得到场景中目标物体到模板的一个初始位姿估计。本发明引入对应点法线一致性约束来改进点到平面的ICP算法，避免陷入局部最优解，从而完成初始位姿的精确修正。