[发明专利]一种自动泊车路径障碍物碰撞检测方法、装置及系统

说明书

本发明公开了一种自动泊车路径障碍物碰撞检测方法、装置及系统。该方法包括：采用路径轮廓、车辆轮廓和障碍物轮廓，以几何方法进行圆弧形路径障碍物碰撞检测和/或直线路径障碍物碰撞检测。该系统包括用于采用路径轮廓、车辆轮廓和障碍物轮廓，以几何方法进行圆弧形路径障碍物碰撞检测和/或直线路径障碍物碰撞检测的碰撞检测模块。该装置包括存储器以及用于采用路径轮廓、车辆轮廓和障碍物轮廓，以几何方法进行圆弧形路径障碍物碰撞检测和/或直线路径障碍物碰撞检测的处理器。通过使用本发明，能够提高障碍物碰撞检测效率，简化步骤且准确率高。本发明作为一种自动泊车路径障碍物碰撞检测方案可广泛应用于路径规划技术领域中。

技术领域

本发明涉及自动检测技术，尤其涉及一种在自动泊车过程中，对泊车路径进行障碍物碰撞检测的方法、装置及系统。

背景技术

近年来，随着汽车智能化的不断发展，自动泊车技术得到了广泛的研究和应用。自动泊车技术可以帮助人们安全可靠的完成泊车，其采用车载传感器检测可用车位，然后规划一条可执行路径，随后则自动控制车辆跟随该路径完成泊车。可见，路径规划是自动泊车技术的关键一环，其基本要求包括有：路径可行、安全无碰撞、算法简洁高效。其中，所述的安全无碰撞、算法简洁高效对路径规划算法尤为至关重要。然而，目前常用的自动泊车路径规划方法中的碰撞检测，其存有检测效率低下的问题，这样则难以满足自动泊车路径规划的要求。

发明内容

为了解决上述技术问题，本发明的第一目的是提供一种高效的自动泊车路径障碍物碰撞检测方法。

本发明的第二目的是提供一种高效的自动泊车路径障碍物碰撞检测装置。

本发明的第三目的是提供一种高效的自动泊车路径障碍物碰撞检测系统。

本发明所采用的第一技术方案是：一种自动泊车路径障碍物碰撞检测方法，该方法包括以下步骤：

采用路径轮廓、车辆轮廓和障碍物轮廓，以几何方法进行圆弧形路径障碍物碰撞检测和/或直线路径障碍物碰撞检测；

其中，所述路径轮廓为车辆沿路径从起点位姿行驶至终点位姿所形成的边界轮廓，所述路径轮廓包括圆弧形的路径轮廓和/或直线形的路径轮廓，所述车辆轮廓为多边形，所述障碍物轮廓为线段。

进一步，所述采用路径轮廓、车辆轮廓和障碍物轮廓，以几何方法进行圆弧形路径障碍物碰撞检测这一步骤，其包括以下子步骤：

判断障碍物是否满足明显不碰撞条件；

判断障碍物线段与圆弧形的路径轮廓之间是否相交；

判断障碍物线段是否位于圆弧形的路径轮廓内；

判断障碍物线段与终点车辆轮廓之间是否相交，其中，所述终点车辆轮廓指的是位于终点位姿的车辆轮廓；

判断障碍物线段是否位于终点车辆轮廓内；

根据判断结果，从而判断出障碍物是否与路径发生碰撞。

进一步，所述明显不碰撞条件包括以下任意一个条件：

障碍物线段的两个端点与圆弧形的路径轮廓所对应的圆心之间的距离均小于第一半径，所述第一半径为圆弧形的路径轮廓中内侧圆弧段所对应的半径；

圆弧形的路径轮廓所对应的圆心到障碍物线段的最小距离大于第二半径，所述第二半径为圆弧形的路径轮廓中外侧圆弧段所对应的半径；

障碍物线段的两个端点均位于第四圆心角的范围内，所述第四圆心角为规划路径所对应的圆心角的组角。

进一步，所述判断障碍物线段与圆弧形的路径轮廓之间是否相交这一步骤，其包括以下子步骤：