3训练模型代码详解_代码详解——无人驾驶车辆模型预测控制3.3.3参考路径更改...

前文注释了《无人驾驶车辆模型预测控制》3.3.3的代码，例程代码中的参考路径是一条直线路径，如果希望将该路径更改为更为复杂的参考路径，可以对原生成参考路径的代码进行替换。

将《无人驾驶车辆模型预测控制》3.3.3源代码中的：

for k=1:1:N

   Xout(k,1)=k*T;  %横坐标

   Xout(k,2)=2;  %纵坐标

   Xout(k,3)=0;  %航向角

   Tout(k,1)=(k-1)*T;  %参考轨迹时间

end

替换为：

for k=1:1:N

    if k<200

        Xout(k,1)=k*T;  %横坐标

        Xout(k,2)=2;  %纵坐标

        Xout(k,3)=0;  %航向角

        Tout(k,1)=(k-1)*T;  %参考轨迹时间

    elseif k<514

        Xout(k,1)=10+10*sin( 0.1*(k-200)*T); 

        Xout(k,2)=12-10*cos(0.1*(k-200)*T); 

        Xout(k,3)=0.1*(k-200)*T;

        Tout(k,1)=(k-1)*T;

    elseif