EN

INV
IE
2005
Encuentro de Investigacion en Ingeniera Electrica
Zacatecas, Zac, Marzo 1718, 2005
Control de Velocidad de un Servomotor con
el Procesador Digital de Se nales
TMS320LF2407 y VisSim
Aurelio Beltran Telles, Miguel Eduardo Gonzalez Elas,
y
Claudia Reyes Rivas
Centro de estudios,
Unidad Ingeniera Electrica, Universidad Autonoma de Zacatecas, Estado Zacatecas
-CP98000.
Tel: +(492)9239407, ext 169,
correo-e:atellesz@yahoo.com.mx, migonzal@yahoo.com.mx, clausy 17@yahoo.com
Resumen En el presente artculo se describe el modelado del servomotor DMES8G y el
dise no e implementacion de los controladores Proporcional Integral (PI) e Integral mas
red de compensacion de adelanto de fase, para control del servomotor. En la implemen-
tacion del control se utilizo el procesador digital de se nales TMS320LF2407 de Texas
Instruments.
Los resultados obtenidos de la simulacion e implementacion indican que el servomotor
responde de manera adecuada a las especicaciones de dise no.
Abstract In this article is described the modeling of the DMES8G servo-motor and
the design and implementation of Integral Proportional (PI) and Integral plus shifted
phase network Compensation controllers to control the servo-motor. It was used the
Texas Instruments TMS320LF2407 digital signal processor for control implementation.
The results obtained in the simulation and control indicate acceptable response of the
servomotor according to the design specications.
Palabras clave Control integral compensado, control proporcional e integral, Modelado,
simulacion, VisSim.
Aurelio Beltran, Miguel E. Gonzalez, y Claudia Reyes : Control de velocidad de servomotor DMES8G 175
Figura 1. Esquema del sistema de control
I. INTRODUCCI

ON
E
L primer paso para el dise no y aplicacion de algoritmos de control, es el tener un buen
modelo de la planta (servomotor). Por lo que para acondicionar los circuitos para obte-
nerlo, se le hicieron pruebas de campo que consistieron en aplicarle valores de voltaje desde
1 hasta 24 volts. Midiendo con el osciloscopio la frecuencia de la se nal suministrada por el
tacogenerador y las revoluciones por segundo que proporciona un sensor optico.
Con estos valores obtenidos, se utilizo el circuito integrado LM2907 (convertidor de frecuencia
a voltaje), para adecuar la se nal para la tarjeta de adquisicion de datos. Para esto se le hicieron
los calculos de sus componentes para que suministrara un voltaje de salida de 3.3 [V] a la
maxima frecuencia obtenida, que corresponde a la maxima velocidad del motor y voltaje
maximo permitido a la entrada analogica de la tarjeta.
El siguiente paso para obtener el modelo y ademas para implementar el sistema de control,
se utilizo la tarjeta TMS320LF2407, utilizando de esta una entrada analogica y una salida
digital.
Los datos capturados por la tarjeta se procesan utilizando el programa VisSim que nos permite
verlos en forma graca o en un archivo tipo texto, ademas de poder programar los algoritmos
de control.
La salida digital de 8 bits se aplico en un convertidor digital analogico cuya salida con todas
las entradas en alto entrega un voltaje de 5 [V]. Voltaje que se utiliza como entrada de la etapa
de potencia. Esta etapa debe entregar un voltaje maximo de salida de 24 [V] al servomotor,
por lo que la ganancia debe de ser
24 [V ]
5 [V ]
= 4.8.
Por ultimo se dise naron los controladores y se realizaron las pruebas para ver su funciona-
miento.
Un esquema del sistema completo se muestra en la Figura 1.
176
EN
INV
IE
2005
Encuentro de Investigacion en IE, 1718 Marzo, 2005
Figura 2. Respuesta del motor a una entrada de 15 V obtenida con la tarjeta.
Figura 3. Respuesta del modelo matematico del motor a una entrada de 15 V .
II. ANTECEDENTES Y JUSTIFICACI

ON
El control de velocidad de motores se ha trabajado extensamente y con buenos resultados [1]
[3]. Sin embargo el utilizar el programa de VisSim y la tarjeta TMS320LF2407 nos permite
explorar y analizar el comportamiento del servomotor con las nuevas tecnologas.
III. OBJETIVOS
Modelado de motor.
Acondicionamiento de se nal y etapa de potencia.
Calculo de controladores PID e integral con compensador de adelanto de fase.
Probar los controladores.
IV. DESCRIPCI

