本发明专利技术公开了一种基于多点预瞄的车道保持辅助控制方法，具体包括：基于前视摄像头检测车道中心线横向距离；基于横摆角速度、车速预测车辆运行轨迹；根据车速设置多个基准预瞄点，并通过车道线曲率进行修正；建立预瞄点仲裁规则，选取最能表征车辆当前车道偏离情况的点作为最终预瞄点；以最终预瞄点的偏离距离作为误差，设计基于前馈+反馈的横向位置控制器，修正车辆横向位置。该方法一方面基于基于跨道距离判断车道保持辅助介入时机；另一方面通过横摆角速度预测车辆横向运动；并通过选取多个预瞄点设计横向位置控制算法，提高车道保持辅助控制稳定性。助控制稳定性。助控制稳定性。
【技术实现步骤摘要】
一种基于多点预瞄的车道保持辅助控制方法及系统
[0001]本专利技术属于车辆控制领域，具体是涉及一种基于多点预瞄的车道保持辅助控制方法及系统。
技术介绍
[0002]随着汽车保有量的不断提高，交通事故频发，虽然引发事故的原因众多，具体包括车辆故障、交通拥堵和驾驶员操作失误等，但是由于驾驶员分神、疲劳、误操作等自身原因引起的交通事故占绝大部分。据统计，约20％的交通事故是车辆偏离本车道造成的。
[0003]车道偏离预警(Lane Departure Warning，LDW)可以提醒驾驶员车辆有驶出原车道的危险以提高车辆主动安全，降低因车道偏离引发交通事故的概率。车道保持辅助(Lane Keeping Assistance，LKA)不仅可以对驾驶员发出预警，还可以在驾驶员未干预时修正车辆的横向位置使车辆重新回到原行驶车道，进一步提高驾驶安全性。车道保持辅助控制方法对车辆横向位置的修正效果至关重要。
[0004]车道偏离判断是指通过视觉传感器探测车道线，结合车辆位置信息和状态信息得到车辆与车道线的相对位置关系，判断车辆是否会偏离车道。目前应用比较广泛的是基于TLC判断，该方法可以给驾驶员预留一定的反应时间，但是需要精准获取车辆的横向速度，实际应用中发现车辆横向速度存在较大的毛刺，导致误判断、漏判断。
技术实现思路
[0005]本专利技术为了解决上述问题，提出了一种基于多点预瞄的车道保持辅助控制方法，该方法通过选取多个预瞄点预测车辆偏离车道中心线的距离，并以此设计横向位置控制器，修正车辆的横向位置，提高车道保持辅助控制稳定性，具体包括：
[0006]提取车道线参数，得到车道中心线方程；
[0007]获取车辆的横摆角速度和车速，预测车辆运行轨迹，得到车辆运行轨迹方程；
[0008]根据所述车速设置多个基准预瞄点，并通过预瞄时间和车速及车道线曲率对所述基准预瞄点进行修正，得到多个修正后的预瞄点；
[0009]通过车道中心线方程和车辆运行轨迹方程，计算所述多个修正后的预瞄点处的车辆运行轨迹偏离车道中心线的距离，得到所述多个修正后的预瞄点的偏离距离；
[0010]根据预设的仲裁规则，在所述多个修正后的预瞄点中选取最能表征车辆当前车道偏离情况的点作为最终预瞄点；
[0011]以所述最终预瞄点的偏离距离作为误差，修正车辆横向位置。
[0012]优选的，所述提取车道线参数，得到车道中心线方程，具体包括：
[0013]通过前视摄像头提取所述车道线参数，所述车道线参数包括车道线截距、车道线斜率、车道线曲率、车道线曲率变化率；
[0014]通过所述车道线参数对车道线进行曲线拟合，得到车道中心线方程。
[0015]所述车道中心线方程为：
[0016][0017]其中，以摄像头安装位置为坐标原点，预瞄距离为x，A0为车道线截距、A1为车道线斜率、A2为车道线曲率、A3为车道线曲率变化率。
[0018]优选的，所述获取车辆的横摆角速度和车速，预测车辆运行轨迹，得到车道运行轨迹方程，具体包括：
[0019]通过车辆质心处的横摆角传感器，实时检测得到横摆角速度；
[0020]通过所述横摆角速度和车速计算得到车辆转弯半径R；
[0021]通过所述转弯半径R得到车辆运行轨迹方程。
[0022]所述车辆运行轨迹方程为：
[0023]当车辆左转且x∈[0,R]时，y∈[0,R]，车辆轨迹方程为：
[0024][0025]当车辆右转且x∈[0,R]时，y∈[
‑
R,0]，车辆轨迹方程为：
[0026][0027]优选的，所述预瞄点为3个，所述预设的仲裁规，具体为：
[0028]修正后的预瞄点的偏离距离大于零则为“+”，小于零则为
“‑”
；
[0029]当修正后的预瞄点的偏离距离符号为“+++”，且偏离距离的大小呈单调递增或单调递减，则取预瞄距离最大的点作为最终预瞄点，若不单调，则取偏离距离第二的点作为最终预瞄点；
[0030]当修正后的预瞄点的偏离距离符为
“‑‑‑”
，且偏离距离呈单调递增或单调递减，则取预瞄距离最大的点作为最终预瞄点，若不单调，则取偏离距离第二的点作为最终预瞄点；
[0031]当修正后的预瞄点的偏离距离符为“++
‑”
，则取最小的正偏离距离点作为最终预瞄点；
[0032]当修正后的预瞄点的偏离距离符为
“‑‑
+”，则取最大的负偏离距离点作为最终预瞄点；
[0033]当修正后的预瞄点的偏离距离符为“+
‑‑”
，则取最大的负偏离距离点作为最终预瞄点；
[0034]当修正后的预瞄点的偏离距离符为
“‑
++”，则取最小的正偏离距离点作为最终预瞄点；
[0035]当修正后的预瞄点的偏离距离符为“+
‑
+”，则取预瞄距离最小的点作为最终预瞄点；
[0036]当修正后的预瞄点的偏离距离符为
“‑
+
‑”
，则取预瞄距离最小的点作为最终预瞄点。
[0037]所述最终预瞄点的偏离距离的绝对值大阈值，则该偏离距离用于作为误差来修正车辆横向位置。所述阈值为：
[0038][0039]其中，Δy为偏离距离，y
L
为左车道线横向距离，y
R
为右车道线横向距离，D
veh
为车
宽，D
set
为跨道距离。
[0040]所述修正车辆横向位置由基于车道线曲率的前馈控制和基于偏离距离的反馈控制组成。
[0041]一种使用上述方法的车道保持辅助系统，所述系统包括感知层、决策层和执行层，所述感知层包括前视摄像头采集车道线参数，VCU(整车控制器)采集车速信号、横摆角速度信号、档位信号、转向灯信号灯信号，所述决策层将所述感知层传输的车道线参数进行拟合、去抖处理，根据车速、横摆角速度对车辆轨迹进行预测，当发生车道偏离且车辆状态允许车道保持辅助功能介入时，调整方向盘转角并下发给执行层，所述执行层响应所述决策层下发的方向盘转角，调整车辆的横向位置，使车辆维持在当前车道内行驶。
[0042]本专利技术的有益效果为：本专利技术通过选取多个预瞄点，并建立了预瞄点仲裁规则，精准预测车辆偏离车道中心线的横向距离，为横向位置控制输入了较能表征车道偏离情况的误差，提高了车道保持辅助系统稳定性，通过横向位置控制可以实现发生车道偏离时修正车辆的横向位置，使车辆重新回到原车道。
附图说明
[0043]为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图示出的结构获得其他的附图。
[0044]图1为车道保持辅助本文档来自技高网...
【技术保护点】
【技术特征摘要】
1.一种基于多点预瞄的车道保持辅助控制方法，其特征在于，该方法包括：提取车道线参数，得到车道中心线方程；获取车辆的横摆角速度和车速，预测车辆运行轨迹，得到车辆运行轨迹方程；根据所述车速设置多个基准预瞄点，并通过预瞄时间和车速及车道线曲率对所述基准预瞄点进行修正，得到多个修正后的预瞄点；通过车道中心线方程和车辆运行轨迹方程，计算所述多个修正后的预瞄点处的车辆运行轨迹偏离车道中心线的距离，得到所述多个修正后的预瞄点的偏离距离；根据预设的仲裁规则，在所述多个修正后的预瞄点中选取最能表征车辆当前车道偏离情况的点作为最终预瞄点；以所述最终预瞄点的偏离距离作为误差，修正车辆横向位置。2.根据权利要求1所述的方法，其特征在于，所述提取车道线参数，得到车道中心线方程，具体包括：通过前视摄像头提取所述车道线参数，所述车道线参数包括车道线截距、车道线斜率、车道线曲率、车道线曲率变化率；通过所述车道线参数对车道线进行曲线拟合，得到车道中心线方程。3.根据权利要求2所述的方法，其特征在于，所述车道中心线方程为：其中，以摄像头安装位置为坐标原点，预瞄距离为x，A0为车道线截距、A1为车道线斜率、A2为车道线曲率、A3为车道线曲率变化率。4.根据权利要求1所述的方法，其特征在于，所述获取车辆的横摆角速度和车速，预测车辆运行轨迹，得到车道运行轨迹方程，具体包括：通过车辆质心处的横摆角传感器，实时检测得到横摆角速度；通过所述横摆角速度和车速计算得到车辆转弯半径R；通过所述转弯半径R得到车辆运行轨迹方程。5.根据权利要求4所述的方法，其特征在于，所述车辆运行轨迹方程为：当车辆左转且x∈[0,R]时，y∈[0,R]，车辆轨迹方程为：当车辆右转且x∈[0,R]时，y∈[
‑
R,0]，车辆轨迹方程为：6.根据权利要求4所述的方法，其特征在于，所述预瞄点为3个，所述预设的仲裁规，具体为：修正后的预瞄点的偏离距离大于零则为“+”，小于零则为
“‑”
；当修正后的预瞄点的偏离距离符号为“+++”，且偏离距离的大小呈单调递增或单调递减，则取预瞄距离最大的点作为最终预瞄点，若不单调，则取偏离距离第二的点作为最终预瞄点；...
【专利技术属性】
技术研发人员：欧阳智，王全，杨杰君，周艳辉，
申请(专利权)人：长沙中车智驭新能源科技有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。