基于双目视觉与切面向量的曲面物体位姿估计

针对单目视觉估计曲面物体位姿时世界坐标不易获得的问题,将双目视觉与合作靶标相结合,提出一种高效的曲面物体位姿估计方法。通过双目相机生成不同位姿下的目标物体点云以便快速提取靶标角点的世界坐标,不同于常用的点云配准位姿估计,本文取对应点坐标差的均值表示平移向量;然后,求取靶标角点所在切面的法向量,组成目标在不同位姿坐标系下的矩阵,从而推导出旋转矩阵。所提方法不仅保证了位姿估计结果的准确性与稳定性,而且算法的运行效率显著提高。实验结果表明,本文方法的运行效率相比ICP算法提高了98.24%,比NDT算法提高了97.58%,具有实际应用价值。