标签:begin right end matrix 推导 求解 cdots MPC vdots
参考论文为《A Predictive Controller for Autonomous Vehicle Path Tracking》。假设我们要求解的代价函数\(J\)为:
\[J=X'QX+U'RU\:(1) \]其中,\(X\)为未来\(N_p\)次的状态预测序列,\(U\)为未来\(N_u\)次的控制序列,亦即表示如下:
\[X=\left[\begin{matrix}x(k+1|k)\\x(k+1|k)\\\vdots&\\x(k+N_p|k)\end{matrix}\right] \]\[U=\left[\begin{matrix}u(k|k)\\u(k+1|k)\\\vdots&\\u(k+N_u-1|k)\end{matrix}\right] \]依据状态方程\(x(k+1)=Ax(k)+Bu(k)\),依次待入解得\(x(k+1),x(k+1),\cdots\)我们可以得到:
\[X=P_xx(k|k)+H_xU\:(2) \]其中\(P_x\)如下:
\[P_x=\left[\begin{matrix}A\\A^2\\\vdots&\\A^{N_p}\end{matrix}\right] \]而\(H_x\)如下:
\[H_x=\left[\begin{matrix}B&0&\cdots&0\\AB&B&\cdots&0\\\vdots&\vdots&\ddots&\vdots\\A^{N_p-1}B&\cdots&\cdots&B\end{matrix}\right] \]我们将\((2)\)待入\((1)\)可以得到:
\[J=C+U'(H_x'QH_x+R)U+x(k|k)'P'QH_xU+U'H_x'QPx(k|k)\:(3) \]通常\(Q\)为对角阵,因此\((3)\)可以化简为:
\[J=C+U'(H_x'QH_x+R)U+2x(k|k)'P'QH_xU\:(4) \]其中\(C\)为常数项,可以忽略,这样便有了标准二次规划\(Y=X'HX+fX\)的形式,可以直接进行求解了。
标签:begin,right,end,matrix,推导,求解,cdots,MPC,vdots 来源: https://www.cnblogs.com/TamakiIroha/p/16023681.html
本站声明: 1. iCode9 技术分享网(下文简称本站)提供的所有内容,仅供技术学习、探讨和分享; 2. 关于本站的所有留言、评论、转载及引用,纯属内容发起人的个人观点,与本站观点和立场无关; 3. 关于本站的所有言论和文字,纯属内容发起人的个人观点,与本站观点和立场无关; 4. 本站文章均是网友提供,不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属;如您发现该文章侵犯了您的权益,可联系我们第一时间进行删除; 5. 本站为非盈利性的个人网站,所有内容不会用来进行牟利,也不会利用任何形式的广告来间接获益,纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。