一种自动泊车路径规划的避障方法及泊车路径规划系统

摘要

本发明涉及一种自动泊车路径规划的避障方法，包括：根据车辆初始位置、停车位以及障碍物信息规划泊车路径轨迹；在泊车路径轨迹上根据预设步长选取若干节点，确定各节点对应的位姿；根据各节点对应的位姿，将车辆轮廓依次拟合至各节点上；建立坐标系，判断是否存在与障碍物在X轴方向以及Y轴方向均发生投影重叠的车辆轮廓，若是，则认为泊车路径轨迹不合格，重新规划泊车路径；否则，认为泊车路径轨迹合格。该方法对以车辆后轴中点为质点规划的泊车路径轨迹进行了障碍物碰撞检测，避免了泊车过程中发生碰撞风险，一定程度增加了泊车成功率，同时也不会增加计算资源，具有重要的实用价值。

权利要求

1.一种自动泊车路径规划的避障方法，其特征在于，该方法包括以下步骤：根据车辆初始位置、停车位以及障碍物信息规划泊车路径轨迹；

在泊车路径轨迹上根据预设步长选取若干节点，确定各节点对应的位姿；

根据各节点对应的位姿，将车辆轮廓依次拟合至各节点上；

建立坐标系，判断是否存在与障碍物在X轴方向以及Y轴方向均发生投影重叠的车辆轮廓，若是，则认为泊车路径轨迹不合格，重新规划泊车路径；否则，认为泊车路径轨迹合格。

2.如权利要求1所述一种自动泊车路径规划的避障方法，其特征在于，所述建立坐标系，判断是否存在与障碍物在X轴方向以及Y轴方向均发生投影重叠的车辆轮廓，若是，则认为泊车路径轨迹不合格，重新规划泊车路径；否则，认为泊车路径轨迹合格步骤，包括：以泊车路径轨迹和障碍物所在平面建立坐标系；

获取节点上的车辆轮廓在X轴上的第一投影以及在Y轴上的第二投影；

获取障碍物在X轴上的第三投影以及在Y轴上的第四投影；

判断第一投影与第三投影、第二投影与第四投影是否均存在重叠区域，若是，则认为泊车路径轨迹不合格，重新规划泊车路径；否则，认为泊车路径轨迹合格。

3.如权利要求2所述一种自动泊车路径规划的避障方法，其特征在于，所述获取节点上的车辆轮廓在X轴上的第一投影以及在Y轴上的第二投影步骤，包括：获取节点上的车辆轮廓在X轴上的投影最大值X1和投影最小值X2，将线段X1X2视为第一投影；

获取节点上的车辆轮廓在Y轴上的投影最大值Y1和投影最小值Y2，将线段Y1Y2视为第二投影。

4.如权利要求2所述一种自动泊车路径规划的避障方法，其特征在于，所述获取障碍物在X轴上的第三投影以及在Y轴上的第四投影步骤，包括：获取障碍物在X轴上的投影最大值X1’和投影最小值X2’，将线段X1’X2’视为第三投影；

获取障碍物在Y轴上的投影最大值Y1’和投影最小值Y2’，将线段Y1’Y2’视为第四投影。

5.如权利要求1所述一种自动泊车路径规划的避障方法，其特征在于，所述根据各节点对应的位姿，将车辆轮廓依次拟合至各节点上步骤，包括：获取车辆的轮廓参数，并根据轮廓参数将车体简化为长方形；

根据各节点对应的位姿，将长方形作为车辆轮廓依次拟合至各节点上。

6.如权利要求5所述一种自动泊车路径规划的避障方法，其特征在于，在所述获取车辆的轮廓参数，并根据轮廓参数将车体简化为长方形步骤中，通过预设膨胀参数，增大车辆的轮廓参数，进而将车体简化为长方形。

7.如权利要求1所述一种自动泊车路径规划的避障方法，其特征在于，所述障碍物信息包括障碍物位置以及障碍物大小；所述障碍物信息通过车载摄像头以及车载雷达获取。

8.如权利要求1所述一种自动泊车路径规划的避障方法，其特征在于，针对存在多个自动泊车路径轨迹的情况，根据预设指标，从多个泊车路径轨迹中筛选出最优泊车路径轨迹作为最终的停车路径。

