一种激光与相机相对位姿关系的标定方法技术

本发明专利技术公开了一种标定激光和相机相对位姿的方法，涉及计算机视觉与图像处理领域。该方法包括以下步骤：安装激光器与相机，制作棋盘格标定板，定义世界坐标系、相机坐标系与图像坐标系，标定相机内参，将激光束打在标定板上并采集含有完整标定板的图像，提取图像上的激光点，计算激光点在相机坐标系下的坐标，计算激光束在相机坐标系下的直线方程，计算激光与相机坐标系的交点及夹角。本发明专利技术方法仅使用棋盘格标定板即能够测量激光与相机坐标系的相对位姿关系，可操作性好，测量精度高，且步骤简单。本发明专利技术提出的测量方法实用性较高，测量结果能应用于计算机视觉测量等领域。

【技术实现步骤摘要】

本专利技术涉及计算机视觉与图像处理领域，具体涉及一种激光与相机相对位姿关系的标定方法，通过使用相机标定技术测量激光与相机坐标系的相对位姿关系。
技术介绍
在复杂的场景中使用相机准确测量目标的大小、位置在工业测量中有着重要的应用，而通过在相机上固定激光发射装置，然后提取激光点在图像中的坐标，可以提供目标物体的附加信息，使视觉测量更易实现。在已知激光发射装置与相机相对位姿的前提下，我们可以更加有效的测量目标与相机间的三维位置关系。本专利技术新需要提出一种测量激光与相机坐标系之间的位置关系的方法，包括激光与相机坐标系各平面之间的夹角和交点坐标。
技术实现思路
本专利技术的目的在于针对上述现有技术中的问题，提供一种激光与相机相对位姿关系的标定方法，在已知激光与相机的相对位置信息的前提下，通过提取激光点在图像中的像素点坐标，通过计算机视觉的方法完成对目标位置、目标大小等的测量，操作简单，结果精确。为了实现上述目的，本专利技术采用的技术方案包括以下步骤：步骤一、将相机和激光器固定在一起，并保证它们的相对位置以及相机的内部参数不发生改变；定义相机坐标系OC、世界坐标系OW；对相机的内部参数进行标定，得到相机的内部参数矩阵A=fx0u00fyv000I,]]>其中(fx,fy)为相机的等效焦距，(u0,v0)为相机光心坐标；步骤二、取标定板并正对于激光器发射出的激光束，打开激光，移动标定板，并始终使激光束的中心打在标定板上，用相机采集标定板的图像；建立图像坐标系，首先获得激光点在图像坐标系下的坐标Di，之后通过相机成像模型求得激光点此时在相机坐标系下的坐标Pc1；然后将标定板由近及远放置在不同的位置下，重复上述步骤，按上述方法依次计算出激光点在各个距离位置下的坐标，记为Pc1,Pc2...Pcn；步骤三、由各位置下激光点坐标Pc1,Pc2...Pcn拟合出激光束在相机坐标系下的直线方程：x-x0m0=y-y0n0=z-z0p0]]>其中，[x0,y0,z0]为激光束直线上一点的坐标，[m0,n0,p0]为激光束直线的方向向量；由激光束在相机坐标系下的直线方程，即求得激光束与相机坐标系XOY平面、YOZ平面、XOZ平面的夹角及交点；结果如下：θXOY=cos-1(m02+n02m02+n02+p02)]]>θYOZ=cos-1(n02+p02m02+n02+p02)]]>θXOZ=cos-1(m02+p02m02+n02+p02)]]>PXOY=-z0p*m0+x0-z0p*n0+y00]]>PYOZ=0-z0p*n0+y0-z0p*p0+z0]]>PXOZ=-z0p*m0+x00-z0p*p0+z0]]>通过上式计算，完成激光束与相机坐标系夹角及交点的测量。所述的标定板采用黑白格标定板，黑白格标定板的黑白方格数为11*10，边长为12mm。固定相机不动，将标定板由近及远放在距离相机300mm、600mm、700mm、900mm、1100mm、1300mm处，将激光束照射在标定板上，使相机采集到的图像含有完整的标定板。相机采集标定板的图像时，记录相机采集到的各距离下图像上激光点在图像坐标系下的坐标D1=u1v1,D2=u2v2,...,D6=u6v6,]]>由Di(i＝1,2,...,6)和相机的内部参数矩阵A计算出各个距离激光点的归一化坐标xniyni1=A-1*Di1,]]>则各距离下通过相机光心与激光点的直线方程为由采集到的标定板图像计算标定板与相机之间的内部参数，计算出标定板平面在各个位置时的平面方程ai*x+bi*y+ci*z+di＝0。所述平面方程的计算过程推导如下：在已知标定板方格边长的前提下，得到标定板上各方格顶点在世界坐标系下的坐标PWb=XWb1XWb2XWbnYWb1YWb2...YWbn000,]]>其中XWbiYWbi0]]>为第i个顶点的世界坐标系坐标；并用标定工具计算出此时标定板相对于相机的外部参数[RcTc]，其中，Rc、Tc分别为标定板处世界坐标系相对于相机坐标系点的旋转矩阵与平移向量；若标定板上各方格顶点在相机坐标系下的坐标记为PCb=XCb1XCb2XCbnYCb1YCb2...YCbnZCb1ZCb2ZCbn,]]>XCbiYCbiZCbi]]>为第i个顶点的相机坐标系坐标，则PCb＝Rc*PWb+Tc，式中相同符号的定义如上所述；由PCb拟合出标定板平面在相机坐标系下的平面方程为：ai*x+bi*y+ci*z+di＝0。根据各个距离下，通过相机光心与激光点的直线方程以及标定板的平面方程ai*x+bi*y+ci*z+di＝0，求得各个位置下的激光点三维坐标，记为Pc1=X1Y1Z1,Pc2=X2Y2Z2,...,Pc6=X6Y6Z6,]]>其中：Pci=-diai*xni+bi*yni+ci-n*diai*xni+bi*yni+ci-m*diai*xni+bi*yni+ci=XiYiZi.]]>与现有技术相比，本专利技术采集不同位置的标定板图像，通过视觉方法，由相机内部参数、标定板与相机之间的外部参数计算出激光束打在标定板上的坐标，完成激光与相机坐标系夹角及交点的测量。本专利技术方法的优势在于：1、不需要使用任何复杂的光学仪器以及测量仪器。2、通过多个点的拟合能够排除因认为操作带来的干扰，找到准确的直线。3、传统方法往往测量的是激光与相机机械结构或者相机光学中心的相对关系，在图像测量领域仍然无法直接使用，而本专利技术直接建立了相机成像中心与激光器的关系，能够直接运用在所有位姿测量程序中，具有通用性。本专利技术克服了基于激光器与相机的视觉测量中不能准确测量激光与相机相对位姿的不足，具有可操作性好，测量精度高等优点，并且操作步骤简单，仅需一个标定板就能完成测量。本专利技术实用性较高，测量结果能够应用于计算机视觉测量等多种领域。进步一步的，本专利技术标定板采用黑白格标定板，具有极易识别的图像模式，易于实现黑白格顶点的自动检测，能够实现较高精度定位，使用方法成熟，有助于提高后续测量的精度。附图说明图1本专利技术方法的流程图；图2本专利技术实施装置示意图；图3各坐标系定义及夹角定义示意图。具体实施方式下面结合附图对本专利技术做进一步的详细说明。此处所描述的具体实施例仅用以解释本专利技术，并不用于限定本专利技术。参见图1，本实施例的实施步骤如下：1、如图2所示，将摄像机和激光器固定在一起，并保证他们的相对位置与相机内参不再发生改变。制作标定板，黑白方格数为11*10，边长为12mm。这里不限于黑白格标定板，具有一定明显图形模式，且易于识别的平面物体均可，因为黑白格标定板比较常见，对黑白本文档来自技高网...

