CN102509067A - 一种车道边界和主车方位检测方法 - Google Patents
一种车道边界和主车方位检测方法 Download PDFInfo
- Publication number
- CN102509067A CN102509067A CN2011102849936A CN201110284993A CN102509067A CN 102509067 A CN102509067 A CN 102509067A CN 2011102849936 A CN2011102849936 A CN 2011102849936A CN 201110284993 A CN201110284993 A CN 201110284993A CN 102509067 A CN102509067 A CN 102509067A
- Authority
- CN
- China
- Prior art keywords
- max
- edge
- lane
- ant
- value
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Image Analysis (AREA)
Abstract
本发明公开了一种车道边界和主车方位检测方法,首先设置最佳车载摄像机外参数;然后根据车道图像像素梯度幅值自适应设置边缘阈值,并提取边缘点、计算边缘点方向;再根据车道边界投影模型、边缘点及其方向利用蚁群优化搜索定位车道边界;最后计算车道平面线形参数值和主车方位;本发明的检测方法能够快速有效搜索定位车道边界,能够适应各种车道线形以及天气和光照变化,并能够测算出车道平面线形参数值和主车在车道中的偏向角和位置。
Description
技术领域
本发明涉及一种能够识别复杂道路环境中的车辆所在车道边界和检测主车在车道中的位置和方向的方法,属于智能车辆技术领域。
背景技术
在智能车辆系统中,车道边界和主车方位检测方法是智能车辆预警和控制系统的重要组成部分,主要应用于车道偏离报警、车辆智能巡航控制、车辆横向控制、车辆自主驾驶等。
在现有的车道检测方法中,主要利用直线、二次多项式、样条曲线、圆弧等车道曲线模型检测车道边界,这些模型只能部分或近似地反映车道平面线形,而且无法测算车道平面线形参数值,如车道曲率、车道曲率变化率等,这些数据对车辆的自主驾驶、智能巡航的控制和决策是非常重要的。另一方面,车辆在行驶过程中道路的状况是复杂和多变的,车道检测需要能够适应各种车道标线、道路光照以及复杂环境,在复杂和恶劣条件下的车道检测是非常困难的,现有的车道检测方法还无法很好解决,需要进一步提高检测的可靠性和精度。另外,现有的车道检测方法在检测车道的同时还无法精确测算主车在车道中的位置和方向。
经对现有技术文献的检索发现,专利号为200480023596.1的发明专利“路面行驶车道检测装置”包括边缘点检测装置、边缘直方图作成装置、方块标记线判定装置、车道边界边缘检测装置和车道边界线位置确定装置;该技术从图像中的轮廓线检测出边缘点,并相对于边缘点的水平成分计算垂直方向边缘直方图,然后根据垂直方向边缘直方图的分布周期性与正边缘以及负边缘的分布组合,判定是否存在方块状的标记线,再检测出存在于方块状标记线外侧的垂直方向边缘点,最后将与垂直方向边缘点相吻合的曲线位置确定为行驶车道的边界线。该专利的缺点在于:对摄像机的高度和姿态角未作最佳设置,也未给出具体的设置范围,在车道图像采集中,摄像机无法最大限度的采集车道信息,这会影响车道检测的准确度;对于存在阴影的道路,在轮廓线检测中会检测出阴影边缘点,这将严重影响车道边界检测的可靠性;另外,该技术还无法有效检测圆弧形和回旋曲线形车道的边界,并且无法检测或测算主车在车道中的位置和方向。
发明内容
为了克服现有技术检测准确度和可靠性不高的不足,本发明提供一种车道边界和主车方位检测方法,该方法不仅能够提高车道信息采集的效率和车道检测的效率,而且能够在道路有阴影、车辆、光线变化等路况环境下检测主车所在车道边界和主车方位。
本发明解决其技术问题所采用的技术方案包括以下步骤:
步骤1:设置最佳车载摄像机外参数,将摄像机架设于车辆顶部中轴线前端位置,摄像机光轴与车辆中轴线位于同一垂直面,定义摄像机的俯仰角α向下为正、面向摄像机前方滚动角γ顺时针方向为正,设置摄像机的俯仰角α=arctan(rOdy/fc)、摄像机的滚动角γ=0、摄像机距离路面的高度其中fc为摄像机焦距,dx、dy分别为摄像机拍摄的图像像素点在水平和垂直方向上的物理尺寸,cO和rO分别为图像中心点的像素横坐标和纵坐标,Wlane为车道宽度;
步骤2:根据摄像机拍摄的车道图像像素梯度幅值自适应设置边缘阈值,并提取边缘点、计算边缘点方向,包括以下步骤:
步骤2.1:计算车道图像除第一行、最后一行、第一列、最后一列像素点外的其它各个像素点水平方向和垂直方向上的梯度幅值
Gx(c,r)=f(c+1,r-1)+2f(c+1,r)+f(c+1,r+1)
-f(c-1,r-1)-2f(c-1,r)-f(c-1,r+1)
Gy(c,r)=f(c-1,r+1)+2f(c,r+1)+f(c+1,r+1)
-r(c-1,r-1)-2f(c,r-1)-f(c+1,r-1)
其中c、r分别表示像素点的横坐标和纵坐标,Gx(c,r)、Gy(c,r)分别表示像素点(c,r)水平方向和垂直方向的梯度幅值,f(c,r)表示像素点(c,r)的像素值,然后计算车道图像像素点的梯度幅值Gm(c,r)=|Gx(c,r)|+|Gy(c,r)|;
步骤2.3:将图像像素点(c,r)的梯度幅值Gm(c,r)与梯度阈值Gmth相比较,其中c=1,2,...,W-2,r=1,2,...,H-2,若Gm(c,r)≥Gmth,则将该像素点标记为边缘像素点,若Gm(c,r)<Gmth,则将该像素点标记为非边缘像素点,然后计算边缘像素点的边缘方向θ(cedge,redge)=arctan[Gy(cedge,redge)/Gx(cedge,redge)],其中cedge、redge分别表示边缘像素点的横坐标和纵坐标;
步骤3:根据车道边界投影模型、边缘点及其方向利用蚁群优化搜索定位车道边界,包括以下步骤:
步骤3.1:设置车道模型,将车道左、右边界投影模型,即图像中的车道边界曲线方程,也称为车道左、右边界线的投影曲线方程设置为
其中rlane表示车道边界曲线上像素点的纵坐标,clane,L和clane,R分别表示车道左、右边界曲线上像素点的横坐标,B1、B2、B3、B4、B5为车道边界投影曲线的参数,并定义B=(B1,B2,B3,B4,B5)T为车道边界投影模型参数向量,其取值范围为(-5,0,0,-2000,-3000)T<B<(0,5,300,2000,3000)T;
步骤3.2:蚁群搜索初始化,初始化迭代计数器t=0、最大迭代次数Itermax,其取值范围为10≤Itermax≤200,并将搜索空间Bmin<B<Bmax的每一维空间平均划分为M个子区间,分别标记为1,...,M,M的取值范围为5≤M≤200,其中
Bmin=(B1,min,B2,min,B3,min,B4,min,B5,min)=(-5,0,0,-2000,-3000)T
Bmax=(B1,max,B2,max,B3,max,B4,max,B5,max)=(0,5,300,2000,3000)T
子区间的半径为
子区间的边界值为2(m-1)Ωn和2mΩn,其中m=1,...,M,n=1,...,5,对应于搜索空间的每一维子空间建立记录表[τnm(t),Δτnm(t),Fnm,max(t),Bnm,max(t)],其中t表示迭代次数,τnm(t)表示第n维第m子区间蚂蚁信息素的残留,Δτnm(t)表示当前第n维第m子区间的信息素增量即所有当前蚂蚁在第n维第m子区间留下的信息素,Fnm,max(t)表示对应子区间的历史最大启发函数值即车道边界曲线置信度,Bnm,max(t)表示相应的路径即车道边界投影模型参数值,初始化τnm(t),其取值范围为0.1≤τnm(t)≤30,初始化Δτnm(t)=0,Bnm,max(t)=(2m-1)Ωn,Fnm,max(t)=0,其中n=1,...,5、m=1,...,M,并初始化信息素挥发系数ρ,其取值范围为0<ρ<1;初始化蚁群规模即蚂蚁数量S,其取值范围为5≤S≤200且S≤M;定义 分别表示第i只蚂蚁经过的子区间、路径即车道模型参数向量值,定义表示期望信息即第i只蚂蚁选择第n维第m子区间的期望值,初始化蚂蚁经过的路径Bi(t)=[B1i,max(t),...,B5i,max(t)]、子区间Ui(t)=(i,i,i,i,i)、期望信息其中i=1,...,S、n=1,...,5、m=1,...,M;然后计算启发函数值即车道边界曲线置信度F[Bi(t)],更新Fni,max(t)=F[Bi(t)],其中n=1,...,5,并比较所有蚂蚁的启发函数值,进而初始化蚁群启发函数的历史最小值Fmin(t)=min{F[Bi(t)]|i=1,...,S}、历史最大值Fmax(t)=max{F[Bi(t)]|i=1,...,S}、对应历史最大值的最优路径Bmax(t)及其子区间Umax(t),并计算当前蚁群启发函数值的平均值初始设定局域搜索的正态分布标准差σ=(σ1,...,σ5)的值、蚂蚁选择概率的信息启发式因子α和期望启发式因子β的值,其取值范围分别为0.2Ω≤σ≤3Ω、0<α≤5、0<β≤5;进一步初始设置Ui(t+1)=Ui(t),其中i=1,...,S;所述启发函数即车道边界曲线置信度F[Bi(t)]的计算方法为
其中
表示边缘点的边缘方向θ(cedge,redge)与车道边界曲线的夹角,其计算方法为
其中
步骤3.3:将迭代计数器t加1;
步骤3.4:蚁群局域搜索,根据蚂蚁所在区域Ui(t)按高斯分布
随机产生新的路径其中i=1,...,S、n=1,...,5,将新路径Bi(t)与Ui(t)子区间的边界值相比较,若超出子区间边界则更新蚂蚁所在的子区间Ui(t),若超出搜索空间边界值则将Bi(t)设为相应边界值,计算启发函数值F[Bi(t)],其中i=1,...,S,再更新启发函数历史最大值Fmax(t)=max{Fmax(t-1),F[Bi(t)]|i=1,...,S}、Fmax(t)对应的最优路径Bmax(t)和子区间Umax(t)、当前蚁群的启发函数最小值Fmin(t)=min{F[Bi(t)]|i=1,...,S},并计算更新当前蚁群的启发函数平均值
步骤3.5:更新信息素表,初始化信息素增量Δτnm(t)=0,其中n=1,...,5、m=1,...,M,计算当前蚂蚁留下的信息素
其中i=1,...,S、n=1,...,5,更新信息素增量和信息素残留τnm(t)=(1-ρ)τnm(t-1)+Δτnm(t),其中n=1,...,5、m=1,...,M;然后将蚂蚁的启发函数值F[Bi(t)]与相比较,若 则更新 若 则更新 其中i=1,...,S、n=1,...,5;
步骤3.6:将迭代次数t和最大迭代次数Itermax相比较,若t>Itermax,则跳转到步骤3.8,若t≤Itermax,则执行下一步骤3.7;
步骤3.7:蚁群全局搜索,计算蚂蚁的期望信息 和蚂蚁选择路径的选择概率 其中i=1,...,S、n=1,...,5、m=1,...,M,分别对每只蚂蚁产生(0,1)均值分布上的随机数Rand,更新蚂蚁的路径子区间
其中i=1,...,S、n=1,...,5,然后跳转到步骤3.3;
步骤3.8:输出车道边界曲线,根据最优路径Bmax(t)以及车道边界投影模型,在图像上画出检测到的车道左、右边界曲线
步骤4:计算车道平面线形参数值和主车方位,计算主车所在点处的车道曲率
和主车前方车道曲率的变化率
其中Q1=dy sin 2α、 计算主车在车道中的偏向角
和车辆偏离车道中心线的距离
本发明的有益效果是:本发明利用了改进的连续域蚁群优化并简化了像素点梯度幅值的计算和边缘点到车道边界曲线距离的计算,能够快速有效搜索定位车道边界和测算主车在车道中的方位,并且能够适应车道有阴影、车辆、光线变化等路况环境,抗干扰能力强,具有较强的鲁棒性;本发明中摄像机的高度和俯仰角的设置能够使摄像机最大限度的采集到车道标线信息,有效提高了车道图像中车道标线信息的含量,减少了车道检测过程中对无关信息的存储和处理;本发明简化的车道边界投影模型符合结构化车道设计规范规定的车道平面线形在图像中的投影,能够计算出车道平面线形的参数值以及主车在车道中的位置和方向。
下面结合附图和实施例对本发明进一步说明。
附图说明
图1是本发明一种车道边界和主车方位检测方法实施例的系统结构示意图;
图2是本发明实施例所述的一种车道边界和主车方位检测方法的总流程图;
图3A是本发明实施例所述的摄像机外参数最佳设置时的侧视图,以及图3B是本发明实施例所述的摄像机外参数最佳设置时的顶视图;
图4是本发明实施例的车载摄像机外参数最佳设置时采集的车道图像示意图。
图5是本发明实施例所述的根据车道边界投影模型、边缘点及其方向利用蚁群优化搜索定位车道边界的方法流程图;
具体实施方式
本发明将一种车道边界和主车方位检测方法应用在车道边界和主车方位检测装置中,该装置的系统结构示意图如图1所示,其具体实施方式如下:
摄像机:采用CCD(Charged Coupled Device电荷耦合器件)图像传感器摄像机,与模数转换器的数据输入接口连接,拍摄车辆前方道路,并将拍摄的模拟图像信号发送到模数转换器;
模数转换器:其数据输入接口与摄像机的数据输出接口连接,数据输出接口与输入接口电路的数据输入接口连接,控制接口与系统控制总线连接,该组件将摄像机的模拟图像信号转换成数字图像信号并传输给输入接口电路;
输入接口电路,连接模数转换器和系统数据总线的适配电路,其数据输入接口与模数转换器的数据输出接口连接,数据输出接口与系统数据总线连接,控制接口与系统控制总线连接,该组件对道路图像数据进行输入和缓冲;
存储器,其数据接口与系统数据总线连接,控制接口与系统控制总线连接,该组件存储系统控制指令和车道图像;
车道数字图像处理器,其数据接口与系统数据总线连接,控制接口与系统控制总线连接,该组件从存储器中读出车道图像并对其进行车道检测,然后将检测结果通过系统数据总线传输给输出接口电路7;
系统控制器,其数据输入接口与系统数据总线连接,控制接口与系统控制总线连接,该组件从存储器中将控制指令取出,经分析后根据指令分析结果发送相应的操作控制信号,控制系统各部件协调工作;
输出接口电路,连接系统数据总线与输出设备的适配电路,其数据输入接口与系统数据总线连接,数据输出接口与输出设备连接,控制接口与系统控制总线连接,该组件输出和缓冲车道检测结果;
系统数据总线,由一组导线和相关的控制、驱动电路组成,与各部件的数据接口连接,传输数据信息;
系统控制总线,由一组导线和相关的控制、驱动电路组成,与各部件的控制接口连接,传送控制信号、时序信号和状态信息;
电源电路,将外部电源提供的电能转换成符合各部件电压和频率要求的电能,为各部件提供电能;
利用本发明实施例,其总流程图如图2所示,车辆沿车道行驶,检测装置实时采集车辆前方道路图像,并对道路图像进行车道边界和主车方位检测,其具体实施方式如下:
步骤1:设置最佳车载摄像机外参数,如图3A和图3B所示,XcYcZc为摄像机直角坐标系,其中Zc为摄像机光轴,摄像机架设于车辆项部中轴线前端位置,摄像机光轴Zc与车辆中轴线位于同一垂直面,定义摄像机的俯仰角α向下为正、面向摄像机前方滚动角γ顺时针方向为正,设置摄像机的俯仰角α=arctan(rOdy/fc)、摄像机的滚动角γ=0、摄像机距离路面高度其中fc为摄像机焦距,dx、dy分别为摄像机拍摄的图像像素点在水平和垂直方向上的物理尺寸,cO和rO分别为图像中心点的像素横坐标和纵坐标,Wlane为车道宽度;摄像机的俯仰角、滚动角、高度设置的具体原理为:在道路图像采集过程中,摄像机的视角、成像面积的大小是不变的,车道宽度的变化也很小,为了最大限度的获取车道边界信息,摄像机的高度、俯仰角和滚动角需要设置在最佳位置,如图4所示,当图像中的地平线为r=0,并且车道左、右边界线穿过图像左下角和右下角时,图像中的车道边界标线最长,根据像素坐标系中的车道边界线方程,此时摄像机的最佳俯仰角、最佳滚动角和最佳高度分别为αopt=arctan(rOdy/fc)、γ=0和因此,本发明实施例在车道图像的采集中可提高图像中车道信息的含量,进而提高了车道和主车方位检测的精确性;
步骤2:根据摄像机拍摄的车道图像像素梯度幅值自适应设置边缘阈值,并提取边缘点、计算边缘点方向;具体地,所述步骤2包括以下步骤:
步骤2.1:计算车道图像除第一行、最后一行、第一列、最后一列像素点外的其它各个像素点水平方向和垂直方向上的梯度幅值
Gx(c,r)=f(c+1,r-1)+2f(c+1,r)+f(c+1,r+1)
-f(c-1,r-1)-2f(c-1,r)-f(c-1,r+1)
Gy(c,r)=f(c-1,r+1)+2f(c,r+1)+f(c+1,r+1)
-f(c-1,r-1)-2f(c,r-1)-f(c+1,r-1)
其中c、r分别表示像素点的横坐标和纵坐标,Gx(c,r)、Gy(c,r)分别表示像素点(c,r)水平方向和垂直方向的梯度幅值,f(c,r)表示像素点(c,r)的像素值,然后计算车道图像像素点的梯度幅值Gm(c,r)=|Gx(c,r)|+|Gy(c,r)|,本发明中用|Gx(c,r)|+|Gy(c,r)|替代近似计算像素点的梯度幅值可以减少计算量并且保持梯度的相对变化,提高计算速度;
步骤2.2:计算提取边缘像素点的梯度阈值其中H、W分别表示图像的高和宽,具体地H=240、W=320,wG为系数,其取值范围为0.1≤wG≤1,具体地wG=0.6,本发明实施例的边缘阈值可根据道路图像的明暗自适应调整,能适应光线变化,进而提高检测的鲁棒性;
步骤2.3:将图像像素点(c,r)的梯度幅值Gm(c,r)与梯度阈值Gmth相比较,其中c=1,2,...,W-2,r=1,2,...,H-2,若Gm(c,r)≥Gmth,则将该像素点标记为边缘像素点,若Gm(c,r)<Gmth,则将该像素点标记为非边缘像素点,然后计算边缘点的边缘方向θ(cedge,redge)=arctan[Gy(cedge,redge)/Gx(cedge,redge)],其中cedge、redge分别表示边缘像素点的横坐标和纵坐标;
步骤3:根据车道边界投影模型、边缘点及其方向利用蚁群优化搜索定位车道边界;具体地,所述步骤3的方法流程图如图5所示,包括以下步骤:
步骤3.1:设置车道模型,将车道左、右边界投影模型即图像中的车道边界曲线方程,也称为车道左、右边界线的投影曲线方程设置为
其中rlane表示车道边界曲线上像素点的纵坐标,clane,L和clane,R分别表示车道左、右边界曲线上像素点的横坐标,B1、B2、B3、B4、B5为车道边界投影曲线的参数,并定义B=(B1,B2,B3,B4,B5)T为车道边界投影模型参数向量,其取值范围为(-5,0,0,-2000,-3000)T<B<(0,5,300,2000,3000)T;根据公路平面路线设计规范,公路平面线形由直线、圆曲线、回旋线三种线形组成,车道曲率C随车道长度l的变化关系可表示为C(l)=C0+C1l,其中C0为主车所在处的车道曲率,C1为车道曲率的变化率,将上述变化关系式通过坐标系变换并考虑摄像机的俯仰角α=arctan(rOdy/fc),可得所述的车道左、右边界投影模型即图像中的车道边界曲线方程,由于本发明实施例摄像机外参数的最佳设置,车道左、右边界投影模型得到了简化;
步骤3.2:蚁群搜索初始化,初始化迭代计数器t=0、最大迭代次数Itermax,其取值范围为10≤Itermax≤200,具体地Itermax=50,并将搜索空间Bmin<B<Bmax的每一维空间平均划分为M个子区间,分别标记为1,...,M,M的取值范围为5≤M≤200,具体地M=50,其中
Bmin=(B1,min,B2,min,B3,min,B4,min,B5,min)=(-5,0,0,-2000,-3000)T
Bmax=(B1,max,B2,max,B3,max,B4,max,B5,max)=(0,5,300,2000,3000)T
子区间的半径为
子区间的边界值为2(m-1)Ωn和2mΩn,其中m=1,...,M,n=1,...,5,对应于搜索空间的每一维子空间建立记录表[τnm(t),Δτnm(t),Fnm,max(t),Bnm,max(t)],其中t表示迭代次数,τnm(t)表示第n维第m子区间蚂蚁信息素的残留,Δτnm(t)表示当前第n维第m子区间的信息素增量即所有当前蚂蚁在第n维第m子区间留下的信息素,Fnm,max(t)表示对应子区间的历史最大启发函数值即车道边界曲线置信度,Bnm,max(t)表示相应的路径即车道边界投影模型参数值,初始化τnm(t),其取值范围为0.1≤τnm(t)≤30,具体地τnm(t)=1,初始化Δτnm(t)=0,Bnm,max(t)=(2m-1)Ωn,Fnm,max(t)=0,其中n=1,...,5、m=1,...,M,并初始化信息素挥发系数ρ,其取值范围为0<ρ<1,具体地ρ=0.6;初始化蚁群规模即蚂蚁数量S,其取值范围为5≤S≤200且S≤M,具体地S=30;定义 分别表示第i只蚂蚁经过的子区间、路径即车道模型参数向量值,定义表示期望信息即第i只蚂蚁选择第n维第m子区间的期望值,初始化蚂蚁经过的路径Bi(0)=[B1i,max(0),...,B5i,max(0)]、子区间Ui(0)=(i,i,i,i,i)、期望信息其中i=1,...,S、n=1,...,5、m=1,...,M;然后计算启发函数值即车道边界曲线置信度F[Bi(t)],更新Fni,max(t)=F[Bi(t)],其中n=1,...,5,并比较所有蚂蚁的启发函数值,进而初始化蚁群启发函数的历史最小值Fmin(t)=min{F[Bi(t)]|i=1,...,S}、历史最大值Fmax(t)=max{F[Bi(t)]|i=1,...,S}、对应历史最大值的最优路径Bmax(t)及其子区间Umax(t),并计算当前蚁群启发函数值的平均值初始设定局域搜索的正态分布标准差σ=(σ1,...,σ5)的值、蚂蚁选择概率的信息启发式因子α和期望启发式因子β的值,其取值范围分别为0.2Ω≤σ≤3Ω、0<α≤5、0<β≤5,具体地σ=2Ω、α=1、β=2;进一步初始设置Ui(t+1)=Ui(t),其中i=1,...,S;所述启发函数即车道边界曲线置信度F[Bi(t)]的计算方法为
其中Λ表示车道边界曲线的邻域,其半径的取值范围为[4,20],具体地邻域半径为10,μW、为常数,其取值范围分别为 具体地μW=1.3、 D(cedge,redge)表示边缘点(cedge,redge)到车道边界曲线的距离,其计算方法为
其中
其中
步骤3.3:将迭代计数器t加1;
步骤3.4:蚁群局域搜索,根据蚂蚁所在区域Ui(t)按高斯分布
随机产生新的路径其中i=0,...,S、n=1,...,5,将新路径Bi(t)与Ui(t)子区间的边界值相比较,若超出子区间边界则更新蚂蚁所在的子区间Ui(t),若超出搜索空间边界值则将Bi(t)设为相应边界值,计算启发函数值F[Bi(t)],其中i=1,...,S,再更新启发函数历史最大值Fmax(t)=max{Fmax(t-1),F[Bi(t)]|i=1,...,S}、Fmax(t)对应的最优路径Bmax(t)和子区间Umax(t)、当前蚁群的启发函数最小值Fmin(t)=min{F[Bi(t)]|i=1,...,S},并计算更新当前蚁群的启发函数平均值
步骤3.5:更新信息素表,初始化信息素增量Δτnm(t)=0,其中n=1,...,5、m=1,...,M,计算当前蚂蚁留下的信息素
其中i=1,...,S、n=1,...,5,更新信息素增量和信息素残留τnm(t)=(1-ρ)τnm(t-1)+Δτnm(t),其中n=1,...,5、m=1,...,M;然后将蚂蚁的启发函数值F[Bi(t)]与相比较,若 则更新 若 则更新 其中i=1,...,S、n=1,...,5;
步骤3.6:将迭代次数t和最大迭代次数Itermax相比较,若t>Itermax,则跳转到步骤3.8,若t≤Itermax,则执行下一步骤3.7;
步骤3.7:蚁群全局搜索,计算蚂蚁的期望信息 和蚂蚁选择路径的选择概率 其中i=1,...,S、n=1,...,5、m=1,...,M,分别对每只蚂蚁产生(0,1)均值分布上的随机数Rand,更新蚂蚁的路径子区间
其中i=1,...,S、n=1,...,5,然后跳转到步骤3.3;
步骤3.8:输出车道边界曲线,根据最优路径Bmax(t)以及车道边界投影模型,在图像上画出检测到的车道左、右边界曲线
步骤4:计算车道平面线形参数值和主车方位,计算主车所在处的车道曲率
和主车前方车道曲率的变化率
其中Q1=dy sin 2α、 计算主车在车道中的偏向角
和车辆偏离车道中心线的距离
车辆安装本发明方法的实施例装置后,启动本发明实施例装置即进入工作状态。如前所述,本发明的一种车道边界和主车方位检测方法设置了摄像机的最佳俯仰角、滚动角和高度,简化了车道边界投影模型、像素点梯度幅值计算以及边缘点到车道边界曲线距离的计算,利用改进的连续域蚁群优化,可以快速有效搜索定位车道边界,有效减小阴影、车辆、光线对车道边界检测的影响,并能够测算出主车在车道中的偏向角和位置,可应用于智能车辆的预警和控制系统。
Claims (1)
1.一种车道边界和主车方位检测方法,其特征在于包括下述步骤:
步骤1:将摄像机架设于车辆顶部中轴线前端位置,摄像机光轴与车辆中轴线位于同一垂直面,定义摄像机的俯仰角α向下为正、面向摄像机前方滚动角γ顺时针方向为正,设置摄像机的俯仰角α=arctan(rOdy/fc)、摄像机的滚动角γ=0、摄像机距离路面的高度其中fc为摄像机焦距,dx、dy分别为摄像机拍摄的图像像素点在水平和垂直方向上的物理尺寸,cO和rO分别为图像中心点的像素横坐标和纵坐标,Wlane为车道宽度;
步骤2:根据摄像机拍摄的车道图像像素梯度幅值自适应设置边缘阈值,并提取边缘点、计算边缘点方向,包括以下步骤:
步骤2.1:计算车道图像除第一行、最后一行、第一列、最后一列像素点外的其它各个像素点水平方向和垂直方向上的梯度幅值
Gx(c,r)=f(c+1,r-1)+2f(c+1,r)+f(c+1,r+1)
-f(c-1,r-1)-2f(c-1,r)-f(c-1,r+1)
Gy(c,r)=f(c-1,r+1)+2f(c,r+1)+f(c+1,r+1)
-f(c-1,r-1)-2f(c,r-1)-f(c+1,r-1)
其中c、r分别表示像素点的横坐标和纵坐标,Gx(c,r)、Gy(c,r)分别表示像素点(c,r)水平方向和垂直方向的梯度幅值,f(c,r)表示像素点(c,r)的像素值,然后计算车道图像像素点的梯度幅值Gm(c,r)=|Gx(c,r)|+|Gy(c,r)|;
步骤2.3:将图像像素点(c,r)的梯度幅值Gm(c,r)与梯度阈值Gmth相比较,其中c=1,2,...,W-2,r=1,2,...,H-2,若Gm(c,r)≥Gmth,则将该像素点标记为边缘像素点,若Gm(c,r)<Gmth,则将该像素点标记为非边缘像素点,然后计算边缘像素点的边缘方向θ(cedge,redge)=arctan[Gy(cedge,redge)/Gx(cedge,redge)],其中cedge、redge分别表示边缘像素点的横坐标和纵坐标;
步骤3:根据车道边界投影模型、边缘点及其方向利用蚁群优化搜索定位车道边界,包括以下步骤:
步骤3.1:设置车道模型,将车道左、右边界线的投影曲线方程设置为
其中rlane表示车道边界曲线上像素点的纵坐标,clane,L和clane,R分别表示车道左、右边界曲线上像素点的横坐标,B1、B2、B3、B4、B5为车道边界投影曲线的参数,并定义B=(B1,B2,B3,B4,B5)T为车道边界投影模型参数向量,其取值范围为(-5,0,0,-2000,-3000)T<B<(0,5,300,2000,3000)T;
步骤3.2:蚁群搜索初始化,初始化迭代计数器t=0、最大迭代次数Itermax,其取值范围为10≤Itermax≤200,并将搜索空间Bmin<B<Bmax的每一维空间平均划分为M个子区间,分别标记为1,...,M,M的取值范围为5≤M≤200,其中
Bmin=(B1,min,B2,min,B3,min,B4,min,B5,min)=(-5,0,0,-2000,-3000)T
Bmax=(B1,max,B2,max,B3,max,B4,max,B5,max)=(0,5,300,2000,3000)T
子区间的半径为
子区间的边界值为2(m-1)Ωn和2mΩn,其中m=1,...,M,n=1,...,5,对应于搜索空间的每一维子空间建立记录表[τnm(t),Δτnm(t),Fnm,max(t),Bnm,max(t)],其中t表示迭代次数,τnm(t)表示第n维第m子区间蚂蚁信息素的残留,Δτnm(t)表示当前第n维第m子区间的信息素增量即所有当前蚂蚁在第n维第m子区间留下的信息素,Fnm,max(t)表示对应子区间的历史最大启发函数值即车道边界曲线置信度,Bnm,max(t)表示相应的路径即车道边界投影模型参数值,初始化τnm(t),其取值范围为0.1≤τnm(t)≤30,初始化Δτnm(t)=0,Bnm,max(t)=(2m-1)Ωn,Fnm,max(t)=0,其中n=1,...,5、m=1,...,M,并初始化信息素挥发系数ρ,其取值范围为0<ρ<1;初始化蚁群规模即蚂蚁数量S,其取值范围为5≤S≤200且S≤M;定义 分别表示第i只蚂蚁经过的子区间、路径即车道模型参数向量值,定义表示期望信息即第i只蚂蚁选择第n维第m子区间的期望值,初始化蚂蚁经过的路径Bi(t)=[B1i,max(t),...,B5i,max(t)]、子区间Ui(t)=(i,i,i,i,i)、期望信息其中i=1,...,S、n=1,...,5、m=1,...,M;然后计算启发函数值即车道边界曲线置信度F[Bi(t)],更新Fni,max(t)=F[Bi(t)],其中n=1,...,5,并比较所有蚂蚁的启发函数值,进而初始化蚁群启发函数的历史最小值Fmin(t)=min{F[Bi(t)]|i=1,...,S}、历史最大值Fmax(t)=max{F[Bi(t)]|i=1,...,S}、对应历史最大值的最优路径Bmax(t)及其子区间Umax(t),并计算当前蚁群启发函数值的平均值初始设定局域搜索的正态分布标准差σ=(σ1,...,σ5)的值、蚂蚁选择概率的信息启发式因子α和期望启发式因子β的值,其取值范围分别为0.2Ω≤σ≤3Ω、0<α≤5、0<β≤5;进一步初始设置Ui(t+1)=Ui(t),其中i=1,...,S;所述启发函数即车道边界曲线置信度F[Bi(t)]的计算方法为
其中
其中
步骤3.3:将迭代计数器t加1;
步骤3.4:蚁群局域搜索,根据蚂蚁所在区域Ui(t)按高斯分布
随机产生新的路径其中i=1,...,S、n=1,...,5,将新路径Bi(t)与Ui(t)子区间的边界值相比较,若超出子区间边界则更新蚂蚁所在的子区间Ui(t),若超出搜索空间边界值则将Bi(t)设为相应边界值,计算启发函数值F[Bi(t)],其中i=1,...,S,再更新启发函数历史最大值Fmax(t)=max{Fmax(t-1),F[Bi(t)]|i=1,...,S}、Fmax(t)对应的最优路径Bmax(t)和子区间Umax(t)、当前蚁群的启发函数最小值Fmin(t)=min{F[Bi(t)]|i=1,...,S},并计算更新当前蚁群的启发函数平均值
步骤3.5:更新信息素表,初始化信息素增量Δτnm(t)=0,其中n=1,...,5、m=1,...,M,计算当前蚂蚁留下的信息素
其中i=1,...,S、n=1,...,5,更新信息素增量和信息素残留τnm(t)=(1-ρ)τnm(t-1)+Δτnm(t),其中n=1,...,5、m=1,...,M;然后将蚂蚁的启发函数值F[Bi(t)]与相比较,若 则更新 若 则更新 其中i=1,...,S、n=1,...,5;
步骤3.6:将迭代次数t和最大迭代次数Itermax相比较,若t>Itermax,则跳转到步骤3.8,若t≤Itermax,则执行下一步骤3.7;
步骤3.7:蚁群全局搜索,计算蚂蚁的期望信息 和蚂蚁选择路径的选择概率 其中i=1,...,S、n=1,...,5、m=1,...,M,分别对每只蚂蚁产生(0,1)均值分布上的随机数Rand,更新蚂蚁的路径子区间
其中i=1,...,S、n=1,...,5,然后跳转到步骤3.3;
步骤3.8:输出车道边界曲线,根据最优路径Bmax(t)以及车道边界投影模型,在图像上画出检测到的车道左、右边界曲线
步骤4:计算车道平面线形参数值和主车方位,计算主车所在点处的车道曲率
和主车前方车道曲率的变化率
其中Q1=dy sin 2α、 计算主车在车道中的偏向角
和车辆偏离车道中心线的距离
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110284993.6A CN102509067B (zh) | 2011-09-22 | 2011-09-22 | 一种车道边界和主车方位检测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110284993.6A CN102509067B (zh) | 2011-09-22 | 2011-09-22 | 一种车道边界和主车方位检测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102509067A true CN102509067A (zh) | 2012-06-20 |
CN102509067B CN102509067B (zh) | 2014-04-02 |
Family
ID=46221148
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110284993.6A Expired - Fee Related CN102509067B (zh) | 2011-09-22 | 2011-09-22 | 一种车道边界和主车方位检测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102509067B (zh) |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103206957A (zh) * | 2012-12-26 | 2013-07-17 | 辽宁师范大学 | 车辆自主导航的车道线检测与跟踪方法 |
CN103577828A (zh) * | 2013-11-22 | 2014-02-12 | 中国科学院自动化研究所 | 一种基于边缘特征的道路检测方法 |
CN104077756B (zh) * | 2014-07-16 | 2017-02-08 | 中电海康集团有限公司 | 一种基于车道线置信度的方向滤波方法 |
CN106920245A (zh) * | 2017-03-13 | 2017-07-04 | 深圳怡化电脑股份有限公司 | 一种边界检测的方法及装置 |
CN108351218A (zh) * | 2015-11-25 | 2018-07-31 | 大众汽车有限公司 | 用于生成数字地图的方法和系统 |
CN108629227A (zh) * | 2017-03-15 | 2018-10-09 | 纵目科技(上海)股份有限公司 | 在图像中确定车辆左右边界的方法及系统 |
CN108647713A (zh) * | 2018-05-07 | 2018-10-12 | 宁波华仪宁创智能科技有限公司 | 胚胎边界识别与激光轨迹拟合方法 |
CN108664016A (zh) * | 2017-03-31 | 2018-10-16 | 腾讯科技(深圳)有限公司 | 确定车道中心线的方法及装置 |
CN109584563A (zh) * | 2018-12-24 | 2019-04-05 | 重庆交通大学 | 一种基于韦布尔分布的城市快速路路段通行能力可靠性分布分析方法 |
CN109814543A (zh) * | 2017-11-22 | 2019-05-28 | 通用汽车环球科技运作有限责任公司 | 道路廊道 |
CN109886122A (zh) * | 2019-01-23 | 2019-06-14 | 珠海市杰理科技股份有限公司 | 车道线检测方法、装置、计算机设备和存储介质 |
CN111462491A (zh) * | 2019-12-10 | 2020-07-28 | 北京航空航天大学 | 一种基于匝道控制的高速公路合流区交通冲突预警方法 |
CN113223312A (zh) * | 2021-04-29 | 2021-08-06 | 重庆长安汽车股份有限公司 | 一种基于地图的摄像头致盲预测方法、装置及存储介质 |
CN113723282A (zh) * | 2021-08-30 | 2021-11-30 | 上海商汤临港智能科技有限公司 | 车辆行驶提示方法、装置、电子设备以及存储介质 |
US20210403008A1 (en) * | 2020-06-29 | 2021-12-30 | Dr. Ing. H.C. F. Porsche Aktiengesellschaft | Method and system for predicting a trajectory of a target vehicle in an environment of a vehicle |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1284899A1 (en) * | 2000-05-30 | 2003-02-26 | Aeroforce Llc | Rectractable air turbulence device for vehicles |
EP0827127B1 (en) * | 1996-08-28 | 2006-10-04 | Matsushita Electric Industrial Co., Ltd. | Local positioning apparatus, and method therefor |
CN101006464A (zh) * | 2004-06-02 | 2007-07-25 | 丰田自动车株式会社 | 图表化装置 |
CN101710448A (zh) * | 2009-12-29 | 2010-05-19 | 浙江工业大学 | 基于全方位计算机视觉的道路交通状态检测装置 |
-
2011
- 2011-09-22 CN CN201110284993.6A patent/CN102509067B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0827127B1 (en) * | 1996-08-28 | 2006-10-04 | Matsushita Electric Industrial Co., Ltd. | Local positioning apparatus, and method therefor |
EP1284899A1 (en) * | 2000-05-30 | 2003-02-26 | Aeroforce Llc | Rectractable air turbulence device for vehicles |
CN101006464A (zh) * | 2004-06-02 | 2007-07-25 | 丰田自动车株式会社 | 图表化装置 |
CN101710448A (zh) * | 2009-12-29 | 2010-05-19 | 浙江工业大学 | 基于全方位计算机视觉的道路交通状态检测装置 |
Non-Patent Citations (1)
Title |
---|
卢卫娜,史忠科: "基于单目视觉的车道线盒道路边界同步检测", 《传感技术学报》 * |
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103206957B (zh) * | 2012-12-26 | 2016-03-02 | 辽宁师范大学 | 车辆自主导航的车道线检测与跟踪方法 |
CN103206957A (zh) * | 2012-12-26 | 2013-07-17 | 辽宁师范大学 | 车辆自主导航的车道线检测与跟踪方法 |
CN103577828A (zh) * | 2013-11-22 | 2014-02-12 | 中国科学院自动化研究所 | 一种基于边缘特征的道路检测方法 |
CN103577828B (zh) * | 2013-11-22 | 2018-02-13 | 极限元(北京)智能科技股份有限公司 | 一种基于边缘特征的道路检测方法 |
CN104077756B (zh) * | 2014-07-16 | 2017-02-08 | 中电海康集团有限公司 | 一种基于车道线置信度的方向滤波方法 |
CN108351218A (zh) * | 2015-11-25 | 2018-07-31 | 大众汽车有限公司 | 用于生成数字地图的方法和系统 |
CN108351218B (zh) * | 2015-11-25 | 2022-04-08 | 大众汽车有限公司 | 用于生成数字地图的方法和系统 |
CN106920245B (zh) * | 2017-03-13 | 2020-01-14 | 深圳怡化电脑股份有限公司 | 一种边界检测的方法及装置 |
CN106920245A (zh) * | 2017-03-13 | 2017-07-04 | 深圳怡化电脑股份有限公司 | 一种边界检测的方法及装置 |
CN108629227B (zh) * | 2017-03-15 | 2021-04-06 | 纵目科技(上海)股份有限公司 | 在图像中确定车辆左右边界的方法及系统 |
CN108629227A (zh) * | 2017-03-15 | 2018-10-09 | 纵目科技(上海)股份有限公司 | 在图像中确定车辆左右边界的方法及系统 |
CN108664016A (zh) * | 2017-03-31 | 2018-10-16 | 腾讯科技(深圳)有限公司 | 确定车道中心线的方法及装置 |
CN108664016B (zh) * | 2017-03-31 | 2020-09-15 | 腾讯科技(深圳)有限公司 | 确定车道中心线的方法及装置 |
CN109814543A (zh) * | 2017-11-22 | 2019-05-28 | 通用汽车环球科技运作有限责任公司 | 道路廊道 |
CN108647713B (zh) * | 2018-05-07 | 2021-04-02 | 宁波华仪宁创智能科技有限公司 | 胚胎边界识别与激光轨迹拟合方法 |
CN108647713A (zh) * | 2018-05-07 | 2018-10-12 | 宁波华仪宁创智能科技有限公司 | 胚胎边界识别与激光轨迹拟合方法 |
CN109584563B (zh) * | 2018-12-24 | 2021-03-12 | 重庆交通大学 | 一种基于韦布尔分布的城市快速路路段通行能力可靠性分布分析方法 |
CN109584563A (zh) * | 2018-12-24 | 2019-04-05 | 重庆交通大学 | 一种基于韦布尔分布的城市快速路路段通行能力可靠性分布分析方法 |
CN109886122A (zh) * | 2019-01-23 | 2019-06-14 | 珠海市杰理科技股份有限公司 | 车道线检测方法、装置、计算机设备和存储介质 |
CN111462491A (zh) * | 2019-12-10 | 2020-07-28 | 北京航空航天大学 | 一种基于匝道控制的高速公路合流区交通冲突预警方法 |
CN111462491B (zh) * | 2019-12-10 | 2022-03-01 | 北京航空航天大学 | 一种基于匝道控制的高速公路合流区交通冲突预警方法 |
US20210403008A1 (en) * | 2020-06-29 | 2021-12-30 | Dr. Ing. H.C. F. Porsche Aktiengesellschaft | Method and system for predicting a trajectory of a target vehicle in an environment of a vehicle |
CN113223312A (zh) * | 2021-04-29 | 2021-08-06 | 重庆长安汽车股份有限公司 | 一种基于地图的摄像头致盲预测方法、装置及存储介质 |
CN113723282A (zh) * | 2021-08-30 | 2021-11-30 | 上海商汤临港智能科技有限公司 | 车辆行驶提示方法、装置、电子设备以及存储介质 |
CN113723282B (zh) * | 2021-08-30 | 2024-03-22 | 上海商汤临港智能科技有限公司 | 车辆行驶提示方法、装置、电子设备以及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN102509067B (zh) | 2014-04-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102509067B (zh) | 一种车道边界和主车方位检测方法 | |
EP3885794A1 (en) | Track and road obstacle detecting method | |
US11085774B2 (en) | System and method of matching of road data objects for generating and updating a precision road database | |
WO2018177026A1 (zh) | 确定道路边沿的装置和方法 | |
US20150332101A1 (en) | Lane boundary line recognition apparatus and program for recognizing lane boundary line on roadway | |
WO2021041402A1 (en) | Systems and methods for vehicle navigation | |
US20180239032A1 (en) | System and method for precision vehicle positioning | |
US20220035378A1 (en) | Image segmentation | |
Wang et al. | Automatic road extraction from mobile laser scanning data | |
CN108227707B (zh) | 基于激光雷达和端到端深度学习方法的自动驾驶方法 | |
JP6171612B2 (ja) | 仮想レーン生成装置及びプログラム | |
KR102456626B1 (ko) | 자율 주행 차량의 차선 인지 방법 및 장치 | |
CN103425764B (zh) | 一种基于视频的车辆匹配方法 | |
CN102867414A (zh) | 一种基于ptz摄像机快速标定的车辆排队长度测量方法 | |
US20220197301A1 (en) | Vehicle Localization Based on Radar Detections | |
CN109241855B (zh) | 基于立体视觉的智能车辆可行驶区域探测方法 | |
CN114808649B (zh) | 基于视觉系统控制的公路划线方法 | |
CN115953912A (zh) | 一种基于边缘计算的车路感知设备和方法 | |
CN115938108A (zh) | 一种基于v2x的智能交通控制系统 | |
CN111506069A (zh) | 一种全天候全地面起重机障碍识别系统及方法 | |
CN202911633U (zh) | 基于多信息融合的混合动力车车道标识线动态检测装置 | |
JP5677281B2 (ja) | 車両検知装置 | |
CN110893845A (zh) | 用于对角车道检测的方法与装置 | |
JP2013134609A (ja) | 縁石検出装置及びプログラム | |
CN103824082A (zh) | 一种行人检测方法及其检测系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20140402 Termination date: 20150922 |
|
EXPY | Termination of patent right or utility model |