一种垂直自动泊车路径规划方法及系统与流程

本发明涉及泊车路径规划技术领域，特别涉及一种垂直自动泊车路径规划方法及系统。

背景技术：

泊车操作难度大，经验要求高。许多驾驶新手由于经验不足而面临巨大的障碍，往往经验不足的驾驶员需要反复多次前进后退才能完成泊车，甚至在某些场景下还无法完成泊车。自动泊车系统为解决这些问题提供了有效解决方案，作为高级驾驶辅助系统中应用场景最频繁的一种，其技术发展也得到了各大车企以及供应商的广泛关注。在自动泊车系统中，路径规划作为控制环节中最为重要的一部分，为泊车控制系统提供了准确参考，然而在垂直泊车过程中车辆在不同的位置有时需要多次换挡才能准确泊车。

技术实现要素：

有鉴于此，本发明要解决的技术问题之一在于提供一种垂直自动泊车路径规划方法，采用简单的几何作图方法规划出垂直泊车换挡次数少的理想路径，提高自动泊车的效率。

本发明通过以下技术手段解决上述技术问题：

本发明提供了一种垂直自动泊车路径规划方法，具体包括以下步骤：

(1)、采用传感器获取待泊车辆环境信息，建立环境全局坐标系；

(2)、根据全局坐标系，确定待泊车辆与待停车库之间的位置；

(3)、利用阿克曼转向机构原理确定待泊车辆的最小转弯半径，确定待泊车辆泊入待停车库的车辆临界起始位置和车辆临界泊入位置；

(4)、根据车辆在不同的起始位置采用几何作图方法绘制待泊车辆垂直泊车路径。

进一步地，所述全局坐标系的坐标原点为待泊车辆后轴中心点o，水平方向为x轴，竖直方向为y轴，逆时针旋转方向为正方向。

进一步地，所述步骤(3)中所述待泊车辆的最小转弯半径为其中，l为车辆轴距，w为车辆轮距，αmax为转向轮的最大转角。

进一步地，所述步骤(3)中车辆起始临界位置的计算方法：根据待泊车库的垂直方向的中轴线l1为切线，以待泊车辆的最小转弯半径rmin为半径画圆1，所述待泊车辆的最小转弯半径rmin减去待泊车辆宽度wk的一半的长度为半径绘制圆1的同心圆圆2，同时移动圆1、2，移动到圆2与待泊车库边缘相交，绘制圆1的水平切线l2，所述圆1与水平切线l2的切点a为临界起点，所述临界起点a和待泊车辆的后轴中心点o重合；所述步骤3中车辆临界泊入位置的计算方法：根据待泊车库的垂直方向的中轴线l1为切线，所述中轴线l1与圆1的切点b为临界终点，所述临界终点b与待泊车辆的后轴中心点o重合。

进一步地，所述步骤(4)中的几何作图方法：根据待泊车辆的初始位置，沿传动轴绘制直线l，最小转弯半径圆与直线l和中轴线l1分别相切于第一点和第二点，依次连接待泊车辆的后轴中心点、第一点、第二点和临界终点，得到垂直泊车路径。

进一步地，所述l1和l2相交将停车区域分为4个区域，当待泊车辆的初始位置位于i区域，所述第一点位于待泊车辆后轴中心点o的左平面，可一次性泊入待泊车库，具体路径为依次连接待泊车辆的后轴中心点、第一点、第二点和临界终点，得到垂直泊车路径。

进一步地，所述l1和l2相交将停车区域分为4个区域，当待泊车辆的初始位置位于i区域，所述第一点位于待泊车辆后轴中心点o的右平面，可两次泊入待泊车库，具体路径为依次连接待泊车辆的后轴中心点、第一点、第二点和临界终点，得到垂直泊车路径。

进一步地，所述l1和l2相交将停车区域分为4个区域，当待泊车辆的初始位置位于i区域，所述第一点位于待泊车辆后轴中心点o的右平面，可两次泊入待泊车库，具体路径为依次连接待泊车辆的后轴中心点、第一点、第二点和临界终点，得到垂直泊车路径。

进一步地，所述步骤(4)中的几何作图方法：所述l1和l2相交将停车区域分为4个区域，当待泊车辆的初始位置位于iv区域，沿传动轴绘制直线l1，以最小转弯半径为半径绘圆5分别相切于直线l1和圆1于第三点和第四点，可三次泊入待泊车库，具体路径为依次连接待泊车辆的后轴中心点、第三点、第四点和临界终点，得到垂直泊车路径。

本发明还包括一种垂直自动泊车路径规划系统，包括上述任一项所述的垂直自动泊车路径规划方法。

本发明的有益效果：

