MPC模型预测控制数学推导以及MatLab实现

这篇具有很好参考价值的文章主要介绍了MPC模型预测控制数学推导以及MatLab实现。希望对大家有所帮助。如果存在错误或未考虑完全的地方,请大家不吝赐教,您也可以点击"举报违法"按钮提交疑问。

最优化控制

研究动机:在一定的约束条件下达到最优的系统表现。

MPC模型预测控制数学推导以及MatLab实现

关于最优的,举个车变道的例子,从表面上来看,轨迹1行车轨迹很平滑,很舒适,没有什么急转弯;轨迹2是快速的,但是假如前面有了障碍物,也需要一种快速的紧急避障能力,所以关于最优的,还得分析特定的情况。

SISO系统

MPC模型预测控制数学推导以及MatLab实现
MPC模型预测控制数学推导以及MatLab实现

轨迹跟踪的性能表示: ∫ 0 t exp ⁡ ( 2 )   d t \int_{0}^{t} \exp(2)\, dt 0texp(2)dt–>其结果越小,追踪的就越好。
(关于为什么采用 e x p ( 2 ) exp(2) exp(2)的解释:误差有正有负, e x p ( 2 ) exp(2) exp(2)可以把正负误差都统计上,外加绝对值也是可行的。至于为什么是积分结果越小,追踪的就好的解释:控制器在变化,看哪个控制器的误差积分最小,哪个控制器最优)

输入: ∫ 0 t   u 2   d t \int_{0}^{t} \ u^2\, dt 0t u2dt->积分结果越小,输入越小。

物理条件:能耗最低的,可以用很小的能耗达到所需条件。

所以可以构建一个Cost Function,如 J = ∫ 0 t   q e 2 + r u 2   d t J = \int_{0}^{t} \ {qe}^2+{ru}^2\, dt J=0t qe2+ru2dtLQR控制

最优化的过程就是对 u u u进行设计,使得 m i n ( J ) min(J) min(J)

q > > r q >> r q>>r:则说明更看重误差
r > > q r >> q r>>q:则说明更看重输入

MIMO系统

公式太难打了,看我手写图吧。

MPC模型预测控制数学推导以及MatLab实现
需要注意的是,上方我写的符号冲突了, y 1 − r 1 y_{1} - r_{1} y1r1当中的 r 1 r_{1} r1是参考值( r 2 r_{2} r2同理),看上方的控制框图中的 r r r。而下方的 u T R u u^{T}Ru uTRu中的 r 1 , r 2 r_{1},r_{2} r1,r2是调节参数。

MPC基本概念

通过模型来预测系统在某一未来时间段内的表现来进行优化控制,多用于数位控制。

常用的是离散形式的表达式: X k + 1 = A X k + B u k X_{k+1} = AX_{k} + Bu_{k} Xk+1=AXk+Buk

MPC的步骤主要有三步:

在k时刻:

Step1:估计/测量读取当前系统状态: y k y_k yk
下图中的参数,分别是输入 u u u以及输出 y y y r r r是其参考值。

MPC模型预测控制数学推导以及MatLab实现

Step2:基于 u k , u k + 1 . . . . . . u k + N u_k,u_{k+1}......u_{k+N} uk,uk+1......uk+N来进行最优化可以看出,下方当中的控制区间当中 u k u_k uk等参数的选择,就是一个最优化的过程。

MPC模型预测控制数学推导以及MatLab实现

其Cost Function就是如下:
J = ∑ k N − 1 E k T Q E K + u k T R u k + E N T F E N J = \sum\limits_{k}\limits^{N-1}{E_{k}^TQE_{K}+u_{k}^TRu_{k}+E_{N}^TFE_{N}} J=kN1EkTQEK+ukTRuk+ENTFEN
其中最后一项, E N T F E N E_{N}^TFE_{N} ENTFEN代表的是最终时刻的最末一点误差的代价函数。

要做的就是把代价函数最优化找到它的最小值。

Step3:这一步是最关键的,上方说过了基于 u k , u k + 1 . . . . . . u k + N u_k,u_{k+1}......u_{k+N} uk,uk+1......uk+N来进行最优化,但是在MPC当中,算了这么多,只取 u k u_k uk,看N步走一步的思想,这是因为预测的模型很难完美描述现实当中的系统,在现实当中的系统可能会有扰动。那是不是之前的计算就白算了呢?没有白算,若不计算后面的 u k + 1 u_{k+1} uk+1之类的项目,就无法保证 k k k时刻能达到最优。

例如,你预测的是蓝色线段,但是实际的可能是蓝色线段上方的一个红色线段,有扰动。
MPC模型预测控制数学推导以及MatLab实现

滚动优化

