本发明涉及车辆辅助驾驶,尤其是一种基于他车轨迹预测的车辆自适应巡航控制方法。
背景技术:
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)得到当前次目标车横向偏离量对纵向弧长的二阶导数,
61、(20),
62、当前时刻次目标在所述自然坐标系上的坐标为,
63、(21);
64、c2、当本车道内不存在主目标车或车速大于自车预设巡航速度时,
65、且相邻车道内的次目标车存在且满足以下条件,
66、(22),
67、其中表示预设的相邻车道内的次目标车与自车的最远距离,重复步骤c1的步骤,得到相邻车道内的次目标车在自然坐标系下的坐标信息;
68、c3、不满足步骤c1或c2的情况均输出空信息;
69、c4、预测次目标轨迹;由于车辆的横向运动均为纵向运动诱发的,预测次目标车在未来t秒内的运动轨迹;认为次目标车在终点状态与初始时刻的运动状态一致,由此得次目标在自然坐标系下的终点状态,
70、(23),
71、终点状态下的、、、与初始时刻相同;
72、由于横纵向终点状态均为未知量,因此纵向轨迹及横向轨迹均用4次多项式连接,
73、(24),
74、纵向轨迹终点状态,
75、(25),
76、其中,和均为函数参数。
77、作为优选,步骤d中,跟踪目标信息输出包括以下步骤,
78、结合式(25)判断相邻车道内的次目标在预测时域内的横向位置是否切入本车道,若存在切入本车道的次目标车,则将与自车最近的目标车作为跟踪目标,否则跟踪目标为本车道内的主目标车。
79、采用上述技术方案所带来的有益效果在于:本发明建立自车行驶车道的自然坐标系的基础上,充分利用传感器对他车的信息监测,通过将他车在自车的车身坐标系下的位姿状态及速度信息转化到所建立的自然坐标下,并结合车辆行为特性预测他车在未来时间内的运动轨迹,根据所预测的他车轨迹判断是否有切入本车行驶域的意图。本发明所提方法充分结合感知信息和车辆行驶特性预测未来时间内车辆的行驶轨迹,基于对他车的轨迹预测结果调整巡航控制策略,可在一定程度上提高驾乘舒适性及驾驶信心,此外,可进一步提高在复杂行驶工况下的行驶安全性。