[发明专利]车辆的路径跟踪方法、装置、车辆及存储介质

说明书

本申请涉及一种车辆的路径跟踪方法、装置、车辆及存储介质，包括：基于建立的车辆误差微分模型和预设的李雅普诺夫函数的稳定性条件，得到车辆轨迹跟踪的控制律，基于车辆实际位姿与期望位姿之间的横纵向偏差和航向角偏差，确定至少一个目标模糊控制器，并利用目标模糊控制器对车辆轨迹跟踪的控制律进行模糊化处理，得到多个模糊输出量，利用预先建立的专家数据库和模糊规则库求解多个模糊输出量，得到实际输出量，据此求解车辆轨迹跟踪的控制律，将得到的控制律待定参数代入车辆轨迹跟踪的控制律输出当前控制量，并对车辆的横向路径进行跟踪。由此，解决了当前路径跟踪算法缺乏必要的控制稳定性理论，参数标定过于复杂等问题，增强用户体验感。

技术领域

本申请涉及车辆技术领域，特别涉及一种车辆的路径跟踪方法、装置、车辆及存储介质。

背景技术

智能化作为车辆新四化的代表之一，如今的技术发展势头愈发快速，其中车辆的自动驾驶技术是智能化开发的主阵地，从技术流向可以划分为感知、定位、预测、决策、规划及控制六大模块，其中控制模块起着直接与车辆执行器直接交互的关键作用，自动驾驶车辆控制模块可分为纵向速度控制和横向路径跟踪控制，其中横向路径跟踪控制的目的是控制车辆方向盘或前轮转角，使得车辆按照预定路径转向行驶，横向路径跟踪控制算法可以提高路径跟踪精度，进而提升驾乘人员的安全感和舒适性。

相关技术中，车辆的路径跟踪算法有基于PID控制的路径跟踪、基于纯跟踪的路径跟踪以及基于模型预测控制的路径跟踪等方法。其中，基于PID控制的路径跟踪算法根据目标路径信息和当前车辆位姿信息，计算路径误差，调整车辆当前位姿，消除稳态误差，使车辆平稳运行；基于纯跟踪的方法，通过预先设定目标轨迹中的一个点，计算圆弧路径，根据车辆实时运动状态，对车辆前进方向和速度进行动态调整，能够实现精度较高的路径跟踪控制；基于模型预测控制的路径规划，其控制策略为根据系统k时刻的状态和控制输入，来预测k+1时刻的输出，主要实现模型的预测作用。

然而，以上方法虽然能够实现较为准确的路径跟踪，但是算法效率较低，并且无法实现在路径跟踪的过程中实时动态避障。

发明内容

本申请提供一种车辆的路径跟踪方法、装置、车辆及存储介质，以解决当前路径跟踪算法缺乏必要的控制稳定性理论，参数标定过于复杂等问题，从而增强用户体验感。

本申请第一方面实施例提供一种车辆的路径跟踪方法，包括以下步骤：

建立车辆的误差微分模型，并基于所述车辆的误差微分模型和预设的李雅普诺夫函数的稳定性条件，得到车辆轨迹跟踪的控制律；

基于车辆实际位姿与期望位姿之间的横纵向偏差和航向角偏差，确定至少一个目标模糊控制器，并利用所述至少一个目标模糊控制器对所述车辆轨迹跟踪的控制律进行模糊化处理，得到多个模糊输出量，并利用预先建立的专家数据库和模糊规则库求解所述多个模糊输出量，得到实际输出量；以及

根据所述实际输出量求解所述车辆轨迹跟踪的控制律，得到控制律待定参数，将所述控制律待定参数代入所述车辆轨迹跟踪的控制律输出当前控制量，以根据所述当前控制量对车辆的横向路径进行跟踪。

根据上述技术手段，本申请基于“李雅普诺夫稳定性理论+模糊逻辑推理系统”的路径跟踪控制算法具有算法理论覆盖面广、理论支撑强等特点，提出一种兼具控制算法稳定性理论和参数模糊自适应的自动驾驶汽车路径跟踪控制方法，鲁棒性更高，增强了用户体验感。

进一步地，所述利用所述至少一个目标模糊控制器对所述车辆轨迹跟踪的控制律进行模糊化处理，得到多个模糊输出量，包括：

确定所述至少一个目标模糊控制器输入参数，所述输入参数包括距离偏差和航向角偏差；

根据距离偏差的值域和航向角偏差的值域分别将所述距离偏差和所述航向角偏差分为多个第一模糊集，并根据所述车辆轨迹跟踪的控制律中每个待定参数的值域将所述每个待定参数分为多个第二模糊集；