Documentos de Académico
Documentos de Profesional
Documentos de Cultura
CinematicaInversaRobot PDF
CinematicaInversaRobot PDF
Robot
CI-2657 Robtica
M.Sc. Kryscia Ramrez Benavides
Introduccin
CI-2657 Robtica
6
Cinemtica Inversa del Robot
Cinemtica Inversa (cont.)
CI-2657 Robtica
7
Cinemtica Inversa del Robot
Cinemtica Inversa (cont.)
CI-2657 Robtica
8
Cinemtica Inversa del Robot
Cinemtica Inversa (cont.)
CI-2657 Robtica
10
Cinemtica Inversa del Robot
Cinemtica Inversa (cont.)
CI-2657 Robtica
11
Cinemtica Inversa del Robot
Cinemtica Inversa (cont.)
Este tipo de solucin presenta las siguientes
ventajas:
En muchas aplicaciones, el problema cinemtico
inverso se debe resolver en tiempo real (por ejemplo,
seguir una determinada trayectoria). Una solucin de
tipo iterativo no garantiza tener la solucin en el
momento adecuado.
Al contrario de lo que ocurra en el problema
cinemtico directo, con cierta frecuencia la solucin
del problema cinemtico inverso no es nica;
existiendo diferentes n-tuplas(q1,...,qn)exp T que
posicionan y orientan el extremo del robot del mismo
modo. En estos casos una solucin cerrada permite
incluir determinadas reglas o restricciones que
aseguren que la solucin obtenida sea la ms
adecuada posible.
CI-2657 Robtica
12
Cinemtica Inversa del Robot
Cinemtica Inversa (cont.)
CI-2657 Robtica
13
Cinemtica Inversa del Robot
Cinemtica Inversa (cont.)
CI-2657 Robtica
14
Cinemtica Inversa del Robot
Cinemtica Inversa (cont.)
CI-2657 Robtica
15
Cinemtica Inversa del Robot
Cinemtica Inversa (cont.)
Solucin: Conjunto de variables articulares que
permiten posicionar el elemento terminal en una
determinada posicin y orientacin.
No existen algoritmos generales de solucin al
problema de cinemtica inversa.
Tipos de solucin:
Mtodos geomtricos: Se suele utilizar para las
primeras variables articulares, uso de relaciones
geomtricas y trigonomtricas.
Por matrices de transformacin homognea:
Despejar las n variables qi en funcin de los
componentes de los vectores n, o, a y p.
Desacoplamiento cinemtico: En robots de 6DOF,
separacin de orientacin y posicionamiento.
Soluciones numricas (iterativas): No aplicables
en tiempo real.
CI-2657 Robtica
16
Cinemtica Inversa del Robot
Introduccin
IntroduccinaaRobtica
Robtica
Mtodos Geomtricos
Identidades trigonomtricas:
http://es.wikipedia.org/wiki/Identidades_trig
onom%C3%A9tricas
CI-2657 Robtica
19
Cinemtica Inversa del Robot
Mtodos Geomtricos (cont.)
CI-2657 Robtica
20
Cinemtica Inversa del Robot
Mtodos Geomtricos (cont.)
CI-2657 Robtica
21
Cinemtica Inversa del Robot
Mtodos Geomtricos (cont.)
CI-2657 Robtica
22
Cinemtica Inversa del Robot
Mtodos Geomtricos (cont.)
CI-2657 Robtica
Cinemtica Inversa del Robot 23
Mtodos Geomtricos (cont.)
CI-2657 Robtica
24
Cinemtica Inversa del Robot
Mtodos Geomtricos (cont.)
CI-2657 Robtica
25
Cinemtica Inversa del Robot
Introduccin
IntroduccinaaRobtica
Robtica
Matriz de Transformacin
Homognea
CI-2657 Robtica
27
Cinemtica Inversa del Robot
Matriz de Transformacin Homognea
(cont.)
Sin embargo, en la prctica esta tarea no es
trivial siendo en muchas ocasiones tan
compleja que obliga a desecharla.
Adems, puesto que el problema cinemtico
directo, resuelto a travs de Tij contiene en el
caso de un robot de 6DOF 12 ecuaciones, y se
busca solo 6 relaciones (una por cada grado de
libertad), existir, necesariamente ciertas
dependencias entre las 12 expresiones de partida
con lo cual la eleccin de las ecuaciones debe
hacerse con sumo cuidado.
CI-2657 Robtica
28
Cinemtica Inversa del Robot
Matriz de Transformacin Homognea
(cont.)
Se va a aplicar este procedimiento al robot
de 3DOF de configuracin esfrica (2 giros y
un desplazamiento).
El robot queda siempre contenido en un
plano determinado por el ngulo q1.
CI-2657 Robtica
29
Cinemtica Inversa del Robot
Matriz de Transformacin Homognea
(cont.)
El primer paso a dar para resolver el
problema cinemtico inverso es obtener Tij
correspondiente a este robot.
Es decir, obtener la matriz T que relaciona el
sistema de referencia (S0) asociado a la base con
el sistema de referencia (S3) asociado a su
extremo.
A continuacin se muestra la asignacin de
sistemas de referencia segn los criterios de
DH con el robot situado en su posicin de
partida (q1 = q2 = 0), y los valores de los
parmetros de DH.
CI-2657 Robtica
30
Cinemtica Inversa del Robot
Matriz de Transformacin Homognea
(cont.)
A partir de esto es inmediato obtener las
matrices A y la matriz T.
Obtenida la expresin de T en funcin de las
coordenadas articulares (q1, q2, q3), y
supuesta una localizacin de destino para el
extremo del robot definida por los vectores
n, o, a y p, se podra intentar manipular
directamente las 12 ecuaciones resultantes
de T a fin de despejar q1, q2 y q3 en funcin
de n, o, a y p.
CI-2657 Robtica
31
Cinemtica Inversa del Robot
Matriz de Transformacin Homognea
(cont.)
Sin embargo, este procedimiento directo es
complicado, apareciendo ecuaciones
trascendentes.
En lugar de ello, suele ser ms adecuado
aplicar el siguiente procedimiento:
Puesto que T = 0A1(1A2)(2A3), se tendr que:
(1/0A1)T = 1A2(2A3)
(1/1A2)(1/0A1)T = 2A3
CI-2657 Robtica
32
Cinemtica Inversa del Robot
Matriz de Transformacin Homognea
(cont.)
0 sen i cos i di
0 0 0 1
Como es sabido, la inversa es la transpuesta
cos i sen i 0 ai
cos sen cos cos sen d sen
i
Ai 1 = i i i i i i i
CI-2657 Robtica
33
Cinemtica Inversa del Robot
Matriz de Transformacin Homognea
(cont.)
[xi,yi,zi] = Matriz de orientacin del sistema de
coordenadas i-simo establecido en el elemento i
con respecto al sistema de coordenadas de la base.
Es la matriz particionada superior izquierda 3x3 de
0Ti.
pi = Vector de posicin que apunta desde el origen
del sistema de coordenadas de la base hasta el
origen del sistema de coordenadas i-simo. Es la
matriz particionada superior derecha 3x1 de 0Ti.
CI-2657 Robtica
34
Cinemtica Inversa del Robot
Matriz de Transformacin Homognea
(cont.)
Para i = 6, se tiene la siguiente matriz T:
CI-2657 Robtica
36
Cinemtica Inversa del Robot
Matriz de Transformacin Homognea
(cont.)
CI-2657 Robtica
37
Cinemtica Inversa del Robot
Matriz de Transformacin Homognea
(cont.)
CI-2657 Robtica
38
Cinemtica Inversa del Robot
Introduccin
IntroduccinaaRobtica
Robtica
Desacoplamiento Cinemtico
CI-2657 Robtica
40
Cinemtica Inversa del Robot
Desacoplamiento Cinemtico (cont.)
CI-2657 Robtica
41
Cinemtica Inversa del Robot
Desacoplamiento Cinemtico (cont.)
CI-2657 Robtica
42
Cinemtica Inversa del Robot
Desacoplamiento Cinemtico (cont.)
CI-2657 Robtica
43
Cinemtica Inversa del Robot
Desacoplamiento Cinemtico (cont.)
CI-2657 Robtica
44
Cinemtica Inversa del Robot
Desacoplamiento Cinemtico (cont.)
CI-2657 Robtica
45
Cinemtica Inversa del Robot
Desacoplamiento Cinemtico (cont.)
CI-2657 Robtica
46
Cinemtica Inversa del Robot
Desacoplamiento Cinemtico (cont.)
CI-2657 Robtica
47
Cinemtica Inversa del Robot
Desacoplamiento Cinemtico (cont.)
CI-2657 Robtica
50
Cinemtica Inversa del Robot
Desacoplamiento Cinemtico (cont.)
CI-2657 Robtica
51
Cinemtica Inversa del Robot
Desacoplamiento Cinemtico (cont.)
CI-2657 Robtica
52
Cinemtica Inversa del Robot
Desacoplamiento Cinemtico (cont.)
CI-2657 Robtica
53
Cinemtica Inversa del Robot
Cinemtica Directa vs. Cinemtica
Inversa
CI-2657 Robtica
54
Cinemtica Inversa del Robot
Referencias Bibliogrficas
Fu, K.S.; Gonzlez, R.C. y Lee, C.S.G. Robotics:
Control, Sensing, Vision, and Intelligence.
McGraw-Hill. 1987.
Cinemtica. URL:
http://proton.ucting.udg.mx/materias/robotica/r
166/r78/r78.htm.
Martnez A. G. M.; Jquez O. S. A.; Rivera M. J.
y Sandoval R. R. Diseo propio y Construccin
de un Brazo Robtico de 5 GDL. URL:
http://antiguo.itson.mx/rieeandc/vol4p1_archivo
s/Art2Junio08.pdf.
ROBOLAB. URL:
http://www.aurova.ua.es/robolab/ejsSystem.ht
m.