本文继MPC运动学方法实现轨迹跟踪推导进行matlab代码实现,虽然你们找到的参考书都是simulink carsim联仿,我却坚持使用纯代码仿真,因为牛逼。 代码模板沿用了LQR轨迹跟踪算法Python/Matlab算法实现,直接复制下来就能用,拿去爽。 clc clear all Kp = 1.0 ; dt = 0.1 ;% [s] Length = 2.9 ;% [m] wheel base of vehicle Nx=3;%状态量的个数 Nu =2;%控制量的个数 Np =60;%预测步长 Nc=30;%控制步长 Row=10;%松弛因子 Q=100*eye(Nx*Np,Nx*Np)