9.一种泊车路径规划系统，基于权利要求1‑8任一项所述的一种自动泊车路径规划的避障方法，其特征在于，包括车辆定位模块(6)、车位检测模块(5)、障碍物检测模块(4)、计算模块(3)以及干涉检测模块(2)；所述车辆定位模块(6)用于获取车辆位置以及位姿；所述车位检测模块(5)用于获取车位位姿；所述障碍物检测模块(4)包括车载摄像头和车载雷达，用于获取障碍物信息；所述计算模块(3)用于结合车辆位置、位姿、障碍物信息以及车位位姿进行泊车路径规划，获取泊车路径轨迹以及确定泊车路径轨迹上各节点的位姿；所述干涉检测模块(2)用于对各节点拟合车辆轮廓，并对各节点上的车辆轮廓与障碍物进行干涉检测，以获取合格的泊车路径轨迹。

说明书

一种自动泊车路径规划的避障方法及泊车路径规划系统

技术领域

[0001] 本发明涉及泊车路径规划技术领域，尤其涉及一种自动泊车路径规划的避障方法及泊车路径规划系统。

背景技术

[0002] 随着汽车保有量的增加，车位空间狭小，使得停车难逐渐成为了普遍现象，导致泊车过程中的安全事故频频发生。而自动泊车系统的出现，可以有效避免泊车过程中此类安
全事故的发生。因此，自动泊车系统近年来成为了国内外各大企业和机构的研究热点。目
前，自动泊车系统已经作为高端配置逐渐应用在了部分车辆上，以协助驾驶员完成泊车过
程，其主要包括识别系统、路径规划系统以及泊车控制系统三个部分。在整个泊车过程中，
一般先由识别系统对空间中的车位以及车位周围的障碍物信息进行识别，然后将所识别的
环境信息传输给路径规划系统，由路径规划系统根据传感器采集到的信息建立对应的坐标
系，通过约束条件判断车位是否符合要求，如果符合要求则将检测到的车位进行存储，并根
据车辆的起始位置及姿态进行泊车路径规划，生成最终的泊车路径；若不符合自动泊车的
要求，则控制车辆继续向前行驶，寻找新的车位，直至检测到可用的停车位为止。最后由泊
车控制系统根据规划的路径将路径信息转化成控制决策，对车辆的转角、速度、档位等进行
控制，同时将执行结果反馈给中央处理器，以方便中央处理器进一步分析和制定决策。从整
个自动泊车过程可以看出，泊车效果的好坏与路径规划息息相关，路径规划的优势直接导
致自动泊车的成功与否，所以自动泊车系统的路径规划是一个极其重要的环节。

[0003] 在现有的自动泊车系统中，一般选取车辆的后轴中点作为车辆参考点(也就是质心点)，规划出来的泊车路径轨迹是指质心点经过的位置集合，即点集。整个路径规划过程
中，是不考虑实际车辆体积大小的，这就导致有些质心点虽然与周围车辆或障碍物的质心
点轨迹之间没有交集，但当考虑了车辆与周围障碍物在地面投影面积之后，就会造成面积
存在重合的情况，也就是存在发生碰撞的风险。换句话说，以质心点经过的位置集合规划出
的泊车路径，当考虑了车辆体积的大小或周围障碍物的体积大小之后，很有可能在泊车过
程中，车辆边缘便会与障碍物边缘存在摩擦或碰撞的风险，如图1所示。然而，如果在路径规
划时直接将车辆和障碍物尺寸考虑到规划算法中去，又会导致解算难度大大增加，解算速
度会明显下降，从而出现明显的延迟现象，造成较大的误差，这样则难以满足自动泊车路径
规划的要求。

发明内容

[0004] 为了解决上述技术问题，本发明提供了一种自动泊车路径规划的避障方法，该方法包括以下步骤：

[0005] 根据车辆初始位置、停车位以及障碍物信息规划泊车路径轨迹；

[0006] 在泊车路径轨迹上根据预设步长选取若干节点，确定各节点对应的位姿；

[0007] 根据各节点对应的位姿，将车辆轮廓依次拟合至各节点上；

[0008] 建立坐标系，判断是否存在与障碍物在X轴方向以及Y轴方向均发生投影重叠的车辆轮廓，若是，则认为泊车路径轨迹不合格，重新规划泊车路径；否则，认为泊车路径轨迹合
格。

