09 Servosistemas Tipo 1 v3
09 Servosistemas Tipo 1 v3
09 Servosistemas Tipo 1 v3
x Ax Bu
y Cx Du
Donde:
K 0 k 2 k3 k n
x1
de tal manera x
u 0 k 2 k3 k n 2 k1 r x1
xn
u Kx k1r
donde
K k1 k 2 k3 k n
Supóngase que la entrada de referencia (función escalón) se
aplica en t=0. Así la dinámica del sistema se puede describir
mediante la siguiente ecuación:
Sustituyendo
u Kx k1r
x Ax Bu A BK x Bk1r
Se define
xt x et
e A BK e
Y s 1
U s ss 1s 2
s1 2 j 2 3 s2 2 j 2 3 s3 10
y 3y 2 y u
x1 0 1 0 x1 0 x1
x 0u
x
2 0 0 1 2 y 1 0 0 x2
x3 0 2 3 x3 1 x3
La señal de control u esta dada por
x1
u 0 k 2 k3 x2 k1 r x1
x3
Donde
K k1 k2 k3
Se determinará la matriz K de ganancia de retroalimentación
de estado por el método de ubicación de polos.
1. Verificar que el sistema sea de estado completamente
B AB A B
controlable
2
0 1 0 0 0
AB 0 0 1 0 1
0 2 3 1 3
0 0 1 0 1
A 2 B 0 2 3 0 3
0 6 7 1 7
0 0 1
B AB A 2 B 0 1 3
1 3 7
0 1 0 0
A BK 0 0 1 0 K1 K2 K3
0 2 3 1
0 1 0 0 0 0
A BK 0 0 1 0 0 0
0 2 3 K1 K2 K 3
0 1 0
A BK 0 0 1
K1 2 K2 3 K 3
s 0 0 0 1 0
sI A BK 0 s 0 0 0 1
0 0 s K1 2 K2 3 K 3
s 1 0
sI A BK 0 s 1
K1 2 K2 s 3 K 3
sI A BK sss 3 K3 2 K 2 K1 0
s 3 3 K3 s 2 2 K 2 s K1 0
x Ax Bu A BK x Bk1r
0 1 0 0
A BK 0 0 1 0 160 54 11
0 2 3 1
0 1 0
0 0 1
160 56 14
0 0
Bk1r 0160r 0 r
1 160
x1 0 1 0 x1 0 x1
x 0 r
x
2 0 0 1 2 y 1 0 0 x2
x3 160 56 14 x3 160 x3
En estado estable
20
7
80
7 1 0
160 r
x 1 0 0 0 r 0
0 1 0 160 0
r
u 160 54 110 160r
0
Y s 1
U s ss 1s 4
s1 2 4i s2 2 4i s3 12
y 5y 4 y u
x1 0 1 0 x1 0 x1
x 0 u
x
2 0 0 1 2 y 1 0 0 x2
x3 0 4 5 x3 1 x3
La señal de control u esta dada por
x1
u 0 k 2 k3 x2 k1 r x1
x3
Donde
K k1 k2 k3
Se determinará la matriz K de ganancia de retroalimentación
de estado por el método de ubicación de polos.
0 1 0 0 0
AB 0 0 1 0 1
0 4 5 1 5
0 0 1 0 1
A 2 B 0 4 5 0 5
0 20 21 1 21
0 0 1
B AB A 2 B 0 1 5
1 5 21
0 1 0 0
A BK 0 0 1 0 K1 K2 K3
0 4 5 1
0 1 0 0 0 0
A BK 0 0 1 0 0 0
0 4 5 K1 K2 K 3
0 1 0
A BK 0 0 1
K1 4 K2 5 K 3
s 0 0 0 1 0
sI A BK 0 s 0 0 0 1
0 0 s K1 4 K2 5 K 3
s 1 0
sI A BK 0 s 1
K1 4 K2 s 5 K 3
sI A BK sss 5 K3 4 K 2 K1 0
s 3 5 K3 s 2 4 K 2 s K1 0
4. Igualar los polinomios (sistema deseado y el polinomio
característico de A-BK )
5. matriz K
x1
u 0 64 11 x2 240r x1
x3
x Ax Bu A BK x Bk1r
0 1 0 0
A BK 0 0 1 0 240 64 11
0 4 5 1
0 1 0
0 0 1
240 68 16
0 0
Bk1r 0 240r 0 r
1 240
x1 0 1 0 x1 0 x1
x 0 r
x
2 0 0 1 2 y 1 0 0 x2
x3 240 68 16 x3 240 x3
En estado estable
x A BK 1 Bk1r
1
0 1 0 0
x 0 0 1 0 r
240 68 16 240
17 15
1 1 0
240 r
60
x 1 0 0 0 r 0
0 1 0 240 0