Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Brazo Robtico
INTRODUCCIN.-
OBJETIVOS.-
Generales:
- Disear y construir un modelo de un brazo robtico industrial.
Especficos:
- Entregar el dibujo del robot.
- Ubicar los sistemas de referencia dentro del dibujo del robot.
- Escribir la tabla de Denavit - Hartemberg para el robot.
- Escribir las matrices del sistema Ti, TT.
- Escribir las ecuaciones para p = (px, py, pz), TT (:,4).
- Evaluar p para i = 0, i =/2, i = .
- Bloque de simulink: motor + caja + barra, con g, Vref = 0, Ks = 0;
Vref = 0, Ks 0; Vref = , Ks 0.
- Leer los 4 ngulos del robot y resolver T(:,4)
px =
py =
pz =
- Mostrar grficamente el espacio de trabajo del robot (3 figuras
con distintos ngulos).
DESARROLLO.-
DIBUJO DEL ROBOT
En la siguiente ilustracin se muestra el dibujo en CAD del brazo robtico diseado
para el proyecto que se estar llevando a cabo el cual constar de cuatro
potencimetros que funcionarn como las articulaciones del robot y al mismo
tiempo, nos permitir hacer la lectura de los movimientos del robot. Este modelo fue
diseado con el programa de CAD SolidWorks 2017.
Ilustracin 2. Dibujo en CAD (SolidWorks 2017) del robot que se utilizar a lo largo del proyecto.
SISTEMAS DE REFERENCIA
Una vez que ya se tiene el diseo del brazo robtico que se utilizar, se procede a
ubicar los sistemas de ejes de referencia que, posteriormente, se utilizarn para
poder obtener las matrices del mismo sistema, los ejes de referencia se muestran
en la siguiente ilustracin. Cabe mencionar que dichos sistemas de referencia nos
permitirn ver las traslaciones y rotaciones que el brazo es capaz de hacer para
mostrar su movimiento y su zona de trabajo.
TABLA D-H
La posicin en la que se encuentra el brazo robtico de la ilustracin anterior
(Ilustracin 3), es a lo que se le llamara posicin de HOME, esto nos ayuda a
obtener los ngulos con los que trabaja el robot, as como sus traslaciones y
rotaciones y por ltimo, pero no menos importante la tabla de Denavit Hartemberg,
la cual se despliega en la siguiente ilustracin (Ver Ilustracin 4).
Ilustracin 4. Tabla D-H para el brazo robtico.
MATRICES Ti y TT
Para que todo el proyecto tenga sentido, como se puede ir observando, hay que
trabajar paso a paso. Lo siguiente que se debe obtener, ya teniendo a mano la tabla
D-H, es que obtengamos las matrices de cada eslabn del robot, tomando en cuenta
los valores ya medidos del brazo se obtiene lo siguiente:
Para el eslabn 1:
Trz1 = [1,0,0,0; 0,1,0,0; 0,0,1,b1; 0,0,0,1]1
Rz1 = [cos(1),-sen(1),0,0; sen(1),cos(1),0,0; 0,0,1,0; 0,0,0,1]2
Trx1 = [1,0,0,a1; 0,1,0,0; 0,0,1,0; 0,0,0,1]3
Rx1 = [1,0,0,0; 0,cos(1),-sen(1),0; 0, sen(1), cos(1),0; 0,0,0,1]4
Para el eslabn 2:
Trz2 = [1,0,0,0; 0,1,0,0; 0,0,1,b2; 0,0,0,1]5
Rz2 = [cos(2),-sen(2),0,0; sen(2),cos(2),0,0; 0,0,1,0; 0,0,0,1]6
Trx2 = [1,0,0,a2; 0,1,0,0; 0,0,1,0; 0,0,0,1]7
Rx2 = [1,0,0,0; 0,cos(2),-sen(2),0; 0, sen(2), cos(2),0; 0,0,0,1]8
Para el eslabn 3:
Trz3 = [1,0,0,0; 0,1,0,0; 0,0,1,b3; 0,0,0,1]9
Rz3 = [cos(3),-sen(3),0,0; sen(3),cos(3),0,0; 0,0,1,0; 0,0,0,1]10
Trx3 = [1,0,0,a3; 0,1,0,0; 0,0,1,0; 0,0,0,1]11
Rx3 = [1,0,0,0; 0,cos(3),-sen(3),0; 0, sen(3), cos(3),0; 0,0,0,1]12
Para el eslabn 4:
Trz4 = [1,0,0,0; 0,1,0,0; 0,0,1,b4; 0,0,0,1]13
Rz4 = [cos(4),-sen(4),0,0; sen(4),cos(4),0,0; 0,0,1,0; 0,0,0,1]14
Trx4 = [1,0,0,a4; 0,1,0,0; 0,0,1,0; 0,0,0,1]15
Rx4 = [1,0,0,0; 0,cos(4),-sen(4),0; 0, sen(4), cos(4),0; 0,0,0,1]16
Al tener ya bien definidas las matrices del robot, mediante un programa de Matlab
(el cual se muestra en la Ilustracin 5), obtendremos las Ti finales y la TT final y
simplificada del brazo robtico, las cuales se muestran a continuacin.
T1 =
[ cos(th1), 0, sin(th1), 0]
[ sin(th1), 0, -cos(th1), 0]
[ 0, 1, 0, 61/5]
[ 0, 0, 0, 1]
T2 =
[ cos(th2), -sin(th2), 0, (15*cos(th2))/2]
[ sin(th2), cos(th2), 0, (15*sin(th2))/2]
[ 0, 0, 1, 3/2]
[ 0, 0, 0, 1]
T3 =
[ cos(th3), 0, -sin(th3), 0]
[ sin(th3), 0, -cos(th3), 0]
[ 0, 1, 0, 3/2]
[ 0, 0, 0, 1]
T4 =
[ cos(th4), -sin(th4), 0, 0]
[ sin(th4), cos(th4), 0, 0]
[ 0, 0, 1, 13/2]
[ 0, 0, 0, 1]
T=
[ sin(th1)*sin(th4) - cos(th4)*(cos(th1)*sin(th2)*sin(th3) - cos(th1)*cos(th2)*cos(th3)),
cos(th4)*sin(th1) + sin(th4)*(cos(th1)*sin(th2)*sin(th3) - cos(th1)*cos(th2)*cos(th3)),
cos(th1)*cos(th3)*sin(th2) - cos(th1)*cos(th2)*sin(th3), 3*sin(th1) + (15*cos(th1)*cos(th2))/2 -
(13*cos(th1)*cos(th2)*sin(th3))/2 + (13*cos(th1)*cos(th3)*sin(th2))/2]
[ - cos(th1)*sin(th4) - cos(th4)*(sin(th1)*sin(th2)*sin(th3) - cos(th2)*cos(th3)*sin(th1)),
sin(th4)*(sin(th1)*sin(th2)*sin(th3) - cos(th2)*cos(th3)*sin(th1)) - cos(th1)*cos(th4),
cos(th3)*sin(th1)*sin(th2) - cos(th2)*sin(th1)*sin(th3), (15*cos(th2)*sin(th1))/2 - 3*cos(th1) -
(13*cos(th2)*sin(th1)*sin(th3))/2 + (13*cos(th3)*sin(th1)*sin(th2))/2]
[ cos(th4)*(cos(th2)*sin(th3) + cos(th3)*sin(th2)), -
sin(th4)*(cos(th2)*sin(th3) + cos(th3)*sin(th2)), - cos(th2)*cos(th3) - sin(th2)*sin(th3),
(15*sin(th2))/2 - (13*cos(th2)*cos(th3))/2 - (13*sin(th2)*sin(th3))/2 + 61/5]
[ 0, 0,
0, 1]
Ilustracin 5. Programa en Matlab para obtener Ti y TT.
pz = (15*sin(th2))/2 - (13*cos(th2)*cos(th3))/2 -
(13*sin(th2)*sin(th3))/2 + 61/5
th1 = th1;
th2 = th2;
th3 = th3;
th4 = th4;
b1 = 12.2;
b2 = 1.5;
b3 = 1.5;
b4 = 6.5;
a1 = 0;
a2 = 7.5;
a3 = 0;
a4 = 0;
T = T1*T2*T3*T4
i = 0:
px = 7.5000
py = -3
pz = 5.7000
i = /2:
px = 3
py = 2.7555e-16
pz = 13.2000
i = :
px = 7.5000
py = 3.0000
pz = 5.7000
Para este apartado se seleccion un motor de para mover una barra de acero 1020
de dimetro 5 cm con una longitud de 50 cm.
Los parmetros del motor seleccionado, as como los parmetros de la caja de
engranes se muestran a continuacin:
Motor DC
V=24 volts
R=4.00 ohms
L=0.00050 henrios
Bm=0.00007005 Nm/rad*seg
Jm=0.000041 Kg/m2
Kv=0.03458 volt/rad seg
Km=0.5140 Nm/A
Caja Reductora
N=80
Bm=0.00022215 Nm/rad*seg
Jm=0.000133 Kg/m2
close all;
clc;
y=zeros(1,1000); %Vector donde se guardarn los datos obtenidos
%Bucle while para que tomar y dibujar las muestras que se requiere
while contador_muestras<=500
b1 = 12.2;
b2 = 1.5;
b3 = 1.5;
b4 = 6.5;
a1 = 0;
a2 = 8;
a3 = 0;
a4 = 0;
T = T1*T2*T3*T4
v= T(:,4);
col=(v);
px=col(1);
py=col(2);
pz=col(3);
plot3(px,py,pz,'.')
contador_muestras=contador_muestras+1;
end
end
b1 = 12.2;
b2 = 1.5;
b3 = 1.5;
b4 = 6.5;
a1 = 0;
a2 = 7.5;
a3 = 0;
a4 = 0;
T1 = [cos(th1), 0, sin(th1), a1*cos(th1); sin(th1), 0, -cos(th1), a1*sin(th1); 0,
1, 0, b1; 0,0,0,1]
T2 = [cos(th2), -sin(th2), 0, a2*cos(th2); sin(th2), cos(th2), 0, a2*sin(th2); 0,
0, 1, b2; 0,0,0,1]
T3 = [cos(th3), 0, -sin(th3), a3*cos(th3); sin(th3), 0, -cos(th3), a3*sin(th3); 0,
1, 0, b3; 0,0,0,1]
T4 = [cos(th4), -sin(th4), 0, a4*cos(th4); sin(th4), cos(th4), 0, a4*sin(th4); 0,
0, 1, b4; 0,0,0,1]
T = T1*T2*T3*T4
%Vector de posicin
vector = T(:, 4);
resultado = eval(vector);
X = resultado(1);
Y = resultado(2);
Z = resultado(3);
plot3(X, Y, Z, 'b*')
title('Espacio de trabajo 3D')
hold on
grid on
xlabel('Eje X');
ylabel('Eje Y');
zlabel('Eje Z');
end
end
end
end
Como se puede observar es un programa con ciclos for anidados para que se
muestre la posicin que puede llegar a tomar cada articulacin junto con su eslabn
y al final muestre las zonas donde este puede trabajar sin ningn tipo de problema,
el lmite est dado por la carrera de cada potencimetro y eso me pone junto a los
ciclos for para que sean tomados en cuenta. El avance del programa est dado
por /7 para su correcto funcionamiento. El programa que se mostr da como
resultado las siguientes formas. (Ver Ilustracin 10, 11, 12).
Ilustracin 11. Espacio de trabajo del robot vista en el plano XY desde arriba.
Ilustracin 12. Tercera vista del rea de trabajo del robot diseado.
CONCLUSIONES: