Professional Documents
Culture Documents
Alumnos:
INDICE
1. DISEÑO MECÁNICO ........................................................................................4
A. VISTA ISOMETRICA DEL MANIPULADOR............ Error! Bookmark not
defined.
B. PLANOS DE CADA PIEZA ............................................................................6
C. PROCESO DEL DISEÑO .............................................................................. 11
D. ESPECIFICACIONES DEL MOTOR............................................................ 15
ELECCIÓN DEL MOTOR ........................................................................ 15
TABLA DE PARAMETROS ...................................................................... 15
PLANO DEL MOTOR .............................................................................. 16
REPRESENTACION EN SOLIDWORK .................................................. 16
VISTA DEL ENCODER ............................................................................. 17
CALCULOS DEL MOTOR ....................................................................... 17
CORROBORANDO .................................................................................. 18
E. PRESUPUESTO ............................................................................................. 19
2. CINEMÁTICA DIRECTA................................................................................. 20
A. VISTA ISOMETRICA DEL MANIPULADOR............................................. 20
B. DIAGRAMA DENAVIT – HARTENBERG .................................................. 21
C. SIMULACIÓN EN MATLAB ....................................................................... 23
3. CINEMÁTICA INVERSA................................................................................. 25
A. VISTA ISOMETRICA DEL MANIPULADOR............................................. 25
C. CALCULO DE LOS ANGULOS DE ROTACIÓN..................................... 26
D. SIMULACIÓN EN MATLAB ....................................................................... 27
~2~
Análisis y Control de Robots
1ER INFORME
~3~
Análisis y Control de Robots
1ER INFORME
1. OBJETIVOS
OBJETIVO PRINCIPAL
- Diseñar y analizar el modelo mecánico y cinemático de un brazo
robótico de 2 grados de libertad.
OBJETIVOS ESPECÍFICOS
- Diseño de un brazo robótico de 2gdl.
- Realizar el cálculo de la cinemática directa e inversa utilizando la
convención Denavit – Hartenberg y el método geométrico.
~4~
Análisis y Control de Robots
1ER INFORME
2. DISEÑO MECÁNICO
~5~
Análisis y Control de Robots
1ER INFORME
Pieza1.
Largo Base
~6~
Análisis y Control de Robots
1ER INFORME
Pieza 2
Base medio
~7~
Análisis y Control de Robots
1ER INFORME
Pieza 5
Torre Atrás
~8~
Análisis y Control de Robots
1ER INFORME
Torre Lateral
~9~
Análisis y Control de Robots
1ER INFORME
Junta2
~ 10 ~
Análisis y Control de Robots
1ER INFORME
Abrazadera
~ 11 ~
Análisis y Control de Robots
1ER INFORME
~ 12 ~
Análisis y Control de Robots
1ER INFORME
~ 13 ~
Análisis y Control de Robots
1ER INFORME
Esta parte aún está en proyecto de diseño debido a que los motores
no llegan, Pero para el siguiente informe, si aún no llegan lo
probaremos con el motor que hemos encontrado que es de un
diámetro de eje mayor igual a 5mm.
~ 14 ~
Análisis y Control de Robots
1ER INFORME
TABLA DE PARAMETROS
MODELO CHR-3429K-1210-50-ABHL
VOLTAJE DC 12.0 V
~ 15 ~
Análisis y Control de Robots
1ER INFORME
REPRESENTACION EN SOLIDWORK
~ 16 ~
Análisis y Control de Robots
1ER INFORME
~ 17 ~
Análisis y Control de Robots
1ER INFORME
𝑻𝒎𝒐𝒕𝒐𝒓 = 𝑰𝟎𝒛𝒛 ∙ 𝜶
Según SolidWorks, el momento de inercia de la carga para el motor
1 es: 21907882.36 g*mm2=0.00219 kg.m2
2 ∙ (2π)
𝛼= 2
= 68.437 𝑟𝑎𝑑/𝑠 2
𝑡
Por lo tanto, el torque requerido al motor será de:
CORROBORANDO
~ 18 ~
Análisis y Control de Robots
1ER INFORME
Además, se sabe que la relación entre la inercia de la carga y la del motor debe
Iyy=29222.72 g*mm2
D. PRESUPUESTO
PRODUCTO COSTO CANTIDAD PRECIO TOTAL
UNITARIO
~ 19 ~
Análisis y Control de Robots
1ER INFORME
CORTE LASÉR
3. CINEMÁTICA DIRECTA
A. VISTA ISOMETRICA DEL MANIPULADOR
~ 20 ~
Análisis y Control de Robots
1ER INFORME
Link 𝜽𝒊 𝒅𝒊 𝒂𝟏 𝜶𝟏
1 𝜃1 𝑑1 0 𝜋/2
2 𝜃2 𝑑2 𝑎2 0
Reemplazando. -
Link 𝜽𝒊 𝒅𝒊 𝒂𝟏 𝜶𝟏
1 𝜃1 14.4 cm 0 𝜋/2
2 𝜃2 6.8 𝑐𝑚 3.6 cm 0
~ 21 ~
Análisis y Control de Robots
1ER INFORME
cos(𝜃1 ) 0 sin(𝜃1 ) 0
sin(𝜃1 ) 0 −cos(𝜃1 ) 0]
𝐴10 = [
0 1 1 𝑑1
0 0 0 1
cos(𝜃1 ) ∗ cos(𝜃2 ) −cos(𝜃1 ) ∗ sin(𝜃2 ) sin(𝜃1 ) 3.6 ∗ cos(𝜃1 ) ∗ cos(𝜃2 ) + 6.8 ∗ sin(𝜃1 )
sin(𝜃1 ) ∗ cos(𝜃2 ) −sin(𝜃1 ) ∗ sin(𝜃2 ) −cos(𝜃1 ) 3.6 ∗ sin(𝜃1 ) ∗ cos(𝜃2 ) 𝑒 − 6.8 ∗ cos(𝜃1 )
[ ]
sin(𝜃2 ) cos(𝜃2 ) 0 3.6 ∗ sin(𝜃2 ) + 14.4
0 0 0 1
~ 22 ~
Análisis y Control de Robots
1ER INFORME
C. SIMULACIÓN EN MATLAB
%---------------------------------------------------------------%
% CINEMÁTICA DIRECTA DEL MANIPULADOR DE 2GDL
%---------------------------------------------------------------%
clc; clear all; close all
%---------------------------------------------------------------%
% 1. LONGITUD DEL MANIPULADOR - WORK-SPACE
%---------------------------------------------------------------%
L1 = 14.4;
L2 = 6.8;
L3 = 3.6;
figure(1)
theta11=180;
theta22=180;
[X,Y] = meshgrid(-theta11:5:theta11,-theta22:5:theta22);
plot(X,Y,Y,X)
hold on
grid on
xlabel('theta1°')
ylabel('theta2°')
%---------------------------------------------------------------%
% 2. PARAMETROS MECÁNICOS DEL MANIPULADOR
%---------------------------------------------------------------%
q1d=35.2255;
q2d=36.2754;
q1=q1d*pi/180;
q2=q2d*pi/180;
%---------------------------------------------------------------%
% 3. PLOTEO DEL ENTORNO
%---------------------------------------------------------------%
figure(2)
T0=eye(4);
plot_frame(T0,'frame','0','color','b','view','auto','length',8);
axis([-20 20 -20 20 -5 30])
hold on
grid on
xlabel('x(cm)')
ylabel('y(cm)')
%---------------------------------------------------------------%
% 4. CONFIGURACION INICIAL DEL ROBOT
%---------------------------------------------------------------%
% 4.1 ESLABON 1
% -> Hallamos A1
theta1 = q1;
d1 = L1;
a1 = 0;
alpha1 = pi/2;
% -> Matriz A1
A1 = matriz_homogenea_DH(theta1,d1,a1,alpha1);
% -> Ploteamos T101
T01=A1;
h1=plot_frame(T01,'frame','1','color','b','length',5);
~ 23 ~
Análisis y Control de Robots
1ER INFORME
% 4.2. ESLABON 2
theta2 = q2;
d2 = L2;
a2 = 0;
alpha2 = 0;
% -> Matriz A2
A2 = matriz_homogenea_DH(theta2,d2,a2,alpha2);
T02=T01*A2;
% -> Ploteamos T02
%h2=plot_frame(T02,'frame','2','color','b','length',5);
% 4.3. ESLABON 3
theta3 = 0;
d3 = 0;
a3 = L3;
alpha3 = 0;
% -> Matriz A2
A3 = matriz_homogenea_DH(theta3,d3,a3,alpha3);
T03=T02*A3;
% -> Ploteamos T02
h3=plot_frame(T03,'frame','2','color','b','length',5);
%------------------------------------------------------------%
% 5. DIBUJAMOS EL ROBOT
%------------------------------------------------------------%
% 5.1. PRIMERA LINEA
x1 = T01(1,4);
y1 = T01(2,4);
z1 = T01(3,4);
line([0 x1], [0 y1], [0 z1], 'LineWidth', 4,'color','k')
% 5.2. SEGUNDA LINEA
x2 = T02(1,4);
y2 = T02(2,4);
z2 = T02(3,4);
line([x1 x2], [y1 y2], [z1 z2], 'LineWidth', 4,'color','k')
% 5.3 TERCERA LINEA
x3 = T03(1,4);
y3 = T03(2,4);
z3 = T03(3,4);
line([x2 x3], [y2 y3], [z2 z3], 'LineWidth', 4,'color','k')
%==============================================================%
~ 24 ~
Análisis y Control de Robots
1ER INFORME
4. CINEMÁTICA INVERSA
~ 25 ~
Análisis y Control de Robots
1ER INFORME
𝑃 = [𝑥𝑓 , 𝑦𝑓 , 𝑧𝑓 ]
B. WORKSPACE
~ 26 ~
Análisis y Control de Robots
1ER INFORME
𝛽 = 𝑎𝑡𝑎𝑛2(𝑦, 𝑥)
𝜑 = 𝑎𝑡𝑎𝑛2(6.8, 3.6 ∗ cos(𝜃2 ))
𝜃1 = 𝜑 + 𝛽
D. SIMULACIÓN EN MATLAB
%---------------------------------------------------------------%
~ 27 ~
Análisis y Control de Robots
1ER INFORME
%---------------------------------------------------------------%
% 1. LONGITUD DEL MANIPULADOR - WORK-SPACE
%---------------------------------------------------------------%
L1 = 14.4;
L2 = 6.8;
L3 = 3.6;
figure(3)
zz = linspace(L1-L3,L1+L3,50);
[x, y, z] = cylinder(sqrt(L3^2+L2^2-((zz-L1).^2)));
zx = z*2*L3+(L1-L3);
surf(x,y,zx), view(134,30)
axis
hold on
grid on
xlabel('x(cm)')
ylabel('y(cm)')
%---------------------------------------------------------------%
% 2. PARAMETROS MECÁNICOS DEL MANIPULADOR
%---------------------------------------------------------------%
xc=9.632;
yc=3.129;
zc=21.1;
if (zc<L1-L3 | zc>L1+L3)
display('"z" se encuentra fuera del espacio de trabajo')
return
%elseif ((zc-L1)^2+xc^2+yc^2~=(L2^2+L3^2))
% display('"x" o "y" estan fuera del espacio de trabajo')
end
PARAMETROS=[L1,L2,L3];
%---------------------------------------------------------------%
% 3. PLOTEO DEL ENTORNO
%---------------------------------------------------------------%
figure(4)
T0=eye(4);
plot_frame(T0,'frame','0','color','b','view','auto','length',8);
xlabel('x(cm)')
ylabel('y(cm)')
plot3(xc,yc,zc,'ro','MarkerFaceColor','k','MarkerSize',10)
%---------------------------------------------------------------%
% 4. CINEMATICA INVERSA
%---------------------------------------------------------------%
~ 28 ~
Análisis y Control de Robots
1ER INFORME
%---------------------------------------------------------------%
% 5. CONFIGURACION INICIAL DEL ROBOT
%---------------------------------------------------------------%
% 5.1 ESLABON 1
% -> Hallamos A1
theta1 = q1;
d1 = L1;
a1 = 0;
alpha1 = pi/2;
% -> Matriz A1
A1 = matriz_homogenea_DH(theta1,d1,a1,alpha1);
% -> Ploteamos T101
T01=A1;
h1=plot_frame(T01,'frame','1','color','b','length',5);
% 5.2. ESLABON 2
theta2 = q2;
d2 = L2;
a2 = 0;
alpha2 = 0;
% -> Matriz A2
A2 = matriz_homogenea_DH(theta2,d2,a2,alpha2);
T02=T01*A2;
% -> Ploteamos T02
%h2=plot_frame(T02,'frame','2','color','b','length',5);
% 5.2. ESLABON 3
theta3 = 0;
d3 = 0;
a3 = L3;
alpha3 = 0;
% -> Matriz A2
A3 = matriz_homogenea_DH(theta3,d3,a3,alpha3);
T03=T02*A3;
% -> Ploteamos T02
h3=plot_frame(T03,'frame','2','color','b','length',5);
%------------------------------------------------------------%
% 6. DIBUJAMOS EL ROBOT
%------------------------------------------------------------%
% 6.1. PRIMERA LINEA
x1 = T01(1,4);
y1 = T01(2,4);
z1 = T01(3,4);
line([0 x1], [0 y1], [0 z1], 'LineWidth', 4,'color','k')
% 6.2. SEGUNDA LINEA
x2 = T02(1,4);
~ 29 ~
Análisis y Control de Robots
1ER INFORME
y2 = T02(2,4);
z2 = T02(3,4);
line([x1 x2], [y1 y2], [z1 z2], 'LineWidth', 4,'color','k')
% 6.4 TERCERA LINEA
x3 = T03(1,4);
y3 = T03(2,4);
z3 = T03(3,4);
line([x2 x3], [y2 y3], [z2 z3], 'LineWidth', 4,'color','k')
%================================================================
~ 30 ~