[发明专利]一种智能车辆自主行驶动态轨迹规划方法及系统

摘要

本发明公开了一种智能车辆自主行驶动态轨迹规划方法，属于智能交通技术领域。本发明方法包括：步骤1、通过最优控制方法搜索数学模型的最优解生成智能车辆的轨迹；步骤2、提取步骤1中所生成轨迹的特征；步骤3、判断所述特征是否满足预设的约束条件，如是，则以该轨迹作为最终的输出轨迹；如否，则根据预设的权重调整规则对权重、、进行调整后，转至步骤1。本发明还公开了一种智能车辆自主行驶动态轨迹规划系统，包括轨迹生成模块、特征提取模块、估计模块、权重调整模块。相比现有技术，本发明具有更强的学习能力及对未知环境的适应性。

主权项

1.一种智能车辆自主行驶动态轨迹规划方法，其特征在于，包括以下步骤：步骤1、通过最优控制方法搜索以下模型的最优解生成所述智能车辆的轨迹： x(t₀)=x₀，x(t_f)=x_f其中，m是智能车辆的重量，c_s是智能车辆的摩擦系数，u(t)是智能车辆行驶时输入的控制量，x＇(t)是车辆的行驶速度，x＂(t)是车辆的行驶加速度，J(u)是最优控制方法的评价函数，t是车辆的行驶时间，t₀是车辆的初始行驶时间，t_f是车辆的终止行驶时间，是车辆行驶中消耗的总能量，j是车辆在行驶过程中有控制输入量u(t)时的不同采样时刻，length(u)w₁是消耗能量的权重，w₂是时间的权重，是智能车距离障碍物边缘的最大值，是智能车距离障碍物边缘的距离，w₃是距离障碍物距离的权重，r_i是智能车距离障碍物中心的距离，i是障碍物的中心，{O}是障碍物的集合，R_i是智能车在障碍物边缘时距离障碍物中心的距离，LIM是限值，K是的值，c₁、c₂、c₃、c₄、c₅、c₆、c₇、c₈是常系数，x₀是车辆的初始行驶位置，x_f是车辆的终止行驶位置；步骤2、提取步骤1中所生成轨迹的特征；步骤3、判断所述特征是否满足预设的约束条件，如是，则以该轨迹作为最终的输出轨迹；如否，则根据预设的权重调整规则对权重、、进行调整后，转至步骤1。