一种用于汽车前碰预警及车道偏离预警的摄像头标定方法与流程

文档序号:12472048阅读:来源:国知局

技术特征:

1.一种用于汽车前碰预警及车道偏离预警的摄像头标定方法,该方法包括下列顺序的步骤:

(1)录制或者实时播放路面视频,选取视频中的一张图片,再选取该图片中的A、B、C、D四个点作为路面上的矩形的四个顶点;

(2)对上述四个顶点做粗略透视变换,得到粗略估算矩阵;

(3)根据粗略估算矩阵存在的误差进行调整;

(4)进行空间分辨率调整和整体平移;

(5)标定完成。

2.根据权利要求1所述的用于汽车前碰预警及车道偏离预警的摄像头标定方法,其特征在于:在步骤(2)中,所述粗略估算矩阵的计算公式为:

<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>1</mn> </msub> </mtd> <mtd> <msub> <mi>x</mi> <mn>2</mn> </msub> </mtd> <mtd> <msub> <mi>x</mi> <mn>3</mn> </msub> </mtd> <mtd> <msub> <mi>x</mi> <mn>4</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>y</mi> <mn>1</mn> </msub> </mtd> <mtd> <msub> <mi>y</mi> <mn>2</mn> </msub> </mtd> <mtd> <msub> <mi>y</mi> <mn>3</mn> </msub> </mtd> <mtd> <msub> <mi>y</mi> <mn>4</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>z</mi> <mn>1</mn> </msub> </mtd> <mtd> <msub> <mi>z</mi> <mn>2</mn> </msub> </mtd> <mtd> <msub> <mi>z</mi> <mn>3</mn> </msub> </mtd> <mtd> <msub> <mi>z</mi> <mn>4</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>a</mi> <mn>11</mn> </msub> </mtd> <mtd> <msub> <mi>a</mi> <mn>12</mn> </msub> </mtd> <mtd> <msub> <mi>a</mi> <mn>13</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>a</mi> <mn>21</mn> </msub> </mtd> <mtd> <msub> <mi>a</mi> <mn>22</mn> </msub> </mtd> <mtd> <msub> <mi>a</mi> <mn>23</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>a</mi> <mn>31</mn> </msub> </mtd> <mtd> <msub> <mi>a</mi> <mn>32</mn> </msub> </mtd> <mtd> <msub> <mi>a</mi> <mn>33</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <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> <mtd> <msub> <mi>u</mi> <mn>4</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>v</mi> <mn>1</mn> </msub> </mtd> <mtd> <msub> <mi>v</mi> <mn>2</mn> </msub> </mtd> <mtd> <msub> <mi>v</mi> <mn>3</mn> </msub> </mtd> <mtd> <msub> <mi>v</mi> <mn>4</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> </mtable> </mfenced> </mrow>

其中a11~a33为透视变换矩阵参数,为未知数;(x1/z1,y1/z1)、(x2/z2,y2/z2)、(x3/z3,y3/z3)、(x4/z4,y4/z4)为逆投影过后的四个点,即变换后的4个点的图像坐标;(u1,v1)(u2,v2)(u3,v3)(u4,v4)为原图像中的A、B、C、D四个点的图像坐标,即变换前的4个点的图像坐标,为已知数;通过解方程组,得到透视变换矩阵参数a11~a33

3.根据权利要求1所述的用于汽车前碰预警及车道偏离预警的摄像头标定方法,其特征在于:在步骤(3)中,若两车道存在平行度误差,则通过分别调节A、B两点的图像坐标中横坐标x值来调整透视矩阵,从而调整透视图像;若车道线末端偏向左,则对应车道线末端的位置应向右调整,即A,B点的横坐标x应增大,单次调整单位为一个像素,直到调整到车道线平行且竖直为止;若车道线末端偏向右,则对应车道线末端的位置应向左调整,即A,B点的横坐标x应减小,单次调整单位为一个像素,直到调整到车道线平行且竖直为止。