ON DEL TRABAJO
El trabajo se realizo de la siguiente manera:
Aurelio Beltran, Miguel E. Gonzalez, y Claudia Reyes : Control de velocidad de servomotor DMES8G 177
A. Modelado
Como no se cuenta con los datos tecnicos del servomotor DMES8G, fue necesario obtenerlos
utilizando un metodo experimental. Para ello se le aplico un voltaje de 15 V, y se capturaron
los datos de la velocidad utilizando la tarjeta de TI y los circuitos de acondicionamiento, el
resultado se muestra en la Figura 2.
A partir de la Figura 2, se hace la identicacion del sistema. Como se puede observar esta res-
puesta corresponde a un sistema de primer orden [2]. Por lo que se procede a su identicacion
de acuerdo con la ecuacion correspondiente.
W
(s)
V
(s)
=
d
s + b
(1)
Donde:
W
(s)
es la velocidad en [rpm].
V
(s)
es el voltaje aplicado [Volts]
Los parametros de la ecuacion los encontramos a partir de la graca del modelo, para esto
obtenemos el valor del tiempo t
b
que es aquel en el cual el servomotor alcanza el 63.2 % de
su velocidad nal estable ( q
final
) [1].
q(t
b
) = 0.632 q
final
= (0.632)(1511) = 955 [rpm] (2)
Y corresponde a t
b
= 0.078 [segundos]
Con estos datos obtenemos el valor de b y d de la siguiente manera:
b =
1
t
b
=
1
0.078
= 12.82 (3)
y
d =
q
final
b
V
cte
=
1511.7(12.82)
15
= 1292 (4)
La funcion de transferencia de la planta con el sensor integrado es:
W
(s)
V
(s)
=
1292
s + 12.82
(5)
Se simulo el modelo obtenido aplicandole una entrada escalon de 15 [V] y se obtuvo la respues-
ta mostrada en la Figura 3, que corresponde a la respuesta de velocidad real del servomotor
178
EN
INV
IE
2005
Encuentro de Investigacion en IE, 1718 Marzo, 2005
Figura 4. Sistema en lazo cerrado con Control PI
por lo que se considera que el modelo obtenido es el adecuado.
Por cuestiones operativas agregamos la etapa de potencia E
p
= 4.9. Y reducimos el sistema
quedando como se indica a continuacion.
W
(s)
V
(s)
=
6330.8
s + 12.82
(6)
B. Prueba de estabilidad
Despues de obtenido el modelo matematico del servomotor y considerando las etapas de
control y potencia, que se muestran en la Figura 4, es necesario vericar la estabilidad del
sistema. Esto se hace utilizando el Criterio de Estabilidad de Routh para ello se obtiene la
funcion de transferencia en lazo cerrado del sistema reduciendo el diagrama de bloques, y al
polinomio caracterstico (denominador de la funcion de transferencia) se le aplica este.
La funcion de transferencia del sistema en lazo cerrado es:
W(s)
W
d
(s)
=
6330.8(K
p
s + K
i
)
s
2
+ (12.82 + 6330.8K
p
)s + 6330.8K
i
(7)
Los coecientes del polinomio caracterstico son:
a
0
= 1
a
1
= [12.82 + 6330.8K
p
]
a
2
= 6330.8K
i
La matriz resultante es:
_
_
s
2
s
1
s
0
_
_
_
_
1 6330.8K
i
12.82 + 6330.8K
p
b
1
0
0
_
_
El coeciente b1 es:
b
1
=
(12.82 + 6330.8K
p
)(6330.8K
i
) (1)(0)
(12.82 + 6330.8K
p
)
= 6330.8K
i
Aurelio Beltran, Miguel E. Gonzalez, y Claudia Reyes : Control de velocidad de servomotor DMES8G 179
Considerando que ninguno de los coecientes de la matriz sea negativo (si esto pasa el sistema
es inestable), por lo tanto para que el sistema sea estable las ganancias deben ser:
K
p
>
12.82
6330.8
= 0.00202
K
i
> 0
C. Dise no de los controladores
Despues de obtener el modelo matematico y vericar su estabilidad, se dise no un control PI
utilizando el metodo de cancelacion de polos, para que el servomotor tenga una respuesta en
velocidad sin sobrepaso con un tiempo de asentamiento de t
s
= 3 [seg]. Para ello se utilizo el
diagrama de bloques de la Figura 4.
C.1 Dise no del Control PI utilizando el Metodo de Cancelacion de Polos.
La siguiente ecuacion representa el modelo matematico o funcion de transferencia del contro-
lador PI:
V
c
(s)
E(s)
=
K
p
s
_
s +
1
T
i
_
(8)
donde:
Kp es la ganancia del control proporcional
Ti es la constante de integracion del control integral
V
c(s)
salida de la etapa del control
E
(s)
entrada a la etapa de control
Ganancias del Control PI.
El metodo de cancelacion de polos consiste en poner un cero en la funcion del control para
que cancele el polo de la planta (servomotor), en este caso (s +12.82). Por lo que se procede
con los calculos de la siguiente manera:
Ajuste de la ganancia K
p
:
K
p
=
4
d t
s
=
4
(6330.8) (3)
= 0.000211
Valor de la constante de tiempo del integrador T
i
:
T
i
=
1
b
= 0.0780
180
EN
INV
IE
2005
Encuentro de Investigacion en IE, 1718 Marzo, 2005
Figura 5. Diagrama de bloques del sistema controlado, con los valores del control PI
Figura 6. Diagrama de bloques del sistema controlado con los valores del control Integral mas red de
adelanto de fase.
Ajuste de la ganancia del control integral K
i
:
K
i
=
K
p
T
i
=
0.000221
0.0780
= 0.0027 (9)
Por lo tanto, la ecuacion del controlador con los parametros calculados es:
V
c
(s)
E(s)
=
0.000211
s
(s + 12.82) (10)
El diagrama de bloques del servomotor con el controlador y etapa de potencia se muestra en
la Figura 5:
C.2 Dise no del control Integral mas red de compensacion de adelanto de fase.
Ahora se dise na un control integral con una red de adelanto, para obtener una respuesta de
la velocidad del servomotor con sobrepaso M
p
= 30 % con un tiempo pico t
p
= 2 seg
Ecuacion de la red de compensacion de adelanto de fase
Modelo matematico de la red de adelanto.
G
c
(s) = K
c
s + z
s + p
(11)
donde:
K
c
es la ganancia de la red de compensacion
A partir de las especicaciones de desempe no deseadas se determino la ubicacion de los polos
dominantes deseados.

