Академический Документы
Профессиональный Документы
Культура Документы
Fatiha Nejjari
SAC, ESAII, UPC
Introduccin
Introduccin
Introduccin
Control ptimo
Control ptimo
Control ptimo
cuadrtico LQR
Fatiha Nejjari
ESAII/UPC
Regulador LQR
Caso continuo
o la ecuacin diferencial,
invariante en el tiempo.
(xT Q x + uT R u) dt
K = LQR (A,B,Q,R)
Control ptimo
0 1
0
x ( t ) =
x (t ) + u (t )
0 0
1
Error x1 =
1 0
Q =
0 0
a ) R = 0 . 1 % Control " caro"
b ) R = 10
= x1 ;
d
/dt = x2
x1=x2
x2=T(t)/J = u
(xT Q x + uT R u)
Control ptimo
% EJEMPLO MATLAB:
A=[0 1;0 0]; B=[0;1];
C=[1 0]; D=[0];
Q=[1 0;0 0];
R=0.1 ; % Control caro
% R=10; % Control barato
K=lqr(A,B,Q,R)
% SIMULACIN
t=0:0.01:20; % Tiempo
u=0*t;
% Entrada nula
x0 = [10 10]; % Estado inicial
[y,x]= lsim(A-B*K,B,C,D,u,t,x0);
plot(t,y);
title('Control LQR de un satlite
');
xlabel('Tiempo (s)');
ylabel('Angulo de posicin');
Control ptimo
Ejemplo de control optimo LQR.
Control de la posicin de un satlite
Control LQR de un satlite
16
K = 3.1623
10
2.5149
K = 0.3162
14
0.7953
12
Angulo de posicin
8
Angulo de posicin
10
8
6
4
2
0
0
-2
10
12
Tiempo (s)
14
16
18
20
-2
10
12
Tiempo (s)
14
Opcin cara
Opcin barata
R=0.1
R=10
16
18
20
Regulador LQR
Caso discreto
xk +1 = Axk + Buk
yk = Cxk + Duk
Xk = Vector de estado (vector-n)
Uk = vector de control (vector-r)
A = matrix de nxn
B = matriz de nxr
Horizonte Finito
xk +1 = Axk + Buk
x0 conocido
sea mnima.
Horizonte Finito
1 T
1 N 1 T
J N = xN PxN + xk Qxk + ukT Ruk
2
2 k =0
Q, matriz Hermtica (o matriz real simtrica) definida positiva o semidefinida
positiva de nxn
R, matriz Hermtica (o matriz real simtrica) definida positiva de rxr
P, matriz Hermtica (o matriz real simtrica) definida positiva o semidefinida
positiva de nxn
Q, R y P se seleccionan para la importancia relativa de la contribucin en
el desempeo debida al vector de estado. Pueden seleccionarse para
penalizar ciertos estados/entradas ms que otros.
xTN PxN
Reemplazando se obtiene,
Ya que xk 0 entonces,
Ecuacin de diferencia de Riccati
Usando el mtodo del barrido, resolvemos a partir de las condiciones
de frontera. Del estado final
Donde
K k = ( R + BT Pk +1 B ) 1 BT Pk +1 A
min
N
1 T
= x0 Px0
2
Horizonte infinito
Ejemplo:
Simulamos el sistema:
Codigo Matlab
% coste
Q=[2 0;0 0.1];R=2;S=diag([5,5]);
k=10;
% Sistema
A=[2 1;-1 1];B=[0;1];x0=[2;-3];
% Solucion de la ecuacion de Riccati
while k>=1
K(k,:)=inv(R+B*S*B)*B*S*A;
S=(A-B*K(k,:))*S*(A-B*K(k,:))+Q+K(k,:)*R*K(k,:);
k=k-1;
end
% Simulacion del sistema realimentado
x(:,1)=x0;
for k=1:10
x(:,k+1) = A*x(:,k)-B*K(k,:)*x(:,k);
end
Hacemos un anlisis de
controlabilidad y observabilidad
El rango de ambas matrices es cuatro lo
que indica que el sistema es totalmente
controlable y observable.
BIBLIOGRAFA