一种基于V2V的自动驾驶优化系统及方法
文献发布时间:2023-06-19 10:18:07
技术领域
本发明属于智能驾驶领域,更具体地,涉及一种基于V2V的自动驾驶优化系统及方法。
背景技术
高速公路辅助(Highway Assist,HWA)/高速场景领航(Highway Pilot,HWP)系统可以在高速路段自动纵向控制及横向车道保持,如果前车过慢,本车的雷达探测到旁边车道的后车在现有位置和速度下没有碰撞风险,则所述本车的HWA/HWP系统可支持本车自动变道。
HWA中的纵向控制,首先通过驾驶员在自适应巡航控制(Adaptive CruiseControl,ACC)里设定跟车距离偏好:远,中,近。然后本车根据与前车的碰撞时间(Time toCollision,TTC)及道路限速,按照主机厂标定好的参数选择加减速度&加减速度变化率,控制本车加减速。
HWA中的横向控制,非变道情况同车道居中保持功能,当车辆距离某一边车道线达到阈值后,通过调整车辆电动转向系统转动前轮,将车辆牵引回本车道中心线位置。当本车和前车速度差达到设定阈值,并且旁边车道后车与本车的TTC高于阈值,则判断可变道,调整车辆电动转向系统和动力系统,越过车道线到达目标车道。
然而上述方式,系数固定,在伴行情况下对于不同驾驶风格的周边驾驶员(激进或保守)无法适配。例如前车每次加减速度过高,加速度变化率高,如果按照某TTC的阈值统一设定跟车距离,容易导致同一工况下跟随前车刹车过猛,又例如旁边车道后车距离本车较近,TTC低于阈值,迟迟无法变道或因为后车突然加速变道失败。
发明内容
针对现有技术的以上缺陷或改进需求,本发明提出了一种基于V2V的自动驾驶优化系统及方法,可以实现更加舒适的跟车以及更加安全的变道体验。
为实现上述目的,按照本发明的一个方面,提供了一种基于V2V的自动驾驶优化方法,包括:
(1)车辆在伴行状态下,本车与周围车辆进行V2V数据交换,根据本车所在车道线信息、本车道前方车辆车牌号及本车道相邻车道车辆车牌号,构建出伴行车辆在本车周边的分布地图,其中,分布地图中包括各伴行车辆的位置信息;
(2)本车持续N秒接收分布地图中处于本车周边各车辆的横向加速度、纵向加速度及偏转角速度,N为自然数;
(3)在伴行直行状态下,本车根据本车道前车的纵向加速度以及相邻车道前车的横向加速度调整跟车制动时间点和减速度,使得跟随前车更舒适;
(4)在伴行需变道情况下,本车通过相邻车道的后车纵向加速度习惯,调整变道触发条件,使得本车变道更安全。
在一些可选的实施方案中,步骤(1)包括:
本车周期性向周边半径R米的车辆发送握手信息,同时也回应周边半径R米车辆发送的握手信号,R为自然数;
当握手信号收发双方完成在线同步及时间同步后,开始进行伴行方位确认,双方互相发送各自识别到的自身所在车道线信息、本车道前方车辆车牌号以及相邻车道前方车牌号,若有车辆前方没有车,则认为此车在伴行车群对应车道的第一位;
通过本车所在车道信息及握手车辆前方车辆信息,构建出伴行车辆在本车周边的分布地图。
在一些可选的实施方案中,步骤(3)包括:
(3.1)在伴行直行状态下,若与本车握手车辆是本车道前方车辆,则根据本车道前车的纵向负加速度均值与本车纵向负加速度均值之间的大小关系,确定本车与本车道前车的跟车距离;
(3.2)若与本车握手车辆是本车道相邻车道的前方车辆,则根据相邻车道前车的横向加速度绝对值均值与本车出厂HWA功能内设置的横向加速度阈值之间的大小关系,确定本车与本车道相邻车道的前方车辆的跟车距离;
(3.3)基于本车与本车道前车的跟车距离和本车与本车道相邻车道的前方车辆的跟车距离之间的大小关系,调整跟车制动时间点和减速度。
在一些可选的实施方案中,步骤(3.1)包括:
获取本车道前车的纵向负加速度a2在N秒内的平均值
在一些可选的实施方案中,步骤(3.2)包括:
获取本车道相邻车道的前车横向加速度绝对值|a3|在N秒内的平均值
在一些可选的实施方案中,步骤(3.3)包括:
若本车与本车道前车的跟车距离f1大于本车与本车道相邻车道的前方车辆的跟车距离f2,则本车根据TTC设定的开始制动时间点将提前T1秒,T1秒内制动减速度使用
若本车与本车道前车的跟车距离f1小于本车与本车道相邻车道的前方车辆的跟车距离f2,则本车根据切入TTC设定的开始制动时间点提前T2秒,T2秒内使用制动减速度
在一些可选的实施方案中,步骤(4)包括:
获取本车道相邻车道的后车纵向正加速度a1在N秒内的平均值
按照本发明的另一方面,提供了一种基于V2V的自动驾驶优化系统,包括:
通信模块,用于车辆在伴行状态下,与周围车辆进行V2V数据交换;
摄像模块,用于获取本车所在车道线信息、本车道前方车辆车牌号及本车道相邻车道车辆车牌号;
ADAS控制器,用于根据本车所在车道线信息、本车道前方车辆车牌号及本车道相邻车道车辆车牌号,构建出伴行车辆在本车周边的分布地图,其中,分布地图中包括各伴行车辆的位置信息;
IMU模块,用于持续N秒接收分布地图中处于本车周边各车辆的横向加速度、纵向加速度及偏转角速度,N为自然数;
所述ADAS控制器,还用于在伴行直行状态下,根据本车道前车的纵向加速度以及相邻车道前车的横向加速度调整跟车制动时间点和减速度,使得跟随前车更舒适;在伴行需变道情况下,通过相邻车道的后车纵向加速度习惯,调整变道触发条件,使得本车变道更安全。
总体而言,通过本发明所构思的以上技术方案与现有技术相比,能够取得下列有益效果:
在伴行直行状态下,本车通过根据本车道前车纵向加速度,以及相邻车道前车横向加速度调整跟车制动时间点和减速度,使得跟随前车更舒适,可以解决在伴行直行状态下,本车跟随前车频繁加减速,如果前车每次刹车减速度大,本车舒适性差的问题。
在伴行需变道情况下,本车通过相临车道后车纵向加速度习惯,调整变道触发条件,使得本车变道更安全,可以解决在伴行需变道情况下,由于本车变道条件设定苛刻,在旁边车道后车跟随等待情况下,也迟迟无法变道,阻碍他车的问题。
在高速伴行情况下,通过本发明的V2V模式可以根据不同的伴行车辆,匹配不同风格的自动驾驶,且不受网络条件限制,可以解决在高速伴行情况下,由于网络限制,无法取得驾驶风格更新的问题。
附图说明
图1是本发明实施例提供的一种基于V2V的自动驾驶优化系统的结构示意图;
图2是本发明实施例提供的一种基于V2V的自动驾驶优化方法的流程示意图;
图3是本发明实施例提供的一种伴行直行状态下的跟车方法流程示意图;
图4是本发明实施例提供的一种车辆位置示意图;
图5是本发明实施例提供的一种伴行需变道情况下的变道方法流程示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
以下对本发明用到的技术术语进行说明:
伴行状态:是指在高速/类高速道路中,轻微拥堵情况下,车辆以松散的群体状态按正常速度行驶(如60km/h以上)。此时随着道路状况变化(如部分车辆速度过低,车道小型障碍物等),自动驾驶车辆仍然需要加减速及做变道动作。
自动驾驶:这里指SAE L2级以上的智能驾驶,可自动控制车加减速及横向位移。
预测算法:对于高度动态和交互性的场景下车辆的行为和轨迹进行预测的算法。
DRSC(Dedicated Short Range Communication):专用短程通信,可用于短距离车与车通讯。
PC5接口:C-V2X的一种车对X的直接通信接口,其中,C-V2X可以包括vehicle-to-vehicle(V2V)车对车,vehicle-to-infrastructure(V2I),vehicle-to-pedestrian(V2P),and vehicle-to-cloud(V2C)。
如图1所示,是本发明实施例提供的一种基于V2V的自动驾驶优化系统结构示意图,包括:
通信模块,用于车辆在伴行状态下,与周围车辆进行V2V数据交换;
摄像模块,用于获取本车所在车道线信息、本车道前方车辆车牌号及本车道相邻车道车辆车牌号;
ADAS控制器,用于根据本车所在车道线信息、本车道前方车辆车牌号及本车道相邻车道车辆车牌号,构建出伴行车辆在本车周边的分布地图,其中,分布地图中包括各伴行车辆的位置信息;
IMU模块,用于持续N秒接收分布地图中处于本车周边各车辆的横向加速度、纵向加速度及偏转角速度,N为自然数;
ADAS控制器,还用于在伴行直行状态下,根据本车道前车的纵向加速度以及相邻车道前车的横向加速度调整跟车制动时间点和减速度,使得跟随前车更舒适;在伴行需变道情况下,通过相邻车道的后车纵向加速度习惯,调整变道触发条件,使得本车变道更安全。
具体地,当车辆处于伴行情况,本车通过装配在车上的通信模块,周期性向周边半径R米的车辆发送基于DSRC或者PC5通讯协议接口的握手信息,同时也回应周边半径R米车辆发送的握手信号。当握手信号收发双方完成在线同步及时间同步后,开始进行伴行方位确认,双方互相发送通过摄像头识别到的自身所在车道线信息、识别到的本车道前方车辆车牌号以及相邻车道前方车牌号,若有车辆前方没有车,则认为此车在伴行车群对应车道的第一位。通过本车所在车道、各握手车辆前方车辆情况在ADAS控制器构建出伴行车辆在本车周边的分布地图。分布地图构建完毕后发送本车IMU输出的横向加速度、纵向加速度及偏转角速度,同时也持续N秒接收分布地图中周边各车辆一一对应的横向加速度、纵向加速度及偏转角速度。以本车行驶方向为正,统计分布地图中与本车握手车辆在N秒内的纵向正加速度a1、纵向负加速度a2及横向加速度绝对值|a3|。
如图2所示是本发明实施例提供的一种基于V2V的自动驾驶优化方法的流程示意图,包括以下步骤:
S1:车辆在伴行状态下,本车与周围车辆进行V2V数据交换,根据本车所在车道线信息、本车道前方车辆车牌号及本车道相邻车道车辆车牌号,构建出伴行车辆在本车周边的分布地图,其中,分布地图中包括各伴行车辆的位置信息;
S2:本车持续N秒接收分布地图中处于本车周边各车辆的横向加速度、纵向加速度及偏转角速度,N为自然数;
S3:在伴行直行状态下,本车根据本车道前车的纵向加速度以及相邻车道前车的横向加速度调整跟车制动时间点和减速度,使得跟随前车更舒适;
S4:在伴行需变道情况下,本车通过相邻车道的后车纵向加速度习惯,调整变道触发条件,使得本车变道更安全。
其中,步骤S3可以通过以下方式实现:
S3.1:在伴行直行状态下,若与本车握手车辆是本车道前方车辆,则根据本车道前车的纵向负加速度均值与本车纵向负加速度均值之间的大小关系,确定本车与本车道前车的跟车距离;
S3.2:若与本车握手车辆是本车道相邻车道的前方车辆,则根据相邻车道前车的横向加速度绝对值均值与本车出厂HWA功能内设置的横向加速度阈值之间的大小关系,确定本车与本车道相邻车道的前方车辆的跟车距离;
如图3所示是本发明实施例提供的一种伴行直行状态下的跟车方法流程示意图,具体实现方式如下:
比较本车道前车的纵向负加速度a2在N秒内的平均值(采样周期可能小于1秒,如50ms获取一次),设为
例如
比较相邻车道前车横向加速度绝对值|a3|在N秒内的平均值(采样周期可能小于1秒,如50ms获取一次),设为
例如
S3.3:基于本车与本车道前车的跟车距离和本车与本车道相邻车道的前方车辆的跟车距离之间的大小关系,调整跟车制动时间点和减速度。
如图5所示是本发明实施例提供的一种伴行需变道情况下的变道方法流程示意图,具体实现过程为:
比较相邻车道后车纵向正加速度绝对值a1在N秒内的平均值(采样周期可能小于1秒,如50ms获取一次),设为
其中,N秒之前目标车辆的纵向正加速度a1,纵向负加速度a2,横向加速度绝对值|a3|不影响本车功能。N秒之后,继续记录本车周边车辆传输值,并顺次更新各均值结果。
其中,如果部分车辆不支持V2X,则由最靠近无V2X的车辆通过摄像头,雷达获取各参数(如获取不支持V2X的车辆的纵向正加速度、纵向负加速度及横向加速度绝对值),通过DSRC或PC5分享给本车。
本发明中提供车辆在伴行情况下,车辆进行V2V数据交换,通过摄像头识别到的自身所在车道线信息、识别到的本车道前方车辆车牌号,并构建出伴行车辆在周边的分布地图。分布地图构建完毕后发送本车输出的横向,纵向加速度,及偏转角速度,同时也持续N秒接收周边各车辆一一对应的横向,纵向加速度,及偏转角速度,在伴行直行状态下,本车通过根据本车道前车纵向加速度,以及相邻车道前车横向加速度调整跟车制动时间点和减速度,使得跟随前车更舒适。在伴行需变道情况下,本车通过相邻车道后车纵向加速度习惯,调整变道触发条件,使得本车变道更安全。在高速伴行情况下,根据不同的伴行车辆,匹配不同风格的自动驾驶,且不受网络条件限制。本发明中构建本车跟车距离函数,通过比较相邻车道前车横向加速度绝对值,判断相邻车道前车切入本车道的风险性程度;通过比较相邻车道后车纵向正加速度绝对值,判断相邻车道后车加速风险性程度;并在不受网络条件限制的情况下,根据不同的伴行车辆,匹配不同风格的自动驾驶,实时自动驾驶策略个性化更新。
需要指出,根据实施的需要,可将本申请中描述的各个步骤/部件拆分为更多步骤/部件,也可将两个或多个步骤/部件或者步骤/部件的部分操作组合成新的步骤/部件,以实现本发明的目的。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
- 一种基于V2V的自动驾驶优化系统及方法
- 基于迭代搜索优化哈希算法的自动驾驶系统域自适应方法