[0009] 进一步的，所述建立坐标系，判断是否存在与障碍物在X轴方向以及Y轴方向均发生投影重叠的车辆轮廓，若是，则认为泊车路径轨迹不合格，重新规划泊车路径；否则，认为
泊车路径轨迹合格步骤，包括：

[0010] 以泊车路径轨迹和障碍物所在平面建立坐标系；

[0011] 获取节点上的车辆轮廓在X轴上的第一投影以及在Y轴上的第二投影；

[0012] 获取障碍物在X轴上的第三投影以及在Y轴上的第四投影；

[0013] 判断第一投影与第三投影、第二投影与第四投影是否均存在重叠区域，若是，则认为泊车路径轨迹不合格，重新规划泊车路径；否则，认为泊车路径轨迹合格。

[0014] 进一步的，所述获取节点上的车辆轮廓在X轴上的第一投影以及在Y轴上的第二投影步骤，包括：

[0015] 获取节点上的车辆轮廓在X轴上的投影最大值X1和投影最小值X2，将线段X1X2视为第一投影；

[0016] 获取节点上的车辆轮廓在Y轴上的投影最大值Y1和投影最小值Y2，将线段Y1Y2视为第二投影。

[0017] 进一步的，所述获取障碍物在X轴上的第三投影以及在Y轴上的第四投影步骤，包括：

[0018] 获取障碍物在X轴上的投影最大值X1’和投影最小值X2’，将线段X1’X2’视为第三投影；

[0019] 获取障碍物在Y轴上的投影最大值Y1’和投影最小值Y2’，将线段Y1’Y2’视为第四投影。

[0020] 进一步的，所述根据各节点对应的位姿，将车辆轮廓依次拟合至各节点上步骤，包括：

[0021] 获取车辆的轮廓参数，并根据轮廓参数将车体简化为长方形；

[0022] 根据各节点对应的位姿，将长方形作为车辆轮廓依次拟合至各节点上。

[0023] 进一步的，在所述获取车辆的轮廓参数，并根据轮廓参数将车体简化为长方形步骤中，通过预设膨胀参数，增大车辆的轮廓参数，进而将车体简化为长方形。

[0024] 进一步的，所述障碍物信息包括障碍物位置以及障碍物大小；所述障碍物信息通过车载摄像头以及车载雷达获取。

[0025] 进一步的，针对存在多个自动泊车路径轨迹的情况，根据预设指标，从多个泊车路径轨迹中筛选出最优泊车路径轨迹作为最终的停车路径。

[0026] 一种泊车路径规划系统，基于上述的一种自动泊车路径规划的避障方法，包括车辆定位模块、车位检测模块、障碍物检测模块、计算模块以及干涉检测模块；所述车辆定位
模块用于获取车辆位置以及位姿；所述车位检测模块用于获取车位位姿；所述障碍物检测
模块包括车载摄像头和车载雷达，用于获取障碍物信息；所述计算模块用于结合车辆位置、
位姿、障碍物信息以及车位位姿进行泊车路径规划，获取泊车路径轨迹以及确定泊车路径
轨迹上各节点的位姿；所述干涉检测模块用于对各节点拟合车辆轮廓，并对各节点上的车
辆轮廓与障碍物进行干涉检测，以获取合格的泊车路径轨迹。

[0027] 本发明取得的技术效果如下：

[0028] 本发明提供了一种自动泊车路径规划的避障方法，该方法对以车辆后轴中点为质点规划的泊车路径轨迹进行了障碍物碰撞检测，即通过对泊车路径轨迹上的各节点拟合车
辆轮廓，考虑车辆轮廓与障碍物在坐标系X轴和Y轴上投影的重合度，从而根据投影重合度
判断泊车路径轨迹是否合格，以避免泊车过程中发生碰撞风险，一定程度增加了泊车成功
率，同时也不会增加计算资源，具有重要的实用价值。

附图说明

[0029] 图1为背景技术中以质点规划的泊车路径轨迹与障碍物发生碰撞的示意图。

[0030] 图2为实施例1中位于节点上的车辆轮廓与障碍物在坐标系中的位置关系示意图。

[0031] 图3为实施例1中对车辆和障碍物进行惊醒膨胀的示意图。

[0032] 图4为实施例1中自动泊车路径规划的避障方法流程示意图。

[0033] 图5为实施例1中泊车路径规划系统的内部连接关系示意图。