【技术保护点】
一种激光与相机相对位姿关系的标定方法，其特征在于，包括以下步骤：步骤一、将相机和激光器固定在一起，并保证它们的相对位置以及相机的内部参数不发生改变；定义相机坐标系OC、世界坐标系OW；对相机的内部参数进行标定，得到相机的内部参数矩阵A=fx0u00fyv0001,]]>其中(fx,fy)为相机的等效焦距，(u0,v0)为相机光心坐标；步骤二、取标定板并正对于激光器发射出的激光束，打开激光，移动标定板，并始终使激光束的中心打在标定板上，用相机采集标定板的图像；建立图像坐标系，首先获得激光点在图像坐标系下的坐标Di，之后通过相机成像模型求得激光点此时在相机坐标系下的坐标Pc1；然后将标定板由近及远放置在不同的位置下，重复上述步骤，按上述方法依次计算出激光点在各个距离位置下的坐标，记为Pc1,Pc2…Pcn；步骤三、由各位置下激光点坐标Pc1,Pc2…Pcn拟合出激光束在相机坐标系下的直线方程：x-x0m0=y-y0n0=z-z0p0]]>其中，[x0,y0,z0]为激光束直线上一点的坐标，[m0,n0,p0]为激光束直线的方向向量；由激光束在相机坐标系下的直线方程，即求得激光束与相机坐标系XOY平面、YOZ平面、XOZ平面的夹角及交点；结果如下：θXOY=cos-1(m02+n02m02+n02+p02)]]>θYOZ=cos-1(n02+p02m02+n02+p02)]]>θXOZ=cos-1(m02+p02m02+n02+p02)]]>PXOY=-z0p*m0+x0-z0p*n0+y00]]>PYOZ=0-z0p*n0+y0-z0p*p0+z0]]>PXOZ=-z0p*m0+x00-z0p*p0+z0]]>通过上式计算，完成激光束与相机坐标系夹角及交点的测量。...

