一种基于单目视觉的自动驾驶汽车换道控制方法
【技术领域】
[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年 Milanes, Vicente 的''Intelligent automatic overtaking system using vision for vehicle detection"，其换道控制过程也采用了前面提到的基于车辆姿态参数进行控制。 这些换道控制策略均可实现安全平稳换道，但它的实现不仅需要车载摄像头，而且还要加 装高精度GPS、加速度传感器、车速传感器等高精密仪器。
【发明内容】
[0006] 针对现有换道控制技术无法进行实时反馈或需要依赖于大量高精度传感器为基 础的问题，以及现有换道控制策略依据的是利用车辆姿态参数来计算车辆在两车道的位 置，因此误差较大且实时性差的问题，本发明提供了一种基于单目视觉的自动驾驶汽车换 道控制方法，换道控制策略基于换道参照角一个参数，且仅使用任何智能车都具有的车载 摄像头即可实现。
[0007] 本发明提供的基于单目视觉的自动驾驶汽车换道控制方法，实现过程为：在自动 驾驶汽车的车顶安装摄像头，用于采集车道线图像；通过图像处理模块对车道线图像处理 和识别得到拟合的车道线；上位机模块根据拟合的车道线计算出方向盘转角增量，输出电 机控制信号给执行单元。
[0008] 其中，上位机模块计算方向盘转角增量的方法是：
[0009] 首先，定义车辆换道参照角，具体是：在摄像头视野内，存在左右两个换道参照角， 分别是车辆所在车道的左侧车道线和右侧车道线同该车道中线的夹角。
[0010] 其次，提供基于换道参照角的换道最优轨迹模型，如下：
[0012] 其中，Θ (t)为换道参照角随时间t变化的函数；Θ _为换道参照角最大值；τ为 时间变化因子；Ld为车辆换道过程产生的纵向位移；V d为车辆换道过程的车速；△ Ρ为换 道偏离度。
[0013] 则通过预瞄控制理论得出方向盘转角增量，如下：
[0015] 其中，β为车辆弥补误差所需要的参照角加速度，Δ δ sw为方向盘转角增量；T为 设定的预瞄时刻，Θ (t+T)为由换道最优轨迹模型得到I\=t+T时刻的期望换道参照角，Θ 为当前获取的换道参照角，i为转向系传动比，L为轴距，V为车辆速度，k为车辆的横向位 移同换道参照角之间线性关系的比例系数。
[0016] 自动驾驶汽车在换道时，分为三个阶段：
[0017] 第一阶段：车辆启动换道模式，确定当前的换道参照角Θ ;若为左换道则当前的 换道参照角为当前车道的左换道参照角，若为右换道则当前的换道参照角为当前车道的 右换道参照角；实时获得当前的换道参照角Θ，根据换道最优轨迹模型确定方向盘转角增 量，对车辆方向盘进行控制；当Θ小于设定的阈值时进入第二阶段；
[0018] 第二阶段：车辆方向盘继续跟随Θ进行控制，当Θ值为〇时，转换当前的换道参 照角；若为左换道则转换当前的换道参照角为目标车道的右换道参照角；若为右换道则转 换当前的换道参照角为目标车道的左换道参照角；
[0019] 第三阶段：实时获取目标车道的左换道参照角0Un和右换道参照角θ Rn，根据换 道最优轨迹模型确定方向盘转角增量，对车辆方向盘进行控制，使得车辆继续向左侧车道 移动；当满足11 Θ^Ι-Ι 0RllJ I < λ时，换道结束，λ为设定的车辆偏离阈值。
[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是本发明自动驾驶汽车拟合的车道线及换道参照角示意图，其中车道线拟合 线同车辆感兴趣区域（R0I)交点为A、B、C、D。AB和CD为拟合的车道线，车辆感兴趣区域 根据摄像头视野设定，本发明实施例中自动驾驶系统所用车载摄像头分辨率为320*240，单 位是像素。则在图像处理过程中制定如图中所示的坐标系，其中左上方为零点，X轴取值范 围为0-320,方向水平向右；Y轴取值范围为0-240,方向垂直向下；如图2中的矩形框所示， 该矩形框为本发明实施例的车辆感兴趣区域。
[0037] 定义：设拟合的车道线即分道线，同R0I的交点坐标上端点为〇w，yj、下端点为 (xdr，ydr)，贝赚关系式⑴，角度"尔为换道参照角。
[0039] 在摄像头视野中，存在左右两个换道参照角，如图2所示，θρ θκ*别为车辆左侧 车道线同车道中线的夹角一一左换道参照角和车辆右侧车道线同车道中线的夹角一一右 换道参照角，当车辆进行左换道时Θ取左换道参照角即θ = θυ车辆进行右换道时Θ取