iar234 robótica unidad 02: fundamentos matemÁticos y fÍsicos. (1 ra parte)

45
IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Upload: sarita-gongora

Post on 07-Feb-2015

15 views

Category:

Documents


5 download

TRANSCRIPT

Page 1: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

IAR234Robótica

UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS.

(1ra parte)

Page 2: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Contenidos1. Descripción de la posición: coordenadas cartesianas,

cilíndricas y esféricas2. Descripción de la orientación y matrices asociadas. 3. Traslación y rotación.4. Velocidad, aceleración momento de inercia, centro de masa

y tensor de inercia. 5. Cinemática del robot: cinemática directa e inversa.6. Cinemática del movimiento.7. Fuerzas que actúan sobre el robot y equilibrio.8. Dinámica del robot: métodos de Lagrange y de Newton-Euler9. Ejercicios sobre dinámica de robots.

Primavera-2008 Dr. Juan José Aranda Aboy 2

Page 3: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Objetivos específicos

• Explicar el funcionamiento de la arquitectura de un robot y de las partes que integran esa arquitectura.

Primavera-2008 Dr. Juan José Aranda Aboy 3

Page 4: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Localización espacial del robot

• La necesidad de manipular piezas demanda el movimiento espacial del extremo del robot, lo que muestra la necesidad de disponer de herramientas matemáticas para especificar la posición y orientación de dicho extremo.

• Por nuestros estudios previos, conocemos que podemos representar una posición en el espacio empleando un sistema de coordenadas, siendo comunes el cartesiano y el polar.

Primavera-2008 Dr. Juan José Aranda Aboy 4

Page 5: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Representación espacial: Posición

• Se establece un sistema de coordenadas con el cual podemos localizar cualquier punto en el espacio mediante un vector de posición (3x1).

• Se indica con un superíndice el sistema de coordenadas al cual dicho vector es referido.

Primavera-2008 Dr. Juan José Aranda Aboy 5

Page 6: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Representación de la posición en coordenadas cartesianas

Primavera-2008 Dr. Juan José Aranda Aboy 6

Page 7: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Representación de la posición en coordenadas polares/cilíndricas

Primavera-2008 Dr. Juan José Aranda Aboy 7

Page 8: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Representación de la posición en coordenadas esféricas

• Otra alternativa 3D son las coordenadas esféricas:

Primavera-2008 Dr. Juan José Aranda Aboy 8

Page 9: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Orientación• 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:

Primavera-2008 Dr. Juan José Aranda Aboy 9

Page 10: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Descripción de la orientación relativa• Luego se da la “descripción” de este sistema de

coordenadas “relativa” al sistema de coordenadas de referencia.

• Existen varios métodos para representar orientaciones:– Matriz de Rotación.– Ángulos de Euler (ZXZ y ZYZ)– Roll, pitch and yaw.– Par de rotación (o Vector - ángulo).– Cuaternios: Para describir la orientación de un cuerpo

respecto de un sistema de coordenadas dado.

Primavera-2008 Dr. Juan José Aranda Aboy 10

Page 11: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Representación de la orientación.Matrices de Rotación 2D• La orientación de un objeto respecto a una referencia se

realiza empleando una matriz.• Una matriz de rotación es ortonormal: R-1=RT

Primavera-2008 Dr. Juan José Aranda Aboy 11R es conocida como matriz de cosenos directores

Page 12: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Matrices de Rotación 3D (1)

Primavera-2008 Dr. Juan José Aranda Aboy 12

Page 13: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Matrices de Rotación 3D (2)

Primavera-2008 Dr. Juan José Aranda Aboy 13

Page 14: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Composición de rotaciones

Orden de la composición:1.Rotación sobre OX2.Rotación sobre YO3.Rotación sobre OZ

Primavera-2008 Dr. Juan José Aranda Aboy 14

Page 15: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Ángulos de Euler

1. Girar el sistema OUVW un ángulo con respecto al eje OZ, convirtiéndose así en el OU'V'W'.

2. Girar el sistema OU'V'W' un ángulo con respecto al eje OU', convirtiéndose así en el OU''V''W''.

3. Girar el sistema OU''V''W'' un ángulo respecto al eje OW'‘ convirtiéndose finalmente en el OU'''V'''W'''

Primavera-2008 Dr. Juan José Aranda Aboy 15

Page 16: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Roll, Pitch y Yaw1. Girar el sistema OUVW

un ángulo con respecto al eje OX. (Yaw)

2. Girar el sistema OUVW un ángulo con respecto al eje OY. (Pitch)

3. Girar el sistema OUVW un ángulo con respecto al eje OZ. (Roll)

Primavera-2008 Dr. Juan José Aranda Aboy 16

Page 17: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Par de rotación

