主权项 |
1、一种单目视觉实时测距方法,其特征在于,包括以下步骤:步骤一、将相机中的图像传感器绕该平面内的水平轴逆时针旋转θ角;步骤二、在测距范围内,对测距目标进行一次成像,确定图像传感器平面接收到最清晰图像的位置ma;模数偏差总和算子计算两相邻像素点的水平方向和垂直方向的一阶灰度偏差的总和如下式所示:<maths id="math0001" num="0001" ><math><![CDATA[ <mrow> <msub> <mi>SMD</mi> <mi>x</mi> </msub> <mo>=</mo> <munder> <mi>Σ</mi> <mi>x</mi> </munder> <munder> <mi>Σ</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>Σ</mi> <mi>x</mi> </munder> <munder> <mi>Σ</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>‾</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>×</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>‾</mo> </mover> </mfrac> <mo>+</mo> <mfrac> <mn>1</mn> <mover> <mi>OU</mi> <mo>‾</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>‾</mo> </mover> <mo>=</mo> <mfrac> <mrow> <mi>f</mi> <mo>×</mo> <mrow> <mo>(</mo> <mn>2</mn> <mi>X</mi> <mover> <mi>ON</mi> <mo>‾</mo> </mover> <mo>-</mo> <msub> <mrow> <mn>2</mn> <mi>m</mi> </mrow> <mi>a</mi> </msub> <mi>h</mi> <mi>sin</mi> <mi>θ</mi> <mo>+</mo> <mi>Xh</mi> <mi>sin</mi> <mi>θ</mi> <mo>)</mo> </mrow> </mrow> <mrow> <mn>2</mn> <mi>X</mi> <mover> <mi>ON</mi> <mo>‾</mo> </mover> <mo>-</mo> <msub> <mrow> <mn>2</mn> <mi>m</mi> </mrow> <mi>a</mi> </msub> <mi>h</mi> <mi>sin</mi> <mi>θ</mi> <mo>+</mo> <mi>Xh</mi> <mi>sin</mi> <mi>θ</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为透镜焦距。 |