代数黎卡提方程通常会在求解最优控制时有所应用,比如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