一种适用于曲面地形自适应车辆轨迹跟踪控制方法及系统

本发明公开了一种适用于曲面地形自适应车辆轨迹跟踪控制方法及系统，包括以下步骤：S1.获取当前环境点云地图和参考轨迹。S2.在参考轨迹上选择关键点，并在这些关键点周围拟合局部地面方程。S3.以车辆的位置、速度和横摆角为状态量，以车辆的纵向加速度和前轮转角为控制量，建立流形模型预测控制器。S4.结合参考轨迹当前位置的曲率，调整流形模型预测控制器的目标函数权重。S5.结合车辆当前速度和车辆与参考轨迹的横向误差，使用PID控制器对控制器输出的加速度和前轮转角进行补偿。本发明所提出的方法，相比于现有的轨迹跟踪方法，能够显著地提高车辆在复杂曲面地形上的轨迹跟踪精度和控制的鲁棒性。