Professional Documents
Culture Documents
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
E.U.I.T. Industrial Profesor: Miguel Hernando Gutirrez & Cecilia Garca Cena
Robtica
Tema 6. Modelo Cinemtico Diferencial
1
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
Resumen
2
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
Objetivos
3
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
Contenido
6.1 Justificacin
6.2 Definicin del Espacio de Trabajo
6.3 Definicin y Calculo del Jacobiano
6.4 Definicin de Configuraciones Singulares
6.5 Manipulabilidad. Elipsoides de velocidad y fuerza
6.6 Ejemplo
Bibliografa
4
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
6.1 Justificacin
En robtica es de inters encontrar la relacin a entre las coordenadas
articulares y la posicin espacial del extremo operativo (modelo cinemtico
directo) y adems:
o La relacin entre las velocidades articulares y las
velocidades del extremo operativo, esto es:
v
q&i
f
n i
Estas dos relaciones estn basadas en un operador lineal matricial denominado
Jacobiano del Robot
5
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
6.1 Justificacin
La Matriz Jacobiana se utiliza con varios objetivos:
6
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
Contenido
6.1 Justificacin
6.2 Definicin del Espacio de Trabajo
6.3 Definicin y Calculo del Jacobiano
6.4 Definicin de Configuraciones Singulares
6.5 Manipulabilidad. Elipsoides de velocidad y fuerza
6.6 Ejemplo
Bibliografa
7
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
8
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
El espacio de trabajo del robot sin considerar la mueca viene dado por el
fabricante.
pe = pe ( q ) qi _ min qi qi _ max
pe ( q )
es una funcin continua, el volumen descrito es una superficie planar, esfrica,
cilndrica o toroidal dependiendo de si la junta es de revolucin o prismtica.
9
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
Contenido
6.1 Justificacin
6.2 Definicin del Espacio de Trabajo
6.3 Definicin y Calculo del Jacobiano
6.4 Definicin de Configuraciones Singulares
6.5 Cinemtica Diferencial Inversa
6.6 Manipulabilidad. Elipsoides de velocidad y fuerza
6.7 Ejemplo
Bibliografa
10
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
Esta relacin est dada por una matriz, denominada Matriz Jacobiana Geomtrica,
que depende exclusivamente de la configuracin del robot.
11
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
R ( q ) p ( q )
T=
0 1
12
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
p& ( t ) = J P ( q ) q& J P 3n
( t ) = J O ( q ) q& J O 3n
O bien:
p& ( t ) J P ( q )
v= = q&
( t ) J O ( q )
f r ( q )
J= 6n Jacobiana geomtrico
q
13
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
n f x ( q )
x& =
i =1 q i n x ox a x px
n oR ap p y
n f y ( q ) =
T=T y
0y 1y
y& = n z o z a z pz
i =1 q i
0 1
n
f z ( q )
z& =
i =1 q i
14
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
n x ox a x px
n o Ra p p
T= T y
= y y y
n z oz 0 a z 1 pz
0 1
15
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
& T + RR
RR &T =0
Se define como:
& T
= RR &T
T = RR
T + = 0
16
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
0 z y
= z 0 x
y x 0
Por lo tanto, para obtener las velocidades angulares (wx, wy, wz) a partir de las
velocidades articulares (q1,q2,.,qn) , debe calcularse la derivada de R tal
como se ha indicado.
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
n f y ( q )
y& = = ( l3c12 + l2 c1 ) q& 1 + l3c12 q& 2
i =1 qi
( l3s12 + l2 s1 ) l3s12 0 0
n f z ( q )
z& = = q& 3 J P = l3 c12 + l2 c1 l3c12 0 0
qi
i =1
0 0 1 0
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
c124 s124 0
R = s124 c124 0
0 0 1
& dR dR dR dR
R= q1 +
& q2 +
& q3 +
& q& 4
dq1 dq 2 dq 3 dq 4
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
c124 s124 0
& = dR q& + dR q& + dR q& + dR q&
R = s124 c124 0 R
dq1
1
dq 2
2
dq 3
3
dq 4
4
0 0 1
s124 c124 0
& =c
R s124 0 ( q& 1 + q& 2 + q& 4 )
124
0 0 0
T
s124 c124 0 c124 s124 0
& T = ( q& + q& + q& ) c
= RR s124 0 s124 c124 0
1 2 4 124
0 0 0 0 0 1
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
0 0 0 0 0 1
0 1 0
& T = ( q& + q& + q& ) 1
= RR 0 0
1 2 4
0 0 0
0 z y 0 1 0
= z 0 x = 1 0 0 1 2 4
y x 0 0 0 0
0 0 0 0
x = 0
J 0 = 0 0 0 0
y = 0
z = q& 1 + q& 2 + q& 4
1 1 0 1
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
0 0 0 0 ( l3s12 + l2 s1 ) l3s12 0 0
J 0 = 0 0 0 0
l3c12 + l2 c1 l3c12 0 0
1 1 0 1 0 0 -1 0
J=
0 0 0 0
0 0 0 0
1 1 0 1
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
Contenido
6.1 Justificacin
6.2 Definicin del Espacio de Trabajo
6.3 Definicin y Calculo del Jacobiano
6.4 Singularidades
6.5 Cinemtica Diferencial Inversa
6.6 Manipulabilidad. Elipsoides de velocidad y fuerza
6.7 Ejemplo
Bibliografa
24
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
6.4 Singularidades
La matriz Jacobiana define un mapeo lineal entre velocidad de extremo
operativo del robot y las velocidades articulares
v = Jq&
donde
J = f (q)
En aquellas configuraciones donde se cumple que:
6.4 Singularidades
6.4 Singularidades
6.4.1 Clasificacin de las Singularidades
Singularidades de Contorno
Son aquellas en la que el robot adopta o bien una postura totalmente extendida
o bien totalmente retrada. Estas singularidades no son peligrosas ya que son
evitables no llevando el manipulador a los extremos de su espacio de trabajo
alcanzable.
Singularidades Internas
6.4 Singularidades
Singularidades de contorno
Singularidad interna
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
6.4 Singularidades
Singularidad debida
al alineamiento de
los ejes 4 y 6
Singularidad de
Contorno
6.4 Singularidades
6.4.1 Desacoplo de Singularidades
Debido a la alta complejidad de clculo que requiere el cmputo de las
singularidades, se divide el problema en dos:
1. Hallar las singularidades del brazo robtico.
2. Hallar las singularidades del extremo operativo
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
6.4 Singularidades
6.4.1 Desacoplo de Singularidades
Si se escoge como origen del sistema de referencia del efector final el centro de
rotacin de la mueca (ejes 4, 5 y 6), la matriz Jacobiana resulta ser triangular
inferior, es decir:
J11 0
J= det ( J ) = J11J 22
J 21 J 22
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
6.4 Singularidades
6.4.1 Desacoplo de Singularidades
J11 0
J= det ( J ) = J11J 22
J 21 J 22
6.4 Singularidades
6.4.2 Ejemplo. Singularidad del robot Scara
( l s + l s ) l s 0
(l3s12 3+ 12l2s1 ) 2 1 l3s12 30 12 0
J PJ=P = l3c12l3+c12l2 c+1 l 2 c1 l3c12 l3 c012 0 0
0 0 0 - 01 0 - 1
0
q2 = q1
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
6.4 Singularidades
La Figura muestra el resultado de intentar realizar con un robot tipo SCARA, una
trayectoria en lnea recta a velocidad constante que pasa por una configuracin
singular.
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando Gutirrez & Cecilia Garca Cena
ndice de Desempao
Un ndice de desempeo de un robot es una cantidad escalar que mide
la eficiencia o la precisin de la conversin entre fuerzas y velocidades.
Sea el sistema
(1)
Donde A y B son matrices. Si existe A-1;
(2)
35 35
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando Gutirrez & Cecilia Garca Cena
ndice de Desempao
Nmero de Condicin de una Matriz:
(3)
36 36
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando Gutirrez & Cecilia Garca Cena
ndice de Desempao
Nmero de Condicin de una Matriz:
Despejando se obtiene:
O bien:
37 37
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando Gutirrez & Cecilia Garca Cena
ndice de Desempao
Nmero de Condicin de una Matriz:
38 38
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando Gutirrez & Cecilia Garca Cena
ndice de Desempao
Indice de Condicin de la Matriz Jacobiana:
De este modo:
0 1
39 39
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
Contenido
6.1 Justificacin
6.2 Definicin del Espacio de Trabajo
6.3 Definicin y Calculo del Jacobiano
6.4 Singularidades
6.5 Cinemtica Diferencial Inversa
6.6 Manipulabilidad. Elipsoides de velocidad y fuerza
6.7 Ejemplo
Bibliografa
[1] Modelling and Control of Robot Manipulator. Lorenzo
Sciavicco, Bruno Siciliano. ISBN: 1852332212
[2] Introduction to Robotics. Mechanics and Control. Jhon
Craig. Addison Wesley. ISBN 0201543613
40
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
Si rang ( J ) = n
v = Jq& q& =J 1 v
t . .
q = q ( ) d + q ( 0 )
0
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
v = J q&
J =J
T
( JJ )T 1
Propiedades de la pseudo-inversa:
J JJ = J
JJ J = J
( JJ ) = JJ
T
(J J) = J J
T
(J ) = J
(J ) = (J )
T T
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
Contenido
6.1 Justificacin
6.2 Definicin del Espacio de Trabajo
6.3 Definicin y Calculo del Jacobiano
6.4 Singularidades
6.5 Cinemtica Diferencial Inversa
6.6 Manipulabilidad. Elipsoides de velocidad y fuerza
6.7 Ejemplo
Bibliografa
[1] Modelling and Control of Robot Manipulator. Lorenzo
Sciavicco, Bruno Siciliano. ISBN: 1852332212
[2] Introduction to Robotics. Mechanics and Control. Jhon
Craig. Addison Wesley. ISBN 0201543613
43
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
6.6 Manipulabilidad
Considere que el vector de velocidad articular cumple con:
v T ( J T J ) v = 1 pero J = J T ( JJ T )
1
Entonces:
v T ( JJ T ) v = 1
1
Elipsoide
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando & Cecilia Garca Cena
6.6 Manipulabilidad
El elipsoide de manipulabilidad es una medida de cun lejos estamos de una
singularidad y cunta amplitud de movimiento es posible realizar desde una
postura.
Gran amplitud de movimiento
6.6 Manipulabilidad
El radio mayor y menor del elipsoide de manipulabilidad est determinado por el
mayor y menor autovalor de la matriz JJ T respectivamente, dado que viene
1
determinado por la inversa de los autovalores, pero i ( A ) = 1 / i ( A)
6.6 Manipulabilidad
Se define la manipulabilidad de un robot como:
m ( q ) = det ( J ( q ) J T ( q ) )
Algunas particularidades ..
6.6 Manipulabilidad
Elipsoide de Manipulabilidad de Fuerzas:
T = 1
(J F)
Sustituyendo, T
T
JTF = 1
O bien: F T ( JJ T ) F = 1
6.6 Manipulabilidad
Los ejes principales del elipsoide de manipulabilidad de fuerzas estn dados
por los autovalores y autovectores de la matriz:
( JJ )
T 1
Los autovectores de ( JJ )
T 1
son los mismos que los de ( JJ ) T
6.6 Manipulabilidad
Elipsoide de Fuerza
Elipsoide de Velocidad
Contenido
6.1 Justificacin
6.2 Definicin del Espacio de Trabajo
6.3 Definicin y Calculo del Jacobiano
6.4 Singularidades
6.5 Cinemtica Diferencial Inversa
6.6 Manipulabilidad
6.7 Ejemplo
Bibliografa
[1] Modelling and Control of Robot Manipulator. Lorenzo
Sciavicco, Bruno Siciliano. ISBN: 1852332212
[2] Introduction to Robotics. Mechanics and Control. Jhon
Craig. Addison Wesley. ISBN 0201543613
51
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando Gutirrez & Cecilia Garca Cena
6.7 Ejemplo
Recordatorio.Cmo calcular autovalores y autovectores
( 0
2 1 1
2 1 !
1 2 3
2 1 1
1 1
1 2 1
2 1 1
3 3
1 2 1
52
ASIGNATURA: Robtica
TEMA: Cinemtica Diferencial
Profesor: Miguel Hernando Gutirrez & Cecilia Garca Cena
6.7 Ejemplo
Encuentre el elipsoide de manipulabilidad de velocidad para el robot de 2 DoF en
la siguiente posicin:
0 2 v 2
q=
4
1 v1
l1s1 l 2 s12 l 2 s12
J (q ) =
l1c1 + l2 c12 l 2 c12
12 1
J (q ) =
2
1 + 2
1 1
2
1 1 +
1
J (q ) J (q )
T 2
=
1 + 12 2 + 2
- 0.3029 - 0.9530
Ejes principales: 1 v1 = 2 v2 =
- 0.1568 1.8411
53