CinemticadeManipuladores

Dr.AlejandroAcevesLpez
CinemticadeRobots
Un robot industrial se puede modelar como una cadena
articulada abierta compuesta de cuerpos rgidos (eslabones)
conectados en serie por articulaciones (de revolucin o
prismticas) movidas por actuadores. Un extremo est fijo en la
base mientras que el otro est libre y unido a una herramienta.
La cinemtica trata del estudio analtico del movimiento
(posicin, velocidad, aceleracin) del robot con respecto a un
sistema coordenado fijo como una funcin del tiempo sin
considerar las fuerzas/momentos que originaron dicho
movimiento.
Un manipulador robtico consta de una secuencia de cuerpos rgidos,
llamados eslabones (vnculos) o elementos conectados mediante
articulaciones rotacionales o prismticas. La base del robot se considera el
elemento 0.
Cadapareja
articulacineslabn
seleconocecomo
gradodelibertad.
Un robot con n grados de libertad, tiene n pares de articulaciones
eslabones. La base del robot no se considera parte del robot.
Las articulacioneseslabones se enumeran desde la base del robot y hasta
la mueca.
Para cada par articulacineslabn se establece un sistema coordenado
intermedio que se fija al eslabn y que se mueve conforme el eslabn se
mueva.
En la base del robot se establece el sistema coordenado de referencia {0} y
en la mueca del robot se establece el sistema coordenado mvil {n}.
Los elementos/vnculos i e i1 estn conectados por la articulacin i.
Problema de cinemtica directa: Para un manipulador
particular, dado un vector con los valores articulares (q
1
(t), q
2
(t),
q
n
(t))
T
y los parmetros geomtricos de los n elementos
(eslabones), determinar la posicin y orientacin del efector
final con respecto a un sistema coordenado fijo de referencia.
Problema de cinemtica inversa: Dada una posicin y
orientacin deseada del rgano efector y conocidos los
parmetros geomtricos de los eslabones con respecto a un
sistema coordenado de referencia, saber si el robot puede
alcanzar dicha posicin y orientacin. Y en caso de ser posible,
conocer cuantas configuraciones diferentes del robot lo pueden
lograr.
En 1955, los investigadores Denavit y Hartenberg propusieron un enfoque
sistemtico y generalizado que utiliza matrices de transformacin
homognea 4 x 4 para describir la relacin espacial (traslacin/rotacin)
entre dos elementos mecnicos adyacentes.
CinemticaporlametodologadeDenavitHartenberg (DH)
Mediante transformaciones secuenciales se puede expresar la posicin y
orientacin del efector final con respecto a un sistema de coordenadas de
referencia fijo en la base del robot.
En la literatura existen reportadas dos metodologas:
1. El mtodo de DH (Anlisis por eslabones).
2. El mtodo de DH modificado (Anlisis por articulaciones).
MetodologadeDenavitHartenberg Modificada(DHm)
Eje i-1 Eje i
a
i1
Distanciadelvnculo
Eje i-1 Eje i
a
i1
a
i
d
i
Desplazamientoentrevnculos
Eje i-1 Eje i
a
i1
a
i
o
i1
d
i
Torsindelvnculo
Eje i-1 Eje i
a
i1
a
i
o
i1
u
i
d
i
nguloarticular
Eje i-1 Eje i
a
i1
a
i
o
i1
u
i
d
i
1

i
z

1

i
y

i
x

i
z

i
y

i
x
Sedefinendossistemascoordenados
Ejemplo1.
Considere dos vnculos con la geometra mostrada en la figura que se conectan
en serie. Calcule la longitud del vnculo a
i
, la torsin del vnculo o
i
y el
desplazamiento del vnculo d
i
.
Solucin: a
i
=7pulg;
o
i
=45 y d
i
=2.5pulg.
DefinicindetramasenlametodologadeDHm DefinicindetramasenlametodologadeDHm
DefinicindeparmetrosenlametodologadeDHm
Ejercicio1.
ObtengalosparmetrosdeDenavitHartenberg del
siguientemanipulador.
Ejercicio1.
i
i
u
i
d
1 i
o


1 i
a

1
1
u
1
0 d =
0
0 o =
0
0 a =
2
2
u
2
0 d =
1
0 o =
1 1
a L =
3
3
u
3
0 d =
2
0 o =
2 2
a L =

Solucin:
Ejercicio2.
ObtengalosparmetrosdeDenavitHartenberg delsiguientemanipulador.
Considresequelosvaloresarticulares{u
1
,u
2
,u
3
}soncero.
1
x
1
y
1
z
3
z
3
y
3
x
2
z
2
y
2
x
0 0 1 1 1
1 1 1 2 2 2 2 2
2 2 2 3 3 3 3
0; 0; ; 0;
; ; ; 0;
0; ; ; ;
a d
a L d
a L d L
t t
o u u
o u u
o u u
= = = =
= = = + =
= = = =
L
3
Solucin:
Ejercicio3.
ObtengalosparmetrosdeDenavitHartenberg delsiguientemanipulador.
Ejercicio3.
Solucin:
i
i
u
i
d
1 i
o


