[发明专利]车辆局部路径规划方法、自动驾驶系统和自动驾驶车辆

权利要求书

1.一种车辆局部路径规划方法，其特征在于，包括：

获取道路信息和障碍物信息；

根据所述道路信息和所述障碍物信息生成Frenet坐标系下的备选路径集合；

根据预设损失函数获取所述备选路径集合中每条路径的运行损失量；

基于人工势场法，根据所述障碍物信息计算斥力损失量；

根据所述运行损失量和所述斥力损失量在所述备选路径集合中确定目标路径；

根据所述目标路径控制车辆的行驶。

2.根据权利要求1所述的车辆局部路径规划方法，其特征在于，根据所述道路信息生成Frenet坐标系下的备选路径集合，包括：

根据所述道路信息确定道路中心线，并以道路中心线作为参考线，以所述车辆为原点建立Frenet坐标系，其中，以所述参考线的切向向量和法向向量作为坐标轴；

基于所述Frenet坐标系获得纵向轨迹规划和横向轨迹规划；

根据所述纵向轨迹规划和所述横向轨迹规划进行轨迹拟合，以生成所述备选路径集合。

3.根据权利要求2所述的车辆局部路径规划方法，其特征在于，基于所述Frenet坐标系获得纵向轨迹规划和横向轨迹规划，包括：

在所述Frenet坐标系下确定所述车辆的横向初始配置和纵向初始配置；

基于所述横向初始配置，以横向位移量(dmin，dmax)和制动时间(Tmin，Tmax)作为横向目标配置进行轨迹采样，以获得所述横向轨迹规划；

基于所述纵向初始配置，以纵向速度和纵向加速度作为纵向目标配置进行轨迹采样，以获得所述纵向轨迹规划。

4.根据权利要求1所述的车辆局部路径规划方法，其特征在于，基于人工势场法，根据所述障碍物信息计算斥力损失量，包括：

所述障碍物信息包括所述车辆与障碍物之间的距离；

所述斥力损失量可以通过以下公式获得：

r＝K₀/p²

其中，r为所述斥力损失量，K₀为斥力系数，p为所述车辆与障碍物之间的距离。

5.根据权利要求1所述的车辆局部路径规划方法，其特征在于，所述运行损失量包括横向运行损失量和纵向运行损失量；

根据所述运行损失量和所述斥力损失函数在所述备选路径集合中确定目标路径，包括：

将每条备选路径的所述横向运行损失量、每条备选路径的所述纵向运行损失量和所述斥力损失量之和作为每条备选路径的最终损失量；

确定所有备选路径的最终损失量中的最小损失量；

将所述最小损失量对应的备选路径作为所述目标路径。

6.根据权利要求5所述的车辆局部路径规划方法，其特征在于，所述预设损失函数可以通过以下公式表示：

Cd＝K_i*J+K_d*d

其中，Cd为所述预设损失函数，K_i、K_d为常数，J为纵向速度损失或横向速度损失，d为横向位置损失。

7.一种自动驾驶系统，其特征在于，包括：

至少一个处理器；

与至少一个所述处理器通信连接的存储器；

其中，所述存储器中存储有可被至少一个所述处理器执行的计算机程序，至少一个所述处理器执行所述计算机程序时实现权利要求1-6任一项所述的车辆局部路径规划方法。

8.一种自动驾驶系统，其特征在于，包括：

第一获取模块，用于获取道路信息和障碍物信息；

生成模块，用于根据所述道路信息生成Frenet坐标系下的备选路径集合；

第二获取模块，用于根据预设损失函数获取所述备选路径集合中每条路径的运行损失量；

计算模块，用于基于人工势场法，根据所述障碍物信息计算斥力损失量；

确定模块，用于根据所述运行损失量和所述斥力损失量在所述备选路径集合中确定目标路径；

控制模块，用于根据所述目标路径控制车辆的行驶。