Professional Documents
Culture Documents
Introduccin:
El Control de un Pndulo Invertido es un proyecto que contiene tanto sistemas
mecnicos como electrnicos y es el principio bsico de funcionamiento de los
transbordadores espaciales. La coordinacin perfecta entre los sistemas mecnicos y
electrnicos hace de este proyecto un tema de gran atencin en los sistemas de control
retroalimentados.
En el documento incluimos todo un anlisis minucioso del diseo de un controlador
electrnico, la experimentacin para determinar los parmetros necesarios para el
anlisis matemtico y las consideraciones para el correcto funcionamiento del pndulo
invertido.
Mediante el estudio de este documento, el lector tendr muchas bases para el
desarrollo e implementacin de su proyecto o proyectos afines que tengan relacin con
los sistemas de control retroalimentados.
Banda Dentada
Rieles Metlicas
Rodamientos
Caja de Engranes
Engranes de
Acople
Zona Lineal
+12 V
LDR1
10K
20K
TL084CN
10K
VL
VP
10K
e1(t)
LDR2
20K
10K
Vout
Vin
24V
0.1A (Incluyendo el Pndulo)
Potencia Disipada:
2.4W
Para los transistores TIP31C y TIP32C estos parmetros tienen los siguientes
valores:
Mximo Voltaje CE:
Mxima Intensidad CE:
50V
4A
Potencia Disipada:
40W
L
x
Gp
L cos P
PB
M
BC
dt x&
x
(
)
m+
x& pm
+ L&
p
cos p pm
L& p
sen =
F
p
B xc &
M
d
T
=
p
dt p
Q p
m+
(M
2)
)x&
(I + m L )&
2
m L&p B xc & = F
+
p
+ m p Lx& + B p & p = m p gL p
Estas son las ecuaciones que describen el movimiento del pndulo junto con su
base mvil. Es necesario mencionar que este modelo, como su nombre lo dice, es una
representacin de la realidad fsica, de esta manera el pndulo, puede tomar cualquier
forma, lo nico que interesa es tener la distancia al centro de masa y su momento de
inercia con respecto al mismo, para poder analizar su comportamiento.
Ra
i
F
Tm,
ia
ef
+
Kf
-
eb
ea
nT2,
1r
Sensor
1T
Jn,Bn
T3
La
Las ecuaciones del sistema en el dominio del tiempo son las siguientes:
e = K ef
= i p
e b = K b &m
Tm = K i i a
+ Bm &m +
1T
T1 = n
2T
m = n n
+ B n &n +
3T
T3 = r 1 F
x=
1r
e = Ra i a + La i& a + e b
Tm
T2
e = Kf
Ea Ef
R
sLa
+a
=
mT
m
2
s
J
2
s J+n
E = K Ef
E bb
= sK m
=
2
(
)
m = n n
T
sB
3
T3 = r1 F
x=
1r
s m pL
I
Tim = K I a
T1 = n
2T
E = Kf
+ sBm
=
n
2
+ sB p
m+ p L
2
m p gL
= P1 X
s
)M
2
+mp
(
)I + m
s
m
2
2
p
+ sBc
L2
+ sB m p gL
p
X = P2 X
T2 =
(
2
s J n + sB n + 1r 3P
2P
sKb
Eb
i
Ef
Kf
m
Ra +
asL
Ki
s 2J +
m
sBm
T1
3
r 1P
nP
p
Gp
(J
P = sLm 1pr nK i K f K
4
n+ 2 J n
P5 s
)
a
s+
L
([
+ n r1
(R
2 a
Jm
+ R B + n 2 Bn + K b K
i
a
m
n+ 2 J n R + Bm
[(
n+ 2 Bn
]] [s (I +
2
)
s
m
B+
2
2
p
L2 + sB p m p gL +
+ sLa) s M + m p
L +
De est ecuacin se puede concluir que los anlisis de estabilidad deben ser
hechos en funcin del parmetro de amplificacin K del amplificador de potencia, por
ser fcil de ajustar a diferencia de los otros que dependen de la construccin de la
maqueta y el pndulo.
Ra:
La :
K i:
K b:
Jm:
Bm :
n:
r1:
Jn:
Bn:
M:
mp :
B c:
Bp:
I:
L:
Kf:
Ra:
Para su determinacin, simplemente se utiliza un hmetro, sin embargo se debe
tener cuidado en el valor que se mida, ya que esto depender de la posicin de las
escobillas del motor. El valor correcto es aquel que es ms pequeo.
Ra = 33.2
La :
Para esto es necesario alimentar al Motor con una tensin alterna de bajo voltaje
(aproximadamente la mitad del voltaje nominal en CC del Motor) y con la ayuda de un
osciloscopio de doble trazo medir el desfase en segundos de la tensin y la corriente a
travs del motor, as como sus valores eficaces. Despus con el uso de las relaciones
para la potencia alterna hallar el valor de la inductancia:
Va = 12 Vef
Ia = 0.38 Aef
S = Va * Ia = 4.56 VA
Tdesfase = 0.4 ms 9
Q = S cos = 4.5 VAR
XL = Q / Ia2 = 31.16
La = XL / (2 60) = 80 mH
K i:
Para esto se utiliz una masa de 39.2gr colocada en el eje del rotor, y luego se
elevo lentamente la corriente hasta el punto en que este se mueve, el dato obtenido fue
muy similar al especificado en la hoja de datos del fabricante (ver ANEXO 1):
Ia = 0.08 A
Tm = 0.001132 Nm
Ki = Tm / Ia = 0.01415 Nm/A
K b:
La determinacin de este parmetro (ya que no aparece en la hoja de datos),
exige que el motor acte como un generador, es decir, se le debe dotar de un
movimiento constante al eje del mismo y medir la tensin de salida en los bornes de
alimentacin, a la vez que se mide la velocidad del eje. Para esto se utilizar un motor
adicional y un sensor ptico, mismo que enviar una seal pulsante al osciloscopio para
obtener la velocidad del eje:
f = 35.71 Hz
Rpm =377 rmp
= 35.71 rad/seg
Vout = 10 V
Kb = Vout / = 0.28 Vseg/rad
B m , B n , B c, B p :
Todos estos parmetros pueden ser determinados bajo una tabla de coeficientes
de friccin viscosa para diferentes superficies o de la hoja de datos del fabricante para el
motor (ANEXO 1), de donde obtenemos los siguientes resultados con su respectiva
transformacin de unidades:
Bm (Acero sobre Acero) = 7.42x10-5 N m seg/rad
Bn (Hierro sobre Hierro) = 10.5x10-5 N m seg/rad
Bc (Acero sobre Acero) = 20x10-5 N seg/m
Bp (Acero sobre Acero) =7.42x10-5 N m seg/rad
M, Mp:
Para la medicin de masas se utiliz una balanza digital electrnica de alta
precisin, con la cual se obtuvieron los siguientes resultados
M = 0.1 Kg
Mp = 0.2 Kg
r1:
El radio de la banda se realiza por una simple medicin con un calibrador:
r1 = 0.0095
n:
Para la relacin total de velocidades, considerando la caja de velocidades del
motor y la relacin de dientes de los engranajes de la banda, se obtiene el siguiente
valor:
n = 40.5
L:
Este valor se determina tomando el centro de gravedad de cada uno de los
elementos que conforman el pndulo, la varilla y la esfera:
Frmulas:
~x dw
x=
; Centro de Gravedad
dw
x=
.
l
L
~ym
m
L= y=
+(
VARILLA + rl
l
=L 2
VARILLA
,0 765
L=
) mESFERA
0 1,
2
+ mESFERA
+(
,0 0857
),0 765 + ,0 0235
0 + ,0 0857
1,
L = 0,569 m.
I:
En base a los resultados obtenidos con anterioridad ahora podemos establecer el
momento de Inercia del pndulo en torno a su centro de gravedad.
2
I 0 = I G + md
I 0 = I 0 _ VARILLA + I 0 _ ESFERA
I =
VARILLA
I =
0 0
765,
1,
l2 +
5
2
m
ESFERA
r 2 + mESFERA (
0
5 08
57
,
0
023
5,
+2 0
0857,
)l + r
(
0 0235,
)+0 765,
I0 = 0,0728 kg m2
2
=I
mTOTAL L
(mVARILLA + mESFERA ) L
GI = I 0
I =0
0728,
G
( +0
)0 1, 085
7,
0 569,
IG = 0,01415 kg m2.
Jm:
Como no se puede obtener la medida exacta del rotor ni su forma, lo que se har
es suponer las mismas de acuerdo a las dimensiones externas del motor y considerar al
rotor como un cilindro. Como densidad se tomar una densidad promedio entre la del
cobre y la del hierro elementos constituyentes del Rotor:
FE
MOTOR
+ CU
2
7870 + 8960
2
MOTOR
mMOTOR = 0
000003534,
mMOTOR r 2
=0
029,
0 0075,
Jm = 0,000001672 kgm2.
Jn:
Finalmente, el ltimo de los momentos de inercia, considerado para el modelo
matemtico, es el engranaje de mayor volumen dentro de la caja de velocidades, para lo
cual se considerar al mismo como un cilindro hecho de hierro:
Datos del Engrane:
Radio: 0,0075 m.
Espesor: 0,004 m
Volumen del engrane: 0,0000007068 m3.
FE = 7,87 gr / cm3.
mENGRANE = VENGRANE FE
mENGRANE = 0 00556,
I ENGRANE m= ENGRANE r 2
kg
Jn = 0.0000003129 Kg m2
Kf:
Para su calculo se midi la relacin voltio-ngulo del sistema armado, dando los
siguientes datos:
p = 5
Vout = 13.1 V
Kf = Vout / p (rad)= 150 V / rad
0.00015s
0.1511Ks
2
(
+ 0.06153s 0.323s
- 1.445 +s 4.52
3
+
)0.1511K
-500
-400
-300
-200
Real Axis
-100
100
Lugar Geomtrico
amplificado
15
10
5
0
-5
-10
-15
-10
-8
-6
-4
-2
0
Real Axis
10
1.511s sK
K
+
= 0.00015s 4 + 0.06153s + (
3
i
)1.511K
- 0.323 s
+
(
)1.511K
- 1.445 +s 4.52
p
A simple vista, vemos que el sistema puede estabilizarse mediante una correcta eleccin
de valores para Kd y Kp. Esto es precisamente lo que indagaremos del anlisis de la
grfica del contorno de races de la funcin de transferencia, para esto supondremos
algunos valores para Kp y hallaremos los correspondientes para Kd que hacen que el
sistema sea estable (Ver las siguientes pginas):
Del anlisis se obtienen las siguientes suposiciones:
Para Kp = 1
Para Kp = 50
Para Kp = 100
Kd >=3.6
Kd >=0.36
Kd >=0.47
Como se observa, mientras ms grande sea Kd, Kd puede ser ms pequeo hasta
cierto valor en donde Kp vuelve a subir. Esto es de vital importancia en el aspecto
prctico ya que no es posible obtener valores muy elevados de Kd en base a
condensadores y resistencias. Por otra parte valores elevados de Kp haran saturar al
amplificador, debido a que la seal de amplificacin del sensor es elevada (Kf =150).
Ahora es tiempo de evaluar estos valores en el tiempo para esto se ha graficado la
respuesta al impulso y al escaln para Kp =10 y Kd = 1 (Ver las siguientes pginas).
De las respuestas podemos sacar las siguientes conclusiones:
Impulse Response
Respuesta al impulso con controlador PD (Kp=10, Kd=1)
4
3
2
1
0
-1
-2
-3
0
0.5
1.5
2.5
3.5
4.5
10
Time (sec.)
Step Response
1.4
1.2
1
0.8
0.6
0.4
0.2
0
0
5
Time (sec.)
Kp = 1
400
200
-200
-1
-400
-400
-300
2000
-200
-100
Real Axis
Kp = 50
100
-2
-0.01
20
-1000
-20
-400
-300
4000
-200
-100
Real Axis
Kp = 100
0.005
0.01
Lugar Geom
40
1000
-2000
-0.005
Real Axis
100
-40
-40
-30
Real Axis
-20
-10
Lugar Geom
50
2000
0
-2000
-4000
-50
-400
-300
-200
-100
Real Axis
100
-60
-50
-40
-30
-20
Real Axis
-10
10
1.511 s Kd + sK p + Ki
0.00015s
+ 0.06153s 0.323s
1.445s + 4.52
e ss =
i
+
1
1.511K i + 4.52
Mientras mayor sea el valor de Ki, el valor del error ms se acercar a 0.5, que es el
lmite cuando Ki tiende al infinito.
El integrador tambin tiene efecto sobre la respuesta del sistema tal como se
haba sealado con anterioridad, esto es ms fcil de visualizar si se tiene la funcin de
transferencia del sistema:
1.511s s K
+
p
4
0.06153s + (
= 0.00015s +
3
)1.511K
sK +p K i
- 0.323 s + (
)1.511K
- 1.445
s
+(
)1.511K
4.52
Impulse Response
Respuesta al impulso con controlador PID (Kp=10, Kd=3, Ki=50)
1
0.5
-0.5
-1
0.5
1.5
2.5
3.5
4.5
Time (sec.)
Respuesta al escal
Step Response
1
0.8
0.6
0.4
0.2
0
0
5
Time (sec.)
10
P = sLm 1pr nK i K f K
5
P
J m n+ 2 J n
P5 s
)
a
s+
L
([
+ n r1
(R
2 a
Jm
+ R B + n 2 Bn + K b K
i
a
m
n+ 2 J n R + Bm
[(
n+ 2 Bn
]] [s (I +
2
L +
L2 + sB p m p gL +
+ sLa) s M + m p
s
m
B+
2
2
p
BIBLIOGRAFA
Internet
http://www.copal-usa.com/geared.htm
http://robotics.me.jhu.edu/~llw/courses/me530420/lab/pittman_specsheet.pdf
http://robotics.me.jhu.edu/~llw/courses/me530420/lab/lab_04_08.pdf
http://www.widus.co.kr/salesdpt/products/motor/geared/lc30g_lc37g.html
Libros referenciales:
KUO
SOLIMAN
OGATA
BOYLESTAD
Robert L.
Electrnica Teora de Circuitos
PRENTICE HALL, Sexta Edicin, Mxico 1999.
CEKIT
HIBBELER
IOVINE
John
ROBOTS, ANDROIDS and ANIMATRONS,
Editorial Mc Graw Hill, Segunda Edicin, New York 2002.
BYERLY
Editorial
Mc Graw Hill,
ANEXO 1
(Hoja de Datos del Motor)
Type Designation
LC 20 G - 101 a
a: Series name
LA: Low cost LB: Brushless LC: Long life LS: Ironless rotor GLA: LA series
with gear box
b: Motor outer diameter (mm)
c: Attachment
d: Spec. number
e: Encoder resolution
Models
LC30-191
LC32-184
LC38-192
LC38188VG
LC38188VP
Rated
Power
W
5.5
9.8
9.6
24
200(1.96)
6100
800 1600(15.68)
9.2
24
270(2.60)
4800
830 1800(17.6)
13