Beruflich Dokumente
Kultur Dokumente
1. INTRODUCCIN.
2. OBJETIVOS:
Determinar las caractersticas del sistema, plantear del modelado matemtico que rige a la
planta, determinar la curva caracterstica de la planta y comprobacin de estas mediante el
uso de Matlab.
3. JUSTIFICACIN
Con este sistema se pretende entender el trasfondo matemtico que gobierna una planta,
aprender a sacar el modelo matemtico del mismo y aplicarlo junto a la electrnica en la
maqueta.
La implementacin de este tipo de control es muy til en la Industria actual ya que se puede
aplicar para mantener la posicin de cualquier objeto para realizar un trabajo, el cual siempre
buscara mantenerse estable a pesar de la aplicacin de perturbaciones en el sistema. Por
ejemplo, podemos mencionar varias aplicaciones como mantener la estabilidad de drones,
en el espacio seria de mucha utilidad para mantener la inclinacin de la nave espacial.
4. MARCO TERICO
Descripcin de la planta
La planta est formada por el balancn o barra mvil cuya longitud aproximada es de 50 cm
y la barra bancada cuya altura es aproximada de 32 cm, el balancn va unido a la bancada
por medio de un rodamiento de bolas que permiten el giro, en uno de los extremos del
balancn hay un soporte donde va colocado el motor y la hlice.
Motor brushless
Arduino
Arduino es una plataforma de electrnica abierta para la
creacin de prototipos basada en software y hardware
flexibles y fciles de usar. Los programas hechos con Arduino
se dividen en tres partes principales: estructura, valores
(variables y constantes), y funciones. El Lenguaje de
programacin Arduino se basa en C/C++.
MPU-6050
El circuito integrado MPU-6050 contiene un acelermetro y
giroscopio MEMS en un solo empaque. Cuenta con una
resolucin de 16-bits, lo cual significa que divide el rango
dinmico en 65536 fracciones, estos aplican para cada eje X,
Y y Z al igual que en la velocidad angular. El sensor es ideal
para disear control de robtica, medicin de vibracin, sistemas de medicin inercial
(IMU), detector de cadas, sensor de distancia y velocidad, y muchas cosas ms. El MPU-
6050 contiene un giroscpico, un acelermetro, adems de un sensor de temperatura,
mediante I2C regresa unos valores conocidos como raw o crudos segn el registro
seleccionado.
Control PID
Es un sistema de control que, mediante un elemento final de control (actuador), es capaz de
mantener una variable o proceso en un punto deseado dentro del rango de medicin del
sensor que la mide en este caso un potencimetro lineal. Es uno de los mtodos de control
ms frecuentes y precisos dentro de la regulacin. Las tres componentes de un controlador
PID son: la accin proporcional, accin integral y accin derivativa. En general, si se tiene
un sistema de primer orden, se suele utilizar control PI (ya que la accin derivativa no tiene
mayor efecto) y si el sistema es de segundo orden, se suele utilizar control PID el cual es el
utilizado en este caso.
Definiciones Importantes
A continuacin, se define la terminologa necesaria para introducirnos en la teora de control
automtico. Estas definiciones estn basadas, en parte, en las propuestas de normas de la
IEEE.
Planta: se designar como planta a cualquier objeto fsico que pueda ser controlado. Puede
ser un equipo, quizs simplemente un juego de piezas de una mquina funcionando juntas,
cuyo objetivo es realizar una operacin determinada. Ejemplos de plantas son: horno de
calentamiento, reactor qumico, etc.
UNIVERSIDAD DE LAS FUERZAS ARMADAS ESPE
CDIGO: SGC.DI.505
DEPARTAMENTOS: ELCTRICA Y ELECTRNICA VERSIN: 1.0
ENERGA Y MECNICA FECHA ULTIMA
REVISIN: 26/10/16
Proceso: se definir como una operacin o conjuntos de pasos con una secuencia
determinada, que producen una serie de cambios graduales que llevan de un estado a otro, y
que tienden a un determinado resultado final. Se denominar proceso a cualquier operacin
que se vaya a controlar. Ejemplos de procesos son: qumicos, econmicos, biolgicos, etc.
Control: esta palabra se usa para designar regulacin, gobierno, direccin o comando.
Entrada de un sistema: Es una variable del sistema elegida de tal manera que se la utiliza
como excitacin del mismo.
Salida de un sistema: Es una variable del sistema elegida de tal modo que se la utiliza para
analizar los efectos que produjo una excitacin en la entrada del mismo.
UNIVERSIDAD DE LAS FUERZAS ARMADAS ESPE
CDIGO: SGC.DI.505
DEPARTAMENTOS: ELCTRICA Y ELECTRNICA VERSIN: 1.0
ENERGA Y MECNICA FECHA ULTIMA
REVISIN: 26/10/16
Entrada de un sistema de control: Es una variable del sistema controlado que se elige de
modo tal que mediante su manipulacin se logra que el sistema cumpla un objetivo
determinado.
Las variables de entrada, son variables que ingresan al sistema y no dependen de ninguna
otra variable interna del mismo.
No solo la seal de referencia (valor deseado de la salida del sistema) conforma una variable
de entrada, tambin hay ciertas seales indeseadas, como son algunas perturbaciones
externas, que se generan fuera del sistema y actan sobre la planta, afectando
desfavorablemente la salida del sistema, comportndose tambin como una variable de
entrada, cuyo valor no dependen de ninguna otra variable interna al sistema.
Salida de un sistema de control: Es una variable del sistema controlado que se elige de
modo tal que mediante su estudio se analiza si el sistema cumple o no con los objetivos
propuestos. Se ver ms adelante que en los sistemas realimentados esta seal de salida
contribuye a realizar el control propuesto.
Realimentacin: es una propiedad de los sistemas que permiten que la salida del sistema o
cualquier variable del mismo sea comparada con la entrada al sistema o con cualquier
componente del sistema, de tal manera que pueda establecerse la accin de control apropiada
entre la entrada y la salida.
En general, se dice que la realimentacin existe en un sistema cuando hay una secuencia
cerrada de relaciones causa-efecto entre las variables de un sistema. Este concepto de
realimentacin juega un papel muy importante en ingeniera de control. Aunque el trmino
parece tener un significado muy sencillo, es bastante difcil encontrar una definicin precisa
para l. La existencia de realimentacin en los sistemas fsicos es difcil de demostrar, en
cambio cuando deliberadamente se introduce realimentacin con el afn de controlar su
existencia y su funcin se identifica ms fcilmente.
UNIVERSIDAD DE LAS FUERZAS ARMADAS ESPE
CDIGO: SGC.DI.505
DEPARTAMENTOS: ELCTRICA Y ELECTRNICA VERSIN: 1.0
ENERGA Y MECNICA FECHA ULTIMA
REVISIN: 26/10/16
6. PROCEDIMIENTO
DETERMINACION DE LOS PARAMETROS DEL PROYECTO
DEFINICIN PARMETRO
MODELAMIENTO MATEMTICO.
Para determinar el modelo matemtico de nuestro sistema debemos tener un completo dominio sobre
el tema, y los conocimientos necesarios sobre el mismo, y tambin de las leyes fsicas que le afectan
a la planta. Es sistema tiene un grado de libertad, mediante el cual se realiza un movimiento
rotacional.
El movimiento realizado por la barra mvil, es la rotacin de un cuerpo rgido alrededor de un eje
fijo, en este movimiento lo que permite tener una aceleracin angular es el torque y tambin la fuerza
que se le aplica. En este sistema ya que solo la fuerza aplicada no puede producir una respuesta en el
movimiento.
Por lo cual el torque est definido como la fuerza ejercida, con una distancia y su direccin en el eje,
su ecuacin representativa es:
= (. 1)
donde:
() es el vector de posicin de la fuerza aplicada que va desde el eje de giro hasta el punto de
aplicacin de esta. Se puede ver que fuerzas aplicadas en el eje de giro no tendrn torque
dando cambio al sistema.
es la fuerza aplica. Como se ve es un producto vectorial por lo tanto depender del ngulo
de aplicacin de la fuerza.
El torque est relacionado con el momento de inercia, otro trmino importante en los movimientos
rotacionales ya que todo elemento que gira en torno a un eje posee momento de inercia, este torque
est representado por:
= (. 2)
UNIVERSIDAD DE LAS FUERZAS ARMADAS ESPE
CDIGO: SGC.DI.505
DEPARTAMENTOS: ELCTRICA Y ELECTRNICA VERSIN: 1.0
ENERGA Y MECNICA FECHA ULTIMA
REVISIN: 26/10/16
donde:
Mediante estas dos ecuaciones podemos obtener las ecuaciones de nuestro sistema, empezando por
el momento de inercia de la barra, motor y las torques de las fuerzas de la planta mostrada en la figura
1.
: fuerza que proporciona el giro del motor y a la encargada de hacer cambiar de posicin a
la barra.
Torque
La fuerza de gravedad acta sobre todos los dispositivos, tanto sobre el motor y hlice, por lo cual el
anlisis se lo realiza por separado.
Si el punto de gravedad de la barra estuviera en su eje de gravedad el torque total que produce la
gravedad sobre la barra sera nulo ya que se compensaran los torques de un lado del eje de giro con
el otro. En nuestro caso el centro de gravedad estar desplazado 3 cm por lo tanto la accin de la
gravedad si producir torque que ser:
0.325 0.325
0.4364
= ( ) = 9.8 ( ) = 0.02383()
0.315 0.315 0.64
Para determinar el torque del motor y de la hlice, todo el conjunto es una sola masa puntual, porque
se encuentra en el punto medio del motor, por lo tanto el torque es:
= = (0.315)(9.8)(0.076) = 0.2346
El motor y la hlice estarn orientados de tal forma que la fuerza que ejercen formara un ngulo de
90 con el vector de posicin. Su torque ser:
= = (0.315) 90 = 0.315
Momento de inercia.
Se define como la resistencia de un cuerpo a obtener una aceleracin angular, es una magnitud escalar
que refleja la distribucin de masas de un cuerpo o un sistema de partculas en rotacin, respecto al
eje de giro. El momento de inercia slo depende de la geometra del cuerpo y de la posicin del eje
de giro; pero no depende de las fuerzas que intervienen en el movimiento.
UNIVERSIDAD DE LAS FUERZAS ARMADAS ESPE
CDIGO: SGC.DI.505
DEPARTAMENTOS: ELCTRICA Y ELECTRNICA VERSIN: 1.0
ENERGA Y MECNICA FECHA ULTIMA
REVISIN: 26/10/16
Fsicamente dado un sistema de partculas y un eje arbitrario, el momento de inercia del mismo se
define como la suma de los productos de las masas de las partculas por el cuadrado de la distancia r
de cada partcula a dicho eje. Matemticamente se expresa como:
= 2 (ec.3)
Para un cuerpo con masa fija y continua la ecuacin ec3 se generaliza de la siguiente forma:
= 2 (. 4)
Para el clculo del momento de inercia de la masa y de la barra, en la siguiente grafica se muestra
una modelo del sistema:
= (. 5)
0.325
0.4364 2
= ( ) = 14.906103 2
0.315 0.64
UNIVERSIDAD DE LAS FUERZAS ARMADAS ESPE
CDIGO: SGC.DI.505
DEPARTAMENTOS: ELCTRICA Y ELECTRNICA VERSIN: 1.0
ENERGA Y MECNICA FECHA ULTIMA
REVISIN: 26/10/16
Para calcular este momento de inercia tomando en cuenta su masa, tomando en cuenta que est
concentrada en un punto la ec.3 para determinar la inercia.
= 2
El conjunto de la masa est determinado por = 0.04364 y esta se encuentra a una distancia de
= 0.325, por lo tanto el momento de inercia es:
= +
= 22.906 103
Como el sistema como respuesta da una variacin de ngulo, la funcin de transferencia como
entrada es una fuerza de empuje y la salida un ngulo que forma la barra mvil con un eje de
referencia que est definida por:
Como todo sistema posee rozamiento por lo tanto le tendremos que unir este trmino. Por lo tanto la
frmula quedara:
= (. 6)
UNIVERSIDAD DE LAS FUERZAS ARMADAS ESPE
CDIGO: SGC.DI.505
DEPARTAMENTOS: ELCTRICA Y ELECTRNICA VERSIN: 1.0
ENERGA Y MECNICA FECHA ULTIMA
REVISIN: 26/10/16
2
+ + ( )= (. 7)
2
0.02383() 0.2346 () + 0.315 = 0.022906
Una vez encontrada las derivadas en la ecuacin, se aplicara la transformada de Laplace para obtener
la funcin de transferencia , como la ecuacin no es lineal, se la linealizar utilizando la serie de
Condiciones:
0 = 0 = 0
= 45
0.21077 (45)
=
0.315
= 0.47313
f f f f
= + + + Fg = 0
Fg
UNIVERSIDAD DE LAS FUERZAS ARMADAS ESPE
CDIGO: SGC.DI.505
DEPARTAMENTOS: ELCTRICA Y ELECTRNICA VERSIN: 1.0
ENERGA Y MECNICA FECHA ULTIMA
REVISIN: 26/10/16
Determinando que las condiciones iniciales F=0 son cero la funcin de transferencia quedara como:
() 0.315
=
() 0.022906 2 + + 0.14903
La nica aceleracin que acta sobre el MPU6050 es la gravedad se puede calcular, con los datos del
acelermetro, la pocin respecto de la vertical. Para ello se coloca en uno de los ejes del acelermetro
paralelo al eje horizontal.
Una de las formas de medir la posicin es llamando a _ y _ al valor medido por el acelermetro
en el eje Z e Y respectivamente y aplicando la relacin que define el ngulo con la vertical:
UNIVERSIDAD DE LAS FUERZAS ARMADAS ESPE
CDIGO: SGC.DI.505
DEPARTAMENTOS: ELCTRICA Y ELECTRNICA VERSIN: 1.0
ENERGA Y MECNICA FECHA ULTIMA
REVISIN: 26/10/16
_
= (. 8)
_
_
= ( ) (. 9)
_
La ec.8 permite obtener el ngulo girado y calcular la posicin con los datos proporcionados por el
acelermetro y giroscopio.
Si se conoce el ngulo inicial de la IMU, se puede sumar el valor que marca el giroscopio para obtener
el ngulo actual. Llamando _ a la velocidad angular medida por el acelermetro en el eje X y
_ obteniendo la ecuacin:
() = ( 1) + (. 10)
donde:
() Es el ngulo actual.
Al utilizar un IMU, se produce mucho error en cuanto al ruido al tomar las mediciones, por lo cual
es indispensable la utilizacin de filtros de Kalman o filtros complementarios, por la complejidad de
estos filtros se ha escogido un filtro complementario obteniendo una aproximacin del ngulo.
El filtro pasa bajo consiste en una fusin de dos filtros: uno de paso alto para el giroscopio y el otro
pasa bajo para el acelermetro, la ecuacin para obtener el ngulo queda definida por:
= 0.98 ( + ) + 0.02
El valor de pulsos entregado por el puerto ~9 (Pin PWM) es de [0.00 a 5.00], sin embargo nuestra
planta solo utiliza desde [2.94 a 3.35] con estos valores es suficiente para elevar el brazo desde [-
60 a 60] siendo el eje x nuestro 0.
1 2.94 -60
2 2.96 -52
3 2.98 -41
4 3.00 -28
5 3.05 -16
6 3.10 5
7 3.15 15
8 3.20 21
9 3.25 29
10 3.30 35
11 3.33 45
12 3.35 62
Utilizando la funcin step() de Matlab, comprobaremos la respuesta del sistema, para ello ejecutemos
los siguientes comandos:
UNIVERSIDAD DE LAS FUERZAS ARMADAS ESPE
CDIGO: SGC.DI.505
DEPARTAMENTOS: ELCTRICA Y ELECTRNICA VERSIN: 1.0
ENERGA Y MECNICA FECHA ULTIMA
REVISIN: 26/10/16
%Comunicacion Arduino
Sumatoriat = 0;
ard= arduino('COM4','uno');
dev= i2cdev(ard,'0x68'); %Conexion al MPU6050
write(dev,hex2dec('6B'));
write(dev,0)
uicontrol('String','Parar','Callback','parada=0;');
parada= 1;
while (parada)
writePWMVoltage(ard,'D10',3.09); %Motor
end
if(parada == 0)
disp('Parada');
writePWMVoltage(ard,'D10',0);%
%clear all;
End
PRUEBAS
UNIVERSIDAD DE LAS FUERZAS ARMADAS ESPE
CDIGO: SGC.DI.505
DEPARTAMENTOS: ELCTRICA Y ELECTRNICA VERSIN: 1.0
ENERGA Y MECNICA FECHA ULTIMA
REVISIN: 26/10/16
MODELADO MATEMATICO
clear all
num=[0.315];
den=[0.022906 1 0.14903];
G=tf(num, den);
step(G)
UNIVERSIDAD DE LAS FUERZAS ARMADAS ESPE
CDIGO: SGC.DI.505
DEPARTAMENTOS: ELCTRICA Y ELECTRNICA VERSIN: 1.0
ENERGA Y MECNICA FECHA ULTIMA
REVISIN: 26/10/16
7. ONCLUSIONES
Desarrollamos el modelo matemtico del sistema.
Corroboramos mediante simulaciones el funcionamiento del diseo del sistema.
8. BIBLIOGRAFIA