d
=

t
p
= 1.57 (12)
Aurelio Beltran, Miguel E. Gonzalez, y Claudia Reyes : Control de velocidad de servomotor DMES8G 181

d
es la parte imaginaria del polo deseado.
=
1
_
_

ln(0.30)
_
2
+ 1
= 0.3578 (13)
es el coeciente de amortiguamiento.

n
=
1.57
_
1 (0.357)
2
= 1.680 (14)

n
es la frecuencia natural del sistema.
=
n
= (0.3578) (1.680) = 0.6011 (15)
es la parte real del polo deseado.
Los polos deseados se ubican en:
0.601 j1.57
La ubicacion del cero del compensador se escoge para cancelar un polo del sistema.
z = 12.82
Y la ubicacion del polo del compensador para garantizar que el lugar geometrico de las races
pase por los polos deseados.
p = 1.2
Calculo de la ganancia Kc:
K
c
=

1
6330.8(s+12.82)
s(s+12.82)(s+1.2)

s=0.601+j1.57
= 0.000446
Ganancias del control integral mas la red de compensacion de adelanto de fase
G
c
(s) = 0.000446
(s + 12.82)
s (s + 1.2)
Los resultados obtenidos se muestran en el diagrama de bloques de la Figura 6.
182
EN
INV
IE
2005
Encuentro de Investigacion en IE, 1718 Marzo, 2005
Figura 7. Convertidor de frecuencia a voltaje.
D. Acondicionamiento de se nales
Adecuar la se nal para que la tarjeta TMS320LF2407 pueda leerla sin da narse se hizo de la
siguiente manera:
Se ajusto la salida maxima del convertidor a 3.3 [V olts], para esto se utilizaron las hojas de
datos que proporcionan los fabricantes y son:
V
rizo
=
V
CC
2
C
1
C
2
_
1
V
CC
f
in
C
1
I
2
_
(16)
donde:
V
CC
es el voltaje de polarizacion f
in
es la frecuencia de la se nal de entrada (maxima o mnima)
C
1
y C
2
son los condensadores de acondicionamiento de la se nal
I
2
la corriente que entregara el circuito.
f
in
=
I
2
C
1
V
CC
(17)
C
1
=
V
o
V
CC
f
in
R
1
(18)
C
2
=
V
CC
2
C
1
V
rizo
_
1
V
CC
f
in
C
1
I
2
_
(19)
C
1
=
3.3
12 1919 100K
= 1.433 [nF]
I
2
= 1919 1.4nF 12 = 33 [A]
C
2
=
12
2
1.4nF
0.05
_
1
12 40 1.4 nF
32 [A]
_
= 0.1684 [F]
Los resultados se muestran en la Figura 7.
Aurelio Beltran, Miguel E. Gonzalez, y Claudia Reyes : Control de velocidad de servomotor DMES8G 183
Figura 8. Convertidor de digital a analogico.
Figura 9. Etapa de potencia.
E. Etapa de potencia
La etapa de potencia se dise no en base a las siguientes consideraciones:
La salida de la tarjeta es un canal digital con 8 bits que se conectan a un convertidor digital
analogico que con todas las entradas en alto proporciona una salida de 5 Volts. Y se muestra
en la Figura 8, la cual se aplica a la entrada de la etapa de potencia.
La etapa de potencia se calculo tomando en cuenta que el voltaje maximo aplicado al motor
es 24 [V olts] y el convertidor A/D entrega 5 [V olts] entonces:
E
p
=
24 [V ]
5 [V ]
= 4.8
Por lo que se utiliza un amplicador no inversor con una ganancia
A
v
= E
p
=
R
f
R
i
+ 1 =
3.9K
1K
+ 1 = 4.9
Y para suministrar la corriente y voltaje adecuado al motor se pone entre la salida del
amplicador y el lazo de retroalimentacion un amplicador de alta ganancia de corriente
Darlington formado con los transistores de potencia TIP41 y TIP35. El primero suministra
184
EN
INV
IE
2005
Encuentro de Investigacion en IE, 1718 Marzo, 2005
Figura 10. Respuesta simulada del modelo servomotor con control proporcional integral.
Figura 11. Respuesta del servomotor con control proporcional integral.
la corriente de base adecuada para el segundo transistor. El esquema de esta etapa se muestra
en la Figura 9.
F. Pruebas del control proporcional integral
EL control se probo para un valor deseado de W
d
= 1500 [rpm] y tiempo de asentamiento
t
s
= 3 [seg] el cual se aplico tanto al modelo del servomotor como al servomotor, los resul-
tados simulados en VisSim se muestran en la Figura 10. Y los resultados reales obtenidos se
muestran en la Figura 11.
Comparando los resultados obtenidos vemos que tanto la respuesta obtenida en la simulacion
como la real son iguales.
G. Prueba del control integral con compensador de adelanto de fase
EL control se probo para un valor de velocidad deseado W
d
= 1500 [rpm] y un sobrepaso
del 30 % en t
p
= 2 [seg], el cual se aplico tanto al modelo del servomotor como al servo-
motor, los resultados simulados en VisSim se muestran en la gura 12. Y los resultados del
comportamiento del servomotor se muestran en la Figura 13.
Comparando los resultados obtenidos vemos que tanto la respuesta obtenida en la simulacion
como la real son iguales.
Aurelio Beltran, Miguel E. Gonzalez, y Claudia Reyes : Control de velocidad de servomotor DMES8G 185
Figura 12. Respuesta del modelo con control integral mas compensador de adelanto de fase.
Figura 13. Respuesta del servomotor con control integral mas compensador de adelanto de fase.
V. CONCLUSIONES
El desempe no del servomotor logrado al aplicarle los algoritmos de control fue satisfactorio.
Ademas el uso de la tarjeta TMS320LF2407 y el programa VisSim facilitan en gran medi-
da el dise no de controladores para diversos comportamientos, y permiten tener un control
exible ya que podemos realizar cualquier modicacion a los valores de las ganancias de los
controladores en la ventana del programa principal sin modicar otros modulos de este como
se muestra en la Figura 14.
186
EN
INV
IE
2005
Encuentro de Investigacion en IE, 1718 Marzo, 2005
Figura 14. Ventana del programa de control de VisSim.
REFERENCIAS
[1] Pierre E. Dupont: Avoiding Sticki-Slip Through PD Control, IEEE TRANSACTIONS ON AUTOMATIC
CONTROL, Vol.39, pp. 1094-1097, (1994).
[2] Ogata Katsuhiko: Ingeniera de Control Moderna: Tercera Edicion, Prentice Hall, (1998).
[3] Cotistantin Llas, Aurelian Sarca, Radu Giuclea, Liviu Kreindler:Using TMS320 Family DSPs in Motion
Control Systems, ESIEE, Paris Septiembre 1996.
[4] Norman S. Nise: Sistemas de Control para Ingeniera, Tercera Edicion, CECSA, (2002).