matlab练习程序(解代数黎卡提方程)

代数黎卡提方程通常会在求解最优控制时有所应用,比如LQR控制。

标准形式有以下两种:

1.连续代数黎卡提方程:

matlab练习程序(解代数黎卡提方程)

2.离散代数黎卡提方程:

 matlab练习程序(解代数黎卡提方程)

其中P是未知量,A、B、Q、R为已知量。

离散代数黎卡提方程可以迭代求解。

matlab代码如下:

clear all;close all;clc;

A = [0.8 0.3;-0.6 0];
B = [1 0.3;0 1.4];
Q = [7 1;1 3];
R = [3 1;1 2];

%连续黎卡提方程
P=care(A,B,Q,R)
Re = A'*P + P*A - P*B*inv(R)*B'*P + Q

%离散黎卡提方程
P=dare(A,B,Q,R)
Re = A'*P*A - (A'*P*B)*inv(R+B'*P*B)*(B'*P*A) + Q - P

%迭代解离散黎卡提方程
P = Q;
e=1;
while (e >= 1e-10)
    Pe = Q + A'*P*A - A'*P*B*inv(R+B'*P*B)*(B'*P*A);
    e = norm(Pe-P);
    P = Pe;
end
P
Re = A'*P*A - (A'*P*B)*inv(R+B'*P*B)*(B'*P*A) + Q - P
上一篇:WIN10和LINUX双系统首装踩坑经验分享


下一篇:VMware 虚拟机进入U盘PE系统方法