发明名称 基于三线激光器固有特性的光平面方程拟合定位标定方法
摘要 本发明一种基于三线激光器固有特性的光平面方程拟合定位标定方法属于将三线激光器所发出的三个光平面的空间姿态方程均精确拟合于相机虚拟空间坐标系中的拟合标定方法领域,本发明的标定方法特别提出了将三个激光平面的邻近夹角量已知、三个激光平面均相交于同一交线、三个激光平面的投影光条均平行这三个真实的固有特性同时作为所述特殊三线激光器投影特征的数理模型的约束条件,由此获得能够整体反映这三个关键特征的目标函数及其约束条件,并为该目标函数的求解带来可能性,最终给出了一整套将真实世界中的三线激光器投射平面的一系列物理特征均同时精确移植到虚拟的相机坐标系的数学模型下的可行方法。
申请公布号 CN104596443B 申请公布日期 2017.02.01
申请号 CN201510038858.1 申请日期 2015.01.26
申请人 长春师范大学 发明人 孙秋成;刘仁云;于繁华;王春艳;孙晔;刘成
分类号 G01B11/25(2006.01)I 主分类号 G01B11/25(2006.01)I
代理机构 长春菁华专利商标代理事务所 22210 代理人 田春梅
主权项 基于三线激光器固有特性的光平面方程拟合定位标定方法,其特征在于,该方法包括如下步骤:步骤一:选用一种能从同一个线光源发出邻近夹角均相同的三个激光平面,且其三个激光平面能在同一投影平面形成三个平行光条的三线激光器,并从该三线激光器固有的出厂性能指标参数中获取其邻近两个激光平面夹角的角度值参数α;步骤二:按照相机内部参数标定方法A完成对相机内部参数的标定;步骤三:获取针对三线激光器中第一个激光平面(a)的N组离散特征点空间坐标值的集合R,其具体包括如下子步骤:步骤3.1:按照离散特征点空间坐标提取方法B对步骤一所述三线激光器的第一个激光平面(a)在标靶平面(K)上的激光光条(a‑1)进行所需的一组离散特征点空间坐标(x,y,z)的采样和提取,从而获得针对前述第一个激光平面(a)在初始姿态下的标靶平面(K)上投影所形成的激光光条(a‑1)采样所获得的第一组离散特征点空间坐标:<img file="FDA0001132102390000011.GIF" wi="437" he="87" />其中i=1,2,...,n,n表示在激光光条(a‑1)上采样的离散特征点的数目,坐标值(x,y,z)各自的上角标(a)均表示该离散特征点隶属于第一个激光平面(a);步骤3.2:改变激光投影标靶平面(K)的倾角,并重复步骤3.1的过程,从而获得针对前述第一个激光平面(a)在新姿态下的标靶平面(K’)上投影所形成的激光光条(a‑2)采样所获得的第二组离散特征点空间坐标:<img file="FDA0001132102390000012.GIF" wi="381" he="79" />其中i=(n+1),(n+2),...,2n,n表示在激光光条(a‑2)上采样的离散特征点的数目,坐标值(x,y,z)各自的上角标(a)均表示该离散特征点隶属于第一个激光平面(a);步骤3.3:通过N(N≥3,N是自然数)次改变激光投影靶标平面的倾角并重复步骤3.2的过程,直至获得针对前述第一个激光平面(a)在标靶平面(K)的第N个新姿态上投影所形成的激光光条(a‑N)采样所获得的第N组离散特征点空间坐标值:<img file="FDA0001132102390000013.GIF" wi="390" he="78" />其中i=((N‑1)×n+1),((N‑1)×n+2)...,N×n,n表示在激光光条(a‑N)上采样的离散特征点的数目,坐标值(x,y,z)各自的上角标(a)均表示该离散特征点隶属于第一个激光平面(a);步骤3.4:将步骤3.1至步骤3.3分别获得的共计N组离散特征点统一合并成为一个非共线的离散特征点的集合R:<maths num="0001"><math><![CDATA[<mrow><mi>R</mi><mo>=</mo><mrow><mo>(</mo><msubsup><mi>x</mi><mi>i</mi><mrow><mo>(</mo><mi>a</mi><mo>)</mo></mrow></msubsup><mo>,</mo><msubsup><mi>y</mi><mi>i</mi><mrow><mo>(</mo><mi>a</mi><mo>)</mo></mrow></msubsup><mo>,</mo><msubsup><mi>z</mi><mi>i</mi><mrow><mo>(</mo><mi>a</mi><mo>)</mo></mrow></msubsup><mo>)</mo></mrow><mo>,</mo><mo>...</mo><mo>...</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>;</mo></mrow>]]></math><img file="FDA0001132102390000021.GIF" wi="764" he="78" /></maths>式(1)中i=1,2,...,N×n,N×n表示在步骤3.1至步骤3.3中共计N次在激光光条(a‑1)、(a‑2)……(a‑N)上采样的离散特征点的总数,坐标值(x,y,z)各自的上角标(a)均表示该离散特征点隶属于第一个激光平面(a);N表示靶标平面倾角的改变总次数;步骤四:采用与步骤三完全相同的方法,分别获取针对三线激光器中第二个激光平面(b)的、由共计N组离散特征点统一合并成为一个非共线的离散特征点的集合<img file="FDA0001132102390000022.GIF" wi="682" he="87" />以及针对三线激光器中第三个激光平面(c)的、由共计N组离散特征点统一合并成为一个非共线的离散特征点的集合<img file="FDA0001132102390000023.GIF" wi="678" he="79" />式(2)中j=1,2,...,N×n,N×n表示在步骤3.1至步骤3.3中共计N次在激光光条(b‑1)、(b‑2)……(b‑N)上采样的离散特征点的总数,坐标值(x,y,z)各自的上角标(b)均表示该离散特征点隶属于第二个激光平面(b);N表示靶标平面倾角的改变总次数;式(3)中k=1,2,...,N×n,N×n表示在步骤3.1至步骤3.3中共计N次在激光光条(c‑1)、(c‑2)……(c‑N)上采样的离散特征点的总数,坐标值(x,y,z)各自的上角标(c)均表示该离散特征点隶属于第三个激光平面(c);N表示靶标平面倾角的改变总次数;步骤五:根据多个空间平面方程在三维空间坐标系下的数学方程,定义一个表示三个空间平面均相交于同一交线的数学方程组表达式:<maths num="0002"><math><![CDATA[<mrow><mo>{</mo><mtable><mtr><mtd><mrow><msub><mi>A</mi><mn>1</mn></msub><mi>x</mi><mo>+</mo><msub><mi>B</mi><mn>1</mn></msub><mi>y</mi><mo>+</mo><msub><mi>C</mi><mn>1</mn></msub><mi>z</mi><mo>+</mo><msub><mi>D</mi><mn>1</mn></msub><mo>=</mo><mn>0</mn></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>A</mi><mn>2</mn></msub><mi>x</mi><mo>+</mo><msub><mi>B</mi><mn>2</mn></msub><mi>y</mi><mo>+</mo><msub><mi>C</mi><mn>2</mn></msub><mi>z</mi><mo>+</mo><msub><mi>D</mi><mn>2</mn></msub><mo>=</mo></mrow></mtd></mtr><mtr><mtd><mrow><mo>(</mo><msub><mi>A</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;A</mi><mn>2</mn></msub><mo>)</mo><mi>x</mi><mo>+</mo><mo>(</mo><msub><mi>B</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;B</mi><mn>2</mn></msub><mo>)</mo><mi>y</mi><mo>+</mo><mo>(</mo><msub><mi>C</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;C</mi><mn>2</mn></msub><mo>)</mo><mi>z</mi><mo>+</mo><mo>(</mo><msub><mi>D</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;D</mi><mn>2</mn></msub><mo>)</mo><mo>=</mo><mn>0</mn></mrow></mtd></mtr></mtable><mn>......</mn><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001132102390000024.GIF" wi="1692" he="271" /></maths>式(4)中,(x,y,z)表示满足方程组的三个空间平面上的一组离散特征点的空间坐标值;待求解的多项式系数(A<sub>1</sub>,B<sub>1</sub>,C<sub>1</sub>,D<sub>1</sub>,A<sub>2</sub>,B<sub>2</sub>,C<sub>2</sub>,D<sub>2</sub>,λ)则共同定义了表示满足方程组(4)的三个空间平面各自的空间姿态系数;式(4)中的第一个方程式是由步骤三所述式(1)所拟合出的、三线激光器的第一个激光平面(a)的激光空间平面方程;式(4)中的第二个方程式是由步骤四所述式(2)所拟合出的、三线激光器的第二个激光平面(b)的激光空间平面方程;式(4)中的第三个方程式是由步骤四所述式(3)所拟合出的、三线激光器的第三个激光平面(c)的激光空间平面方程;式(4)中的第三个方程式同时表示第三个激光平面(c)严格通过式(4)中第一个激光平面(a)和第二个激光平面(b)的激光空间平面方程的交线;步骤六:利用由步骤三所获得的针对前述第一个激光平面(a)的一组非共线离散特征点空间坐标的集合<img file="FDA0001132102390000031.GIF" wi="907" he="79" />由步骤四所获得的针对前述第二个激光平面(b)的一组非共线离散特征点空间坐标的集合<img file="FDA0001132102390000032.GIF" wi="915" he="90" />以及由步骤四所获得的针对前述第三个激光平面(c)的一组非共线离散特征点空间坐标的集合<img file="FDA0001132102390000033.GIF" wi="885" he="79" />共同作为拟合数据,将由步骤五所确定的表示三个空间平面均相交于同一交线的数学方程组表达式(4)作为拟合函数,并根据公知的最小二乘法建立统一的目标函数:<maths num="0003"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><mi>M</mi><mi>i</mi><mi>n</mi><mrow><mo>(</mo><mi>&Delta;</mi><mo>)</mo></mrow><mo>=</mo><munderover><mo>&Sigma;</mo><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mrow><mi>N</mi><mo>&times;</mo><mi>n</mi></mrow></munderover><msup><mrow><mo>(</mo><msub><mi>A</mi><mn>1</mn></msub><msubsup><mi>x</mi><mi>i</mi><mrow><mo>(</mo><mi>a</mi><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>B</mi><mn>1</mn></msub><msubsup><mi>y</mi><mi>i</mi><mrow><mo>(</mo><mi>a</mi><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>C</mi><mn>1</mn></msub><msubsup><mi>z</mi><mi>i</mi><mrow><mo>(</mo><mi>a</mi><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>D</mi><mn>1</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><munderover><mo>&Sigma;</mo><mrow><mi>j</mi><mo>=</mo><mn>1</mn></mrow><mrow><mi>N</mi><mo>&times;</mo><mi>n</mi></mrow></munderover><msup><mrow><mo>(</mo><msub><mi>A</mi><mn>2</mn></msub><msubsup><mi>x</mi><mi>j</mi><mrow><mo>(</mo><mi>b</mi><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>B</mi><mn>2</mn></msub><msubsup><mi>y</mi><mi>j</mi><mi>b</mi></msubsup><mo>+</mo><msub><mi>C</mi><mn>2</mn></msub><msubsup><mi>z</mi><mi>j</mi><mrow><mo>(</mo><mi>b</mi><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>D</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></mtd></mtr><mtr><mtd><mrow><mo>+</mo><munderover><mo>&Sigma;</mo><mrow><mi>k</mi><mo>=</mo><mn>1</mn></mrow><mrow><mi>N</mi><mo>&times;</mo><mi>n</mi></mrow></munderover><msup><mrow><mo>(</mo><mo>(</mo><mrow><msub><mi>A</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;A</mi><mn>2</mn></msub></mrow><mo>)</mo><msubsup><mi>x</mi><mi>k</mi><mrow><mo>(</mo><mi>c</mi><mo>)</mo></mrow></msubsup><mo>+</mo><mo>(</mo><mrow><msub><mi>B</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;B</mi><mn>2</mn></msub></mrow><mo>)</mo><msubsup><mi>y</mi><mi>k</mi><mrow><mo>(</mo><mi>c</mi><mo>)</mo></mrow></msubsup><mo>+</mo><mo>(</mo><mrow><msub><mi>C</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;C</mi><mn>2</mn></msub></mrow><mo>)</mo><msubsup><mi>z</mi><mi>k</mi><mrow><mo>(</mo><mi>c</mi><mo>)</mo></mrow></msubsup><mo>+</mo><mo>(</mo><mrow><msub><mi>D</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;D</mi><mn>2</mn></msub></mrow><mo>)</mo><mo>)</mo></mrow><mn>2</mn></msup></mrow></mtd></mtr></mtable><mn>......</mn><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001132102390000034.GIF" wi="1798" he="284" /></maths>步骤七:将步骤一所述三线激光器固有的出厂性能指标参数:邻近两个激光平面夹角的角度值参数α作为已知的约束条件,对步骤六所确定的目标函数(5)中的三个激光平面的各自的空间姿态多项式系数(A<sub>1</sub>,B<sub>1</sub>,C<sub>1</sub>,D<sub>1</sub>,A<sub>2</sub>,B<sub>2</sub>,C<sub>2</sub>,D<sub>2</sub>,λ)做进一步的数学限定,从而得到包含有角度限定条件的约束表达式:<maths num="0004"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mfrac><mrow><mo>(</mo><msub><mi>A</mi><mn>1</mn></msub><mo>,</mo><msub><mi>B</mi><mn>1</mn></msub><mo>,</mo><msub><mi>C</mi><mn>1</mn></msub><mo>)</mo><mo>(</mo><msub><mi>A</mi><mn>2</mn></msub><mo>,</mo><msub><mi>B</mi><mn>2</mn></msub><mo>,</mo><msub><mi>C</mi><mn>2</mn></msub><mo>)</mo></mrow><mrow><msqrt><mrow><msup><msub><mi>A</mi><mn>1</mn></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>B</mi><mn>1</mn></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>C</mi><mn>1</mn></msub><mn>2</mn></msup></mrow></msqrt><msqrt><mrow><msup><msub><mi>A</mi><mn>2</mn></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>B</mi><mn>2</mn></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>C</mi><mn>2</mn></msub><mn>2</mn></msup></mrow></msqrt></mrow></mfrac><mo>=</mo><mi>c</mi><mi>o</mi><mi>s</mi><mn>2</mn><mi>&alpha;</mi></mrow></mtd></mtr><mtr><mtd><mrow><mfrac><mrow><mo>(</mo><msub><mi>A</mi><mn>1</mn></msub><mo>,</mo><msub><mi>B</mi><mn>1</mn></msub><mo>,</mo><msub><mi>C</mi><mn>1</mn></msub><mo>)</mo><mo>(</mo><msub><mi>A</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;A</mi><mn>2</mn></msub><mo>,</mo><msub><mi>B</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;B</mi><mn>2</mn></msub><mo>,</mo><msub><mi>C</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;C</mi><mn>2</mn></msub><mo>)</mo></mrow><mrow><msqrt><mrow><msup><msub><mi>A</mi><mn>1</mn></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>B</mi><mn>1</mn></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>C</mi><mn>1</mn></msub><mn>2</mn></msup></mrow></msqrt><msqrt><mrow><msup><mrow><mo>(</mo><msub><mi>A</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;A</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>B</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;B</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>C</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;C</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></msqrt></mrow></mfrac><mo>=</mo><mi>c</mi><mi>o</mi><mi>s</mi><mi>&alpha;</mi></mrow></mtd></mtr><mtr><mtd><mrow><mfrac><mrow><mo>(</mo><msub><mi>A</mi><mn>2</mn></msub><mo>,</mo><msub><mi>B</mi><mn>2</mn></msub><mo>,</mo><msub><mi>C</mi><mn>2</mn></msub><mo>)</mo><mo>(</mo><msub><mi>A</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;A</mi><mn>2</mn></msub><mo>,</mo><msub><mi>B</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;B</mi><mn>2</mn></msub><mo>,</mo><msub><mi>C</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;C</mi><mn>2</mn></msub><mo>)</mo></mrow><mrow><msqrt><mrow><msup><msub><mi>A</mi><mn>2</mn></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>B</mi><mn>2</mn></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>C</mi><mn>2</mn></msub><mn>2</mn></msup></mrow></msqrt><msqrt><mrow><msup><mrow><mo>(</mo><msub><mi>A</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;A</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>B</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;B</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>C</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&lambda;C</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></msqrt></mrow></mfrac><mo>=</mo><mi>c</mi><mi>o</mi><mi>s</mi><mi>&alpha;</mi></mrow></mtd></mtr></mtable></mfenced><mn>......</mn><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001132102390000041.GIF" wi="1702" he="543" /></maths>步骤八:通过公知的Lenvenberg‑Marquardt非线性优化算法对式(5)及其限定条件表达式(6)同时求解,从而解出(A<sub>1</sub>,B<sub>1</sub>,C<sub>1</sub>,D<sub>1</sub>,A<sub>2</sub>,B<sub>2</sub>,C<sub>2</sub>,D<sub>2</sub>,λ)的值,并完成利用一种能从同一个线光源发出邻近夹角均相同的三个激光平面,且其三个激光平面能在同一投影平面形成三个平行光条的三线激光器的固有特性,将三线激光器所发出的三个光平面的空间姿态方程均精确拟合于相机虚拟空间坐标系中的拟合标定过程。
地址 130032 吉林省长春市二道区长吉北路677号