CN105329238B - 一种基于单目视觉的自动驾驶汽车换道控制方法 - Google Patents

一种基于单目视觉的自动驾驶汽车换道控制方法 Download PDF

Info

Publication number
CN105329238B
CN105329238B CN201510883479.2A CN201510883479A CN105329238B CN 105329238 B CN105329238 B CN 105329238B CN 201510883479 A CN201510883479 A CN 201510883479A CN 105329238 B CN105329238 B CN 105329238B
Authority
CN
China
Prior art keywords
lane
change
angle
vehicle
steering wheel
Prior art date
Application number
CN201510883479.2A
Other languages
English (en)
Other versions
CN105329238A (zh
Inventor
王云鹏
周彬
余贵珍
于海洋
吴家轩
Original Assignee
北京航空航天大学
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 北京航空航天大学 filed Critical 北京航空航天大学
Priority to CN201510883479.2A priority Critical patent/CN105329238B/zh
Publication of CN105329238A publication Critical patent/CN105329238A/zh
Application granted granted Critical
Publication of CN105329238B publication Critical patent/CN105329238B/zh

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18163Lane change; Overtaking manoeuvres
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/20Conjoint control of vehicle sub-units of different type or different function including control of steering systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D15/00Steering not otherwise provided for
    • B62D15/02Steering position indicators ; Steering position determination; Steering aids
    • B62D15/025Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
    • B62D15/0255Automatic changing of lane, e.g. for passing another vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/12Lateral speed
    • B60W2520/125Lateral acceleration
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/18Steering angle

Abstract

本发明提供了一种基于单目视觉的自动驾驶汽车换道控制方法,属于汽车电子控制技术领域。本方法在自动驾驶汽车的车顶安装摄像头,用于采集车道线图像;通过图像处理模块对车道线图像处理和识别得到拟合的车道线;通过上位机模块计算出方向盘转角增量,输出电机控制信号给执行单元。本方法定义了换道参照角,提供了基于换道参照角的换道最优轨迹模型,通过预瞄控制理论得出方向盘转角增量,对车辆方向盘进行控制,换道参照角根据需要选取左换道参照角或右换道参照角。本发明仅使用用于路径识别的摄像头即可实现换道闭环控制,换道过程稳定可靠,并且降低了成本,减少了系统的复杂程度。

Description

一种基于单目视觉的自动驾驶汽车换道控制方法
技术领域
[0001] 本发明涉及汽车电子控制技术,特别是涉及一种基于单目视觉使用驾驶机器人的 自动驾驶汽车换道控制方法。
背景技术
[0002] 近年来,中国汽车工业的迅猛发展使得国内汽车数量有着大幅的增长,而汽车在 使用过程中的安全可靠性能日益受到重视,安全可靠的车辆可降低交通事故的伤亡,减少 事故所造成的经济损失。各大汽车厂家在新车上市之前往往要在汽车综合试验场做大量实 车试验,汽车综合试验场可以模拟多种复杂路况,可以对车辆进行动力性能、安全性能以及 耐久性能等各方面的试验。车辆试验最直接的方式是人工驾驶,但人工驾驶受到人为因素 和环境因素的影响,在进行试验时存在很多不足。
[0003] 而自动驾驶系统能够实现对车辆的准确操纵和控制,具有长时间高强度持续工 作、试验效率高、重复性好和测试精度高等优点,能够安全有效地完成各种测试。开发用于 车辆试验的驾驶机器人代替驾驶员,可克服人工驾驶存在的不足,较好满足车辆可靠性和 安全性道路等试验要求。
[0004] 汽车运动的控制是油门、制动及方向盘的综合动作的结果,汽车换道便是由油门、 制动及方向盘综合控制完成的,这些都是汽车控制的基本动作,因此做好自动驾驶汽车的 换道控制研究具有重要意义。
[0005] 目前世界上大部分驾驶机器人能控制方向盘但不具有环境识别能力,其代表主要 有:英国ABD公司研发的无人驾驶车辆测试系统(DTS),DTS系统的转向控制使用的是基于 GPS路径数据;一些文献中也曾提到过运用车辆加速度及速度等车辆姿态参数为基准对智 能车辆换道进行控制如:在2012年Guoqing,Xu的 “Dynamic Modeling of Driver Control Strategy of Lane-Change Behavior and Trajectory Planning for Collision Prediction” 一文提到了动态换道模型,就是居于高精度GPS及车辆姿态进行换道控制;还 有学者曾经提出根据前方车辆类型(车的横向纵向尺寸)为换道基准,如2012年Milan6s, Vicente的“Intelligent automatic overtaking system using vision for vehicle detection”,其换道控制过程也采用了前面提到的基于车辆姿态参数进行控制。这些换道 控制策略均可实现安全平稳换道,但它的实现不仅需要车载摄像头,而且还要加装高精度 GPS、加速度传感器、车速传感器等高精密仪器。
发明内容
[0006] 针对现有换道控制技术无法进行实时反馈或需要依赖于大量高精度传感器为基 础的问题,以及现有换道控制策略依据的是利用车辆姿态参数来计算车辆在两车道的位 置,因此误差较大且实时性差的问题,本发明提供了一种基于单目视觉的自动驾驶汽车换 道控制方法,换道控制策略基于换道参照角一个参数,且仅使用任何智能车都具有的车载 摄像头即可实现。
[0007] 本发明提供的基于单目视觉的自动驾驶汽车换道控制方法,实现过程为:在自动 驾驶汽车的车顶安装摄像头,用于采集车道线图像;通过图像处理模块对车道线图像处理 和识别得到拟合的车道线;上位机模块根据拟合的车道线计算出方向盘转角增量,输出电 机控制信号给执行单元。
[0008] 其中,上位机模块计算方向盘转角增量的方法是:
[0009] 首先,定义车辆换道参照角,具体是:在摄像头视野内,存在左右两个换道参照角, 分别是车辆所在车道的左侧车道线和右侧车道线同该车道中线的夹角。
[0010] 其次,提供基于换道参照角的换道最优轨迹模型,如下:
Figure CN105329238BD00041
[0012]其中,Θ⑴为换道参照角随时间t变化的函数;0max为换道参照角最大值;τ为时间 变化因子;Ld为车辆换道过程产生的纵向位移;Vd为车辆换道过程的车速;A ρ为换道偏离 度。
[0013]则通过预瞄控制理论得出方向盘转角增量,如下:
Figure CN105329238BD00042
[0015]其中,β为车辆弥补误差所需要的参照角加速度,△ Ssw为方向盘转角增量;T为设定 的预瞄时刻,9(t+T)为由换道最优轨迹模型得到Tiit+T时刻的期望换道参照角,Θ为当前 获取的换道参照角,i为转向系传动比,L为轴距,V为车辆速度,k为车辆的横向位移同换道 参照角之间线性关系的比例系数。
[0016] 自动驾驶汽车在换道时,分为三个阶段:
[0017] 第一阶段:车辆启动换道模式,确定当前的换道参照角Θ;若为左换道则当前的换 道参照角为当前车道的左换道参照角,若为右换道则当前的换道参照角为当前车道的右换 道参照角;实时获得当前的换道参照角Θ,根据换道最优轨迹模型确定方向盘转角增量,对 车辆方向盘进行控制;当Θ小于设定的阈值时进入第二阶段;
[0018] 第二阶段:车辆方向盘继续跟随Θ进行控制,当Θ值为〇时,转换当前的换道参照角; 若为左换道则转换当前的换道参照角为目标车道的右换道参照角;若为右换道则转换当前 的换道参照角为目标车道的左换道参照角;
[0019] 第三阶段:实时获取目标车道的左换道参照角右换道参照角0R,m,根据换道 最优轨迹模型确定方向盘转角增量,对车辆方向盘进行控制,使得车辆继续向左侧车道移 动;当满足
Figure CN105329238BD00043
时,换道结束,λ为设定的车辆偏离阈值。
[0020] 本发明基于单目摄像头获取车道线信息,运用提出的车辆换道参照角判断车身在 换道过程中所处的位置,根据预瞄跟随基本理论给出车辆方向盘控制量,从而完成自动驾 驶汽车换道的方法。本发明的优点与积极效果在于:
[0021] (1)本发明基于单目视觉驾驶机器人的自动驾驶汽车换道控制方法可以实时获取 车道线的信息,根据换道参照角判断车身在换道过程中所处的位置,可实现换道的闭环控 制,使自动驾驶汽车的换道过程稳定可靠。
[0022] (2)本发明方法在整个换道过程无需借助转角传感器、加速度传感器及高精度GPS 等,仅使用用于路径识别的摄像头即可实现换道闭环控制,降低成本,减少了系统的复杂程 度。
[0023] (3)本发明方法在换道过程中运用新提出的换道标志一一换道参照角作为换道依 据,简化了换道控制过程,使得整个控制方法简单可行。
[0024] (4)本发明方法中提出了一个基于换道参照角的换道轨迹模型,该模型源于真人 驾驶员的驾驶经验,在换道应用上更加拟人化,更加符合真实换道操作。
[0025] (5)本发明在换道控制上运用驾驶员预瞄原理,结合换道轨迹对车辆进行精确控 制。
附图说明
[0026] 图1是本发明自动驾驶汽车驾驶机器人的结构框图;
[0027] 图2是拟合的车道线及换道参照角示意图;
[0028] 图3是自动驾驶车辆一次左换道其参照角变化情况图;(a)为车辆未进行换道前; (b)为车辆开始进行左换道;(C)为车辆处于分界线正上方时;(d)为车辆进入目标车道后;
[0029] 图4是自动驾驶车辆左换道所获取参照角变化情况;
[0030] 图5是本发明自动驾驶车辆换道控制流程示意图。
具体实施方式
[0031] 下面将结合附图和实施例对本发明作进一步的详细说明。
[0032] 本发明自动驾驶汽车的换道控制方法参考人工驾驶汽车换道的方法。驾驶员驾驶 汽车进行换道时,眼睛主要注视车辆前方的本车道同目标车道。其中两条车道的分界线(一 条车道线)是换道过程中的一个重要参照。车辆的换道过程主要分为靠近分界线、骑压分界 线及远离分界线并进行姿态调整三个阶段,在这三个阶段中分界线的斜率会随车辆的位置 变化,呈现一定的变化规律。因此自动驾驶汽车通过单目摄像头识别车道线信息,根据换道 参照角的变化规律建立换道最优轨迹模型,并结合预瞄跟随基本理论,给出方向盘及油门、 制动踏板控制机构的控制目标量,从而实现自动驾驶车辆自动换道控制。
[0033] 本发明中自动驾驶汽车依靠单目摄像头感知道路环境信息,通过驾驶机器人实现 对车辆的操纵控制,依靠以工控机为主的控制单元建立环境感知端与执行机构端之间的联 系,通过控制方法实现对自动驾驶汽车的换道控制。
[0034] 图1是本发明自动驾驶汽车驾驶机器人结构框图,包括:一个能够对道路车道线信 息进行采集的摄像头,摄像头安装在车顶;一个对摄像头采集到的车道线图像进行算法分 析和处理的图像处理模块,一个接收车道线信息处理结果并给出电机控制信号的上位机模 块;根据上位机输出的电机控制信号执行方向盘及油门、制动踏板动作的执行单元。所使用 的摄像头安装于后视镜处的车顶上方,为驾驶机器人提供车道线信息。
[0035] 摄像头安装在车顶正中靠近挡风玻璃的位置,以确保车辆循线时能够行驶在车道 的正中位置。摄像头获取车辆前方道路图像,通过运用OpenCV获取车道线信息,得出换道参 照角,运用预瞄跟随理论结合换道轨迹得出换道参照角偏移量,该角度值会作为换道控制 输入,经过换道控制算法计算出当前车辆需要转动的方向盘增量,通过控制转向电机实现 对车辆前进方向的控制。
[0036] 图2是本发明自动驾驶汽车拟合的车道线及换道参照角示意图,其中车道线拟合 线同车辆感兴趣区域(ROI)交点为A、B、C、D 和CD为拟合的车道线,车辆感兴趣区域根据 摄像头视野设定,本发明实施例中自动驾驶系统所用车载摄像头分辨率为320*240,单位是 像素。则在图像处理过程中制定如图中所示的坐标系,其中左上方为零点,X轴取值范围为 0-320,方向水平向右;Y轴取值范围为0-240,方向垂直向下;如图2中的矩形框所示,该矩形 框为本发明实施例的车辆感兴趣区域。
[0037] 定义:设拟合的车道线即分道线,同ROI的交点坐标上端点为(xur,yur)、下端点为 (XdrJdr),则存在关系式(1),角度Θ称为换道参照角。
Figure CN105329238BD00061
[0039] 在摄像头视野中,存在左右两个换道参照角,如图2所示,0L、0R分别为车辆左侧车 道线同车道中线的夹角一一左换道参照角和车辆右侧车道线同车道中线的夹角一一右换 道参照角,当车辆进行左换道时Θ取左换道参照角即Θ = 车辆进行右换道时Θ取右换道参 照角即0 = 0R,通过反三角函数公式容易得到车辆换道参照角的数值如下式:
Figure CN105329238BD00062
[0041] 式中:点A(xa,ya)、B(xb,yb)分别为拟合的左侧车道线同ROI相交的上下两端点坐 标;
[0042] 点(^。,以^⑷^彡分别为拟合的右侧车道线同如^目交的上下两端点坐标;
[0043] 且定义0L彡〇和0R<〇。
[0044] 图3是自动驾驶车辆一次左换道其参照角变化情况图。整个换道过程可分为三个 阶段。图3中(a)为车辆未进行换道前,此时自动驾驶车辆行驶在当前车道中央
Figure CN105329238BD00063
Figure CN105329238BD00064
。进行换道决策后车辆开始远离当前车道并向左侧移动,开始减小,如图3的(b),此时为 第一个阶段。换道过程中当车辆处于两车道分界线正上方时即Sl = O或0R,m = 〇时处于第二 个阶段,换道参照角会出现一次更迭,9R,m为目标车道的右换道参照角,此时换道参照角Θ更 迭为0R,m,即0 = 0R,m,如图3的(c)所示。车辆经过分界线后开始进入目标车道,进入第三个阶 段,并渐渐远离分界线时,
Figure CN105329238BD00065
开始增大,直至在目标车道内
Figure CN105329238BD00066
时,换道结 束。λ为设定的车辆偏离阈值,取值为正数。^为目标车道的左换道参照角。
[0045] 图4为自动驾驶车辆左换道得到的参照角变化情况,图中所示参照角Θ的角度变化
Figure CN105329238BD00067
为(60〜0〜-50)。换道过程中参照角的最大值0max为当车辆行驶在车道正中央时,所固定的 摄像头能获取的最大车道线夹角,Smax与摄像头安装的俯仰角和左右摆角有关系,当摄像头 固定后该角度固定。本发明实施例中最大值Gmax为60度。本发明实施例中,在车辆换道完毕 后参照角处于-50度时,由于已满足条件 ,因此车辆结束换道任务,此时车辆 在当前车道中央靠左行驶。
[0046] 下面说明本发明方法中建立的基于换道参照角的换道最优轨迹模型,以及利用稳 态预瞄基本理论对车辆进行方向控制的原理方法。
[0047] 在自动驾驶环境下,不存在驾驶员反应滞后环节并且车辆在换道过程中转向比较 缓和,这样的汽车运动服从于“Acklman几何关系”,因此车辆方向控制的稳态特性可以运用 线性系统来表示:
Figure CN105329238BD00071
[0049] 式中:Ssw为方向盘转角,y为车辆横向位移,Gay为横向加速度稳态增益,V为车辆速 度,i为转向系传动比,L为轴距。
[0050] 由于车辆在换道过程中,车辆的横向位移同换道参照角Θ之间是一一对应的,可表 示为线性关系9(t) =ky⑴+b,k为比例系数,b为实参数,因此车辆方向盘转角Ssw使用如下 式表达:
Figure CN105329238BD00072
[0052] 其中,
Figure CN105329238BD00073
为换道参照角的二阶导数。
[0053] 本发明根据真人驾驶车辆换道数据,分析得出基于换道参照角的换道最优轨迹模 型:
Figure CN105329238BD00074
[0055] 式中,Θ⑴为车辆换道参照角随时间t变化的函数;9max为换道参照角最大值;τ为 时间变化因子,具体变化值可根据经验设定;Ld为车辆换道过程产生的纵向位移;Vd为车辆 换道过程的车速;A P为换道偏离度。
[0056] 本发明利用稳态预瞄基本理论对车辆进行方向控制,设定预瞄时刻为Τ,Τ主要由 摄像头安装位置及车速决定,可根据经验来设定值。由换道最优轨迹模型得到T1=t+T时刻 的期望换道参照角为Θ (t+T)。摄像头当前获取的换道参照角为Θ,通过预瞄控制理论得出方 向盘需要改变的角度为:
Figure CN105329238BD00075
[0058] 式中:β为车辆弥补误差所需要的参照角加速度;Δ Ssw为方向盘转角增量。
[0059] 下面结合图5说明本发明的基于单目视觉的自动驾驶汽车换道控制方法的实现步 骤。
[0060] 步骤1,首先确定当前要进行的左换道还是右换道,确定当前的换道参照角Θ。如是 左换道则确定当前的换道参照角为当前车道的左换道参照角,若是右换道则确定当前的换 道参照角为当前车道的右换道参照角。
[0061] 左换道和右换道的流程是一样的,下面已左换道为例进行说明。
[0062] 步骤2,实时获得当前的换道参照角Θ,并结合换道最优轨迹模型,确定参照角加速 度β和方向盘转角增量A Ssw,对车辆方向盘进行控制。
[0063] 本发明实施例中,当车辆获得左换道指令后,驾驶机器人会根据当前环境信息给 出换道最优轨迹模型,利用摄像头预瞄作用获取当前左右换道参照角,运用预瞄跟随理论 并计算Ti (Ti = t+T)时刻的期望值Θ (t+T),计算当前车辆需要转动的方向盘增量对车辆方向 盘进行控制。
[0064] 步骤3,判断实时获取的当前换道参照角Θ是否大于〇,若是,继续转步骤2执行,若 否,转步骤4进行。
[0065] 步骤4,将当前的换道参照角进行转换,采用目标车道上的换道参照角。对于左换 道则转换当前的换道参照角为目标车道的右换道参照角。对于右换道则转换当前的换道参 照角为目标车道的左换道参照角。
[0066] 本发明实施例中,
Figure CN105329238BD00081
,车辆换道进入换道第二阶段,此时方向盘转角 继续跟随参照角变小而逐渐向左打,当θ = θ^ = 〇时,换道参照角会进行一次更迭,即在下一 时刻道参照角Θ将采用目标车道的0R,m,此时
Figure CN105329238BD00082
0R,m为负数。
[0067] 步骤5,实时获取目标车道的左换道参照角0L,m和右换道参照角0R,m,结合换道最优 轨迹模型确定参照角加速度β和方向盘转角增量A Ssw,对车辆方向盘进行控制。
[0068] 步骤6,判断当前获取的目标车道的左换道参照角右换道参照角0R,m,是否满 足条件
Figure CN105329238BD00083
如果满足,则说明车辆已正常进入左侧车道并进行了调正,换 道结束,如不满足,则转步骤5继续执行。
[0069] 本发明实例中,驾驶机器人控制中心始终利用预瞄跟随理论对车辆方向盘进行相 应控制,当满足条件:
Figure CN105329238BD00084
,换道进入第三阶段,直到满足车辆跟随模型
Figure CN105329238BD00085
Figure CN105329238BD00086
时,标志着车辆已正常进入左侧车道并进行了调正,换道结束。
[0070] 整个换道过程,驾驶机器人对车辆方向的控制量主要来自于最优换到轨迹的期望 值同当前时刻车辆获取的换道参照角预瞄值的差值对方向盘进行修正调节。其中预瞄T时 刻的换道参照角为摄像头实时获取的参照角,期望值来自于换道初始所形成的换道轨迹。

Claims (3)

1. 一种基于单目视觉的自动驾驶汽车换道控制方法,其特征在于,实现过程如下:在自动驾驶汽车的车顶安装摄像头,用于采集车道线图像;通过图像处理模块对车道线图像处理和识别得到拟合的车道线;上位机模块根据拟合的车道线计算方向盘转角增量,输出电机控制信号给执行单元; 其中,上位机模块计算方向盘转角增量的方法是: 首先,定义车辆换道参照角,具体是:在摄像头视野内,存在左右两个换道参照角,分别是车辆所在车道的左侧车道线和右侧车道线同车辆所在的车道中线的夹角。 其次,提供基于换道参照角的换道最优轨迹模型,如下:
Figure CN105329238BC00021
其中,Θ (t)为换道参照角随时间t变化的函数;Θ m a x为换道参照角最大值;τ为时间变化因子;U为车辆换道过程产生的纵向位移;Vd为车辆换道过程的车速;A ρ为换道偏离度; 则通过预瞄控制理论得出方向盘转角增量,如下:
Figure CN105329238BC00022
其中,β为车辆弥补误差所需要的参照角加速度,ASsw为方向盘转角增量;T为设定的预瞄时刻,9(t+T)为由换道最优轨迹模型得到t+T时刻的期望换道参照角,Θ为当前获取的换道参照角,i为转向系传动比,L为轴距,V为车辆速度,k为车辆的横向位移同换道参照角之间线性关系的比例系数。
2. 根据权利要求1所述的基于单目视觉的自动驾驶汽车换道控制方法,其特征在于,所述的自动驾驶汽车在换道时,包括三个阶段: 第一阶段:车辆启动换道,确定当前的换道参照角Θ;若为左换道则当前的换道参照角为当前车道的左换道参照角,若为右换道则当前的换道参照角为当前车道的右换道参照角;实时获得当前的换道参照角Θ,根据换道最优轨迹模型确定方向盘转角增量,对车辆方向盘进行控制;当Θ小于设定的阈值时进入第二阶段; 第二阶段:车辆方向盘继续跟随Θ进行控制,当Θ值为O时,转换当前的换道参照角;若为左换道则转换当前的换道参照角为目标车道的右换道参照角;若为右换道则转换当前的换道参照角为目标车道的左换道参照角; 第三阶段:实时获取目标车道的左换道参照角右换道参照角0R,m,根据换道最优轨迹模型确定方向盘转角增量,对车辆方向盘进行控制,使得车辆继续向左侧车道移动;当满足
Figure CN105329238BC00023
时,换道结束,λ为设定的车辆偏离阈值。
3. 根据权利要求1所述的基于单目视觉的自动驾驶汽车换道控制方法,其特征在于,所述的左右两个换道参照角,如下获得: 设感兴趣区域与拟合的左侧车道线相交的上下两端点坐标为A(xa,ya)和B(Xb,yb),感兴趣区域与拟合的右侧车道线相交的上下两端点坐标为C(Xc;,y。)和D(Xd,yd); 通过反三角函数公式得到车辆在当前车道的左换道参照角0L和右换道参照角θκ:
Figure CN105329238BC00024
CN201510883479.2A 2015-12-04 2015-12-04 一种基于单目视觉的自动驾驶汽车换道控制方法 CN105329238B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510883479.2A CN105329238B (zh) 2015-12-04 2015-12-04 一种基于单目视觉的自动驾驶汽车换道控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510883479.2A CN105329238B (zh) 2015-12-04 2015-12-04 一种基于单目视觉的自动驾驶汽车换道控制方法

Publications (2)

Publication Number Publication Date
CN105329238A CN105329238A (zh) 2016-02-17
CN105329238B true CN105329238B (zh) 2017-08-08

Family

ID=55280080

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510883479.2A CN105329238B (zh) 2015-12-04 2015-12-04 一种基于单目视觉的自动驾驶汽车换道控制方法

Country Status (1)

Country Link
CN (1) CN105329238B (zh)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106295651B (zh) * 2016-07-25 2019-11-05 浙江零跑科技有限公司 一种基于双俯视相机与后轴转向的车辆路径跟随方法
CN106327433B (zh) * 2016-08-01 2019-03-08 浙江零跑科技有限公司 一种基于单俯视相机与后轴转向的车辆路径跟随方法
JP2018077565A (ja) * 2016-11-07 2018-05-17 本田技研工業株式会社 車両制御装置
CN106843210B (zh) * 2017-01-24 2019-10-18 同济大学 一种基于仿生学的自动驾驶车辆运行控制方法
CN107544496A (zh) * 2017-08-25 2018-01-05 江苏大学 一种改进余弦换道模型的轨迹规划方法
CN107792073B (zh) * 2017-09-29 2019-10-25 东软集团股份有限公司 一种车辆换道控制方法、装置及相关设备
CN109955851B (zh) * 2017-12-21 2020-07-31 财团法人车辆研究测试中心 变换车道决策与轨迹规划方法
CN108891414A (zh) * 2018-05-22 2018-11-27 通化市聚诚网络科技有限公司 一种车道变换辅助方法及装置
CN110712680B (zh) * 2018-07-12 2020-12-25 广州小鹏汽车科技有限公司 一种车辆的自动换道方法及装置
CN110979305A (zh) * 2019-03-18 2020-04-10 长城汽车股份有限公司 车辆异常换道控制方法、装置及系统
CN110481551B (zh) * 2019-08-16 2020-12-29 中国第一汽车股份有限公司 一种自动换道的控制方法、装置及车辆
CN110936958B (zh) * 2019-11-26 2021-01-19 交通运输部公路科学研究所 自动驾驶换道轨迹优化方法及其系统

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101870293B (zh) * 2009-04-24 2013-06-05 南京理工大学 基于切道行为检测的车辆驾驶状态评价方法
DE102011081892A1 (de) * 2011-08-31 2013-02-28 Robert Bosch Gmbh Verfahren zur Fahrspur-Überwachung und Fahrspur-Überwachungssystem für ein Fahrzeug
KR101500070B1 (ko) * 2013-04-15 2015-03-06 현대자동차주식회사 도로경사 추정 시스템
CN203332106U (zh) * 2013-04-17 2013-12-11 上海理工大学 基于单目视觉的汽车预警防撞系统
CN103496366B (zh) * 2013-09-09 2016-02-24 北京航空航天大学 一种基于车车协同的主动换道避撞控制方法与装置
CN104029680B (zh) * 2014-01-02 2016-12-07 上海大学 基于单目摄像头的车道偏离预警系统及方法

Also Published As

Publication number Publication date
CN105329238A (zh) 2016-02-17

Similar Documents

Publication Publication Date Title
US10073462B2 (en) Autonomous vehicle with improved visual detection ability
EP3295422B1 (en) Road profile along a predicted path
US10940889B2 (en) System for a towing vehicle
CN104977933B (zh) 一种自主驾驶车辆的区域型路径跟踪控制方法
US9457807B2 (en) Unified motion planning algorithm for autonomous driving vehicle in obstacle avoidance maneuver
US9902425B2 (en) System for guiding trailer along target route during reversing maneuver
US10046803B2 (en) Vehicle control system
JP6361567B2 (ja) 自動運転車両システム
US20200108834A1 (en) Image-based velocity control for a turning vehicle
CN104217615B (zh) 一种基于车路协同的行人防碰撞系统和方法
DE102012207525B4 (de) System und Verfahren zur verbesserten Detektierung der Ausserkraftsetzung der Lenkung während der automatischen Fahrspurzentrierung
CN105292116B (zh) 自动驾驶车辆的车道变换路径规划算法
KR101553459B1 (ko) 차량을 주차하기 위한 방법 및 장치
CN105015545B (zh) 一种无人驾驶汽车的自主变道决策方法
Xu et al. Dynamic modeling of driver control strategy of lane-change behavior and trajectory planning for collision prediction
US20160084661A1 (en) Performance driving system and method
CN105197010B (zh) 辅助泊车系统以及辅助泊车控制方法
CN104442814B (zh) 基于偏差预测算法的车道保持及自动对中系统和方法
DE102015114465A1 (de) Verfahren zur Wegplanung für ein Ausweichlenkmanöver
CN105813914B (zh) 用于紧急转向支持功能的控制单元和方法
CN104260725B (zh) 一种含有驾驶员模型的智能驾驶系统
US8392104B2 (en) Avoidance maneuver calculation device, avoidance control device, vehicle having each device, avoidance maneuver calculating method, and avoidance controlling method
US20150142207A1 (en) Method and driver assistance device for supporting lane changes or passing maneuvers of a motor vehicle
Chung et al. Design and evaluation of side slip angle-based vehicle stability control scheme on a virtual test track
CN104859650B (zh) 一种多时间尺度的车辆横摆稳定性滚动优化控制方法

Legal Events

Date Code Title Description
PB01 Publication
C06 Publication
SE01 Entry into force of request for substantive examination
C10 Entry into substantive examination
GR01 Patent grant
GR01 Patent grant