Escolar Documentos
Profissional Documentos
Cultura Documentos
ESCUELA DE POSGRADO
Curso:
CONTROL PTIMO
Tema:
Presentado por:
Docente:
2016
1
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Sistema de suspensin
= + + 0
2
21
=[ ]
1
10
() 1
= () =
() 2 + 1
= 0.5 + 0.5
Entonces se tiene:
= 0.5
= 0.5
= 1
2
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Sistema resultante:
0
[ ] = [ 44 ] [ ] + [ 41 ] + [ 41 ]
0 0 1
= [ ]
44
=[ ]
0
= [ 41 ]
0
La nueva funcin de costo:
= 0.5 + +
0
0 0 0 0 0
0 2 0 0 0
= 0 0 0 0 0
0 0 0 3 0
[0 0 0 0 0]
1 0 0 0 0
0 0 0 0 0
= 0 0 0 0 0
0 0 0 0 0
[0 0 0 0 0]
Quedara:
= 0.5 ( + ) + 2 ( ) + ( + )
0
= +
= 1
= ( 1 , 1 , 1 )
3
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Script en Matlab
El Sistema:
m2 = 10;
m1 = 1;
f2 = 1; w2 = 2*pi*f2;
f1 = 10; w1 = 2*pi*f1;
k2 = w2*w2*m2;
k1 = w1*w1*m1;
eta2 = 0.5;
c2 = 2*eta2*w2*m2;
El ruido coloreado
AA = [ A W*Cr
Z14 Ar ];
BB = [ B
0 ];
4
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
N = AA'*S*BB;
RR = R+BB'*S*BB;
QQ = QQ + AA'*S*AA;
PP = are(AA - BB*inv(RR)*N',BB*inv(RR)*BB', QQ-N*inv(RR)*N');
K = inv(RR)*BB'*PP;
ti = 0; tf = 5; dt = 0.001;
t = ti:dt:tf; t = t';
nt = length(t);
[Ak Bk ] = c2d(A,B,dt);
[Ak Wk ] = c2d(A,W,dt);
[Ark Brk ] = c2d(Ar,Br,dt);
x = [ 0; 0; 0; 0 ];
xp = [0]; %valor inicial
k = 1;
w = randn(nt,1); %ruido blanco
for tt = ti:dt:tf
xx21(k,1) = x(2,1);
xx10(k,1) = x(4,1);
u = -K*[ x; xp ];
FF(k,1) = u;
xx2_2p(k,1) = C*x + D*u;
x = Ak*x + Bk*u + Wk*xp;
xp = Ark*xp + Brk*w(k,1);
ruido_coloreado(k,1) = xp;
k = k+1 ;
end
figure(1);
subplot(3,1,1); plot(t,xx21,'-k',t,xx10,'-r');
legend('x21','x10'); grid;
subplot(3,1,2); plot(t,xx2_2p,'-k'); legend('Accel x2p');grid;
subplot(3,1,3); plot(t,w,'-k',t,ruido_coloreado,'-r');
legend('ruido blanco','coloreado'); grid;
5
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Espectros:
Variando el peso q
-2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
0.2
Accel x2p
0
-0.2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
5
ruido blanco
0 coloreado
-5
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
90
Accel x2p
80
70
60
50
40
30
20
10
0
0 50 100 150 200 250 300 350 400 450 500
6
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
-3
x 10
1
x21
0 x10
-1
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
0.1
Accel x2p
0
-0.1
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
5
ruido blanco
0 coloreado
-5
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
60
Accel x2p
50
40
30
20
10
0
0 50 100 150 200 250 300 350 400 450 500
7
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
-3
x 10
2
x21
0 x10
-2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
0.2
Accel x2p
0
-0.2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
5
ruido blanco
0 coloreado
-5
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
60
Accel x2p
50
40
30
20
10
0
0 50 100 150 200 250 300 350 400 450 500
8
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Fric = 0*10
0.4
posicion modelo
0.2 posicion sistema
0
0 1 2 3 4 5 6 7 8 9 10
Voltaje
50
voltaje sistema
0
-50
0 1 2 3 4 5 6 7 8 9 10
Potencia
50
potencia sistema
0
-50
0 1 2 3 4 5 6 7 8 9 10
Fric = 2*10
9
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
0.5
posicion modelo
0 posicion sistema
-0.5
0 1 2 3 4 5 6 7 8 9 10
Voltaje
50
voltaje sistema
0
-50
0 1 2 3 4 5 6 7 8 9 10
Potencia
200
potencia sistema
0
-200
0 1 2 3 4 5 6 7 8 9 10
Fric = 4*10
0.5
posicion modelo
0 posicion sistema
-0.5
0 1 2 3 4 5 6 7 8 9 10
Voltaje
50
voltaje sistema
0
-50
0 1 2 3 4 5 6 7 8 9 10
Potencia
500
potencia sistema
0
-500
0 1 2 3 4 5 6 7 8 9 10
Fric = 6*10
10
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
0.5
posicion modelo
0 posicion sistema
-0.5
0 1 2 3 4 5 6 7 8 9 10
Voltaje
50
voltaje sistema
0
-50
0 1 2 3 4 5 6 7 8 9 10
Potencia
500
potencia sistema
0
-500
0 1 2 3 4 5 6 7 8 9 10
Fric = 8*10
0.5
posicion modelo
0 posicion sistema
-0.5
0 1 2 3 4 5 6 7 8 9 10
Voltaje
50
voltaje sistema
0
-50
0 1 2 3 4 5 6 7 8 9 10
Potencia
1000
potencia sistema
0
-1000
0 1 2 3 4 5 6 7 8 9 10
11
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
= 0.4
= 2
= 0.9
0 1
= [ ]
2 2
0
= [ 2 ]
= [1 0]
Con F = 1.2*0.4
0.4
posicion modelo
0.2 posicion sistema
0
0 1 2 3 4 5 6 7 8 9 10
Voltaje
20
voltaje sistema
0
-20
0 1 2 3 4 5 6 7 8 9 10
Potencia
50
potencia sistema
0
-50
0 1 2 3 4 5 6 7 8 9 10
12
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Con F = 1.5*0.4
0.4
posicion modelo
0.2 posicion sistema
0
0 1 2 3 4 5 6 7 8 9 10
Voltaje
50
voltaje sistema
0
-50
0 1 2 3 4 5 6 7 8 9 10
Potencia
50
potencia sistema
0
-50
0 1 2 3 4 5 6 7 8 9 10
Con F = 1.8*0.4
0.4
posicion modelo
0.2 posicion sistema
0
0 1 2 3 4 5 6 7 8 9 10
Voltaje
50
voltaje sistema
0
-50
0 1 2 3 4 5 6 7 8 9 10
Potencia
100
potencia sistema
0
-100
0 1 2 3 4 5 6 7 8 9 10
13
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
0.4
posicion modelo
0.2 posicion sistema
0
0 1 2 3 4 5 6 7 8 9 10
Voltaje
50
voltaje sistema
0
-50
0 1 2 3 4 5 6 7 8 9 10
Potencia
500
potencia sistema
0
-500
0 1 2 3 4 5 6 7 8 9 10
Con F = 2.5*0.4
0.4
posicion modelo
0.2 posicion sistema
0
0 1 2 3 4 5 6 7 8 9 10
Voltaje
50
voltaje sistema
0
-50
0 1 2 3 4 5 6 7 8 9 10
Potencia
1000
potencia sistema
0
-1000
0 1 2 3 4 5 6 7 8 9 10
14
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
= + +
Sean:
1
2
= 3
(1 )
[ ]
33 031
= [ ]
[1 0 0] 0
= [ ]
0
0
0
= [ ]
0
1
= [1 0 0 0]
= + +
1
1
2 0
2
3 0
3 042
=[ ] + [ ] + 0
1 024 1 021
1
1 1 [21 ]
[ 2 ] [ 2 ]
2
= (( )2 + ((1 )) + 2 )
0
15
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Siendo:
0
Se forma:
0 0 0 0
0 0 0 0
44 =[ ]
0 0 0 0
0 0 0
+
= [ ] [ ] [ ] +
0
11 :
11 + 11 11 1 11 + + = 0
12 :
( 11 1 ) 12 + 12 = 0
= 1 11
= 1 12
= [ ]
= [ 1 11 1 12 ] [ ]
16
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Script en Matlab:
%sistema aumentado
Ai = [ 0 1 0 0
0 a22 a23 0
0 a32 a33 0
1 0 0 0 ]; %Matriz Ai
Bi = [ 0
0
b31
0 ]; %Matriz Bi
Wfi = [ 0
0
0
-1]; %Friccin seca acta como una
perturbacin no lineal
Ci = [ 1 0 0 0];
Di = [0];
Q = [q];
qi = input('Peso del integrador [1e9]: ');
Qi = [0 0 0 0
0 0 0 0
0 0 0 0
0 0 0 qi];
RRi = [1];
%% Hallamos Kx
QQi = Ci'*Q*Ci+Qi; % CTqC para Riccati
P11i = are(Ai,Bi*inv(RRi)*Bi',QQi); %Hallamos P11 para Kx
Kfbi = inv(RRi)*Bi'*P11i; %Hallamos Kx
%% Hallamos Kz
APRi = Ai'-P11i*Bi*inv(RR)*Bi'; %Para Lyapunov
CQCmi = -Ci'*Q*Cm; % -CTqCb para Lyapunov
P12i = lyap(APRi,Am,CQCmi); %Hallamos P12 para Kz
Kffi = inv(RR)*Bi'*P12i; %Hallamos Kz
%% Condiciones iniciales
xi = [ 0; 0; 0]; %Valor inicial de las variables de control
xmi = [ 0; 0 ]; %Valor inicial de las variables del modelo
k = 1; %Inicializa la interacin
int_err = 0; % Valor incial de integral del error
17
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Ploteo:
figure(2);
subplot(2,1,1);
plot(time,uc,'-b',time,uci,'k'); %Graficamos el voltaje
legend('voltaje Fb+Fff','voltaje Fb+Fff+Acc.Integral');
title('Voltaje'); grid;
subplot(2,1,2);
plot(time,pot,'-b',time,poti,'k'); %Graficamos la potencia
legend('potencia Fb+Fff','potencia Fb+Fff+Acc.Integral');
title('Potencia'); grid;
18
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Fric = 0*10
Posicion x1
0.35
modelo
Fb+Fff
0.3
Fb+Fff+Acc.Integral
0.25
0.2
0.15
0.1
0.05
0
0 1 2 3 4 5 6 7 8 9 10
Voltaje
30
voltaje Fb+Fff
20 voltaje Fb+Fff+Acc.Integral
10
-10
0 1 2 3 4 5 6 7 8 9 10
Potencia
40
potencia Fb+Fff
potencia Fb+Fff+Acc.Integral
20
-20
0 1 2 3 4 5 6 7 8 9 10
19
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Fric = 0.5*10
Posicion x1
0.35
modelo
0.3 Fb+Fff
Fb+Fff+Acc.Integral
0.25
0.2
0.15
0.1
0.05
-0.05
0 1 2 3 4 5 6 7 8 9 10
Posicion x1
0.305 modelo
Fb+Fff
0.304 Fb+Fff+Acc.Integral
0.303
0.302
0.301
0.3
0.299
0.298
0.297
20
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Voltaje
30
voltaje Fb+Fff
20 voltaje Fb+Fff+Acc.Integral
10
-10
0 1 2 3 4 5 6 7 8 9 10
Potencia
100
potencia Fb+Fff
potencia Fb+Fff+Acc.Integral
50
-50
0 1 2 3 4 5 6 7 8 9 10
Voltaje
voltaje Fb+Fff
20 voltaje Fb+Fff+Acc.Integral
10
0
0.2 0.4 0.6 0.8 1 1.2 1.4 1.6
Potencia
100
potencia Fb+Fff
potencia Fb+Fff+Acc.Integral
50
-50
0 1 2 3 4 5 6 7 8 9 10
21
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Fric = 2*10
Posicion x1
0.35
modelo
0.3 Fb+Fff
Fb+Fff+Acc.Integral
0.25
0.2
0.15
0.1
0.05
-0.05
0 1 2 3 4 5 6 7 8 9 10
modelo
0.3
Fb+Fff
Fb+Fff+Acc.Integral
0.25
0.2
0.15
0.1
10
-10
0 1 2 3 4 5 6 7 8 9 10
Potencia
200
potencia Fb+Fff
potencia Fb+Fff+Acc.Integral
100
-100
0 1 2 3 4 5 6 7 8 9 10
22
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Fric = 4*10
Posicion x1
0.35
modelo
0.3 Fb+Fff
Fb+Fff+Acc.Integral
0.25
0.2
0.15
0.1
0.05
-0.05
0 1 2 3 4 5 6 7 8 9 10
Voltaje
40
voltaje Fb+Fff
voltaje Fb+Fff+Acc.Integral
20
-20
0 1 2 3 4 5 6 7 8 9 10
Potencia
400
potencia Fb+Fff
potencia Fb+Fff+Acc.Integral
200
-200
0 1 2 3 4 5 6 7 8 9 10
23
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Fric = 6*10
Posicion x1
0.35
modelo
0.3 Fb+Fff
Fb+Fff+Acc.Integral
0.25
0.2
0.15
0.1
0.05
-0.05
0 1 2 3 4 5 6 7 8 9 10
Voltaje
30
voltaje Fb+Fff
20 voltaje Fb+Fff+Acc.Integral
10
-10
0 1 2 3 4 5 6 7 8 9 10
Potencia
600
potencia Fb+Fff
400 potencia Fb+Fff+Acc.Integral
200
-200
0 1 2 3 4 5 6 7 8 9 10
24
Pesos dependientes de la frecuencia y observadores CONTROL OPTIMO
Conclusiones:
1.
25