发明名称 小型二维靶大视场双目立体视觉系统结构参数在位标定法
摘要 小型二维靶大视场双目立体视觉系统结构参数在位标定法,属于光学测量和机械工程技术领域。其标定方法如下:首先将小尺寸二维标定靶置于测量场景中的不同位置,获取标定靶的图像;其次根据离线已标定的左右摄像机内参数,分别计算对应不同摆放位置的标定靶相对左右摄像机的外参数,进而计算立体视觉系统的结构参数;最后建立目标函数对立体视觉系统结构参数进行非线性优化。小尺寸二维标定靶,有效地解决使用大尺寸高精度标定靶的成本高,运输保管困难,使用维护不便等问题,能够适应复杂环境下的立体视觉系统结构参数的在位标定。
申请公布号 CN102968794A 申请公布日期 2013.03.13
申请号 CN201210479935.3 申请日期 2012.11.22
申请人 上海交通大学 发明人 俊通;王振兴;吴卓琦;陈晓波
分类号 G06T7/00(2006.01)I 主分类号 G06T7/00(2006.01)I
代理机构 上海汉声知识产权代理有限公司 31236 代理人 郭国中
主权项 1.一种小型二维靶大视场双目立体视觉系统结构参数在位标定法,其特征在于该标定方法包括如下步骤:1)制作小尺寸二维标定靶,小尺寸二维标定靶采用Ipad的液晶屏,标定图样为圆斑阵列,并将此标定图样显示在Ipad液晶屏幕上。取圆斑中心作为标定靶上特征点;2)在测量场景中摆放标定靶,将小尺寸二维标定靶置于大视场双目立体视觉系统的测量场景中,并将其固定;3)获取测量系统标定所需图像,左摄像机和右摄像机分别采集标定靶图片;4)计算标定靶至左右摄像机的外参数,利用已在离线下完成标定的摄像机内参数矩阵A,和给定标定靶上特征点的空间坐标M<sub>w</sub>及其对应的成像面投影坐标m,计算摄像机相对于标定靶的外参数<img file="FDA00002450837600011.GIF" wi="58" he="48" />和<img file="FDA00002450837600012.GIF" wi="75" he="48" />其中<img file="FDA00002450837600013.GIF" wi="57" he="48" />表示标定靶坐标系至摄像机坐标系的旋转矩阵,<img file="FDA00002450837600014.GIF" wi="51" he="48" />表示标定靶坐标系至摄像机坐标系的平移向量,计算公式如下:<maths num="0001"><![CDATA[<math><mrow><mi>sm</mi><mo>=</mo><mi>A</mi><mrow><mo>(</mo><msubsup><mi>R</mi><mi>c</mi><mi>w</mi></msubsup><msub><mi>M</mi><mi>w</mi></msub><mo>+</mo><msubsup><mi>T</mi><mi>c</mi><mi>w</mi></msubsup><mo>)</mo></mrow></mrow></math>]]></maths>式中,s投影比例因子,因此,当给定的足够数量(至少三个非共线)标定靶上特征点的空间坐标及其对应的成像面投影坐标,便可分别计算标定靶在i次摆放位置下,左右摄像机相对于标定靶的外参数(R<sub>1,i</sub>,T<sub>l,i</sub>)和(R<sub>r,i</sub>,T<sub>r,i</sub>);5)计算立体视觉系统的结构参数,立体视觉结构参数与左右摄像机的外参数间存在如下关系:<maths num="0002"><![CDATA[<math><mrow><msub><mi>R</mi><mi>i</mi></msub><mo>=</mo><msub><mi>R</mi><mrow><mi>r</mi><mo>,</mo><mi>i</mi></mrow></msub><msubsup><mi>R</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi></mrow><mi>T</mi></msubsup></mrow></math>]]></maths>T<sub>i</sub>=T<sub>r,i</sub>-R<sub>i</sub>T<sub>l,i</sub>因此,根据上述关系,即可计算出第i次摆放标定靶对应的立体视觉系统结构参数;6)计算立体视觉系统结构参数的初始值,虽然理论上,标定靶摆放一次即可完成系统结构参数的标定,但考虑到噪声的影响,每次摆放标定靶所计算出的立体视觉系统结构参数均有些轻微差别,为减少噪声对标定结构参数的影响,需将标定靶在测量空间中多次摆放,当摆放次数少于设定的总摆放次数n时,重复步骤1)~4),当摆放次数达到设定的总摆放次数n时,可通过如下关系式,求取立体视觉系统结构参数的初始值:R<sub>0</sub>=median{R<sub>i</sub>},i=1...nT<sub>0</sub>=median{T<sub>i</sub>},i=1...n7)立体视觉系统结构参数的非线性优化,利用标定靶上特征点对左右摄像机的重投影误差最小,可建立如下目标函数:<maths num="0003"><![CDATA[<math><mrow><mi>min</mi><munder><mi>&Sigma;</mi><mi>i</mi></munder><mo>[</mo><munder><mi>&Sigma;</mi><mi>j</mi></munder><msup><mrow><mo>|</mo><mo>|</mo><msub><mi>m</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>-</mo><msub><mover><mi>m</mi><mo>^</mo></mover><mrow><mi>l</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mrow><mo>(</mo><msub><mi>R</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo><msub><mi>T</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msup><mo>+</mo><munder><mi>&Sigma;</mi><mi>j</mi></munder><msup><mrow><mo>|</mo><mo>|</mo><msub><mi>m</mi><mrow><mi>r</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>-</mo><msub><mover><mi>m</mi><mo>^</mo></mover><mrow><mi>r</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mrow><mo>(</mo><msub><mi>R</mi><mrow><mi>r</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo><msub><mi>T</mi><mrow><mi>r</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msup><mo>]</mo></mrow></math>]]></maths>式中,m<sub>l,i,j</sub>和m<sub>r,i,j</sub>分别为在第i次摆放位置,标定靶上第j个特征点对应的左右摄像机成像面上的实际投影点,<img file="FDA00002450837600022.GIF" wi="239" he="47" />为左摄像机成像面上对应于m<sub>l,i,j</sub>的计算重投影点,<img file="FDA00002450837600023.GIF" wi="261" he="51" />为右摄像机成像面上对应于m<sub>r,i,j</sub>的计算重投影点,若R和T分别表示立体视觉系统结构参数的最终优化解,则有:R<sub>r,i</sub>=RR<sub>l,i</sub>T<sub>r,i</sub>=T+RT<sub>l,i</sub>所以上述目标函数可表示为<maths num="0004"><![CDATA[<math><mrow><mi>min</mi><munder><mi>&Sigma;</mi><mi>i</mi></munder><mo>[</mo><munder><mi>&Sigma;</mi><mi>j</mi></munder><msup><mrow><mo>|</mo><mo>|</mo><msub><mi>m</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>-</mo><msub><mover><mi>m</mi><mo>^</mo></mover><mrow><mi>l</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mrow><mo>(</mo><msub><mi>R</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo><msub><mi>T</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msup><mo>+</mo><munder><mi>&Sigma;</mi><mi>j</mi></munder><msup><mrow><mo>|</mo><mo>|</mo><msub><mi>m</mi><mrow><mi>r</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>-</mo><msub><mover><mi>m</mi><mo>^</mo></mover><mrow><mi>r</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mrow><mo>(</mo><msub><mi>R</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo><msub><mi>T</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo><mi>R</mi><mo>,</mo><mi>T</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msup><mo>]</mo></mrow></math>]]></maths>此外,根据对极几何我们又可以得到如下目标函数<maths num="0005"><![CDATA[<math><mrow><mi>min</mi><munder><mi>&Sigma;</mi><mi>i</mi></munder><munder><mi>&Sigma;</mi><mi>j</mi></munder><mo>|</mo><msub><mover><mi>m</mi><mo>&OverBar;</mo></mover><mrow><mi>l</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mi>F</mi><msub><mover><mi>m</mi><mo>&OverBar;</mo></mover><mrow><mi>r</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>|</mo><mo>=</mo><mi>min</mi><munder><mi>&Sigma;</mi><mi>i</mi></munder><munder><mi>&Sigma;</mi><mi>j</mi></munder><mo>|</mo><msub><mover><mi>m</mi><mo>&OverBar;</mo></mover><mrow><mi>l</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><msubsup><mi>A</mi><mi>r</mi><mrow><mo>-</mo><mi>T</mi></mrow></msubsup><msubsup><mi>RSA</mi><mi>l</mi><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><msub><mover><mi>m</mi><mo>&OverBar;</mo></mover><mrow><mi>r</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>|</mo></mrow></math>]]></maths>式中,<img file="FDA00002450837600026.GIF" wi="84" he="49" />和<img file="FDA00002450837600027.GIF" wi="87" he="49" />分别是左右摄像机成像面上矫正的对应点,F为基础矩阵,S为向量T的反对称矩阵,其表示为<maths num="0006"><![CDATA[<math><mrow><mi>S</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mo>-</mo><msub><mi>T</mi><mi>z</mi></msub></mtd><mtd><msub><mi>T</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msub><mi>T</mi><mi>z</mi></msub></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><msub><mi>T</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><mo>-</mo><msub><mi>T</mi><mi>y</mi></msub></mtd><mtd><msub><mi>T</mi><mi>x</mi></msub></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>因此,最终的目标函数可表示如下<maths num="0007"><![CDATA[<math><mrow><mrow><mi>min</mi><mo>(</mo><mi>&alpha;</mi><munder><mi>&Sigma;</mi><mi>i</mi></munder><munder><mi>&Sigma;</mi><mi>j</mi></munder><msup><mrow><mo>(</mo><mrow><mo>|</mo><mo>|</mo><msub><mi>m</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>-</mo><msub><mover><mi>m</mi><mo>^</mo></mover><mrow><mi>l</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mrow><mo>(</mo><msub><mi>R</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo><msub><mi>T</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>|</mo><mo>|</mo><msub><mi>m</mi><mrow><mi>r</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>-</mo><msub><mover><mi>m</mi><mo>^</mo></mover><mrow><mi>r</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mrow><mo>(</mo><msub><mi>R</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo><msub><mi>T</mi><mrow><mi>l</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo><mi>R</mi><mo>,</mo><mi>T</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msup></mrow><mo>)</mo><mo>+</mo><munder><mi>&Sigma;</mi><mi>i</mi></munder><munder><mi>&Sigma;</mi><mi>j</mi></munder><mo>|</mo><msub><mover><mi>m</mi><mo>&OverBar;</mo></mover><mrow><mi>l</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><msubsup><mi>A</mi><mi>r</mi><mrow><mo>-</mo><mi>T</mi></mrow></msubsup><msubsup><mi>RSA</mi><mi>l</mi><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><msub><mover><mi>m</mi><mo>&OverBar;</mo></mover><mrow><mi>r</mi><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>|</mo><mo>)</mo></mrow></math>]]></maths>式中,α和β为权重系数,对上式采用Levenberg-Marquardt非线性优化方法,即可完成最终的立体视觉系统结构参数优化标定。
地址 200240 上海市闵行区东川路800号