水平车位泊出路径规划方法、车辆、装置、电子设备及存储介质与流程

摘要: 本技术涉及自动驾驶,尤其涉及一种水平车位泊出路径规划方法、装置、电子设备及存储介质。背景技术:1、随着汽车电动化与智能化技术的快速发展,自动驾驶功能逐步成为智能...
水平车位泊出路径规划方法、车辆、装置、电子设备及存储介质与流程

本技术涉及自动驾驶,尤其涉及一种水平车位泊出路径规划方法、装置、电子设备及存储介质。

背景技术:

1、随着汽车电动化与智能化技术的快速发展,自动驾驶功能逐步成为智能汽车的核心配置,自动泊车作为自动驾驶体系的重要组成部分,能够辅助驾驶员完成停车位的自动驶入与驶出,显著降低停车操作难度,为日常用车提供极大便利。当前行业研究与技术方案多聚焦于自动泊入场景的路径规划与控制策略,针对泊出场景的技术研发相对滞后,而水平车位(侧方车位)的自动泊出需求尤为突出。在城市狭小停车空间中,水平车位常出现前后均有车辆停靠的情况,对于驾驶经验不足的用户而言,手动泊出操作难度大、易发生剐蹭事故,自动泊出技术成为解决该痛点的关键手段。

2、现有水平车位自动泊出方案仍存在明显缺陷:一方面,路径规划多基于初始探测场景生成固定路线,缺乏动态调整能力,当感知信息不全或场景发生变化时,车辆易偏离预期轨迹,导致泊出失败,任务完成率较低;另一方面,现有方案普遍未充分考虑车位内限位器的影响,车辆在揉库调整过程中易出现车轮撞击限位器的情况,影响驾乘舒适性;同时,多数方案仅关注车位内路径规划,未对出库后通道内可能出现的障碍物设置主动应对策略,依赖主动安全系统紧急制动或人工干预,存在较高碰撞风险,难以兼顾泊出过程的舒适性、完成率与安全性。

3、因此,现有技术中车位自动泊出技术缺乏对复杂场景下的路径自适应调整能力及出库后障碍物的主动规避策略,难以兼顾泊出过程的舒适性、完成率与安全性。

技术实现思路

1、为了解决上述技术问题或者至少部分地解决上述技术问题,本技术提供了一种水平车位泊出路径规划方法、装置、电子设备及存储介质。

2、第一方面,本技术提供了一种水平车位泊出路径规划方法,包括:

3、根据车辆传感器采集的障碍物聚类信息、可通行自由空间、雷达扫描扇区信息,初步计算得到所述车辆泊出所所需的安全边界;

4、识别车位内部有无限位器,若有则对所述安全边界进行修正,得到揉库边界;

5、基于所述揉库边界计算揉库路径,并根据该揉库路径以车辆的最小转弯半径为约束进行揉库调整车辆姿势;

6、计算得到四段式出库路径,在所述车辆姿势满足出库条件后,控制所述车辆按照所述出库路径出库;其中,所述四段式出库路径包括外摆圆弧段、第一直行段、回正圆弧段和第二直行段;

7、实时监测所述车辆的出库情况,在障碍物探测出现偏差时自适应调整所述四段式出库路径后继续泊出。

8、本技术一可能的实施例中,所述根据车辆传感器采集的障碍物聚类信息、可通行自由空间、雷达扫描扇区信息,初步计算得到所述车辆泊出所所需的安全边界,包括:

9、以车辆当前状态下后轴中心为原点建立泊出坐标系,根据所述障碍物聚类信息、雷达扫描扇区信息和预设安全距离,确定前后边界位置、侧边界位置以及前方需要绕过障碍物的宽度。

10、本技术一可能的实施例中,所述识别车位内部有无限位器,若有则对所述安全边界进行修正,包括:

11、在车辆所处区域的指定范围内确定是否限位器存在,若有则基于所述限位器位置、车辆后悬长度和预设安全距离重新计算得到所述安全边界的后边界,得到揉库边界。

12、本技术一可能的实施例中,计算得到四段式出库路径,在所述车辆姿势满足出库条件后,控制所述车辆按照所述出库路径出库,包括:

13、在所述车辆姿势满足出库条件后,通过预设出库角度、车身与前方障碍物的横向安全距离、圆弧转弯角度及出库后直行距离,结合车辆后轴中心位置、车身姿态与最小转弯半径,依次计算所述外摆圆弧段终点、第一直行段终点、回正圆弧终点与第二直行段终点,从而得到完整的四段式出库路径,控制所述车辆按照所述出库路径出库。

14、本技术一可能的实施例中,所述方法还包括:

