INTELIGENCIA ARTIFICIAL Cinemática Directa Mg. Samuel Oporto Díaz

Tabla de Contenido INTRODUCION DEMOS ORGANIZACIÓN FUNCIONAL PARTES DE UN ROBOT TIPOS DE ARTICULACIONES APLICACIONES DE LA ROBÓTICA BIBLIOGRAFIA

Objetivos Al final del curso el alumnos estará en capacidad de: Describir y analizar movimientos rígidos. Describir las ecuaciones cinemáticas de un manipulador y operar con los resultados de las ecuaciones. Resolver problemas de cinemática inversa

REPRESENTACION DE POSICION Y ORIENTACION EN EL ESPACIO

Orientación de los ejes en 3-D Regla de la mano derecha X Z Y Z Y X Z Y X

Ejercicio 1 Para los siguientes sistemas de referencia, indique la orientación de los ejes (el lado positivo). Y X Z X Y Z

Sistema de Referencia Es el sistema de coordenadas con respecto al cual se realizan los cálculos. Se hace uso del sistema de coordenadas cartesianas. {A} x y z Xi I x Pf x y z X’ {B} x Px β Pi Yi {C} Y’

Movimiento del efector final La manipulación de piezas mediante un robot implica conocer la posición del efector final y la orientación que tiene, con respecto a la base del robot. x y z x y z POSICION ORIENTACION

POSICION Una vez que se establece un sistema de coordenadas, podemos localizar cualquier punto en el espacio con un vector de posición (3x1). Se indica con un superíndice el sistema de coordenadas al cual dicho vector es referido. px py pz AP =

ORIENTACION Para describir la orientación de un cuerpo respecto de un sistema de coordenadas dado, se le asigna solidariamente a este, otro sistema de coordenadas. Luego se da la “descripción” de este sistema de coordenadas “relativa” al sistema de coordenadas de referencia. Existen varios métodos para representar la orientación: Matriz de Rotación. Ángulos de Euler (ZXZ y ZYZ) Roll, pitch y yaw. Vector -ángulo (o par de rotación). Cuaternios.

Giro en ángulo positivo Eje + θ +

ORIENTACION

ORIENTACION La orientación de B con respecto a A es representado por: Z θ Y θ

Coordenadas Homogéneas Las matrices que indican la posición y orientación de un espacio no es suficiente para describir un espacio. Por lo que es necesario incluir algunos conceptos adicionales. La nueva matriz incluye la perspectiva y la escala. T = = R3x3 p3x1 f1x3 w1x1 Rotación Traslación Perspectiva Escalado

TRANSFORMACION DE COORDENADAS

TRASLACION Cómo expresar la traslación de sistemas de coordenadas: Sea el espacio {B} que se desplaza P con respecto al espacio {A} XB YB ZB {B} XA YA ZA {A} P 1 0 0 px 0 1 0 py 0 0 1 pz 0 0 0 1 A B T =

Ejercicio 2 Sea el espacio {A} y el vector AP = [2 3 4]T. Indique la matriz de transformación para trasladar el espacio {A} en una distancia dada por el ventor P. Esta matriz permite trasladar cualquier punto en el espacio {B} hacia el espacio {A}. Indique la ubicación, en el espacio {A} de los siguientes puntos dados en el espacio {B}. [1 2 3]T, [3 4 5]T, [3 2 1]T Indique la ubicación, en el espacio {B} de los siguientes puntos dados en el espacio {A}. [1 2 2]T, [3 3 5]T, [3 2 2]T

Ejercicio 2 Matriz de transformación de B hacia A. = T = = = 1 2 3 1 0 0 2 0 1 0 3 0 0 1 4 0 0 0 1 5 7 = 1 0 0 2 0 1 0 3 0 0 1 4 0 0 0 1 A B T = 3 4 5 1 1 0 0 2 0 1 0 3 0 0 1 4 0 0 0 1 7 9 = 3 2 1 1 0 0 2 0 1 0 3 0 0 1 4 0 0 0 1 5 =

Ejercicio 2 Matriz de transformación de A hacia B. = T = = = 1 2 3 1 0 0 2 0 1 0 3 0 0 1 4 0 0 0 1 5 7 = 1 0 0 -2 0 1 0 -3 0 0 1 -4 0 0 0 1 B A T = 3 4 5 1 1 0 0 2 0 1 0 3 0 0 1 4 0 0 0 1 7 9 = 3 2 1 1 0 0 2 0 1 0 3 0 0 1 4 0 0 0 1 5 =

Ejercicio 3 Cierto sistema, se traslada en P1, luego se traslada en P2 y luego en P3, para obtener finalmente el sistema {B}. P1 = [-3, 3, 2]T, P2 = [2, 4 -1]T, P3 = [0, -2, 4]T Indique la ubicación, en el espacio {A} de los siguientes puntos dados en el espacio {B}. [1 2 3]T, [3 4 5]T, [3 2 1]T Indique la ubicación, en el espacio {B} de los siguientes puntos dados en el espacio {A}. [-1 2 3]T, [2 2 2]T, [3 -2 1]T

ROTACION Cómo expresar la rotación de coordenadas. Se implementará la función R( eje, ángulo) La función indica la orientación del nuevo sistema de referencia con respecto al primero, cuando se rota cierto eje en cierto ángulo. La rotación positiva se considera tomando en consideración la regla de la mano derecha.

Rotación en el eje X Definir las matrices de rotación para los ejes X, Y, Z

Ejercicio 4 El sistema {A}, se rota 60º, alrededor del eje Z, calcule la ubicación en el sistema {A} del punto P = [2, 3, 4]T, dado en el sistema {B}

Ejercicio 4 Y X 60º 60º cπ/3 -sπ/3 0 0 cπ/3 cπ/3 0 0 0 0 1 0 0 0 0 1 Z Y Y 60º X 60º cπ/3 -sπ/3 0 0 cπ/3 cπ/3 0 0 0 0 1 0 0 0 0 1 cπ/3 -sπ/3 0 0 cπ/3 cπ/3 0 0 0 0 1 0 0 0 0 1 Rot(z, π/3) =

Ejercicio 5 El sistema {A}, se rota 60º, alrededor del eje X, luego 60º alrededor del eje Y y luego 60º alrededor del eje Z. Calcule la ubicación en el sistema {A} del punto P = [2, 3, 4]T, dado en el sistema {B}

Bibliografía John Craig, “Introduction to robotics,” Addison Wesley. G. Dudek and M. Jenkin, “Computational Principles of Mobile Robotics,” Cambridge University Press.

PREGUNTAS