Dpt. Teoría de la Señal, Telemática y Comunicaciones

Presentación del tema: "Dpt. Teoría de la Señal, Telemática y Comunicaciones"— Transcripción de la presentación:

1 Dpt. Teoría de la Señal, Telemática y Comunicaciones
Tema 4 PLANIFICACIÓN DE TRAYECTORIAS

2 Secciones Introducción. Trayectorias Interpoladas.
TSTC Secciones Introducción. Trayectorias Interpoladas. Trayectorias Interpoladas con Funciones polinómicas. Trayectoria Trayectorias Interpoladas con Funciones Lineales Trayectorias Cartesianas.

3 TSTC 1. Introducción. La realización de cualquier movimiento implica dos tareas: Planificación de la Trayectoria. Control del Movimiento.

4 1. Introducción. ¿En que consiste?
TSTC 1. Introducción. ¿En que consiste? Obtención de las funciones temporales 0TN(t) que nos llevan desde una localización inicial (Tini) hasta otra final (Tfin). O, alternativamente: q(t)=(q1(t), q2(t), …, qN(t)). Tipos de trayectorias: Trayectorias punto a punto: Evolución independiente de cada articulación. Sólo útiles en tareas a manipulador parado. Trayectorias continuas: 0TN(t) es conocida. Trayectorias suaves. Útiles en tareas con el brazo en movimiento.

5 Trayectorias interpoladas Trayectorias Cartesianas
TSTC 1. Introducción. Tipos de Trayectorias Continuas: Trayectorias interpoladas Trayectorias Cartesianas Control directo del movimiento en el espacio cartesiano. Ortogonalidad (separación rotación/translación) Mayor dificultad de implementación y control. Algoritmos más sencillos. Fácil control. Riesgo de choques con obstáculos.

6 2. Trayectorias Interpoladas.
TSTC 2. Trayectorias Interpoladas. Trayectorias interpoladas con funciones polinómicas. Trayectoria polinómica desde una posición inicial a otra final. Condiciones para trayectoria suave: Continuidad en la velocidad. Grado del polinomio (t) menor posible.

7 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas.
TSTC 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas. Condiciones a satisfacer: 4 ! polinomio de grado 3. Aplicando las (4) condiciones de contorno:

8 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas.
TSTC 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas. Ejemplo: 0 = 15º, f = 75º, tf = 3 seg.

9 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas.
TSTC 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas. Es conveniente dar puntos intermedios (¿Por qué?). Podemos emplear un polinómio cúbico para cada segmento y replicar el método. Discusión del caso anterior: 0 = 15º, 1 = 75º, f = 135º, t01 = 3 seg, t1f = 3 seg.

10 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas.
TSTC 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas. Trayectorias con varios segmentos: Recorrido por secuencia varias posiciones intermedias. Cada segmento emplea un polinómio cúbico. Se garantiza continuidad en la posición y velocidad. Ventajas e inconvenientes.

11 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas.
TSTC 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas. Inconvenientes: No se asegura la continuidad en la aceleración. Problema mayor: fijar las velocidades intermedias. Solución: intercambio de las restricciones anteriores. No se indica velocidad en los puntos intermedios. A cambio se asegura la continuidad en la aceleración.

12 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas.
TSTC 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas. Caso sencillo con dos segmentos [0, v, g]: Nótese los intervalos de tiempo. Condiciones impuestas: Recorrer los puntos inicial, final e intermedio:

13 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas.
TSTC 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas. Velocidades (nulas en este caso) en los extremos: Continuidad en la posición, velocidad y aceleración en el punto intermedio: Nótese que no exigimos un valor concreto en la velocidad, pero sí continuidad en la aceleración. Segmento Segmento 2 !?

14 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas.
TSTC 2.1. Trayectorias Interpoladas. Uso de funciones polinómicas. Solución (tf1 = tf2 = tf): Avances: Ajuste de tiempo favorable para resolver ecuaciones. Introducir continuidad en aceleración para no definir velocidades intermedias.