[0034] 附图标记：

[0035] 1‑泊车路径规划系统，2‑干涉检测模块，3‑计算模块，4‑障碍物检测模块，5‑车位检测模块，6‑车辆定位模块。

具体实施方式

[0036] 下面结合附图对本发明的较佳实施例进行详细阐述，以使本发明的优点和特征更易被本领域技术人员理解，从而对本发明的保护范围作出更为清楚的界定。

[0037] 实施例1：

[0038] 本发明实施例提供了一种自动泊车路径规划的避障方法，如图4所示，包括如下步骤：

[0039] 101、根据车辆初始位置、停车位以及障碍物信息规划泊车路径轨迹。

[0040] 泊车路径轨迹的规划过程是以车辆的后轴中点作为质心点的(参考阿克曼转向原理)，以质心点所经过的路径画出来的曲线或直线即作为泊车路径轨迹。

[0041] 本实施例中，所说的障碍物信息包括障碍物位置以及障碍物大小，障碍物信息主要通过车载摄像头以及车载雷达来获取。这里之所以采用车载摄像头和车载雷达相互配合
来获取障碍物信息，是因为单一的车载摄像头或单一的车载雷达均不能保证完全识别到障
碍物的位姿信息，会造成障碍物信息采集出现误差，影响对泊车路径轨迹的规划和判断。当
然，为了进一步提高障碍物信息采集的精准度，还可以继续融合停车位摄像头，甚至是北斗
高精定位系统，在此不做唯一限制。

[0042] 102、在泊车路径轨迹上根据预设步长选取若干节点，确定各节点对应的位姿。

[0043] 在泊车路径轨迹上根据预设步长选取若干节点，其实质是对泊车路径轨迹进行离散化处理，以得到多个离散点，以离散点作为节点进行后续的计算。这里的预设步长是为了
保证若干节点等距设置，预设步长可以根据实际需要进行设定，如泊车路径轨迹周围的障
碍物数量较多，则可以将预设步长设置的较短一些，以获取更多数量的节点，增加障碍物干
涉检测的次数，提高对泊车路径轨迹的验证准确性；若泊车路径轨迹周围的障碍物数量较
少，则可以将预设步长设置的较长一些，以减少节点的数量，从而适当减少障碍物干涉检测
的次数，提高对泊车路径轨迹的验证效率。

[0044] 103、根据各节点对应的位姿，将车辆轮廓依次拟合至各节点上。

[0045] 为了将车辆轮廓拟合至各节点上，需要先获取得到车辆的轮廓参数，并根据轮廓参数将车体简化为长方形。再根据各节点对应的位姿，将长方形作为车辆轮廓依次拟合至
各节点上。本实施例中，通过预设膨胀参数，增大车辆轮廓参数的方法，进而将车体简化为
了长方形。当然，为了进一步简化计算过程，也可以将车体直接设置成长方形，根据车长和
车宽对长方形的大小进行赋值即可。

[0046] 104、建立坐标系，判断是否存在与障碍物在X轴方向以及Y轴方向均发生投影重叠的车辆轮廓，若是，则认为泊车路径轨迹不合格，重新规划泊车路径；否则，认为泊车路径轨
迹合格。

[0047] 具体的，首先需要以泊车路径轨迹和障碍物所在平面建立坐标系(二维坐标系)，为了简化分析过程，通常将泊车路径轨迹以及障碍物设置在同一相限内。然后获取节点上
的车辆轮廓在X轴上的第一投影以及在Y轴上的第二投影，同时获取障碍物在X轴上的第三
投影以及在Y轴上的第四投影。最后，将第一投影与第三投影相比较，将第二投影和第四投
影相比较，判断第一投影与第三投影、第二投影与第四投影是否均存在重叠区域，若是，则
认为泊车路径轨迹不合格，重新规划泊车路径；否则，认为泊车路径轨迹合格，并按照合格
的泊车路径轨迹执行泊车过程。这里所说的重叠区域包括全部重合、部分重合以及点重合
这三种情况，即无论是第一投影与第三投影完全重重合，还是部分重合，甚至是只有一个点
是重合，都被视为第一投影和第三投影有重叠区域；同理，无论是第二投影和第四投影完全
重合，还是部分重合，还是只有一个点重合，也都被视为第二投影和第四投影有重叠区域。
当同时满足第一投影与第三投影有重叠区域，第二投影与第四投影有重叠区域，则认为车
辆按照该泊车路径轨迹进行泊车时，车辆会与障碍物发生碰撞，泊车危险性是较高的，此时
泊车路径轨迹是不合格的，是需要重新规划的。值得注意的是，只要泊车路径轨迹上有一个
节点上的车辆轮廓与障碍物在X轴方向以及Y轴方向均发生投影重叠，就可认为泊车路径轨
迹是不合格的。换句话说，只要泊车路径轨迹上有一个节点上的车辆轮廓满足条件，就可以
判断泊车路径轨迹不合格，这里并不要求泊车路径轨迹上所有节点上的车辆轮廓均满足上
述要求。

