Professional Documents
Culture Documents
CONTROL
BALL & A BEAM
.
ABSTRACT
MARCO TEORICO
1
.
3
.
provoca una mejora en la precisión en estado estable. arriba, tiene internamente una circuitería de control
interna y es sumamente poderoso para su tamaño.
Control proporcional-integral-derivativa (PID): Un servo normal o Standard como el HS-300 de
Esta acción combinada reúne las ventajas de cada Hitec tiene 42 onzas por pulgada o mejor 3kg por
una de las tres acciones de control individuales. La cm. de torque que es bastante fuerte para su
ecuación de un controlador con esta acción tamaño. También potencia proporcional para
combinada se obtiene mediante: cargas mecánicas. Un servo, por consiguiente, no
consume mucha energía. Se muestra la
composición interna de un servo motor en el cuadro
de abajo. Podrá observar la circuitería de control, el
motor, un juego de piñones, y la caja.
Control de Posición
posición y se resistirá a fuerzas externas que intenten mantener su posición, de modo que cualquier
cambiarlo de posición. Si los pulsos no se envían, el fuerza externa podría desplazarlo.
servomotor quedará liberado, y cualquier fuerza
externa puede cambiarlo de posición fácilmente.
SERVOMOTOR
6
.
tiempo de encendido (ON) se le llama Ancho de Pulso crecen o se reducen. Ahora estás viendo el ancho
(pulse width). Para variar el valor analógico de pulso (pulse width).
cambiamos, o modulamos, ese ancho de pulso. Si
repetimos este patrón de encendido-apagado lo
suficientemente rápido por ejemplo con un LED el
resultado es como si la señal variara entre 0 y 5 voltios MODELAMIENTO DEL BALL & BEAM
controlando el brillo del LED.
Una bola se coloca en un haz, donde se permite
En el gráfico de abajo las líneas verdes representan rodar con un grado de libertad a lo largo de la
un periodo regular. Esta duración o periodo es la longitud de la barra. Un brazo de palanca se une a
inversa de la frecuencia del PWM. En otras palabras, la barra en un extremo y un servomotor en el otro. A
con la Arduino la frecuencia PWM es bastante próxima medida que el equipo de servo se convierte en un
a 500Hz lo que equivale a periodos de 2 milisegundos ángulo , la palanca de cambios en el ángulo del
cada uno. La llamada a la función analogWrite() debe haz de α. Cuando se cambia el ángulo de la
ser en la escala desde 0 a 255, siendo 255 el 100% de posición horizontal, la gravedad hace que la bola
ciclo (siempre encendido), el valor 127 será el 50% del ruede a lo largo de la barra. Un controlador se
ciclo (la mitad del tiempo encendido), etc. diseña para el sistema de modo que la posición de
la bola puede ser manipulada.
L = 0.7;
d
2
J d r
2
0 2 m 2 mg ( sen ) mr d = 0.1;
R dt dt J = 9.99e-6;
K = (m*g*d)/(L*(J/R^2+m));
Linealización de la ecuación sobre el ángulo del haz,
α = 0, nos da la siguiente aproximación lineal del num = [-K];
sistema: den = [1 0 0];
J d r printsys(num,den)
2
2 m 2 mg step(num,den)
R dt
d
L
J d r
2
d
2 m 2 mg
R dt L
8
.
Fig. 12 Respuesta a la señal paso con Kp=1 Fig. 14 Respuesta a la señal paso con variación de
kp, kd
Como se puede ver la adición de ganancia
proporcional no hace que el sistema estable. El Como se puede ver en la trama, sobre todo, los
siguiente paso es cambiar el valor de kp y tenga en objetivos de control se han cumplido sin el uso de
cuenta que el sistema sigue siendo inestable. un controlador integral (tiempo de establecimiento
Control proporcional-derivativo de este ejemplo se considera alcanzado cuando la
Ahora, vamos a añadir un término derivado al respuesta es inferior al 2% de su valor final). Pero
controlador. para efectos reales se debió utilizar un controlador
kp = 10; integral para mejor el tiempo de establecimiento.
kd = 10; Las ecuaciones asociadas a los tiempos que
numPD = [kd kp]; encontramos son :
numh = conv(num, numPD);
[numc, denc] = cloop(numh, den); PULSO NIVEL ALTO t1= 0,693 * (R1+R2) * C1
t=0:0.01:5;
step(numc,denc,t) PULSO NIVEL BAJO t2 = 0,693 * R2 * C1
por tanto:
T = t1 + t2 = 0,693 * ( R1 + 2R2 ) * C1
9
.
PROPORCIONAL
𝑍1 𝑅1 0,954 𝐾Ω
𝐾𝑝 = − =− = −
𝑍2 𝑅2 1 𝐾Ω
Controlador PID Implementado 𝐾𝑝 = −0,954
INTEGRAL
2
𝒁𝒂 = 𝑍3 ║ 𝑍𝑐
5
1 𝑍3 ∗ 𝑍𝑐
𝒁𝒂 =
3 𝑍3 + 𝑍𝑐
𝑅3
4
𝐶1
𝒁𝒂 =
1
𝑅3 + 𝐶
1
𝑅3
𝒁𝒂 =
𝑅3 𝐶1 + 1
Simulación del PID
1. Amp. Diferencial 𝑍𝑎
2. Controlador P 𝑲𝒊 = −
3. Controlador I 𝑅4
4. Controlador D
𝑅3
5. Amp. Sumador Inversor 𝑲𝒊 = −
𝑅4 𝑅3 𝐶1 + 𝑅4
Calculo de las constantes P.I.D. Cada elemento del
Controlador lo manejamos como impedancia y se
obtiene:
10
.
2 𝐾Ω 𝐶 = 1 𝜇𝐹
𝑲𝒊 = − (5,78 𝐾Ω∗2 𝐾Ω∗100 𝜇𝐹)+5,78 𝐾Ω
3 Fuentes DC
1 Osciloscipio
2 Protoboard
Resistencias
Trimmers
Capacitores
Arduino uno
𝑲𝒊 = −0,2883 LM358
Servomotor 3001 HD
DERIVATIVO MATERIALES PARA LA MAQUETA
Balso (Madera)
Angulo (50 cm)
Balín
Cuerda de Ferroníquel
Brazo de palanca acodada
Acrilico
CONCLUSIONES
11
.
REFERENCIAS
http://www.unicrom.com/tut_multivibrador_ast
able_555.asp
http://es.wikipedia.org/wiki/Circuito_integrado_
555
http://cfievalladolid2.net/tecno/cyr_01/robotica/
sistema/motores_servo.htm
http://es.scribd.com/doc/26916307/Probador-
de-Servos-Con-El-Integrado-555
http://syscontrol2.blogspot.com/2007/12/contr
oladores-pid.html
http://www.engin.umich.edu/group/ctm/exampl
es/ball/ball.html#Problem
http://www.control-systems-
principles.co.uk/whitepapers/spanishwp/04Bal
landBeam1SP.pdf
http://arduino.cc/es/Tutorial/PWM
http://www.arduteka.com/2011/11/tutorial-
arduino-0003-entrada-analogica-y-salida-
pwm/
12