进行刚刚的一个轮回选择完 u k u_k uk进行优化后,就是在发现实际有偏差之后,以当前的实际为基础,把之前整个黄色框图整体向未来移动一步,再进行优化设计(之前预测的蓝色线段就不要了)。
MPC模型预测控制数学推导以及MatLab实现

MPC模型预测控制数学推导以及MatLab实现

所以MPC对计算性能有要求,因为每一步都要进行最优化的计算。

最优化建模

以下公式太多,采用手写笔记替代,必要时会进行文字说明。

MPC模型预测控制数学推导以及MatLab实现

二次规划

MPC模型预测控制数学推导以及MatLab实现

因为二次规划的求解已经非常成熟了(MatLab/Python),所以可以把模型化成这样的一般形式,这样的话就可以扔到里面进行计算了。

MPC模型预测控制数学推导以及MatLab实现

关于为什么是 u k + N − 1 u_{k+N-1} uk+N1 x k + N x_{k+N} xk+N等维度不一致的问题,因为 x k + N x_{k+N} xk+N是由 u k + N − 1 u_{k+N-1} uk+N1推出来的,所以少了一个。
MPC模型预测控制数学推导以及MatLab实现

记住这个绿色的 X k X_k Xk以及蓝色的 u k u_k uk

MPC模型预测控制数学推导以及MatLab实现

MPC模型预测控制数学推导以及MatLab实现

就是将初始条件代入 A X + B U AX+BU AX+BU的方程中,计算出下一时刻后,就把新的时刻值再代入到之前的方程,再计算出下一时刻。反复计算,直到计算出 X ( k + N ∣ k ) {X}(k+N|k) X(k+Nk),预测空间结束。

化简结果:
MPC模型预测控制数学推导以及MatLab实现

得到了绿色的 X k = M x k + C u k X_k = Mx_k + Cu_k Xk=Mxk+Cuk,把这个公式代入到下图当中的 J J J中进行化简。
记住,这里的 Q , R Q,R Q,R都是对角矩阵。
MPC模型预测控制数学推导以及MatLab实现

MPC模型预测控制数学推导以及MatLab实现

因为 J J J是一个数, 1 ∗ 1 1*1 11的形式,所以中间两项转置也就是本身,可以进行合并。
就是说J是1乘1的矩阵,它的这几个分式子也只能是1乘1的加起来才是1乘1的,所以转置前后相等。

算了这么久,得到了新的代价函数: J = x k T G x k + 2 x k T E u k + u k T H u k J=x_k^TGx_k+2x_k^TEu_k+u_k^THu_k J=xkTGxk+2xkTEuk+ukTHuk,最开始的一项只是初始状态,对最优化部分不影响,有了模型后就能进行模型预测控制部分了。
二次规划的一般形式为: m i n z T Q z + c T z min z^TQz+c^Tz minzTQz+cTz
与二次规划的一般形式进行对比,发现是一模一样的

MPC建模

状态空间的离散表达形式:
MPC模型预测控制数学推导以及MatLab实现

一个SISO系统的例子:
MPC模型预测控制数学推导以及MatLab实现

各向量维度

维度的问题需要清楚的了解。

X k X_k Xk维度: ( N + 1 ) n ∗ 1 (N+1)n*1 (N+1)n1

MPC模型预测控制数学推导以及MatLab实现

U k U_k Uk维度: N p ∗ 1 Np*1 Np1
MPC模型预测控制数学推导以及MatLab实现

M M M的维度: ( N + 1 ) n ∗ n (N+1)n*n (N+1)nn
MPC模型预测控制数学推导以及MatLab实现

C C C的维度: ( N + 1 ) n ∗ N p (N+1)n*Np (N+1)nNp
MPC模型预测控制数学推导以及MatLab实现

之前最优化建模当中推得的表达式为: X ( k ) = M x ( k ) + C U ( k ) X(k)=Mx(k)+CU(k) X(k)=Mx(k)+CU(k)
MPC模型预测控制数学推导以及MatLab实现

接下来,就用SISO的例子,具体算一下。

MPC模型预测控制数学推导以及MatLab实现

MPC模型预测控制数学推导以及MatLab实现

MPC模型预测控制数学推导以及MatLab实现

MPC模型预测控制数学推导以及MatLab实现

可以化简成以下形式。
MPC模型预测控制数学推导以及MatLab实现

现在只包含了输入项以及初始状态项,所以对其进行最优化,就能得到输入的一个最优化结果了。以上是非常关键的一点。

MPC模型预测控制数学推导以及MatLab实现


代码实现

%% 清屏

~~~~~~~~~~~~~~~~~~~~~~~~~~~MPC_Test.m~~~~~~~~~~~~~~~~~~~~~~~~~~

~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~

%% 清屏

clear ; 

close all; 

clc;

%%%%%%%%%%%%%%%%%%%%%%%%%%

%% 第一步,定义状态空间矩阵

%% 定义状态矩阵 A, n x n 矩阵