【技术特征摘要】
1.一种激光与相机相对位姿关系的标定方法，其特征在于，包括以下步骤：
步骤一、将相机和激光器固定在一起，并保证它们的相对位置以及相机的内部参数不发
生改变；定义相机坐标系OC、世界坐标系OW；对相机的内部参数进行标定，得到相机的
内部参数矩阵A=fx0u00fyv0001,]]>其中(fx,fy)为相机的等效焦距，(u0,v0)为相机光心坐标；
步骤二、取标定板并正对于激光器发射出的激光束，打开激光，移动标定板，并始终使
激光束的中心打在标定板上，用相机采集标定板的图像；建立图像坐标系，首先获得激光点
在图像坐标系下的坐标Di，之后通过相机成像模型求得激光点此时在相机坐标系下的坐标
Pc1；然后将标定板由近及远放置在不同的位置下，重复上述步骤，按上述方法依次计算出
激光点在各个距离位置下的坐标，记为Pc1,Pc2…Pcn；
步骤三、由各位置下激光点坐标Pc1,Pc2…Pcn拟合出激光束在相机坐标系下的直线方程：
x-x0m0=y-y0n0=z-z0p0]]>其中，[x0,y0,z0]为激光束直线上一点的坐标，[m0,n0,p0]为激光束直线的方向向量；
由激光束在相机坐标系下的直线方程，即求得激光束与相机坐标系XOY平面、YOZ平
面、XOZ平面的夹角及交点；结果如下：
θXOY=cos-1(m02+n02m02+n02+p02)]]>θYOZ=cos-1(n02+p02m02+n02+p02)]]>θXOZ=cos-1(m02+p02m02+n02+p02)]]>PXOY=-z0p*m0+x0-z0p*n0+y00]]>PYOZ=0-z0p*n0+y0-z0p*p0+z0]]>PXOZ=-z0p*m0+x00-z0p*p0+z0]]>通过上式计算，完成激光束与相机坐标系夹角及交点的测量。
2.根据权利要求1所述的激光与相机相对位姿关系的标定方法，其特征在于：所述的标
定板采用黑白格标定板，黑白格标定板的黑白方格数为11*10，边长为12mm。
3.根据权利要求1所述的激光与相机相对位姿关系的标定方法，其特征在于：固定相机
不动，将标定板由近及远放在六个不同的距离下，分别为300mm、600mm、700mm、900mm、
1100mm、...

【专利技术属性】
技术研发人员：王飞，董航，陈亚南，李中衡，党政，张观洲，王璇，杨海伟，
申请(专利权)人：西安交通大学，
类型：发明
国别省市：陕西;61