• Mediante la definición de un vector k (kx,ky.kz) y un ángulo de giro , tal que el sistema OUVW corresponde al sistema OXYZ girado un ángulo sobre el eje k

Primavera-2008 Dr. Juan José Aranda Aboy 17

Page 18: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Cuaternios• Alta eficiencia computacional• Utilizados por algunos fabricantes de robots (ABB)

Q=[q0,q1,q2,q3]=[s,v]

• Giro de un ángulo 2 sobre el vector k:

Primavera-2008 Dr. Juan José Aranda Aboy 18

Page 19: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Coordenadas homogéneas

• Coordenadas de un espacio (n+1)-dimensional para representar sólidos en el espacio n-dimensional.p(x,y,z) p(wx,wy,wz,w) con w=factor de escala

• Vector en coordenadas homogéneas:

• Ejemplo: 2i+3j+4k [4,6,8,2]T ó [-6,-9,-12,-3]T

• Vector nulo:[0,0,0,n]T

Primavera-2008 Dr. Juan José Aranda Aboy 19

Page 20: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Matrices de transformación homogénea• Matriz 4x4 que representa la transformación de un vector en

coordenadas homogéneas de un sistema de coordenadas a otro.

R3x3: matriz de rotación

p3x1: vector de traslación

f1x3: transformación de perspectiva

w1x1: escalado global (1)

Primavera-2008 Dr. Juan José Aranda Aboy 20

Page 21: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Aplicación de las matrices de transformación homogénea

• Representar la posición y orientación de un sistema girado y trasladado O'UVW con respecto a un sistema fijo de referencia OXYZ., que es lo mismo que representar una rotación y traslación realizada sobre un sistema de referencia.

• Transformar un vector expresado en coordenadas con respecto a un sistema O'UVW, a su expresión en coordenadas del sistema de referencia OXYZ.

• Rotar y trasladar un vector con respecto a un sistema de referencia fijo OXYZ.

Primavera-2008 Dr. Juan José Aranda Aboy 21

Page 22: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Traslación con matrices homogéneas

• Matriz básica de traslación:

• Cambio de sistema de coordenadas:

Primavera-2008 Dr. Juan José Aranda Aboy 22

Page 23: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Ejemplo de traslación (1)• Según la figura el sistema O'UVW está trasladado un

vector p(6,-3,8) con respecto del sistema OXYZ. • Calcular las coordenadas (rx , ry ,rz) del vector r cuyas

coordenadas con respecto al sistema O'UVW son ruvw(-2,7,3)

Primavera-2008 Dr. Juan José Aranda Aboy 23

Page 24: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Ejemplo de traslación (2)

• Calcular el vector r’xyz resultante de trasladar al vector rxyz(4,4,11) según la transformación T(p) con p(6,-3,8)

Primavera-2008 Dr. Juan José Aranda Aboy 24

Page 25: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Rotación con matrices homogéneas

• Matrices de rotación básicas:

• Cambio de sistema de coordenadas:

Primavera-2008 Dr. Juan José Aranda Aboy 25

Page 26: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Ejemplo de rotación

• Según la figura el sistema OUVW se encuentra girado -90º alrededor del eje OZ con respecto al sistema OXYZ.

• Calcular las coordenadas del vector rxyz si ruvw = [4,8,12]T

Primavera-2008 Dr. Juan José Aranda Aboy 26

Page 27: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Combinación de rotaciones y traslaciones (1)• Es posible combinar rotaciones y traslaciones básicas

multiplicando las matrices correspondientes• El producto NO es conmutativo:

rotar y trasladar ≠ trasladar y rotar

Primavera-2008 Dr. Juan José Aranda Aboy 27

Page 28: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

• Rotación seguida de traslación:

• Traslación seguida de rotación:

Combinación de rotaciones y traslaciones (2)

Primavera-2008 Dr. Juan José Aranda Aboy 28

Page 29: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Ejemplo de combinación traslación-rotación (1)• Un sistema OUVW ha sido girado 90º alrededor del

eje OX y posteriormente trasladado un vector p(8,-4,12) con respecto al sistema OXYZ.

• Calcular las coordenadas (rx ,ry ,rz) del vector r con coordenadas ruvw (-3,4,-11)

Primavera-2008 Dr. Juan José Aranda Aboy 29

Page 30: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Ejemplo de combinación traslación-rotación (2)• Un sistema OUVW ha sido trasladado un vector p(8,-

4,12) con respecto al sistema OXYZ y girado 90º alrededor del eje OX.

• Calcular las coordenadas (rx , ry , rz) del vector r de coordenadas ruvw (-3,4,-11)

Primavera-2008 Dr. Juan José Aranda Aboy 30