15、实时监测车辆出库通道指定区域内有无障碍物侵入,如有,则计算为避免碰撞所述障碍物的车辆极限位置点,控制所述车辆在所述位置点驻停。

16、本技术一可能的实施例中,所述实时监测车辆出库通道指定区域内有无障碍物侵入,如有,则计算为避免碰撞所述障碍物的车辆极限位置点,控制所述车辆在所述位置点驻停,包括:

17、在出库通道内预设矩形监测区域,实时遍历障碍物聚类与可通行自由空间信息,判断是否有障碍物出现,如有则获取所述监测区域内障碍物的坐标,基于车辆轴距、前悬长度、车身姿态角及预设车头安全距离,计算得到车头禁止越过的极限位置;

18、根据极限位置分别落在四段式路径的分段区间,对应截断后续路径分段,进而控制车辆提前平稳停车,避免碰撞风险。

19、本技术一可能的实施例中,所述实时监测所述车辆的出库情况,在障碍物探测出现偏差时自适应调整所述四段式出库路径后继续泊出,包括:

20、在出库过程中,若因前方障碍物探测不全导致车辆在所述四段式出库路径的外摆圆弧段未结束前刹停,则自适应调整为三段式出库路径,按照所述三段式出库路径继续执行泊出操作。

21、本技术一可能的实施例中,所述三段式出库路径是通过以下计算方式得出:

22、以当前刹停位置为基准,先按最小转弯半径和调整角度确定新起点坐标,根据所述新起点坐标、所述四段式路径的第一直线段终点、回正圆弧段终点和第二直线段终点,确定所述三段式出库路径的直线段、回正圆弧段和最终直行段路线。

23、第二方面,本技术提供了一种车辆,所述车辆用于按照如第一方面任一实施例所述的水平车位泊出路径规划方法,进行车辆自动泊出。

24、第三方面,本技术提供了一种水平车位泊出路径规划装置,包括:

25、第一计算模块,用于根据车辆传感器采集的障碍物聚类信息、可通行自由空间、雷达扫描扇区信息,初步计算得到所述车辆泊出所所需的安全边界;

26、修正模块,用于识别车位内部有无限位器,若有则对所述安全边界进行修正,得到揉库边界;

27、调整模块,用于基于所述揉库边界计算揉库路径,并根据该揉库路径以车辆的最小转弯半径为约束进行揉库调整车辆姿势;

28、第二计算模块,用于计算得到四段式出库路径,在所述车辆姿势满足出库条件后,控制所述车辆按照所述出库路径出库;其中,所述四段式出库路径包括外摆圆弧段、第一直行段、回正圆弧段和第二直行段;

29、自适应调整模块,用于实时监测所述车辆的出库情况,在障碍物探测出现偏差时自适应调整所述四段式出库路径后继续泊出。

30、第四方面,本技术提供了一种电子设备,包括处理器、通信接口、存储器和通信总线,其中,处理器,通信接口,存储器通过通信总线完成相互间的通信;

31、存储器,用于存放计算机程序;

32、处理器,用于执行存储器上所存放的程序时,实现第一方面任一所述的水平车位泊出路径规划方法。

33、第五方面,本技术提供了一种计算机可读存储介质,所述计算机可读存储介质上存储有水平车位泊出路径规划方法的程序,所述水平车位泊出路径规划方法的程序被处理器执行时实现第一方面任一所述的水平车位泊出路径规划方法的步骤。

34、本发明的有益效果:

35、本技术实施例提供的水平车位泊出路径规划方法,根据车辆传感器采集的障碍物聚类信息、可通行自由空间、雷达扫描扇区信息,初步计算得到车辆泊出所所需的安全边界;然后进一步识别车位内部有无限位器,若有则对该安全边界进行修正,得到揉库边界;基于揉库边界计算揉库路径,并根据该揉库路径使用车辆的最小转弯半径进行揉库调整车辆姿势;在车辆姿势满足出库条件后,根据计算得到的四段式出库路径,控制车辆按照该出库路径出库;该四段式出库路径包括外摆圆弧段、第一直行段、回正圆弧段和第二直行段;并且出库过程中,实时监测车辆的出库情况,在遇到障碍物侵入时自适应调整该四段式出库路径进行泊出;进而本技术实施例中,通过初步确立车辆泊出的安全边界,并增加限位器识别进行揉库路径计算,充分考虑车位内限位器的影响,避免车辆在揉库调整过程中出现车轮撞击限位器的情况,进一步的实时检测车辆泊出情况,在有障碍物侵入车道时自适应调整路径,进而提高了泊出的成功率、安全性和驾乘舒适性。