本发明的垂直自动泊车路径规划方法，利用传感器获取的待泊车辆周边环境信息建立全局坐标系，结合基于阿克曼转向机构的车辆转向特性，确定待泊车辆在当前全局坐标系下是否能够通过一次换挡完成自动泊车，并进行垂直泊车路径规划。本发明采用简单的几何作图方法进行垂直泊车路径进行规划，最多三次就可以成功泊车，提高了垂直泊车路径规划的效率，并具有较好的鲁棒性，在仅有障碍车库的干扰下，均能够快速实现路径规划。本发明路径规划方法逻辑简单，换挡次数少，不同车辆起始状态均能完成路径规划，具有较高的工程实用价值。

本发明的垂直自动泊车路径规划系统包含了垂直自动泊车路径规划的方法，采用几何作图的方法提高了垂直泊车路径规划的效率，并具有较好的鲁棒性，在仅有障碍车库的干扰下，均能够快速实现路径规划。本发明路径规划方法逻辑简单，换挡次数少，不同车辆起始状态均能完成路径规划，具有较高的工程实用价值。

附图说明

下面结合附图和实施例对本发明作进一步描述。

图1为本发明建立全局坐标系的示意图；

图2为本发明起始临界位置和临界泊入位置的示意图；

图3为本发明实施例1的示意图；

图4为本发明实施例2的示意图；

图5为本发明实施例3的示意图；

图6为本发明实施例4的示意图；

图7为本发明实施例4的计算示意图。

具体实施方式

以下将结合附图对本发明进行详细说明。

本发明的垂直自动泊车路径规划方法，具体包括以下步骤：

(1)、采用传感器获取待泊车辆环境信息，建立环境全局坐标系；

(2)、根据全局坐标系，确定待泊车辆与待停车库之间的位置；

(3)、利用阿克曼转向机构原理确定待泊车辆的最小转弯半径，确定待泊车辆泊入待停车库的车辆临界起始位置和车辆临界泊入位置；

(4)、根据车辆在不同的起始位置采用几何作图方法绘制待泊车辆垂直泊车路径。

如图1所示，待泊车辆21欲停入2号车库，1号障碍车库和3号障碍车库分别已停有车辆11和31。待泊车辆21上的超声波雷达采集周围的环境信息，建立全局坐标系，坐标系的原点o为待泊车辆后轴中心点，水平方向为x轴，竖直方向为y轴，逆时针旋转角度θ为正方向。雷达测得待泊车辆的后轴中心距1号障碍车库(待泊车库的左侧障碍车库)的右侧边界线的距离为h2，待泊车辆的后轴中心距3号障碍车库(待泊车库的右侧障碍车库)的左侧边界线的距离为h1，待泊车辆的后轴中心距障碍车库的上边界限距离为p1，距障碍车库的下边界限距离为p2，因此，可计算出待泊车库的尺寸，wk＝h2-h1，lk＝p2-p1，其中，wk为待泊车库的宽度，lk为待泊车库的长度，根据车库的大小可以判断待泊车辆是否能泊入车库中。

待泊车辆21的最小转弯半径rmin由转向机构参数所决定，大小为其中，l为车辆轴距，w为车辆轮距，αmax为转向轮的最大转角。如图2所示，以2号车库的中轴线泊入为最佳泊入位置。以中轴线为切线，rmin为半径画圆1，圆1的圆心o1的坐标为再画圆1的同心圆圆2，圆2的半径r为待泊车辆21的最小转弯半径减去待泊车辆的半车宽，即其中，rmin为待泊车辆的最小转弯半径，w为待泊车辆整车宽度。沿y轴方向向下平移圆1与圆2，根据碰撞条件，圆2与3号障碍车库不能相交，取临界相交状态时圆1与圆2的位置作为临界位置，即两圆的圆心坐标为作圆1的水平切线水平切线l2与圆1相切于点点a与待泊车辆21的后轴中心(全局坐标系原点o)重合，即得到待泊车辆21起始临界位置，中轴线l1与圆1相切于点点b与待泊车辆21的后轴中心重合，得到待泊车辆临界泊入位置。

水平切线l2与中轴线l1将全局坐标系划分为四个区域i、ii、iii、iv，通常情况下，车辆都是在i、iv区域开始泊车，即使当待泊车辆在与i、iv区域对称的ii、iii区域时，算法相同，因此以i、iv区域为例。当车辆处于iv区域时，明显不能以最小转弯半径泊入2号车库，因此，当车辆处于iv区域时需要进行后退修正，其泊车次数为3次。当车辆处于i区域时，有两种情况：1)可以1次泊入车库；2)可以2次泊入车库。

实施例1

