一种基于行车风险评估的自动驾驶汽车规划方法及系统

本发明涉及车辆运动预测，尤其是一种基于行车风险评估的自动驾驶汽车规划方法及系统。

背景技术：

1、自动驾驶汽车和先进的驾驶辅助系统因在高效、安全和清洁的交通系统中显示出显着的优势，越来越受到关注。轨迹规划是自动驾驶汽车系统的重要组成部分，直接影响自动驾驶交通安全。但目前保证自动驾驶汽车在复杂和不确定的交通场景中做出准确、高效、安全的决策和规划仍然是一个挑战。基于碰撞风险评估的有效运动规划方法，通过对候选路径进行风险评估，实时优化获取最优路径，可有效降低行车风险。

2、风险评估需要对周围车辆未来时域进行运动预测。目前针对车辆运动预测主要有基于学习的和基于物理模型的方法。基于学习模型主要依赖于机器学习方法，模型需要大量数据训练并且缺乏一定的解释性；而基于物理的运动模型由于长预测范围内的准确性较低且不适合复杂交通场景中的风险评估。

3、轨迹规划方面，针对目前大多数规划控制方法在运动规划层采用的运动学模型和跟踪控制层中车辆非线性动力学模型不一致，这可能导致车辆的控制效果偏差、甚至失稳的缺点。

4、综上所述，面对当前复杂和不确定性的交通场景，提出一种能够基于行车风险评估的自动驾驶汽车运动规划控制方法极为重要。

技术实现思路

1、针对现有技术的不足，本发明提供一种基于行车风险评估的自动驾驶汽车规划方法及系统，目的是在不确定性的风险场景下实现高效的智能驾驶。

2、本发明采用的技术方案如下：

3、本申请提供一种基于行车风险评估的自动驾驶汽车规划方法，包括：

4、感知预测层，获取周围车辆在世界坐标系下的历史运动轨迹,采用交互式多模型算法分析周围车辆预测时域内在各车道的概率分布，融合计算出车辆的目标位置；根据周围车辆当前位置及下一时刻目标位置，拟合生成预测时域内的预测轨迹；

5、轨迹重规划层，根据所述预测轨迹，将预测时域内的全局路径跟踪偏差、碰撞风险、本车车辆控制转角的变化作为代价目标建立自动驾驶车辆模型的非线性优化函数，求解获得局部最优轨迹；

6、跟踪控制层，采用运动控制目标函数来进行局部最佳轨迹跟踪控制，将计算的当前时刻最优车辆转角输入所述车辆动力学模型，实现车辆避障和循迹行驶。

7、进一步技术方案为：

8、所述采用交互式多模型算法分析周围车辆预测时域内在各车道的概率分布，预测得到周围车辆下一时刻横向位置，包括：

9、建立车道模型：

10、

11、式中，sk代表k时刻各车道的状态序列，i代表车道编号，n是总车道数，分别为k时刻下i车道的状态值、协方差以及置信概率；

12、计算混合概率和混合转移概率；

13、

14、

15、式中，混合概率表示从k-1时刻至k时刻周围车辆处于j车道的概率，混合转移概率表示从k-1时刻至k时刻周围车辆在i车道与j车道之间相互转移的概率；πij为状态转移矩阵中对应于i车道与j车道之间转移的概率，所述状态转移矩阵是由各车道两两之间的转移概率构成的矩阵；

16、

17、计算混合状态和混合协方差：

18、

19、

20、式中，混合状态混合协方差分别表示从k-1时刻至k时刻周围车辆处于j车道的更新后的状态值、以及周围车辆处于j车道的更新后的不确定度；

21、获得各车道的似然估计：

22、

23、

24、式中，表示j车道的似然估计，输入是混合状态与观测值zk的差值r为观测噪声，qk为k时刻的总状态估计值；

25、根据所述似然估计对车道模型概率更新获得后验概率

26、计算各车道的总状态估计值qk和总协方差pk：

27、

28、

29、总状态估计值qk和总协方差pk分别代表各车道状态值及协方差的加权平均值，上式中，t代表矩阵转置式中。

30、采用交互式多模型算法分析周围车辆预测时域内在各车道的概率分布时，假设纵向为匀速运动。因此根据周围车辆当前位置及下一时刻横向位置，拟合生成预测时域内的预测轨迹，包括：

31、采用如下三次多项式进行拟合：

32、

33、设置起始和终端航向角边界条件如下：

34、

35、式中，(xk,yk)表示k时刻周围车辆的当前位置，表示k时刻周围车辆偏航角，(xp,yp)表示p时刻预测的周围车辆位置，ai为系数。

