[发明专利]一种基于角度约束的空间圆姿态识别二义性消除方法

说明书

技术领域

本发明涉及空间物体的位姿测量技术，尤其涉及一种基于角度约束的空间圆姿态识别二义性消除方法。

背景技术

通过单幅图像进行空间物体位姿测量的问题是机器视觉领域中一个基本而重要的问题，在视觉导航、机器人定位、物体识别、视觉监控和工业测量等方面都有着广泛而重要的应用。所谓位姿测量指的是，在摄像机已标定的条件下，通过空间三维基元(如点和直线等)与图像二维基元之间的对应关系，求得摄像机坐标系与物体坐标系之间的刚体变换关系，从而能够得到物体在摄像机坐标系中的位置和姿态。

目前常用的位姿定位方法主要包括：基于空间点到图像点对应的定位方法和基于空间直线到图像直线对应的定位方法。相比较而言，基于空间直线到图像直线对应的定位方法抗噪声能力较强，从而具有更好的鲁棒性。所谓鲁棒性就是指系统的健壮性，鲁棒性是在异常和危险情况下系统生存的关键。

由于圆是物体的基本几何形状，在许多自然景物和人造物体中大量存在，如各种工件、零部件的定位孔等。基于单个圆进行空间位姿测量的视觉检测技术，综合运用了电子学，光电探测，图像处理和计算机技术，实现对物体的空间定位，具有非接触，速度快，柔性好以及自动化程度高等优点，具有广泛而重要的应用前景。另外，基于圆特征的空间位姿测量方法较点、线等特征，具有抗遮挡、鲁棒性强的特点，并且可以得到空间物体位姿的闭式解，避免了基于点、线定位过程中复杂、耗时的非线性优化过程，使得测量简单快速。

现有技术中存在一种基于虚圆点的方式利用单个空间圆进行空间物体定位的方法，但是该方法需要求解高次二元方程组，在计算上复杂且易于受到噪声的影响；并且基于圆特征的空间位姿测量方法，由于圆提供的约束太少，从而无法消除在空间物体定位过程中产生的二义性问题。

发明内容

有鉴于此，本发明的主要目的在于提供一种基于角度约束的空间圆姿态识别二义性消除方法，以解决现有的空间单个圆姿态识别方法存在二义性的问题。

为达到上述目的，本发明的技术方案是这样实现的：

本发明提供了一种基于角度约束的空间圆姿态识别二义性消除方法，包括：

对摄像机进行标定，得到摄像机的内部参数；

获取所述摄像机拍摄空间圆得到的测量图像，并对所述测量图像进行处理，获取所述测量图像中的椭圆边缘点和几何元素的特征点；

根据得到的所述摄像机内部参数、测量图像中的椭圆边缘点，拟合椭圆曲线的方程，计算得到在摄像机坐标系下空间圆的圆心坐标和空间圆所在平面的法向量；

根据所述空间圆的圆心在摄像机坐标系下的坐标、空间圆所在平面在摄像机坐标系下的法向量，以及测量图像中几何元素的特征点，计算得到与所述几何元素对应的空间几何元素的表达式；

根据空间几何元素的表达式得到空间几何元素的方向系数，并根据所述方向系数得到空间几何元素的夹角；根据空间角度约束，从空间几何元素的夹角中选取得到真实夹角，并确定空间圆所在平面的真实法向量。

所述几何元素为与所述空间圆所在平面共面的两条不重合直线。

根据张正友平面法对所述摄像机进行标定。

通过Hessian矩阵法对所述测量图像进行处理，得到所述测量图像中的椭圆边缘点和几何元素的特征点。

所述计算得到与几何元素对应的空间几何元素的表达式，具体包括：

根据所述几何元素的表达式得到所述几何元素的投影平面的方程；

根据所述空间圆的圆心在摄像机坐标系下的坐标，以及所述空间圆所在平面在摄像机坐标系下的法向量，确定空间中的两个平面；

根据所确定的两个平面的方程，以及所述投影平面的方程，分别得到两组空间几何元素的表达式。

本发明所提供的基于形状特征的空间圆姿态识别二义性消除方法，通过标定得到摄像机的内部参数；获取摄像机拍摄空间圆得到的测量图像，处理得到测量图像中的椭圆边缘点和几何元素的特征点，并计算得到在摄像机坐标系下空间圆的圆心坐标和空间圆所在平面的法向量，进而得到与测量图像上的几何元素所对应的空间几何元素的表达式；根据空间几何元素的表达式，以及已知的空间角度约束，确定空间圆所在平面的真实法向量。本发明通过引入与空间圆所在的平面共面的几何元素，基于角度约束，有效的消除了空间圆姿态识别中的二义性问题，提高了空间圆姿态识别的实用性和可靠性。

附图说明

图1为本发明一种基于角度约束的空间圆姿态识别二义性消除方法的流程图；

图2为本发明中数字二维平面靶标的示意图；

图3为本发明中空间圆姿态识别的示意图；