15 2. Trayectorias Interpoladas.
TSTC 2. Trayectorias Interpoladas. Trayectoria 4-3-4 Operación frecuente: Traslado de objetos desde una superficie a otra. Solución sencilla: una trayectoria con cuatro puntos como la de la figura. Objetivo: evitar colisiones (¿por qué?). Cómo: introducción de dos puntos intermedios.

16 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Se escogen puntos intermedios en unas posiciones de despegue y asentamiento normales a las superficies de origen y destino, respectivamente. Relación tiempos ! velocidad.

17 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Condiciones de contorno para un movimiento suave: Inicio: posición, velocidad (nula) y aceleración (nula) determinadas. Fin: posición, velocidad (nula) y aceleración (nula) determinadas. Intermedios: paso por posiciones de despegue y asentamiento con continuidad en posición, velocidad y aceleración. ¿Grado del polinomio? 8 condiciones ) 8 parámetros ) orden 7: ¿Bondad del polinómio?

18 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Es preferible dividir el movimiento en 3 segmentos con polinomios de grado inferior. Soluciones: trayectorias y trayectorias Variables: : tiempo real en segundos. i: tiempo real al final de la trayectoria i-ésima. ti =(i-i-1): tiempo real requerido para el segmento i-ésimo. t: tiempo normalizado en el intervalo [0,1]:

19 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Polinomios empleados: Ventajas/Inconvenientes del tiempo normalizado: 4 3

20 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Condiciones de contorno: Punto inicial: Punto despegue:

21 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Punto asentamiento: Punto final: 14 ligaduras (ecuaciones) para 14 parámetros

22 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Primer segmento de la trayectoria:  = 0, t = 0 (inicio primer segmento).

23 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria =1, t =1 (final primer segmento). Ahora no ofrecen soluciones, más adelante recurriremos a ellas.

24 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Segundo segmento de la trayectoria:  = 1, t = 0 (inicio segundo segmento).

25 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Condiciones de continuidad con el tramo anterior: =2, t =1 (final segundo segmento).

26 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Tercer (último) segmento de la trayectoria: Nuevo cambio de variable para facilitar la resolución. Las derivadas no quedan afectadas (suma de constante). Nótese que el polinomio esta basado en la nueva variable y no en t (aunque podemos obtener fácilmente el correspondiente en t).

27 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria =f, t =1, (final tercer segmento). =2, t =0, (inicio tercer segmento).

28 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Condiciones de continuidad con el tramo anterior: Gracias a los cambios de variable hemos obtenido de forma directa 7 de los 14 parámetros. Para el resto …

29 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Se calculan los cambios de las variables de articulación entre segmentos contiguos: Las condiciones (1) a (7) se pueden expresar en forma matricial: y C x = .

30 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Solución: x = C-1y

31 2.2. Trayectorias Interpoladas. Trayectoria 4-3-4.
TSTC 2.2. Trayectorias Interpoladas. Trayectoria Los coeficientes (a10,a11,a12,a20,an0,an1,an2) se obtienen de forma directa. Importante: recordar el último cambio de variable. Si utilizamos: Deberemos recorrer el tiempo de -1 a 0. Si queremos homogeneizar el tiempo (siempre de 0 a 1) hay que deshacer el cambio de variable:

32 2. Trayectorias Interpoladas.
TSTC 2. Trayectorias Interpoladas. Trayectorias interpoladas con funciones lineales. Opción alternativa al uso de polinomios. Fundamento sencillo: conectar los puntos mediante rectas y solucionar los problemas derivados. Problema: discontinuidad en los extremos.

33 2.3. Trayectorias Interpoladas. Uso de Funciones Lineales.
TSTC 2.3. Trayectorias Interpoladas. Uso de Funciones Lineales. Solución: suavizado parabólico con una determinada aceleración. Secuencia de movimientos: Uniforme acelerado. Uniforme. Uniforme decelerado. ¿Durante cuanto tiempo aceleramos/deceleramos? tb

34 2.3. Trayectorias Interpoladas. Uso de Funciones Lineales.
TSTC 2.3. Trayectorias Interpoladas. Uso de Funciones Lineales. Suponemos una cierta aceleración (Ã ventajas prácticas). Implicaciones del discriminante positivo.

