Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
SANGOLQU - ECUADOR
2010
CERTIFICACIN
Certificamos
que
el
presente
Proyecto
de
Grado
titulado
DISEO
____________________
Ing. Vctor Proao
DIRECTOR
_____________________
Ing. Rodolfo Gordillo
CODIRECTOR
AGRADECIMIENTO
A mis padres, Enrique y Marina por darme todo su apoyo y quererme por sobre todas
las cosas.
A mis abuelitos, Telmo y Maura por darme su amor, apoyo y confianza.
A mis hermanas, Gabi y Nati por siempre estar a mi lado apoyndome y brindndome
su comprensin y cario.
A mis tos Oswaldo y Mara por siempre darme buenos consejos.
A Freddy y Germmy por brindarme su apoyo y amistad incondicional.
A Rosy por compartir momentos importantes en mi vida y darme su apoyo para
terminar este proyecto.
Un agradecimiento especial a mi director de tesis el Ing. Vctor Proao por ayudarme a
hacer posible esta tesis gracias a su conocimiento y paciencia, a mi codirector el Ing.
Rodolfo Gordillo quien colabor desinteresadamente en la elaboracin del proyecto,
gracias por el apoyo brindado.
Javier
DEDICATORIA
Javier
PRLOGO
Antecedentes.
Justificacin e Importancia.
obtienen.
Objetivo General
Objetivos Especficos
INDICE DE CONTENIDOS
CAPTULO 1 ................................................................................................................................................. 1
INTRODUCCIN .......................................................................................................................................... 1
1.1. DESCRIPCIN DEL SISTEMA DE SERVOMOTOR ...................................................................................... 1
1.1.1 COMPONENTES DEL SISTEMA SERVOMOTOR ............................................................................... 2
1.2. MODELAMIENTO MATEMTICO DE LA PLANTA .................................................................................... 4
1.2.1 Modelo Lineal .................................................................................................................................. 4
1.2.2 Modelo No Lineal ............................................................................................................................ 7
1.3. REPRESENTACIN DEL MODELO MATEMTICO DE LA PLANTA MEDIANTE ECUACIONES DE
VARIABLES DE ESTADO.................................................................................................................................. 8
1.4. MODELOS DE SIMULACIN .................................................................................................................... 9
1.5. ESTABILIDAD DEL SISTEMA................................................................................................................... 10
1.5.1. Estabilidad del sistema en lazo abierto ........................................................................................ 11
1.5.2 Estabilidad del sistema en lazo cerrado con realimentacin unitaria .......................................... 11
CAPTULO 2 ............................................................................................................................................... 13
TECNOLOGAS DE CONTROL ...................................................................................................................... 13
2.1 CONTROL CLSICO ................................................................................................................................ 13
2.1.1 COMPENSACIN EN ADELANTO ................................................................................................... 15
2.1.1.1 DISEO DE BODE ................................................................................................................................... 16
2.1.1.2 DISEO MEDIANTE LUGAR DE LAS RACES ............................................................................................ 18
2.1.1.3 MTODO GEOMTRICO ......................................................................................................................... 19
CAPITULO 1: INTRODUCCIN
1
_____________________________________________________________________________________________________________
CAPTULO 1
INTRODUCCIN
1.1. DESCRIPCIN DEL SISTEMA DE SERVOMOTOR
Componentes:
Hardware:
Los siguientes elementos son los componentes de hardware del Sistema Servomotor:
CAPITULO 1: INTRODUCCIN
2
_____________________________________________________________________________________________________________
Potencimetro de entrada
Tarjeta RT-DAC/PCI
Interfaz de potencia
Software:
Los tipos de software que utiliza el Sistema Servomotor son los siguientes:
MS Windows2000/XP
CAPITULO 1: INTRODUCCIN
3
_____________________________________________________________________________________________________________
Funcionamiento:
El motor DC junto con el tacogenerador inicia el sistema mientras que la caja de cambios
con disco a la salida finaliza el sistema. El mdulo del potencimetro est ubicado fuera
del sistema. El motor DC puede activar los siguientes mdulos:
Inercia
Backlash
Codificador digital
Freno magntico
El ngulo de rotacin del eje del motor DC se mide utilizando un codificador incremental.
En cualquier lugar que sea necesario la medicin del ngulo de rotacin se puede colocar
el codificador. Un tacogenerador est conectado directamente al motor DC y genera una
seal de tensin proporcional a la velocidad angular.
El servomecanismo est conectado a una computadora donde se realiza el algoritmo de
control basado en mediciones de ngulo y velocidad angular. El sistema no tiene
realimentacin interior para compensacin de la zona muerta. La precisin de la medicin
de la velocidad es de 5%, mientras que la precisin de la medida del ngulo es de 0,1%. El
voltaje inducido del motor DC est controlado por una seal PWM. La seal de control
adimensional es el voltaje de entrada escalonado u(t) = v(t)/vmax. El control admisible
satisface |u(t)| 1 y vmax = 12 [V].
El sistema de medicin se basa en una tarjeta de adquisicin RTDAC/ PCI equipada con
convertidores A/D.
La tarjeta I/O se comunica con la unidad de interfaz de energa. Toda la lgica necesaria
para activar y leer las seales del codificador y generar la secuencia adecuada de pulsos
PWM para controlar el motor DC se configura en el chip Xilinx de la tarjeta
RTDAC/PCI.
Todas las funciones de la tarjeta pueden ser accedidas desde el Modular Servo Toolbox,
que opera directamente en MATLAB / Simulink.
CAPITULO 1: INTRODUCCIN
4
_____________________________________________________________________________________________________________
se lo considera como
despreciable.
La Elctrica:
v(t ) R * i (t ) K e
d
dt
d
dt
La Mecnica:
J
d 2
d
K m i (t )
2
dt
dt
2
d d
dt
dt 2
Donde:
v(t)
voltaje de entrada
i(t)
corriente en la armadura
CAPITULO 1: INTRODUCCIN
5
_____________________________________________________________________________________________________________
resistencia de la armadura
v(t ) K e d
R
R dt
d
d 2
K m i (t )
J 2
dt
dt
i (t )
R dt
R
d
K m v(t ) K m K e
R
dt
d
d 2
J 2
dt
dt
d
d 2
RJ 2
dt
dt
d
d 2
K m v(t ) ( K m K e R )
RJ 2
dt
dt
Km
d
RJ
d 2
v(t )
K m K e R
dt
K m K e R dt 2
Ts
RJ
K m K e R
K sm
Donde:
Ts
Km
K m K e R
CAPITULO 1: INTRODUCCIN
6
_____________________________________________________________________________________________________________
Funcin de Transferencia
Ts * s 2 * ( s ) K sm v( s ) s * ( s )
v( s )
Ts * s 1
(s)
v( s )
K sm
s (Ts * s 1)
(s)
v( s )
K sm
(Ts * s 1)
Se asume la seal de control adimensional como una escala de voltaje, u (t ) v(t ) / V max ,
esto satisface el control u (t ) 1
(s)
u (s)
(s)
K sm * V max
Ts * s 1
u (s)
K s K sm * V max
(s)
u (s)
Ks
s (Ts * s 1)
(s)
u (s)
Ks
(Ts * s 1)
K sm * V max
s (Ts * s 1)
CAPITULO 1: INTRODUCCIN
7
_____________________________________________________________________________________________________________
Los pequeos cambios en las variables de estado se los asumen como despreciables, por lo
que se considera al sistema servomotor como un modelo lineal.
Sin embargo hay algunas aplicaciones no lineales en el lazo de control en las cuales se
debe tomar en cuenta a dichos cambios.
x1 x 2
x 2 c(u g ( x 2 ))
0
1
0
x1
x u (t )
x 0 cg
c
2
1 0
0 1 x
CAPITULO 1: INTRODUCCIN
8
_____________________________________________________________________________________________________________
Haciendo:
x1
x2
x1 x 2
x 2 ax 2 bu (t )
Ts x 2 K s * u (t ) x 2
x2
K
1
x 2 s u (t )
Ts
Ts
1
0
0
1 x K s u (t )
x1
T
x 0 T
s
2
s
1 0
0 1 x
1
Ts
Ks
Ts
CAPITULO 1: INTRODUCCIN
9
_____________________________________________________________________________________________________________
Las funciones de transferencia tanto para la posicin y velocidad angular quedan descritas
de la siguiente manera:
(s)
u (s)
186
s (1.04s 1)
(s)
u (s)
186
1.04s 1
178.8
x 0 0.961
2
1 0
0 1 x
Este sistema puede ser clasificado como tipo SIMO (Single Input, Multiple Output), ya que
posee dos variables de estado que pueden ser medidas (ngulo y velocidad) y una variable
de control.
CAPITULO 1: INTRODUCCIN
10
_____________________________________________________________________________________________________________
CAPITULO 1: INTRODUCCIN
11
_____________________________________________________________________________________________________________
G (s)
186
s (1.04 s 1)
G(s)
186
(1.04s 1)
G (s)
186
s (1.04 s 1)
186
186 K
K
KG
186 K
s (1.04 s 1)
s (1.04 s 1)
2
2
1 KG
1 K
s (1.04 s 1)
s (1.04 s 1)
Ec. caracterstica
1 KG 0
1.04 s 2 s 186 K 0
CAPITULO 1: INTRODUCCIN
12
_____________________________________________________________________________________________________________
s 2 1.04
s1
186 K
s 0 186 K
b1
1 1.04 186 K
1 * (186 K ) 186 K
0
1 1
186
(1.04 s 1)
K
KG
186 K
(1.04 s 1)
(1.04 s 1)
1
.
04
s
186
K
1 KG
1.04 s 1 186 K
186
1 K
(1.04 s 1)
(1.04 s 1)
Ec. caracterstica
1 KG 0
1.04 s 1 186 K 0
s 1 1.04
s 0 186 K 1
El sistema es estable mientras K
1
186
CAPTULO 2
TECNOLOGAS DE CONTROL
La funcin de transferencia de la figura 2.1 que relaciona la salida con la entrada del
sistema es la siguiente:
C (s)
Gc( s )Gp( s )
R( s)
1 Gc( s )Gp( s )
F ( s)
S Q1 ( s )
Aqu se define a:
ess lim sE ( s )
s0
Donde:
E (s)
R( s)
1 Gc( s )Gp( s )
ess lim
s 0
sR ( s )
1 Gc( s )Gp( s )
ess
1
1 Kp
Donde:
Kp constante de error de posicin
De donde:
Si N 1 ;
Kp ; ess = 0
Si N = 0 ; ess
1
1 Kp
ess
1
Kv
Donde:
Kv constante de error de velocidad
De donde:
Si N 2 ;
Kv ; ess = 0
Si N = 1 ; ess
Si N = 0 ;
1
Kv
Kv 0
; ess =
K ( s ) Kc
s z0
s p0
Donde:
Kc ganancia del compensador en adelanto
z 0 cero
p 0 polo
que el polo.
z0
Kc .
p0
2.1.1.1
DISEO DE BODE
K1 ( s)
Ts 1
Ts 1
K ( s ) KcK1 ( s )
Donde:
Kc ganancia del compensador en adelanto
max
*T
1
1
1 sen
1 sen
dB
10 log
1 sen( )
1 sen( )
* gc
La razn por la que se aade unos pocos grados (5) al ngulo de adelanto de fase es para
obtener el margen de fase deseado, esto aade un cero en el compensador lo que causa que
la frecuencia de cruce de ganancia compensada se incremente.
Es una reforma del lugar de las races del sistema mediante la adicin de polos y ceros para
forzar que el lugar de las races pase a travs de puntos deseados.
Los siguientes son los pasos generales a seguir para este tipo de diseo:
GH GH 1180
Figura. 2.2. Criterio del ngulo en el diseo mediante lugar de las races
2.1.1.3
MTODO GEOMTRICO
Dibujar una lnea desde el origen al punto s_1 y una horizontal desde s_1. Encontrar el
ngulo c formado por estas dos lneas y dividirlo en 2 partes iguales. Las lneas desde el
cero deseado y el polo forman un ngulo c / 2 con la bisectriz.
Este procedimiento reduce la distancia entre la ubicacin del cero y el polo, lo cual
minimiza la ganancia Kc del compensador.
c 180 GH ( s _ 1)
c ngulo de compensacin
c 0
Figura. 2.3. Mtodo Geomtrico para el diseo mediante lugar de las races
Una tcnica puramente analtica se puede derivar del mtodo geomtrico la cual se muestra
a continuacin:
c
2
y z
c
2
Im(s _ 1)
tan p
Im(s _ 1)
tan z
6. Encuentre Kc
1
.
G ( s _ 1) K ( s _ 1)
s z0
s p0
Donde:
Kc ganancia del compensador en atraso
z 0 cero
p 0 polo
z0
Kc .
p0
2.1.2.1
DISEO DE BODE
K1 (s)
1 Ts
; 1
1 Ts
K ( s ) KcK1 ( s )
Donde:
Kc ganancia del compensador en adelanto
5.
dB
10 GR / 20
10
gc
2.1.2.2
Los siguientes son los pasos a seguir para proceder con este diseo:
2.1.3.1
MTODO ZIEGLER-NICHOLS
Este mtodo est desarrollado para sintonizar un controlador PID basado en un simple
anlisis de estabilidad.
La ganancia proporcional se la multiplica por un factor constante de 0.6, y las otras dos
ganancias se las calcula mediante las siguientes ecuaciones:
Kp 0.6 Km
Kp *
Kd
4 * m
Ki
Kp * m
Donde:
K m ganancia a la cual el sistema empieza a oscilar
m frecuencia de oscilacin.
Con este mtodo no se puede cumplir con especificaciones de la planta, ya que este mtodo
es slo una aproximacin de los resultados.
2.1.3.2
K p K d s i G (s )
s
K n 1 s n K i G ( s ) | s 0
1
ess
Tiempo de estabilizacin
Tss
Sobrepico
POS = e
Margen de fase
MF
Tiempo de subida
Tr
Tiempo pico
Tp
1 2
*100%
0.01
1 2
n 1 2
n 1 2
Esta representacin relaciona la primera derivada de cada estado con los estados y las
entradas del sistema.
x Ax B
y Cx D
Donde:
x1
x1
x
x
2
2 A* B
xn
x
n
x1
x
y C * 2 D
xn
x estados
y salida
entrada
Cannica Controlador
Cannica Observador
Cannica de Controlabilidad
Cannica de Observabilidad
Cannica Modal
x c1 (t ) a1
x c 2 (t ) 1
x c 3 (t ) 0
y (t ) b1 b2
a2
0
1
a3 xc1 (t ) 1
0 xc 2 (t ) 0 (t )
0 xc 3 (t ) 0
xc1 (t )
b3 xc 2 (t )
xc 3 (t )
x o1 (t ) a1
x o 2 (t ) a
2
x o 3 (t ) a3
1 0 xo1 (t ) b1
0 1 xo 2 (t ) b2 (t )
0 0 xo 3 (t ) b3
xo1 (t )
y (t ) 1 0 0 xo 2 (t )
xo 3 (t )
x co1 (t ) 0 0 a3 xco1 (t ) 1
x co 2 (t ) 1 0 a x (t ) 0 (t )
2 co 2
0
0
1
a
x
(
t
)
x co3 (t )
1 co 3
xco1 (t )
y (t ) 1 2 3 xco 2 (t )
xco3 (t )
Donde:
1 b1
2 b2 b1 a1
3 b3 b2 a1 b1 (a1 2 a 2 )
x ob1 (t ) 0
x ob 2 (t ) 0
x ob 3 (t ) a3
1
0
a2
0 xob1 (t ) 1
1 xob 2 (t ) 2 (t )
a1 xob 3 (t ) 3
xob1 (t )
y (t ) 1 0 0 xob 2 (t )
xob 3 (t )
Donde:
1 b1
2 b2 b1 a1
3 b3 b2 a1 b1(a1 2 a 2 )
x d 1 (t ) 1
x d 2 (t ) 0
x dn (t ) 0
y (t ) c1
x d 1 (t )
c3 x d 2 (t )
x dn (t )
c2
0
0
0 x d 1 (t ) b1
0 x d 2 (t ) b2 (t )
3 x dn (t ) b3
Estimadores de estado.
La ley de control involucra n ganancias con suficientes grados de libertad para colocar n
polos de lazo cerrado en cualquier lugar deseado en el plano s.
Ley de Control
Kx K 1 K 2 .....K n x
c ( s ) ( s s1 )( s s 2 )......( s s n )
c ( s ) s n 1 s n 1 ...... n
Donde:
s1 , s 2 ,......s n polos deseados para trabajar en el sistema
K ac ker( A, B, [ p1 p 2 pn])
Donde:
A, B matrices del sistema.
p1, p 2,... pn polos deseados para trabajar en el sistema.
x ( A BK ) x B
y Cx
2.2.3.
Cuando los estados del sistema no pueden medirse, se recurre a estimarlos mediante un
estimador de estados, que reconstruye x(estados) a partir de mediciones de y(salida) y
(entrada).
Ley de Control
Kx K 1 K 2 .....K n x
Donde:
x estado estimado
x Ax B L( y Cx )
x ( A LC ) ~
x.
La dinmica del error del sistema est dada por: ~
Donde:
A, C matrices del sistema.
dep
A BK
x
~
x 0
BK x
A LC ~
x
Esto significa que el diseo de la ley de control y del estimador pueden hacerse
independientemente.
El conjunto de polos del sistema combinado consiste de la unin de los polos de control y
los polos de estimacin.
2.2.4.
Si la salida del sistema es ya una de las variables de estado, y adems esta medicin no es
ruidosa, es completamente innecesario realizar una estimacin de dicha variable.
Donde:
x a estados medidos
xb estados a estimarse
Por lo tanto la representacin por variables de estado podr ser escrita como:
Aaa Aab x Ba
a
x a
x b Aba Abb xb Bb
x
y 1 0 a
xb
x b Abbxb Abax a Bb
entrada.conocida
x a y Aaay Aabxb Ba
y Aaay Ba Aabxb
medidas .conocidas
Con esto se pueden establecer las siguientes sustituciones en las ecuaciones originales del
estimador para obtener un estimador de xb .
x xb
A Abb
B Abay Bb
y y Aay Ba
C Aab
x Ax B
y Cx
entrada
medida
~
x b ( Abb LAab) ~
xb
Las ecuaciones del estimador reducido pueden ser rescritas de la siguiente forma:
de y es inaceptable. Para evitar esta dificultad se define el estado del nuevo controlador:
xc x b Ly
Donde:
pe polos del estimador
CAPTULO 3
186
s (1.04 s 1)
ess_/ 3% ,
MF = 55
Ts 2.5s
186
1.04s s 186
2
Respuestas del sistema sin compensar para una seal rampa y una seal paso
Determinacin de Kc
Kv l im sG ( s ) Kc
s 0
186
Kv l im s
Kc
s 0
s (1.04 s 1)
Kv 186 Kc
1
1
ess
Kv 186 Kc
1
0.03
Kc 0.179
186 Kc
MF
0.01
0.55
POS e
1 2
*100%
POS 12.63%
Ts
n 2.9rad / s
Clculo del tiempo de subida (Tr)
Tr
1 2
n 1 2
Tr 0.95s
Tp
n 1 2
Tp 1.29 s
KcG ( s ) 0.179 *
186
s (1.04 s 1)
Figura. 3.3. Diagrama de Bode del sistema en lazo abierto (sistema sin compensar)
Clculo de
1 sen( )
1 sen( )
1 sen(50 )
1 sen(50 )
7.548
Clculo de T
T
T
* gc
1
7.548 * 9.35
T 0.038
Ts 1
Ts 1
0.286 s 1
K1
0.038s 1
0.286 s 1
K ( s ) 0.179 *
0.038s 1
2
1.04 s s 0.038s 1
9.486 s 33.294
K ( s )G ( s )
3
2
0.039 s 1.078s s
gc(rad/s)
Fase()
Sin compensar
5.6
-170
Compensado
9.35
-124
Cdigo en Matlab
num=[9.486 33.294]
den=[0.039 1.078 1 0]
gp=tf(num,den)
gt=feedback(gp,1)
u=0:0.01:10;
t=u;
figure (1)
lsim(gt,u,t)
figure (2)
step(gt)
La siguiente figura muestra la respuesta del sistema con el compensador en lazo cerrado
para una seal tipo rampa.
La siguiente figura muestra la respuesta del sistema con el compensador en lazo cerrado
para una seal tipo paso.
Figura. 3.9. Diagrama de Simulacin del sistema sin compensar (Modelo Lineal)
Respuesta del sistema sin compensar a una seal rampa y a una seal paso
Se observa en las grficas de las simulaciones del sistema servomotor sin compensar que
los tiempos de estabilizacin son demasiado altos aproximadamente de 10s y con
sobrepicos alrededor del 89% por lo que se procedi a acoplar un compensador en adelanto
para mejorar dichas caractersticas.
186
s (1.04 s 1)
Especificaciones:
ess_/ 1% ,
POS e
1 2
*100%
0.45
4
n *
Ts 2.22 s
1 2
n 1 2
Tr 0.63s
Tp
n 1 2
Tp 0.88s
0.01
MF 45
n 4rad / s
n (0.45)(4) 1.8
d n 2 ( n ) 2 3.57i
s _ 1 1.8 3.57i
3.57
1.8
1 63.24
1 tg 1
1 63.24 180
1 116.75
2 180 2
2 180 76.79 103.21
3.57
1.8 0.9615
3.57
2 tg 1
0.838
2 76.79
2 tg 1
1 / 2 58.37
1 2 116.75 103.21 219.96
c 219.96 180 39.96
c / 2 20
90 58.37 31.63
31.63 20 11.63
x
tg 11.63
3.57
x 0.734
cero (0.734 1.8)
cero 2.534
tg 51.63
y
3.57
y 4.5
polo (4.5 1.8)
polo 6.3
Determinacin de Kc
Kc
Kc
1
G ( s _ 1) * K ( s _ 1)
1
186
0.73 3.57i
11.68 9.79i 4.5 3.57i
0.129
Para que el punto de trabajo s_1 se logre, se requiere que Kc sea 0.129 por lo que el
compensador de adelanto queda de la forma:
s 2.53
K 1 ( s ) 0.129
s 6.3
Gp1 ( s ) K 1 ( s ) * G ( s )
186
s 2.53
Gp1 ( s ) 0.129
s 6.3 s (1.04s 1)
Kv lim sG ( s ) K 1 ( s )
s 0
s 2.53
186
s
0.129 K at
s (1.04s 1) s 6.3
9.63K 2
1
ess
Kv
1
0.01
K at 10.38
9.63K at
z
10.38
p
1.8
z
0.36
5
0.36
p
0.034
10.38
s 0.034
0.129
s 6.3 s 0.034
s 2.53 s 0.36
186
Gp( s )
0.129
s (1.04 s 1) s 6.3 s 0.034
Cdigo en Matlab
numc=conv([1 2.53],[1 0.36]);
denc=conv([1 6.3],[1 0.034]);
numc1=0.129*numc;
gc=tf(numc1,denc)
g=tf([186],[1.04 1 0])
gt=series(gc,g)
gp=feedback(gt,1)
La siguiente figura muestra la respuesta del sistema con el compensador en lazo cerrado
para una seal tipo rampa.
La siguiente figura muestra la respuesta del sistema con el compensador en lazo cerrado
para una seal tipo paso.
Diagrama de Nyquist
Cdigo en Matlab
angle=0:0.01*pi:2*pi;
x=cos(angle);
y=sin(angle);
plot(x,y)
hold on
gp=tf([186],[1.04 1 0])
gc=tf([0.129 0.3728 0.1175],[1 6.334 0.2142])
gf=series(gp,gc)
nyquist(gf)
axis equal
estabilidad
El sistema es estable
El margen de fase es de 34.7
G(s)
186
1.04s 1
El sistema nunca se vuelve inestable por lo que no se puede aplicar el mtodo ZieglerNichols para encontrar las constantes del controlador PID.
Para la funcin de transferencia de la posicin angular del servomotor
G (s)
186
s (1.04 s 1)
Figura. 3.32. Lugar de las races para la posicin angular del servomotor
El sistema nunca se vuelve inestable por lo que no se puede aplicar el mtodo ZieglerNichols para encontrar las constantes del controlador PID.
3.3.2
Mtodo Analtico
G ( s)
186
1.04 s 1
ess_ / 3% ,
POS 10% Ts 2s
POS e
1 2
*100%
0.59
0.01
MF 59
0.59
0.01
Ts * 2 * 0.59
n 3.39rad / s
1 2
n 1 2
Tr 0.85s
Tp
n 1 2
Tp 1.147 s
1
ess
186
lim K i
s 0
1.04 s 1
1
1
186 K i
186 K i
K i 0.179
ess
0.03
Cdigo en Matlab
%analitico pid
function[kp,kd]=pid(ng,dg,ki,dpm,wgc)
ngv=polyval(ng,j*wgc)
dgv=polyval(dg,j*wgc)
g=ngv/dgv
thetar=(dpm-180)*pi/180
ejtheta=cos(thetar)+j*sin(thetar)
Kp = 0.0135
Kd = 0.0113
Ki = 0.179
0.179
s
3.3.3
SIMULACIN
EN
SIMULINK
DEL
SISTEMA
SERVOMOTOR
0 0.961
0
B
178.8
1 0
C
0 1
D0
MF = 40
Ts 2s
0.01
0.4
POS e
1 2
*100%
POS 25.38%
1 2
n 1 2
Tr 0.48s
Tp
n 1 2
Tp 0.68s
n (0.4)(5) 2
d n 2 ( n ) 2 4.58i
s _ 1 2 4.58i
c ( s ) ( s p1)( s p 2)
s 2 ( p1 p 2) s p1 p 2
s 2 (2 4.58i 2 4.58i ) s (2 4.58i )(2 4.58i )
s 2 4 s 25
1 0
s 0 0
SI A BK
K 1 K 2
0 s 0 0.961 178.8
0
1 0
s
a k (s)
s
178.8 K 1
1
s 0.961 178.8 K 2
K 1 0.139
K 0.139 0.0169
x ( A BK ) x B
y Cx
0
1 x1 0
x1
x 24.85 3.982 x 2 178.8
2
1 0 x1
y
0 1 x 2
Cdigo en MATLAB
A=[0 1;0 -0.961];
B=[0;178.8];
C=[1 0];
D=[0];
p1=-2+4.58i;
p2=-2-4.58i;
K=acker(A,B,[p1 p2])
K = [0.139
0.0169]
Respuesta del sistema a una seal paso (para posicin angular y velocidad angular)
Figura. 3.41. Grfica del sistema compensado para posicin angular y velocidad angular (seal paso)
Para resolver este problema se completa el sistema con un precompensador que se calcula
en la siguiente seccin.
Nx A B 0
Nu C D 1
Nu 0
1
Nx
0
N Nu KNx
N 0.139
Cdigo en Matlab
3.4.2
SIMULACIN
EN
SIMULINK
DEL
SISTEMA
SERVOMOTOR
UTILIZANDO UN CONTROLADOR LQ
Sistema Servomotor con controlador LQ
Para el diseo del estimador completo de estados se utiliz el siguiente cdigo en Matlab.
Cdigo en Matlab
%ubicacin de polos mediante SRL
%servomotor
disp('srl_servo')
pause
clear all
%modelo lineal
close all
Ks=186;
Ts=1.04;
x=-1/Ts;
y=Ks/Ts;
a=[0 1;0 x]
b=[0;y]
c=[1 0]
d=0
%fin modelo lineal
numGG=[186]
denGG=conv([1.04 1 0],[1.04 -1 0])
sysGG=tf(numGG,denGG)
rlocus(sysGG)
[k,poles]=rlocfind(sysGG)
pause
pc=poles(3:4)
pc=pc
pe=4*pc
Lt=acker(A',C',pe)
L=Lt'
b=[b L]
c=[1 0 ;0 1]
d=zeros(2,2)
acl=A-B*K
Nt=inv([A B;C 0])*[0;0;1]
Nx=Nt(1:2,1)
Nu=0
Nf=K*Nx+Nu
bcl=B*Nf
syscl=ss(acl,bcl,ccl,0)
step(syscl)
3.5.2
SIMULACIN
EN
SIMULINK
DEL
SISTEMA
SERVOMOTOR
Figura. 3.49. Diagrama de Simulacin del estimador completo de estados (Modelo Lineal)
Para el diseo del estimador reducido de estados se utiliz el siguiente cdigo en Matlab
Cdigo en Matlab
%ubicacin de polos mediante SRL
%servomotor
disp('srl_servo_red')
pause
clear all
%modelo lineal
close all
Ks=186;
Ts=1.04;
x=-1/Ts;
y=Ks/Ts;
a=[0 1;0 x]
b=[0;y]
c=[1 0]
d=0
%fin modelo lineal
numGG=[186]
denGG=conv([1.04 1 0],[1.04 -1 0])
sysGG=tf(numGG,denGG)
rlocus(sysGG)
[k,poles]=rlocfind(sysGG)
pause
pc=poles(3:4)
pc=pc
A=a
B=b
C=c
ccl=C
Aaa=A(1,1)
Aab =A(1,2)
Aba=A(2,1)
Abb=A(2,2)
Ba=B(1,1)
Bb=B(2,1)
pe=[4*pc(1,1)]
Lt=acker(Abb',Aab',pe)
L=Lt'
aer=Abb-L*Aab
ber1=(Abb-L*Aab)*L+Aba-L*Aaa
ber2=Bb-L*Ba
ber=[ber1 ber2]
cer=[1]
der=[L zeros(1,1)]
acl=A-B*K
Nt=inv([A B;C 0])*[0;0;1]
Nx=Nt(1:2,1)
Nu=0
Nf=K*Nx+Nu
bcl=B*Nf
syscl=ss(acl,bcl,ccl,0)
step(syscl)
3.6.1
SIMULACIN
EN
SIMULINK
DEL
SISTEMA
SERVOMOTOR
Figura. 3.56. Diagrama de Simulacin del estimador reducido de estados (Modelo Lineal)
CAPTULO 4
IMPLEMENTACIN Y RESULTADOS
4.1.1
4.2.1
4.3.1
4.4.1
El Tr en la
4.5.1
4.6.1
El Tr en la
CAPTULO 5
CONCLUSIONES Y RECOMENDACIONES
5.1. CONCLUSIONES
compar con la ecuacin caracterstica de lazo cerrado del sistema para poder
encontrar las ganancias K del controlador.
5.2. RECOMENDACIONES
Los diagramas de Bode deben ser utilizados para sistemas estables ya que
predice el comportamiento del lazo cerrado del sistema, as como su error de
estado estable, ancho de banda y mrgenes de estabilidad.
Como regla, los polos del estimador deben escogerse de 2 a 6 veces ms rpidos
que los polos del controlador para que la velocidad de respuesta del sistema est
definida por el controlador.
REFERENCIAS BIBLIOGRFICAS
Phillips, Charles & Harbor Royce, Feedback Control Systems third edn
Prentice Hall 1996
Shahian, Bahram & Hassul Michael, Control System Desing Using MATLAB
Prentice-Hall 1993
INDICE DE FIGURAS
Figura. 1.1. Componentes del Sistema Servomotor
Figura. 1.2. Diagrama para el modelamiento matemtico de la planta
Figura. 1.3. Grfica de las caractersticas inversas de estado estacionario del sistema
Figura. 1.4. Modelo de Simulacin Lineal
Figura. 1.5. Modelo de Simulacin no Lineal
Figura. 2.1. Sistema de control en lazo cerrado
Figura. 2.2. Criterio del ngulo en el diseo mediante lugar de las races
Figura. 2.3. Mtodo Geomtrico para el diseo mediante lugar de las races
Figura. 2.4. Representacin general de un sistema en el espacio de estados
Figura. 2.5. Forma Cannica Controlador
Figura. 2.6. Forma Cannica Observador
Figura. 2.7. Forma Cannica de Controlabilidad
Figura. 2.8. Forma Cannica de Observabilidad
Figura. 2.9. Forma Cannica Modal
Figura. 2.10. Esquema de un sistema de control con realimentacin completa de estados
Figura. 2.11. Esquema del estimador completo de estados
Figura. 2.12. Esquema alternativo del estimador completo de estados
Figura. 2.13. Esquema de la combinacin entre la ley de control y el estimador de estados
Figura. 2.14. Esquema del estimador reducido de estados
Figura. 3.1. Grfica del sistema sin compensar (seal rampa)
Figura. 3.2. Grfica del sistema sin compensar (seal paso)
Figura. 3.3. Diagrama de Bode del sistema en lazo abierto (sistema sin compensar)
Figura. 3.4. Diagrama de Bode del compensador en adelanto
Figura. 3.5. Diagrama de Bode del sistema compensado
Figura. 3.6. Diagrama de Bode del sistema sin compensar y compensado
Figura. 3.7. Grfica del sistema compensado (seal rampa)
Figura. 3.8. Grfica del sistema compensado (seal paso)
Figura. 3.9. Diagrama de Simulacin del sistema sin compensar (Modelo Lineal)
Figura. 3.10. Grfica del sistema sin compensar para una seal paso - Simulacin (Modelo
Lineal)
Figura. 3.11. Grfica del sistema sin compensar para una seal rampa - Simulacin
(Modelo Lineal)
Figura. 3.12. Diagrama de Simulacin del compensador en adelanto (Modelo Lineal)
Figura. 3.13. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo Lineal)
Figura. 3.14. Grfica del sistema compensado (seal paso) - Simulacin (Modelo Lineal)
Figura. 3.15. Diagrama de Simulacin del compensador en adelanto (Modelo no Lineal)
Figura. 3.16. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo no
Lineal)
Figura. 3.17. Grfica del sistema compensado (seal paso) - Simulacin (Modelo no
Lineal)
Figura. 3.18. Grfica de la obtencin de los ngulos de cada polo
Figura. 3.19. Grfica de ubicacin del polo y cero del controlador
Figura. 3.20. Obtencin del cero del controlador
Figura. 3.21. Obtencin del polo del controlador
Figura. 3.22. Grfica del sistema compensado (seal rampa)
Figura. 3.23. Grfica del sistema compensado (seal paso)
Figura. 3.24. Diagrama de Nyquist del sistema compensado
Figura. 3.25. Diagrama de Simulacin del compensador en adelanto-atraso (Modelo
Lineal)
Figura. 3.26. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo Lineal)
Figura. 3.27. Grfica del sistema compensado (seal paso) - Simulacin (Modelo Lineal)
Figura. 3.28. Diagrama de Simulacin del compensador en adelanto-atraso (Modelo no
Lineal)
Figura. 3.29. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo no
Lineal)
Figura. 3.30. Grfica del sistema compensado (seal paso) - Simulacin (Modelo no
Lineal)
Figura. 3.31. Lugar de las races para la velocidad del servomotor
Figura. 3.32. Lugar de las races para la posicin angular del servomotor
Figura. 3.33 Grfica del sistema compensado (seal rampa)
Figura. 3.34. Grfica del sistema compensado (seal paso)
Figura. 3.35. Diagrama de Simulacin del controlador PID (Modelo Lineal)
Figura. 3.36. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo Lineal)
Figura. 3.37. Grfica del sistema compensado (seal paso) - Simulacin (Modelo Lineal)
Figura. 3.38. Diagrama de Simulacin del controlador PID (Modelo no Lineal)
Figura. 3.39. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo no
Lineal)
Figura. 3.40. Grfica del sistema compensado (seal paso) - Simulacin (Modelo no
Lineal)
Figura. 3.41. Grfica del sistema compensado para posicin angular y velocidad angular
(seal paso)
Figura. 3.42. Grfica del sistema con tracking (seal paso)
Figura. 3.43. Diagrama de Simulacin del controlador LQ (Modelo Lineal)
Figura. 3.44. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo Lineal)
Figura. 3.45. Grfica del sistema compensado (seal paso) - Simulacin (Modelo Lineal)
Figura. 3.46. Grfica de la velocidad del servomotor (seal rampa) - Simulacin (Modelo
Lineal)
Figura. 3.47. Grfica de la velocidad del servomotor (seal paso) - Simulacin (Modelo
Lineal)
Figura. 3.48. Grfica del sistema compensado (seal paso)
Figura. 3.49. Diagrama de Simulacin del estimador completo de estados (Modelo Lineal)
Figura. 3.50. Condiciones iniciales de ngulo y velocidad
Figura. 3.51. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo Lineal)
Figura. 3.52. Grfica del sistema compensado (seal paso) - Simulacin (Modelo Lineal)
Figura. 3.53. Grfica de la velocidad del servomotor (seal rampa) - Simulacin (Modelo
Lineal)
Figura. 3.54. Grfica de la velocidad del servomotor (seal paso) - Simulacin (Modelo
Lineal)
Figura. 3.55. Grfica del sistema compensado (seal paso)
Figura. 3.56. Diagrama de Simulacin del estimador reducido de estados (Modelo Lineal)
Figura. 3.57. Condiciones iniciales de ngulo y velocidad
Figura. 3.58. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo Lineal)
Figura. 3.59. Grfica del sistema compensado (seal paso) - Simulacin (Modelo Lineal)
Figura. 3.60. Grfica de la velocidad del servomotor (seal rampa) - Simulacin (Modelo
Lineal)
Figura. 3.61. Grfica de la velocidad del servomotor (seal paso) - Simulacin (Modelo
Lineal)
Figura. 4.1. Implementacin del controlador en adelanto
Figura. 4.2. Bloque de la funcin de transferencia del controlador
Figura. 4.3. Grfica del sistema compensado (seal rampa) - Implementacin (Tiempo
Real)
Figura. 4.4. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo no
Lineal)
Figura. 4.5. Grfica del sistema compensado (seal paso) - Implementacin (Tiempo Real)
Figura. 4.6. Grfica del sistema compensado (seal paso) - Simulacin (Modelo no Lineal)
Figura. 4.7. Implementacin del controlador en adelanto-atraso
Figura. 4.8. Bloque de la funcin de transferencia del controlador
Figura. 4.9. Grfica del sistema compensado (seal rampa) - Implementacin (Tiempo
Real)
Figura. 4.10. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo no
Lineal)
Figura. 4.11. Grfica del sistema compensado (seal paso) - Implementacin (Tiempo
Real)
Figura. 4.12. Grfica del sistema compensado (seal paso) - Simulacin (Modelo no
Lineal)
Figura. 4.13. Implementacin del controlador PID
Figura. 4.14. Bloques de la funcin de transferencia del controlador
Figura. 4.15. Grfica del sistema compensado (seal rampa) - Implementacin (Tiempo
Real)
Figura. 4.16. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo no
Lineal)
Figura. 4.17. Grfica del sistema compensado (seal paso) - Implementacin (Tiempo
Real)
Figura. 4.18. Grfica del sistema compensado (seal paso) - Simulacin (Modelo no
Lineal)
Figura. 4.19. Implementacin del controlador LQ
Figura. 4.20. Bloques de la ganancia K del controlador
Figura. 4.21. Grfica del sistema compensado (seal rampa) - Implementacin (Tiempo
Real) posicin angular
Figura. 4.22. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo Lineal)
- posicin angular
Figura. 4.23. Grfica del sistema compensado (seal paso) - Implementacin (Tiempo
Real) - posicin angular
Figura. 4.24. Grfica del sistema compensado (seal paso) - Simulacin (Modelo Lineal) posicin angular
Figura. 4.25. Grfica del sistema compensado (seal rampa) - Implementacin (Tiempo
Real) velocidad angular
Figura. 4.26. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo Lineal)
- velocidad angular
Figura. 4.27. Grfica del sistema compensado (seal paso) - Implementacin (Tiempo
Real) - velocidad angular
Figura. 4.28. Grfica del sistema compensado (seal paso) - Simulacin (Modelo Lineal) velocidad angular
Figura. 4.29. Implementacin del estimador completo de estados
Figura. 4.30. Grfica del sistema compensado (seal rampa) - Implementacin (Tiempo
Real) posicin angular
Figura. 4.31. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo Lineal)
- posicin angular
Figura. 4.32. Grfica del sistema compensado (seal paso) - Implementacin (Tiempo
Real) - posicin angular
Figura. 4.33. Grfica del sistema compensado (seal paso) - Simulacin (Modelo Lineal) posicin angular
Figura. 4.34. Grfica del sistema compensado (seal rampa) - Implementacin (Tiempo
Real) velocidad angular
Figura. 4.35. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo Lineal)
- velocidad angular
Figura. 4.36. Grfica del sistema compensado (seal paso) - Implementacin (Tiempo
Real) - velocidad angular
Figura. 4.37. Grfica del sistema compensado (seal paso) - Simulacin (Modelo Lineal) velocidad angular
Figura. 4.38. Implementacin del estimador reducido de estados
Figura. 4.39. Grfica del sistema compensado (seal rampa) - Implementacin (Tiempo
Real) posicin angular
Figura. 4.40. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo Lineal)
- posicin angular
Figura. 4.41. Grfica del sistema compensado (seal paso) - Implementacin (Tiempo
Real) - posicin angular
Figura. 4.42. Grfica del sistema compensado (seal paso) - Simulacin (Modelo Lineal) posicin angular
Figura. 4.43. Grfica del sistema compensado (seal rampa) - Implementacin (Tiempo
Real) velocidad angular
Figura. 4.44. Grfica del sistema compensado (seal rampa) - Simulacin (Modelo Lineal)
- velocidad angular
Figura. 4.45. Grfica del sistema compensado (seal paso) - Implementacin (Tiempo
Real) - velocidad angular
Figura. 4.46. Grfica del sistema compensado (seal paso) - Simulacin (Modelo Lineal) velocidad angular
INDICE DE TABLAS
Tabla. 3.1. Comparacin entre el sistema sin compensar y compensado
GLOSARIO
MSS
RTWT
Siglas en ingles de Real Time Windows Target es una herramienta de Matlab que permite
trabajar en tiempo real.
CONTROLADOR PID
PWM
Fecha de entrega:
________________________________
Autor
_____________________________
Coordinador de Carrera