线结构光测头外参数的标定方法

专利名称：：线结构光测头外参数的标定方法
技术领域：
：本发明属于光机电一体化
技术领域：
中的坐标测量方法，具体涉及一种线结构光测头外参数的标定方法。
背景技术：
：目前，线结构光测头外参数的标定主要的方法，是将线结构光测头2D(即二维)坐标系和坐标测量机运动扫描轴构成一个3D(即三维)坐标系，建立从这个坐标系向3D世界坐标系转换的数学模型，并通过测量四面体或标准球确定该模型的"共轭对"，最后利用该"共轭对"以最小二乘法求得线结构光测头的外参数。由于坐标测量机运动扫描轴很难与线结构光光平面(线结构光测头2D坐标系建立在该面上)精确垂直，所以线结构光测头2D坐标系和坐标测量机运动扫描轴构成的3D坐标系是非正交的，这种非正交性在坐标变换过程中必然引入非线性误差，而且已有方法标定过程复杂，也使其在线测量实时性差。
发明内容本发明的发明目的是提供一种线结构光测头外参数标定方法，以克服现有的线结构光测头外参数标定方法上存在的非线性误差和在线实时性差的不足等。本发明是对己有的线结构光测头外参数标定方法的改进，其基本构思是首先建立从线结构光测头2D坐标系向3D世界坐标系转换的数学模型，然后通过控制线结构光测头沿坐标测量机;^运动方向运动，扫描标准球得到标定用的"共轭对"，最后利用得到的"共轭对"以最小二乘法求得模型中的未知参数实现了线结构测头外参数的标定。该标定方法不仅没有引入非正交坐标系，避免了由此产生的非线性误差，而且标定过程简单，精度高，实时性好。本发明所采用的技术方案是首先建立数学模型，即建立从线结构光测头2D坐标系向3D世界坐标系的转换关系；再确定"共轭对"——即通过控制线结构光测头沿坐标测量机i^运动方向运动扫描标准球，以确定扫描得到的球面上两圆弧之间的距离与线结构光测头沿坐标测量机Zw运动方向的移动距离之间存在的线性关系，由此便使线结构光测头能测出空间一固定点(标准球球心)的线结构光测头2D坐标0v^)和对应的坐标测量机的光栅尺读数(&，《/C),这样就得到了其中一个"共轭对"；最后利用该"共轭对"以最小二乘法求得了线结构光测头的外参数。即实现了一种崭新的标定方法。本发明首先建立了数学模型——变换公式I，具体说是从线结构光测头2D坐标系A.;TsZs向3D世界坐标系CVJ^l^Zw的转换关系<formula>formulaseeoriginaldocumentpage5</formula>式中，矢量P^和Ps分别为被测点在坐标系CVX『)VZ,y和Os}^Z5中的矢量的齐次坐标表示，其中矢量<formula>formulaseeoriginaldocumentpage6</formula>矢量<formula>formulaseeoriginaldocumentpage6</formula>矩阵I为3X3的单位矩阵，I<formula>formulaseeoriginaldocumentpage6</formula>矢量Q-是坐标系相对于cv^,i;.zM,的平移量，直接由坐标测量机的光栅尺读数得到，矢暈Q<formula>formulaseeoriginaldocumentpage6</formula>矩阵R二是从坐标系<9MXMywZM到0、.y,Z、转换的3X2旋转矩阵，、l<formula>formulaseeoriginaldocumentpage6</formula>进一歩确定本发明的"共轭对"，在确定"共轭对"时所用的变换公式1I如下C<formula>formulaseeoriginaldocumentpage6</formula>式中A为测量用的标准球的半径，为已知量；/fM、/，为线结构光测头沿坐标测量机X^运动方向做第/和第/+1次扫描运动时，线结构光光平面与标准球相交得到了两条圆弧，对这两条圆弧分别拟合圆所得到的圆心离球心的距。、为线结构光测头沿坐标测量机1,运动方向做第/和第Z+l次扫描运动时，线结构光光平面与标准球相交得到了两条圆弧，对这两条圆弧分别拟合圆所得的两个圆的半径；、^4,,+1为线结构光测头沿坐标测量机^^.运动方向做第/和第/+1次扫描运动时，线结构光测头在坐标测量机X^运动方向上所处的位置坐标(即Xw坐标)；^是比例系数，在线结构光测头方向不变的情况下是常数(在本发明中是常数)。^^。为线结构光光平面穿过标准球球心时线结构光测头在坐标测量机X『运动方向上所处的位置坐标(即^^坐标)；公式③表征了球面上两圆弧之间的距离与线结构光测头沿坐标测量机X^运动方向的移动距离之间存在的线性关系，它是以公式①、②为基础的，同时又是公式④的基础；公式④表征了线结构光光平面穿过标准球球心时线结构光测头在坐标测量机;^运动方向上所处的位置坐标X,;因此，只要控制线结构光测头沿坐标测量机^^方向运动到公式④所示的X,处，记下固定点的线结构光测头2D坐标(JV^)和对应的坐标测量机的光栅尺读数(&，&，&)，就得到了一个"共轭对"。最后，用最小二乘法求解外参数，将上述变换公式I推导得到符合最小二乘法形式需要的变换公式ni，它是坐标系cvx^;^Zw和o、;r、.z、.坐标之间的最终转换关系式，也是用最小二乘法求解外参数的关系式，变换公式ni如下M+-xw=-^—凡+-么，二式中《、/2，附,,、/^和、是矩阵R二(见所述变换公式I中的说明)的元素；&、&、《z是矢量Q^(见所述变换公式I中的说明)的元素；>V%为被测点在坐标系Os^Z,s,中的坐标(;vzp。在该式中&、^、《z、；^、^这五个参数为最小二乘法求解过程中的已知量(即后面会详细阐述的"共轭对")；、/z、附y、mz、"v、—、xw、凡、、,为最小二乘法求解过程中的未知参数。其中用6个参数——^、/z、Wy、mz、"v、wz来表征需求的线结构光测头外参数。所述的共轭对，是指测量空间中一固定点(在本方法中，固定点为标准球的球心)时，所得的线结构光测头2D坐标(1Vz^和对应的坐标测量机的光栅尺读数(&，^，g,;"共轭对"是对变换公式ni采用最小二乘法求解线结构光测头外参数步骤中所必备的已知信息。所述的坐标系CVZM,.4.Z『为世界坐标系(也称为3D世界坐标系)，三个坐标轴JTM、^、Z^分别与坐标测量机的三个运动方向轴平行。所述的坐标系O,T,Z,为线结构光测头坐标系(也称为线结构光测头2D坐标系)，该坐标系在线结构光光平面内，是在标定测头内参数时确定的，内参数在本发明中是已知的。所述的坐标系C^XM乙ZM为坐标测量机移动坐标系，该坐标系的坐标原点C^与线结构光测头坐标系O^Z,s的原点0,s,重合，三个轴Z『4、Zw分别与世界坐标系6VZ『IVZw的三个轴平行。因为随着线结构光测头在坐标测量机的^V运动方向上运动，该坐标系的原点也在移动，所以该坐标系是移动坐标系。本发明的核心在于，建立了从线结构光测头2D坐标系向3D世界坐标系转换的数学模型以及确定"共轭对"，并实现线结构光测头外参数标定的方法。首先建立了变换关系公式I所示的数学模型，再通过控制线结构光测头沿坐标测量机X『运动方向运动扫描标准球并利用变换关系公式II得到标定用的"共轭对"，最终将"共轭对"带入公式III，并使用最小二乘法，实现了高精度、实时性好的线结构光测头外参数的标定。下面结合附图和实施例进一歩说明本发明图l、本发明的巳有的5自由度扫描测量系统示意其中1为坐标测量机，2为线结构光测头(以下简称为测头)。本发明所涉及的线结构光测头外参数的标定方法就是针对该扫描测量系统的。图2、本发明的坐标系之间的变换关系示意图；其中(1)世界坐标系OwX^.JVZw(也称为3D世界坐标系)，三个坐标轴1、4、^分别与坐标测量机的三个运动方向轴平行。(2)线结构光测头坐标系O,;r,Z,(也称为线结构光测头2D坐标系)，该坐标系在线结构光光平面内，是在标定测头内参数时确定的。(3)坐标测量机移动坐标系0,,^1/&2^，该坐标系的坐标原点C^与线结构光测头坐标系的原点o,重合，三个轴.、,、^、z,w分别与世界坐标系cv;^i;4的三个轴平行。图3、本发明的线结构光光平面与标准球相交得到的圆弧拟合出的圆示意其中，箭头所示的"义w方向"指的是本发明中线结构光测头沿坐标测量机的运动扫描方向，在本发明中线结构光测头在坐标测量机其他两运动方向上的位置保持不变；两条虚线所表示的平面是线结构光光平面；线结构光光平面和标准球球面相交出多条圆弧，对这些圆弧拟合圆得到了图中所示的圆，。与巧+l为圆的半径。图4、本发明的球面上两圆弧之间的距离与线结构光测头沿坐标测量机^V运动方向的移动距离之间存在的线性关系示意其中O为标准球的球心，即本发明中的固定点；直线^'为垂直于线结构光光平面且经过球心O的直线。线结构光测头沿坐标测量机X,y方向运动，当运动到xw,位置时对应的线结构光光平面为A4'(平面垂直于纸面)，该光面与标准球交出一条圆弧(该圆弧在坐标系O,T,.Z,.中的全部坐标是己知的)，利用该圆弧上的点拟合圆可以得到圆心4和半径C，球的半径^是一个已知参数，则有/04=04=(i2-"2)1/2表明线结构光光平面到球心的距离可直接由线结构光光平面和球面相交所得的圆弧的半径确定；线结构光测头继续沿坐标测量机iV方向运动，当运动到、w时，对应的圆的半径为。+1，球心到圆的距离/os=0^(i2",2+1)1/2。由图4可以看出线结构光测头沿坐标测量机J^运动方向的移动距离和球面上两圆弧之间的距离存在线性关系，即有式中^=02-04=/训-^，5是比例系数，在测头方向不变的情况下该系数不变。如果线结构光测头在坐标测量机^V方向的当前坐标为^,々，对应的圆半径为G，则要使线结构光光平面穿过球心O，坐标测量机需沿X^轴运动到Xw。\,。二^,+^^这样就得到了公式I1。此时可以认为G是线结构光光平面内的一点，它的坐标是通过拟合圆得到的。这样就实现了利用该测头测量空间的一固定点，记下固定点的线结构光测头2D坐标0vz,)和对应的坐标测量机的光栅尺读数(&，&，^)就得到了一个共轭对。图5、本发明的测量标准球的测量实例。具体实施例方式该标定方法是首先建立数学模型，即线结构光测头2D坐标系C^.&Z,.到3D世界坐标系C^^V1VZ^的变换关系公式I;再确定了"共轭对"——通过控制线结构光测头沿坐标测量机I^运动方向运动扫描标准球，确定了扫描得到的球面上两圆弧之间的距离与线结构光测头沿坐标测量机^^运动方向的移动距离之间存在的线性关系，参见变换公式n，由此便使线结构光测头能测出空间一固定点(标准球球心)的线结构光测头2D坐标(JV^)和对应的坐标测量机的光栅尺读数(&，义,，《P,这样就得到了一个"共轭对"；最后利用得到的"共轭对"，对公式III利用最小二乘法实现了线结构光测头外参数的标定。现具体阐述确定"共轭对"的详细步骤确定"共轭对"就是得到一系列关于固定点(即标准球的球心)的线结构光测头2D坐标(A，^)和对应的坐标测量机的光栅尺读数(&，《y，&)。为了得到"共轭对"，首先要使线结构光光平面通过固定点，但是通过移动线结构光测头并观察线结构光光平面很难使其恰好通过固定点，因此本发明使用了以下方法使线结构光光平面通过固定点进而确定"共轭对"(1).把标准球固定在坐标测量机上，以确保在整个标定过程中固定点(即上述的标准球的球心)在世界坐标系中的位置始终保持不变，即固定点的在世界坐标系中的坐标(x，,.,，y,,,，；)始终不变。之所以这样做是因为本发明最终是要对变换关系公式III采用最小二乘法从而求得未知参数〃、t、附少、附——、、"z、&、少,、、，也就是说将&、凡、Z^在整个标定过程中当成是不变的参数，因此如果在标定过程中固定点的(&，yw，、)变<table>tableseeoriginaldocumentpage10</column></row><table>化了，则用最小二乘法求得的外参数^、/z、附^、W-、、就一定是不准确的。(2).线结构光测头沿坐标测量机AV运动方向做扫描运动，在此过程中线结构光测头在坐标测量机的其它运动方向上的位置保持不变，使线结构光光平面与标准球的球面相交得到两条圆弧，对这两条圆弧拟合圆心并求得圆的半径，利用公式II可以得到固定点所在结构光光平面在坐标测量机中的^^坐标，即x,。(3).驱动线结构光测头沿坐标测量机^V运动方向运动，直到运动到第2步中得到的X,位置，记下固定点的线结构光测头2D坐标(少,，z,)和对应的坐标测量机的光栅尺读数(&，&，《P，这样就得到了"共轭对"。(4).重复步骤(2)、(3)，直到取够至少10条圆弧。把得到的"共轭对"带入公式III中，利用最小二乘法便可以求得精确的线结构光测头的外参数。本发明的变换公式I——II应用实施如下公式I、III中，在同一线结构光测头方向下旋转矩阵的5次求解结果如下公式<table>tableseeoriginaldocumentpage10</column></row><table>II中，利用球面上不同位置的圆求共轭对的结果如下<table>tableseeoriginaldocumentpage10</column></row><table>对标准球的测量结果见图5。综上所述，本发明首先建立了从线结构光测头2D坐标系向3D世界坐标系转换的数学模型，然后通过控制线结构光测头沿坐标测量机^V运动方向运动扫描标准球得到标定用的"共轭对"，最后利用最小二乘法求得模型中的未知参数实现了线结构测头外参数的标定。该标定方法不仅没有引入非正交坐标系，避免了由此产生的非线性误差，而且标定过程简单，精度高，实时性好。权利要求1、一种线结构光测头外参数的标定方法，首先建立了数学模型，即建立了从线结构光测头2D坐标系向3D世界坐标系的转换关系；再确定“共轭对”——通过控制线结构光测头沿坐标测量机XW运动方向运动扫描标准球，确定扫描得到的球面上两圆弧之间的距离与线结构光测头沿坐标测量机XW运动方向的移动距离之间存在的线性关系，由此便使线结构光测头能测出空间一固定点---标准球球心的线结构光测头2D坐标(yS，zS)和对应的坐标测量机的光栅尺读数(qx，qy，qz)，这样就得到了一个“共轭对”；最后利用该“共轭对”以最小二乘法求得线结构光测头的外参数。2、如权利要求1所述的线结构光测头外参数的标定方法，其特征在于所述的数学模型如下，具体说是从线结构光测头光平面2D坐标系向3D世界坐标系的转换关系<formula>formulaseeoriginaldocumentpage2</formula>式中，矢量P『和Ps分别为被测点在坐标系UV^和6>s&Zs中的矢的齐次坐标表示，<formula>formulaseeoriginaldocumentpage2</formula>矩阵I为3X3的单位矩阵，1=<formula>formulaseeoriginaldocumentpage2</formula>矢量Q-是坐标系J^1^ZM相对于^VIVZw的平移量，直接由坐标测:机的光栅尺读数得到，矢量Q矩阵R是从坐标系OmA^Zm到OA^转换的3X2旋转矩阵，<formula>formulaseeoriginaldocumentpage3</formula>3、如权利要求1所述的线结构光测头外参数的标定方法，其特征在于所述的"共轭对"是通过如下的变换公式II确定<formula>formulaseeoriginaldocumentpage3</formula>①<formula>formulaseeoriginaldocumentpage3</formula>(2)<formula>formulaseeoriginaldocumentpage3</formula>(3)<formula>formulaseeoriginaldocumentpage3</formula>④式中i为测量用的标准球的半径，为已知量；t,、U为线结构光测头沿坐标测量机《,,运动方向做第/和第/+1次扫描运动时，线结构光光平面与标准球相交得到了两条圆弧，对这两条圆弧分别拟合圆所得到的圆心离球心的距离；。、巧+1为线结构光测头沿坐标测量机;^运动方向做第/和第/+1次扫描运动时，线结构光光平面与标准球相交得到了两条圆弧，对这两条圆弧分别拟合圆所得到的两个圆的半径；1^,+|为线结构光测头沿坐标测量机;^运动方向做第/和第/+1次扫描运动时，线结构光测头在坐标测量机^运动方向上所处的位置坐标；5是比例系数，在线结构光测头方向不变的情况下是常数。、。为线结构光光平面穿过标准球球心时线结构光测头在坐标测量机^运动方向上所处的位置坐标；公式③表征了球面上两圆弧之间的距离与线结构光测头沿坐标测量机Zw运动方向的移动距离之间存在的线性关系；公式④表征了线结构光光平面穿过标准球球心时线结构光测头在坐标测量机Xw运动方向上所处的位置坐标、。；控制线结构光测头沿坐标测量机Xw方向运动到公式④所示的x，处，记下固定点的线结构光测头2D坐标(;vzp和对应的坐标测量机的光栅尺读数(&，&，&)，就得到了一个"共轭对"。4、如权利要求1所述的线结构光测头外参数的标定方法，其特征在于所述的利用上述"共轭对"以最小二乘法求得线结构光测头的外参数所依据的公式III如下XA+ZA—&=—《;t<兀，+&mz—兀，=—&、凡+Z,z—、，=—&式中^、4,附y、附z和、是矩阵R二的元素；A、&、^是矢量Q^的元素；A、^为被测点在坐标系0,}^,,中的坐标；在上述式中&、&、^这五个参数为最小二乘法求解过程中的已/少、/z、w〃mz、、"z、xw、凡、、为最小二乘法求解过程中的未知参数，其中的6个参数——/v、/z、wv、、即为所求的线结构光测头外参数。全文摘要本发明涉及一种线结构光测头外参数的标定方法。首先建立了数学模型——从线结构光测头2D坐标系向3D世界坐标系转换关系；再确定“共轭对”——通过控制线结构光测头沿坐标测量机X_W运动方向扫描标准球，确定扫描得到的球面上两圆弧之间的距离与线结构光测头沿坐标测量机X_W运动方向的移动距离之间存在的线性关系，由此便可以使得线结构光测头能测测出空间一固定点(标准球的球心)的线结构光测头2D坐标(y_S，z_S)和对应的坐标测量机的光栅尺读数(q_x，q_y，q_z)，这样就得到一个“共轭对”；最后利用该“共轭对”以最小二乘法求得线结构光测头的外参数。本发明不仅没有引入非正交坐标系，避免了其由此产生的非线性误差，而且其标定过程简单，精度高，实时性好。文档编号G06T7/00GK101285680SQ20071011583公开日2008年10月15日申请日期2007年12月12日优先权日2007年12月12日发明者刘世晶,张志伟,琨王,解则晓,明金申请人:中国海洋大学