编程语言
首页 > 编程语言> > matlab练习程序(解代数黎卡提方程)

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

作者:互联网

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

标准形式有以下两种:

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

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

 

其中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

标签:方程,inv,离散,黎卡提,matlab,Pe,代数
来源: https://www.cnblogs.com/tiandsp/p/15860367.html