Page 31: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Significado geométrico de las matrices homogéneas

n,o,a: terna ortonormal que representa la orientaciónp: vector que representa la posición||n||=||o||=||a||=1n x o = a[n o a]-1=[n o a]T

Primavera-2008 Dr. Juan José Aranda Aboy 31

Page 32: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Inversa de una matriz de transformación homogénea

Primavera-2008 Dr. Juan José Aranda Aboy 32

Page 33: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Composición de matrices homogéneas (1)• Una transformación compleja puede descomponerse

en la aplicación consecutiva de transformaciones simples: giros básicos y traslaciones.

• Una matriz que representa un giro de un ángulo a sobre el eje OX, seguido de un giro de ángulo sobre el eje OY y de un giro de un

• ángulo sobre el eje OZ, puede obtenerse por la composición de las matrices básicas de rotación:

Primavera-2008 Dr. Juan José Aranda Aboy 33

Page 34: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Composición de matrices homogéneas (2)

Primavera-2008 Dr. Juan José Aranda Aboy 34

Page 35: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Criterios de composición de matrices homogéneas• Si el sistema fijo OXYZ y el sistema transformado O'UVW son

coincidentes, la matriz homogénea de transformación será la matriz 4 x 4 unidad, I4

• Si el sistema O'UVW se obtiene mediante rotaciones y traslaciones definidas con respecto al sistema fijo OXYZ, la matriz homogénea que representa cada transformación se deberá premultiplicar sobre las matrices de las transformaciones previas.

• Si el sistema O'UVW se obtiene mediante rotaciones y traslaciones definidas con respecto al sistema móvil, la matriz homogénea que representa cada transformación se deberá postmultiplicar sobre las matrices de las transformaciones previas.

Primavera-2008 Dr. Juan José Aranda Aboy 35

Page 36: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Ejemplo de composición de matrices homogéneas (1)

PREMULTIPLICACIÓN• Obtener la matriz de transformación que representa

al sistema O'UVW obtenido a partir del sistema OXYZ mediante un giro de ángulo -90º alrededor del eje OX, de una traslación de vector pxyz(5,5,10) y un giro de 90º sobre el eje OZ:

Primavera-2008 Dr. Juan José Aranda Aboy 36

Page 37: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Ejemplo de composición de matriceshomogéneas (2)

POSMULTIPLICACIÖN• Obtener la matriz de transformación que representa las

siguientes transformaciones sobre un sistema OXYZ fijo de referencia: – traslación de un vector pxyz(-3,10,10);

– giro de -90º sobre el eje O'U del sistema trasladado y – giro de 90º sobre el eje O'V del sistema girado

Primavera-2008 Dr. Juan José Aranda Aboy 37

Page 38: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Gráficos de transformación

Primavera-2008 Dr. Juan José Aranda Aboy 38

Page 39: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Comparación entre métodos de localización espacial

Primavera-2008 Dr. Juan José Aranda Aboy 39

Page 40: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Descripción de “frame”

• La información necesaria para especificar completamente la ubicación del efector final (o cualquier elemento) de un manipulador puede definirse por medio de un “Frame”: Conjunto de 4 vectores que dan información de posición y orientación.

Primavera-2008 Dr. Juan José Aranda Aboy 40

Page 41: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Mapeos: cambiando la descripción de un frame a otro

• Mapeos sobre frames trasladados de igual orientación:

Primavera-2008 Dr. Juan José Aranda Aboy 41

Page 42: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Mapeos: cambiando la descripción de un frame a otro

• Mapeos sobre frames rotados sin traslación:

Primavera-2008 Dr. Juan José Aranda Aboy 42

Page 43: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Mapeo general: Traslación + Rotación

Primavera-2008 Dr. Juan José Aranda Aboy 43

Page 44: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Referencias de archivos en .PDF

• Fundamentos de Robótica (Cap3, p49 (57 de 314))• curso_biom_ar/Cap_2_2007• curso_umh_es/Tema3• upm_disam_es/Herramientas matemáticas• robotica/Apuntes de Robotica (Tema 2, 18 de 177)• robots_springer_2008/07_PositionOrientation y

08_EulerRPYHomogeneous

Primavera-2009 Dr. Juan José Aranda Aboy 44

Page 45: IAR234 Robótica UNIDAD 02: FUNDAMENTOS MATEMÁTICOS Y FÍSICOS. (1 ra parte)

Sitios en Internet

• http://www.worldrobotics.org/• ISO 25.040.30: Industrial robots. Manipulators• INDUSTRIAL ROBOTS AND ROBOT SYSTEM SAFETY • Academic Websites • The Robotics WEBook• ROBOTICA I - Curso 2004-05

Primavera-2009 Dr. Juan José Aranda Aboy 45