编队自动驾驶跟随车路径规划方法、设备和产品

摘要: 本申请涉及自动驾驶,特别是涉及一种编队自动驾驶跟随车路径规划方法、设备和产品。背景技术:1、目前,随着智能驾驶、车车通信及车辆线控技术的发展,重载货车编队行驶逐...
编队自动驾驶跟随车路径规划方法、设备和产品

本申请涉及自动驾驶,特别是涉及一种编队自动驾驶跟随车路径规划方法、设备和产品。

背景技术:

1、目前,随着智能驾驶、车车通信及车辆线控技术的发展,重载货车编队行驶逐渐成为高速公路干线运输的重要技术方向。重载货车编队通常由一辆头车和若干辆跟随车组成,各车辆按照较小的纵向间距连续行驶;头车可由驾驶员驾驶,也可采用自动驾驶方式运行,跟随车则根据前车的运动状态、相对位置及道路环境信息,自动完成纵向跟驰和横向路径跟踪。

2、相关技术中,跟随车的路径规划方案通常利用全球卫星导航系统、惯性导航系统及高精度地图获得车辆在大地坐标系中的绝对位置,再依据道路中心线或车道级地图生成参考路径;或者利用车载摄像头识别车道线,结合雷达测量得到的前车当前位置,在自车局部坐标系中生成短距离行驶路径。然而,上述方案对高精度地图、卫星定位精度及道路视觉条件的依赖程度较高,在隧道、山区等卫星信号受限场景,或者雨雪、逆光、车道线磨损及前车遮挡等场景下,参考路径容易出现漂移、缺失或跳变;并且,现有方案多以前车当前位置为跟随目标,未能充分利用前车已经行驶形成的历史轨迹,在弯道路段容易产生“切弯”现象;对于牵引车-挂车组合式货车编队,跟随车的视野还会受到前车挂车的遮挡,难以直接观测前车牵引车,而牵引车与挂车之间存在相对转动,挂车尾部轨迹与牵引车轨迹并不一致,直接跟随挂车尾部轨迹会产生误差累积。

3、因此,如何在不依赖持续可靠的绝对定位信息和完整车道线观测的条件下,充分利用前车的历史行驶轨迹,为跟随车规划出连续、平滑且安全的行驶路径,成为重载货车编队自动驾驶领域亟待解决的技术问题。

技术实现思路

1、本申请的目的是提供一种编队自动驾驶跟随车路径规划方法、设备和产品,可在不依赖高精度地图和绝对定位信息的条件下,实现跟随车安全行驶路径的滚动规划,提高编队跟随的安全性、稳定性和鲁棒性。

2、为实现上述目的,本申请提供了如下方案:

3、第一方面,本申请提供了一种编队自动驾驶跟随车路径规划方法,所述方法包括:获取编队中前车相对于跟随车的相对位置数据,以及所述跟随车周围的障碍物数据;根据所述跟随车在相邻规划周期之间的运动,将各历史规划周期得到的所述相对位置数据对应的前车相对位置点递推变换至当前规划周期的跟随车局部坐标系,得到统一表达于当前规划周期的所述跟随车局部坐标系下的前车历史路径点序列;采用样条曲线表示所述跟随车的期望路径,以所述样条曲线的控制系数作为决策变量,根据所述前车历史路径点序列构建跟随一致性目标,并设置起终端边界约束;其中,所述跟随一致性目标表征所述期望路径与前车历史路径之间的跟随偏差,所述起终端边界约束用于约束所述期望路径的起点和终点;根据所述前车历史路径点序列与所述障碍物数据构建安全约束,将所述跟随一致性目标、所述起终端边界约束和所述安全约束纳入同一优化问题,求解所述同一优化问题得到所述控制系数,根据所述控制系数生成所述跟随车的安全行驶路径,所述安全行驶路径作为所述跟随车进行纵向协同控制和横向路径跟踪控制的参考输入。

4、第二方面,本申请提供了一种编队自动驾驶跟随车路径规划设备,包括存储器和处理器,所述存储器中存储有计算机程序,所述处理器执行所述计算机程序时实现如第一方面所述的编队自动驾驶跟随车路径规划方法。

5、第三方面,本申请提供了一种计算机程序产品,包括计算机程序,所述计算机程序被处理器执行时实现如第一方面所述的编队自动驾驶跟随车路径规划方法。

6、根据本申请提供的具体实施例,本申请公开了以下技术效果:

7、本申请提供的编队自动驾驶跟随车路径规划方法、设备和产品,根据跟随车在相邻规划周期之间的运动,将各历史规划周期的前车相对位置点递推变换至当前规划周期的跟随车局部坐标系,避免了不同采样时刻、不同局部坐标系下的位置点直接拼接造成的路径错位,使前车历史路径点序列准确反映前车实际驶过的空间轨迹;采用样条曲线表示跟随车的期望路径,以其控制系数作为决策变量,根据前车历史路径点序列构建跟随一致性目标并设置起终端边界约束,使期望路径逼近前车历史行驶轨迹,并与跟随车和前车的当前状态平滑衔接,保证路径的连续性和平滑性;将跟随一致性目标、起终端边界约束和安全约束纳入同一优化问题统一求解,无需先生成历史拟合路径再进行二次避障修正,直接得到兼顾跟随一致性与行驶安全性的安全行驶路径,降低了在线计算复杂度,满足车载滚动规划的实时性要求,从而在不依赖高精度地图和绝对定位信息的条件下提高了编队跟随的安全性、稳定性和鲁棒性。

1.一种编队自动驾驶跟随车路径规划方法,其特征在于,所述方法包括:

2.根据权利要求1所述的编队自动驾驶跟随车路径规划方法,其特征在于,所述获取编队中前车相对于跟随车的相对位置数据,以及所述跟随车周围的障碍物数据,包括:

3.根据权利要求2所述的编队自动驾驶跟随车路径规划方法,其特征在于,所述获取编队中前车相对于跟随车的相对位置数据,还包括:

4.根据权利要求1所述的编队自动驾驶跟随车路径规划方法,其特征在于,所述根据所述跟随车在相邻规划周期之间的运动,将各历史规划周期得到的所述相对位置数据对应的前车相对位置点递推变换至当前规划周期的跟随车局部坐标系,包括:

5.根据权利要求3所述的编队自动驾驶跟随车路径规划方法,其特征在于,所述根据所述前车历史路径点序列构建跟随一致性目标,包括:

6.根据权利要求1所述的编队自动驾驶跟随车路径规划方法,其特征在于,所述起终端边界约束包括起点约束和终点约束;

7.根据权利要求1所述的编队自动驾驶跟随车路径规划方法,其特征在于,所述根据所述前车历史路径点序列与所述障碍物数据构建安全约束,包括:

8.根据权利要求2所述的编队自动驾驶跟随车路径规划方法,其特征在于,所述前车为牵引车-挂车组合式货车,所述前车尾部为所述前车的挂车尾部,所述前车质心为所述前车中牵引车的质心;

9.一种编队自动驾驶跟随车路径规划设备,其特征在于,包括存储器和处理器,所述存储器中存储有计算机程序,所述处理器执行所述计算机程序时实现如权利要求1至8中任一项所述的编队自动驾驶跟随车路径规划方法。

10.一种计算机程序产品,包括计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至8中任一项所述的编队自动驾驶跟随车路径规划方法。