本发明专利技术公开了一种基于他车轨迹预测的车辆自适应巡航控制方法，包括以下步骤：A、车道线数据拟合；B、车道目标筛选；C、目标轨迹预测；D、跟踪目标信息输出。本发明专利技术能够改进现有技术的不足，提高自适应巡航控制系统的行驶安全性及舒适性。
【技术实现步骤摘要】
本专利技术涉及车辆辅助驾驶，尤其是一种基于他车轨迹预测的车辆自适应巡航控制方法。
技术介绍
1、近年来，随着汽车感知能力及芯片计算能力的提升，汽车高级辅助驾驶系统（advanced driving assistant system，adas）已成为当前汽车智能辅助系统的研究热点。其中自适应巡航控制（adaptive cruise control，acc）根据当前行驶工况主动调节车辆制动压力及驱动扭矩，极大程度上减少驾驶员控制加速踏板或制动踏板的频率，缓解驾驶疲劳，因此该功能的上车率正逐年增加。该算法核心逻辑为当自车行驶车道前方有可跟踪的目标车辆时，自车以一定的跟车时距跟随目标车辆行驶；若本车道内无可跟踪的目标车辆，则自车以预设的巡航速度行驶。
2、传统acc对邻车道内车辆运动意图的预测方法主要分为两类，一类是只关注当前周期内传感器对他车的位姿及速度信息的监测来进行意图的判断，包含目标横向速度，横向加速度及与自车的相对横向距离，纵向距离等。一类是考虑连续几帧周期内他车相对位姿的变化来进行他车轨迹预测，进而获取他车的运动意图。以上两种策略均未考虑结合车辆自车行驶特性来进行他车的意图预测，这就使得在相对复杂的工况条件（如拥堵城市工况，弯道路况等）下出现acc主目标筛选错误或者筛选不及时的情况，进一步影响acc控制性能，出现误刹或减速不及时或制动剧烈或急加再急减等情况的发生，导致驾乘体验感降低，更严重的，在高速或者弯道等道路上行驶时错误的意图预判还存在相当的安全隐患。
技术实现思路
1、本专利技术要解决的技术问题是提供一种基于他车轨迹预测的车辆自适应巡航控制方法，能够解决现有技术的不足，提高自适应巡航控制系统的行驶安全性及舒适性。
2、为解决上述技术问题，本专利技术所采取的技术方案如下。
3、一种基于他车轨迹预测的车辆自适应巡航控制方法，包括以下步骤：
4、a、车道线数据拟合；
5、b、车道目标筛选；
6、c、目标轨迹预测；
7、d、跟踪目标信息输出。
8、作为优选，步骤a中，车道线数据拟合包括以下步骤，
9、a1、算法参数初始化；设置车道线拟合函数形式为一元三次多项式，
10、（1）
11、其中，x和y分别表示传感器识别到的车道线上的点在自车的车身坐标系下的纵向和横向坐标值，a、b、c和d为车道线拟合系数；
12、a2、车道线数据点输入；读取车道线传感器识别出的车道线点数据，将传感器坐标系转换成车身坐标系，并记录下对应车道线点数据，记为data，
13、（2），
14、，，m表示每条识别到的车道线的点的个数，n表示识别的车道线的条数；
15、a3、最小二乘法拟合车道线；结合式（1）的拟合函数，考虑拟合函数与实际数据值的均方误差最小，对任一条识别到的车道线的均方误差表示为如下形式，
16、（3），
17、分别对系数求偏导得到，
18、（4），
19、整理式（4）得到任一条车道线最小二乘法拟合的表达形式，
20、（5），
21、据式（5）计算得到车道线拟合系数；
22、a4、识别当前自车行驶车道的左右侧车道线；在车道宽已知的情况下，结合拟合函数系数d的值识别出当前自车行驶车道的左右侧车道线系数，
23、（6），
24、其中，其中d为车道宽，和分别表示自车行驶车道对应的左右侧车道线的常数拟合系数，根据该系数得到其对应的车道线参数拟合系数，
25、（7），
26、和分别表示自车当前行驶车道的左侧，右侧车道线拟合系数；根据式（7）得到当前自车行驶车道的车道中心线的拟合函数，
27、（8），
28、其中，，，，。
29、作为优选，步骤b中，车道目标筛选包括以下步骤，
30、b1、获取目标传感器识别数据；读取目标识别传感器识别到的其他车辆信息，记录为obsdata，
31、（9），
32、其中，、、、、分别表示第n个识别到的车辆在当前自车的车身坐标系下的纵坐标、横坐标、与自车的相对速度、与自车的相对航向、识别到车辆的id；
33、b2、区分其他行驶车辆所在车道；结合当前自车行驶车道的车道中心线拟合函数，如式（8）所示，识别出当前本车道及相邻左侧车道及相邻右侧车道内的其他行驶车辆信息；
34、b3、确定主目标车及次目标车；将本车道内与自车最近的其他行驶车辆作为主目标车，将相邻车道内与自车行驶方向一致的最近的其他行驶车辆作为次目标车。
35、作为优选，步骤c中，目标轨迹预测包括以下步骤，
36、c1、当本车道内主目标车存在且车速小于等于自车预设巡航速度时，
37、且当相邻车道内的次目标车存在且满足以下条件时，
38、（10），
39、其中，表示次目标车与自车的相对速度，表示次目标车与自车的相对纵向距离，表示主目标车与自车的相对纵向距离；
40、获取相邻车道内的次目标车在当前自车的车身坐标系下的信息，
41、（11），
42、其中，、、、、、分别表示次目标车的纵向坐标、横向坐标、纵向速度、横向速度、纵向加速度、横向加速度；
43、计算相邻的次目标车在自车的车道中心线上的投影点信息；找到该目标离车道中心线最近的点并记作匹配点，利用匹配点的信息计算次目标对应的投影点信息，包括投影点坐标，曲率及航向；
44、结合式（8）得到匹配点处路径横向对纵向的一阶导数及二阶导数，其表达形式如下，
45、（12），
46、由式（12）计算出匹配点处的航向角及匹配点处的曲率，
47、（13），
48、次目标车位姿与匹配点的纵向距离表示为，
49、（14），
50、综合式（13）、（14）计算出次目标车在车道中心线上投影点的航向、投影点的纵向坐标、横向坐标，
51、（15）；
52、将当前时刻下次目标车的位姿信息转换至以自车在本车道中心线的投影点为原点，车道中心线为纵轴s轴，正方向为自车行驶方向的自然坐标系；该自然坐标系上的点均遵循右手坐标系；插值找到当前次目标位置在自然坐标系上的纵向弧长，记作，计算次目标车偏离对应投影点的位移，
53、（16），
54、根据式（16）计算当前次目标车在自然坐标系下的速度，
55、（17），
56、计算当前次目标车横向偏移量对纵向弧长的一阶导数，
57、（18），
58、综合式（16）~（18）计算当前次目标车的纵向加速度，
59、（19），
60、根据式（17）~（19）得到当前次目标车横向偏离量对纵向弧长的二阶导数，
<本文档来自技高网...
【技术保护点】
1.一种基于他车轨迹预测的车辆自适应巡航控制方法，其特征在于包括以下步骤：
2.根据权利要求1所述的基于他车轨迹预测的车辆自适应巡航控制方法，其特征在于：步骤A中，车道线数据拟合包括以下步骤，
3.根据权利要求2所述的基于他车轨迹预测的车辆自适应巡航控制方法，其特征在于：步骤B中，车道目标筛选包括以下步骤，
4.根据权利要求3所述的基于他车轨迹预测的车辆自适应巡航控制方法，其特征在于：步骤C中，目标轨迹预测包括以下步骤，
5.根据权利要求4所述的基于他车轨迹预测的车辆自适应巡航控制方法，其特征在于：步骤D中，跟踪目标信息输出包括以下步骤，
【技术特征摘要】
1.一种基于他车轨迹预测的车辆自适应巡航控制方法，其特征在于包括以下步骤：
2.根据权利要求1所述的基于他车轨迹预测的车辆自适应巡航控制方法，其特征在于：步骤a中，车道线数据拟合包括以下步骤，
3.根据权利要求2所述的基于他车轨迹预测的车辆自适应巡航控制方法，其特征在于：...
【专利技术属性】
技术研发人员：刘俊骏，孙浩，李再兴，
申请(专利权)人：深圳安智杰科技有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。