专利名称：无位姿约束线激光单目视觉三维测量传感器参数标定方法
技术领域：
本发明涉及一种线激光单目视觉三维测量传感器的标定方法，特别是一种无位姿约束的单目视觉三维测量传感器参数标定方法。属于光学测量和机械工程技术领域。
背景技术：
典型的线激光单目视觉三维测量传感器由线激光投射器和单目摄像机组成，其参数包括单目摄像机内外参数等效焦距、主点坐标、由祀标坐标系到单目摄像机坐标系的变换矩阵；线激光投射器光平面参数即线激光光平面方程的参数。传统的线激光单目视觉三维测量传感器的标定方法，包括拉丝法、锯齿靶法以及三维靶标法等。但是这些方法中所用靶标制作相对复杂，且标定操作受到标定参照物的限制。已有技术中，V. Niola et al.在论文 A method for the calibration ofa 3-D laserscanner (Robotics and Computer-1ntegrated Manufacturing, 2011，27:479-484)中提出的标定方法，标定时需要机械平台控制靶标精确移动，既容易引入机械误差，又限制了标 定操作的自由度;F. Zhou> G. Zhang 在论文 Completecalibration of a structured lightstripe vision sensor through planar target of unknownorientations (Image andVision Computing, 2005，23 (I) :59-67)中提出了一种基于自由移动平面靶标的标定方法，该方法虽然避免了标定时需要控制靶标位移而引入的机械误差，但当方形棋盘靶标绕其所在平面的法向量旋转角度稍大时，靶标方格的行与列的辨识会出现二义性，导致交比不变原理中靶标特征点与其成像点的对应关系出错，无法正确标定光平面；因此，在移动靶标时，仍需避免靶标绕其所在平面的法向量旋转，靶标的摆放位姿并非完全自由，操作仍受到较大限制。
发明内容
本发明针对现有标定方法中靶标的移动需要精密机械控制或可自由移动靶标的摆放位姿受约束等不足，提出一种靶标可自由移动且摆放位姿无约束的新标定方法。该标定方法提取标定图像中的光刀中心点集及靶标特征点的成像点作为三维测量传感器标定的基础数据；根据靶标特征点的成像点所构成的向量簇叉积集合在任意拍摄位姿下的不变性，对靶标特征点的成像点进行排序，从而建立靶标特征点与其成像点的一一对应关系；由光刀中心点集拟合直线与靶标特征点的成像点所构成四边形求交，提取图像中的光平面特征点，并根据交比不变原理计算其三维坐标。由上述全部数据信息，最优化拟合计算单目摄像机的内外参数及线激光投射器的光平面参数，从而实现线激光单目视觉三维测量传感器参数的精确标定。具体标定步骤如下I)制作平面靶标。以白色为底色制作平面靶标，靶标上分布四个黑色标志圆图案，这四个黑色标志圆图案均在设定的靶标坐标系内；其中一个大直径标志圆的形心为A，三个相同直径的小直径标志圆的形心分别为B、C、D，四个标志圆形心的相对位置如下以形心A为基准，形心B位于形心A正右方，形心C位于形心A右上方，形心D位于形心A正上方，这4个形心就是标定三维测量传感器的靶标特征点。2)获取三维测量传感器标定所需图像。将靶标置于线激光单目视觉三维测量传感器的测量场景中，开启线激光投射器，投射线激光光刀至靶标上，通过移动或旋转任意改变革巴标位姿，用单目摄像机拍摄包含祀标特征点及线激光光刀—的K幅标定图像，K > 2。3)三维测量传感器标定基础数据的获取。根据步骤2)中已获得的标定图像中，提取4个标志圆图像的形心a、b、C、d ;在像素行方向上采用灰度质心法提取光刀图像^每一行的光刀中心点，由所有这些光刀中心点构成光刀中心点集，其中形心a、b、C、d即为靶标特征点在单目摄像机成像平面中的二维成像点；通过在靶标平面上定义靶标坐标系，设定4个靶标特征点A、B、C、D在靶标坐标系中的三维坐标，靶标坐标系定义如下以大直径标志圆的形心A为原点，大直径标志圆形心A 水平指向小直径标志圆形心B的方向作为U轴方向，大直径标志圆形心A竖直指向小直径标志圆形心D的方向作为V轴方向，W轴方向满足右手法则，垂直于靶标所在平面并向外；将光刀中心点集、形心a、b、c、d的二维坐标以及靶标坐标系下形心A、B、C、D的三维坐标作为三维测量传感器标定的基础数据。4)三维测量传感器标定全部数据信息的获取。在获取了三维测量传感器标定基础数据的基础上，依次对每一幅自由位姿的标定图像，计算靶标坐标系下三维靶标特征点与其二维成像点的一一对应关系，以及光平面特征点在靶标坐标系下的三维坐标，从而构成三维测量传感器标定所需全部数据信息。4.1)三维靶标特征点与其二维成像点一一对应关系的获取。在获取了单目摄像机参数标定基础数据的基础上，针对每一幅标定图像，将成像面积最大的标志圆所包含靶标特征点的二维成像点a与靶标坐标系中大直径标志圆的三维形心点A对应；并在标定图像中，以点a为始点，逆时针方向依次以其余三个小直径标志圆所包含祀标特征点的二维成像点b、C、d为终点作向量,则得到向量簇V = ^h,c,d^ ;逐一计算向量簇V中的向量叉积并判断其方向，有
-\{bxc)-k <Q对于向量办:]——一，两项均为负，
-(cxb)-k> 0对于向量———，两项一正一负，
(cxd)-k<0
,-\{<dxb) k>0 ,对于向量彳———，两项均为正，
[(^ X c) ■ A > 0其中!为摄像机成像平面法向量，且满足右手法则。以“ + ”代表正，代表负，则上述计算结果可写成集合5二|(-，-)5,(+，-);，(+，+)3；}，称作向量簇￥的叉积方向集合。由透射投影性质可知集合S具有不变性，即无论靶标如何旋转或移动，集合S始终保持不变。根据这一性质，即可将这三个小直径标志圆所包含靶标特征点的二维成像点b、c、d与其在靶标坐标系下的三维形心点B、C、D依次对应，从而确定了所有4个三维靶标特征点与其二维成像点的对应关系。4. 2)光平面特征点在靶标坐标系下三维坐标的获取。
获得4个靶标特征点的二维成像点a、b、c、d所围成的四边形；计算获得直线巧与直线i的交点e以及直线忑与直线忑的交点f的坐标。同样地，在靶标坐标系中计算获得直线7万与直线元的交点E以及直线与直线]^的交点F的坐标。在图像中，最小二乘法拟合四边形abed内的光刀中心点集得到光刀中心点集拟合直线^，获取直线^与四边形abed的两个交点，即图像中的光平面特征点P、q。运用图像中的点P、q，点a、b、c、d、e、f 及其在靶标坐标系下对应的三维坐标点，根据交比不变原理，即可计算得到点P、q在靶标坐标系下的三维坐标点P、Q，其W坐标均为O。5)单目摄像机内外参数的标定。定义单目摄像机坐标系如下以单目摄像机镜头光心0为原点，单目摄像机镜头光轴为Z轴，像素行方向为X轴，像素列方向为Y轴。由三维靶标特征点坐标及其对应二维成像点坐标，采用张正友的平板标定算法对单目摄像机内外参数进行线性求解后，通过Levenberg-Marquardt非线性优化,使祀标特征点在单目摄像机成像平面上的投影误差的平方和最小，即优化标定得到单目摄像机所有内外参数内部参数为单目摄像机X轴方向、Y轴方向等效焦距fx=f/Dx、fY=f/DY以及主点坐标(Cx，CY)，其中Dx、Dy为单目摄像机行像素、列像素间距，f为单目摄像机实际焦距，外部参数为K个由靶标坐标系到单目摄像机坐标系的变换矩阵H。6)线激光投射器光平面参数的标定。通过光平面特征点在靶标坐标系下的三维坐标左乘相应的变换矩阵H，将所有K幅标定图像共计2K个光平面特征点统一变换到摄像机坐标系下，由这2K个光平面特征点在摄像机坐标系下的坐标，运用最小二乘法，以点到面的距离为目标函数
权利要求
1.一种无位姿约束线激光单目视觉三维测量传感器參数标定方法，其特征在于本发明的标定方法包括如下步骤 1)制作平面靶标以白色为底色制作平面靶标，靶标上分布四个黑色标志圆图案，这四个黑色标志圆图案均在设定的靶标坐标系内；其中ー个大直径标志圆的形心为A，三个相同直径的小直径标志圆的形心分别为B、C、D，四个标志圆形心的相对位置如下以形心A为基准，形心B位于形心A正右方，形心C位于形心A右上方，形心D位于形心A正上方，这4个形心就是标定三维测量传感器的靶标特征点； 2)拍摄三维测量传感器标定所需图像将靶标置于线激光单目视觉三维測量传感器的測量场景中，开启线激光投射器，投射线激光图案至靶标上，通过移动或旋转任意改变靶标位姿，用单目摄像机拍摄包含祀标特征点及线激光光刀i的K幅标定图像，K ^ 2 ； 3)三维测量传感器标定基础数据的获取 根据步骤2)中已获得的标定图像中，提取4个标志圆图像的形心a、b、c、d,在像素行方向上采用灰度质心法提取光刀图像▲每一行的光刀中心点，由所有这些光刀中心点构成光刀中心点集，其中形心a、b、C、d即为靶标特征点在单目摄像机成像平面中的ニ维成像点，将光刀中心点集、形心a、b、C、d的ニ维坐标以及靶标坐标系下形心A、B、C、D的三维坐标作为三维测量传感器标定的基础数据； 4)三维测量传感器标定全部数据信息的获取 在获取了三维测量传感器标定基础数据的基础上，依次对每一幅自由位姿的标定图像，计算靶标坐标系下三维靶标特征点与其ニ维成像点的一一对应关系，以及光平面特征点在靶标坐标系下的三维坐标，从而构成三维测量传感器标定所需全部数据信息； .4.I)三维靶标特征点与其ニ维成像点一一对应关系的获取 针对每一幅标定图像，将成像面积最大的标志圆所包含靶标特征点的ニ维成像点a与革巴标坐标系中大直径标志圆的三维形心点A对应,并在标定图像中，以点a为始点,逆时针方向依次以其余三个小直径标志圆所包含祀标特征点的ニ维成像点b、C、d为终点作向量，则得到向量簇ァ逐一计算向量簇V中的向量叉积并判断其方向，有 对于向量ゲ彳
2.根据权利要求I所述的无位姿约束线激光单目视觉三维测量传感器参数标定方法，其特征是所述的步骤I)中，所述的形心B位于形心A正右方16mm处，形心D位于形心A正上方16mm处，所述的靶标坐标系定义如下以形心A为原点，形心A水平指向形心B的方向作为U轴方向，形心A竖直指向形心D的方向作为V轴方向，W轴方向满足右手法则，垂直于靶标所在平面并向外，形心C位于形心A右上方，且距离U轴和V轴各IOmm处，则在靶标坐标系下，形心A坐标为(Ctam, 0臟,0臟)，形心B坐标为(16臟,0臟,0臟)，形心C坐标为(10臟，10mm, Omm),形心 D 坐标为(0mm, 16mm, 0mm)。
3.根据权利要求I所述的无位姿约束线激光单目视觉三维测量传感器参数标定方法，其特征是所述的步骤I)中，所述的平面靶标为40X40mm的平板，黑色大直径标志圆的直径为5mm,黑色小直径标志圆的直径为3mm。
全文摘要
无位姿约束线激光单目视觉三维测量传感器参数标定方法，属于光学测量和机械工程技术领域。本发明在提取基础数据后，根据靶标特征点的成像点所构成向量簇叉积方向集合在任意拍摄位姿下的不变性，对成像点排序，建立靶标特征点与其成像点的对应关系；由光刀中心点集拟合直线与靶标特征点的成像点所构成四边形求交，提取光平面特征点，并根据交比不变原理计算其三维坐标。最优化拟合计算单目摄像机内外参数及线激光投射器光平面参数，实现线激光单目视觉三维测量传感器参数的精确标定。标定时，靶标可完全自由移动或旋转，摆放位姿无约束，两部分参数的标定共用同一组标定图像，在保证三维测量传感器标定精度的同时简化了标定步骤。
文档编号G01B11/24GK102980528SQ20121047379
公开日2013年3月20日 申请日期2012年11月21日 优先权日2012年11月21日
发明者习俊通, 李凌旻, 王振兴, 陈晓波 申请人:上海交通大学