本代码基于无人驾驶车辆模型预测控制第一版本第五章中的代码予以纠正，下面代码已经过测试。
通过函数来生成参考轨迹（双移线），然后用模型预测控制器去跟踪。
需要会员课程的朋友可以点击文末小卡片
加入 HUIYUAN 全年无限制学习后台（MPC相关矩阵的底层逻辑、纵向控制、非线性系统线性化处理及MPC算法动力学跟踪任何轨迹等）专属爆品课程（赠送会员专属全套答疑课程及全套爆品资源，且课程持续更新）！
代码段：
function [sys,x0,str,ts] = chapter5_2_2(t,x,u,flag)switch flag,case 0[sys,x0,str,ts] = mdlInitializeSizes; % Initializationcase 2sys = mdlUpdates(t,x,u); % Update discrete statescase 3sys = mdlOutputs(t,x,u); % Calculate outputs% case 4% sys = mdlGetTimeOfNextVarHit(t,x,u); % Get next sample time case {1,4,9} % Unused flagssys = [];otherwiseerror([unhandled flag = ,num2str(flag)]); % Error handlingend% End of dsfunc.%=========================