4.根据权利要求1所述的用于汽车前碰预警及车道偏离预警的摄像头标定方法,其特征在于:在步骤(3)中,若两条车道线长度比例不同导致存在误差,则由车道线虚线部分是否对齐来判断:若两车道存在图像y方向的误差,此类误差可通过分别调节A,B两点的图像坐标中纵坐标y值来调整透视矩阵,从而调整透视图像;若车道线末端偏向上,则对应车道线末端应向下调整,即A,B点的纵坐标y应增大,单次调整单位为一个像素,直到调整到车道线比例相同为止;若车道线末端偏向下,则对应车道线末端应向上调整,即A,B点的纵坐标y应减小,单次调整单位为一个像素,直到调整到车道线比例相同为止。

5.根据权利要求1所述的用于汽车前碰预警及车道偏离预警的摄像头标定方法,其特征在于:在步骤(4)中,所述空间分辨率调整是指进行透视图像x方向和y方向的放缩,使空间分辨率等于规定值,此调整通过同时放缩A,B,C,D点的X值以调整X方向的空间分辨率和放缩A,B,C,D点的Y值以调整Y方向的空间分辨率来进行,公式如下:

<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msubsup> <mi>x</mi> <mn>1</mn> <mo>&prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>x</mi> <mn>2</mn> <mo>&prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>x</mi> <mn>3</mn> <mo>&prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>x</mi> <mn>4</mn> <mo>&prime;</mo> </msubsup> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>y</mi> <mn>1</mn> <mo>&prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>y</mi> <mn>2</mn> <mo>&prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>y</mi> <mn>3</mn> <mo>&prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>y</mi> <mn>4</mn> <mo>&prime;</mo> </msubsup> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msub> <mi>k</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <mi>M</mi> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mrow> <msub> <mi>k</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>-</mo> <mi>M</mi> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mrow> <msub> <mi>k</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>-</mo> <mi>M</mi> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mrow> <msub> <mi>k</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>4</mn> </msub> <mo>-</mo> <mi>M</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>y</mi> <mn>1</mn> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>y</mi> <mn>2</mn> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>y</mi> <mn>3</mn> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>y</mi> <mn>4</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>

其中,(x′1,y′1)(x′2,y′2)(x′3,y′3)(x′4,y′4)为放缩过后的A,B,C,D四点坐标值,(x1,y1)(x2,y2)(x3,y3)(x4,y4)为未放缩的A,B,C,D四点的坐标值。k1,k2分别为X方向的空间分辨率,Y方向的空间分辨率调节参数,M为图像纵向中轴线。

6.根据权利要求1所述的用于汽车前碰预警及车道偏离预警的摄像头标定方法,其特征在于:在步骤(4)中,所述整体平移是指通过同时平移A、B、C、D点的坐标,将与车头垂直的中间线置于透视变换图像的x方向中轴线上,计算公式如下:

<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msubsup> <mi>x</mi> <mn>1</mn> <mo>&prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>x</mi> <mn>2</mn> <mo>&prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>x</mi> <mn>3</mn> <mo>&prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>x</mi> <mn>4</mn> <mo>&prime;</mo> </msubsup> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>y</mi> <mn>1</mn> <mo>&prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>y</mi> <mn>2</mn> <mo>&prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>y</mi> <mn>3</mn> <mo>&prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>y</mi> <mn>4</mn> <mo>&prime;</mo> </msubsup> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>x</mi> </mrow> </mtd> <mtd> <mrow> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>x</mi> </mrow> </mtd> <mtd> <mrow> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>x</mi> </mrow> </mtd> <mtd> <mrow> <msub> <mi>x</mi> <mn>4</mn> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>x</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>y</mi> </mrow> </mtd> <mtd> <mrow> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>y</mi> </mrow> </mtd> <mtd> <mrow> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>y</mi> </mrow> </mtd> <mtd> <mrow> <msub> <mi>y</mi> <mn>4</mn> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>y</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>

其中,(x′1,y′1)(x′2,y′2)(x′3,y′3)(x′4,y′4)为平移过后的A,B,C,D四点坐标值,(x1,y1)(x2,y2)(x3,y3)(x4,y4)为未平移的A,B,C,D四点的坐标值,Δx,Δy分别为图像在x方向,y方向的平移量。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1