A = [1 0.1; -1 2];

n= size (A,1);

%% 定义输入矩阵 B, n x p 矩阵

B = [ 0.2 1; 0.5 2];

p = size(B,2);

%% 定义Q矩阵,n x n 矩阵

Q=[100 0;0 1];

%% 定义F矩阵,n x n 矩阵

F=[100 0;0 1];

%% 定义R矩阵,p x p 矩阵

R=[1 0 ;0 .1];

%% 定义step数量k

k_steps=100; 

%% 定义矩阵 X_K, n x k 矩 阵

X_K = zeros(n,k_steps);

%% 初始状态变量值, n x 1 向量

X_K(:,1) =[20;-20];

%% 定义输入矩阵 U_K, p x k 矩阵

U_K=zeros(p,k_steps);



%% 定义预测区间K

N=5;

%% Call MPC_Matrices 函数 求得 E,H矩阵 

[E,H]=MPC_Matrices(A,B,Q,R,F,N);



%% 计算每一步的状态变量的值

for k = 1 : k_steps 

%% 求得U_K(:,k)

U_K(:,k) = Prediction(X_K(:,k),E,H,N,p);

%% 计算第k+1步时状态变量的值

X_K(:,k+1)=(A*X_K(:,k)+B*U_K(:,k));

end



%% 绘制状态变量和输入的变化

subplot  (2, 1, 1);

hold;

for i =1 :size (X_K,1)

plot (X_K(i,:));

end

legend("x1","x2")

hold off;

subplot (2, 1, 2);

hold;

for i =1 : size (U_K,1)

plot (U_K(i,:));

end

legend("u1","u2")

~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~

~~~~~~~~~~~~~~~~~~~~~~~MPC_Matrices.m~~~~~~~~~~~~~~~~~~~~

function  [E , H]=MPC_Matrices(A,B,Q,R,F,N)



n=size(A,1);   % A 是 n x n 矩阵, 得到 n

p=size(B,2);   % B 是 n x p 矩阵, 得到 p

%%%%%%%%%%%%

M=[eye(n);zeros(N*n,n)]; % 初始化 M 矩阵. M 矩阵是 (N+1)n x n的, 

                         % 它上面是 n x n 个 "I", 这一步先把下半部

                         % 分写成 0 

C=zeros((N+1)*n,N*p); % 初始化 C 矩阵, 这一步令它有 (N+1)n x NP 个 0

% 定义M 和 C 

tmp=eye(n);  %定义一个n x n 的 I 矩阵

% 更新M和C

for i=1:N % 循环,i 从 1到 N

    rows =i*n+(1:n); %定义当前行数,从i x n开始,共n行 

    C(rows,:)=[tmp*B,C(rows-n, 1:end-p)]; %将c矩阵填满

    tmp= A*tmp; %每一次将tmp左乘一次A

    M(rows,:)=tmp; %将M矩阵写满

end 



% 定义Q_bar和R_bar

Q_bar = kron(eye(N),Q);

Q_bar = blkdiag(Q_bar,F);

R_bar = kron(eye(N),R); 



% 计算G, E, H

G=M'*Q_bar*M; % G: n x n

E=C'*Q_bar*M; % E: NP x n

H=C'*Q_bar*C+R_bar; % NP x NP 



end

~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~

~~~~~~~~~~~~~~~~~~~~~~~Prediction.m~~~~~~~~~~~~~~~~~~~~~

function u_k= Prediction(x_k,E,H,N,p)

U_k = zeros(N*p,1); % NP x 1

U_k = quadprog(H,E*x_k);

u_k = U_k(1:p,1); % 取第一个结果

end

~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ 

MPC模型预测控制数学推导以及MatLab实现

可以看出随着K的增加,是逐渐趋向于0的。要侧重于 x 1 , x 2 , u 1 , u 2 x_1,x_2,u_1,u_2 x1,x2,u1,u2可以修改代码当中对应的权重系数。
以上不光适用于SISO,也适用于MIMO。文章来源地址https://www.toymoban.com/news/detail-405278.html

到了这里,关于MPC模型预测控制数学推导以及MatLab实现的文章就介绍完了。如果您还想了解更多内容,请在右上角搜索TOY模板网以前的文章或继续浏览下面的相关文章,希望大家以后多多支持TOY模板网!

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处: 如若内容造成侵权/违法违规/事实不符,请点击违法举报进行投诉反馈,一经查实,立即删除!

领支付宝红包 赞助服务器费用

