Professional Documents
Culture Documents
Si se colocan muestreadores 𝜹𝑻 (𝒕) en eh(t) y en ec(t), y un retenedor de orden cero después del
muestreador en ec(t), realizar la conversión de tiempo continuo a tiempo discreto del espacio de estado
representado en la parte (b) y representarlo en un diagrama de bloques de estado en tiempo discreto
con un periodo de muestreo T.
Con muestreadores y retenedor de orden cero:
x(k 1) G.x(k ) H .u (k )
y (k ) C1 x(k ) D1u (k )
x3 (t )
x4 (t )
0
0.0003
H =[ ]
0.0292
0.0806
C1 = [0.7237 0.0555 0.0005 0.0002]
D1 = [8.8245e-006]
x1 (k )
x (k )
y (k ) 0.7237 0.0555 0.0005 0.0002. [0.0000088245].u (k )
2
x3 (k )
x4 ( k )
Figura 02. Sistema de control de seguimiento con realimentación de estado y control integral.
Donde:
𝑠1,2 = −𝜀𝜔𝑛 ± 𝜔𝑛 √𝜀 2 − 1
Entonces:
𝑠1 = −0.0017; 𝑠2 = −0.0042
En el sistema se tiene cinco polos dominantes, ya que se agregara un integrador, con lo cual se tendrá que
agregar 3 polos más relativamente alejados de los dos polos dominantes:
𝑠3 = −4; 𝑠4 = −5 𝑦 𝑠5 = −7
𝑉(𝑧) 𝑧 −1
= → 𝑧𝑉(𝑧) − 𝑉(𝑧) = 𝐸(𝑧) → 𝑣(𝑘 + 1) − 𝑣(𝑘) = 𝑒(𝑘)
𝐸(𝑧) 1 − 𝑧 −1
Entonces:
𝑣(𝑘 + 1) = 𝑣(𝑘) + 𝑒(𝑘)
De (*):
𝑣(𝑘 + 1) = 𝑣(𝑘) + 𝑟(𝑘) − 𝑘𝑚 𝑦(𝑘)
De (2):
𝑣(𝑘 + 1) = 𝑣(𝑘) + 𝑟(𝑘) − 𝑘𝑚 [𝐶𝑥(𝑘) + 𝐷𝑢(𝑘)] … (3)
Ecuación de estado:
𝑥(𝑘 + 1) 𝐺 0 𝑥(𝑘) 𝐻 0
( )=( )( )+( ) 𝑢(𝑘) + ( ) 𝑟(𝑘) … (4)
𝑣(𝑘 + 1) −𝑘𝑚 𝐶 1 𝑣(𝑘) −𝑘𝑚 𝐷 1
Ecuación de salida:
𝑥(𝑘)
𝑦(𝑘) = (𝐶 0) ( ) + 𝐷𝑢(𝑘) … (5)
𝑣(𝑘)
Ecuación de control:
𝑥(𝑘)
𝑢(𝑘) = −(𝐾 −𝑘𝐼 ) ( ) … (6)
𝑣(𝑘)
Definiendo:
𝑥(𝑘) 𝐺 0 ̂=( 𝐻 ) ̆ = ( 0)
𝑥̂(𝑘) = ( ) 𝐺̂ = ( ) 𝐻 𝐻
𝑣(𝑘) −𝑘𝑚 𝐶 1 −𝑘𝑚 𝐷 1
𝐶̂ = (𝐶 0) ̂=𝐷
𝐷 ̂ = [𝐾
𝐾 −𝑘𝐼 ]
𝑥(𝑘)
𝑥̂(𝑘 + 1) = 𝐺̂ ( ̂ 𝑢(𝑘) + 𝐻
)+𝐻 ̆ 𝑟(𝑘) … (7)
𝑣(𝑘)
𝑥(𝑘)
𝑦(𝑘) = 𝐶̂ ( )+𝐷 ̂ 𝑢(𝑘) … (8)
𝑣(𝑘)
𝑢(𝑘) = −𝐾̂ 𝑥̂(𝑘) … (9)
Finalmente se obtiene:
|𝑧𝐼̂ − 𝐺̂ + 𝐻
̂𝐾̂ | = 0 … (10)
Donde:
Km es constante de conversión, de la ecuación (*):
𝑟(∞) 10
𝑘𝑚 = = =5
𝑦(∞) 2
0
0.0003
H =[ ]
0.0292
0.0806
C1 = [0.7237 0.0555 0.0005 0.0002]
D1 = [8.8245e-006]
Ga=[G zeros(4,1);-Km*C1 1]
Ga =
0.9964 0.1532 0.0015 0.0005 0
0 0.6931 0.0165 0.0054 0
0 0 0.7881 0.5846 0
0 0 -0.5846 0.6127 0
-3.6184 -0.2776 -0.0027 -0.0009 1.0000
Ha = [H;-km*D1]
Ha =
0.0000
0.0003
0.0292
0.0806
-0.0000
Ca = [C1 0]
0.7237 0.0555 0.0005 0.0002 0
Da = [D1]
Da = 8.8245e-006
Utilizaremos el método algorítmico para hallar k .Verificando que el sistema es de estado completamente
k
controlable, ya que en otro caso no se puede calcular la matriz .
Ma =
0.0000 0.0001 0.0004 0.0009 0.0013
0.0003 0.0011 0.0021 0.0026 0.0022
0.0292 0.0702 0.0742 0.0461 0.0033
0.0806 0.0323 -0.0212 -0.0564 -0.0615
-0.0000 -0.0004 -0.0014 -0.0038 -0.0076
r= 5
ans = -4.9725e-013
T=Ma.W
Donde M es la matriz de controlabilidad y W es una matriz simétrica que se expresan respectivamente como:
W=
De la expresión (&):
𝑃(𝑧) = 𝑧 5 − 2.0836325 ∗ 𝑧 4 + 1.1731593 ∗ 𝑧 3 − 0.091500872 ∗ 𝑧 2 + 0.0019866778 ∗ 𝑧
− 0.000009126792
Identificando los coeficientes αi:
Entonces:
Utilizando los siguientes comandos del MATLAB para hallar T 1
Ti = inv(T)
Ti =
1.0e+004 *
-1.0298 0.1574 -0.0011 0.0001 -0.1417
-0.5135 -0.0093 0.0006 -0.0001 -0.1417
0.0009 -0.0458 -0.0000 0.0001 -0.1417
0.5135 0.0077 -0.0005 -0.0001 -0.1417
1.0242 0.1233 0.0010 0.0001 -0.1417
Utilizando los siguientes comandos del MATLAB para hallar K
K =Ka*inv(T)
Entonces la matriz K es la siguiente:
K = [3.1574 379.4057 20.9896 16.0097 -0.0049]
KI= 0.0049
g. Si er(t)=r(k) determinar las funciones de transferencia Y(z)/R(z)
x(k 1) G.x(k ) H .u (k )
y (k ) C.x(k ) D.u (k )
u (k ) K .x(k ) K I .v(k )
v(k 1) v(k ) r (k 1) y (k )
Obtenemos:
zI ( z ) R( z )
G H K X H1
1
X ( z ) zI G H K H 1 R( z )
1
Y ( z ) C D K zI G H K
H 1 R( z )
R( z )
En MATLAB,
F ( z ) C .( z.I G2 ) 1 .H 2 D2
2
G2=Ga-Ha*K;
H2=H1=[0;0;0;0;1];
C2=Ca-Da*K;
D2=[0];
[num,den]=ss2tf(G2,H2,C2,D2)
tf(num,den,T)
𝒀(𝒛) 𝟒. 𝟑𝟒𝟖𝒆 − 𝟎𝟎𝟖 𝒛𝟒 + 𝟏. 𝟕𝟑𝟗𝒆 − 𝟎𝟎𝟕 𝒛𝟑 + 𝟐. 𝟔𝟎𝟗𝒆 − 𝟎𝟎𝟕 𝒛𝟐 + 𝟏. 𝟕𝟑𝟗𝒆 − 𝟎𝟎𝟕 𝒛 + 𝟒. 𝟑𝟒𝟖𝒆 − 𝟎𝟎𝟖
=
𝑹(𝒛) 𝒛𝟓 – 𝟐. 𝟎𝟖𝟒 𝒛𝟒 + 𝟏. 𝟏𝟕𝟑 𝒛𝟑 – 𝟎. 𝟎𝟗𝟏𝟓 𝒛𝟐 + 𝟎. 𝟎𝟎𝟏𝟗𝟖𝟕 𝒛 – 𝟗. 𝟏𝟐𝟕𝒆 − 𝟎𝟎𝟔
h. Graficar las variables de estado x(k), del error e(k), v(k), y(k) y la variable de control u(k) ante una
entrada en r(k)= 1 rad (tipo escalón) usando como vector de condiciones iniciales x(0) según su buen
criterio.
1.8
1.6
1.4
1.2
0.8
0.6
0.4
0.2
0
0 500 1000 1500 2000 2500 3000 3500 4000
kT (seg)
1.8
1.6
1.4
1.2
0.8
0.6
0.4
0.2
0
0 500 1000 1500 2000 2500 3000 3500 4000
10000
8000
6000
4000
2000
-2000
0 500 1000 1500 2000 2500 3000 3500 4000
2.5
1.5
0.5
0
0 500 1000 1500 2000 2500 3000 3500 4000
kT (seg)
Figura 4: x1(t)
0.1
0.09
0.08
0.07
0.06
0.05
0.04
0.03
0.02
0.01
0
0 500 1000 1500 2000 2500 3000 3500 4000
kT (seg)
Figura 5: x2(t)
0.5
-0.5
-1
-1.5
0 500 1000 1500 2000 2500 3000 3500 4000
kT (seg)
Figura 6: x3(t)
3
-1
-2
-3
-4
0 500 1000 1500 2000 2500 3000 3500 4000
kT (seg)
Figura 7: x4(t)
12000
10000
8000
6000
4000
2000
0
0 500 1000 1500 2000 2500 3000 3500 4000
kT (seg)
0
0 500 1000 1500 2000 2500 3000 3500 4000
kT (seg)
i.- Interpretar físicamente la dinámica del sistema basándose en las gráficas de la parte (h).
FIGURA 1: Se muestra como para Y(t) (h(t)), en condiciones iníciales cero, y una entrada escalón, llega a
un tope de 2m estableciéndose en el tiempo “ts” y no lo sobrepasa, la grafica es sobre amortiguada,
cumpliendo con el requerimiento, ya que no hay sobre pico (es decir sin desbordamiento).
FIGURA 2: Se muestra también la grafica de Y(t) para una entrada arbitraria, y condiciones iníciales, el cual
también presenta sobre amortiguamiento (sin desbordamiento), estableciéndose en el tiempo “ts”.
FIGURA 5: Es la respuesta del caudal de entrada al tanque qe(t) con condición inicial igual a 0.1m3/s; luego
del cual inmediatamente toma cero; estableciéndose luego en 0.055 m3/s, sin sobre pico (sobreamoriguado) en
el tiempo “ts”.
FIGURA 6: Es la respuesta del desplazamiento x(t) con condición inicial igual a 0m; estableciéndose luego
en 0.8m, en un tiempo “ts” sin sobre pico (sobreamoriguado).
FIGURA 7: Es la respuesta dx(t)/dt, es decir de la velocidad del desplazamiento del impulsor hidráulico, con
condición inicial de 0.01m/s. El cual luego decae, estableciéndose en el tiempo “ts”.
FIGURA 8: Es la respuesta de V(t), el cual se establece en el tiempo “ts”, es también sobre amortiguada.
ts=(No+19)*60/2; tf(num,den,T)
eps=1.1; X0=[0 0.1 0 0.01 0];%condiciones
wn=4/(ts*eps) iniciales
s1=-eps*wn+wn*sqrt(eps^2-1) R=10*ones(N,1);
s2=-eps*wn-wn*sqrt(eps^2-1) figure(2)
S=[s1 s2 -4 -5 -7]; [Y,X]=dlsim(G2,H2,C2,D2,R,X0);
Z=exp(T*S) stairs((1:N)*T,Y);
Pz=poly(Z) title('Respuesta del sistema');
Pzz=vpa(poly2sym(Pz,'z'),8) grid on;
Km=5;
Ga=[G zeros(4,1);-Km*C1 1] figure(3)
Ha = [H;-Km*D1] stairs((1:N)*T,X);
Ca = [C1 0] grid on;
Da = [D1] figure(4)
stairs((1:N)*T,X(:,1));
Ma=[Ha Ga*Ha (Ga^2)*Ha (Ga^3)*Ha xlabel('kT (seg)');
(Ga^4)*Ha ] grid on;
r = rank(Ma) figure(5)
det(Ma) stairs((1:N)*T,X(:,2));
xlabel('kT (seg)');
grid on;
Pa=poly(Ga) figure(6)
syms z stairs((1:N)*T,X(:,3));
Pzz=vpa(det(z*eye(5,5)-Ga),4) xlabel('kT (seg)');
grid on;
W=[Pa(5) Pa(4) Pa(3) Pa(2) 1;Pa(4) figure(7)
Pa(3) Pa(2) 1 0;Pa(3) Pa(2) 1 0 stairs((1:N)*T,X(:,4));
0;Pa(2) 1 0 0 0;1 0 0 0 0] xlabel('kT (seg)');
TT=Ma*W grid on;
aa1= -2.03; aa2=1.065 ; aa3=- figure(8)
0.03465; aa4=0.0002144; aa5= - stairs((1:N)*T,X(:,5));
0.0000002432; xlabel('kT (seg)');
a1 = -4.09; a2 = 6.972; a3 = - figure(9)
6.242; a4 = 2.93; a5= -0.5695; km=5;
Ka=[Pz(6)-Pa(6) Pz(5)-Pa(5) Pz(4)- stairs((1:N)*T,10*ones(N,1)-km*Y);
Pa(4) Pz(3)-Pa(3) Pz(2)-Pa(2)] xlabel('kT (seg)');
Ti=inv(TT) title('Grafica del Error');
K=Ka*Ti