一种基于最优航向角的长轴车辆路径跟踪控制方法

摘要

本发明公开一种基于最优航向角的长轴车辆路径跟踪控制方法。包括如下步骤：根据长轴车辆的运动学模型选取控制系统的状态量与控制量，建立参考状态点的跟踪误差方程，建立长轴车辆与参考路径的整体偏差模型，根据坐标变换的方法求解得到整体偏差的最值从而确定长轴车辆在转向中的最优航向角，基于该航向角与实际车辆之间的位姿误差方程建立MPC路径跟踪控制器，通过求解控制器中的代价函数确定长轴车辆在转向过程中的最优前轮转角，进而控制车辆沿着参考路径行驶。本发明实现了长轴车辆路径跟踪控制而且使得前轮行驶轨迹更加靠近参考路径，有效的减小长轴车辆在转向过程中前轮的扫略面积，提高了长轴车辆在狭窄区域的通过性。