35 2.3. Trayectorias Interpoladas. Uso de Funciones Lineales.
TSTC 2.3. Trayectorias Interpoladas. Uso de Funciones Lineales. Generalización a varios segmentos: Definición de secuencia de puntos (1, 2, …, f). Definición de los instantes de tiempo (t1, t2, …, tf). En los puntos intermedios se realiza una aceleración de suavizado . i: ángulo punto i-ésimo. ti: tiempo punto i-ésimo. tsi: duración del suavizado. tli-1,i: duración zona lineal. tdi-1,i: duración segmento.

36 2.3. Trayectorias Interpoladas. Uso de Funciones Lineales.
TSTC 2.3. Trayectorias Interpoladas. Uso de Funciones Lineales. Parámetros que definen el movimiento (Ã síntesis posterior): Segmentos intermedios:

37 2.3. Trayectorias Interpoladas. Uso de Funciones Lineales.
TSTC 2.3. Trayectorias Interpoladas. Uso de Funciones Lineales. Segmento inicial:

38 2.3. Trayectorias Interpoladas. Uso de Funciones Lineales.
TSTC 2.3. Trayectorias Interpoladas. Uso de Funciones Lineales. Segmento final:

39 3. Trayectorias Cartesianas.
TSTC 3. Trayectorias Cartesianas. Descripción de las posiciones del manipulador. 0TN ! T: Trans. Hom. brazo robot. NGherr ! G: coordenadas herramienta (desde el EF). absZbase ! Z: coordenadas base del robot (desde el SdR global). absW(t)obj ! W(t) : coordenadas del objeto (desde el SdR global). Caso General: Consideramos que puede estar en movimiento (depende de t). objPherr ! P: coordenadas de la herramienta (desde el SdR del objeto). G Z M W(t) T P C(t) Para simplificar el cálculo posterior: C(t)=Z-1W(t)

40 3. Trayectorias Cartesianas.
TSTC 3. Trayectorias Cartesianas. La posición del manipulador se puede expresar como: TG=C(t)P Aplicando PCI podremos resolver: T=C(t)PG-1 Para realizar una tarea habrá que desplazar la herramienta entre varios puntos consecutivos (1,2,3,…,f): T1G1=C1(t)P1 T2G2=C2(t)P2 … TfGf=Cf(t)Pf G1 T1 P1 C1(t) T2 G2 C2(t) P2

41 3. Trayectorias Cartesianas.
TSTC 3. Trayectorias Cartesianas. Entre dos puntos consecutivos cualquiera: Entonces podríamos obtener: Vamos a suponer un par de transformaciones, Pi,i y Pi,i+1, tal que fuera posible: Es decir, el movimiento entre los dos puntos (i,i+1) consistiría simplemente en la transformación de Pi,i+1 en Pi+1,i+1.

42 3. Trayectorias Cartesianas.
TSTC 3. Trayectorias Cartesianas. Obviamente Pi,i=Pi, pero ¿Pi,i+1? Despejamos Pi,i+1 de la segunda ecuación: Despejando T de la primera ecuación y sustituyendo en la anterior: Así, Pi,i+1 puede ser precalculado. G1 G2 T1 P1 C1(t) T2 G2 P1,2 C2(t) P2

43 3. Trayectorias Cartesianas.
TSTC 3. Trayectorias Cartesianas. Podemos definir una transformación D(t) (transformación de impulsión) que convierte la matriz Pi,i+1 en la matriz Pi+1,i+1 conforme avanza el tiempo. Se realiza en tiempo normalizado t (0 · t · 1). Verifica las siguientes condiciones de contorno: De donde podemos despejar D(1):

44 3. Trayectorias Cartesianas.
TSTC 3. Trayectorias Cartesianas. La transformación D(t) consiste en un movimiento translacional (para alcanzar la posición final) y dos rotacionales (orientación). La translación lleva el vector pi hasta pi+1. La primera rotación lleva ai hasta ai+1 (!). La segunda rotación (sobre a) lleva oi hasta oi+1 (y por tanto ni a ni+1).