36、所述自动驾驶车辆模型的非线性目标函数：

37、

38、

39、式中，第一项是指通过最小化参考路径跟踪误差来跟踪参考轨迹，ye(t+k,t)为本车预测时域的横向坐标，ydes(t+k,t)为全局路径，t代表当前时刻，k代表未来采样时刻。第二项表示最小化本车和周围车辆之间的碰撞风险，n表示周围车辆总数，np总数表示预测步长，为风险碰撞评估函数,分别为本车和周围车辆之间的纵向距离、横向距离，γ为衰减因子，α1、α2分别权重因子，ζ为系数，第三项是指最小化控制输入量消耗u。

40、所述运动控制目标函数及其约束条件为：

41、

42、其中，yref,local(t+i)为局部参考轨迹序列，δu(t+i)表示控制增量，q、r、p为权重矩阵，ε为权重因子，aδut+ut，umax，umin分别为控制量及其上、下限，δut，δumax，δumin分别为控制量增加量及其上、下限，yhc、yhc,max、yhc,min分别是输出量横向位置及其上、下限。

43、本申请还提供一种基于行车风险评估的自动驾驶汽车规划系统，包括：

44、感知预测层，获取周围车辆在世界坐标系下的历史运动轨迹,采用交互式多模型算法分析周围车辆预测时域内在各车道的概率分布，融合计算出车辆的目标位置；根据周围车辆当前位置及下一时刻目标位置，拟合生成预测时域内的预测轨迹；

45、轨迹重规划层，根据所述预测轨迹，将预测时域内的全局路径跟踪偏差、碰撞风险、本车车辆控制转角的变化作为代价目标建立自动驾驶车辆模型的非线性优化函数，求解获得局部最优轨迹；

46、跟踪控制层，采用运动控制目标函数来进行局部最佳轨迹跟踪控制，将计算的当前时刻最优车辆转角输入所述车辆动力学模型，实现车辆避障和循迹行驶。

47、本发明的有益效果如下：

48、通过对复杂行驶场景提出一种碰撞风险评估算法，建立本车安全高效的运行规划策略，从而有效考虑到场景的不确定性对本车运动控制及安全的影响。

49、将运动规划层和跟踪控制层分层处理的汽车规划框架，可分别进行任务处理和目标优化，提高算法的解算实时性和拓展性能。

50、本发明的其它特征和优点将在随后的说明书中阐述，并且，部分地从说明书中变得显而易见，或者通过实施本发明而了解。

技术特征：

1.一种基于行车风险评估的自动驾驶汽车规划方法，其特征在于，包括：

2.根据权利要求1所述的基于行车风险评估的自动驾驶汽车规划方法，其特征在于，所述采用交互式多模型算法分析周围车辆预测时域内在各车道的概率分布，预测得到周围车辆下一时刻横向位置，包括：

3.根据权利要求2所述的基于行车风险评估的自动驾驶汽车规划方法，其特征在于，采用交互式多模型算法分析周围车辆预测时域内在各车道的概率分布时，假设纵向为匀速运动。

4.根据权利要求1所述的基于行车风险评估的自动驾驶汽车规划方法，其特征在于，根据周围车辆当前位置及下一时刻横向位置，拟合生成预测时域内的预测轨迹，包括：

5.根据权利要求1所述的基于行车风险评估的自动驾驶汽车规划方法，其特征在于，所述自动驾驶车辆模型的非线性目标函数：

6.根据权利要求1所述的基于行车风险评估的自动驾驶汽车规划方法，其特征在于，所述运动控制目标函数及其约束条件为：

7.一种基于行车风险评估的自动驾驶汽车规划系统，其特征在于，包括：

技术总结
本发明涉及一种基于行车风险评估的自动驾驶汽车规划方法及系统，包括：获取周围车辆在世界坐标系下的历史运动轨迹,采用交互式多车道模型算法分析周围车辆预测时域内在各车道的概率分布，融合计算出车辆的目标位置；根据周围车辆当前位置及下一时刻目标位置，拟合生成预测时域内的预测轨迹；根据所获得的预测轨迹，将预测时域内的全局路径跟踪偏差、碰撞风险、本车车辆控制转角的变化作为代价目标建立自动驾驶车辆模型的非线性优化函数，求解获得局部最优轨迹；采用运动控制目标函数来进行局部最佳轨迹跟踪控制，将计算的当前时刻最优车辆转角输入车辆动力学模型，实现车辆避障和循迹行驶。本发明提高了循迹和避障的准确性和实时性。

技术研发人员：徐利伟,王磊,殷国栋
受保护的技术使用者：东南大学
技术研发日：
技术公布日：2024/1/13