如图3所示，待泊车辆处于区域i中的任意位置，以待泊车辆的后轴中心点o为原点，原点o:(0,0,θ)建立全局坐标系，θ为车辆的航向角。判断车辆在i区域中能否一次泊入车库，沿待泊车辆的传动轴作延长线l3，后轴中心点o位于l3上，沿2号车库的中轴线l1为切线向上平移圆1得到圆3，圆3与l3相切于点圆3与l1相切于点点c位于坐标原点o的左平面，具体的泊车路径为依次连接点o、c、d和b，车辆可以一次性泊入2号车库，本实施例一次性泊入车库的具体路径为分为3段，第一段是点o与点c的连接线段，第二段为点c与点d之间的圆弧段，第三段为点d与点b的直线段。

实施例2

如图4所示，与实施例1相同，不同的是切点c位于坐标原点o的右平面，则车辆必须两次泊入车库，待泊车辆需向前移动到c点，再根据实施例1的路径进行泊车。其中点点具体的泊车路径为依次连接点o、c、d和b。本实施例的垂直泊车路径分为3段，第一段为点o与点c的连接线段，第二段为点c与点d之间的圆弧段，第三段为点d与点b的直线段。

实施例3

若车辆位于区域iv，则需要三次换挡才能完成泊车。如图5所示，待泊车辆的初始位置位于区域iv中，以待泊车辆的后轴中心点o为原点建立全局坐标系，原点o在区域iv中，绘制待泊车辆传动轴所在直线l4，原点o在直线l4上，以待泊车辆的最小转弯半径为半径画圆4，圆4分别与l4和l1分别相切于点和泊车路径为依次连接o、e、f和b。此时，将待泊车辆泊入2号车库，需要3次换挡，本实施例具体的泊车路径为3段，第一段为点o与点e连接的直线段，第二段为点e和点f连接的圆弧段，第三段为点f与点b连接的直线段。

实施例4

当道路宽度有限时，待泊车辆若采用实施例3的方法进行泊车将会与道路边缘发生碰撞，则需要另行规划，如图6所示，待泊车辆初始位置依然位于区域iv中，同样地，以待泊车辆的后轴中心点为原点o建立全局坐标系，原点o区域iv中,沿原点o作水平线l4，以l4为切线，圆1为相切圆，半径为最小转弯半径rmin画圆5，圆5分别与l4相切于点g，圆5与圆1相切于点h，泊车路径为依次连接点o、g、h和b。将待泊车辆泊入2号车库，需要3次换挡，本实施例的具体的泊车路径为3段，第一段为点o与点g连接的直线段，第二段为点g和点h接的圆弧段，第三段为点h和点b连接的圆弧段。

如图7所示，g点坐标与h点坐标的具体计算方法为：

h点为圆1与圆5的公切点，且水平线l2、水平线l4分别与圆1、圆5相切，则线段hm到直线l2与l4的距离相等，已知l4:y＝0，则h点和m点的纵坐标均为

所以线段o5m的长度为

在δho5m中，根据三角函数关系可以求得η，α为o5h与o5m的夹角，

因此，由以上结论可以分别求得g点和h点的坐标为

按照本发明的垂直自动泊车路径规划方法，采用几何作图的方法提高了垂直泊车路径规划的效率，并具有较好的鲁棒性，在仅有障碍车库的干扰下，均能够快速实现路径规划。本发明路径规划方法逻辑简单，换挡次数少，不同车辆起始状态均能完成路径规划，具有较高的工程实用价值。

本发明还提供一种垂直自动泊车路径规划的系统，包含了上述垂直自动泊车路径规划方法。本发明的垂直自动泊车路径规划系统包含了垂直自动泊车路径规划的方法，采用几何作图的方法提高了垂直泊车路径规划的效率，并具有较好的鲁棒性，在仅有障碍车库的干扰下，均能够快速实现路径规划。本发明路径规划方法逻辑简单，换挡次数少，不同车辆起始状态均能完成路径规划，具有较高的工程实用价值。

以上显示和描述了本发明的基本原理和主要特征和本发明的优点,对于本领域技术人员而言，显然本发明不限于上述示范性实施例的细节，而且在不背离本发明的精神或基本特征的情况下，能够以其他的具体形式实现本发明。因此，无论从哪一点来看，均应将实施例看作是示范性的，而且是非限制性的，本发明的范围由所附权利要求而不是上述说明限定，因此旨在将落在权利要求的等同要件的含义和范围内的所有变化囊括在本发明内。

此外，应当理解，虽然本说明书按照实施方式加以描述，但并非每个实施方式仅包含一个独立的技术方案，说明书的这种叙述方式仅仅是为清楚起见，本领域技术人员应当将说明书作为一个整体，各实施例中的技术方案也可以经适当组合，形成本领域技术人员可以理解的其他实施方式。