Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Control de Velocidad y Posicion para Un Motor DC PDF
Control de Velocidad y Posicion para Un Motor DC PDF
b. Como la frecuencia del encoder hace referencia a la medidas cada 0.05s y dos veces por cada entrada de PWM,
cantidad de pulsos por segundo, ahora calculamos la luego se promediaron cada una de las medidas (Ver Tabla
cantidad de pulsos en un minuto. Nº1).
60
∗ (2)
1 Al observar los datos se puede inferir que nuestro sistema se
Donde es la cantidad de pulsos por minuto. comporta como un sistema lineal de primer orden. Para lo cual
la función de transferencia de muestro sistema tendría la
c. Una vez conocido los pulsos por minuto del encoder siguiente forma.
calculamos la cantidad de vueltas que da este en un
minuto sabiendo que nuestro encoder genera 32 (
pulsos por vuelta, con lo que obtendríamos las rpm !(') = (6)
de nuestro encoder. )' + 1
1 Donde ( es la ganancia y ) es la constante de tiempo del
= ∗ (3)
32 sistema, la cual es una medida de la rapidez con la que un
Donde son las rpm del encoder. sistema determinado responde en presencia de alguna
perturbación [8].
d. Finalmente para calcular las rmp de nuestro motor se
tiene que 5514 rpm del encoder equivales a 200 rpm Para obtenerla función de transferencia de nuestro
del motor. sistema a partir de la curva de respuesta se utilizo el ToolBox
200 de Matlab llamado Ident, el cual se encarga de caracterizar el
= ∗ (4)
5514 sistema a partir de la señal de entrada y la señal de salida de la
planta. [9]
B. Señales Para Controlador de Posición Esta caracterización se realizo para cada uno de las rpm
obtenidas ante las entradas respectivas de PWM. Al final se
a. Partiendo de los datos mostrados en el Señales Para promediaron todas la funciones obtenidas con el objetivo de
Controlador de Velocidad se determino que el obtener una función equivalente que representara nuestro
encoder nos provee de 800 pulsos por cada vuelta del sistema.
eje del motor y teniendo que una vuelta equivale a
360º se obtiene la siguiente relación. Los resultados obtenidos fueron:
360°
! "#$ = ∗ (5) a. Función de transferencia equivalente
800
0.80706
!(') = (7)
Donde son los pulsos del encoder. (1 + 0.1556')
V. CARACTERIZACIÓN DE LA PLANTA b. Respuesta del sistema ante una entrada escalón
DATOS
ESCALONES
20 40 60 80 100 120 140 160 180 200 230 250
PWM PWM PWM PWM PWM PWM PWM PWM PWM PWM PWM PWM
Tiempo
(S)
RPM RPM RPM RPM RPM RPM RPM RPM RPM RPM RPM RPM
0 0 0 0 0 0 0 0 0 0 0 0 0
0.05 4 6 10 9 10 18 15 24 18 17 21 28
0.1 6 13 22 27 32 44 44 56 56 61 71 68
0.15 7 19 31 39 48 61 67 81 86 95 109 125
0.2 9 24 37 49 59 72 82 97 106 117 137 152
0.25 9 28 42 55 66 80 92 108 120 132 154 169
0.3 10 31 45 58 70 85 98 115 128 143 165 180
0.35 10 32 47 60 73 88 102 119 135 150 172 187
0.4 11 34 48 61 75 92 106 123 140 155 177 191
0.45 11 34 49 62 76 92 107 125 143 159 181 195
0.5 11 34 49 63 77 93 109 127 146 162 183 198
0.55 11 35 49 63 77 93 110 128 147 163 185 200
0.6 12 35 49 63 78 94 110 129 148 165 187 200
0.65 11 35 49 63 78 94 111 130 150 166 188 201
0.7 12 35 49 63 78 94 112 130 150 167 188 202
0.75 12 35 49 63 79 94 112 130 151 168 189 203
0.8 12 35 49 63 79 94 112 131 151 169 190 203
0.85 11 35 49 63 78 94 112 131 151 169 190 203
0.9 12 35 49 63 78 94 112 131 151 170 190 203
0.95 12 35 49 63 79 94 112 131 152 169 190 204
1 12 35 50 63 79 94 112 131 152 169 190 204
1.05 12 35 49 63 78 94 112 131 152 170 190 204
1.1 12 35 50 64 78 94 112 132 152 170 191 204
1.15 12 35 49 64 78 95 113 131 152 170 191 204
1.2 12 35 49 64 78 95 112 132 153 170 191 204
1.25 12 35 49 64 78 95 113 132 152 170 191 204
1.3 12 35 49 63 78 95 112 131 153 170 191 204
B. Posición:
Para el control de la posición se tomara la señal (tren de
pulsos) enviada por el encoder y se procesara con el
objetivo de convertirla en grados, esto se hará en el
microcontrolador, una vez convertida esa señal se compara
con la señal de consigna para determinar si el sistema está o
Figura 7. Respuesta del sistema discretizado ante una entrada escalón. no en la posición deseada, si esta, la acción de control es
cero, sino esta diferencia pasara al controlador el cual
determinara cuanto ha de seguir moviéndose el motor para
alcanzar la posición deseada, manteniendo activo o no el
CONTROL DE VELOCIDAD Y POSICIÓN PARA UN MOTOR DC 5
PWM. En este caso la velocidad del motor se mantendrá C. Implementación del controlador:
constante. Si el valor actual de la posición es positivo el Para poder implementar el controlador en el
motor se moverá en sentido horario en caso contrario anti microcontrolador se hizo necesario valerse de una serie de
horario, esto se conseguirá emitiendo el PWM por otro pin ecuaciones llamadas Ecuaciones en Diferencias las cuales nos
del microcontrolador. permitieron ingresar nuestro controlador a base de sumas,
restas y divisiones teniendo en cuenta los errores anteriores y
VII. DISEÑO DEL CONTROLADOR el actual para poder generar la acción de control [12].
A. Elección del controlador:
Teniendo como referencia que la acción de control viene
Debido a los diferentes tipos de controlador y a las
características que cada uno de ellos puede presentan se ha dada por:
decidido utilizar un controlador tipo PI debido a que un este
controlador nos ayuda a eliminar el error en estado 67 = 6789 + :; <7 + :9 <789 + := <78= (10)
estacionario que se pueda presentar en nuestro sistema
haciendo que la señal de salida del proceso sea igual en Donde <7 es el error actual, <789 y <78= los errores
magnitud a la de referencia, de igual manera nos permite anteriores y :; , :9 y := son constantes que dependen de los
modificar la ganancia de este con el objetivo de poder valores de >1 , >? y >2 .
incrementar o disminuir el MP el cual se ve reflejado en la
cantidad de energía que nuestro sistema debe tomar para Los valores de las constantes vienen dadas por:
alcanzar la estabilidad [10].
@? (?
:; = (1 1 + :; = (1 + (11)
Ecuación de un controlador PI en tiempo continúo. @ @
(2 @ @? (?
/0(') = (1 + (9) :9 = (1 −1 + −2 :9 = −(1 + (2 @ − 2 (12)
' @2 @ @
(1 @? (?
Donde ' es la variable en tiempo continúo y (1 , (2 , son := = := = (13)
las constantes proporcional e integral respectivamente. @ @
(0.78792' + 5.628)
5(') = (10)
'
IX. MONTAJE DE LOS CIRCUITOS operaciones para conseguir la variable que en realidad
deseábamos medir, que no era la frecuencia sino los rpm del
El montaje de los circuitos se realizo sobre una placa de motor.
acrílico y cada circuito esta soportada mediante tornillos lo Que se utilizara un controlador PI para realizar el control de
cuales poseen arandelas aislantes para evitar que ocurra un nuestro sistema debido a que este posee todas las ventajas de
corto entre el circuito y los tornillo. Además para conectar las los controladores tipo K e I lo que nos permitiría eliminar el
diferentes placas se utilizo cable UTP trenzado para disminuir error en estado estable, aumentar o disminuir el Kp y
las interferencias por campo magnético, así mismo los disminuir o aumentar el tiempo de elevación según sea
circuitos poseen planos de masa para recoger cualquier señal necesario.
o corriente parasita y posteriormente enviarlas a tierra. Que nuestro sistema controlado posee un tiempo de
elevación de 0.471 S, no posee sobre pico, tiempo de
asentamiento de 0.798S y un error en estado estable de 0.
REFERENCIAS
[1] Encoders, Javier Venegas Requena. Recurso digital, disponible en:
http://www2.elo.utfsm.cl/~elo212/docs/Encoders-jvr-v01.pdf
[2] Encoder Absoluto. Silge Elctronica S.A. Recurso digital, disponible en:
http://control-gray.googlecode.com/files/Encoder%20Absoluto.pdf
[3] Imagen tomada de: Codificador Rotatorio - Autor Desconocido-
Wikipedia- http://es.wikipedia.org/wiki/Codificador_rotatorio
Figura 10. Imagen real e impreso del driver de motor. [4] Imagen tomada de: Encoder Absoluto e incremental - Autor
Desconocido- http://www.picvietnam.com/forum/showthread.php?t=224
[5] 50:1 Metal Gearmotor – Pololu Robotics & Electronics.
http://www.pololu.com/catalog/product/1444
[6] Imagen tomada de: 50:1 Metal Gearmotor – Pololu Robotics &
Electronics. http://www.pololu.com/catalog/product/1444
[7] Imagen tomada de: 50:1 Metal Gearmotor – Pololu Robotics &
Electronics. http://www.pololu.com/catalog/product/1444
[8] Respuesta Dinámica De Sistemas Lineales de Primer Orden. Antonio
Flores. Disponible en:
http://200.13.98.241/~antonio/cursos/control/notas/dynamics/1order.pdf
[9] System Identification Toolbox. MathWorks.
http://www.mathworks.com/products/sysid/
[10] Recurso Digital: Universidad de San Carlos de Guatemala. Diseño de
Figura 11. Imagen superior del montaje del sistema. Controladores PID en Tiempo Discreto, y Análisis De Respuesta
Utilizando Herramientas Computacionales. S. Toledo. Disponible en:
http://biblioteca.usac.edu.gt/tesis/08/08_0202_EO.pdf
[11] Interactively design and tune SISO feedback loops. MathWorks.
http://www.mathworks.com/help/toolbox/control/ref/sisotool.html
[12] Recurso Digital: Implementación digital de controladores PID.
Departamento de Tecnologia – Universidad de Jaume. Roberto Sanchiz.
Disponible en:
http://www.tec.uji.es/asignatura/dir_asignaturas/3/67/Tema1.pdf
[13] Graphical User Interfaces. MathWorks.
http://www.mathworks.com/discovery/matlab-gui.html