发明名称 一种单目视觉实时测距方法
摘要 本发明公开了一种单目视觉实时测距方法,包括以下步骤:步骤一、将相机中的图像传感器绕该平面内的水平轴逆时针旋转θ角;步骤二、在测距范围内,对测距目标进行一次成像,确定图像传感器平面接收到最清晰图像的位置m<sub>a</sub>;步骤三、利用m<sub>a</sub>,求出测距目标到相机的距离<img file="200910082807.3_AB_0.GIF" wi="28" he="24" />;只需利用单个相机即可完成测距任务;本方法属于被动式的测距方法,不需要主动投射光源,结构更加简单;对测距目标只需进行一次成像即可满足测距需要;硬件上只需对现有相机的图像传感器进行倾斜,结构改动小,成本低;由于测距算法简练、快速,因此测距的实时性好,在工业控制,机器人导航以及飞机着陆、导弹巡航、目标运动估计等军事领域都存在应用价值。
申请公布号 CN101539422A 申请公布日期 2009.09.23
申请号 CN200910082807.3 申请日期 2009.04.22
申请人 北京航空航天大学 发明人 周浩;陈万春;覃天;刘小明;顾家立
分类号 G01C3/00(2006.01)I 主分类号 G01C3/00(2006.01)I
代理机构 北京永创新实专利事务所 代理人 周长琪
主权项 1、一种单目视觉实时测距方法,其特征在于,包括以下步骤:步骤一、将相机中的图像传感器绕该平面内的水平轴逆时针旋转θ角;步骤二、在测距范围内,对测距目标进行一次成像,确定图像传感器平面接收到最清晰图像的位置ma;模数偏差总和算子计算两相邻像素点的水平方向和垂直方向的一阶灰度偏差的总和如下式所示:<maths id="math0001" num="0001" ><math><![CDATA[ <mrow> <msub> <mi>SMD</mi> <mi>x</mi> </msub> <mo>=</mo> <munder> <mi>&Sigma;</mi> <mi>x</mi> </munder> <munder> <mi>&Sigma;</mi> <mi>y</mi> </munder> <mo>|</mo> <mi>f</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>,</mo> <mi>y</mi> <mo>)</mo> </mrow> <mo>-</mo> <mi>f</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>,</mo> <mi>y</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>|</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>]]></math></maths><maths id="math0002" num="0002" ><math><![CDATA[ <mrow> <msub> <mi>SMD</mi> <mi>y</mi> </msub> <mo>=</mo> <munder> <mi>&Sigma;</mi> <mi>x</mi> </munder> <munder> <mi>&Sigma;</mi> <mi>y</mi> </munder> <mo>|</mo> <mi>f</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>,</mo> <mi>y</mi> <mo>)</mo> </mrow> <mo>-</mo> <mi>f</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>+</mo> <mn>1</mn> <mo>,</mo> <mi>y</mi> <mo>)</mo> </mrow> <mo>|</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>]]></math></maths>式中,f(x,y)为图像像素坐标为(x,y)处的灰度值;设f(m)为图像传感器平面第m行的SMD对焦函数,测距目标成像图像的分辨率为X×Y,X为行数,Y为列数,则f(m)=SMDx+SMDy (3)其中x=m,1≤m≤X,1≤y≤Y;当f(m)取最大值时,此时m=ma,则认为ma行处所在的水平线位置接收到的图像为最清晰的;步骤三、利用ma,求出测距目标到相机的距离OU;由几何关系可得:OM=ON-NC sinθ (4)式中,OM为透镜中心到图像传感器上目标成清晰像处位置在透镜中心的水平轴上投影点的距离,ON为透镜中心到图像传感器与透镜中心的水平轴的交点的距离,NC为图像传感器与透镜中心的水平轴的交点到图像传感器平面与目标呈清晰像的交点的距离;图像传感器根据比例关系可得:<maths id="math0003" num="0003" ><math><![CDATA[ <mrow> <mover> <mi>NC</mi> <mo>&OverBar;</mo> </mover> <mo>=</mo> <mfrac> <mrow> <msub> <mrow> <mn>2</mn> <mi>m</mi> </mrow> <mi>a</mi> </msub> <mo>-</mo> <mi>X</mi> </mrow> <mrow> <mn>2</mn> <mi>X</mi> </mrow> </mfrac> <mo>&times;</mo> <mi>h</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>]]></math></maths>透镜公式如式(6):<maths id="math0004" num="0004" ><math><![CDATA[ <mrow> <mfrac> <mn>1</mn> <mover> <mi>OM</mi> <mo>&OverBar;</mo> </mover> </mfrac> <mo>+</mo> <mfrac> <mn>1</mn> <mover> <mi>OU</mi> <mo>&OverBar;</mo> </mover> </mfrac> <mo>=</mo> <mfrac> <mn>1</mn> <mi>f</mi> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>]]></math></maths>式中,OU为物距,f为透镜焦距;将式(4)、式(5),代入式(6),得到测距公式(7)为:<maths id="math0005" num="0005" ><math><![CDATA[ <mrow> <mover> <mi>OU</mi> <mo>&OverBar;</mo> </mover> <mo>=</mo> <mfrac> <mrow> <mi>f</mi> <mo>&times;</mo> <mrow> <mo>(</mo> <mn>2</mn> <mi>X</mi> <mover> <mi>ON</mi> <mo>&OverBar;</mo> </mover> <mo>-</mo> <msub> <mrow> <mn>2</mn> <mi>m</mi> </mrow> <mi>a</mi> </msub> <mi>h</mi> <mi>sin</mi> <mi>&theta;</mi> <mo>+</mo> <mi>Xh</mi> <mi>sin</mi> <mi>&theta;</mi> <mo>)</mo> </mrow> </mrow> <mrow> <mn>2</mn> <mi>X</mi> <mover> <mi>ON</mi> <mo>&OverBar;</mo> </mover> <mo>-</mo> <msub> <mrow> <mn>2</mn> <mi>m</mi> </mrow> <mi>a</mi> </msub> <mi>h</mi> <mi>sin</mi> <mi>&theta;</mi> <mo>+</mo> <mi>Xh</mi> <mi>sin</mi> <mi>&theta;</mi> <mo>-</mo> <mn>2</mn> <mi>Xf</mi> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>]]></math></maths>式中,X为图像高度的像素数,h为图像传感器平面的高度,f为透镜焦距。
地址 100083北京市海淀区学院路37号
您可能感兴趣的专利