相关文章

  • MATLAB - 利用非线性模型预测控制(Nonlinear MPC)来控制四旋翼飞行器

    本示例展示了如何利用非线性模型预测控制(MPC)为四旋翼飞行器设计一个跟踪轨迹的控制器。 四旋翼飞行器有四个向上的旋翼。从四旋翼飞行器的质量中心出发,旋翼呈等距离的正方形排列。四旋翼飞行器动力学数学模型采用欧拉-拉格朗日方程 [1]。 四旋翼飞行器的十二种

    2024年01月22日
    浏览(66)
  • 【轨迹跟踪】模型预测控制MPC无人机轨迹跟踪【含Matlab源码 3958期】

    获取代码方式1: 完整代码已上传我的资源:【轨迹跟踪】基于matlab模型预测控制MPC无人机轨迹跟踪【含Matlab源码 3958期】 点击上面蓝色字体,直接付费下载,即可。 获取代码方式2: 付费专栏Matlab物理应用(初级版) 备注: 点击上面蓝色字体 付费专栏Matlab物理应用(初级

    2024年02月21日
    浏览(46)
  • 模型预测控制(MPC)解析(一):模型

    1.1 预测控制的日常应用         模型预测控制的设计目标是计算未来控制变量u的轨迹,以优化未来的系统输出y。优化过程在一个有限的时间窗口进行,并且利用优化时间窗口开始时的系统信息进行优化。为了理解预测控制的基本思想,以一个日常工作为例来进行说明。

    2024年02月02日
    浏览(45)
  • mpc模型预测控制原理详解

    本文是对mpc模型预测控制学习的记录,主要参照了DR_CAN老师的视频进行学习。视频专栏链接:DR_CAN老师mpc视频专栏。在这篇博客中博主也针对DR_CAN老师的讲解做了详尽的笔记和代码实现。读者可以相结合地进行学习。 MPC算法主要包括以下三步: 估计/测量读取当前系统状态

    2023年04月14日
    浏览(45)
  • MPC(模型预测控制)-Simulink仿真

    一、为什么使用MPC控制器? ① MPC可以处理多输入耦合控制多输出的问题: ② MPC可以处理对于控制量有约束的问题 比如,驾驶汽车的时候,汽车速度和转角都有上限 ③ MPC具有预测效果 即MPC考虑的不是根据当前参考值进行控制,而是根据预测时间内的参考去预测当前的控制量,

    2024年01月25日
    浏览(41)
  • 路径跟踪算法之模型预测控制(MPC)跟踪

    模型预测控制(以下简称 MPC)是一种依赖于系统模型进行数学优化的复杂控制器。它利用优化算法计算有限时间范围内一系列的控制输入序列,并优化该序列,但控制器仅执行序列中的第一组控制输入,然后再次重复该循环。MPC 主要分为 3 个关键步骤:模型预测、滚动优化

    2024年01月23日
    浏览(50)
  • 【自动驾驶】模型预测控制(MPC)实现轨迹跟踪

    bilibili的DR_CAN讲解的MPC模型预测控制器 知乎上一个比较通俗易懂的解释 模型预测控制 轨迹跟踪模型预测控制(MPC)原理与python实现 DR_CAN笔记MPC MPC控制笔记 模型预测控制(MPC)的核心思想就是以优化方法求解最优控制器,其中优化方法大多时候采用二次规划(Quadratic Programmin

    2024年02月02日
    浏览(50)
  • 机器人模型预测控制MPC(model predictive control)

    当前控制动作是在每一个采样瞬间通过求解一个有限时域开环最优控制问题而获得。过程的当前状态作为最优控制问题的初始状态,解得的最优控制序列只实施第一个控制作用。这是它与那些使用预先计算控制律的算法的最大不同。本质上模型预测控制求解一个开环最优控制

    2024年02月07日
    浏览(45)
  • 【模型预测】A-4D战斗机姿态控制的模型预测控制方法(Matlab代码实现)

    💥💥💞💞 欢迎来到本博客 ❤️❤️💥💥 🏆博主优势: 🌞🌞🌞 博客内容尽量做到思维缜密,逻辑清晰,为了方便读者。 ⛳️ 座右铭: 行百里者,半于九十。 📋📋📋 本文目录如下: 🎁🎁🎁 目录 💥1 概述 📚2 运行结果 🎉3 参考文献 🌈4 Matlab代码实现 飞行器姿

    2024年02月06日
    浏览(40)
  • 使用模型预测控制对USV进行自主控制(Matlab代码实现)

        目录 💥1 概述 📚2 运行结果 🎉3 参考文献 👨‍💻4 Matlab代码   无人船(unmanned surface vehicles,USV)是一种船端无人操控的水面船舶,近年来受到了广泛关注。如何实现自主航行是USV面临的核心问题,而设计一种具有精确航迹控制能力的运动控制器是解决该问题的基础。   

    2023年04月09日
    浏览(72)

觉得文章有用就打赏一下文章作者

支付宝扫一扫打赏

博客赞助

微信扫一扫打赏

请作者喝杯咖啡吧~博客赞助

支付宝扫一扫领取红包,优惠每天领

二维码1

领取红包

二维码2

领红包