Documentos de Académico
Documentos de Profesional
Documentos de Cultura
3 DISEÑO DE SERVOSISTEMAS
En esta sección se analizará el método de asignación de polos para el diseño de
servosistemas de tipo 1. El método se limitará a sistemas que tengan una señal
de control 𝑢 escalar y una salida 𝑦 también escalar.
Figura 2.8
Servosistema de tipo 1 cuando la planta tiene un integrador
x
+ u y x1
x Ax Bu y Cx
r +
k1
- -
x2
k2
x3
k3
.
.
.
xn
kn
La figura anterior muestra una configuración general del servosistema de tipo 1
cuando la planta tiene integrador. Se supone que 𝑦 = 𝑥1 . En el análisis que se
efectúa, se supone que la entrada de referencia 𝑟 es una función escalón. En
este sistema se utiliza el siguiente esquema de control mediante realimentación
del estado:
𝑥1 83
𝑥2
𝑢 = − 0 𝑘2 𝑘3 … 𝑘𝑛 ⋮ + 𝑘1 (𝑟 − 𝑥1 )
𝑥𝑛
𝑢 = −𝐾𝑥 + 𝑘1 𝑟 84
𝐾 = 𝑘1 𝑘2 ⋯ 𝑘𝑛 85
Supóngase que la entrada de referencia (la función escalón) se aplica en 𝑡 = 0.
Así, para 𝑡 > 0, la dinámica del sistema se puede describir mediante
𝑥 = 𝐴𝑥 + 𝐵𝑢 = 𝐴 − 𝐵𝐾 𝑥 + 𝐵𝑘1 𝑟 86
(𝑠 3 + 3𝑠 2 + 2𝑠)𝑌 𝑠 = 𝑈(𝑠)
𝑦 + 3𝑦 + 2𝑦 = 𝑢
𝑥1 = 𝑦 → 𝑥1 = 𝑦=𝑥2
𝑥2 = 𝑦 → 𝑥2 = 𝑦 = 𝑥3
𝑥3 = 𝑦 → 𝑥3 = 𝑦 = −2𝑥2 − 3𝑥3 + 𝑢
𝑥1 = 0𝑥1 + 𝑥2 + 0𝑥3 + 0𝑢
𝑥2 = 0𝑥1 + 0𝑥2 + 𝑥3 + 0𝑢
𝑥3 = 0𝑥1 − 2𝑥2 − 3𝑥3 + 𝑢
0 1 0 0
𝑥= 0 0 1 𝑥 + 0 𝑢, 𝑦 = 1 0 0 𝑥
0 −2 −3 1
𝐾= 0 0 1 𝑀𝑐 −1 ∅(𝐴)
𝑀𝑐 = 𝐵 𝐴𝐵 𝐴2 𝐵
𝑠𝐼 − 𝐴 + 𝐵𝐾 = 𝑠 3 + 𝛼1 𝑠 2 + 𝛼2 𝑠 + 𝛼3 = 𝑠 + 2 + 𝑗2 3 𝑠 + 2 − 𝑗2 3 𝑠 + 10
= 𝑠 3 + 14𝑠 2 + 56𝑠 + 160
Mc =
0 0 1
0 1 -3
1 -3 7
McInv =
2 3 1
3 1 0
1 0 0
fiA =
160 54 11
0 138 21
0 -42 75
K =
160 54 11
𝐾 = 160 54 11
Respuesta a un escalón unitario del sistema diseñado
0 1 0 0 0 1 0
𝐴 − 𝐵𝐾 = 0 0 1 − 0 160 54 11 = 0 0 1
0 −2 −3 1 −160 −56 −14
𝑥 = 𝐴 − 𝐵𝐾 𝑥 + 𝐵𝑘1 𝑟
0 1 0 0
𝑥= 0 0 1 𝑥+ 0 𝑟
−160 −56 −14 160
𝑦= 1 0 0𝑥
close all; clear all; clc;
AA=[0 1 0; 0 0 1; -160 -56 -14];
BB=[0; 0; 160];
CC=[1 0 0];
DD=[0];
t=0:0.01:5;
y=step(AA,BB,CC,DD,1,t);
plot(t,y)
grid
title('respuesta escalon unitario')
xlabel('t seg')
ylabel('salida y')
Figura 2.9
Respuesta en el tiempo
respuesta escalon unitario
1.4
1.2
salida y 0.8
0.6
0.4
0.2
0
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
t seg
1.6
1.4
1.2
1
salida y
0.8
0.6
0.4
0.2
0
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
t seg
𝑥1 (∞)
𝑢 ∞ = − 160 54 11 𝑥2 (∞) + 160𝑟
𝑥3 (∞)
𝑟
𝑢 ∞ = − 160 54 11 0 + 160𝑟 = 0
0
Figura 2.11
Servosistema de tipo 1
r u x y
+
- k1 +
-
B +
+ C
K
𝑥 = 𝐴𝑥 + 𝐵𝑢, 𝑦 = 𝐶𝑥
𝑢 = −𝐾𝑥 + 𝑘1 𝜉
𝜉 = 𝑟 − 𝑦 = 𝑟 − 𝐶𝑥
Donde
𝑥 = 𝑣𝑒𝑐𝑡𝑜𝑟 𝑑𝑒 𝑒𝑠𝑡𝑎𝑑𝑜 𝑝𝑎𝑟𝑎 𝑙𝑎 𝑝𝑙𝑎𝑛𝑡𝑎 𝑣𝑒𝑐𝑡𝑜𝑟 𝑑𝑒 𝑑𝑖𝑚𝑒𝑛𝑠𝑖𝑜𝑛 𝑛
𝑢 = 𝑠𝑒ñ𝑎𝑙 𝑑𝑒 𝑐𝑜𝑛𝑡𝑟𝑜𝑙 𝑒𝑠𝑐𝑎𝑙𝑎𝑟
𝑦 = 𝑠𝑒ñ𝑎𝑙 𝑑𝑒 𝑠𝑎𝑙𝑖𝑑𝑎 𝑒𝑠𝑐𝑎𝑙𝑎𝑟
𝜉 = 𝑠𝑎𝑙𝑖𝑑𝑎 𝑑𝑒𝑙 𝑖𝑛𝑡𝑒𝑔𝑟𝑎𝑑𝑜𝑟 (𝑣𝑎𝑟𝑖𝑎𝑏𝑙𝑒 𝑑𝑒 𝑒𝑠𝑡𝑎𝑑𝑜 𝑑𝑒𝑙 𝑠𝑖𝑠𝑡𝑒𝑚𝑎, 𝑒𝑠𝑐𝑎𝑙𝑎𝑟)
𝑟 = 𝑠𝑒ñ𝑎𝑙 𝑑𝑒 𝑒𝑛𝑡𝑟𝑎𝑑𝑎 𝑑𝑒 𝑟𝑒𝑓𝑒𝑟𝑒𝑛𝑐𝑖𝑎 (𝑓𝑢𝑛𝑐𝑖𝑜𝑛 𝑒𝑠𝑐𝑎𝑙𝑜𝑛, 𝑒𝑠𝑐𝑎𝑙𝑎𝑟)
𝐴 = 𝑚𝑎𝑡𝑟𝑖𝑧 𝑑𝑒 𝑐𝑜𝑒𝑓𝑖𝑐𝑖𝑒𝑛𝑡𝑒𝑠 𝑐𝑜𝑛𝑠𝑡𝑎𝑛𝑡𝑒𝑠 𝑛 𝑥 𝑛
𝐵 = 𝑚𝑎𝑡𝑟𝑖𝑧 𝑑𝑒 𝑐𝑜𝑒𝑓𝑖𝑐𝑖𝑒𝑛𝑡𝑒𝑠 𝑐𝑜𝑛𝑠𝑡𝑎𝑛𝑡𝑒𝑠 𝑛 𝑥 1
𝐶 = 𝑚𝑎𝑡𝑟𝑖𝑧 𝑑𝑒 𝑐𝑜𝑒𝑓𝑖𝑐𝑖𝑒𝑛𝑡𝑒𝑠 𝑐𝑜𝑛𝑠𝑡𝑎𝑛𝑡𝑒𝑠 1 𝑥 𝑛
𝑥𝑒 (𝑡) 𝐴 0 𝑥𝑒 𝑡 𝐵 95
= + 𝑢 𝑡
𝜉𝑒 (𝑡) −𝐶 0 𝜉𝑒 (𝑡) 0 𝑒
𝑢𝑒 𝑡 = −𝐾𝑥𝑒 𝑡 + 𝑘𝐼 𝜉𝑒 (𝑡) 96
Se define un nuevo vector de error 𝑒(𝑡) de dimensión (n+1) mediante
𝑥𝑒 𝑡 97
𝑒 𝑡 = = 𝑛 + 1 − 𝑣𝑒𝑐𝑡𝑜𝑟
𝜉𝑒 (𝑡)
Así la ecuación 95 se transforma en
𝑒 = 𝐴𝑒 + 𝐵𝑢𝑒 99
Donde
𝐴 0 𝐵 100
𝐴= , 𝐵=
−𝐶 0 0
Y la ecuación 95 se convierte en
𝑢𝑒 = −𝐾 𝑒 101
𝐾= 𝐾 −𝑘𝐼 102
La ecuación de estado del error es
𝑒 = 𝐴 − 𝐵𝐾 𝑒 103
Si los valores propios deseados de la matriz 𝐴 − 𝐵𝐾 (es decir, los polos en lazo
cerrado deseados) se especifican como 𝜇1 , 𝜇2 , … , 𝜇𝑛+1 , entonces la matriz de
ganancias de realimentación del estado K y la constante de ganancia integral 𝑘𝐼
pueden determinarse mediante el método de asignación de polos presentado en
el capítulo 1, a condición de que el sistema definido por la ecuación 100 es de
estado completamente controlable. Obsérvese que si la matriz
𝐴 𝐵 104
−𝐶 0
tiene rango 𝑛 + 1 , entonces el sistema definido por la ecuación 12.40 es de
estado completamente controlable. Como ocurre normalmente, no todas las
variables de estado se pueden medir de forma directa. Si este es el caso, se
necesita usar un observador de estado. La figura 2.12 muestra un diagrama de
bloques de un servosistema de tipo 1 con un observador de estado (en la figura,
cada bloque con un símbolo integral representa un integrador (1/s).)
Figura 2.12
Servosistema de tipo 1 con observador de estado
r ξ + x
+ u
∫ Ki B ∫ C y
- +
Observador
K
EJEMPLO 2.5
Considérese el sistema de control del péndulo invertido que se muestra en la
figura 12.8. En este ejemplo, se está interesado en los movimientos del péndulo
y en el movimiento del carro en el plano de la página.
Figura 2.13
Sistema de control del péndulo invertido
y
Lsenθ
x
Lcosθ
mg
L
O x
P
u M
Se desea mantener el péndulo invertido lo más cercano posible a la vertical y al
mismo tiempo controlar la posición del carro; por ejemplo, moverlo súbitamente
de un punto a otro.
Para controlar la posición del carro es necesario construir un servosistema de
tipo 1. El sistema del péndulo invertido montado en un carro no tiene un
integrador. Por lo tanto, se realimenta la señal de posición y (que indica la
posición del carro) a la entrada y se inserta un integrador en el camino directo,
tal como se muestra en la figura 2.13.
Figura 2.14
Sistema de control del péndulo invertido
Servosistema tipo 1 cuando la planta no tiene un integrador
x
r + + y
ξ u
∫ ki ẋ=Ax+Bu y=Cx
-
-
k1
k2
k3
k4
Las ecuaciones dinámicas del péndulo son
𝑀𝐿𝜃 = 𝑀 + 𝑚 𝑔𝜃 − 𝑢, 𝑀𝑥 = 𝑢 − 𝑚𝑔𝜃
Sustituyendo los valores numéricos
𝜃 = 20.601𝜃 − 𝑢, 𝑥 = 0.5𝑢 − 0.4905𝜃
Se definen las variables de estado como
𝑥1 = 𝜃, 𝑥2 = 𝜃 , 𝑥3 = 𝑥, 𝑥4 = 𝑥
De la figura 2.14 se obtienen las ecuaciones para el sistema del modo siguiente:
𝑥 = 𝐴𝑥 + 𝐵𝑢, 𝑦 = 𝐶𝑥
𝑢 = −𝐾𝑥 + 𝑘𝐼 𝜉
𝜉 = 𝑟 − 𝑦 = 𝑟 − 𝐶𝑥
0 1 0 0 0
𝐴 = 20.601 0 0 0 , 𝐵 = −1 , 𝐶= 0 0 1 0
0 0 0 1 0
−0.4905 0 0 0 0.5
Khat =
-157.6336 -35.3733 -56.0652 -36.7466 50.9684
0.2 0.2
x1
x2
0.1 0
0 -0.2
-0.1 -0.4
0 1 2 3 4 5 6 0 1 2 3 4 5 6
t seg t seg
x3-t x4-t
1.5 1.5
1 1
x3
x4
0.5 0.5
0 0
-0.5 -0.5
0 1 2 3 4 5 6 0 1 2 3 4 5 6
t seg t seg
x5-t
1.5
1
x5
0.5
0
0 1 2 3 4 5 6
t seg
Se obtiene 𝑢 ∞ = 0 de la ecuacion 12.33 se tiene
𝑢 ∞ = 0 = −𝐾𝑥 ∞ + 𝑘𝐼 𝜉 ∞
1 1 −56.0652
𝜉 ∞ = 𝐾𝑥 ∞ = 𝑥3 ∞ = 𝑟 = 1.1𝑟
𝑘𝐼 𝑘𝐼 −50.9684
Por lo tanto para r=1 se obtiene 𝜉 ∞ = 1.1. Se observa, como en cualquier
problema de diseño, si la velocidad y el amortiguamiento no son suficientemente
aceptables se debe modificar la ecuación característica deseada y determinar una
nueva matriz 𝐾 . Las simulaciones en el computador se deben repetir hasta que se
alcance un resultado satisfactorio