[0048] 本实施例中，将车辆轮廓分别投影至X轴上和Y轴上，获取节点上的车辆轮廓在X轴上的投影最大值X1和投影最小值X2，将线段X1X2视为第一投影，获取节点上的车辆轮廓在Y
轴上的投影最大值Y1和投影最小值Y2，将线段Y1Y2视为第二投影。同理，将障碍物也分别投
影至X轴上和Y轴上，获取障碍物在X轴上的投影最大值X1’和投影最小值X2’，将线段X1’X2’
视为第三投影，获取障碍物在Y轴上的投影最大值Y1’和投影最小值Y2’，将线段Y1’Y2’视为
第四投影，具体如图2所示。在图2中，蓝色方块代表拟合在节点上的车辆轮廓，红色不规则
曲线代表了障碍物的位置和大小。

[0049] 作为优选的，在对泊车路径规划时，一般会将车辆简化为质点，规划出多条泊车路径轨迹，此时针对这种存在多个自动泊车路径轨迹的情况，就需要根据预设指标，从多个泊
车路径轨迹中筛选出最优泊车路径轨迹作为最终的停车路径。通常泊车路径轨迹上各节点
上的车辆轮廓与障碍物在X轴上的投影距离越大，且泊车路径轨迹上各节点上的车辆轮廓
与障碍物在Y轴上的投影距离也越大，则认为该泊车路径轨迹就越安全。本实施例中，针对
上述筛选出的多条合格泊车路径轨迹，先计算出每条泊车路径轨迹上的车辆轮廓的第一投
影与障碍物的第三投影之间的最小距离，作为第一距离值；然后，再计算出每条泊车路径轨
迹上的车辆轮廓的第二投影与障碍物的第四投影之间的最小距离，作为第二距离值；最后
将第一距离值与第二距离值相加，得到的和值最大的泊车路径轨迹即为最优泊车路径轨
迹。

[0050] 本实施例提供的自动泊车路径规划的避障方法本质上是把车和障碍物在一开始建立的坐标系下做惊醒膨胀，如图3所示。在图3中，将较大的黑框看成是车，将较小的黑框
看成是障碍物，这样就可以不考虑车的姿态信息以及障碍物的姿态信息，大大简化了计算
难度。所以只有当X轴和Y轴同时都有交点的时候，两个黑框才会重合，即膨胀后的车和障碍
物才会发生碰撞。该判断方法计算简单，且安全性较高，适于大范围内的推广应用。

[0051] 实施例2：

[0052] 本实施例公开了一种泊车路径规划系统，用于实现实施例1中所说的一种自动泊车路径规划的避障方法。如图5所示，泊车路径规划系统1包括车辆定位模块6、车位检测模
块5、障碍物检测模块4、计算模块3以及干涉检测模块2。所述车辆定位模块6用于获取车辆
位置以及位姿。所述车位检测模块5用于获取车位位姿。所述障碍物检测模块4包括车载摄
像头和车载雷达，用于获取障碍物信息。所述计算模块3用于结合车辆位置、位姿、障碍物信
息以及车位位姿进行泊车路径规划，获取泊车路径轨迹以及确定泊车路径轨迹上各节点的
位姿。所述干涉检测模块2用于对各节点拟合车辆轮廓，并对各节点上的车辆轮廓与障碍物
进行干涉检测，以获取合格的泊车路径轨迹。

[0053] 上面结合附图对本发明的实施方式作了详细说明，但是本发明并不限于上述实施方式，在本领域普通技术人员所具备的知识范围内，还可以在不脱离本发明宗旨的前提下
作出各种变化。