1 i
a

1
1
u
1
0 d =
0
0 o =
0
0 a =
2
2
0 u =
2
d
1
90 o =
1
0 a =
3
3
u
3 2
d L =
2
0 o =
2
0 a =

Transformacintotal:
i1
i
T
Ejercicio:ObtenerestamatrizconlaSymbolic toolbox deMatlab
ProgramaenMATLAB
function T=MatrizTransformacion(alfai_1,ai_1,qi,di)
% La funcin regresa en T la expresin simblica de la matriz.
T=[cos(qi) ,-sin(qi) ,0 , ai_1;
sin(qi)*cos(alfai_1),cos(qi)*cos(alfai_1),-sin(alfai_1),-di*sin(alfai_1);
sin(qi)*sin(alfai_1),cos(qi)*sin(alfai_1), cos(alfai_1), di*cos(alfai_1);
0 ,0 ,0 , 1];
T=simplify(T);
Ejercicio4.
Escribirlasexpresionesdelastransformacioneshomogneasparacadavnculo.
>> T01=MatrizTransformacion(0,0,sym(q1'),0)
T01 =
[ cos(q1), -sin(q1), 0, 0]
[ sin(q1), cos(q1), 0, 0]
[ 0, 0, 1, 0]
[ 0, 0, 0, 1]
>> T12=MatrizTransformacion(sym(pi)/2,0,0,sym('d2'))
T12 =
[ 1, 0, 0, 0]
[ 0, 0, -1, -d2]
[ 0, 1, 0, 0]
[ 0, 0, 0, 1]
>> T23=MatrizTransformacion(0,0,sym('q3'),sym('L2'))
T23 =
[ cos(q3), -sin(q3), 0, 0]
[ sin(q3), cos(q3), 0, 0]
[ 0, 0, 1, L2]
[ 0, 0, 0, 1]
Ejercicio5. PUMA560
u
1
u
2
u
3
u
4
u
6
u
5
% Este programa muestra las matrices de transformacin para el
% PUMA 560 que estn reportadas en la notas y en el libro.
%
% El nombre de este programa es:
%
% CinematricaPUMA560.m
%
T01=MatrizTransformacion( 0, 0, 0,sym('t1'))
T12=MatrizTransformacion(-sym(pi)/2, 0, 0,sym('t2'))
T23=MatrizTransformacion( 0,sym('a2'),sym('d3'),sym('t3'))
T34=MatrizTransformacion(-sym(pi)/2,sym('a3'),sym('d4'),sym('t4'))
T45=MatrizTransformacion( sym(pi)/2, 0, 0,sym('t5'))
T56=MatrizTransformacion(-sym(pi)/2, 0, 0,sym('t6'))
T46=simplify(T45*T56)
T36=simplify(T34*T46)
T13=simplify(T12*T23)
T05=T01*T13*T34*T45
collect(T01*T13*T36,[sin(sym('t1')), cos(sym('t1'))])
11 12 13
0 0
21 22 23 0 6 6
6
31 32 33
[0,0,0] 1
0 0 0 1
x
y O
z
r r r P
r r r P R P
T
r r r P
(
(
(
(
= =
(
(

(

0 6
0
6
0 0 0 6
6 6
0 0 6 0
6 6
1 1
1 [0,0,0] 1 1
O
O
P P
T
P R P P
P R P P
( (
=
( (

( ( (
=
( ( (

= +
( ) ( )
( ) ( )
| |
( ) ( )
( )
11 1 23 4 5 6 4 6 23 5 6 1 4 5 6 4 6
21 1 23 4 5 6 4 6 23 5 6 1 4 5 6 4 6
31 23 4 5 6 4 6 23 5 6
12 1 23 4 5 6 4 6 23 5 6 1 4 6 4 5 6
22 1 23 4 5 6 4 6 23 5 6
r c c c c c s s s s c s s c c c s
r s c c c c s s s s c c s c c c s
r s c c c s s c s c
r c c c c s s c s s s s c c s c s
r s c c c s s c s s s
= + + (

= + (

=
= + + (

= + (

( )
| |
| |
| |
| |
| |
1 4 6 4 5 6
32 23 4 5 6 4 6 23 5 6
13 1 23 4 5 23 5 1 4 5
23 1 23 4 5 23 5 1 4 5
33 23 4 5 23 5
1 2 2 3 23 4 23 3 1
1 2 2 3 23 4 23 3 1
3 23 2 2 4 23
x
y
z
c c c s c s
r s c c s s c c s s
r c c c s s c s s s
r s c c s s c c s s
r s c s c c
P c a c a c d s d s
P s a c a c d s d c
P a s a s d c

= +
= +
= + +
=
= +
= + +
=
Ejercicio6. Yasukawa Motoman L3
Elrobotsemuestra
enlaposicin
(0,90,90,90,0).
Solucin:
Recordarqueelrobotestenlaposicin(0,90,90,90,0).
Entonces:
11 12 13
0 0
21 22 23 0 5 5
5
31 32 33
[0,0,0] 1
0 0 0 1
x
y O
z
r r r P
r r r P R P
T
r r r P
(
(
(
(
= =
(
(

(

0 5
0
5
0 0 0 5
5 5
0 0 5 0
5 5
1 1
1 [0,0,0] 1 1
O
O
P P
T
P R P P
P R P P
( (
=
( (

( ( (
=
( ( (

= +
% Este programa muestra las matrices de transformacin para el
% Yasukawa Motoman L-3 que estn reportadas en la notas.
%
% El nombre de este programa es:
%
% CinematicaYasukawaMotomanL3.m
T01=MatrizTransformacion( 0, 0,0,sym('t1'))
T12=MatrizTransformacion(-sym(pi)/2, 0,0,sym('t2'))
T23=MatrizTransformacion( 0,sym('L2'),0,sym('t3'))
T34=MatrizTransformacion( 0,sym('L3'),0,sym('t4'))
T45=MatrizTransformacion( sym(pi)/2, 0,0,sym('t5'))
T05=T01*simplify(T12*T23*T34)*T45
( )
( )
1 234 5 1 5 1 234 5 1 5 1 234 1 2 2 3 23
0 1 234 5 1 5 1 234 5 1 5 1 234 1 2 2 3 23
5
234 5 234 5 234 2 2 3 23
0 0 0 1
c c c s s c c s s c c s c L c L c
s c c c s s c s c c s s s L c L c
T
s c s s c L s L s
+ + + (
(
+
(
=
(

(

( )
( )
234 2 3 4
234 2 3 4
cos
sin
c
s
u u u
u u u
= + +
= + +
Donde:
L
2
L
1
Ejercicio7.
UtilizandolametodologadeDHescribirlamatrizdetransformacin
totaldelaherramientahastalabase.
Relacindeespacios
Un robot de n GDL tiene n variables articulares formando un vector
columna definido en el espacio articular.
En general cada articulacin es accionada por un actuador, sin
embargo, no siempre es el caso. Por ejemplo, dos motores accionan
una flecha, un actuador lineal acciona una articulacin rotacional. Es
til entonces conocer la relacin entre la posicin del actuador y la
posicin de la articulacin.
Espaciodeactuador
LosmotoresyservomotoresseutilizanenROBOTICApara
producirmovimientodepiezasyarticulacionesmecnicas.
Servomotores
SSC32ServoController
http://www.lynxmotion.com/p395ssc32servocontroller.aspx
http://www.robodacta.mx/index.php?dispatch=products.view&product_id=29885
Servomotores
Porejemplo,siqueremosqueelservo0recibaunasealPWMde1500ms,sepodraenviar
lasecuenciadebytessiguientes:
enhexadecimal:0x84,0x00,0x70,0x2E
endecimal: 132, 0, 112, 46
Servomotores
En el caso ms sencillo, la relacin Espacio de actuador vs.
Espacio articular es una funcin lineal que se puede conocer si se
realizar una tabla y usar ajuste de curva (Ej. Mnimos cuadrados).
Valoractuador(x) q
1
[] q
2
[] q
n
[]
0x000
0x001

0xFFF
( )
i i i i
q f x m x b = = +
MotoresdeCD
SimpleHighPowerMotorController18v25
MotoresdeCD
Protocolocompacto
Elpaquetedeprotocolodecomandoscompactoessimplemente:
Porejemplo,siqueremosestablecerlavelocidaddelmotora3200(altavelocidad)
haciaeladelante,podraenviarlasecuenciadebytessiguientes:
Hexagonaldelanotacin:0x85,0x00,0x64
Notacindecimal:133,0,100
El0x85byteeselcomandoAjustedelmotorhaciaadelante,ylosdosltimos
bytescontienenlavelocidad.
ActuadoresDynamixel
GoalPosition
Itisapositionvalueofdestination.
0to1023(0x3FF)isavailable. Theunitis0.29degree.
IfGoalPositionisoutoftherange,AngleLimitErrorBit(Bit1)ofStatusPacketis
returnedas1andAlarmistriggeredassetinAlarmLED/Shutdown.