Find S value in Algebra Ricatti Equation LQR
Afficher commentaires plus anciens
I have code like that
In that code i want find S matriks Value with left_ARE = Right_are it can?
clear; close; clc;
syms a1 a2 b h
% Model data
A = sym(zeros(4,4));
A(1,2) = a1;
A(3,2) = a2-1; A(3,4) = a2;
display(A);
B = sym(zeros(4,2));
B(1,1) = -b*h;
B(2,1) = b;
B(3,2) = -b*h;
B(4,1) = -b; B(4,2) = b;
display(B);
% Q and R matrices for ARE
Q = sym(eye(4)); display(Q);
R = sym(zeros(2,2)); R(1,:) = [1 1]; R(2,:) = [1 2]; display(R);
% Matrix S to find
svar = sym('s',[1 16]);
S = [svar(1:4); svar(5:8); svar(9:12); svar(13:16)];
S(2,1) = svar(2);
S(3,1) = svar(3);
S(3,2) = svar(7);
S(4,1) = svar(4);
S(4,2) = svar(8);
S(4,3) = svar(12);
display(S);
% LHS of ARE: A'*S + S*A' - S*B*Rinv*B'*S
left_ARE = transpose(A)*S + S*A - S*B*inv(R)*transpose(B)*S;
display(left_ARE);
% RHS of ARE: A'*S + S*A' - S*B*Rinv*B'*S
right_ARE = -Q;
display(right_ARE);
% Find S in ARE
S = left_ARE == right_ARE;
display(S);
Réponses (1)
Ivan Dwi Putra
le 15 Mai 2020
0 votes
Catégories
En savoir plus sur Biological and Health Sciences dans Centre d'aide et File Exchange
Community Treasure Hunt
Find the treasures in MATLAB Central and discover how the community can help you!
Start Hunting!