[发明专利]一种车辆轨迹的规划方法及规划系统

权利要求书

1.一种车辆轨迹的规划方法，其特征在于，所述车辆包括通信连接的主控制器和从控制器，所述方法应用于所述从控制器，所述方法包括：

实时接收来自所述主控制器的目标障碍物的运动信息；其中，所述目标障碍物是所述主控制器从待规划车辆周围的各个障碍物中确定出的最危险的障碍物；

在检测到所述主控制器失效且所述车辆的电子制动系统处于正常状态时，根据最新接收到的所述目标障碍物的运动信息判断所述车辆的行驶轨迹上是否存在所述目标障碍物；

当判定所述行驶轨迹上存在所述目标障碍物时，根据最新接收到的所述目标障碍物的运动信息规划所述车辆的停车轨迹。

2.根据权利要求1所述的规划方法，其特征在于，所述根据最新接收到的所述目标障碍物的运动信息规划车辆的停车轨迹的步骤，具体包括：

根据所述目标障碍物的运动信息计算出所述目标障碍物的运动轨迹；

获取车辆的当前速度和当前位置；

针对预设的多个减速度中的每个减速度，根据车辆的所述当前速度、当前位置以及所述减速度，计算该减速度对应的停车轨迹；

将所述目标障碍物的运动轨迹与每一个所述停车轨迹进行比较；

选择与所述目标障碍物的运动轨迹没有交点的所述停车轨迹作为车辆最终的停车轨迹。

3.根据权利要求2所述的规划方法，其特征在于，还包括：

在检测到所述主控制器未失效时处于待机状态，以便所述主控制器根据目标障碍物的运动信息规划车辆的行驶轨迹，并根据车辆的当前位置和所述目标障碍物的当前位置判断车辆与所述目标障碍物是否会发生碰撞，在判定车辆与所述目标障碍物会发生碰撞时根据所述目标障碍物的运动信息规划车辆的停车轨迹。

4.根据权利要求3所述的规划方法，其特征在于，所述判断车辆与所述目标障碍物是否会发生碰撞的检测方法为：

将车辆和所述目标障碍物虚拟化为矩形，并将车辆的纵向中心线和横向中心线、所述目标障碍物的纵向中心线和横向中心线设为四个投影线；

若车辆和所述目标障碍物在四个投影线上投影后均满足公式A，则判定车辆会与所述目标障碍物发生碰撞；其中，

公式A：ap≤0.5*(bp+cp)；

ap表示车辆的中心与所述目标障碍物的中心的连线在投影线上的投影长度；

bp表示车辆在投影线上的投影长度的一半；

cp表示所述目标障碍物在投影线上的投影长度的一半。

5.根据权利要求1所述的规划方法，其特征在于，还包括：

在所述车辆无法正常规划行驶轨迹时，根据所述目标障碍物的运动信息规划车辆的停车轨迹。

6.根据权利要求5所述的规划方法，其特征在于，在所述车辆无法正常规划行驶轨迹时，所述根据所述目标障碍物的运动信息规划车辆的停车轨迹的步骤，具体包括：

判断车辆的电子制动系统是否发生故障；

若所述电子制动系统发生故障且车辆的速度大于预设阈值同时车辆的电池电量小于预设电量时，控制车辆进行能量回收制动和控制电子驻车制动系统进行制动；若所述电子制动系统发生故障且车辆的速度不大于所述预设阈值或车辆的电量不小于预设电量时直接控制电子驻车制动系统进行制动。

7.根据权利要求2所述的规划方法，其特征在于，

当所述行驶轨迹上不存在所述目标障碍物时，选择多个预设的减速度中的任一减速度在当前的行驶轨迹上停车。

8.根据权利要求2所述的规划方法，其特征在于，根据以下公式计算出所述目标障碍物的运动轨迹：

s＝s1+v*t+0.5*a*t²；

其中，v＝v1+a*t；

s1表示所述目标障碍物的当前位置；

a表示所述目标障碍物的加速度；

t表示未来某一时刻；

v表示所述目标障碍物的未来某一时刻的速度；

v1表示所述目标障碍物的当前速度；

s表示所述目标障碍物的未来某一时刻的位置。