Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Índice
1. Introducción 2
2. Autopiloto básico 2
2.1. Conversor . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 2
2.2. Sensor . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 2
2.3. Controlador . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 3
2.4. Planta . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 3
2.4.1. Actuador . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 3
2.4.2. Sistema de estabilidad aumentada . . . . . . . . . . . . . . . . . . . . . . . . 4
2.4.3. Dinámica del avión . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4
3. Modelo 5
3.1. Ecuaciones de movimiento . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 5
3.2. Datos . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 6
3.3. Diagrama de bloques . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 7
4. Análisis 8
4.1. Respuesta en lazo abierto . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 8
4.1.1. Respuesta ante entradas impulso y escalón . . . . . . . . . . . . . . . . . . . 8
4.1.2. Respuesta en frecuencia . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9
4.2. Respuesta en lazo cerrado . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 10
4.2.1. Error en régimen permanente . . . . . . . . . . . . . . . . . . . . . . . . . . . 10
4.2.2. Respuesta en frecuencia . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 11
4.2.3. Margen de estabilidad - Criterio de Routh-Hurwitz . . . . . . . . . . . . . . . 12
5. Diseño 13
5.1. Polos objetivos . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 13
5.2. Lugar de raíces . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 13
5.2.1. Polos y ceros . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 13
5.2.2. Asíntotas . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 14
5.2.3. Puntos del eje real que pertenecen al lugar de las raíces . . . . . . . . . . . . 14
5.2.4. Puntos de ruptura . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 14
5.2.5. Puntos de corte con el eje imaginario . . . . . . . . . . . . . . . . . . . . . . . 15
5.2.6. Ángulos de salida y llegada . . . . . . . . . . . . . . . . . . . . . . . . . . . . 15
5.2.7. Gráca del lugar de raíces . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 15
5.3. Compensador de adelanto-retraso . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 17
5.3.1. Ajuste por el lugar de raíces . . . . . . . . . . . . . . . . . . . . . . . . . . . . 17
5.3.2. Criterio de selección de a y b . . . . . . . . . . . . . . . . . . . . . . . . . . . 17
5.3.3. Calculo de la ganancia . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 18
5.3.4. Análisis de los resultados . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 18
5.4. Rediseño . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 20
5.4.1. Reubicación de los polos objetivos . . . . . . . . . . . . . . . . . . . . . . . . 21
5.4.2. Diseño nal . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 23
6. Conclusión 27
1. Introducción
2. Autopiloto básico
Perturbaciones
θref vref ev vcontrol θout
Conversor − Controlador Planta
vsensor
Sensor
2.1. Conversor
El conversor traduce el angulo de referencia a la cual se quiere equilibrar el avión en una señal de
voltaje de referencia manipulable para el sistema. Suponemos el uso de un conversor proporcional
de relación unitaria. Por ejemplo, para un angulo de referencia de 5 grados, la señal de referencia
es de 5 volts. La función de transferencia es la unidad.
vref (s)
Conversor = =1
θref (s)
en unidades de V/◦ .
2.2. Sensor
Para el sensor suponemos el uso de un giróscopo vertical que mida la inclinación del avión y
devuelva una señal de voltaje como realimentación del sistema. Para la ley de conversión suponemos
como en el caso anterior una relación proporcional unitaria. En cuanto al tiempo de retraso en la
medición, se aproxima a una función de transferencia de primer orden:
vsensor (s) 1
Sensor = =
θout (s) τs s + 1
2.3. Controlador
El bloque del controlador corresponde a la ley de control que se quiere diseñar para que el
sistema de autopiloto responda con los requerimientos deseados.
2.4. Planta
El bloque de la planta consiste en el conjunto formado por el actuador, la dinámica del avión
y el sistema de estabilidad aumentada (SAS: stability augmentation system). El subdiagrama de
bloques para la planta se representa como:
vsas
SAS
Planta
2.4.1. Actuador
Suponemos el uso de un actuador electrohidráulico para el elevador, de relación proporcional
unitaria (1 grado de deexión de elevador por voltio) y retardo en la actuación de primer orden. La
función de transferencia es:
δ(s) 1
Actuador = =
vdamp (s) τe s + 1
Impulse Response
1.4
con SAS
sin SAS
1.2
1
Amplitude
0.8
0.6
0.4
0.2
0
0 1 2 3 4 5 6 7 8 9 10
Time (seconds)
3. Modelo
Se asume que el avión se encuentra en vuelo crucero a velocidad y altitud constantes. Por tanto
el empuje, el arrastre, el peso y la sustentación se balancean en las direcciones x e y . Las ecuaciones
de movimiento longitudinal se escriben como sigue:
1 CL
(CDα − CL ) α +
CD u + τ u̇ + θ = 0
2 2
CLα
CL u + α + τ α̇ − τ θ̇ = 0
2
Cmu u + Cmα α + Cmdα τ α̇ + Cmdθ τ θ̇ − hτ 2 θ̈ = −Cmδ δ − Cmdδ τ δ̇
donde:
α = angulo de ataque.
θ = angulo de cabeceo.
δ = deexión del elevador.
CL = coeciente de sustentación.
CDα = pendiente del coeciente de resistencia.
CLα = pendiente del coeciente de sustentación.
Cmα = momento de cabeceo por angulo de ataque.
Cmdα = momento de cabeceo por velocidad de cambio de angulo de ataque.
Cmdθ = amortiguamiento de cabeceo.
Cmδ = potencia del elevador.
1
CL α + τ α̇ − τ θ̇ = 0
2 α
Cmα α + Cmdα τ α̇ + Cmdθ τ θ̇ − hτ 2 θ̈ = −Cmδ δ
3.2. Datos
Usaremos los datos del Boeing 747-400 en vuelo crucero a Mach=0.65 y 20000 pies. Los datos
para esta condición de vuelo (sacados de Roskam J., Aircraft Flight Dynamics and Automatic Flight
Controls) son:
Finalmente, la función de transferencia que relaciona el angulo de cabeceo con la deexión del
elevador es:
4.22s + 2.2 0
θout (s) −0.072s − 1 1.3 1.69s + 0.84
= =
2 + 1.18s + 1.59)
δ(s) 4.22s + 2.2 −4.22s
s(s
−0.072s − 1 0.768s2 − 0.359s
1 V/◦
vsas
0.5s
Planta
Se tiene que
θout (s) Actuador × Dinamica
=
vcontrol (s) 1 + Actuador × Dinamica × SAS
1 1.69s+0.84
0.1s+1 s(s2 +1.18s+1.59) 16.90(s + 0.50)
1 1.69s+0.84 =
1+ 0.1s+1 s(s2 +1.18s+1.59) 0.5s
s(s + 9)(s2 + 2.17s + 2.23)
entonces
Planta
vsensor
1 V/◦
4. Análisis
Se establecen los requerimientos y se analizan las respuestas del sistema en lazo abierto y cerrado
ante entradas impulso y escalón unitario.
El piloto automático deberá recibir una señal del tipo entrada escalón y llevar el avión a la
inclinación deseada dentro de los siguientes limites:
Sobrepasamiento menor al 5 %.
Tiempo de establecimiento menos de 5 segundos.
Error en el estado estacionario menor al 1 %.
Entrada impulso
1
vref (s) = s 16.90(s+0.50)
θout (s)
s(s+9)(s2 +2.17s+2.23)
0.8 3.5
0.7
3
0.6
2.5
0.5
Amplitude
Amplitude
2
0.4
1.5
0.3
1
0.2
0.5
0.1
0 0
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7
Time (seconds) Time (seconds)
Se ve que el sistema posee un amortiguamiento natural que lo hace estable ante perturbacio-
nes del tipo impulso. El sistema es claramente divergente ante una entrada escalón cuando no es
realimentado.
Vemos que la función de transferencia lazo abierto es el producto entre una ganancia, un inte-
grador, un polo simple, un cero simple y un polo doble. El diagrama de Bode resultante es la suma
de los diagramas de Bode para cada una de las funciones elementales, en virtud de que el logaritmo
de un producto es la suma de los logaritmos de los factores.
Bode Diagram
50
−100
−150
−45
−90
Phase (deg)
−135
−180
−225
−270
−2 −1 0 1 2 3
10 10 10 10 10 10
Frequency (rad/s)
1 1 1
s s2 s3
0 1
1+Kp ∞ ∞
I 0 1
Kv ∞
II 0 0 1
Ka
Utilizando MATLAB vericamos que es así. Presentamos la salida del sistema lazo cerrado ante
una entrada escalón (Figura 4).
Se ve que el sistema cumple con la mayoría de los requerimientos salvo el tiempo de asentamiento,
que es mas del doble de lo deseado. Algún tipo de compensación se debe realizar.
1
vref (s) = s ev (s) 16.90(s+0.50)
θout (s)
− s(s+9)(s2 +2.17s+2.23)
vsensor
1 V/◦
Step Response
0.9
0.8
0.7
0.6
Amplitude
0.5
0.4
0.3
0.2
0.1
0
0 2 4 6 8 10 12 14 16 18 20
Time (seconds)
Bode Diagram
50
Lazo abierto
Lazo cerrado
0
−100
−150
0
Lazo abierto
Lazo cerrado
Phase (deg)
−90
−180
−270
−2 −1 0 1 2 3
10 10 10 10 10 10
Frequency (rad/s)
Todos los coecientes de la ecuación característica son positivos para K > 0. Se procede a armar
la tabla y se verica que los valores de la primera columna sean positivos.
s4 1 21.78 8.45k
s3 11.17 16.9K + 20.11
s2 20 − 1.51K 8.45K
−25.52K 2 +213.25K+402.2
s1 20−1.51K
s0 8.45K
En la la 3 se tiene 20 − 1.51K > 0 ⇒ K < 13.25. En la la 4 se tiene −25.52K 2 + 213.25K +
402.2 > 0 ⇒ K < 9.93. Por tanto, la ganancia critica queda denido por el limite inferior, o sea
Kcr = 9.93
5. Diseño
Con los requerimientos de diseño presentados, se denen los polos objetivos. Se emplea el método
de lugar de las raíces para el diseño de un compensador proporcional que logre que los polos
dominantes del sistema sean los polos objetivos. De no ser posible, se procede al diseño de un
compensador de adelanto-retraso que modique el lugar de raíces de forma que pase por los polos
objetivos.
Sobrepasamiento menor al 5 %.
√−πξ
0.05 ≥ Mp = e 1−ξ2 ⇒ ξ ≥ 0.69
El polo objetivo debe localizarse dentro de la zona del eje real negativo entre los ángulos 134.43◦ y
−134.43◦ . Usaremos ξ = 0.7.
Tiempo de levantamiento menor a 5 segundos.
4
5 s ≥ ts = ⇒ ξω ≥ 0.8
ξωn
La parte real de los polos objetivos debe ser menor o igual a −0.8. Para ξ = 0.7 ⇒ ωn ≥ 1.143 rad/s.
El modulo de los polos objetivos debe ser mayor o igual a 1.143. Adopto ωn = 2 rad/s.
Los polos objetivos resultan:
−1.4 ± 1.43i
Si los polos del sistema contienen a los polos objetivos, y estos son dominantes, entonces nos
aseguraremos de que cumplirán los requerimientos.
Se hallan los polos y ceros de la planta. Luego se hallan las asíntotas, el lugar en el eje real,
corte en el eje imaginario, puntos de ruptura, ángulos de salida/entrada y margen de ganancia.
0
−9
polos =
−1.09 + 1.03i
−1.09 − 1.03i
ceros = −0.5
5.2.2. Asíntotas
Todas las asíntotas se cortan en un único punto del eje real, que se calcula de la forma:
P P
pi − zj
σa =
n−m
donde n es la cantidad de polos y m es la cantidad de ceros. Los ángulos que forman las asíntotas
son:
180◦
θa = (2k + 1) k = 0, 1, . . . , n − m − 1
n−m
Para los datos,
(0 − 9 − 1.09 + 1.03i − 1.09 − 1.03i) − (−0.5)
σa = = −3.56
4−1
Los ángulos que forman las asíntotas son 60º, 180º y 300º.
5.2.3. Puntos del eje real que pertenecen al lugar de las raíces
Los intervalos de la parte real que pertenecen al lugar de las raíces deben dejar a su derecha un
numero impar de ceros y polos. De acuerdo a esto, los intervalos [−0.5, 0] y (−∞, −9] son lugar de
de las raíces. Es decir, todo el eje real negativo excepto el intervalo (−9, 0).
Las soluciones reales no pertenecen al lugar de las raíces, por tanto no son puntos de ruptura.
16.90(s+0.50)
− K s(s+9)(s2 +2.17s+2.23)
El lugar de raíces en el eje real ya se analizo anteriormente. Por tanto solo resta saber el angulo
de salida en los polos complejos.
Para q ≈P −1.09 + 1.03i
◦ ◦ ◦ ◦
P
iq −
zc pcj q = 136.63 − 90 − 7.26 = 39.4
El lugar de raíces sale del polo −1.09 + 1.03i a un angulo de 39.4◦ y del polo −1.09 − 1.03i a un
angulo de −39.4◦ .
Root Locus
−2
−4
−6
−8
−12 −10 −8 −6 −4 −2 0 2 4 6
Real Axis (seconds−1)
El compensador de adelanto puede ayudar a mejorar la respuesta transitoria del sistema, mien-
tras que el compensador de retraso mejora la respuesta estacionaria. En la sección anterior habíamos
examinado la función de transferencia del sistema lazo abierto y nos dimos cuenta que éste era del
tipo I con lo que el error en régimen permanente ante una entrada escalón seria nulo. Por tanto solo
nos haría falta un compensador de adelanto. Un compensador de adelanto tiene la siguiente forma:
s+a
C = Kc a<b
s+b
El efecto de un compensador de adelanto en el lugar de raíces es la de arrastrar las ramas del
lugar de raíces hacia la zona negativa, haciendo que más puntos del lugar de raíces pertenezcan
a la zona estable. Esto es deseable en nuestro sistema ya que posee muy poca disponibilidad de
puntos para el diseño. Se intentará elegir valores para a y b para que las ramas del lugar de raíces
se desplacen y pasen por los polos objetivos.
Donde las sumatorias son sobre los polos y ceros del sistema original.
Siendo p4 = −1.4 + 1.43i ⇒ ϕc = 68◦ .
Root Locus
20
15
10
Imaginary Axis (seconds−1)
−5
−10
−15
−20
−10 −8 −6 −4 −2 0 2
Real Axis (seconds−1)
Figura 8: Compensación PD
16.9(s+0.5)
θout (s) C × P lanta 0.45 (s + 2) s(s+9)(s2 +2.17s+2.23) 7.6 (s + 2) (s + 0.5)
= = =
θref (s) 1 + C × P lanta 16.9(s+0.5)
1 + 0.45 (s + 2) s(s+9)(s2 +2.17s+2.23) (s + 8.14) (s + 0.23) (s2 + 2.8s + 4.04)
En la Figura 10 se muestra el lugar de raíces con los polos y ceros del sistema lazo cerrado. Los
puntos cuadrados rosados representan los polos lazo cerrado, el punto circular azul es el cero de la
planta y el punto circular rojo es el cero introducido por el compensador. Los puntos en cruz son
los polos de la planta.
Step Response
1
0.9
0.8
0.7
0.6
Amplitude
0.5
0.4
0.3
0.2
0.1
0
0 5 10 15 20 25 30
Time (seconds)
Resulta que tenemos un problema con la aparición de un polo mas dominante (s = −0.23)
que los polos objetivos que queríamos. Además, el polo se encuentra muy cerca del origen. El
efecto resultante es la de una respuesta con mucho mayor amortiguamiento, pero a costa de un
aumento en el tiempo de asentamiento. El gráco de la respuesta (Figura 9) muestra este hecho
donde el requerimiento en el sobrepasamiento esta claramente satisfecho mientras que el tiempo de
asentamiento es 3 veces mayor que el limite requerido (∼ 15 segs).
5.4. Rediseño
cualquier polo objetivo posible. Sin embargo, el efecto del polo puede aminorarse si ésta se encuentra
sucientemente cerca del cero del sistema, en −0.5.
ξ = 0.74
ωn = 2.7 rad/s
Kc =
0.97
−2 ± 1.8i
polos = −6.87
−0.33
Mp = 0%
ts = 8.76 s
Step Response
1
0.9
0.8
0.7
0.6
Amplitude
0.5
0.4
0.3
0.2
0.1
0
0 5 10 15
Time (seconds)
p∆ = −3 ± 2.2i
ξ = 0.81
ωn = 3.71 rad/s
Kc =
1.47
−3 ± 2.2i
polos = −4.81
−0.37
Mp = 0%
ts = 6.84 s
Step Response
1
0.9
0.8
0.7
0.6
Amplitude
0.5
0.4
0.3
0.2
0.1
0
0 2 4 6 8 10 12
Time (seconds)
p∆ = −4 ± 4.2i
ξ = 0.69
ωn = 5.8 rad/s
Kc =
2.27
−4 ± 4.2i
polos = −2.77
−0.41
Mp = 1.5 %
ts = 5.33 s
Step Response
1.4
1.2
0.8
Amplitude
0.6
0.4
0.2
0
0 2 4 6 8 10 12
Time (seconds)
Para este ultimo caso, nos hemos acercado bastante a los requerimientos exigidos (Mp =
1.5 %, ts = 5.33s). Notar que esta vez el polo problemático s = −0.41 esta bastante cerca del
cero del sistema, en −0.5. Se ve que el amortiguamiento de los polos oscilantes esta por debajo
del limite propuesto (ξ ≥ 0.7) pero esta insuciencia es compensada por el cuarto polo real del
sistema, de efecto amortiguante, que esta vez resulta ser más dominante que los polos objetivos,
pero a diferencia del polo problemático, ésta se encuentra en la zona de diseño.
p∆ = −4.08 ± 4.92i
ξ = 0.64
ωn = 6.39 rad/s
Kc =
2.65
−4 ± 4.92i
polos = −2.59
−0.423
Mp = 4.66 %
ts = 4.88 s
Step Response
1.4
1.2
1
Amplitude
0.8
0.6
0.4
C=1
Kc=0.45
0.2 Kc=0.97
Kc=1.47
Kc=2.27
Kc=2.65
0
0 1 2 3 4 5 6 7 8 9 10
Time (seconds)
Step Response
1.4
1.2
0.8
Amplitude
0.6
0.4
0.2
0
0 1 2 3 4 5 6 7 8 9
Time (seconds)
vsensor
1 V/◦
6. Conclusión
Se ha visto que el uso de un compensador es una aplicación poderosa que mejora la respuesta
de un sistema. También vimos que el diseño de un compensador puede resultar una tarea directa
o terminar en un proceso de prueba y error para encontrar el ajuste preciso para que el sistema
responda como se desea. El conocimiento de las herramientas y metodologías brindadas por la
Teoría de Control fueron cruciales para diseñar el sistema automático y simplicar los procesos de
cálculo.
Referencias