发明名称 双目视觉转轴标定方法
摘要 本发明属于利用视觉原理进行检测的技术,特别涉及双目视觉转轴标定方法。为提供一种操作方便,标定的过程比较简单的双目视觉转轴标定方法,发明采用的技术方案是:双目视觉转轴标定方法,包括下列步骤:1)获取球形靶标边缘;2)求取空间球心坐标;3)标定计算转轴参数。本发明主要用于利用两个摄像机模拟人眼的结构对空间特征点进行测量。
申请公布号 CN100562707C 申请公布日期 2009.11.25
申请号 CN200810052054.7 申请日期 2008.01.11
申请人 天津大学 发明人 王鹏;孙长库
分类号 G01B11/27(2006.01)I;G01B11/24(2006.01)I;G06T7/00(2006.01)I 主分类号 G01B11/27(2006.01)I
代理机构 天津市北洋有限责任专利代理事务所 代理人 刘国威
主权项 1、一种双目视觉转轴标定方法,其特征在于,包括下列步骤:1)球形靶标边缘获取:通过灰度值跳变像素的寻找粗略搜寻出靶标的边缘,然后根据边缘上相邻象素点之间的曲率变化对边缘进行筛选,得到准确的球形靶标边缘点;2)空间球心坐标求取:设球形靶标边缘l<sub>c</sub>上点的图像坐标为(u<sub>i</sub>,v<sub>i</sub>),则其对应的圆心坐标(u<sub>o</sub>,v<sub>o</sub>)应满足:(u<sub>i</sub>-u<sub>o</sub>)<sup>2</sup>+(v<sub>i</sub>-v<sub>o</sub>)<sup>2</sup>=r<sup>2</sup>    i=1,2,…,n    (1)使用最小二乘法求解方程组(1)即可得到l<sub>c</sub>对应的圆心坐标O,根据摄像机小孔成像模型,摄像机像平面上的圆心坐标O在摄像机坐标系下的坐标为(u<sub>o</sub>,v<sub>o</sub>,-f),f为摄像机镜头的焦距,通过摄像机标定获取,连接O与摄像机镜头的光心O<sub>c</sub>(0,0,0),得到空间直线l<sub>0</sub>:<maths num="0001"><![CDATA[<math><mrow><mfrac><mrow><mi>x</mi><mo>-</mo><msub><mi>t</mi><mi>x</mi></msub></mrow><mrow><msub><mi>r</mi><mn>1</mn></msub><msub><mi>u</mi><mi>o</mi></msub><mo>-</mo><msub><mi>r</mi><mn>2</mn></msub><msub><mi>v</mi><mi>o</mi></msub><mo>-</mo><msub><mi>r</mi><mn>3</mn></msub><mi>f</mi></mrow></mfrac><mo>=</mo><mfrac><mrow><mi>y</mi><mo>-</mo><msub><mi>t</mi><mi>y</mi></msub></mrow><mrow><msub><mi>r</mi><mn>4</mn></msub><msub><mi>u</mi><mi>o</mi></msub><mo>+</mo><msub><mi>r</mi><mn>5</mn></msub><msub><mi>v</mi><mi>o</mi></msub><mo>-</mo><msub><mi>r</mi><mn>6</mn></msub><mi>f</mi></mrow></mfrac><mo>=</mo><mfrac><mrow><mi>z</mi><mo>-</mo><msub><mi>t</mi><mi>z</mi></msub></mrow><mrow><msub><mi>r</mi><mn>7</mn></msub><msub><mi>u</mi><mi>o</mi></msub><mo>+</mo><msub><mi>r</mi><mn>8</mn></msub><msub><mi>v</mi><mi>o</mi></msub><mo>-</mo><msub><mi>r</mi><mn>9</mn></msub><mi>f</mi></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中:<maths num="0002"><![CDATA[<math><mrow><mi>R</mi><mo>=</mo><mfenced open='(' close=')'><mtable><mtr><mtd><msub><mi>r</mi><mn>1</mn></msub></mtd><mtd><msub><mi>r</mi><mn>2</mn></msub></mtd><mtd><msub><mi>r</mi><mn>3</mn></msub></mtd></mtr><mtr><mtd><msub><mi>r</mi><mn>4</mn></msub></mtd><mtd><msub><mi>r</mi><mn>5</mn></msub></mtd><mtd><msub><mi>r</mi><mn>6</mn></msub></mtd></mtr><mtr><mtd><msub><mi>r</mi><mn>7</mn></msub></mtd><mtd><msub><mi>r</mi><mn>8</mn></msub></mtd><mtd><msub><mi>r</mi><mn>9</mn></msub></mtd></mtr></mtable></mfenced><mo>,</mo></mrow></math>]]></maths><maths num="0003"><![CDATA[<math><mrow><mi>T</mi><mo>=</mo><mfenced open='(' close=')'><mtable><mtr><mtd><msub><mi>t</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><msub><mi>t</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msub><mi>t</mi><mi>z</mi></msub></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>分别为摄像机坐标系到测量系统世界坐标系的旋转矩阵和平移矩阵,r<sub>1</sub>,r<sub>2</sub>…r<sub>9</sub>为旋转矩阵的旋转分量,代表摄像机坐标系与测量系统世界坐标系之间每个坐标轴的角度关系,t<sub>x</sub>,t<sub>y</sub>,t<sub>z</sub>分别为坐标两系之间的平移分量,是两个坐标系坐标原点之间的相互位置,旋转分量、平移分量通过对双目测量系统的标定获取;分别设置左右两个摄像机的摄像机坐标系,它们与测量系统世界坐标系O<sub>w</sub>-X<sub>w</sub>Y<sub>w</sub>Z<sub>w</sub>之间的相互位置关系通过双目视觉测量系统标定获取,分别对左右摄像机像面上球形靶标边缘进行筛选,l<sub>c1</sub>和l<sub>c2</sub>分别为左右摄像机像面上球形靶标边缘筛选结果,l<sub>c1</sub>和l<sub>c2</sub>在空间上对应标定球形靶标上的两个大圆l<sub>1</sub>和l<sub>2</sub>,通过方程组(1)可以分别得到l<sub>c1</sub>和l<sub>c2</sub>在各自摄像机坐标系下的圆心坐标(u<sub>o1</sub>,v<sub>o1</sub>,-f<sub>1</sub>)和(u<sub>o2</sub>,v<sub>o2</sub>,-f<sub>2</sub>),则根据公式(2)得到的圆心空间直线l<sub>01</sub>和l<sub>02</sub>的交点即为标定球形靶标在当前位置上的球心坐标;3)转轴参数标定计算:在若干个位置上分别求取标定球形靶标的球心坐标,得到一组围绕转轴中心轴线旋转的点O<sub>n</sub>(x<sub>n</sub>,y<sub>n</sub>,z<sub>n</sub>)n=1,2,…,N,将这些球心坐标代入空间平面方程,构造线性方程组:Ax<sub>n</sub>+By<sub>n</sub>+Cz<sub>n</sub>+D=0    n=1,2,…,N    (3)其中A、B、C、D为平面方程参数,利用最小二乘法求解这个方程组,可以得到球心旋转轨迹所在的平面方程P<sub>B</sub>,该平面的法线矢量即是旋转台转轴的方向矢量:<maths num="0004"><![CDATA[<math><mrow><mi>u</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>u</mi><mn>1</mn></msub></mtd><mtd><msub><mi>u</mi><mn>2</mn></msub></mtd><mtd><msub><mi>u</mi><mn>3</mn></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mfrac><mi>A</mi><msqrt><msup><mi>A</mi><mn>2</mn></msup><mo>+</mo><msup><mi>B</mi><mn>2</mn></msup><mo>+</mo><msup><mi>C</mi><mn>2</mn></msup></msqrt></mfrac></mtd><mtd><mfrac><mi>B</mi><msqrt><msup><mi>A</mi><mn>2</mn></msup><mo>+</mo><msup><mi>B</mi><mn>2</mn></msup><mo>+</mo><msup><mi>C</mi><mn>2</mn></msup></msqrt></mfrac></mtd><mtd><mfrac><mi>C</mi><msqrt><msup><mi>A</mi><mn>2</mn></msup><mo>+</mo><msup><mi>B</mi><mn>2</mn></msup><mo>+</mo><msup><mi>C</mi><mn>2</mn></msup></msqrt></mfrac></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow></math>]]></maths>在轨迹平面内P<sub>B</sub>内利用搜寻法求取与球心坐标距离最小的点,即在约束条件:Ax+By+Cz+D=0下求取目标函数:<maths num="0005"><![CDATA[<math><mrow><mi>f</mi><mrow><mo>(</mo><msub><mi>x</mi><mi>n</mi></msub><mo>,</mo><msub><mi>y</mi><mi>n</mi></msub><mo>,</mo><msub><mi>z</mi><mi>n</mi></msub><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></munderover><msqrt><msup><mrow><mo>(</mo><msub><mi>x</mi><mi>A</mi></msub><mo>-</mo><msub><mi>x</mi><mi>i</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>y</mi><mi>A</mi></msub><mo>-</mo><msub><mi>y</mi><mi>i</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>z</mi><mi>A</mi></msub><mo>-</mo><msub><mi>z</mi><mi>i</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></msqrt><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow></math>]]></maths>的最小值,点O<sub>A</sub>(x<sub>A</sub>,y<sub>A</sub>,z<sub>A</sub>)是转轴与球心轨迹平面的交点,因此该点也是转轴上的一点,利用转轴的方向矢量和转轴上的一点就可以将旋转台转轴的方位在空间中表示出来,即完成了旋转台转轴的标定。
地址 300072天津市南开区卫津路92号