[发明专利]单相机测量物体三维位置与姿态的方法

摘要

本发明公开一种单相机测量物体三维位置与姿态的方法，利用单相机获得待测目标的图像，通过精确识别待测目标上的标记点，来确定待测目标的实时三维位置与姿态信息；根据检测场景和范围选定合适的相机，并对相机进行标定，获得相机的内外参数；根据待测目标设计目标标记点并将标记点合理布局；然后根据相机捕获的图像进行目标检测和特征点的识别，并将检测到的特征点与标记点进行匹配；最后根据测量点与物体标记点的对应关系来求待测目标的三维位置与姿态信息。对于非刚性物体还能够检测到物体是否有变形。本发明采用单相机来实现三维测量，能够获知目标在三维空间中的空间几何参数、位置与姿态等信息，降低了测量成本和测量系统的体积，并且便于操作。

主权项

单相机测量物体三维位置与姿态的方法，其特征在于：包括相机标定，目标标记，特征点的检测，特征点与标记点的匹配和目标三维位置与姿态信息的计算五个步骤；步骤1：相机标定，标定相机的内外参数，建立视觉测量系统中三维世界坐标和二维图像坐标的映射关系，所述相机的内参数是指相机的焦比、光心及成像坐标系两轴间的夹角；所述相机的外参数是指旋转矩阵和平移向量；步骤2：目标标记，将标记点标记在目标上，以便准确快速的检测和识别；步骤3：特征点的检测，对相机采集的图像进行图像处理，获得图像中的所有特征点，计算各特征点在图像中的位置，所述图像的特征点是成像后待测目标上的标记点；步骤4：特征点与标记点的匹配，在检测出的所有特征点中确定用于匹配的特征点，将其与目标上标记点进行匹配，获得二维坐标与三维坐标的对应关系；步骤5：目标三维位置与姿态信息的计算，根据特征点与标记点的对应关系，计算目标的三维位置与姿态信息，所述的三维位置与姿态信息是指目标在三维世界坐标系中的三维坐标和其相对于坐标系的偏转角度。