tesis

267
UNIVERSIDAD PÚBLICA DE NAVARRA NAFARROAKO UNIBERTSITATE PUBLIKOA DEPARTAMENTO DE INGENIERÍA MECÁNICA ENERGÉTICA Y DE MATERIALES INGENIERITZA MEKANIKOA, ENERGETIKOA ETA MATERIALEEN SAILA SÍNTESIS CINEMÁTICA Y DINÁMICA DE MECANISMOS. MANIPULADOR PARALELO 6-RKS MEMORIA que para optar al Grado de Doctor Ingeniero Industrial presenta ISIDRO ZABALZA VILLAVA Dirigida por José Manuel Jiménez Bascones y Jesús María Pintor Borobia Pamplona, diciembre de 1999

Upload: victor-antonio-qquenaya-espinoza

Post on 28-Dec-2015

6 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Tesis

UNIVERSIDAD PÚBLICA DE NAVARRA NAFARROAKO UNIBERTSITATE PUBLIKOA

DEPARTAMENTO DE INGENIERÍA MECÁNICA

ENERGÉTICA Y DE MATERIALES INGENIERITZA MEKANIKOA, ENERGETIKOA ETA

MATERIALEEN SAILA

SÍNTESIS CINEMÁTICA Y DINÁMICA DE MECANISMOS.

MANIPULADOR PARALELO 6-RKS

MEMORIA que para optar al Grado de Doctor Ingeniero Industrial

presenta ISIDRO ZABALZA VILLAVA

Dirigida por José Manuel Jiménez Bascones y Jesús María Pintor Borobia

Pamplona, diciembre de 1999

Page 2: Tesis
Page 3: Tesis

A la memoria de mi padre, a mi madre, a mis hermanos y hermanas,

sin cuya ayuda no habría llegado hasta este punto.

Nire emazte Feli eta nire alaba Arantxa eta Iratxeri hainbat ordu kendu dizuedanoi

tesi hau burutu ahal izateko.

Page 4: Tesis
Page 5: Tesis

AGRADECIMIENTOS

En primer lugar, a todos mis profesores desde los Estudios Primarios hasta los Cursos de Doctorado. En cuanto a la dirección de la tesis a: Alejo Avello Iturriagoitia, del Departamento de Mecánica Aplicada de la Universidad de Navarra, por la propuesta del tema y dirección inicial, José González Vián, del Departamento de Ingeniería Mecánica, Energética y de Materiales de la Universidad Pública de Navarra por la dirección inicial de la tesis, José Manuel Jiménez Bascones, del Departamento de Mecánica Aplicada de la Universidad de Navarra y Jesús María Pintor Borobia, del Departamento de Ingeniería Mecánica, Energética y de Materiales de la Universidad Pública de Navarra, los que debido a un cambio de organigrama y por mayor afinidad al tema, asumieron la dirección de la tesis hasta estar concluida. Al resto de profesores del Departamento de Ingeniería Mecánica, Energética y de Materiales de la Universidad Pública de Navarra por su ayuda, ánimo y consejos sobre la tesis, a las Secretarias del Departamento por la realización de los trabajos administrativos que la tesis conlleva, a los técnicos de laboratorio, especialmente a Iñaki Calvo Elizazu, por la construcción de prototipos. Quiero mostrar mi agradecimiento también al Departamento de Proyectos e Ingeniería Rural de la Universidad Pública de Navarra y especialmente a los profesores José Ramón Alfaro López y Miguel Ángel Pascual Buisan por sugerirme y permitirme la utilización del programa CATIA para la visualización del espacio de trabajo del manipulador, y al becario Iker Echarri Carasatorre por su manejo del programa CATIA y la realización de figuras. Por la atención que han tenido enviándome sus artículos, algunos incluso antes de ser publicados en las revistas, mi agradecimiento a los profesores e investigadores J. Ángeles (McGill University) Canadá, R. Clavel (École Politechnique Fédérale de Lausanne) Suiza, C. L. Colins (California Institute of Technology) USA, G. Danescu (Laboratoire de Méchanique Appliquée de BesanÇon) Francia, A. Ferrand, M. Renaud y J. Catala (Laboratoire d’Analyse et d’Architecture des Systemes, Toulouse) Francia, A. Ghosal (Indian Institute of Science, Bangalore) India, M. Giordano y E. Benoit (LMécA, Universiteé de Savoie) Francia, C. Gosselin y R. Ricard (Université

Page 6: Tesis

Laval, Québec) Canadá, C. Innocenti (Universitá degli Studi di Bologna) Italia, L. Notash (Queen’s University Kingston) Canadá, Y Takeda (Tokio Institute of Technology) Japón, L. W. Tsai (University of Maryland) USA, V. Zamanov (Technical University of Sofia) Bulgaria, D. Zlatanov, R. G. Fenton y B. Benhabid (University of Toronto) Canadá. Al resto de investigadores que figuran en las referencias porque sus artículos han supuesto una gran ayuda para el desarrollo de esta tesis. Finalmente un agradecimiento muy especial a J. P. Merlet (INRIA, Francia) por tener a disposición pública toda su contribución al estudio de los Robots Paralelos y las referencias de otros autores.

Page 7: Tesis

RESUMEN

Esta tesis se enmarca en el campo de la síntesis de mecanismos e

incluye un trabajo desarrollado en el campo de la optimización de mecanismos planos y un estudio de las características cinemáticas de un manipulador paralelo, un mecanismo espacial formado por dos plataformas, una fija y otra móvil con varios grados de libertad, unidas por varias cadenas cinemáticas sobre las que accionan los actuadores.

Después de una introducción contenida en el Capítulo I, en el Capítulo

II se realiza un estudio sobre el proceso de síntesis, desde la elección de mecanismo, pasando por una síntesis de puntos de precisión y acabando con la optimización dinámica, poniendo ejemplos por medio de mecanismos planos (Anexos I y II).

Al intentar aplicar el proceso expuesto en el párrafo anterior a

mecanismos espaciales, se encuentran infinidad de mecanismos, con unas características cinemáticas y dinámicas propias de cada uno, lo que obliga a analizarlas, para ver si el mecanismo resulta idóneo para realizar el trabajo deseado, antes de pasar al proceso de optimización.

Para realizar el estudio de las características cinemáticas y dinámicas

de un mecanismo espacial, se toma el conjunto de manipuladores paralelos y, de entre éstos, el manipulador paralelo 6-RKS1.

En el Capítulo III, se hace una aproximación al estado del arte sobre

los manipuladores paralelos, y en particular a las características cinemáticas de los manipuladores 6-RKS conocidos.

El manipulador paralelo 6-RKS, debido a que las cadenas cinemáticas

de unión de las plataformas se pueden considerar mecanismos de biela-manivela, posee unas configuraciones de insensitividad de posición de la plataforma móvil, en las que la plataforma móvil permanece fija independientemente del movimiento introducido por los actuadores. Entre estas configuraciones hay algunas que son de insensitividad total y otras de insensitividad parcial, dependiendo de si la plataforma móvil permanece fija al introducir movimiento por todos los actuadores o por parte de ellos respectivamente.

1 6-RKS - Manipulador paralelo, con las dos plataformas unidas por seis cadenas cinemáticas, conteniendo cada una: un par giratorio, una junta cardan y un par esférico.

Page 8: Tesis

El Capítulo IV comprende el estudio de las configuraciones de insensitividad de posición de la plataforma móvil. En un ejemplo numérico, se determinan todas las configuraciones de insensitividad total para unas determinadas dimensiones del manipulador.

Debido a las ventajas que ofrecen este tipo de configuraciones, en el

Capítulo V se propone un método para conseguir que varias posiciones prefijadas de la plataforma móvil se consigan en configuración de insensitividad total. En dos ejemplos numéricos, se determinan las dimensiones del manipulador para lograr, respectivamente, dos y tres posiciones.

Finalmente, en el Capítulo VI, se realiza un estudio para comprobar si

son alcanzables todas las configuraciones de insensitividad total, para unas determinadas dimensiones del manipulador. Esta comprobación se lleva a cabo mediante el establecimiento de un proceso a seguir con una serie de reglas, que tienen cierta similitud con las leyes de Grashof aplicables al cuadrilátero articulado.

Page 9: Tesis

ÍNDICE

Page 10: Tesis

Índice

ii

Page 11: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

ÍNDICE

CAPÍTULO I - INTRODUCCIÓN I.1 - Introducción............................................................................................... 3 I.2 - Situación actual de la síntesis de mecanismos........................................... 5 I.3 - Objetivos de la tesis................................................................................... 7 I.4 - Proceso seguido en la realización de la tesis............................................. 8

CAPÍTULO II - SÍNTESIS DE MECANISMOS II.1 - Introducción a la síntesis de mecanismos............................................... 15 II.2 - Métodos clásicos de síntesis de mecanismos......................................... 18 II.3 - Métodos actuales de síntesis de mecanismos......................................... 18

II.3.1 - Síntesis de tipo y de número o síntesis estructural...................... 19 II.3.1.1 - Ejemplo de síntesis estructural.......................................... 19

II.3.2 - Síntesis de generación de trayectoria y de puntos de precisión... 22 II.3.2.1 - Ejemplo de síntesis de generación de trayectoria............. 22

II.3.3 - Optimización dinámica................................................................ 25 II.3.3.1 - Estudio cinemático............................................................ 25 II.3.3.2 - Estudio dinámico............................................................... 27 II.3.3.3 - Simulación dinámica......................................................... 28 II.3.3.4 - Optimización del mecanismo............................................ 29

II.4 - Conclusiones........................................................................................... 31 CAPÍTULO III - MANIPULADORES PARALELOS III.1 - Introducción.......................................................................................... 35 III.2 - Manipuladores paralelos....................................................................... 36

III.2.1 - Manipuladores paralelos 6-RKS................................................ 40 II.2.1.1 - Características de los manipuladores paralelos 6-RKS.... 47

III.3 - Conclusiones.......................................................................................... 48

iii

Page 12: Tesis

Índice

CAPÍTULO IV - CONFIGURACIONES DE INSENSITIVIDAD IV.1 - Introducción.......................................................................................... 51 IV.2 - CIP y CIN en mecanismos espaciales................................................... 54

IV.2.1 - CIP y CIN en manipuladores paralelos...................................... 55 IV.2.1.1 - CIP y CIN en manipuladores paralelos 6-RKS............... 57

IV.3 - CIP en manipuladores paralelos 6-RKS................................................ 58 IV.3.1 - Configuraciones de insensitividad total y parcial....................... 61 IV.3.2 - Determinación de las 64 CIP del manipulador 6-RKS............... 66 IV.3.3 - Comprobación de las 64 configuraciones logradas.................... 70

IV.4 - Ejemplo numérico................................................................................. 72 IV.4.1 - Cálculo de la primera configuración de insensitividad.............. 74

IV.4.1.1 - Resolución del sistema.................................................... 75 IV.4.1.2 - Solución........................................................................... 75

IV.4.2 - Cálculo de las CIP...................................................................... 76 IV.4.3 - Cálculo de velocidades............................................................... 88

IV.4.3.1 - Comprobación de las CIP................................................ 89 IV.5 - Conclusiones......................................................................................... 90 CAPÍTULO V - SÍNTESIS DE UN MANIPULADOR 6-RKS V.1 - Introducción............................................................................................ 95 V.2 - Posiciones predeterminadas en CIP........................................................ 96

V.2.1 - Una posición predetermina en CIP.............................................. 98 V.2.2 - Dos posiciones predeterminadas en CIP...................................... 100

V.2.2.1 - Formas de obtener dos posiciones en CIP........................ 101 V.2.3 - Tres posiciones predeterminadas en CIP..................................... 103

V.2.3.1 - Formas de obtener tres posiciones en CIP........................ 105 V.2.4 - Cuatro posiciones predeterminadas en CIP................................. 106

V.2.4.1 - Formas de obtener cuatro posiciones en CIP................... 106 V.3 - Ejemplo numérico para dos CIP............................................................ 107

V.3.1 - Introducción de datos.................................................................. 108 V.3.2 - Condiciones de restricción.......................................................... 110 V.3.3 - Resolución del sistema................................................................ 113 V.3.4 - Soluciones.................................................................................... 114 V.3.5 - Conclusiones de la síntesis para dos CIP..................................... 122

V.4 - Ejemplo numérico para tres CIP............................................................ 123 V.4.1 - Introducción de datos.................................................................. 123 V.4.2 - Condiciones de restricción.......................................................... 126 V.4.3 - Resolución del sistema................................................................ 130 V.4.4 - Soluciones................................................................................... 131

V.5 - Conclusiones.......................................................................................... 132

iv

Page 13: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

CAPÍTULO VI - COMPROBACIÓN DEL GIRO DE MANIVELAS VI.1 - Introducción.......................................................................................... 137 VI.2 - Situación actual.................................................................................... 137 VI.3 - Proceso a seguir.................................................................................... 138

VI.3.1 - Dimensiones previas.................................................................. 138 VI.3.2 - Comprobación de la longitud de las bielas................................ 140

VI.3.2.1 - Comprobación de la longitud de las bielas "2" y "3"..... 141 VI.3.2.2 - Comprobación de la longitud de las bielas "4" y "5"..... 148 VI.3.2.3 - Comprobación de la longitud de las bielas "6" y "1"..... 149 VI.3.2.4 - Conclusiones sobre las longitudes de las bielas............. 150

VI.3.3 - Dimensiones de las aristas de la plataforma móvil.................... 151 VI.3.3.1 - Comprobación de la longitud de la arista "A12"............. 152 VI.3.3.2 - Distancias de los puntos "123" y "161" analíticamente.. 153 VI.3.3.3 - Distancias de los puntos "123" y "161"

por el método numérico de Newton-Raphson............... 157 VI.3.3.4 - Distancias de los puntos "123" y "161" gráficamente.... 158 VI.3.3.5 - Distancias entre los puntos "123" y "145"

y entre los puntos "145" y "161"................................... 170 VI.3.3.6 - Conclusiones sobre la longitud de una arista.................. 170

VI.3.4 - Dimensiones de la plataforma móvil......................................... 171 VI.4 - Conclusiones........................................................................................ 174

CONCLUSIONES GENERALES

C.1 - Síntesis de mecanismos......................................................................... 179 C.2 - Manipuladores Paralelos........................................................................ 179 C.3 - Configuraciones de insensitividad de posición...................................... 179 C.4 - Síntesis de un manipulador paralelo 6-RKS.......................................... 181 C.5 - Comprobación del giro de las manivelas............................................... 181 LÍNEAS DE INVESTIGACIÓN ABIERTAS

L.1 - Síntesis de un manipulador paralelo 6-RKS........................................... 187 L.2 - Dimensiones del manipulador................................................................ 187 L.3 - Espacio de trabajo................................................................................... 187 L.4 - Configuraciones de incertidumbre......................................................... 188 L.5 - Dinámica del manipulador..................................................................... 188 L.6 - Optimización del manipulador............................................................... 188

v

Page 14: Tesis

Índice

ANEXO I.- SINTESIS DE PUNTOS DE PRECISIÓN AI.1 - Ejemplo numérico................................................................................ 191

AI.1.1 - Introducción de datos................................................................ 191 AI.1.2 - Condiciones de restricción........................................................ 192 AI.1.3 - Resolución del sistema.............................................................. 193 AI.1.4 - Solución..................................................................................... 194

ANEXO II - OPTIMIZACIÓN DE UN CUADRILÁTERO ARTICULADO AII.1 - Ejemplo numérico............................................................................... 197

AII.1.1 - Datos del mecanismo............................................................... 198 AII.1.2 - Estudio cinemático................................................................... 200

AII.1.2.1 - Cálculo de posición....................................................... 201 AII.1.2.2 - Cálculo de velocidades.................................................. 202 AII.1.2.3 - Cálculo de aceleraciones............................................... 203

AII.1.3 - Cálculo dinámico..................................................................... 205 AII.1.3.1 - Simulación dinámica.................................................... 207

AII.1.4 - Cálculo de sensibilidad cinemática.......................................... 209 AII.1.4.1 - Sensibilidad de posición................................................ 209 AII.1.4.2 - Sensibilidad de velocidades.......................................... 211 AII.1.4.3 - Sensibilidad de aceleraciones........................................ 213

AII.1.5 - Cálculo de sensibilidad dinámica............................................. 215 AII.2 - Resolución del ejemplo numérico....................................................... 220

AII.2.1 - Longitudes de los eslabones..................................................... 221 AII.2.2 - Simulación dinámica................................................................ 224 AII.2.3 - Resultados................................................................................ 225 AII.2.4 - Diagramas del par motor.......................................................... 226

AII.3 - Conclusiones....................................................................................... 227 REFERENCIAS Referencias..................................................................................................... 231

vi

Page 15: Tesis

NOMENCLATURA

Page 16: Tesis

Nomenclatura

viii

Page 17: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

NOMENCLATURA

Apq......... Longitud del lado de la plataforma móvil entre las bielas "p" y "q",

para pq = [12, 34, 56]. b.............. Vector de variables de diseño. bT ........... Vector "b" traspuesto. CIN......... Configuración de incertidumbre de posición. CIP.......... Configuración de insensitividad de posición total. CIP-1...... Configuración de insensitividad de posición para una cadena

cinemática. CIP-2...... Configuración de insensitividad de posición para dos cadenas

cinemáticas. CIP-3...... Configuración de insensitividad de posición para tres cadenas

cinemáticas. CIP-4...... Configuración de insensitividad de posición para cuatro cadenas

cinemáticas. CIP-5...... Configuración de insensitividad de posición para cinco cadenas

cinemáticas. CIP-6...... Configuración de insensitividad de posición total (CIP). Di-j.......... Distancia entre los puntos "i" y "j". Dmax...... Distancia máxima entre dos puntos. Dm1........ Distancia máxima o mínima relativa "1" entre dos puntos. Dm2........ Distancia máxima o mínima relativa "2" entre dos puntos. Dmc........ Distancia máxima o mínima entre dos puntos con las bielas

cruzadas. Dmin....... Distancia mínima entre dos puntos. (Dmax)max.. Máximo de las distancias máximas entre dos puntos. (Dmin)max.. Máximo de las distancias mínimas entre dos puntos. (Dmax)min.. Mínimo de las distancias máximas entre dos puntos. (Dmin)min.. Mínimo de las distancias mínimas entre dos puntos. Ei............ Descentramiento del actuador "i" respecto de los ejes de simetría del

triángulo formado por los ejes de los actuadores. K............ Junta cardan. Li............ Longitud del eslabón o de la biela "i". M............ Matriz de masas referida a las coordenadas naturales. M............ Par del motor eléctrico. Mb ......... Sensibilidad de la matriz de masas respecto de las variables de

diseño. PI............ Posición de insensitividad. Q............ Vector de fuerzas exteriores.

ix

Page 18: Tesis

Nomenclatura

Qt............ Relación de tiempos de las carreras de ida y retorno. qQ .......... Derivada de las fuerzas exteriores respecto de las coordenadas

naturales. bQ .......... Sensibilidad de las fuerzas exteriores respecto de las variables de

diseño. Qq& .......... Derivada de las fuerzas exteriores respecto de las velocidades. q............. Vector de coordenadas naturales (vector de posición de los puntos de

referencia). qi............. Vector de posición en la iteración "i". qi+1.......... Vector de posición en la iteración "i+1". qT .......... Vector "q" traspuesto. q& ............ Vector de velocidades de los puntos de referencia. q&& ............ Vector de aceleraciones de los puntos de referencia. qb ........... Sensibilidad del vector de posición respecto de las variables de

diseño. qb& .......... Sensibilidad de las velocidades respecto de las variables de diseño. qb&& .......... Sensibilidad de las aceleraciones respecto de las variables de diseño.

R............. Par giratorio. Ri............ Longitud de la manivela "i". R2............ Resistencia del rotor del motor eléctrico. S............. Par esférico. S............. Deslizamiento del campo magnético del motor eléctrico V............. Velocidad de un punto. X2........... Reactancia del rotor del motor eléctrico. X& ........... Componente "X" de la velocidad de un punto. Y& ........... Componente "Y" de la velocidad de un punto. Z& ........... Componente "Z" de la velocidad de un punto. X&& ........... Componente "X" de la aceleración de un punto. Y&& ........... Componente "Y" de la aceleración de un punto. Z&& ........... Componente "Z" de la aceleración de un punto. α ........... Coeficiente de la corrección de Baungarte. α ........... Ángulo entre las dos posiciones del eslabón acoplador en

configuración de insensitividad. αi .......... Aceleración angular de la manivela "i". β ............ Coeficiente de la corrección de Baungarte. θi ........... Ángulo del eslabón o de la manivela "i". λ ........... Vector de multiplicadores de Lagrange.

x

Page 19: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

bλ .......... Sensibilidad de los multiplicadores de Lagrange respecto de las variables de diseño.

φ............. Ecuación de restricción. Φ ........... Sistema de ecuaciones de restricción. Φ& ........... Derivada implícita2 de " Φ " respecto de "t". Φ&& ........... Derivada segunda implícita de " Φ " respecto de "t".

qΦ ......... Matriz jacobiana de las condiciones de restricción respecto de "q".

qTΦ ......... Matriz jacobiana traspuesta.

Φ& q .......... Derivada implícita de " qΦ " respecto de "t".

Φ&& q .......... Derivada segunda implícita de " qΦ " respecto de "t".

Φ& qq ........ Derivada implícita de " qqΦ " respecto de "t".

qqΦ ........ Derivada segunda de " Φ " respecto de las coordenadas naturales.

qqTΦ ........ Matriz " Φ " traspuesta. qq

qbΦ ........ Derivada de la matriz Jacobiana respecto de las variables de diseño.

qbTΦ ........ Matriz " Φ " traspuesta. qb

Φ& qb ........ Derivada implícita de " qbΦ " respecto de "t".

bΦ .......... Derivada de " " respecto de las variables de diseño. Φ

Φ& b .......... Derivada implícita de " bΦ " respecto de "t".

Φ&& b .......... Derivada segunda implícita de " bΦ " respecto de "t". tΦ .......... Derivada explícita3 de las condiciones de restricción respecto "t".

Φ& t .......... Derivada implícita de " tΦ " respecto de "t". tqΦ ......... Derivada de " " respecto de las coordenadas naturales. tΦ

tbΦ ......... Derivada de " " respecto de las variables de diseño. tΦΦ& tq ......... Derivada implícita de " tqΦ " respecto de "t".

ωi .......... Velocidad angular de la manivela "i". 0i............ Punto del eje del actuador "i", en la base de la perpendicular trazada

a dicho eje desde el punto "1i". 1i............ Centro de la articulación cardan del extremo de la manivela del

actuador "i". 1jk.......... Centro de la rótula de la plataforma móvil donde se unen las bielas

"j" y "k", para jk = [23, 45, 61]. 6-RKS..... Seis cadenas cinemáticas con pares "R", "K" y "S". 2 Derivada implícita quiere decir que se derivan respecto de "t" todos los términos que dependen del tiempo. 3 Derivada explícita quiere decir que se derivan respecto de "t" solamente los términos en los que aparece la variable "t".

xi

Page 20: Tesis

Nomenclatura

xii

Page 21: Tesis

CAPÍTULO I

INTRODUCCIÓN

Page 22: Tesis

Introducción

2

Page 23: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

CAPÍTULO I - INTRODUCCIÓN

I.1 – INTRODUCCIÓN Esta tesis se enmarca, dentro de la mecánica, en el campo de la

síntesis de mecanismos. Según Reuleaux una máquina se puede considerar como "una

combinación de cuerpos resistentes de tal manera que, por medio de ellos, las fuerzas mecánicas de la naturaleza se pueden encauzar para realizar un trabajo acompañado de movimientos determinados". Y un mecanismo se puede considerar como "una combinación de cuerpos resistentes conectados por medio de articulaciones para formar una cadena cinemática cerrada con un eslabón fijo y cuyo propósito es transformar el movimiento".

En el diseño de una máquina pueden intervenir muchos campos de la

ciencia como por ejemplo la mecánica, la termodinámica, la mecánica de fluidos o la ciencia de materiales, y se deben tener en cuenta aspectos como el económico, el estético, ..... No obstante, de todos los estudios que se deben de realizar en el diseño de una máquina, el estudio mecánico es de primordial importancia, ya que la mecánica es la ciencia que relaciona la geometría, las fuerzas y los desplazamientos, factores que determinan el funcionamiento de la máquina. En el diseño de los mecanismos, el estudio mecánico será uno de los más importantes ya que, según la definición de mecanismo, el objetivo de éstos es transformar el movimiento y el análisis del movimiento lo realiza la mecánica.

Al principio de la revolución industrial, el trabajo de los animales y el

trabajo más pesado del hombre fue sustituido por el de las máquinas. Poco a poco, se ha ido sustituyendo el trabajo físico del hombre y, actualmente, con la reconversión industrial, se está sustituyendo por el de las máquinas, incluso el trabajo más cualificado realizado por hombre.

De lo expuesto anteriormente, se deduce la importancia del "Diseño

de Máquinas" para que éstas sean capaces de realizar los trabajos más complejos, a gran velocidad, con seguridad para las personas y bienes que estén a su alrededor, y con unos costes competitivos.

El diseño global de una máquina comienza por el diseño particular de

los mecanismos que la componen; ya que los movimientos necesarios en la

3

Page 24: Tesis

Introducción

máquina se consiguen por medio de diferentes mecanismos y, por lo tanto, desde el punto de vista mecánico, las máquinas se pueden considerar formadas por la combinación de varios mecanismos.

En muchas máquinas, la energía se introduce por medio del

movimiento giratorio de un motor eléctrico o térmico y su objetivo es generar unos movimientos que no son giratorios, o si lo son, son más rápidos o más lentos que el movimiento de entrada. Estos cambios entre el movimiento de entrada y el de salida se consiguen por medio de mecanismos.

Otras máquinas, como por ejemplo los motores de combustión interna

alternativos, aprovechan la energía que el combustible suministra al pistón, que realiza un movimiento rectilíneo alternativo. Como el movimiento más fácilmente aprovechable a la salida de un motor es el giratorio, se necesita el mecanismo pistón-biela-manivela para hacer la conversión del movimiento alternativo en giratorio.

Por lo visto en los párrafos anteriores, se deduce que es muy

importante hacer un buen diseño de mecanismos para realizar un buen diseño mecánico de máquinas.

El diseño de un mecanismo en particular, o de una máquina en

general, consta de dos partes diferenciadas: "Síntesis" y "Análisis". La síntesis consiste en establecer a priori los tamaños, formas,

composición de materiales y disposición de las piezas, del tal modo que el mecanismo o máquina resultante desempeñe el trabajo deseado.

Mediante el análisis se hace un estudio sobre un mecanismo o

máquina previamente sintetizada, para determinar si los movimientos que realiza (trayectorias, velocidades y aceleraciones) son los deseados, y si los esfuerzos que aparecen en los diferentes puntos de las piezas son menores que los esfuerzos que son capaces de soportar.

La síntesis requiere imaginación, creatividad, sentido común y

experiencia. En cambio, en el análisis se necesitan una serie de conocimientos de mecánica para determinar si el mecanismo o máquina sintetizado realiza los movimientos prescritos, y si es suficientemente resistente como para soportar los esfuerzos a que se verá sometido. No obstante, el trabajo de análisis puede resultar muy complejo; por ejemplo, cuando se trata de determinar el movimiento de un mecanismo sometido a unas fuerzas exteriores.

4

Page 25: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

En el diseño de un mecanismo o máquina, el proceso habitual es el siguiente: En primer lugar, se sintetiza el mecanismo o máquina, normalmente de forma aproximada. Posteriormente, se realiza el análisis. Por regla general, el mecanismo o máquina sintetizada no suele realizar perfectamente el movimiento prescrito, o está mal dimensionado en cuanto a resistencia. Por ello, se hace necesario variar el diseño, y volver a realizar el análisis, en un proceso iterativo hasta comprobar que el mecanismo o máquina realiza el movimiento deseado, y sus piezas están dimensionadas de forma que serán capaces de soportar los esfuerzos a que vayan a estar sometidas.

Hasta hace aproximadamente 40 años, el proceso indicado en el

párrafo anterior se hacía manualmente y, normalmente, no se tenía en cuenta si la solución obtenida era la óptima. En muchos casos, las máquinas y mecanismos se iban optimizando gracias a la experiencia adquirida con los resultados reales de otras máquinas construidas anteriormente. En las últimas décadas, con el desarrollo de la informática, el proceso iterativo se ha realizado por medio de ordenadores, que reducen el tiempo de cálculo y permiten añadir la optimización de las diferentes soluciones posibles; algo impensable realizar manualmente, para problemas ligeramente complicados, por lo tedioso y costoso en tiempo que resultaba.

I.2 - SITUACIÓN ACTUAL DE LA SÍNTESIS DE MECANISMOS En la actualidad, al realizar la síntesis de mecanismos, se debe

conseguir que ésta sea óptima bajo algún punto de vista preestablecido por el diseñador.

Para conseguir un diseño óptimo, éste se divide en dos grandes

bloques, tal como se ha visto en el apartado anterior: Elección del tipo de mecanismo y optimización del mismo.

Para la elección del tipo, es necesario conocer las características

cinemáticas y dinámicas de muchos mecanismos, cuantos más mejor, y así poder hacer la elección de uno, entre los que sean capaces de desarrollar el trabajo deseado.

El punto de vista mecánico bajo el que se suelen optimizar los

mecanismos puede depender de la cinemática del mecanismo (posiciones, velocidades y aceleraciones) y de la dinámica (fuerzas y momentos).

Hoy en día, en la síntesis de mecanismos se está trabajando, por un

lado, en el desarrollo de nuevos mecanismos, estudiando sus características

5

Page 26: Tesis

Introducción

cinemáticas y dinámicas y, por otro lado, en la optimización de los mecanismos ya desarrollados.

Esta tesis incluye un trabajo desarrollado en el campo de la

optimización de mecanismos planos y un estudio de las características cinemáticas de un manipulador paralelo, un mecanismo espacial formado por dos plataformas, una fija y otra móvil con varios grados de libertad, unidas por varias cadenas cinemáticas, en paralelo, sobre las que accionan los actuadores (Fig. I-1).

Fig. I-1 Manipulador paralelo

6

Page 27: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

I.3 - OBJETIVOS DE LA TESIS El objetivo ideal de una tesis de síntesis de mecanismos, es desarrollar

un método que permita realizar el diseño óptimo, tanto de mecanismos planos como espaciales.

En esta tesis se describe un proceso para llevar a cabo la síntesis de

mecanismos, desde la elección del tipo de mecanismo hasta la optimización cinemática y dinámica del mismo, poniendo ejemplos de los pasos seguidos en el proceso, por medio de mecanismos planos.

El proceso a seguir con mecanismos espaciales sería el mismo que

para mecanismos planos; pero debido a las diversas características cinemáticas y dinámicas de los innumerables tipos que existen o que se pueden diseñar, aunque el objetivo final sería la síntesis óptima, sólo se estudiarán algunas características cinemáticas de un determinado tipo de mecanismo espacial, el manipulador paralelo 6-RKS propuesto por Hunt en 1983 [HUN. 83].

Se estudiarán, en primer lugar, las características cinemáticas y

dinámicas propias de los Manipuladores Paralelos 6-RKS, para disponer de una información que permita la síntesis estructural o elección del mecanismo para un trabajo para el que sea idóneo.

Entre las características cinemáticas de estos manipuladores se

encuentran las "configuraciones de insensitividad de posición de la plataforma móvil". Se analizarán estas configuraciones y se introducirá el concepto de su utilidad, pues no se conoce ningún trabajo anterior que lo haga. La mayoría de investigadores que han estudiado configuraciones singulares lo han hecho con el objeto de eliminarlas del espacio de trabajo. A continuación se determinará el número de configuraciones de este tipo que puede alcanzar el manipulador y un método para localizarlas.

Se propondrá un método para conseguir que varias posiciones

predeterminadas de la plataforma móvil se alcancen estando el mecanismo en configuración de insensitividad total.

Se propondrá un proceso a seguir con unas reglas, con cierta similitud

a las leyes de Grashof, que permita comprobar si todas las manivelas del manipulador pueden dar vueltas completas y así conseguir todas las configuraciones de insensitividad de posición posibles.

7

Page 28: Tesis

Introducción

I.4 - PROCESO SEGUIDO EN LA REALIZACIÓN DE LA TESIS Esta tesis se inició con el objetivo general de realizar "síntesis

cinemáticas y dinámicas de mecanismos asistidas por computador". Para realizar la síntesis se siguió un proceso basado en algunos

métodos propuestos por García de Jalón J. y Bayo E. [GAR. 94]. Por ejemplo:

- Utilización de coordenadas naturales para determinar la posición del mecanismo. Con estas coordenadas se definen puntos característicos como los pares cinemáticos.

- Planteamiento de condiciones de restricción entre los puntos definidos por

las coordenadas naturales, como distancias fijas entre puntos o ángulos constantes entre determinadas direcciones.

- Cálculo de las posiciones de los puntos del mecanismo, definidos por las

coordenadas naturales, por el método iterativo de Newton-Raphson de linealización de las condiciones de restricción.

- Cálculo de velocidades y aceleraciones por derivación de las condiciones de

restricción respecto del tiempo.

- Simulación cinemática a partir de unas posiciones, velocidades y aceleraciones dadas.

- Planteamiento de las ecuaciones de la dinámica con las aceleraciones de los

puntos definidos por las coordenadas naturales, lo que obliga a introducir la matriz de masa y los multiplicadores de Lagrange.

- Simulación dinámica por integración numérica, a partir de unas posiciones y

velocidades iniciales, resolviendo en cada paso las ecuaciones dinámicas del mecanismo.

- Aplicación del método de Baumgarte durante la simulación dinámica para

garantizar la convergencia de la integración numérica.

- Análisis de sensibilidades cinemática y dinámica, con el objeto de determinar las sensibilidades de posiciones, velocidades, aceleraciones, masas, multiplicadores y fuerzas exteriores respecto de las variables de diseño.

8

Page 29: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

- Planteamiento de una función objetivo dependiente de la cinemática y dinámica del mecanismo, cálculo de sus sensibilidades respecto de las variables de diseño y variación de éstas, en el sentido indicado por la sensibilidad correspondiente, hasta minimizar o maximizar la función.

Siguiendo los pasos expuestos, se realizaron programas en Qbasic

Visual-Basic y Matlab para el cálculo cinemático y dinámico de cuadriláteros articulados, levas y mecanismos de Whitworth.

En el cálculo cinemático se determinaron posiciones, velocidades y

aceleraciones de los puntos definidos por las coordenadas naturales y se realizaron simulaciones cinemáticas en el tiempo a partir de la posición, velocidad y aceleración del eslabón de entrada. También se realizó un programa para síntesis de puntos de precisión, haciendo que un punto del eslabón acoplador de un cuadrilátero articulado alcance cinco posiciones predeterminadas.

En dinámica, los programas resuelven tanto los problemas inversos,

en los que se determinan las fuerzas a partir de una cinemática dada, como los problemas directos en los que se determinan las aceleraciones a partir de unas fuerzas exteriores dadas. En dinámica directa, también realizan la simulación en el tiempo a partir de unas posiciones y velocidades dadas por medio de integración numérica con corrección de Baungarte.

En Matlab, se realizaron programas de optimización de cuadriláteros

articulados y mecanismos de Whitworth, tomando como función objetivo la minimización del par motor máximo, de un motor asíncrono que impulse al mecanismo, durante una revolución de la manivela. La optimización se realizó determinando la sensibilidad del par motor respecto de las variables de diseño, variando éstas paso a paso en el sentido indicado por la sensibilidad hasta que la sensibilidad fuese cero.

Una vez seguido el proceso de síntesis cinemática y optimización

dinámica, resolviendo ejemplos de mecanismos planos, el objetivo era aplicar la misma teoría para mecanismos espaciales.

De mecanismos espaciales hay tal variedad, con unas características

cinemáticas propias de cada uno, que hizo que el estudio se centrase en los manipuladores paralelos. Estos mecanismos están formados por una plataforma fija y otra móvil unidas por medio de varias cadenas cinemáticas en paralelo sobre las que accionan los actuadores.

9

Page 30: Tesis

Introducción

En la bibliografía referente a manipuladores paralelos se da gran importancia a las características cinemáticas:

- Cinemática directa o determinación de la posición de la plataforma móvil a

partir de las posiciones de los actuadores. - Cinemática inversa o determinación de las posiciones de los actuadores a

partir de la posición de la plataforma móvil. - Configuraciones singulares, posiciones del mecanismo en las que la

plataforma móvil pierde o gana algún grado de libertad. - Espacio de trabajo o posiciones que puede llegar a alcanzar la plataforma

móvil. Una vez realizado el estudio de las características cinemáticas

anteriores, se inicia el estudio dinámico del manipulador. Al realizar un repaso sobre diferentes tipos de manipuladores

paralelos y sus características cinemáticas, se centró la atención en el manipulador paralelo 6-RKS propuesto por Hunt en 1983. Este manipulador está formado por una plataforma fija sobre la que están fijados seis actuadores giratorios (R) y una plataforma móvil triangular. Esta plataforma está unida a los actuadores por seis cadenas cinemáticas, cada una formada por una manivela y una biela unidas por una junta cardan (K). A cada vértice de la plataforma móvil se unen dos bielas por medio de juntas esféricas (S).

Como en este manipulador las plataformas están unidas con cadenas

cinemáticas de manivela biela se pensó que, de forma similar a los mecanismos planos de piston-biela-manivela y manivela-oscilador tienen configuraciones de insensitividad (puntos muertos o posiciones de volquete), en los que la velocidad del eslabón de salida es nula independientemente de la del de entrada, ellos deberían tener también configuraciones de insensitividad, en las que las velocidades de los puntos de la plataforma móvil fuesen nulas independientemente de las de los actuadores.

En las configuraciones de insensitividad, la posición del eslabón de

salida es de gran precisión, ya que pequeños errores en las posiciones de los eslabones de entrada no le afectan. Además, al pasar de una de estas configuraciones a otra, tanto la velocidad inicial como la final de los puntos del eslabón de salida son nulas, con la consiguiente ventaja dinámica que esto representa.

En estas configuraciones, los pares a aplicar a los actuadores para

equilibrar a las fuerzas y momentos que actúan sobre la plataforma móvil son

10

Page 31: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

nulos. Ello es debido a que las líneas de acción de las fuerzas que actúan en los extremos de las manivelas cortan a los ejes de sus actuadores correspondientes.

Viendo la utilidad de las configuraciones de insensitividad, por

ejemplo de cara a posicionar piezas a mecanizar, se desarrolló un método para su localización sistemática, comprobándose a continuación que las configuraciones alcanzadas son realmente de insensitividad.

A continuación, y de forma similar a la síntesis de puntos de precisión

en mecanismos planos, se estudió la síntesis de manipuladores con el fin de lograr que varias posiciones de la plataforma móvil preestablecidas se consiguiesen estando el mecanismo en configuración de insensitividad.

Finalmente, con el fin de comprobar que todas las configuraciones de

insensitividad con alcanzables, se estudió un proceso con unas reglas a seguir tipo leyes de Grashof.

11

Page 32: Tesis

Introducción

12

Page 33: Tesis

CAPÍTULO II

SÍNTESIS DE MECANISMOS

Page 34: Tesis

Síntesis de Mecanismos

14

Page 35: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

CAPÍTULO II - SÍNTESIS DE MECANISMOS

II.1 – INTRODUCCIÓN A LA SÍNTESIS DE MECANISMOS

La síntesis de mecanismos más o menos complicados, se ha venido utilizando desde la más remota antigüedad. A continuación, según la clasificación de J. Nieto [NIE. 78], se expone una relación de los diferentes tipos de síntesis de mecanismos que se han ido utilizando.

- Síntesis de tipo o de Reuleaux Trata de determinar la tipología de los eslabones a utilizar (barras,

levas, engranajes, etc.) y pares que los unen, en función de los criterios de equivalencia, idoneidad y de diversas cualidades de los mecanismos a conseguir.

- Síntesis de número o de Grubbler Estudia los grados de libertad de la cadena cinemática, inversiones,

isomorfismos, posibles configuraciones de un número de barras dado, de movilidad dada, etc.

Las dos síntesis anteriores unidas se conocen como síntesis

estructural.

- Síntesis dimensional

Una vez realizada las síntesis de tipo y de número, se inicia la síntesis dimensional, de la que se puede hacer la clasificación siguiente:

- Síntesis dimensional o de Burmester

Aunque en principio se asignaba esta denominación a los trabajos tendentes a obtener las dimensiones de las barras de un mecanismo, actualmente se reserva a las síntesis geométrico-planas que elaboró Burmester.

15

Page 36: Tesis

Síntesis de Mecanismos

- Síntesis de generación de funciones o de coordinación de barra

El objetivo se plantea como una relación entre varias posiciones de eslabones de entrada y salida. Se suele referir a un número finito de posiciones.

- Síntesis de generación de trayectorias

Trata de situar algún o algunos puntos de los eslabones de un mecanismo a lo largo de una trayectoria.

- Síntesis de puntos de precisión

En esta síntesis se pretende que se cumplan las exigencias de diseño en unos puntos determinados. Se puede considerar una variante del anterior.

- Síntesis de guiado de cuerpo rígido

El problema se plantea no como obtención de una serie de puntos, sino como situación y orientación de uno de los eslabones del mecanismo.

- Síntesis de Chebyshev

Se mide la desviación entre la función generada por el mecanismo y la perseguida a través de los polinomios de Chebyshev.

- Síntesis por tanteo gráfico o método "overlay"

Consiste en la búsqueda de la solución mediante procesos de tanteo que se ayudan de elementos auxiliares como gráficos. No comporta cálculo pero su convergencia es dudosa. Su principal ventaja es la sencillez.

- Síntesis cinemáticas

En este tipo de síntesis, se incluyen exigencias de tipo cinemático, como posición, valores de velocidades y aceleraciones. A este tipo de síntesis pertenecerían todas las citadas anteriormente.

16

Page 37: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

- Síntesis analíticas, gráficas, grafo-analíticas

Se clasifica la síntesis según la herramienta de cálculo utilizada sea analítica, gráfica o una mezcla de ambas.

- Síntesis planas y espaciales

Según sea el ámbito del movimiento del mecanismo al que se aplica la síntesis en el plano o en el espacio.

- Síntesis exactas

Este tipo de síntesis supone la existencia de, al menos, una solución que haga posible el cumplimiento de todas las exigencias de diseño.

- Síntesis aproximadas

Cuando, a diferencia del caso anterior, no se dispone de una solución que cumpla todas las exigencias de diseño, se trata de aproximar en lo posible los resultados a los objetivos propuestos.

- Síntesis óptima

Cuando en la síntesis exacta se tiene varias o infinitas soluciones o en la síntesis aproximada no se tiene ninguna solución exacta, se puede, desde algún punto de vista, fijar una función objetivo que en la síntesis óptima se puede minimizar o maximizar utilizando técnicas de optimización.

- Optimización dinámica

Reciben este nombre las síntesis en las que se engloban objetivos dinámicos como minimización de fuerzas de inercia, de fuerzas de restricción, pares motores, etc.

17

Page 38: Tesis

Síntesis de Mecanismos

II.2 - MÉTODOS CLÁSICOS DE SÍNTESIS DE MECANISMOS Tradicionalmente los problemas considerados por la síntesis

cinemática, y que están estrechamente relacionados entre sí en todo el proceso de diseño del nuevo mecanismo, son clasificados en tres categorías. La primera categoría incluye aquellas consideraciones que conciernen a la selección del tipo de mecanismo que mejor cumple con los requerimientos del diseño. Actualmente, se denomina "Síntesis de Tipo" y es el primer paso que se debe dar para iniciar el análisis. El objetivo es determinar la clase de eslabones o unidades constructivas a emplear: cuerpos, juntas, levas, engranajes, etc.

El segundo nivel o categoría se conoce como "Síntesis de Número".

Dado un mecanismo particular, este tipo de síntesis trata de determinar el número de cuerpos y el más apropiado número y clase de juntas cinemáticas que el mecanismo debe incluir para obtener un número dado de grados de libertad.

La última categoría trata de seleccionar los valores más apropiados

para los parámetros geométricos y dimensiones del mecanismo con el fin de cumplir los requerimientos impuestos por el diseñador, o al menos ser considerado como diseño óptimo desde algún punto de vista. Esta categoría se llama normalmente "Síntesis Dimensional".

Entre las tres categorías citadas, la resolución de los problemas de

síntesis de tipo y de número depende mucho de la experiencia del diseñador y resulta difícil desarrollar un algoritmo para resolverlos. En cambio, en la síntesis dimensional es más fácil utilizar métodos gráficos o analíticos para resolver el problema.

En general, los problemas tratados por la síntesis dimensional se

agrupan en tres familias diferentes: síntesis de generación de funciones, síntesis de generación de trayectorias y síntesis de guiado de cuerpo rígido.

II.3 - MÉTODOS ACTUALES DE SÍNTESIS DE MECANISMOS En la actualidad los métodos de síntesis clásicos han sido

complementados con la optimización de las síntesis cinemática y la optimización dinámica. Además, ha aumentado el número de mecanismos desarrollados y el conocimiento de sus características cinemáticas y dinámicas, por lo que han aumentado las posibilidades de cara a la elección del mecanismo.

18

Page 39: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

A continuación se exponen a modo de ejemplo tres tipos de síntesis actuales:

- Estructural. - De puntos de precisión. - Dinámica óptima.

II.3.1 - Síntesis de tipo y de número o síntesis estructural La síntesis de tipo y de número conjuntas, o síntesis estructural

consiste en elegir un tipo de mecanismo para realizar un determinado trabajo. Para poder realizar esta elección se deben conocer todas las

características cinemáticas y dinámicas de un gran número de mecanismos articulados, levas, engranajes....; y dentro de estos grupos, las diferentes características que pueden tener según sean sus dimensiones. Por ejemplo, un mecanismo articulado puede: ser manivela oscilador, tener puntos límite, ser de retorno rápido, etc.

II.3.1.1 - Ejemplo de síntesis estructural Se desea conseguir un movimiento giratorio oscilante, que se

aproxime a los extremos de la oscilación con velocidad angular decreciente, a partir de un movimiento de entrada giratorio de velocidad angular constante.

Para conseguir el tipo de movimiento deseado se puede intentar

diseñar un mecanismo totalmente nuevo, aunque eso no es lo más habitual, normalmente se estudian las características cinemáticas de mecanismos ya existentes, y en la mayoría de los casos, se pueden utilizar una serie de mecanismos que cumplan con las exigencias planteadas.

Por ejemplo, en el problema propuesto, se podría utilizar un

mecanismo de leva (Fig. II-1) o un manivela-oscilador basado en el cuadrilátero articulado (Fig. II-2) ya que ambos cumplen con las exigencias planteadas de que el eslabón de salida realice un movimiento giratorio oscilante entre dos posiciones extremas a las que llega con velocidad angular decreciente.

Las posiciones globales del mecanismo en las que la velocidad del

eslabón de salida es nula, independientemente de la velocidad del eslabón de entrada, se denominan configuraciones de insensitividad.

19

Page 40: Tesis

Síntesis de Mecanismos

Fig. II-1 Mecanismo de leva

Fig. II-2 Mecanismo manivela-oscilador

Si los dos mecanismos son de unas dimensiones apropiadas, tienen el

mismo diagrama de posición y el mismo diagrama de velocidad. El diagrama de posición representa el ángulo que forma el eslabón "4" con la horizontal frente al ángulo que forma el eslabón "2" también con la horizontal (Fig. II-3) y el diagrama de velocidades representa la velocidad angular del eslabón "4" en función de la posición del eslabón "2", suponiendo la velocidad angular de éste constante (Fig. II-4).

20

Page 41: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Fig. II-3 Diagrama de posición

Fig. II-4 Diagrama de velocidad Finalmente, por ejemplo, se decide utilizar el mecanismo de manivela-

oscilador por razones de situación del mecanismo en el conjunto de la máquina. Esta metodología seguida en el estudio de los diferentes tipos de

mecanismos que pueden cumplir con las exigencias pedidas y la elección de uno de esos mecanismos, siguiendo algún criterio propuesto por el diseñador, se correspondería con la síntesis estructural.

21

Page 42: Tesis

Síntesis de Mecanismos

Una vez realizada la síntesis estructural o elección del tipo de mecanismo y del número de eslabones, se van estableciendo otros tipos de síntesis, como síntesis cinemáticas o dinámicas, en las que se puede aplicar métodos de optimización, con el fin de lograr, dentro del tipo de mecanismo escogido, que éste tenga unas determinadas dimensiones y sea óptimo bajo algún punto de vista.

II.3.2 - Síntesis de generación de trayectoria y de puntos de precisión Una vez realizada la síntesis estructural, la síntesis de generación de

trayectoria trata de conseguir que un punto de un sólido rígido del mecanismo, describa una trayectoria predeterminada. Si en vez de exigir que un determinado punto describa una trayectoria completa, se fija que este punto pase por un determinado número de posiciones, a ésta variante se le puede llamar síntesis de puntos de precisión.

II.3.2.1 - Ejemplo de síntesis de generación de trayectoria

Como ejemplo de síntesis de generación de trayectoria se puede poner el diseño de un cuadrilátero articulado plano (Fig. II-5) de tal forma que un punto del eslabón acoplador (punto 3) describa una trayectoria definida por una serie de puntos dados.

Fig. II-5 Cuadrilátero articulado para generación de trayectoria

22

Page 43: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

En este caso, la síntesis comprende la determinación de las dimensiones de los eslabones del mecanismo que hacen que se cumplan las condiciones preestablecidas. Estas dimensiones serán las variables de diseño.

Utilizando las coordenadas naturales, introducidas por García de Jalón

J. y Bayo E. [GAR. 94], siguiendo el método propuesto por Jiménez, Álvarez, Cardenal y Cuadrado [JIM. 97], suponiendo que los puntos "A" y "B" son fijos y que se pueden variar las longitudes de la manivela y del eslabón seguidor y las dimensiones y la forma del eslabón acoplador, resulta que las variables de diseño son los elementos del vector

bT = {L1, L2, L3, L4, L5} (II-1)

siendo L1 la longitud de la manivela, L2 la longitud del eslabón

acoplador, L3 la longitud del eslabón seguidor, L4 la distancia entre el punto "1" y la base de la perpendicular trazada desde el punto "3" al eslabón acoplador y L5 la distancia entre el punto "3" y la base de la perpendicular antes citada.

El vector de coordenadas dependientes de los puntos "1", "2" y "3",

que irán variando a lo largo de las trayectorias que describan según sea la posición del mecanismo, será:

qT = {X1, Y1, X2, Y2, X3, Y3} (II-2)

Las restricciones geométricas que deben cumplir los diferentes puntos

del mecanismo, para cualquier posición en la que se encuentre, se pueden expresar de la forma siguiente:

φ1 = (X1 - XA)2 + (Y1 - YA)2 - L = 0 (II-3) 2

1

φ2 = (X1 - X2)2 + (Y1 - Y2)2 - = 0 (II-4) L22

φ3 = (X2 - XB)2+ (Y2 - YB)2 - = 0 (II-5) L23

φ4 = X3 - X1 - (X2 - X1) · L4 / L2 + (Y2 - Y1) · L5 / L2 = 0 (II-6) φ5 = Y3 - Y1 - (Y2 - Y1) · L4 / L2 - (X2 - X1) · L5 / L2 = 0 (II-7) φ6 = X3 - Xp = 0 (II-8) φ7 = Y3 - Yp = 0 (II-9)

Las tres primeras restricciones, ecuaciones (II-3), (II-4) y (II-5),

corresponden a las longitudes fijas de la manivela, el acoplador y el seguidor, las ecuaciones (II-6) y (II-7), indican la perpendicularidad entre los segmentos de longitudes "L4" y "L5" y las ecuaciones (II-8) y (II-9), recogen la condición

23

Page 44: Tesis

Síntesis de Mecanismos

de que las coordenadas del punto “3“ deben ser las coordenadas de los puntos “P“ que se desean conseguir.

Si la trayectoria a seguir por el punto "3" se diese por menos de cinco

puntos, por ejemplo por cuatro, resultaría que las 7 condiciones de restricción anteriores se convertirían en 28 ecuaciones, siete por cada punto propuesto. El número de incógnitas sería 29: cuatro valores de los seis elementos del vector de coordenadas dependientes "q", más los cinco elementos del vector "b" de las variables de diseño. En este caso, se tendría 28 ecuaciones y 29 incógnitas resultando un problema indeterminado con infinitas soluciones, por lo que admitiría poder plantear una optimización, por ejemplo buscar la solución en la que la suma de las longitudes de las barras sea mínima. También se podría predeterminar la longitud de un eslabón, con lo que quedaría reducido el problema a un sistema de 28 ecuaciones con 28 incógnitas que, en general, tendría solución única.

Ahora, se contempla el caso en que la trayectoria a seguir por el punto

"3" venga dada por más de cinco puntos, por ejemplo por "6". En este caso se tendrán siete condiciones de restricción por seis puntos que darían 42 ecuaciones de restricción. Por otro lado, seis valores de los seis elementos del vector "q" de coordenadas dependientes más los cinco valores del vector "b" de las variables de diseño, da un total de 41 incógnitas. En este problema, se tendrían 42 ecuaciones de restricción y 41 incógnitas por lo que, en general, no tendría solución, o sea no se podría conseguir que el punto "3" pasase por los seis puntos preestablecidos de la trayectoria. En este caso, se puede buscar una solución de manera que la suma de los cuadrados de las distancias entre los puntos previstos y los puntos logrados sea mínima, lo que supone optimizar una solución aproximada.

En el caso de que la trayectoria se dé exactamente por cinco puntos, se

tendrán siete condiciones de restricción por cinco puntos, es decir un total de 35 ecuaciones. Por otro lado, cinco valores de los seis elementos del vector "q" de coordenadas más cinco valores del vector "b" de variables de diseño, resulta un total de 35 incógnitas. Como en este caso se tienen 35 ecuaciones con 35 incógnitas, el problema, en general, tendrá solución y se podrá conseguir que el punto "3" del eslabón acoplador alcance las cinco posiciones preestablecidas. En este caso, a la síntesis se le puede considerar "síntesis de puntos de precisión".

En el Anexo I, se muestra la resolución de un ejemplo numérico de

"síntesis de puntos de precisión" para un cuadrilátero articulado plano, en el que se pretende que un punto del eslabón acoplador alcance cinco posiciones predeterminadas.

24

Page 45: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

II.3.3 - Optimización dinámica Hasta hace pocos años, sólo se disponía de programas de análisis

dinámico; esto es, programas que analizaban el comportamiento dinámico de un mecanismo después de haber definido de antemano su geometría y sus características dinámicas. En la actualidad se están desarrollando programas de diseño dinámico que no sólo analizan el comportamiento dinámico del mecanismo, sino que modifican automáticamente los parámetros del mismo hasta conseguir una solución óptima bajo algún punto de vista. Por ello, actualmente, diseño dinámico es sinónimo de solución óptima.

El diseño óptimo de un mecanismo se inicia con la definición de la

función objetivo que valora el funcionamiento del mecanismo. La solución del problema será la configuración que minimice la función objetivo en relación con las variables de diseño. El problema puede tener ecuaciones de restricción, esto es, igualdades o desigualdades que deben cumplir ciertas funciones de las variables de diseño. Dependiendo de la aplicación, la función objetivo se puede definir a lo largo de un intervalo de tiempo, pudiendo ser de tipo integral a lo largo de todo el intervalo, o puede estar definida en varios puntos del intervalo, o en un solo punto. La función objetivo normalmente depende de las variables de diseño no sólo de forma explícita, sino también implícitamente a través de los resultados del análisis dinámico: posiciones, velocidades, aceleraciones, fuerzas de restricción, ....

La mayoría de los programas de diseño dinámico se basan, para su

realización, en el cálculo de las derivadas de la función objetivo respecto de las variables de diseño. Este método se conoce como análisis de sensibilidad y es el primer paso en el proceso de optimización. Se puede considerar también separadamente, ya que la sensibilidad determina la tendencia de la función objetivo con respecto a la variación del diseño y esto resulta muy útil en los procesos de diseño iterativo no automático realizados paso a paso por el diseñador.

Para la realización de la optimización dinámica se utilizarán las

coordenadas naturales y se aplica el método expuesto por García de Jalón J. y Bayo E. [GAR. 94].

II.3.3.1 – Estudio cinemático La resolución del problema de optimización comienza por el estudio

cinemático. Es decir, el cálculo de la posición, velocidad y aceleración de una serie de puntos característicos del mecanismo.

25

Page 46: Tesis

Síntesis de Mecanismos

Sea "q" el vector de coordenadas naturales de los puntos característicos del mecanismo, "b" el vector de parámetros o variables de diseño (por ejemplo longitudes de los eslabones) y "Φ" el conjunto de restricciones geométricas que debe cumplir el mecanismo durante su funcionamiento.

Las restricciones geométricas del mecanismo se pueden escribir, de

forma compacta, como:

Φ(q, b, t) = 0 (II-10) La resolución del problema de posición consiste en determinar el

vector "q" de coordenadas naturales que cumpla con las condiciones de restricción, para una determinada posición del eslabón de entrada.

Como las condiciones de restricción normalmente son no lineales, se

utiliza en su resolución el método de linealización iterativo de Newton-Raphson. Con este método, se obtiene el vector de coordenadas naturales para una posición del mecanismo que cumple las restricciones geométricas, para una determinada posición del eslabón de entrada.

Para iniciar el método de Newton-Raphson se debe partir de un vector

de coordenadas naturales aproximadas. Según sea ese vector inicial puede que el método no converja a una solución aceptable; en cuyo caso, se debe probar con otro vector inicial de coordenadas naturales, y así sucesivamente hasta conseguir converger a una solución que represente una posición real del mecanismo. Un buen vector inicial suele ser el correspondiente a una posición real del mecanismo y fácil de determinar, que sea próxima a la posición que se desea calcular.

Una vez resuelto el problema de posición, derivando las ecuaciones de

restricción respecto del tiempo y suponiendo que los parámetros de diseño no varían con el tiempo, se obtiene:

Φq q& + Φt = 0 (II-11)

ecuaciones que relacionan las velocidades de los puntos dados por las

coordenadas naturales, para la posición determinada del mecanismo. Volviendo a derivar las ecuaciones de restricción respecto del tiempo

se obtiene:

Φq & + = 0 (II-12) q& qq&&Φ Φ& t

26

Page 47: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

ecuaciones que relacionan las aceleraciones de los puntos dados por las coordenadas naturales, para la posición determinada del mecanismo.

En las ecuaciones (II-11) y (II-12) "Φq" y " " representan, la matriz

jacobiana de las condiciones de restricción respecto de las coordenadas naturales y la derivada de esa matriz respecto del tiempo respectivamente, "q", " " y " " representan las posiciones, velocidades y aceleraciones de los puntos característicos del mecanismo y "Φt" y representan la primera y segunda derivadas de las condiciones de restricción respecto del tiempo.

Φ& q

q& q&&

Φ& t

II.3.3.2 – Estudio dinámico Una vez resuelto el problema cinemático, se estudia el problema

dinámico, que es el estudio de las ecuaciones que relacionan las masas con la cinemática del mecanismo y con las fuerzas.

Debido a que el conjunto de coordenadas naturales no son

independientes, se introducen los multiplicadores de Lagrange en las ecuaciones que relacionan las masas con las fuerzas y las aceleraciones. Las ecuaciones para el estudio dinámico son:

M + λ = Q (II-13) q&& ΦT

q

donde "M" representa la matriz de masas, " Φ " la matriz jacobiana

traspuesta, "λ" el vector de los multiplicadores de Lagrange y "Q" el vector de las fuerzas exteriores.

Tq

En el sistema (II-13) de "n" ecuaciones, se tienen "(n+m)" incógnitas:

los "n" elementos de vector de aceleraciones más los "m" elementos del vector de los multiplicadores. Para poder resolver este sistema, se toman en consideración también las "m" ecuaciones cinemáticas (II-12) del cálculo de las aceleraciones, formando así un sistema de "n+m" ecuaciones con "n+m" incógnitas, que se puede expresar en forma matricial como:

Φ

Φ

0

M

q

Tq

· = (II-14)

λq&&

Φ−Φ− &&& tq qQ

27

Page 48: Tesis

Síntesis de Mecanismos

Sistema de ecuaciones que sirve tanto para resolver los problemas dinámicos directos, en los que las incógnitas son las aceleraciones, como los dinámicos inversos, en los que las incógnitas son las fuerzas. II.3.3.3 – Simulación dinámica

En los problemas dinámicos directos, para poder hacer una simulación

dinámica en el tiempo, partiendo de una posición y velocidad dadas, se van integrando numéricamente las ecuaciones dinámicas para obtener las nuevas velocidades y posiciones. No obstante esta integración puede no converger a la solución real y puede ir violando cada vez más las condiciones de restricción geométricas y de velocidades.

Para evitar este problema, en este caso, se utiliza el método de

estabilización de Baumgarte [BAU. 72]: - Tomando las ecuaciones de restricción (II-10) y su primera y

segunda derivada respecto del tiempo (II-11) y (II-12) respectivamente, se tendrá los siguientes sistemas de ecuaciones:

Φ(q, t) = 0 Φq &q + Φt = 0 Φq + + = 0 q&& qq

&&Φ Φ& t

- que esquemáticamente se pueden representar como:

Φ = 0 (II-15) Φ& = 0 (II-16) Φ&& = 0 (II-17)

- Si se cumplen las condiciones de restricción de posición y de

velocidad, "Φ" y " Φ " serán iguales a cero, por lo que la ecuación (II-17) se puede escribir:

&

Φ&& + 2 α Φ& + β Φ = 0 (II-18) 2

- Si al ir realizando la simulación dinámica, se van violando las

condiciones de restricción de posición o de velocidad, el sistema de ecuaciones (II-18) deja de cumplirse. En ese momento, los parámetros "α" y "β" introducen

28

Page 49: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

una corrección, que hacen que la integración converja a la solución real en la mayoría de los casos.

- Al introducir los parámetros "α" y "β" propuestos por Baumgarte, se

sustituye la ecuación (II-12) por la (II-18), y el conjunto de ecuaciones cinemáticas y dinámicas queda de la siguiente forma:

· = (II-19)

Φ

Φ

0

M

q

Tq

λq&&

g

Q

- siendo:

g = - (II-20) Φβ−Φ+Φα−Φ−Φ2

tqtq )q(2q &&&&

II.3.3.4 – Optimización del mecanismo Una vez resuelto el problema cinemático y dinámico del mecanismo,

comienza la optimización, que consiste en minimizar o maximizar una cierta función objetivo que habrá definido el diseñador.

Para iniciar la optimización se realiza el análisis de sensibilidad, que

determina la variación de la respuesta del mecanismo en relación con la variación de los parámetros de diseño.

En el estudio de la sensibilidad se parte de las ecuaciones de

restricción (II-10) y se deriva respecto de los parámetros de diseño, obteniéndose: Φqqb + Φb = 0 (II-21)

ecuaciones de las que se determina el vector "qb" de sensibilidad de

posición respecto de los parámetros de diseño, siendo "Φb" la matriz de derivadas de las ecuaciones de restricción respecto de los parámetros de diseño.

Derivando las ecuaciones que relacionan las velocidades (II-11)

respecto de los parámetros de diseño se obtiene:

Φq q + Φb& qqqb q& + Φqb q& + Φtqqb + Φtb = 0 (II-22)

29

Page 50: Tesis

Síntesis de Mecanismos

ecuaciones donde "Φqq" y "Φqb" son hipermatrices, resultado de derivar la matriz jacobiana respecto de las coordenadas dependientes y de las variables de diseño respectivamente, y "Φtq" y "Φtb" son las matrices de derivadas respecto de las coordenadas dependientes y de las variables de diseño respectivamente, del vector "Φt". Con estas ecuaciones se determina el vector " " de sensibilidad de las velocidades respecto de los parámetros de diseño. qb&

Derivando respecto de los parámetros de diseño las ecuaciones que

relacionan las aceleraciones (II-12) se obtiene:

Φq q& + Φqqqb & + Φqb + Φ qb q + + + qb + Φtb = 0 (II-23) b& q& q&& & qq

& Φ& qb q& qbq&&Φ Φ& tq

ecuaciones que relacionan la sensibilidad de las aceleraciones respecto

de los parámetros de diseño " q& ", donde " ", " ", " " y " " representan las derivadas respecto del tiempo de matrices ya conocidas.

b& Φ& qq Φ& qb Φ& q Φ& tq

En los párrafos anteriores se han estudiado las sensibilidades

cinemáticas de posición y velocidad respecto de los parámetros de diseño, necesarias para determinar las sensibilidades en el problema dinámico. Tomando ahora la ecuación (II-13) de la dinámica del mecanismo y derivando respecto de los parámetros de diseño se obtiene:

=λΦ+ b

TqbqM && λΦ−λΦ−−++ T

qbbTqqbbqbqb qqMqQqQQ &&&& (II-24)

ecuaciones que relacionan las sesibilidades cinemáticas con las de los

multiplicadores de Lagrange y las fuerzas, y en las que " " es la matriz de derivadas de los multiplicadores respecto de las variables de diseño, " ", " " y " Q " son las matrices de derivadas de las fuerzas exteriores respecto de las variables de diseño, de las coordenadas y de las velocidades y "M

λb

Qb

Qq q&

b" es la hipermatriz de las derivadas de la matriz de masas respecto de las variables de diseño.

La ecuación anterior, junto con la de sensibilidad de aceleraciones

(II-23) se puede escribir en forma compacta como:

Φ

Φ

0

M

q

Tq

· =

λb

bq&&

g

Q (II-25)

30

Page 51: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

donde:

Q = Q (II-26) λΦ−λΦ−−++ Tqbb

Tqqbbqbqb qqMqQqQ &&&&

g = - Φqqqb &&q - Φqb - Φ qb q - Φ - - qb - Φtb (II-27) &&q & qq & & qb &q qbq &&Φ Φ& tq

Con el sistema de ecuaciones (II-25) se pueden obtener, en cada caso

distintas sensibilidades, dependiendo de cuales sean incógnitas. Una vez se han obtenido las sensibilidades de posición, velocidad,

aceleración, multiplicadores de Lagrange, masas y fuerzas exteriores respecto de los parámetros de diseño, se puede calcular la sensibilidad de la función objetivo respecto de dichos parámetros. Ello proporcionará información para saber cómo se deben variar los parámetros o variables de diseño con el fin de conseguir que la función objetivo sea máxima o mínima, bien paso a paso o aplicando algoritmos de optimización.

En el anexo II, siguiendo el proceso expuesto en este apartado, se

presenta un ejemplo numérico de optimización de las dimensiones de un cuadrilátero articulado, accionado por un motor asíncrono, para que el valor máximo del par motor durante un ciclo, es decir una revolución completa de la manivela, sea mínimo. Como condiciones de restricción se toman: el ángulo girado por el eslabón oscilador, su longitud y la relación de tiempos entre la carreras de ida y de retorno. II.4 CONCLUSIONES

En este capítulo se ha hecho un repaso de los métodos de síntesis

clásicos y actuales, aplicando los actuales a tres ejemplos típicos:

- Síntesis estructural, que consiste en la preselección de una serie de mecanismos que cumplen con las características prescritas (leva y manivela-oscilador) y, finalmente la elección de uno de ellos (manivela-oscilador).

- Síntesis de puntos de precisión, que se encuadra dentro de la síntesis

cinemática y su objetivo es el dimensionamiento de un mecanismo ya escogido, de forma que un punto determinado alcance una serie de posiciones predeterminadas. Como ejemplo, en el Anexo I, se determinan las dimensiones de un cuadrilátero articulado para que un punto del eslabón acoplador alcance cinco posiciones prefijadas.

31

Page 52: Tesis

Síntesis de Mecanismos

- Optimización dinámica o determinación de las dimensiones de un mecanismo que hagan máxima o mínima una determinada función objetivo. Como ejemplo en el Anexo II se presenta la optimización de las dimensiones de un cuadrilátero articulado accionado por un motor asíncrono, cuya función objetivo minimizada es el par motor máximo.

32

Page 53: Tesis

CAPÍTULO III

MANIPULADORES PARALELOS

Page 54: Tesis

Manipuladores Paralelos

34

Page 55: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

CAPÍTULO III - MANIPULADORES PARALELOS

III.1 – INTRODUCCIÓN En el Capítulo II se ha expuesto un método actual para la síntesis

óptima de mecanismos, mostrando su aplicación por medio de tres ejemplos: Síntesis estructural, síntesis de puntos de precisión y optimización dinámica en mecanismos planos.

La síntesis óptima de mecanismos planos está muy desarrollada, con

numerosos programas de ordenador para su consecución. La teoría para la realización de la síntesis óptima de mecanismos

espaciales es la misma que para los mecanismos planos, sin embargo, tiene dificultades de aplicación por las diversas características cinemáticas y dinámicas de los innumerables tipos de mecanismos espaciales que existen o que se pueden diseñar.

Particularizando el proceso expuesto en el Capítulo II "Métodos

actuales de síntesis de mecanismos", para mecanismos espaciales, se seguirían los pasos siguientes:

- Síntesis estructural o elección del tipo de mecanismo. - Síntesis cinemática. - Optimización dinámica.

En la síntesis cinemática, también se podrá aplicar un proceso de

optimización planteando una función objetivo que deberá ser optimizada. Para resolver el primer paso de la optimización dinámica, que es la

síntesis estructural o elección del mecanismo, se deben conocer las características cinemáticas y dinámicas de los mecanismos espaciales y, sobre todo, las del mecanismo que se pretende elegir para desarrollar el trabajo deseado.

También se pueden sintetizar mecanismos nuevos, sobre los que

todavía no se ha realizado estudio alguno, con características mecánicas desconocidas, en los que se deberá comenzar por analizar sus características, continuar con el desarrollo de programas para realizar su análisis cinemático y dinámico y finalmente realizar su diseño óptimo.

35

Page 56: Tesis

Manipuladores Paralelos

Las características cinemáticas y dinámicas del mecanismo elegido o sintetizado condicionan todo el proceso de síntesis posterior, según sean éstas, el mecanismo será capaz o no de conseguir los objetivos propuestos.

Como consecuencia de lo expuesto en los párrafos anteriores, para

realizar la síntesis óptima de mecanismos espaciales, se ha fijado la atención solamente en los manipuladores paralelos, y en el conjunto de éstos, en el manipulador paralelo 6-RKS propuesto por Hunt [HUN. 83], en el que se realiza el estudio de una serie de características cinemáticas y dinámicas que le son propias.

III.2 – MANIPULADORES PARALELOS En una clasificación de mecanismos espaciales, un tipo podría ser el

conjunto de robots paralelos, caracterizados por el hecho de ser mecanismos de cadena cinemática cerrada y constituidos por un elemento móvil con varios grados de libertad que está unido a la base fija del mecanismo por varias cadenas cinemáticas en paralelo. Merlet J. P. [MER 90/97].

De este tipo de mecanismos el más utilizado y estudiado es el

conocido con el nombre de Plataforma de Stewart Generalizada (Fig. III-1). Aunque su configuración coincide con la plataforma de Gough [GOU. 62] (Fig. III-2) que fue diseñada con anterioridad a la de Stewart.

Fig. III-1 Plataforma de Stewart generalizada

36

Page 57: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Debido a que la plataforma de Stewart [STE. 65] (Fig. III-3 y III-4) fue utilizada para la construcción de simuladores de vuelo, hizo que fuese la más conocida cuando fue diseñada, y después ha ido cambiando su configuración hasta coincidir con la de Gough, manteniendo su denominación inicial.

La actual Plataforma de Stewart o Plataforma de Stewart Generalizada

está constituida por una plataforma móvil con varios grados de libertad, unida a una plataforma fija por medio de varias cadenas cinemáticas en paralelo, constituidas por actuadores lineales de longitud variable.

Fig. III-2 Plataforma de Gough

37

Page 58: Tesis

Manipuladores Paralelos

Fig. III-3 Plataforma de Stewart inicial, esquema

Fig. III-4 Plataforma de Stewart inicial, prototipo

38

Page 59: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

En el estudio de los manipuladores paralelos, varios investigadores, como [BEN. 96-2], [CLA 91], [MER. 87] a [MER. 90/97], [STA. 97], analizan los siguientes puntos:

- Estudio cinemático directo de posición. - Estudio cinemático inverso de posición. - Configuraciones singulares. - Espacio de trabajo. - Análisis cinemático de velocidades y aceleraciones. - Cálculo estático. - Cálculo dinámico.

En el estudio cinemático directo, se determina la posición de la

plataforma móvil, conociendo las coordenadas articulares de los actuadores. Por ejemplo, se determina la posición de la plataforma móvil conociendo la longitud de los actuadores lineales que unen la plataforma fija y la móvil. Este estudio suele ser complejo ya que para unas determinadas coordenadas articulares el manipulador puede adquirir varias configuraciones diferentes.

En el estudio cinemático inverso, se determinan las coordenadas

articulares de los actuadores para conseguir una determinada posición de la plataforma móvil. Por ejemplo, se calculan las longitudes de los actuadores rectilíneos para una determinada posición de la plataforma móvil. Este estudio suele resultar más sencillo que el cinemático directo; aunque a veces las coordenadas articulares admiten dos soluciones para una posición de la plataforma móvil, por ejemplo cuando los actuadores son giratorios.

En las configuraciones singulares, por lo general, se estudian aquellas

posiciones del manipulador en las que aparece algún grado de libertad más de los que tiene el manipulador controlados por los actuadores. Por lo tanto, en las proximidades de esa posición, el manipulador tiene algún movimiento incontrolado. Este tipo de configuraciones singulares hay que evitarlas en la zona de trabajo en la que se va a utilizar el manipulador. También algunos investigadores, que se verán en el Capítulo IV, estudian configuraciones singulares en las que se pierde algún grado de libertad, es decir el órgano terminal del manipulador permanece inmóvil para una determinada velocidad articular.

En el estudio del espacio de trabajo se determina las posiciones que

puede alcanzar, por ejemplo, el centro de gravedad de la plataforma móvil para una determinada orientación de la misma y también los ángulos máximos que puede girar la plataforma para una determinada posición de su centro de gravedad.

39

Page 60: Tesis

Manipuladores Paralelos

En el análisis de velocidades y aceleraciones, se calculan las velocidades y aceleraciones de puntos de la plataforma móvil en función de las velocidades y aceleraciones articulares de los actuadores. Por ejemplo el cálculo de la velocidad y aceleración del centro de gravedad de la plataforma móvil, conociendo las velocidades y aceleraciones articulares de los actuadores lineales.

En el cálculo estático se determinan las fuerzas que hará cada actuador

para equilibrar una determinada resultante y a un par que actúen sobre la plataforma móvil.

Finalmente, en el problema dinámico se relacionan fuerzas y aceleraciones. Este puede ser dinámico inverso o directo. En el inverso, se conocen las velocidades y aceleraciones de unos puntos determinados del manipulador y se deben calcular las fuerzas que deben ejercer los actuadores para conseguir el movimiento previsto. En el dinámico directo, se conocen las fuerzas que ejercen los actuadores y se debe calcular las aceleraciones que adquirirá el manipulador. En ambos casos, se pueden calcular toda una serie de fuerzas de restricción que aparecerán en los puntos de unión de los eslabones del mecanismo.

En el estudio dinámico directo, se pueden ir integrando en el tiempo

las aceleraciones y velocidades para obtener nuevas velocidades y posiciones a partir de unas velocidades y posición iniciales, consiguiendo así una simulación dinámica.

III.2.1 – Manipuladores paralelos 6-RKS Aparte de la Plataforma de Stewart, en la familia de manipuladores

paralelos existen infinidad de tipos diferentes. Por ejemplo, manipuladores paralelos planos, espaciales y entre los espaciales de tres, cuatro, cinco y seis grados de libertad, con sus características cinemáticas y dinámicas propias. Un tipo de estos mecanismos es el "Manipulador Paralelo 6-RKS" (Fig. III-5) propuesto por Hunt [HUN. 83], sobre el que se centrarán los capítulos siguientes de esta tesis.

Estos mecanismos se caracterizan por estar constituidos por una

plataforma móvil, con seis grados de libertad, unida a una plataforma fija por medio de seis cadenas cinemáticas formadas por actuador giratorio, manivela y biela.

40

Page 61: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Fig. III-5 Manipulador paralelo 6-RKS de Hunt Los actuadores giratorios "R" están montados sobre la plataforma fija,

las manivelas están montadas sobre los ejes de los actuadores y las bielas están conectadas por un extremo al extremo de la manivela por medio de una junta cardan "K" y por el otro extremo a la plataforma móvil por medio de una junta esférica "S".

Sobre este tipo de robots aparte del diseño realizado por Hunt

[HUN. 83] se han realizado algunos estudios, conociéndose los realizados por:

- Pierrot; Dauchez, Fraisse, Begon, Fournier, Uchiyama, Iimura, Unno, Toyama, etc.

- Zamanov de la Universidad Técnica de Sofía (Bulgaria). - Plitea, Giordano y Benea. - Takeda, Funabashi e Ichimaru. - Zanganeh, Sinatra y Angeles.

41

Page 62: Tesis

Manipuladores Paralelos

Pierrot, Dauchez, Fraisse, Begon y Fournier de la Universidad de Montpellier II (Francia), Uchiyama e Iimura de la Universidad de Tohoku (Japón) y Unno y Toyama de la empresa Toyoda Machine Works, Ltd. [PIE. 90], [PIE. 91-1], [PIE. 91-2], [PIE. 91-3], [PIE. 92-1], [PIE. 92-2], [UCH. 92], [BEG. 93], [TOY. 93], [BEG. 95], desarrollaron el robot paralelo de 6 grados de libertad HEXA (Fig. III-6) como generalización del robot de tres grados de libertad DELTA desarrollado por Clavel de la Escuela Técnica Federal de Lausana (Suiza) [CLA. 88] (Fig. III-7). Estos manipuladores tienen la estructura del manipulador paralelo 6-RKS de Hunt, no obstante, debido a las dimensiones de las manivelas y de la plataforma móvil, no poseen, y sus autores tampoco han puesto de manifiesto, las características cinemáticas del modelo que se verá en los capítulos siguientes.

Fig. III-6 Manipulador paralelo Hexa

42

Page 63: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Fig. III-7 Manipulador paralelo Delta El profesor Zamanov de la Universidad Técnica de Sofía (Bulgaria) ha

diseñado y construido un prototipo de estructura parecida al manipulador 6-RKS de Hunt (Fig. III-8), pero con la dirección de los ejes de los actuadores diferente, con lo que cambian algunas características cinemáticas.

Fig. III-8 Manipulador paralelo de Zamanov

43

Page 64: Tesis

Manipuladores Paralelos

Los estudios realizados en la Universidad de Savoia (Francia) por Giordano y en la Universidad Técnica de Cluj-Napoca (Rumania) por Benea y Plitea [PLI. 94], [GIO. 95], [BEN. 96-1], [BEN. 96-2] sobre un manipulador paralelo 6-RKS (Fig. III-9 y III-10) siguen la estructura clásica de los estudios realizados sobre los manipuladores paralelos: estudio de posición directo e inverso, configuraciones singulares, espacio de trabajo, estática y dinámica.

La composición de las cadenas cinemáticas de unión de las

plataformas son las mismas que las del manipulador propuesto por Hunt, pero la disposición de los actuadores es diferente, por lo que varían bastante las características cinemáticas respecto de las del manipulador de Hunt.

Fig. III-9 Manipulador 6-RKS estudiado por Benea, esquema

44

Page 65: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Fig. III-10 Manipulador 6-RKS estudiado por Benea, prototipo Takeda y Funabashi, del Instituto Tecnológico de Tokio, e Ichimaru,

de la empresa Sumimoto Steel Corporation, [TAK. 97] han construido y estudiado un prototipo basado en la estructura 6-RKS de Hunt (Fig. III-11 y III-12). En el trabajo referenciado, realizan una optimización de las dimensiones del mecanismo basándose en el índice de transmisión; pero no realizan un estudio de las características cinemáticas del manipulador.

45

Page 66: Tesis

Manipuladores Paralelos

Fig. III-11 Manipulador 6-RKS de Takeda, esquema

Fig. III-12 Manipulador 6-RKS de Takeda, prototipo

46

Page 67: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Zanganeh de la Universidad de Toronto (Canadá), Sinatra de la Universidad de Catania (Italia) y Angeles de la Universidad McGill de Montreal (Canadá) [ZAN. 97] realizan un estudio cinemático y dinámico de un manipulador que tiene la misma estructura que el 6-RKS de Hunt (Fig. III-13), pero no abordan el tema de características cinemáticas del manipulador.

Fig. III-13 Manipulador 6-RKS de Zanganeh

III.2.1.1 – Características de los manipuladores paralelos 6-RKS Este tipo de manipuladores paralelos, al tener la plataforma superior e

inferior unidas por medio de cadenas cinemáticas de actuador giratorio, manivela y biela, tiene unas características cinemáticas y dinámicas propias. Características que no posee, por ejemplo, la plataforma de Stewart generalizada, ya que en ésta la unión entre las plataformas se realiza por medio de actuadores lineales.

Una característica cinemática de los manipuladores paralelos 6-RKS

es poseer configuraciones de insensitividad de posición (CIP). En estas configuraciones, las velocidades de los puntos de la plataforma móvil son nulas

47

Page 68: Tesis

Manipuladores Paralelos

independientemente de las velocidades articulares de los actuadores, poseyendo además una serie de ventajas que se pondrán de manifiesto en el Capítulo IV.

III.3 – CONCLUSIONES En este capítulo se ha realizado una aproximación al arte de los

manipuladores paralelos basados en la estructura 6-RKS propuesta por Hunt, y se ha introducido el concepto de utilidad de las configuraciones de insensitividad posición (CIP), característica cinemática ventajosa que posee este tipo de manipuladores, si tienen unas dimensiones apropiadas.

En los manipuladores 6-RKS conocidos, los investigadores que han

trabajado sobre ellos no han puesto de manifiesto las ventajas de las configuraciones de insensitividad de posición, bien porque debido a sus dimensiones no se pueden alcanzar o porque las han considerado perjudiciales, y por lo tanto, tratan de eliminarlas del espacio de trabajo del manipulador.

48

Page 69: Tesis

CAPÍTULO IV

CONFIGURACIONES DE INSENSITIVIDAD

Page 70: Tesis

Configuraciones de Insensitividad.

50

Page 71: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

CAPÍTULO IV - CONFIGURACIONES DE

INSENSITIVIDAD En este capítulo se definen las configuraciones de insensitividad de

posición (CIP) del manipulador paralelo 6-RKS propuesto por Hunt. Se pone de manifiesto las ventajas de las (CIP), determinando el número de configuraciones de este tipo existente, y se propone un método numérico para lograrlas. También se definen las configuraciones de incertidumbre de posición (CIN) que es necesario eliminarlas del espacio de trabajo del manipulador por resultar perjudiciales o negativas.

IV.1 – INTRODUCCIÓN Los mecanismos planos de pistón-biela-manivela y manivela-

oscilador se utilizan en muchos automatismos: el primero cuando se necesita un movimiento rectilíneo y el segundo cuando se precisa un movimiento giratorio. Ambos son movimientos alternativos y parten de un movimiento giratorio continuo.

En estas aplicaciones, el movimiento giratorio continuo, en ambos

mecanismos, se introduce por el eslabón llamado manivela. En el mecanismo pistón-biela-manivela, el movimiento de salida será el del pistón, y en el mecanismo de manivela-oscilador será el del seguidor.

Ambos mecanismos se utilizan de forma extensa porque tienen la

peculiaridad de poseer, cada uno, dos configuraciones (llamadas también puntos límite, muertos o de volquete) [BUR. 79], [ERD. 91] y [SHI. 80], en las que la velocidad del pistón en uno o la velocidad del seguidor en el otro son nulas para cualquier valor de la velocidad de la manivela. Estas configuraciones se dan en el mecanismo pistón-biela-manivela cuando la manivela y la biela están alineadas, superpuestas o en prolongación (Fig. IV-1). En el mecanismo manivela-oscilador; estas configuraciones se dan cuando la manivela y el eslabón acoplador están alineados, en superposición o en prolongación (Fig. IV-2).

Estas configuraciones recibirán el nombre de "configuraciones de

insensitividad de posición" (CIP).

51

Page 72: Tesis

Configuraciones de Insensitividad.

Fig. IV-1 CIP en el mecanismo Pistón-Biela-Manivela

Fig. IV-2 CIP en el mecanismo Manivela-Oscilador

52

Page 73: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Estas CIP son configuraciones de gran precisión de posición para el pistón en el mecanismo pistón-biela-manivela, y para el eslabón seguidor en el mecanismo manivela-oscilador. En ellas, pequeños errores en la posición de las manivelas de entrada apenas influyen en la posición del pistón y del seguidor respectivamente, de ahí su calificativo de insensitividad de posición.

El ser nula la velocidad del eslabón de salida en las CIP supone una

gran ventaja cuando con estos mecanismos se realiza una carrera que finaliza en una detención. Así se aprovecha para detener el mecanismo en las CIP, cuando el eslabón de salida tiene velocidad nula, lo que hace que las fuerzas de inercia en el mecanismo sean reducidas. Ello es debido a que en ese momento la aceleración del eslabón de salida, por muy rápida que sea la detención, será la misma que si pasase por esa configuración sin detenerse; en cambio, la detención brusca del mecanismo en cualquier otra configuración donde la velocidad del eslabón de salida no es nula, producirá una aceleración muy elevada.

En las CIP citadas, el par de entrada en la manivela será nulo

independiente de las fuerzas o momentos aplicados al eslabón de salida. Esto es debido a que la reacción que aparece en la articulación de unión de la manivela y el eslabón acoplador tiene la dirección de la manivela.

De los párrafos anteriores se desprende que en los mecanismos de

pistón-biela-manivela y manivela oscilador las CIP descritas resultan positivas, y por ello, estos mecanismos se vienen empleando desde hace años en automatismos y máquinas, haciendo uso de sus CIP.

En los mecanismos planos, pueden existir "configuraciones de

incertidumbre de posición" (CIN), que suelen resultar perjudiciales o negativas, en las que el eslabón de salida puede realizar pequeños desplazamientos aunque el eslabón de entrada permanezca inmóvil, de ahí la incertidumbre de posición. También, el eslabón de salida puede tener una cierta velocidad, siendo nula la velocidad del eslabón de entrada. Un ejemplo de este tipo de CIN se puede dar en cualquiera de los mecanismos citados anteriormente si se introduce el movimiento por el pistón en uno o por el eslabón seguidor en el otro y se toma la manivela como eslabón de salida. En ambos casos, si no se toma ningún tipo de precaución, los mecanismos pueden quedar fuera de control en esas configuraciones, al surgir un nuevo grado de libertad para el eslabón de salida.

53

Page 74: Tesis

Configuraciones de Insensitividad.

IV.2 – CIP Y CIN EN MECANISMOS ESPACIALES En los mecanismos espaciales de un grado de libertad cabrá hablar de

una configuración de insensitividad de posición (CIP) cuando se tenga una configuración del mecanismo tal que, aunque se introduzca un movimiento con una velocidad cualquiera en el eslabón de entrada, el eslabón de salida permanezca inmóvil. De manera análoga, se hablará de una configuración de incertidumbre de posición (CIN) cuando el eslabón de salida pueda realizar determinados movimientos estando inmóvil el eslabón de entrada.

Para algunos mecanismos espaciales de un grado de libertad, basados

en el cuadrilátero articulado, muchos autores han estudiado, por razones varias, los límites de su espacio de trabajo, que son posiciones de los mecanismos en las que se producen las CIP. Entre dichos autores, cabe citar a Harrisberger [HAR. 64], Skreiner [SKR. 67], Freudenstein y Kiss [FRE. 69], Sticher [STI. 69], Botema [BOT. 70], Gupta y Radcliffe [GUP. 71], Freudenstein y Primrose [FRE. 76], Soylemez y Freudenstein [SOY. 82], Gupta y Kazerounian [GUP. 83], Sandor y Zhuang [SAN. 84], Tinubu y Gupta [TIN. 84], Alizade y Sandor [ALI. 85], Williams y Reinholtz [WIL. 87] y Rastegar y Tu [RAS. 92].

Hunt [HUN. 78/90] se refiere a este tipo de configuraciones en

mecanismos articulados planos y espaciales llamándolas "configuraciones estacionarias" a las aquí referidas como (CIP) y "configuraciones de incertidumbre" a las (CIN).

En los mecanismos planos o espaciales de varios grados de libertad, se

dará una CIP cuando el eslabón de salida permanezca inmóvil para una velocidad cualquiera de uno o varios eslabones de entrada. Del mismo modo, se tendrá una CIN cuando el eslabón de salida tenga algún movimiento estando inmóviles todos los eslabones de entrada.

En mecanismos de varios grados de libertad, autores como Uchiyama

[UCH. 79], Hunt [HUN. 82] y [HUN. 87], Sugimoto, Duffy y Hunt [SUG. 82] y Rastegar y Deravi [RAS. 87-1] y [RAS. 87-2], han realizado estudios sobre CIP en robots tipo serie. En estas configuraciones, un determinado punto del brazo del robot describe una superficie que suele ser, de alguna manera, límite del espacio de trabajo. Mientras ese punto determinado se encuentre en la superficie límite puede permanecer inmóvil independientemente del movimiento de algún actuador, perdiendo el robot algún grado de libertad. A estas configuraciones, normalmente las denominan como "configuraciones singulares" y las estudian como límites negativos del espacio de trabajo, no habiendo ningún estudio que se conozca en el que las consideren ventajosas.

54

Page 75: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

IV.2.1 – CIN y CIP en manipuladores paralelos En manipuladores paralelos de varios grados de libertad, desde que

Stewart [STE. 65] propuso su plataforma citando que tenía dos posibles posiciones de inestabilidad (positions of instability), es decir dos CIN, varios investigadores han realizado estudios sobre las CIP y las CIN de estos mecanismos. Así, Hunt [HUN. 83] cita dos posibles tipos de configuraciones (él las llama "special configurations"): un tipo se produce cuando la plataforma móvil permanece inmóvil aunque se introduzca algún movimiento por alguno o varios actuadores "stationary singularity" (lo que aquí se denomina CIP), y otro tipo en el que la plataforma móvil puede realizar pequeños desplazamientos aunque todos los actuadores permanezcan fijos "uncertainty singularity" (CIN).

Kokkinis y Stoughton [KOK. 88] estudian las CIP y CIN de un

manipulador paralelo de 3 grados de libertad, denominándolas, al igual que Hunt, "stationary singularity" y "uncertainty singularity".

Hunt, Samuel y McAree [HUN. 91] estudian las configuraciones

especiales para un tipo de manipulador con una mezcla de actuadores en serie y paralelo, utilizando los ejes instantáneos de rotación y deslizamiento. Determinan configuraciones en las que el eslabón de salida del manipulador pierde o gana algún grado de libertad (CIP) y (CIN) respectivamente, estudiando el conjunto de vectores que representan el giro y deslizamiento de los actuadores sobre los ejes instantáneos.

Merlet [MER. 88] estudia las CIN de varios manipuladores,

denominándolas configuraciones singulares, utilizando los vectores de Plücker y la geometría de Grassmann, con el fin de evitar esas configuraciones en el espacio de trabajo de los manipuladores. Por el mismo método autores como Mouly [MOU. 93], Collins y Long [COL. 94], Notash y Podhorodeski [NOT. 94], Pasqui-Boutard [PAS. 94], Long [LON. 97], Hao y McCarthy [HAO. 98] y Notash [NOT. 98], estudian fundamentalmente las CIN por medio de la geometría de Grassmann.

A su vez, Gosselin y Angeles [GOS 90-1] clasifican las CIP y CIN

(singularity), teniendo en cuenta los valores de los determinantes de las matrices que relacionan las velocidades articulares de los actuadores y las velocidades lineales y angulares de la plataforma móvil, en tres tipos:

- Tipo I, coincide con la CIP. - Tipo II, coincide con la CIN. - Tipo III, cuando una configuración es al mismo tiempo CIP y CIN.

55

Page 76: Tesis

Configuraciones de Insensitividad.

Siguiendo la clasificación de Gosselin y Angeles varios autores como Funabashi, Horie, Kubota y Takeda [FUN. 91], Uchiyama [UCH. 94], Sefrioui y Gosselin [SEF. 94] y [SEF. 95], Gosselin y Wang [GOS. 95] y [GOS. 97], Mohammadi, Zsombor-Murray y Ángeles [MOH. 95], Chablat y Wenger [CHA 96], St-Onge y Gosselin [ST-O. 96] y Wang y Gosselin [WAN.J. 97], estudian las CIP y CIN de diversos tipos de manipuladores paralelos.

Al mismo tiempo, Gosselin [GOS. 90-2] relaciona las configuraciones

singulares con los mapas de rigidez de la plataforma móvil en todo el espacio de trabajo de los manipuladores paralelos.

De forma análoga, Tahmasebi y Tsai [TAH. 93] clasifican las

configuraciones singulares en: "Inverse kinematics singularities" y "Direct kinematics singularities" que coinciden con las CIP y las CIN respectivamente, o con las singularidades Tipo I y Tipo II de Gosselin y Angeles. A continuación, estudian esas configuraciones para un manipulador paralelo de tres brazos y 6 grados de libertad.

Por otro lado, Basu y Ghosal [BAS 96] estudian configuraciones

singularidades de un manipulador paralelo basándose en el método geométrico de la tangente común para las velocidades de los puntos de dos eslabones coincidentes en una articulación. Suponiendo que se elimine dicha articulación, para que las velocidades de los dos puntos tengan tangente común, los eslabones unidos por dicha articulación deben estar contenidos en el mismo plano, condición que se da en las CIP y CIN.

Mientras, Zlatanov, Fenton y Benhabib [ZLA. 94-1] a [ZLA. 98],

estudian seis tipos de singularidades para varios manipuladores paralelos. Singularidades que, como normalmente se dan dos al mismo tiempo, coinciden aproximadamente con la clasificación de tres tipos hecha por Gosselin y Angeles.

Innocenti y Parenti-Castelli [INN. 92] estudian las singularidades y el

paso entre zonas del espacio de trabajo limitadas por superficies de configuraciones singulares tanto en robots serie como en manipuladores paralelos.

Por último, otros autores como Clavel [CLA. 89], [CLA. 91] y

[CLA. 94], Pierrot [PIE. 91-4], Kumar [KUM. 92], Lee y Kim [LEE. 93], Lui, Lewis, Lebret y Taylor [LIU. 93], Ait-Ahmed [AIT. 93], Fioretti [FIO 94], Wang [WAN.S. 94], Tadokoro [TAD. 94], Vischer [VIS. 95], Zsombor-Murray, Husty y Hartmann [ZSO. 95], Ferrand y Renaud [FER. 95], Takeda y Funabashi [TAK. 95] y [TAK. 96], Merlet [MER. 96], Funabashi y Takeda

56

Page 77: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

[FUN. 97], Collins y McCarthy [COL. 97-1], [COL. 97-2] y [COL. 97-3], Nenchev y Uchiyama [NEN. 97-1] y [NEN. 98], Nenchev, Bhattacharya y Uchiyama [NEN 97-2], Dafaoui, Amirat, Pontnau y François [DAF. 98] y Dasgupta y Mruthyunjaya [DAS. 98-1] y [DAS. 98-2], han estudiado por algún método las CIP y CIN de algún manipulador paralelo.

No obstante, resulta importante constatar como, en los artículos

citados, se estudian normalmente con detenimiento las CIN con el fin de evitarlas en el espacio de trabajo y, como mucho, se cita que existen las CIP, sin hacer mención en ningún caso conocido, a su posible utilidad.

IV.2.1.1. - CIP y CIN en manipuladores paralelos 6-RKS Entre los estudios sobre configuraciones singulares CIP y CIN

realizados sobre manipuladores paralelos tipo 6-RKS, cabe señalar los siguientes:

- En el manipulador HEXA (Fig. III-6) por Pierrot, Uchiyama, Dauchez y

Fourier [PIE. 90], Pierrot, Dauchez y Fourier [PIE. 91-2] y [PIE. 91-3] y Uchiyama, Iimura, Pierrot, Dauchez, Unno y Toyama [UCH. 92]. En estos trabajos se estudian las configuraciones singulares distinguiendo dos tipos: "Undermobility", que coincide con las CIP, y "Overmobility", que coincide con las CIN. También, sobre este mismo manipulador, ha realizado estudios Begon [BEG. 95-2] basándose en los seis tipos de singularidades expuestos por Zlatanov y otros. Al final los reduce a dos tipos que los denomina: "Sous-movilité" y "Sur-movilité" que coinciden con las CIP y CIN respectivamente.

- En el prototipo construido y estudiado por Takeda, Funabashi e Ichimaru

[TAK. 97] (Fig. III-11 y III-12), realizan una optimización del manipulador y localizan las regiones de configuraciones singulares basándose en el índice de transmisión, índice que relaciona la velocidad angular de un actuador con la velocidad de la rótula de unión de la plataforma móvil con la biela correspondiente a ese actuador, y lo calculan para diferentes puntos del espacio de trabajo siguiendo un método aleatorio.

- En el prototipo 6-RKS estudiado por Plitea, Giordano y Benea

[BEN. 96-2] (Fig. III-9 y III-10), Benea realiza un estudio sobre las configuraciones singulares clasificándolas en Singularités de type 1 ("parallèles") que coinciden con las CIN y con las singularidades Tipo II de Gosselin y Angeles y Singularités de type 2 ("série") que coinciden con las CIP y con las singularidades Tipo I de Gosselin y Angeles. Para la

57

Page 78: Tesis

Configuraciones de Insensitividad.

localización de las singularidades utiliza un método numérico de cálculo del valor del determinante de la matriz jacobiana haciendo un mallado a través del espacio de trabajo que puede alcanzar la plataforma móvil. Como conclusiones, cita que se han encontrado 26 = 64 posiciones de singularidad que deberían poder ser evitadas.

En esta tesis se obtendrán las CIP por un método directo de paso de

una configuración a otra siguiendo un orden preestablecido. Además, se pondrá de manifiesto las ventajas de estas configuraciones, al contrario que los autores anteriores que las determinan con el fin de eliminarlas del espacio de trabajo.

IV.3 - CIP EN MANIPULADORES PARALELOS 6-RKS El Manipulador Paralelo 6-RKS de Hunt (Fig. IV-3 y IV-4) está

formado por una plataforma inferior fija sobre la que están montados seis actuadores con movimiento giratorio, y cuyos ejes de giro se encuentran en un plano paralelo a dicha plataforma, y una plataforma superior móvil conectada a los actuadores por medio de seis cadenas cinemáticas biela-manivela.

Fig. IV-3 Manipulador Paralelo 6-RKS de Hunt Los actuadores "R" están montados sobre la plataforma inferior, en los

lados de un imaginario triángulo. La plataforma superior también es un triángulo, en cada uno de cuyos vértices están conectadas dos bielas. Las bielas

58

Page 79: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

están conectadas por un extremo a las manivelas por medio de articulaciones cardan "K" y por el otro a la plataforma superior por medio de rótulas "S".

Fig. IV-4 Nomenclatura del Manipulador Paralelo 6-RKS de Hunt

La nomenclatura utilizada en la definición de la topología de este

manipulador (Fig. IV-4) es:

- 1i Centro de la articulación cardan del extremo de la manivela del actuador "i".

- 0i Punto del eje del actuador "i", en la base de la perpendicular trazada a dicho eje desde el punto "1i".

- Ri Longitud de la manivela correspondiente al actuador "i" y que une los puntos 0i con 1i

- Li Longitud de la biela correspondiente al actuador "i" y que une el punto "1i" con el correspondiente vértice de la plataforma móvil

- 1jk Centro de la rótula de la plataforma móvil donde se unen las bielas "j" y "k", para jk = [23, 45, 61].

- Apq Longitud del lado de la plataforma móvil entre las bielas "p" y "q", para pq = [12, 34, 56].

59

Page 80: Tesis

Configuraciones de Insensitividad.

Como una generalización de las configuraciones de insensitividad de posición (CIP) de los mecanismos planos de pistón-biela-manivela y manivela-oscilador, al estar constituida la estructura de los manipuladores 6-RKS por dos plataformas unidas por varias cadenas de actuador-manivela-biela, es lógico suponer que estos mecanismos poseerán CIP [ZAB. 99]. Estas configuraciones se darán cuando la posición de alguna cadena sea tal que el eje del actuador, la manivela y la biela se encuentren en el mismo plano. Esta posición de la cadena se denominará posición de insensitividad (PI).

De alguna manera, esta condición ya fue planteada por Harrisberger

[HAR. 64] y Freudenstein y Kiss [FRE. 69] como condición para determinar la posición límite en un cuadrilátero articulado espacial, por Nombrail [NOM. 93] al estudiar las singularidades tipo serie en los manipuladores con actuadores rotativos y por Benea [BEN. 96-2] al estudiar las singularidades tipo 2 ("Serie") en un manipulador 6-RKS.

Analizando las posibles posiciones del eje del actuador, la manivela y

la biela, se observa que cada cadena tendrá dos posiciones de insensitividad (PI) por encima de la plataforma fija: una cuando la manivela y biela estén casi en prolongación y otra cuando estén casi superpuestas (Fig. IV-5)4.

Fig. IV-5 Posiciones de Insensitividad sobre la Plataforma Fija

4 Se ha supuesto, en todos los desarrollos a lo largo de esta tesis, que la longitud de la biela es mayor que la de la manivela.

60

Page 81: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Cada cadena actuador-manivela-biela también tendrá dos PI similares a las anteriores por debajo de la plataforma fija (Fig. IV-6); pero estas dos posiciones normalmente no se utilizarán ya que, por lo general, no se podrán alcanzar sin desmontar el manipulador.

Fig. IV-6 Posiciones de Insensitividad bajo la Plataforma Fija

IV.3.1 - Configuraciones de insensitividad total y parcial El manipulador paralelo 6-RKS se encontrará en una configuración de

insensitividad total cuando sus seis cadenas cinemáticas de unión de las plataformas se encuentren en posición de insensitividad. En estas configuraciones, la plataforma móvil permanecerá fija aunque se introduzca movimiento por todos los actuadores. Y se encontrará en una configuración de insensitividad parcial cuando solamente algunas cadenas se encuentren en posición de insensitividad. En estos casos, la plataforma móvil permanecerá fija si el movimiento se introduce por los actuadores cuya cadena cinemática correspondiente se encuentre en posición de insensitividad.

Este manipulador tiene seis cadenas actuador-manivela-biela y cada

una tiene cuatro PI. Por lo tanto, cabría hablar teóricamente de 46 = 4096 posibles CIP totales (CIP-6) de la plataforma móvil frente a movimientos de todos los actuadores.

Sin embargo, si solamente se tienen en cuenta las dos posibles PI de

cada cadena sobre la plataforma fija (Fig. IV-5), ya que las combinaciones de PI

61

Page 82: Tesis

Configuraciones de Insensitividad.

sobre la plataforma con PI bajo la plataforma normalmente serán imposibles debido a la interferencia física de la plataforma móvil con la fija, se obtienen 26 = 64 CIP-6 de la plataforma fija. Valor que coincide con las 64 configuraciones de singularidad tipo 2 (serie) encontradas por Benea haciendo un mallado del espacio de trabajo del manipulador y calculando el valor del determinante de la matriz jacobiana que relaciona las velocidades articulares de los actuadores con las velocidades de la plataforma móvil.

Estas 64 CIP-6 de insensitividad total son configuraciones puntuales,

encontrándose los vértices de la plataforma móvil en la intersección de las superficies que describen los extremos de las bielas cuando su cadena correspondiente se encuentra en PI. También, como se verá más adelante, sobre estas superficies se encontrarán los vértices de la plataforma móvil correspondientes a las cadenas en PI en las CIP parciales del manipulador. Por lo tanto las CIP-6 se pueden considerar como intersección de CIP parciales.

Analizando el movimiento del extremo de la biela unido a la

plataforma móvil, es fácil deducir que las cuatro posibles PI de cada cadena actuador-manivela-biela se dan cuando el extremo de la biela está contenida en la superficie toroidal (Figs. IV-7 y IV-8). Esto es debido a que el extremo de la manivela describe una circunferencia contenida en un plano perpendicular al eje del actuador y a partir de esa circunferencia el extremo de la biela describe otra circunferencia contenida en el plano del eje del actuador y de la manivela, por lo tanto, contenida en un plano perpendicular en cada punto a la circunferencia primera, condiciones que cumplen las superficies toroidales.

Fig. IV-7 Superficie toroidal del extremo de la biela, sección

62

Page 83: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Fig. IV-8 Superficie toroidal del extremo de la biela, perspectiva Las dos PI sobre la plataforma, se dan cuando el extremo de la biela

está contenida en la superficie de la parte del toro que queda sobre la plataforma fija.

Considerando solamente el volumen del toro sobre la plataforma fija,

que será la zona donde realmente se podrá encontrar el vértice de la plataforma móvil correspondiente, si la cadena actuador-manivela-biela se encuentra en (PI), habrá dos posibles superficies donde se pueda encontrar dicho vértice, que serán las dos superficies toroidales (Fig. IV-9).

Fig. IV-9 Superficies toroidales sobre la plataforma fija

63

Page 84: Tesis

Configuraciones de Insensitividad.

Considerando todas las posibles PI de las seis cadenas, se podrán obtener 6 x 2 = 12 CIP en las que la plataforma móvil permanecerá fija si solamente se introduce movimiento por el actuador correspondiente a la cadena que se encuentre en PI, independientemente de la posición de los otros actuadores. Este tipo de configuración se denomina CPI-1, y en ellas el extremo de la biela en PI se encontrará en una porción de una superficie toroidal, dependiendo su posición de las posiciones de los otros actuadores. Por eso, estas CIP se consideran superficiales.

Para combinaciones de dos cadenas en PI habrá 60 CIP-2, en las que

la plataforma móvil permanecerá fija para entradas de movimiento simultáneo por dos actuadores cuyas cadenas correspondientes se encuentre en PI. De estas 60 CIP-2 habrá 48 que son superficiales, en las que el extremo de cada biela se encontrará sobre una porción de su superficie toroidal correspondiente, y 12 lineales, que se producirán cuando las cadenas actuador-manivela-biela en PI vayan unidas a un mismo vértice de la plataforma móvil. En este caso los extremos de las bielas en PI se encontrarán sobre las líneas de intersección de las superficies toroidales correspondientes (Figs. IV-10 y IV-11).

Fig. IV-10 Intersección de dos superficies toroidales con el plano horizontal

64

Page 85: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Fig. IV-11 Intersección de dos superficies toroidales, dos vistas Siguiendo con el razonamiento de los párrafos anteriores, se pueden

encontrar 120 CIP-3, 240 CIP-4 y 192 CIP-5, en las que los extremos de las bielas correspondientes a las cadenas que se encuentren en PI estarán situados en líneas o superficies, según vayan los extremos de esas bielas a unirse al mismo punto de la plataforma móvil o no. En estos casos la plataforma superior permanecerá inmóvil cuando se introduzca un determinado movimiento simultáneo por 3, 4 ó 5 manivelas adecuadas. Finalmente se tiene las 64 citadas CIP-6 ó CIP totales y que son las que en adelante se denominarán CIP.

Las 64 CIP son configuraciones de gran precisión de posición de la

plataforma superior móvil, pequeños errores en la posición de los actuadores apenas influyen en la posición de la plataforma móvil. En estas configuraciones se puede detener el manipulador evitando la aparición de grandes fuerzas de inercia debidas a las aceleraciones de detención. Y además los pares que aparecen en los ejes de los actuadores son nulos.

65

Page 86: Tesis

Configuraciones de Insensitividad.

De forma similar a las aplicaciones de los mecanismos de pistón-biela-manivela y manivela-oscilador en los que se aprovechan las CIP, los manipuladores basados en el 6-RKS de Hunt se pueden utilizar para posicionar piezas o herramientas cuyas diversas posiciones necesarias coincidan con las CIP del manipulador.

Aparte de estas 64 CIP, en el manipulador existen otras

configuraciones de incertidumbre de posición de la plataforma móvil; es decir, que la plataforma móvil puede realizar pequeños desplazamientos aunque los actuadores permanezcan inmóviles. Estas configuraciones son las llamadas CIN, y han sido ya objeto de estudio por un gran número de investigadores. Son configuraciones indeseables en el espacio de trabajo del manipulador ya que introducen grados de libertad adicionales al sistema, y en esta tesis no se entra en su estudio.

IV.3.2 - Determinación de las 64 CIP del Manipulador 6-RKS A lo largo de este subapartado, se llevará a cabo la determinación

analítica de las 64 CIP utilizando las coordenadas naturales definidas por García de Jalón y Bayo [GAR. 94] y tomando como origen de un único sistema de coordenadas el baricentro del triángulo formado por los ejes de los actuadores montados sobre la plataforma fija, con los ejes "X" e "Y" contenidos en el plano de los ejes de los actuadores, y con el eje "Y" paralelo al eje de los actuadores "1" y "2", (fig. IV-3).

Suponiendo conocidas las posiciones de los actuadores y las

longitudes de las manivelas, bielas y lados del triángulo de la plataforma móvil, y utilizando la nomenclatura introducida en el apartado IV-3. Para las longitudes constantes de las manivelas se pueden establecer las siguientes condiciones de restricción:

( ) ( ) ( ) 0RZZYYXX 2

12

01112

01112

0111 =−−+−+− (IV-1) ( ) ( ) ( ) 0RZZYYXX 2

22

02122

02122

0212 =−−+−+− (IV-2) ( ) ( ) ( ) 0RZZYYXX 2

32

03132

03132

0313 =−−+−+− (IV-3) ( ) ( ) ( ) 0RZZYYXX 2

42

04142

04142

0414 =−−+−+− (IV-4) ( ) ( ) ( ) 0RZZYYXX 2

52

05152

05152

0515 =−−+−+− (IV-5) ( ) ( ) ( ) 0RZZYYXX 2

62

06162

06162

0616 =−−+−+− (IV-6)

66

Page 87: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Para evitar, en lo posible, la interferencia de la biela con el eje del actuador la manivela ha de tener una cierta inclinación tal y como se observa en la Fig. IV-12. Por ello, los puntos 01 a 06 no son propiamente los de unión de las manivelas con los ejes de los actuadores, sino que están sobre las perpendiculares a dichos ejes trazadas desde los puntos de unión biela-manivela y se toman así para simplificar los cálculos.

Fig. IV-12 Puntos de unión manivela-eje del actuador

De forma análoga, para las longitudes constantes de las bielas se establecen las siguientes condiciones de restricción:

( ) ( ) ( ) 0LZZYYXX 2

12

111612

111612

11161 =−−+−+− (IV-7) ( ) ( ) ( ) 0LZZYYXX 2

22

121232

121232

12123 =−−+−+− (IV-8) ( ) ( ) ( ) 0LZZYYXX 2

32

131232

131232

13123 =−−+−+− (IV-9) ( ) ( ) ( ) 0LZZYYXX 2

42

141452

141452

14145 =−−+−+− (IV-10) ( ) ( ) ( ) 0LZZYYXX 2

52

151452

151452

15145 =−−+−+− (IV-11) ( ) ( ) ( ) 0LZZYYXX 2

62

161612

161612

16161 =−−+−+− (IV-12) A su vez, para las longitudes constantes de los lados del triángulo de

la plataforma móvil se tendrá:

( ) ( ) ( ) 0AZZYYXX 212

2123161

2123161

2123161 =−−+−+− (IV-13)

( ) ( ) ( ) 0AZZYYXX 234

2123145

2123145

2123145 =−−+−+− (IV-14)

( ) ( ) ( ) 0AZZYYXX 256

2145161

2145161

2145161 =−−+−+− (IV-15)

67

Page 88: Tesis

Configuraciones de Insensitividad.

Los puntos 11 a 16, que son los extremos de las manivelas, describen circunferencias en planos perpendiculares a los ejes de los actuadores (Fig. IV-4). Para expresar la perpendicularidad entre el radio de la circunferencia y el eje del actuador correspondiente, teniendo en cuenta que los ejes de los actuadores "1" y "2" son coincidentes y lo mismo ocurre para los actuadores "3" y "4" y para los actuadores "5" y "6", se plantean las condiciones de restricción siguientes:

0)ZZ)·(ZZ()YY)·(YY()XX)·(XX(

01020111

0102011101020111

=−−+−−+−−

(IV-16)

0)ZZ)·(ZZ()YY)·(YY()XX)·(XX(

01020212

0102021201020212

=−−+−−+−−

(IV-17)

0)ZZ)·(ZZ()YY)·(YY()XX)·(XX(

03040313

0304031303040313

=−−+−−+−−

(IV-18)

0)ZZ)·(ZZ()YY)·(YY()XX)·(XX(

03040414

0304041403040414

=−−+−−+−−

(IV-19)

0)ZZ)·(ZZ()YY)·(YY()XX)·(XX(

05060515

0506051505060515

=−−+−−+−−

(IV-20)

0)ZZ)·(ZZ()YY)·(YY()XX)·(XX(

05060616

0506061605060616

=−−+−−+−−

(IV-21)

Finalmente, cada cadena cinemática actuador-manivela-biela estará en

posición de insensitividad cuando el producto mixto de tres vectores orientados respectivamente según el eje del actuador, la manivela y la biela sea cero, ya que los tres deben estar contenidos en el mismo plano:

0)XX)·(YY)·(ZZ()YY)·(XX)·(ZZ()ZZ)·(XX)·(YY()XX)·(ZZ)·(YY()YY)·(ZZ)·(XX()ZZ)·(YY)·(XX(

11161011101021116101110102

11161011101021116101110102

11161011101021116101110102

=−−−−−−−+−−−−−−−+−−−−−−−

(IV-22)

68

Page 89: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

0)XX)·(YY)·(ZZ()YY)·(XX)·(ZZ()ZZ)·(XX)·(YY()XX)·(ZZ)·(YY()YY)·(ZZ)·(XX()ZZ)·(YY)·(XX(

12123021201021212302120102

12123021201021212302120102

12123021201021212302120102

=−−−−−−−+−−−−−−−+−−−−−−−

(IV-23)

0)XX)·(YY)·(ZZ()YY)·(XX)·(ZZ()ZZ)·(XX)·(YY()XX)·(ZZ)·(YY()YY)·(ZZ)·(XX()ZZ)·(YY)·(XX(

13123031303041312303130304

13123031303041312303130304

13123031303041312303130304

=−−−−−−−+−−−−−−−+−−−−−−−

(IV-24)

0)XX)·(YY)·(ZZ()YY)·(XX)·(ZZ()ZZ)·(XX)·(YY()XX)·(ZZ)·(YY()YY)·(ZZ)·(XX()ZZ)·(YY)·(XX(

14145041403041414504140304

14145041403041414504140304

14145041403041414504140304

=−−−−−−−+−−−−−−−+−−−−−−−

(IV-25)

0)XX)·(YY)·(ZZ()YY)·(XX)·(ZZ()ZZ)·(XX)·(YY()XX)·(ZZ)·(YY()YY)·(ZZ)·(XX()ZZ)·(YY)·(XX(

15145051505061514505150506

15145051505061514505150506

15145051505061514505150506

=−−−−−−−+−−−−−−−+−−−−−−−

(IV-26)

0)XX)·(YY)·(ZZ()YY)·(XX)·(ZZ()ZZ)·(XX)·(YY()XX)·(ZZ)·(YY()YY)·(ZZ)·(XX()ZZ)·(YY)·(XX(

16161061605061616106160506

16161061605061616106160506

16161061605061616106160506

=−−−−−−−+−−−−−−−+−−−−−−−

(IV-27)

Las condiciones de restricción anteriores, ecuaciones de la (IV-1) a la

(IV-27), forman un sistema de 27 ecuaciones, con 27 incógnitas, que debe cumplir el manipulador para estar en una configuración de insensitividad de posición CIP, y que se pueden expresar abreviadamente como:

Φ(q) = 0 (IV-28)

69

Page 90: Tesis

Configuraciones de Insensitividad.

siendo "q" el vector de las 27 incógnitas correspondientes a las coordenadas "X", "Y" y "Z" de los tres vértices de la plataforma móvil (puntos 123, 145 y 161) y de los extremos de las seis manivelas (puntos 11 a 16).

Sistema de ecuaciones que se resolverá mediante la aplicación del

método de Newton-Raphson.

Φ ( ) = Φqi q( q )·( - ) (IV-29) i qi q 1i+

Tomando una posición aproximada de los puntos de unión de las

manivelas con las bielas y de los vértices de la plataforma móvil para iniciar la primera iteración, se logra una CIP. Determinada una CIP, para ir calculando el resto, se gira una manivela 180º, por ejemplo en 6 etapas de 30º, haciendo que las otras cinco cadenas actuador-manivela-biela se coloquen en PI al final de cada etapa. Partiendo de esta configuración, en la que se tiene cinco cadenas actuador-manivela-biela en posición de insensitividad y un conjunto girado 180º, de nuevo por Newton-Raphson, se localiza una nueva CIP de la plataforma móvil. Repitiendo esta operación con todas las cadenas actuador-manivela-biela las veces necesarias, y siguiendo un orden preestablecido, se consiguen las 64 CIP de la plataforma móvil.

El giro de la manivela de la cadena que se quiere pasar de una PI a

otra, se hace en varias etapas debido a que si, por ejemplo, se efectúa un giro de 180º de una sola vez, al buscar la nueva CIP del manipulador por el método de Newton-Raphson, la solución no converge a la nueva configuración deseada sino a la configuración anterior, o sea a la configuración de la que se ha partido. Esto es debido a que la solución encontrada por el método de Newton-Raphson depende de los valores con los que se inicie la iteración, de ahí la importancia de tomar unos valores iniciales lo más próximos posibles a la solución buscada.

IV.3.3 - Comprobación de las 64 configuraciones logradas La comprobación de que las configuraciones logradas son CIP se hace

determinando que las velocidades de los vértices de la plataforma móvil son nulas independientemente de las velocidades de giro de los actuadores, o lo que es lo mismo, de las velocidades de los extremos de las manivelas (puntos 11 a 16).

Tomando las seis ecuaciones de restricción (IV-7) a (IV-12) de

longitud constante de las bielas y las tres de longitud constante de los lados de la plataforma móvil (IV-13) a (IV-15), derivándolas respecto del tiempo y ordenando los términos se llega al siguiente sistema de ecuaciones:

70

Page 91: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

−−−−−−

−−−−−−

−−−−−−

−−−

−−−

−−−

−−−

−−−

−−−

Z

Y

X

Z

Y

X

Z

Y

X

·

ZZYYXXZZYYXX000

000ZZYYXXZZYYXX

ZZYYXX000ZZYYXX

ZZYYXX000000ZZYYXX000000

000ZZYYXX000

000ZZYYXX000

000000ZZYYXX

000000ZZYYXX

161

161

161

145

145

145

123

123

123

145161145161145161161145161145161145

123145123145123145145123145123145123

123161123161123161161123161123161123

111611116111161

161611616116161

151451514515145

141451414514145

131231312313123

121231212312123

&

&

&

&

&

&

&

&

&

=

= (IV-30)

−+−+−

−+−+−

−+−+−

−+−+−

−+−+−

−+−+−

0

0

0Z)·ZZ(Y)·YY(X)·XX(Z)·ZZ(Y)·YY(X)·XX(Z)·ZZ(Y)·YY(X)·XX(Z)·ZZ(Y)·YY(X)·XX(Z)·ZZ(Y)·YY(X)·XX(Z)·ZZ(Y)·YY(X)·XX(

111116111111611111161

161616116161611616161

151514515151451515145

141414514141451414145

131312313131231313123

121212312121231212123

&&&

&&&

&&&

&&&

&&&

&&&

El sistema de ecuaciones (IV-30) relaciona las velocidades de los

vértices de la plataforma móvil con las velocidades de los puntos extremos de las manivelas. Tomando, por ejemplo, la primera fila de este sistema de ecuaciones:

Z)·ZZ(Y)·YY(X)·XX( Z)·ZZ(Y)·YY(X)·XX(

121212312121231212123

123121231231212312312123

&&&

&&&

−+−+−=

=−+−+− (IV-31)

Se observa que el término de la derecha es cero si la cadena "2" se

encuentra en PI, ya que es el desarrollo del producto escalar de un vector en la dirección de la biela "2" con el vector velocidad del extremo de la manivela "2". La velocidad del extremo de la manivela es perpendicular a ésta y al eje del actuador, por lo tanto perpendicular al plano formado por ellos, y en el que estará contenida la biela.

Luego, si el término de la derecha es nulo, deben ser nulas las

velocidades , y del vértice de la plataforma, ya que el término de X123& Y123& Z123&

71

Page 92: Tesis

Configuraciones de Insensitividad.

la izquierda de la ecuación representa el desarrollo del producto escalar de un vector en la dirección de la biela "2", con el vector velocidad del punto "123" que son dos vectores cuyo producto escalar no tiene por que ser nulo.

En efecto, el vector velocidad del extremo de una biela, como ésta no

gira alrededor de un punto fijo como la manivela, sino que su movimiento viene impuesto por las otras cinco cadenas cinemáticas actuador-manivela-biela, en principio puede tener cualquier dirección. Por lo tanto, si el producto escalar del vector velocidad con un vector no nulo en la dirección de la biela es cero, en el caso más general, debe ser cero el vector velocidad.

Haciendo este mismo razonamiento con las seis primeras filas del

sistema de ecuaciones (IV-30) se llega a la conclusión que si el eje del actuador, la manivela y la biela se encuentran en el mismo plano, esa cadena cinemática se encuentra en PI, y si se cumple para las seis cadenas a la vez, el manipulador se encontrará en una CIP.

IV.4 - EJEMPLO NUMÉRICO

En este apartado, por medio del programa INSENSI5, se calcularán las 64 configuraciones de insensitividad de posición (CIP) de la plataforma móvil para un manipulador de unas dimensiones dadas y se demostrará que las CIP logradas, comprobándolo para dos de ellas, son realmente de insensitividad. Para ello, dadas unas determinadas velocidades giratorias de las manivelas, se calcularán las velocidades de los vértices de la plataforma móvil en las dos CIP, comprobándose que son nulas.

Para determinar las 64 CIP, se toma un manipulador paralelo 6-RKS (Fig. IV-13) en el que los ejes de los actuadores montados sobre la plataforma fija forman un triángulo equilátero de un metro de lado. Los actuadores están montados simétricamente respecto de los ejes de simetría del triángulo, siendo 0.1 metros la distancia entre los puntos de las manivelas que están sobre los ejes de los actuadores de un mismo lado del triángulo, o sea las distancias de los puntos "01" a "02", "03" a "04" y "05" a "06". Las manivelas son todas iguales con una longitud de 0.1 metros, las bielas son también todas iguales de 0.6 metros de longitud, y la plataforma móvil será un triángulo equilátero de 0.5 metros de lado.

5 INSENSI, programa realizado en Matlab para la determinación y comprobación de las configuraciones de insensitividad (CIP) por el método iterativo de Newton-Raphson.

72

Page 93: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Con los datos y condiciones anteriores, y tomando como origen de coordenadas el baricentro del triángulo equilátero formado por los ejes actuadores, con los ejes "X" e "Y" contenidos en plano de los actuadores, el eje "Y" paralelo a los ejes de actuadores "1" y "2" y con el eje "Z" hacia la plataforma móvil, se tendrá las coordenadas de los puntos siguientes:

01 = (-0.288675134, -0.05, 0) 02 = (-0.288675134, 0.05, 0) 03 = (0.101036297, 0.275, 0) 04 = (0.187638837, 0.225, 0) 05 = (0.187638837, -0.225, 0) 06 = (0.101036297, -0.275, 0)

Fig. IV-13 Manipulador Paralelo 6-RKS

73

Page 94: Tesis

Configuraciones de Insensitividad.

IV.4.1 - Cálculo de la primera configuración de insensitividad

Siguiendo el proceso expuesto en el apartado IV.3.2 para la obtención de las configuraciones de insensitividad, teniendo en cuenta la geometría del manipulador de este ejemplo, se tendrá las 27 ecuaciones de restricción siguientes:

( ) ( ) ( ) 0RZZYYXX 2

12

01112

01112

0111 =−−+−+− (IV-32) ( ) ( ) ( ) 0RZZYYXX 2

22

02122

02122

0212 =−−+−+− (IV-33) ( ) ( ) ( ) 0RZZYYXX 2

32

03132

03132

0313 =−−+−+− (IV-34) ( ) ( ) ( ) 0RZZYYXX 2

42

04142

04142

0414 =−−+−+− (IV-35) ( ) ( ) ( ) 0RZZYYXX 2

52

05152

05152

0515 =−−+−+− (IV-36) ( ) ( ) ( ) 0RZZYYXX 2

62

06162

06162

0616 =−−+−+− (IV-37) ( ) ( ) ( ) 0LZZYYXX 2

12

111612

111612

11161 =−−+−+− (IV-38) ( ) ( ) ( ) 0LZZYYXX 2

22

121232

121232

12123 =−−+−+− (IV-39) ( ) ( ) ( ) 0LZZYYXX 2

32

131232

131232

13123 =−−+−+− (IV-40) ( ) ( ) ( ) 0LZZYYXX 2

42

141452

141452

14145 =−−+−+− (IV-41) ( ) ( ) ( ) 0LZZYYXX 2

52

151452

151452

15145 =−−+−+− (IV-42) ( ) ( ) ( ) 0LZZYYXX 2

62

161612

161612

16161 =−−+−+− (IV-43) ( ) ( ) ( ) 0AZZYYXX 2

122

1231612

1231612

123161 =−−+−+− (IV-44) ( ) ( ) ( ) 0AZZYYXX 2

342

1231452

1231452

123145 =−−+−+− (IV-45) ( ) ( ) ( ) 0AZZYYXX 2

562

1451612

1451612

145161 =−−+−+− (IV-46) 0YY 0111 =− (IV-47) 0YY 0212 =− (IV-48)

( ) ( 0YYXX3 03130313 =−−−⋅ ) (IV-49) ( ) ( 0YYXX3 04140414 =−−−⋅ ) (IV-50) ( ) ( 0YYXX3 05150515 =−−−⋅ ) (IV-51) ( ) ( 0YYXX3 06160616 =−−−⋅ ) (IV-52)

( ) ( ) ( ) ( ) 0ZZXXXXZZ 111610111111610111 =−⋅−−−⋅− (IV-53) ( ) ( ) ( ) ( ) 0ZZXXXXZZ 121230212121230212 =−⋅−−−⋅− (IV-54)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

131230313131230313

131230313131230313

=−−+−−

+−−−−−− (IV-55)

74

Page 95: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

141450414141450414

141450414141450414

=−−+−−

+−−−−−− (IV-56)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

151450515151450515

151450515151450515

=−−+−−

+−−−−−− (IV-57)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

161610616161610616

161610616161610616

=−−+−−

+−−−−−− (IV-58)

IV.4.1.1 - Resolución del sistema

Tomando una posición aproximada para iniciar la primera iteración, por ejemplo, suponiendo que las seis manivelas están verticales hacia arriba y la plataforma móvil centrada con su centro de gravedad sobre el eje "Z" y con sus vértices en unas coordenadas "Z" de 0.7 metros, igual a la suma de longitudes de una biela y una manivela, resolviendo el sistema de 27 ecuaciones, (IV-32) a (IV-58), por medio del programa "INSENSI", se obtendrá una CIP en la que los puntos de unión manivela-biela de los seis conjuntos se encontrarán por encima de la plataforma fija. En este caso, debido a la simetría del mecanismo, la plataforma móvil se encontrará horizontal. IV.4.1.2 - Solución

Una vez resuelto el sistema, las coordenadas de los puntos de unión de las manivelas con las bielas serán los siguientes:

11 = (-0.266992585, -0.05, 0.097621038) 12 = (-0.266992585, 0.05, 0.097621038) 13 = (0.090195022, 0.256222361, 0.097621038) 14 = (0.176797562, 0.206222361, 0.097621038) 15 = (0.176797562, -0.206222361, 0.097621038) 16 = (0.090195022, -0.256222361, 0.097621038)

Y las coordenadas de los vértices de la plataforma móvil:

123 = (-0.144337567, 0.25, 0.649849022) 145 = (0.288675134, 0, 0.649849022) 161 = (-0.144337567, -0.25, 0.649849022)

75

Page 96: Tesis

Configuraciones de Insensitividad.

IV.4.2 - Cálculo de las 64 configuraciones de insensitividad de posición

Una vez determinada la primera CIP, en la que los ángulos de la manivelas son los correspondientes a la primera fila de la tabla (IV-1), girando las manivelas de una PI a otra, siguiendo un orden conveniente establecido en el programa INSENSI, se conseguirán las otras 63 CIP.

Ángulo de la manivela

"1" θ1

Ángulo de la manivela

"2" θ2

Ángulo de la manivela

"3" θ3

Ángulo de la manivela

"4" θ4

Ángulo de la manivela

"5" θ5

Ángulo de la manivela

"6" θ6

1 1.3522 1.3522 1.3522 1.3522 1.3522 1.3522 2 4.825 1.4474 1.4474 1.2347 1.2347 0.9229 3 4.9521 4.9521 1.0298 1.1394 1.1394 1.0298 4 1.4474 4.825 0.9229 1.2347 1.2347 1.4474 5 1.3522 4.3514 4.3514 1.3522 1.3522 1.3522 6 4.8537 4.4862 4.4862 1.2178 1.2178 0.9461 7 4.6973 0.9924 4.9091 1.2852 1.2852 0.8248 8 1.2347 0.9229 4.825 1.4474 1.4474 1.2347 9 1.1394 1.0298 4.9521 4.9521 1.0298 1.1394

10 4.6182 1.1538 5.0854 4.8032 0.9055 0.7682 11 4.7222 4.67 4.67 4.7222 0.8432 0.8432 12 1.2178 4.4862 4.4862 4.8537 0.9461 1.2178 13 1.2852 4.9091 0.9924 4.6973 0.8248 1.2852 14 4.8032 5.0854 1.1538 4.6182 0.7682 0.9055 15 4.7222 1.5806 1.5806 4.7222 0.8432 0.8432 16 1.2347 1.4474 1.4474 4.825 0.9229 1.2347 17 1.3522 1.3522 1.3522 4.3514 4.3514 1.3522 18 4.8424 1.4201 1.4201 4.2454 4.2454 0.9369 19 4.9521 4.9521 1.0298 4.1356 4.1356 1.0298 20 1.4201 4.8424 0.9369 4.2454 4.2454 1.4201 21 1.3137 4.3973 4.3973 4.3973 4.3973 1.3137 22 4.8347 4.5166 4.5166 4.2513 4.2513 0.9307 23 4.6911 1.0104 4.93 4.3322 4.3322 0.8203 24 1.2178 0.9461 4.8537 4.4862 4.4862 1.2178 25 1.2852 0.8248 4.6973 0.9924 4.9091 1.2852 26 4.7111 0.835 4.7111 0.835 4.7111 0.835 27 4.93 4.3322 4.3322 0.8203 4.6911 1.0104 28 1.4201 4.2454 4.2454 0.9369 4.8424 1.4201 29 1.5806 4.7222 0.8432 0.8432 4.7222 1.5806

76

Page 97: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

30 5.0854 4.8032 0.9055 0.7682 4.6182 1.1538 31 4.9091 1.2852 1.2852 0.8248 4.6973 0.9924 32 1.4474 1.2347 1.2347 0.9229 4.825 1.4474 33 1.0298 1.1394 1.1394 1.0298 4.9521 4.9521 34 4.4862 1.2178 1.2178 0.9461 4.8537 4.4862 35 4.67 4.7222 0.8432 0.8432 4.7222 4.67 36 1.1538 4.6182 0.7682 0.9055 4.8032 5.0854 37 1.0298 4.1356 4.1356 1.0298 4.9521 4.9521 38 4.5166 4.2513 4.2513 0.9307 4.8347 4.5166 39 4.3322 0.8203 4.6911 1.0104 4.93 4.3322 40 0.9055 0.7682 4.6182 1.1538 5.0854 4.8032 41 0.8432 0.8432 4.7222 4.67 4.67 4.7222 42 4.2513 0.9307 4.8347 4.5166 4.5166 4.2513 43 4.3973 4.3973 4.3973 4.3973 4.3973 4.3973 44 0.9307 4.2513 4.2513 4.5166 4.5166 4.8347 45 1.0104 4.6911 0.8203 4.3322 4.3322 4.93 46 4.5166 4.8347 0.9307 4.2513 4.2513 4.5166 47 4.3973 1.3137 1.3137 4.3973 4.3973 4.3973 48 0.9461 1.2178 1.2178 4.4862 4.4862 4.8537 49 0.8248 1.2852 1.2852 4.9091 0.9924 4.6973 50 4.2454 1.4201 1.4201 4.8424 0.9369 4.2454 51 4.3322 4.93 1.0104 4.6911 0.8203 4.3322 52 0.835 4.7111 0.835 4.7111 0.835 4.7111 53 0.8203 4.3322 4.3322 4.93 1.0104 4.6911 54 4.2513 4.5166 4.5166 4.8347 0.9307 4.2513 55 4.1356 1.0298 4.9521 4.9521 1.0298 4.1356 56 0.7682 0.9055 4.8032 5.0854 1.1538 4.6182 57 0.8432 0.8432 4.7222 1.5806 1.5806 4.7222 58 4.2454 0.9369 4.8424 1.4201 1.4201 4.2454 59 4.3973 4.3973 4.3973 1.3137 1.3137 4.3973 60 0.9369 4.2454 4.2454 1.4201 1.4201 4.8424 61 0.9924 4.6973 0.8248 1.2852 1.2852 4.9091 62 4.4862 4.8537 0.9461 1.2178 1.2178 4.4862 63 4.3514 1.3522 1.3522 1.3522 1.3522 4.3514 64 0.9229 1.2347 1.2347 1.4474 1.4474 4.825

Tabla IV-1 Ángulos de las manivelas en las 64 CIP

77

Page 98: Tesis

Configuraciones de Insensitividad.

Las coordenadas de los vértices de la plataforma móvil en las 64 CIP serán los siguientes:

X 123 Y 123 123 X 145 Y 145 Z 145 161 Y 161 Z 161

1 0.25 0.6498 0.2887 0 0.6498 -0.1443 -0.25 2 -0.2139 0.3706 0.6026 0.117 0 -0.3447 -0.0999 0.4948 3 -0.3993 0.25 -0.006 0 0.6335 -0.3993 -0.25 0.4524

-0.3447 0.0999 0.4948 0.117 0 0.6587 -0.2139 0.6026 5 -0.1194 0.2069 0.4482 0.2887 0.6498 -0.1443 -0.25 0.6498 6 -0.1925 0.4179 0.094 0 0.6561 -0.3583 -0.1328 0.4893 7 0.0195 0.4307 0.4721 0.1891 0 0.6612 0.0318 0.4943 8 0.0858 0.3484 0.4948 0 0.6026 -0.0585 -0.1013 0.6587 9 0.4708 0.4524 0.4161 0.2208 0.4524 0.003 0.0052 10 -0.1278 0.5712 0.3631 0.2324 0.2515 -0.2434 0.0988 0.4791 11 -0.275 0.4763 0.1395 0.2584 0.4971 -0.2935 0.0084 0.4971

-0.1925 0.3335 0.4179 0.2942 0.2439 0.4893 -0.047 0.6561 13 -0.3827 0.1984 0.4721 0.113 0.4943 -0.0945 -0.1637 0.6612 14 -0.4308 0.3631 0.0361 0.2602 0.4791 -0.334 -0.0755 0.4974

Z X

-0.1443 0.6498 0.6587

0.4524 4 -0.3706

0 0.3335

-0.2812 0.4279

-0.0169 0.6335 0.4974

0.3219 12 -0.0814

0.2594 0.3963

15 -0.2935 0.5083 0.4872 0.1395 0.2584 0.4971 -0.2935 0.0084 0.4971 16 -0.2139 0.3706 0.6026 0.2588 0.2485 0.4948 -0.0585 -0.1013 0.6587 17 0.25 0.6498 0.2389 0 0.4482 -0.1443 -0.25 18 -0.1945 0.3369 0.6198 0.1301

-0.1443 0.6498 0 0.4435 -0.353 -0.1197 0.4918

19 -0.3993 0.25 0.4524 0.0325 0 0.4188 -0.3993 -0.25 0.4524 20 -0.353 0.1197 0.4918 0.1301 0 0.4435 -0.1945 -0.3369 0.6198 21 -0.1443 0.25 0.4428 0.2887 0 0.4428 -0.1155 -0.2001 0.6585 22 -0.2083 0.3607 0.4054 0.1358 0 0.4444 -0.3493 -0.1109 0.4932 23 0.0019 0.4505 0.4632 0.2184 0 0.4491 -0.2782 0.0374 0.4935 24 0.0641 0.3767 0.4893 0.385 0 0.4179 -0.047 -0.0814 0.6561 25 0.1682 0.2276 0.4943 0.3632 -0.2322 0.4721 -0.0945 -0.1637 0.6612 26 0.1604 0.24 0.496 0.1276 -0.2589 0.496 -0.2881 0.0189 0.496 27 -0.1092 0.1892 0.4491 0.1067 -0.2596 0.4935 -0.3911 -0.2236 0.4632 28 -0.0651 0.1127 0.4435 0.2801 -0.2458 0.4918 -0.1945 -0.3369 0.6198 29 -0.2935 -0.0084 0.4971 0.1395 -0.2584 0.4971 -0.2935 -0.5083 0.4872 30 -0.334 0.0755 0.4974 0.0361 -0.2602 0.4791 -0.4308 -0.3963 0.3631 31 -0.0945 0.1637 0.6612 0.113 -0.2594 0.4943 -0.3827 -0.1984 0.4721 32 -0.0585 0.1013 0.6587 0.2588 -0.2485 0.4948 -0.2139 -0.3706 0.6026 33 0.003 -0.0052 0.6335 0.4161 -0.2208 0.4524 -0.0169 -0.4708 0.4524 34 -0.047 0.0814 0.6561 0.2942 -0.2439 0.4893 -0.1925 -0.3335 0.4179 35 -0.2935 -0.0084 0.4971 0.1395 -0.2584 0.4971 -0.275 -0.4763 0.3219 36 -0.2434 -0.0988 0.4791 0.2324 -0.2515 0.4974 -0.1278 -0.5712 0.3631 37 -0.0162 0.0281 0.4188 0.4161 -0.2208 0.4524 -0.0169 -0.4708 0.4524 38 -0.0679 0.1176 0.4444 0.2707 -0.2471 0.4932 -0.2083 -0.3607 0.4054 39 0.1715 0.2222 0.4935 0.3892 -0.2269 0.4632 -0.1092 -0.1892 0.4491 40 0.2073 0.1614 0.4791 0.5586 -0.1749 0.3631 0.1016 -0.327 0.4974 41 0.154 0.25 0.4971 0.55 0 0.3219 0.154 -0.25 0.4971

78

Page 99: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

42 0.0786 0.3579 0.4932 0.4165 0 0.4054 -0.0679 -0.1176 0.4444 43 -0.1443 0.25 0.4428 0.2887 0 0.4428 -0.1443 -0.25 0.4428 44 -0.0679 0.1176 0.4444 0.4165 0 0.4054 0.0786 -0.3579 0.4932 45 -0.2782 -0.0374 0.4935 0.2184 0 0.4491 0.0019 -0.4505 0.4632 46 -0.3493 0.1109 0.4932 0.1358 0 0.4444 -0.2083 -0.3607 0.4054 47 -0.1155 0.2001 0.6585 0.2887 0 0.4428 -0.1443 -0.25 0.4428 48 -0.047 0.0814 0.6561 0.385 0 0.4179 0.0641 -0.3767 0.4893 49 -0.0945 0.1637 0.6612 0.3632 0.2322 0.4721 0.1682 -0.2276 0.4943 50 -0.1945 0.3369 0.6198 0.2801 0.2458 0.4918 -0.0651 -0.1127 0.4435 51 -0.3911 0.2236 0.4632 0.1067 0.2596 0.4935 -0.1092 -0.1892 0.4491 52 -0.2881 -0.0189 0.496 0.1276 0.2589 0.496 0.1604 -0.24 0.496 53 -0.1092 0.1892 0.4491 0.3892 0.2269 0.4632 0.1715 -0.2222 0.4935 54 -0.2083 0.3607 0.4054 0.2707 0.2471 0.4932 -0.0679 -0.1176 0.4444 55 -0.0169 0.4708 0.4524 0.4161 0.2208 0.4524 -0.0162 -0.0281 0.4188 56 0.1016 0.327 0.4974 0.5586 0.1749 0.3631 0.2073 -0.1614 0.4791 57 0.154 0.25 0.4971 0.5869 0 0.4872 0.154 -0.25 0.4971 58 0.0728 0.3655 0.4918 0.3891 0 0.6198 -0.0651 -0.1127 0.4435 59 -0.1443 0.25 0.4428 0.2311 0 0.6585 -0.1443 -0.25 0.4428 60 -0.0651 0.1127 0.4435 0.3891 0 0.6198 0.0728 -0.3655 0.4918 61 -0.2812 -0.0318 0.4943 0.1891 0 0.6612 0.0195 -0.4307 0.4721 62 -0.3583 0.1328 0.4893 0.094 0 0.6561 -0.1925 -0.3335 0.4179 63 -0.1443 0.25 0.6498 0.2887 0 0.6498 -0.1194 -0.2069 0.4482 64 -0.0585 0.1013 0.6587 0.4279 0 0.6026 0.0858 -0.3484 0.4948

Tabla IV-2 Coordenadas de los vértices de la Plataforma móvil en las 64 CIP

En la tabla IV-3, en las páginas siguientes, se representan las 64 configuraciones de insensitividad de posición que puede adoptar el Manipulador Paralelo 6-RKS del ejemplo que se está considerando en este apartado.

La numeración sobre la plataforma móvil indica la posición de los

extremos de las manivelas. Por ejemplo, "1-0-1-0-1-0" representa que los extremos de las manivelas "1", "3" y "5" se encuentran sobre la plataforma fija y los de las manivelas "2", "4" y "6" se encuentran por debajo de dicha plataforma.

79

Page 100: Tesis

Configuraciones de Insensitividad.

80

Page 101: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

81

Page 102: Tesis

Configuraciones de Insensitividad.

82

Page 103: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

83

Page 104: Tesis

Configuraciones de Insensitividad.

84

Page 105: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

85

Page 106: Tesis

Configuraciones de Insensitividad.

86

Page 107: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Tabla IV-3 64 configuraciones de insensitividad de posición

87

Page 108: Tesis

Configuraciones de Insensitividad.

IV.4.3 - Cálculo de velocidades

Como comprobación de que las configuraciones logradas, son configuraciones de insensitividad de posición, se calcularán las velocidades de los vértices de la plataforma móvil para unas velocidades cualesquiera de las manivelas y se verificará si son nulas, condición que se debe cumplir en las CIP.

Las velocidades de los puntos de unión de las manivelas con las

bielas, para unas determinadas velocidades angulares de los manivelas "ω1", "ω2", "ω3", "ω4", "ω5" y "ω6", serán:

Vx11 = - ω1 R1 sin θ1 (IV-59) Vx12 = - ω2 R2 sin θ2 (IV-60) Vx13 = 0.5 ω3 R3 sin θ3 (IV-61) Vx14 = 0.5 ω4 R4 sin θ4 (IV-62) Vx15 = 0.5 ω5 R5 sin θ5 (IV-63) Vx16 = 0.5 ω6 R6 sin θ6 (IV-64) Vy11 = 0 (IV-65) Vy12 = 0 (IV-66) Vy13 = 3 /2 ω3 R3 sin θ3 (IV-67) Vy14 = 3 /2 ω4 R4 sin θ4 (IV-68) Vy15 = - 3 /2 ω5 R5 sin θ5 (IV-69) Vy16 = - 3 /2 ω6 R6 sin θ6 (IV-70) Vz11 = ω1 R1 cos θ1 (IV-71) Vz12 = ω2 R2 cos θ2 (IV-72) Vz13 = ω3 R3 cos θ3 (IV-73) Vz14 = ω4 R4 cos θ4 (IV-74) Vz15 = ω5 R5 cos θ5 (IV-75) Vz16 = ω6 R6 cos θ6 (IV-76)

Una vez calculadas las velocidades de los puntos 11 a 16 con las

ecuaciones (IV-59) a (IV-76), por medio del sistema (IV-30), se calcularán las velocidades de los vértices de la plataforma móvil.

88

Page 109: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

IV.4.3.1 - Comprobación de las CIP

Resolviendo el sistema de ecuaciones (IV-30), por medio del programa "INSENSI", para la CIP correspondiente a los valores de las primeras filas de tablas (IV-1) y (IV-2), introduciendo unas velocidades angulares de 1 rad/s. a todas las manivelas, resultan las velocidades de los vértices de la plataforma móvil siguientes:

Vx123 = -6.192186911252181e-017 Vy123 = 2.313274611394614e-017 Vz123 = -2.603771706316032e-017 Vx145 = -1.214154295405641e-017 Vy145 = 1.093548002088909e-016 Vz145 = 5.601110253714043e-018 Vx161 = 3.763878316494410e-017 Vy161 = 2.313274611394616e-017 Vz161 = -3.767776844629405e-017

Como se puede observar, las velocidades de los vértices de la plataforma móvil son despreciables cuando el manipulador se encuentra en una CIP, que es lo que se pretendía demostrar.

Para otra CIP del manipulador, por ejemplo para la configuración "0-1-0-1-0-1" correspondiente a la fila 26 de las tablas (IV-1) y (IV-2), que tendrá las manivelas 1", "3" y "5" por debajo, y las manivelas "2", "4" y "6" sobre la plataforma fija, se tendrá que las coordenadas de los puntos de unión del eje del actuador con la manivela (puntos de 01 a 06), al ser fijos, serán los mismos que en el ejemplo anterior:

01 = (-0.288675134, -0.05, 0) 02 = (-0.288675134, 0.05, 0) 03 = (0.101036297, 0.275, 0) 04 = (0.187638837, 0.225, 0) 05 = (0.187638837, -0.225, 0) 06 = (0.101036297, -0.275, 0)

Partiendo de la primera CIP lograda "1-1-1-1-1-1", girando las manivelas "1", "3" y "5" por medio del programa "INSENSI", se obtendrá la CIP que se pretende estudiar "0-1-0-1-0-1", cuyas coordenadas de los puntos de unión manivela-biela serán los siguientes:

89

Page 110: Tesis

Configuraciones de Insensitividad.

11 = (-0.288675134, -0.05, -0.099999921) 12 = (-0.221559188, 0.05, 0.074131301) 13 = (0.101098857, 0.275108358, -0.099999921) 14 = (0.154080864, 0.166875885, 0.074131301) 15 = (0.187701397, -0.225108358, -0.099999921) 16 = (0.067478324, -0.216875885, 0.074131301)

Y las coordenadas de los vértices de la plataforma móvil:

123 = ( 0.160411877, 0.240002840, 0.496028238) 145 = ( 0.127642618, -0.258922180, 0.496028239) 161 = (-0.288054494, 0.018919340, 0.496028238)

Calculando las velocidades de los vértices de la plataforma móvil para

unas velocidades angulares de las manivelas de 1 rad/s, resultan en este caso, los valores siguientes:

Vx123 =-5.422162348772668e-015 Vy123 =5.157982651548186e-015 Vz123 =2.569677055887484e-015 Vx145 =1.035113226518595e-015 Vy145 =4.733870557753380e-015 Vz145 =4.817838154888438e-015 Vx161 =-2.560816408164872e-015 Vy161 =-6.462380843204576e-016 Vz161 =-1.772153366471474e-015

Se puede observar, que al igual que en el caso anterior, las velocidades

de los vértices de la plataforma móvil son despreciables, lo que demuestra que el manipulador se encuentra en otra CIP.

IV.5 - CONCLUSIONES Como una generalización de la utilidad de las configuraciones de

insensitividad de posición de los mecanismos planos de pistón-biela-manivela y manivela-oscilador, se expone la utilidad de las configuraciones de insensitividad de posición "CIP" del manipulador paralelo 6-RKS propuesto por Hunt.

90

Page 111: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Se determina el número de CIP de todos los tipos posibles, constatando que existen 12 CIP-1, 60 CIP-2, 120 CIP-3, 240 CIP-4, 192 CIP-5 y 64 CIP-6 ó total.

Las 64 CIP-6 son las que se han llamado y se llamarán CIP y

corresponden con configuraciones puntuales de gran precisión de posición para la plataforma móvil. En estas configuraciones, pequeños errores en la posición de los actuadores no afectan a la posición de la plataforma.

Al pasar de una CIP a otra, la velocidad cuando se acerque a la nueva

posición disminuirá progresivamente, por lo que las fuerzas de inercia, si el manipulador se detiene en esa posición, serán muy reducidas, permitiendo la utilización de motores eléctricos asíncronos, más económicos que los motores que permiten un control de su velocidad, y que sería necesario utilizar si se produjesen detenciones del manipulador fuera de sus CIP.

En estas configuraciones, los pares a aplicar a los actuadores para

equilibrar a las fuerzas y pares aplicados sobre la plataforma móvil serán nulos. Ello es debido a que las fuerzas que aparecen en los extremos de las manivelas cortan a los ejes de los actuadores.

Se ha expuesto un método numérico para la obtención de una de estas

configuraciones y a partir de ella, las 63 restantes. Observando el sistema de ecuaciones que relaciona las velocidades de

los extremos de las manivelas y de los vértices de la plataforma móvil, se comprueba que si en cada cadena cinemática se cumple que el eje del actuador, la manivela y la biela están en el mismo plano, el manipulador se encuentra en una CIP.

Finalmente, en el ejemplo numérico del apartado IV.4, se determinan

las 64 CIP para un manipulador de unas dimensiones determinadas, comprobándose numéricamente que las CIP obtenidas son realmente configuraciones de insensitividad de posición.

91

Page 112: Tesis

Configuraciones de Insensitividad.

92

Page 113: Tesis

CAPÍTULO V

SÍNTESIS DE UN MANIPULADOR 6-RKS

Page 114: Tesis

Síntesis de un Manipulador 6-RKS

94

Page 115: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

CAPÍTULO V - SÍNTESIS DE UN

MANIPULADOR 6-RKS

V.1 – INTRODUCCIÓN En este capítulo se sintetizará un manipulador para lograr que varias

posiciones prefijadas de la plataforma móvil se consigan estando el manipulador en configuración de insensitividad de posición.

Así como los mecanismos planos de pistón-biela-manivela y de

manivela-oscilador es interesante diseñarlos de forma que las posiciones de detención deseadas coincidan con configuraciones de insensitividad, también en los mecanismos espaciales tipo manipulador paralelo 6-RKS resulta ventajoso conseguir que varias posiciones de detención prefijadas de la plataforma móvil se alcancen estando el manipulador en configuración de insensitividad de posición. De esta forma se consigue que estas configuraciones sean de gran precisión de posición, que los pares sobre los actuadores sean nulos y que las velocidades de los puntos de la plataforma móvil sean nulas, con lo que las aceleraciones, y por lo tanto las fuerzas de inercia, serán menores que si se detiene al mecanismo en cualquier otra configuración.

En el Capítulo IV se ha visto que son 64 las CIP totales y que éstas

son puntuales; es decir, que para una determinada posición de los actuadores sobre la plataforma fija, unas longitudes de las manivelas, de las bielas y de los lados del triángulo de la plataforma móvil, el manipulador tendrá 64 configuraciones de insensitividad de posición sobre la plataforma fija perfectamente determinadas.

Para ciertas aplicaciones, como posicionar piezas o utillajes en

máquina-herramienta, se puede utilizar el manipulador paralelo 6-RKS aprovechando sus CIP por las ventajas que se han descrito anteriormente. Por ello, sería importante conseguir que las posiciones que deba tener la pieza o utillaje se alcancen estando el manipulador en CIP.

En este capítulo, se trata de dimensionar el manipulador de forma que

varias posiciones predeterminadas de la plataforma móvil necesarias para realizar una determinada labor, coincidan con CIP.

El problema, así planteado, se corresponde con la "Síntesis

Dimensional". Después de haber llevado a cabo la "Síntesis de Tipo y de

95

Page 116: Tesis

Síntesis de un Manipulador 6-RKS

Número" al seleccionar el de tipo de mecanismo por el hecho de que posee una plataforma móvil con 6 grados de libertad y configuraciones de insensitividad de posición. Ahora, se trata de calcular las dimensiones de los diferentes eslabones con el fin de conseguir que varias posiciones deseadas de la plataforma móvil se puedan alcanzar estando el manipulado en CIP. Este estudio se puede corresponder con la "síntesis de puntos de precisión" de mecanismos planos puesta como ejemplo en el Anexo I.

V.2 – POSICIONES PREDETERMINADAS EN CIP En principio, se podrían predeterminar 64 posiciones de la plataforma

móvil, que son las correspondientes a las 64 configuraciones de insensitividad de posición que alcanza el manipulador 6-RKS. Sin embargo, esto es muy difícil ya que para cada posición se deben cumplir 24 condiciones de restricción por lo tanto se tendrían 64 por 24 igual a 1536 ecuaciones. Por otro lado, se tendría 18 coordenadas de los seis extremos de las manivelas, que para las 64 posiciones representarían 1152 incógnitas, por lo que se necesitarían añadir 364 incógnitas para que resultase un sistema de ecuaciones determinado. Teniendo en cuenta que el manipulador tiene 6 cadenas cinemáticas de unión de la plataforma fija con la plataforma móvil, corresponden 64 incógnitas por cada cadena. Es decir, que en cada cadena formada por el actuador, la manivela y la biela se deben introducir 64 variables.

Las 24 condiciones de restricción del párrafo anterior corresponden: 6

a las longitudes constantes de las manivelas, 6 a las longitudes constantes de las bielas, 6 a la condición de que los extremos de las manivelas describan unas circunferencias perpendiculares a los ejes de los actuadores y finalmente otras 6 condiciones asociadas a que el eje de un actuador, la manivela y la biela correspondientes estén en el mismo plano para que se dé una CIP. Las otras tres condiciones de restricción expuestas en el Capítulo IV referentes a las longitudes constantes de los lados del triángulo de la plataforma móvil no son necesarias ya que la posición deseada de la plataforma móvil se da por medio de las coordenadas de los vértices del triángulo y, por lo tanto, estas condiciones de restricción ya se cumplen.

En lugar de intentar resolver el problema más complejo, se inicia el

estudio para dos configuraciones de insensitividad de posición y posteriormente se irán considerando más configuraciones. En la realidad de la industria, con unas pocas posiciones ya suele ser suficiente, ya que la mayoría de las piezas, al colocarlas en una máquina, suele ser necesario colocarlas, como mucho, en tres o cuatro posiciones determinadas.

96

Page 117: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Con el fin de que las ecuaciones de restricción, introducidas en el Capítulo IV, resulten más sencillas, y sin perder generalidad, en este capítulo se supone que los ejes de los actuadores forman un triángulo equilátero (Fig. V-1).

Fig. V-1 Actuadores sobre la plataforma fija Se toma como origen de coordenadas el baricentro del triángulo

formado por los ejes de los actuadores, con los ejes "X" e "Y" contenidos en el plano de los ejes de los actuadores y el eje "Y" paralelo a los ejes de los actuadores "1" y "2" y con el eje "Z" hacia la plataforma móvil.

97

Page 118: Tesis

Síntesis de un Manipulador 6-RKS

V.2.1 – Una posición predeterminada en CIP Para una posición predeterminada de la plataforma móvil como CIP

(Fig. V-2), se tendrán 24 ecuaciones de restricción para el manipulador: - 6 para las longitudes constantes de las manivelas. - 6 para las longitudes constantes de las bielas. - 6 para indicar que el extremo de la manivela se mueve en un plano

perpendicular al eje del actuador. - 6 para determinar que los elementos de cada cadena actuador, manivela y

biela se encuentran en un plano y por lo tanto el manipulador en una CIP.

Fig. V-2 Manipulador 6-RKS en una CIP

Las condiciones de restricción para las longitudes constantes de las

manivelas serán las siguientes:

( ) ( ) ( ) 0RZZYYXX 21

20111

20111

20111 =−−+−+− (V-1)

( ) ( ) ( ) 0RZZYYXX 22

20212

20212

20212 =−−+−+− (V-2)

( ) ( ) ( ) 0RZZYYXX 23

20313

20313

20313 =−−+−+− (V-3)

( ) ( ) ( ) 0RZZYYXX 24

20414

20414

20414 =−−+−+− (V-4)

( ) ( ) ( ) 0RZZYYXX 25

20515

20515

20515 =−−+−+− (V-5)

( ) ( ) ( ) 0RZZYYXX 26

20616

20616

20616 =−−+−+− (V-6)

98

Page 119: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Las condiciones de restricción para las longitudes constantes de las bielas serán las siguientes:

( ) ( ) ( ) 0LZZYYXX 2

12

111612

111612

11161 =−−+−+− (V-7) ( ) ( ) ( ) 0LZZYYXX 2

22

121232

121232

12123 =−−+−+− (V-8) ( ) ( ) ( ) 0LZZYYXX 2

32

131232

131232

13123 =−−+−+− (V-9) ( ) ( ) ( ) 0LZZYYXX 2

42

141452

141452

14145 =−−+−+− (V-10) ( ) ( ) ( ) 0LZZYYXX 2

52

151452

151452

15145 =−−+−+− (V-11) ( ) ( ) ( ) 0LZZYYXX 2

62

161612

161612

16161 =−−+−+− (V-12) Para indicar la perpendicularidad entre la manivela y el eje del

actuador correspondiente:

0YY 0111 =− (V-13) 0YY 0212 =− (V-14)

( ) ( ) 0YYXX3 03130313 =−−−⋅ (V-15) ( ) ( ) 0YYXX3 04140414 =−−−⋅ (V-16) ( ) ( ) 0YYXX3 05150515 =−−−⋅ (V-17) ( ) ( ) 0YYXX3 06160616 =−−−⋅ (V-18)

Y finalmente para conseguir que el eje del actuador, la manivela y la

biela se encuentren en un plano:

( ) ( ) ( ) ( ) 0ZZXXXXZZ 111610111111610111 =−⋅−−−⋅− (V-19) ( ) ( ) ( ) ( ) 0ZZXXXXZZ 121230212121230212 =−⋅−−−⋅− (V-20)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

131230313131230313

131230313131230313

=−−+−−

+−−−−−− (V-21)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

141450414141450414

141450414141450414

=−−+−−

+−−−−−− (V-22)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

151450515151450515

151450515151450515

=−−+−−

+−−−−−− (V-23)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

161610616161610616

161610616161610616

=−−+−−

+−−−−−− (V-24)

99

Page 120: Tesis

Síntesis de un Manipulador 6-RKS

V.2.2 – Dos posiciones predeterminadas en CIP Si se desean dos posiciones predeterminadas como CIP (Fig. V-3) se

tendrá un total de 48 ecuaciones de restricción, 24 para cada posición.

Fig. V-3 Manipulador 6-RKS en dos CIP

Para que este sistema de 48 ecuaciones tenga solución, en el caso más

general, deben existir 48 incógnitas. En principio, podrían ser las 18 coordenadas de posición de los puntos extremos de las manivelas, puntos de unión de las manivelas con las bielas, que al ser para dos posiciones representarían 36 incógnitas. Como se necesitan 12 incógnitas más, se pueden tomar como variables las longitudes de las manivelas y de las bielas. De este modo, se tiene un sistema con 48 ecuaciones y 48 incógnitas que, en principio, tendrá solución, siendo ésta las posiciones de los puntos extremos de las manivelas para las dos CIP y las longitudes de bielas y manivelas.

Aparte de las dos CIP predeterminadas, el manipulador tendrá otras 62

CIP más, ya que éste tiene un total de 64 sobre la plataforma fija. Las 62 CIP restantes podrán ser aprovechadas en algunos casos, si en vez de necesitarse una posición determinada, se puede ajustar la posición de trabajo a una de las CIP que proporciona el manipulador.

100

Page 121: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

V.2.2.1 –Formas de obtener dos posiciones en CIP Tal y como se vio en el Capítulo IV, atendiendo a las seis últimas

condiciones de restricción, las que hacen que el eje del actuador, la manivela y la biela estén contenidos en un plano para que el manipulador esté en CIP, se llega a la conclusión de que los extremos de las bielas deben estar sobre unas superficies tóricas (Fig. V-4).

Fig. V-4 Lugar geométrico del extremo de una biela en PI Como a cada extremo de la plataforma móvil van unidas dos bielas,

por ejemplo la biela "2" y la "3" que se unen al punto "123", este punto debe estar contenido en dos superficies tóricas: una la correspondiente a la cadena cinemática 2 y otra correspondiente a la cadena 3.

La intersección de dos toros, del tipo que resultan cuando la manivela

tiene menor longitud que la biela, o sea que son toros que no tienen agujero central, se produce a lo largo de 4 líneas cerradas (Fig. V-5). Por lo que el punto "123", vértice de la plataforma móvil, puede estar sobre cuatro líneas diferentes cuando las cadenas actuador, manivela y biela "2" y "3" estén en PI.

101

Page 122: Tesis

Síntesis de un Manipulador 6-RKS

Fig. V-5 Lugar geométrico de un vértice de la plataforma móvil en PI Que el lugar geométrico del vértice de la plataforma móvil sean 4

líneas resulta lógico, ya que cada cadena actuador, manivela y biela tiene dos PI, por lo tanto el punto "123", que es la unión de dos bielas, tendrá 22 = 4 PI.

Teniendo en cuenta que la plataforma móvil, en las dos posiciones

predeterminadas, debe tener cada uno de sus vértices en alguna de las cuatro líneas intersección de los dos toros correspondientes a cada vértice, resulta que dos posiciones predeterminadas se pueden conseguir de varias formas diferentes. El número teórico de soluciones para cada vértice de la plataforma móvil será variaciones con repetición de cuatro elementos tomados de dos en dos que es igual a 16 y, como son tres vértices, resulta 163; es decir, 4096 posibles soluciones, al menos en teoría.

De estas 4096 posibles soluciones, existen 64 en las que las dos

posiciones prefijadas para la plataforma móvil son la misma. Esto es debido a que dos posiciones diferentes de la plataforma móvil pueden tener un vértice de la plataforma móvil sobre la misma línea de intersección de los dos toros correspondientes, incluso puede ocurrir esto para dos vértices, pero si cada uno de los tres vértices de la plataforma, en las dos posiciones de ésta, se encontrase sobre la misma línea, resultaría que esas dos posiciones serían la misma. Estas posibles soluciones han sido contabilizadas al calcular variaciones con

102

Page 123: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

repetición y, como no es lógico que se prefijen dos posiciones iguales para la plataforma móvil, resulta que el número de posibles soluciones teóricas, para conseguir que dos posiciones de la plataforma móvil sean CIP, es 4032.

Para conseguir las posibles soluciones mencionadas en el párrafo

anterior se utiliza el método iterativo de Newton-Raphson. El proceso es el siguiente: Se introducen como valores iniciales las coordenadas de los vértices de la plataforma móvil para las dos posiciones deseadas, las longitudes iniciales de las seis manivelas y de las seis bielas y los dos conjuntos de coordenadas iniciales de los puntos extremos de las seis manivelas para las dos posiciones de la plataforma prefijada. Se consideran las 48 ecuaciones de restricción correspondientes a las dos posiciones prefijadas. Se itera, tomando como valores iniciales para una iteración los resultados de la iteración anterior, y así sucesivamente, hasta obtener unas longitudes de manivelas y bielas y unas coordenadas de los puntos extremos de las manivelas que cumplan las ecuaciones de restricción cometiendo un error inferior a una cantidad prefijada.

Como el método de Newton-Raphson no siempre converge, y con el

fin de obtener el máximo de soluciones posibles, se repite el proceso 4.096 veces. Para ello se inician las iteraciones con las 64 x 64 combinaciones posibles de coordenadas de los puntos extremos de las manivelas obtenidas al conseguir las 64 CIP de un manipulador con las seis manivelas de la misma longitud y las seis bielas también de la misma longitud.

Es este un punto en el que podría haberse hecho uso de un método

aleatorio para tomar los valores iniciales de las coordenadas de los seis puntos extremos de las manivelas y las longitudes de las manivelas y bielas para las dos posiciones prefijadas. No obstante, como en el capítulo anterior se ha expuesto un método para determinar las 64 CIP, y en un ejemplo numérico se han determinado las CIP para un manipulador con longitudes de manivelas iguales y también con longitudes de bielas iguales, parece lógico tomar como configuraciones iniciales dos CIP ya determinadas, y como longitudes de bielas y manivelas iniciales las longitudes del manipulador al que corresponden esas CIP.

V.2.3 – Tres posiciones predeterminadas en CIP Si se desean alcanzar tres posiciones predeterminadas de la plataforma

móvil estando el manipulador en configuración de insensitividad de posición (Fig. V-6), se tendrá, igual que en el caso de dos posiciones: - 6 ecuaciones de restricción para las longitudes constantes de las manivelas. - 6 para las longitudes constantes de las bielas.

103

Page 124: Tesis

Síntesis de un Manipulador 6-RKS

- 6 para indicar que el extremo de la manivela se mueve en un plano perpendicular al eje del actuador.

- 6 para determinar que cada cadena actuador-manivela-biela se encuentra en un plano y por lo tanto en posición de insensitividad.

Es decir, resultan 24 ecuaciones de restricción por cada posición y,

por lo tanto, un total de 72 ecuaciones de restricción para las tres posiciones predeterminadas de la plataforma móvil deseadas.

Para que este sistema de 72 ecuaciones tenga solución, deben existir

72 incógnitas. En principio, podrían ser las 18 coordenadas de posición de los puntos extremos de las manivelas que, al ser para tres configuraciones, representarían 54 incógnitas. Como son necesarias 18 incógnitas más, se pueden tomar como variables las longitudes de las manivelas y de las bielas y por ejemplo las coordenadas "X" de los actuadores. De esta manera, se tiene un sistema con 72 ecuaciones y 72 incógnitas que, en principio, tendrá solución, siendo ésta las posiciones de los puntos extremos de las manivelas para las tres configuraciones de insensitividad, las longitudes de manivelas y bielas y las coordenadas "X" de los actuadores.

Fig. V-6 Manipulador 6-RKS en tres CIP

Aparte de las tres configuraciones de insensitividad predeterminadas,

el manipulador tendrá otras 61 configuraciones de insensitividad más, ya que puede alcanzar un total de 64. Las 61 configuraciones restantes podrán ser

104

Page 125: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

aprovechadas siempre que se ajuste las necesidades del trabajo a la posición de la plataforma móvil.

V.2.3.1 – Formas de obtener tres posiciones en CIP Para tres posiciones predeterminadas, de forma similar a lo expuesto

para el caso de dos posiciones, cada vértice de la plataforma móvil se debe encontrar sobre alguna de las líneas intersección de las superficies toroidales correspondientes a las cadenas actuador, manivela y biela cuyas bielas van unidas al vértice considerado.

Teniendo en cuenta que la plataforma móvil, en las tres posiciones

predeterminadas, debe tener cada uno de sus vértices en alguna de las cuatro líneas intersección de los dos toros correspondientes a cada vértice, resulta que tres posiciones predeterminadas se pueden conseguir de varias formas diferentes. El número teórico de soluciones para cada vértice de la plataforma móvil será variaciones con repetición de cuatro elementos tomados de tres en tres, que es igual a 64, y como son tres vértices, se tienen 643 igual a 262.144 posibles soluciones.

Haciendo el mismo razonamiento que para dos posiciones, de estas

262.144 posibles soluciones existen 64.000 en las que las dos o tres posiciones prefijadas para la plataforma móvil son la misma. Como no es lógico que se prefijen dos o tres posiciones iguales para la plataforma móvil, resulta que el número de posibles soluciones teóricas para conseguir que tres posiciones de la plataforma móvil se consigan estando el manipulador en configuración de insensitividad es de 198.144.

Para conseguir las posibles soluciones mencionadas en el párrafo

anterior se utiliza el método iterativo de Newton-Raphson. El proceso es el siguiente: Se introducen como valores iniciales las coordenadas de los vértices de la plataforma móvil para las tres posiciones deseadas, las longitudes iniciales de las seis manivelas y de las seis bielas, las coordenadas "X" de los actuadores y los tres conjuntos de coordenadas de los puntos extremos de las seis manivelas para las tres posiciones de la plataforma. Se consideran las 72 ecuaciones de restricción correspondientes a las tres posiciones prefijadas. Se itera, tomando como valores iniciales para una iteración los resultados de la iteración anterior, y así sucesivamente, hasta obtener unas longitudes de manivelas y bielas, unas coordenadas "X" de los actuadores y unas coordenadas de los puntos extremos de las manivelas que cumplan las ecuaciones de restricción cometiendo un error inferior a una cantidad prefijada.

105

Page 126: Tesis

Síntesis de un Manipulador 6-RKS

Como el método de Newton-Raphson no siempre converge o converge a soluciones no constructivas, por ejemplo con longitudes de bielas y manivelas de miles de metros y, con el fin de obtener el máximo de soluciones posibles, se repite el proceso 262.144 veces, iniciando las iteraciones con las 64 x 64 x 64 combinaciones posibles de coordenadas de los puntos extremos de las manivelas de las 64 CIP determinadas en el ejemplo numérico del Capítulo IV. Se toman como valores iniciales para determinar las dimensiones del manipulador todas las combinaciones posibles de CIP porque, de ese modo, es más fácil que entre todas las soluciones obtenidas haya varias constructivas.

V.2.4 – Cuatro posiciones predeterminadas en CIP Haciendo el mismo razonamiento que para dos y tres posiciones

prefijadas, como se tienen 24 condiciones de restricción, se tendrá un sistema de 96 ecuaciones. Por otro lado se tienen 72 incógnitas que serán las coordenadas de los extremos de las manivelas. Serán necesarias 24 incógnitas más, que se pueden tomar, por ejemplo, las longitudes de manivelas y bielas y las coordenadas "X" e "Y" de los actuadores.

Igual que en los casos anteriores, aparte de las cuatro posiciones de

insensitividad de la plataforma móvil predeterminadas, el manipulador tendrá otras 60 configuraciones de insensitividad de posición más.

V.2.4.1 – Formas de obtener 4 posiciones en CIP Teniendo en cuenta que la plataforma móvil, en las cuatro posiciones

predeterminadas, debe tener cada uno de sus vértices en alguna de las cuatro líneas intersección de los dos toros correspondientes a cada vértice, resulta que cuatro posiciones predeterminadas se pueden conseguir de varias formas diferentes. El número teórico de soluciones para cada vértice de la plataforma móvil será variaciones con repetición de cuatro elementos tomados de cuatro en cuatro que es igual a 256; y como son tres vértices resulta 2563 igual a 16.777.216 posibles soluciones.

De estas 16.777.216 posibles soluciones, existen 1.528.192 en las que

las dos, tres o cuatro posiciones prefijadas para la plataforma móvil son la misma. Como no es lógico que se prefijen dos, tres o cuatro posiciones iguales para la plataforma móvil, resulta que el número de posibles soluciones teóricas para conseguir que cuatro posiciones de la plataforma móvil, se consigan estando el manipulador en configuraciones de insensitividad de posición, es de 12.249.024.

106

Page 127: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Para obtener las posibles soluciones mencionadas en el párrafo anterior se utiliza el método iterativo de Newton-Raphson para la resolución del sistema de 96 ecuaciones: Se introducen como datos para la primera iteración las coordenadas de los vértices de la plataforma móvil para las cuatro posiciones deseadas, las longitudes iniciales de las manivelas y de las bielas, las coordenadas "X" e "Y" iniciales de los actuadores, los cuatro conjuntos de coordenadas iniciales de los puntos extremos de las seis manivelas para las cuatro posiciones de la plataforma. Se consideran las 96 ecuaciones de restricción correspondientes a las cuatro posiciones prefijadas. Se itera, tomando como valores iniciales para cada iteración los resultados de la iteración anterior, y así sucesivamente, hasta obtener como resultado las longitudes de manivelas y bielas, las coordenadas "X" e "Y" de los actuadores y las coordenadas de los puntos extremos de las manivelas que cumplan las condiciones de restricción con un error inferior a una cantidad prefijada.

Al igual que en los casos anteriores, como el método de Newton-

Raphson no siempre converge y con el fin de obtener el máximo de soluciones constructivas posibles, se repite el proceso iniciando la iteración con las 64 x 64 x 64 x 64 combinaciones posibles de coordenadas de los puntos extremos de las manivelas obtenidas al determinar las 64 CIP de un manipulador con las seis manivelas de la misma longitud y las seis bielas también de la misma longitud.

Debido a lo costoso en tiempo que resultaría este método, ya que

habría que resolver 644 = 16.777.216 veces un sistema de 96 ecuaciones, y en cada una de ellas al menos se deben realizar un mínimo de 8 iteraciones hasta conseguir la convergencia, en este caso, se puede utilizar un método aleatorio para tomar los valores iniciales en cada una de las aplicaciones del método de Newton-Raphson dentro de la serie de 16.777.216 posibles, hasta conseguir varias soluciones para las longitudes de bielas y manivelas y posiciones de los actuadores que se consideren satisfactorias.

V.3 – EJEMPLO NUMÉRICO PARA DOS CIP

En este ejemplo numérico, se aplicará el método descrito en el Apartado V.2.2 para lograr que dos posiciones prefijadas de la plataforma móvil se consigan estando el manipulador en configuración de insensitividad de posición (CIP).

Se pretende mecanizar, en una esfera de 100 milímetros de diámetro

apoyada en el centro de la plataforma móvil, dos caras de un icosaedro. Para poder mecanizar correctamente, las caras deben estar horizontales, con sus

107

Page 128: Tesis

Síntesis de un Manipulador 6-RKS

baricentros coincidiendo con el eje "Z" del manipulador y con la arista entre las dos caras paralela al eje "Y". La primera cara se mecanizará estando la plataforma móvil horizontal (Fig. V-7).

Fig. V-7 Superficies a mecanizar

V.3.1 – Introducción de datos

Con las condiciones propuestas en el apartado anterior, tomando como primera posición de la plataforma móvil la primera de las 64 CIP del ejemplo del apartado IV.4, y teniendo en cuenta que el ángulo entre caras de un icosaedro es de 41.81º, las coordenadas de los vértices de la plataforma móvil en la primera posición serán las siguientes: X123A = -0.1441 Y123A = 0.25 Z123A = 0.6498 X145A = 0.2887 Y145A = 0 Z145A = 0.6498 X161A = -0.1441 Y161A = -0.25 Z161A = 0.6498

108

Page 129: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Para la segunda posición, la plataforma móvil deberá realizar un giro de 41.81º alrededor de un eje paralelo al eje "Y" que pase por el centro de la esfera a mecanizar, resultando que las coordenadas de los vértices de la plataforma en esta segunda posición serán las siguientes: X123B = -0.1409 Y123B = 0.25 Z123B = 0.7587 X145B = 0.1819 Y145B = 0 Z145B = 0.4701 X161B = -0.1409 Y161B = -0.25 Z161B = 0.7587

Tomando las dimensiones de la plataforma fija y la posición de los actuadores igual que en el ejemplo del Capítulo IV, resultará que las coordenadas de los puntos 01 a 06 serán:

01 = (-0.288675134, -0.05, 0) 02 = (-0.288675134, 0.05, 0) 03 = (0.101036297, 0.275, 0) 04 = (0.187638837, 0.225, 0) 05 = (0.187638837, -0.225, 0) 06 = (0.101036297, -0.275, 0)

Para la primera iteración se tomará, como longitudes de las manivelas:

R1 = R2 = R3 = R4 = R5 = R6 = 0.1 metros. Y como longitudes de las bielas:

L1 = L2 = L3 = L4 = L5 = L6 = 0.6 metros

Las longitudes de los lados del triángulo de la plataforma móvil, de 0.5 metros, ya quedan determinados por las dos posiciones preestablecidas.

Para las coordenadas de los extremos de las manivelas, puntos del "11" al "16" en sus dos posiciones, se irán tomando las 64 x 64 = 4096 combinaciones de coordenadas de estos puntos en las 64 CIP del manipulador obtenidas en el ejemplo del Capítulo IV.

109

Page 130: Tesis

Síntesis de un Manipulador 6-RKS

V.3.2 – Condiciones de restricción

Como condiciones de restricción se tendrá:

Para las longitudes constantes de las manivelas en la primera posición:

( ) ( ) ( ) 0RZZYYXX 21

201A11

201A11

201A11 =−−+−+− (V-25)

( ) ( ) ( ) 0RZZYYXX 22

202A12

202A12

202A12 =−−+−+− (V-26)

( ) ( ) ( ) 0RZZYYXX 23

203A13

203A13

203A13 =−−+−+− (V-27)

( ) ( ) ( ) 0RZZYYXX 24

204A14

204A14

204A14 =−−+−+− (V-28)

( ) ( ) ( ) 0RZZYYXX 25

205A15

205A15

205A15 =−−+−+− (V-29)

( ) ( ) ( ) 0RZZYYXX 26

206A16

206A16

206A16 =−−+−+− (V-30)

Para las longitudes constantes de las manivelas en la segunda posición:

( ) ( ) ( ) 0RZZYYXX 21

201B11

201B11

201B11 =−−+−+− (V-31)

( ) ( ) ( ) 0RZZYYXX 22

202B12

202B12

202B12 =−−+−+− (V-32)

( ) ( ) ( ) 0RZZYYXX 23

203B13

203B13

203B13 =−−+−+− (V-33)

( ) ( ) ( ) 0RZZYYXX 24

204B14

204B14

204B14 =−−+−+− (V-34)

( ) ( ) ( ) 0RZZYYXX 25

205B15

205B15

205B15 =−−+−+− (V-35)

( ) ( ) ( ) 0RZZYYXX 26

206B16

206B16

206B16 =−−+−+− (V-36)

Para las longitudes constantes de las bielas en la primera posición:

( ) ( ) ( ) 0LZZYYXX 21

2A11A161

2A11A161

2A11A161 =−−+−+− (V-37)

( ) ( ) ( ) 0LZZYYXX 22

2A12A123

2A12A123

2A12A123 =−−+−+− (V-38)

( ) ( ) ( ) 0LZZYYXX 23

2A13A123

2A13A123

2A13A123 =−−+−+− (V-39)

( ) ( ) ( ) 0LZZYYXX 24

2A14B145

2A14B145

2A14B145 =−−+−+− (V-40)

( ) ( ) ( ) 0LZZYYXX 25

2A15A145

2A15A145

2A15A145 =−−+−+− (V-41)

( ) ( ) ( ) 0LZZYYXX 26

2A16A161

2A16A161

2A16A161 =−−+−+− (V-42)

110

Page 131: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Para las longitudes constantes de las bielas en la segunda posición: ( ) ( ) ( ) 0LZZYYXX 2

12

B11B1612

B11B1612

B11B161 =−−+−+− (V-43) ( ) ( ) ( ) 0LZZYYXX 2

22

B12B1232

B12B1232

B12B123 =−−+−+− (V-44) ( ) ( ) ( ) 0LZZYYXX 2

32

B13B1232

B13B1232

B13B123 =−−+−+− (V-45) ( ) ( ) ( ) 0LZZYYXX 2

42

B14B1452

B14B1452

B14B145 =−−+−+− (V-46) ( ) ( ) ( ) 0LZZYYXX 2

52

B15B1452

B15B1452

B15B145 =−−+−+− (V-47) ( ) ( ) ( ) 0LZZYYXX 2

62

B16B1612

B16B1612

B16B161 =−−+−+− (V-48)

Para indicar la perpendicularidad de las circunferencias descritas por los extremos de las manivelas con los ejes de los actuadores respectivos, en la primera posición:

0YY 01A11 =− (V-49) 0YY 02A12 =− (V-50)

( ) ( ) 0YYXX3 03A1303A13 =−−−⋅ (V-51) ( ) ( ) 0YYXX3 04A1404A14 =−−−⋅ (V-52) ( ) ( ) 0YYXX3 05A1505A15 =−−−⋅ (V-53) ( ) ( ) 0YYXX3 06A1606A16 =−−−⋅ (V-54)

Para la perpendicularidad de las circunferencias descritas por los

extremos de las manivelas con los ejes de los actuadores respectivos, en la segunda posición:

0YY 01B11 =− (V-55) 0YY 02B12 =− (V-56)

( ) ( 0YYXX3 03B1303B13 =−−−⋅ ) (V-57) ( ) ( 0YYXX3 04B1404B14 =−−−⋅ ) (V-58) ( ) ( 0YYXX3 05B1505B15 =−−−⋅ ) (V-59) ( ) ( 0YYXX3 06B1606B16 =−−−⋅ ) (V-60)

111

Page 132: Tesis

Síntesis de un Manipulador 6-RKS

Para la condición de que los ejes de los actuadores, las manivela y las bielas en cada cadena deben estar contenidas en un plano, para la primera posición de la plataforma móvil:

( ) ( ) ( ) ( ) 0ZZXXXXZZ A11A16101A11A11A16101A11 =−⋅−−−⋅− (V-61) ( ) ( ) ( ) ( ) 0ZZXXXXZZ A12A12302A12A12A12302A12 =−⋅−−−⋅− (V-62)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

A13A12303A13A13A12303A13

A13A12303A13A13A12303A13

=−−+−−

+−−−−−− (V-63)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

A14A14504A14A14A14504A14

A14A14504A14A14A14504A14

=−−+−−

+−−−−−− (V-64)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

A15A14505A15A15A14505A15

A15A14505A15A15A14505A15

=−−+−−

+−−−−−− (V-65)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

A16A16106A16A16A16106A16

A16A16106A16A16A16106A16

=−−+−−

+−−−−−− (V-66)

Para la condición de que los ejes de los actuadores, las manivela y las bielas en cada cadena deben estar contenidas en un plano, para la segunda posición de la plataforma móvil:

( ) ( ) ( ) ( ) 0ZZXXXXZZ B11B16101B11B11B16101B11 =−⋅−−−⋅− (V-67) ( ) ( ) ( ) ( ) 0ZZXXXXZZ B12B12302B12B12B12302B12 =−⋅−−−⋅− (V-68)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

B13B12303B13B13B12303B13

B13B12303B13B13B12303B13

=−−+−−

+−−−−−− (V-69)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

B14B14504B14B14B14504B14

B14B14504B14B14B14504B14

=−−+−−

+−−−−−− (V-70)

112

Page 133: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

B15B14505B15B15B14505B15

B15B14505B15B15B14505B15

=−−+−−

+−−−−−− (V-71)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

B16B16106B16B16B16106B16

B16B16106B16B16B16106B16

=−−+−−

+−−−−−− (V-72)

V.3.3 – Resolución del sistema

Resolviendo el sistema de 48 ecuaciones, de la (V-25) a (V-72), para las 4096 combinaciones de valores iniciales, por el método iterativo de Newton-Raphson con el programa "DOSINSENSI" realizado en MATLAB, se han conseguido 68 combinaciones diferentes de longitudes de manivelas y bielas en lugar de las 4032 teóricamente posibles. Esto es lógico ya que, por ejemplo, si la coordenada "Z123" de la posición prefijada "1" es mayor que la coordenada "Z123" de la posición prefijada "2", las 16 posibles combinaciones para un vértice de la plataforma quedarían reducidas a 6 (Fig. V-8), siendo entonces el número de posibles soluciones 63 = 216. Si este mismo razonamiento se aplica a las coordenadas "X123" e "Y123", se reducirán las posibles soluciones, resultando aceptable que éstas sean 68.

Fig. V-8 Posibles posiciones de un vértice de la plataforma móvil en PI

De las 4096 veces que se ha aplicado el método iterativo de Newton-

Raphson por medio del programa "DOSINSENSI", en muchos casos no converge a una solución, y en los casos que converge, lo hace a una de las 68 soluciones que pueden verse en las tablas (V-1) a (V-4).

113

Page 134: Tesis

Síntesis de un Manipulador 6-RKS

V.3.4 – Soluciones

Ángulo de la manivela

"1" θ1

Ángulo de la manivela

"2" θ2

Ángulo de la manivela

"3" θ3

Ángulo de la manivela

"4" θ4

Ángulo de la manivela

"5" θ5

Ángulo de la manivela

"6" θ6

1 1.7894 1.7897 1.7892 1.3522 4.9309 1.7893 2 4.4938 1.7897 1.7892 1.3522 4.9309 1.3522 3 1.7894 1.7897 1.7892 1.3522 1.3522 1.7893 4 1.7894 1.7897 1.7892 1.3522 1.3522 1.3522 5 1.7894 1.7897 1.7892 1.3522 1.3522 1.7893 6 1.7894 1.7897 1.7892 1.3522 4.9309 1.3522 7 1.7894 1.7897 4.494 4.9309 1.3522 4.4938 8 1.7894 1.7897 1.7892 1.3522 1.3522 1.3522 9 1.7894 1.7897 1.3524 1.3522 4.9309 1.7893

10 1.7894 1.7897 1.3524 1.3522 1.3522 1.3522 11 1.7894 1.7897 4.9308 4.9309 1.3522 4.4938 12 1.7894 1.7897 1.3524 1.3522 1.3522 4.9309 13 1.7894 1.7897 1.3524 1.3522 1.3522 1.7893 14 1.7894 1.7897 1.3524 1.3522 4.9309 1.3522 15 1.7894 1.7897 4.9308 4.9309 1.3522 4.4938 16 1.7894 1.7897 1.3524 1.3522 1.3522 1.3522 17 1.7894 4.4935 4.9308 4.9304 1.3522 1.7893 18 1.7894 4.4935 1.5708 4.9309 4.9309 4.9309 19 4.4938 1.3519 1.7892 1.3522 4.9309 1.3522 20 4.4938 1.3519 1.7892 4.9309 0.9762 4.4938 21 4.4938 1.3519 1.7892 1.3522 4.9309 4.9309 22 1.7894 1.3519 1.7892 1.3522 1.3522 1.7893 23 4.4938 1.3519 1.7892 1.3522 4.9309 1.3522 24 1.7894 1.3519 4.494 4.9309 1.3522 4.4938 25 1.7894 1.3519 4.494 4.9309 1.3522 4.9309 26 1.7894 1.3519 1.3524 1.3522 4.9309 1.7893 27 1.7894 1.3519 1.3524 1.3522 1.3522 1.3522 28 1.7894 4.9313 4.9308 4.9309 1.3522 4.4938 29 1.7894 1.3519 4.9308 4.9309 1.3522 4.9309 30 1.7894 1.3519 1.3524 1.3522 1.3522 1.7893 31 1.7894 1.3519 1.3524 1.3522 1.3522 1.3522 32 1.7894 4.9313 4.9308 4.9309 1.3522 4.4938 33 1.7894 1.3519 1.3524 1.3522 1.3522 1.3522

114

Page 135: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

34 4.3216 1.7897 4.494 4.9309 4.9309 1.3522 35 1.3522 1.7897 1.7892 1.3522 1.3522 1.7893 36 1.3522 1.7897 1.7892 1.3522 4.9309 1.3522 37 1.3522 1.7897 1.7892 1.3522 1.3522 1.7893 38 4.931 1.7897 1.7892 1.3522 1.3522 1.3522 39 1.3522 1.7897 1.7892 1.3522 1.3522 1.7893 40 1.3522 1.7897 1.7892 1.3522 4.9309 1.3522 41 1.3522 1.7897 4.494 4.9309 1.3522 4.4938 42 4.931 1.7897 1.7892 1.3522 1.3522 1.3522 43 4.931 1.7897 1.3524 1.3522 4.9309 1.7893 44 1.3522 1.7897 1.3524 1.3522 4.9309 1.3522 45 1.3522 1.7897 4.9308 4.9309 1.3522 4.4938 46 1.3522 1.7897 4.9308 4.9309 1.3522 4.9309 47 4.931 1.7897 1.3524 1.3522 1.3522 1.7893 48 1.3522 1.7897 1.3524 1.3522 1.3522 1.3522 49 1.3522 1.7897 4.9308 4.9309 1.3522 4.4938 50 4.931 1.7897 1.3524 1.3522 1.3522 1.3522 51 1.3522 4.4935 1.5708 4.9309 4.9309 4.4938 52 1.3522 4.4935 1.5708 4.9309 4.9309 4.4938 53 4.931 1.3519 1.7892 1.3522 4.9309 1.7893 54 1.3522 1.3519 1.7892 1.3522 4.9309 1.3522 55 4.931 4.9313 1.7892 1.3522 1.3522 1.7893 56 4.931 4.9313 1.7892 1.3522 1.3522 1.3522 57 4.931 1.3519 1.7892 1.3522 1.3522 1.7893 58 1.3522 1.3519 1.7892 1.3522 4.9309 1.3522 59 1.3522 1.3519 4.494 4.9309 1.3522 4.4938 60 4.931 4.9313 1.7892 1.3522 1.3522 1.3522 61 1.3522 1.3519 1.3524 1.3522 4.9309 1.7893 62 1.3522 1.3519 1.3524 1.3522 1.3522 1.3522 63 4.931 4.9313 4.9308 1.3522 1.3522 1.7893 64 4.931 4.9313 4.9308 1.3522 1.3522 1.3522 65 1.3522 1.3519 1.3524 1.3522 4.9309 1.7893 66 1.3522 1.3519 1.3524 1.3522 1.3522 1.3522 67 4.931 4.9313 4.9308 4.9309 1.3522 1.7893 68 1.3522 1.3519 1.3524 1.3522 1.3522 1.3522

Tabla V-1 Ángulos de las manivelas en la primera posición.

115

Page 136: Tesis

Síntesis de un Manipulador 6-RKS

Ángulo de

la manivela "1" θ1

Ángulo de la manivela

"2" θ2

Ángulo de la manivela

"3" θ3

Ángulo de la manivela

"4" θ4

Ángulo de la manivela

"5" θ5

Ángulo de la manivela

"6" θ6

1 4.9048 4.9048 4.8982 4.3142 1.9689 4.8982 2 1.3784 4.9048 4.8982 4.3142 1.9689 1.385 3 4.9048 4.9048 4.8982 4.3142 1.1727 4.8982 4 4.9048 4.9048 4.8982 4.3142 1.1727 1.385 5 4.9048 4.9048 4.8982 1.1727 4.3142 4.8982 6 4.9048 4.9048 4.8982 1.1727 1.9689 1.385 7 4.9048 4.9048 1.385 5.1105 1.1727 1.385 8 4.9048 4.9048 4.8982 1.1727 1.1727 1.385 9 4.9048 4.9048 1.385 4.3142 1.9689 4.8982

10 4.9048 4.9048 1.385 4.3142 4.3142 1.385 11 4.9048 4.9048 4.8982 1.9689 1.1727 1.385 12 4.9048 4.9048 1.385 4.3142 1.1727 4.8982 13 4.9048 4.9048 1.385 1.1727 4.3142 4.8982 14 4.9048 4.9048 1.385 1.1727 1.9689 1.385 15 4.9048 4.9048 4.8982 5.1105 1.1727 1.385 16 4.9048 4.9048 1.385 1.1727 1.1727 1.385 17 4.9048 1.3784 4.8982 5.1078 4.3142 4.8982 18 4.9048 1.3784 1.5216 1.9689 5.1105 4.8982 19 1.3784 1.3784 4.8982 4.3142 1.9689 1.385 20 1.3784 1.3784 4.8982 1.9689 4.0397 1.385 21 1.3784 1.3784 4.8982 4.3142 5.1105 4.8982 22 4.9048 1.3784 4.8982 1.1727 4.3142 4.8982 23 1.3784 1.3784 4.8982 1.1727 1.9689 1.385 24 4.9048 1.3784 1.385 5.1105 1.1727 1.385 25 4.9048 1.3784 1.385 5.1105 1.1727 4.8982 26 4.9048 1.3784 1.385 4.3142 1.9689 4.8982 27 4.9048 1.3784 1.385 4.3142 4.3142 1.385 28 4.9048 4.9048 4.8982 1.9689 1.1727 1.385 29 4.9048 1.3784 4.8982 1.9689 1.1727 4.8982 30 4.9048 1.3784 1.385 1.1727 4.3142 4.8982 31 4.9048 1.3784 1.385 1.1727 4.3142 1.385 32 4.9048 4.9048 4.8982 5.1105 1.1727 1.385 33 4.9048 1.3784 1.385 1.1727 1.1727 1.385 34 1.1936 4.9048 1.385 1.9689 1.9689 1.385

116

Page 137: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

35 1.3784 4.9048 4.8982 4.3142 4.3142 4.8982 36 1.3784 4.9048 4.8982 4.3142 1.9689 1.385 37 1.3784 4.9048 4.8982 4.3142 1.1727 4.8982 38 4.9048 4.9048 4.8982 4.3142 1.1727 1.385 39 1.3784 4.9048 4.8982 1.1727 4.3142 4.8982 40 1.3784 4.9048 4.8982 1.1727 1.9689 1.385 41 1.3784 4.9048 1.385 5.1105 1.1727 1.385 42 4.9048 4.9048 4.8982 1.1727 1.1727 1.385 43 4.9048 4.9048 1.385 4.3142 1.9689 4.8982 44 1.3784 4.9048 1.385 4.3142 1.9689 1.385 45 1.3784 4.9048 4.8982 1.9689 1.1727 1.385 46 1.3784 4.9048 4.8982 1.9689 1.1727 4.8982 47 4.9048 4.9048 1.385 1.1727 4.3142 4.8982 48 1.3784 4.9048 1.385 1.1727 4.3142 1.385 49 1.3784 4.9048 4.8982 5.1105 1.1727 1.385 50 4.9048 4.9048 1.385 1.1727 1.1727 1.385 51 1.3784 1.3784 1.5216 1.9689 1.9689 1.385 52 1.3784 1.3784 1.5216 5.1105 5.1105 1.385 53 4.9048 1.3784 4.8982 4.3142 1.9689 4.8982 54 1.3784 1.3784 4.8982 4.3142 1.9689 1.385 55 4.9048 4.9048 4.8982 4.3142 1.1727 4.8982 56 4.9048 4.9048 4.8982 4.3142 1.1727 1.385 57 4.9048 1.3784 4.8982 1.1727 4.3142 4.8982 58 1.3784 1.3784 4.8982 1.1727 1.9689 1.385 59 1.3784 1.3784 1.385 5.1105 1.1727 1.385 60 4.9048 4.9048 4.8982 1.1727 1.1727 1.385 61 1.3784 1.3784 1.385 4.3142 1.9689 4.8982 62 1.3784 1.3784 1.385 4.3142 4.3142 1.385 63 4.9048 4.9048 4.8982 4.3142 1.1727 4.8982 64 4.9048 4.9048 4.8982 4.3142 1.1727 1.385 65 1.3784 1.3784 1.385 1.1727 1.9689 4.8982 66 1.3784 1.3784 1.385 1.1727 4.3142 1.385 67 4.9048 4.9048 4.8982 5.1105 1.1727 4.8982 68 1.3784 1.3784 1.385 1.1727 1.1727 1.385

Tabla V-2 Ángulos de las manivelas para la segunda posición.

117

Page 138: Tesis

Síntesis de un Manipulador 6-RKS

Longitud

de la manivela

"1" R 1

Longitud de la

manivela "2" R 2

Longitud de la

manivela "3" R 4

Longitud de la

manivela "4" R 4

Longitud de la

manivela "5" R 5

Longitud de la

manivela "6" R 6

1 0.0537 0.0536 0.0528 0.0899 0.0899 0.0528 2 0.0537 0.0536 0.0528 0.0899 0.0899 0.7133 3 0.0537 0.0536 0.0528 0.0899 0.6792 0.0528 4 0.0537 0.0536 0.0528 0.0899 0.6792 0.7133 5 0.0537 0.0536 0.0528 0.6792 0.0899 0.0528 6 0.0537 0.0536 0.0528 0.6792 0.0899 0.7133 7 0.0537 0.0536 0.0528 0.6792 0.6792 0.0528 8 0.0537 0.0536 0.0528 0.6792 0.6792 0.7133 9 0.0537 0.0536 0.7136 0.0899 0.0899 0.0528

10 0.0537 0.0536 0.7136 0.0899 0.0899 0.7133 11 0.0537 0.0536 0.7136 0.0899 0.6792 0.0528 12 0.0537 0.0536 0.7136 0.0899 0.6792 0.7133 13 0.0537 0.0536 0.7136 0.6792 0.0899 0.0528 14 0.0537 0.0536 0.7136 0.6792 0.0899 0.7133 15 0.0537 0.0536 0.7136 0.6792 0.6792 0.0528 16 0.0537 0.0536 0.7136 0.6792 0.6792 0.7133 17 0.0537 0.0536 0.7136 0.6814 0.0899 0.0528 18 0.0537 0.0536 0.7665 0.0899 0.6792 0.7133 19 0.0537 0.7193 0.0528 0.0899 0.0899 0.7133 20 0.0537 0.7193 0.0528 0.0899 0.106 0.0528 21 0.0537 0.7193 0.0528 0.0899 0.6792 0.7133 22 0.0537 0.7193 0.0528 0.6792 0.0899 0.0528 23 0.0537 0.7193 0.0528 0.6792 0.0899 0.7133 24 0.0537 0.7193 0.0528 0.6792 0.6792 0.0528 25 0.0537 0.7193 0.0528 0.6792 0.6792 0.7133 26 0.0537 0.7193 0.7136 0.0899 0.0899 0.0528 27 0.0537 0.7193 0.7136 0.0899 0.0899 0.7133 28 0.0537 0.7193 0.7136 0.0899 0.6792 0.0528 29 0.0537 0.7193 0.7136 0.0899 0.6792 0.7133 30 0.0537 0.7193 0.7136 0.6792 0.0899 0.0528 31 0.0537 0.7193 0.7136 0.6792 0.0899 0.7133 32 0.0537 0.7193 0.7136 0.6792 0.6792 0.0528 33 0.0537 0.7193 0.7136 0.6792 0.6792 0.7133 34 0.0566 0.0536 0.0528 0.0899 0.0899 0.7133

118

Page 139: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

35 0.7193 0.0536 0.0528 0.0899 0.0899 0.0528 36 0.7193 0.0536 0.0528 0.0899 0.0899 0.7133 37 0.7193 0.0536 0.0528 0.0899 0.6792 0.0528 38 0.7193 0.0536 0.0528 0.0899 0.6792 0.7133 39 0.7193 0.0536 0.0528 0.6792 0.0899 0.0528 40 0.7193 0.0536 0.0528 0.6792 0.0899 0.7133 41 0.7193 0.0536 0.0528 0.6792 0.6792 0.0528 42 0.7193 0.0536 0.0528 0.6792 0.6792 0.7133 43 0.7193 0.0536 0.7136 0.0899 0.0899 0.0528 44 0.7193 0.0536 0.7136 0.0899 0.0899 0.7133 45 0.7193 0.0536 0.7136 0.0899 0.6792 0.0528 46 0.7193 0.0536 0.7136 0.0899 0.6792 0.7133 47 0.7193 0.0536 0.7136 0.6792 0.0899 0.0528 48 0.7193 0.0536 0.7136 0.6792 0.0899 0.7133 49 0.7193 0.0536 0.7136 0.6792 0.6792 0.0528 50 0.7193 0.0536 0.7136 0.6792 0.6792 0.7133 51 0.7193 0.0536 0.7665 0.0899 0.0899 0.0528 52 0.7193 0.0536 0.7665 0.6792 0.6792 0.0528 53 0.7193 0.7193 0.0528 0.0899 0.0899 0.0528 54 0.7193 0.7193 0.0528 0.0899 0.0899 0.7133 55 0.7193 0.7193 0.0528 0.0899 0.6792 0.0528 56 0.7193 0.7193 0.0528 0.0899 0.6792 0.7133 57 0.7193 0.7193 0.0528 0.6792 0.0899 0.0528 58 0.7193 0.7193 0.0528 0.6792 0.0899 0.7133 59 0.7193 0.7193 0.0528 0.6792 0.6792 0.0528 60 0.7193 0.7193 0.0528 0.6792 0.6792 0.7133 61 0.7193 0.7193 0.7136 0.0899 0.0899 0.0528 62 0.7193 0.7193 0.7136 0.0899 0.0899 0.7133 63 0.7193 0.7193 0.7136 0.0899 0.6792 0.0528 64 0.7193 0.7193 0.7136 0.0899 0.6792 0.7133 65 0.7193 0.7193 0.7136 0.6792 0.0899 0.0528 66 0.7193 0.7193 0.7136 0.6792 0.0899 0.7133

0.7193 0.7193 0.6792 0.0528 68 0.7193 0.7136 0.6792 0.7193 0.6792 0.7133 67 0.7136 0.6792

Tabla V-3 Longitudes de las manivelas para dos CIP

119

Page 140: Tesis

Síntesis de un Manipulador 6-RKS

Longitud

biela "1" L1

Longitud biela "2"

LL2

Longitud biela "3"

L3

Longitud biela "4"

L4

Longitud biela "5"

5

Longitud biela "6"

L6 1 0.7466 0.7466 0.7457 0.6095 0.6095 0.7457 2 0.7466 0.7466 0.7457 0.6095 0.6095 0.2056 3 0.7466 0.7466 0.7457 0.6095 0.2005 0.7457

0.7466 0.7466 0.7457 0.6095 0.2005 0.2056 5 0.7466 0.7466 0.7457 0.2005 0.6095 0.7457 6 0.7466 0.7466 0.7457 0.2005 0.6095 0.2056 7 0.7466 0.7466 0.7457 0.2005 0.2005 0.7457 8 0.7466 0.7466 0.7457 0.2005 0.2005 0.2056

0.7466 0.7466 0.2055 0.6095 0.6095 0.7457 10 0.7466 0.7466 0.2055 0.6095 0.6095 0.2056 11 0.7466 0.7466 0.2055 0.6095 0.2005 0.7457 12 0.7466 0.7466 0.2055 0.6095 0.2005 0.2056 13 0.7466 0.7466 0.2055 0.2005 0.6095 0.7457

0.7466 0.2055 0.2005 0.2056 15 0.7466 0.7466 0.2055 0.2005 0.2005 0.7457 16 0.7466 0.7466 0.2055 0.2005 0.2005 0.2056 17 0.7466 0.7457 0.7466 0.2055 0.1993 0.6095 18 0.7466 0.7466 0.6095 0.1654 0.2005 0.2056 19 0.7466 0.2071 0.7457 0.6095 0.6095 0.2056 20 0.7466 0.2071 0.7457 0.6095 0.6095 0.7457 21 0.7466 0.2071 0.7457 0.6095 0.2005 0.2056 22 0.7466 0.2071 0.7457 0.2005 0.6095 0.7457 23 0.7466 0.2071 0.7457 0.2005 0.6095 0.2056 24 0.7466 0.2071 0.7457 0.2005 0.2005 0.7457 25 0.7466 0.2071 0.7457 0.2005 0.2005 0.2056 26 0.7466 0.2071 0.2055 0.6095 0.6095 0.7457 27 0.7466 0.2071 0.2055 0.6095 0.6095 0.2056 28 0.7466 0.2071 0.2055 0.6095 0.2005 0.7457 29 0.7466 0.2071 0.2055 0.6095 0.2005 0.2056 30 0.7466 0.2071 0.2055 0.2005 0.6095 0.7457 31 0.7466 0.2071 0.2055 0.2005 0.6095 0.2056 32 0.7466 0.2071 0.2055 0.2005 0.2005 0.7457 33 0.7466 0.2071 0.2055 0.2005 0.2005 0.2056

0.7457 0.6095 0.2056 35 0.2071 0.7466 0.7457 0.6095 0.6095 0.7457

4

9

14 0.7466 0.6095

34 0.7466 0.7466 0.6095

120

Page 141: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

36 0.2071 0.7466 0.7457 0.6095 0.6095 0.2056 37 0.2071 0.2005 0.7466 0.7457 0.6095 0.7457 38 0.2071 0.7466 0.7457 0.6095 0.2005 0.2056 39 0.2071 0.7466 0.7457 0.2005 0.6095 0.7457 40 0.2071 0.7466 0.6095 0.7457 0.2005 0.2056 41 0.2071 0.7466 0.7457 0.2005 0.2005 0.7457 42 0.2071 0.7466 0.7457 0.2005 0.2005 0.2056 43 0.2071 0.2055 0.6095 0.7466 0.6095 0.7457 44 0.2071 0.7466 0.2055 0.6095 0.6095 0.2056 45 0.2071 0.7466 0.2055 0.6095 0.2005 0.7457 46 0.2071 0.7466 0.2055 0.2005 0.6095 0.2056 47 0.2071 0.7466 0.2005 0.2055 0.6095 0.7457 48 0.2071 0.7466 0.2055 0.2005 0.6095 0.2056 49 0.2071 0.7466 0.2055 0.2005 0.2005 0.7457 50 0.2071 0.7466 0.2055 0.2005 0.2005 0.2056

0.7466 0.1654 0.6095 0.6095 0.7457 52 0.2071 0.2005 0.7466 0.1654 0.2005 0.7457 53 0.2071 0.2071 0.7457 0.6095 0.6095 0.7457 54 0.2071 0.2071 0.7457 0.6095 0.6095 0.2056 55 0.2071 0.2071 0.7457 0.6095 0.2005 0.7457 56 0.2071 0.2071 0.7457 0.6095 0.2005

0.2071 0.7457 0.2005 0.6095 0.7457 58 0.2071 0.2071 0.7457 0.2005 0.6095 0.2056

0.2071 0.7457 0.2005 0.2005 0.7457 60 0.2071 0.2071 0.7457 0.2005 0.2005 0.2056 61 0.2071 0.2071 0.7457 0.2055 0.6095 0.6095

0.2071 0.2055 0.6095 0.6095 0.2056 63 0.2071 0.2071 0.2055 0.6095 0.2005 0.7457 64 0.2071 0.2071 0.2055 0.6095 0.2005 0.2056 65 0.2071 0.2071 0.2055 0.2005 0.6095 0.7457 66 0.2071 0.2071 0.2055 0.6095 0.2005 0.2056

0.2005 0.2055 0.2005 0.2056

51 0.2071

0.2056 57 0.2071

59 0.2071

62 0.2071

67 0.2071 0.2071 0.2055 0.2005 0.7457 68 0.2071 0.2071 0.2005

Tabla V-4 Longitudes de las bielas para dos CIP

121

Page 142: Tesis

Síntesis de un Manipulador 6-RKS

V.3.5 – Conclusiones de la síntesis para dos CIP

Como conclusión, para que el manipulador del ejemplo pueda conseguir las dos posiciones predeterminadas, deberá tener las dimensiones siguientes:

Longitudes de manivelas:

R1 = 0.0537 metros.

R "

Para la solución aceptable, otra conclusión interesante es, que la primera posición se consigue con las manivelas "1", "2", "3", "4" y "6" hacia arriba y la "5" hacia abajo y la segunda posición se consigue con las manivelas totalmente opuestas, es decir, las manivelas "1", "2", "3", "4" y "6" hacia abajo y la "5" hacia arriba.

Observando los valores de las longitudes de las manivelas, se observa, que de las 68 combinaciones solamente es aceptable la primera, ya que las demás tienen alguna manivela de mayor longitud que su biela correspondiente y por lo tanto, esa manivela no podría alcanzar las dos posiciones de insensitividad al haber interferencia de la plataforma móvil con la fija.

R2 = 0.0536 " R3 = 0.0528 "

4 = 0.0899 R5 = 0.0899 " R6 = 0.0528 "

Y longitudes de bielas:

L1 = 0.7466 metros. L2 = 0.7466 " L3 = 0.7457 " L4 = 0.6095 " L5 = 0.6095 " L6 = 0.7457 "

122

Page 143: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

V.4 – EJEMPLO NUMÉRICO PARA TRES CIP

En este ejemplo, siguiendo el proceso expuesto en el apartado V.2.3, se sintetizará un manipulador paralelo 6-RKS para lograr que tres posiciones predeterminadas de la plataforma móvil se consigan estando el manipulador en configuración de insensitividad de posición (CIP).

Con el manipulador expuesto como ejemplo del Capítulo IV, se desea

posicionar horizontalmente para realizar un mecanizado, tres triángulos equiláteros de 0.15 metros de altura, y que forman un ángulo de 10º entre ellos (Fig. V-9), de forma que:

- En la primera posición la plataforma móvil y el triángulo "1" deben estar

horizontales, la arista entre los triángulos "1" y "2" paralela al eje "Y" del manipulador y con el baricentro del triángulo "1" sobre el eje "Z".

- En la segunda posición el triángulo "2" debe estar horizontal, con la arista entre los triángulos "1" y "2" paralela al eje "Y" del manipulador y con el baricentro del triángulo "2" sobre el eje "Z".

- Y en la tercera posición el triángulo "3" horizontal, con la arista de la derecha paralela al eje "Y" y con el baricentro sobre el eje "Z".

La altura del baricentro de los triángulos, en todos los casos, debe ser

0.1 metros por encima del baricentro del triángulo de la plataforma móvil correspondiente a la primera CIP del ejemplo del Capítulo IV, es decir, a 0.7498 metros. V.4.1 – Introducción de datos

Realizando los cálculos oportunos resulta que las coordenadas de los vértices de la plataforma móvil para la primera posición serán las siguientes:

X123A = -0.1441 Y123A = 0.25 Z123A = 0.6498

X145A = 0.2887 Y145A = 0 Z145A = 0.6498

X161A = -0.1441 Y161A = -0.25 Z161A = 0.6498

123

Page 144: Tesis

Síntesis de un Manipulador 6-RKS

Fig. V-9 Posiciones de las superficies a mecanizar

Para la segunda posición la pieza debe realizar un giro de 10º alrededor de un eje paralelo al eje "Y", que corte al eje "Z" y que esté 0.4715 metros por debajo de la plataforma móvil, resultando las coordenadas siguientes:

X Y Z145B = 0.5919

X123B = -0.0603 Y123B = 0.25 Z123B = 0.6677

145B = 0.3656 145B = 0

X161B = -0.0603 Y161B = -0.25 Z161B = 0.6677

124

Page 145: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Para la tercera posición, partiendo de la primera, la pieza debe realizar un giro de 10º alrededor de un eje paralelo a los ejes de los actuadores "3" y "4", que corte al eje "Z" y que esté 0.4715 metros por debajo de plataforma móvil, resultando las coordenadas siguientes de los vértices de la plataforma móvil: X Y123C = 0.1773 Z

123C = -0.1863 123C = 0.6677

X145C = 0.3656 Y145C = -0.073 Z145C = 0.6677

X161C = -0.1828 Y161C = -0.317 Z161C = 0.5919

Tomando las dimensiones de la plataforma fija y la posición de los actuadores igual que en el ejemplo del Capítulo IV, resultará que las coordenadas de los puntos 01 a 06 serán:

01 = (-0.288675134, -0.05, 0) 02 = (-0.288675134, 0.05, 0) 03 = (0.101036297, 0.275, 0) 04 = (0.187638837, 0.225, 0) 05 = (0.187638837, -0.225, 0) 06 = (0.101036297, -0.275, 0)

Como valores para la primera iteración se tomará, longitudes de las

manivelas:

R1 = R2 = R3 = R4 = R5 = R6 = 0.1 metros. Y como longitudes de las bielas:

L1 = L2 = L3 = L4 = L5 = L6 = 0.6 metros

Las longitudes de los lados del triángulo de la plataforma móvil ya quedan determinados al introducir las coordenadas de los vértices para las tres posiciones preestablecidas.

Para las coordenadas de los extremos de las manivelas, puntos del 11 al 16, se irán tomando como coordenadas las 64 x 64 x 64 = 262.144 combinaciones de coordenadas de estos puntos obtenidas en las 64 CIP del manipulador del ejemplo del Capítulo IV.

125

Page 146: Tesis

Síntesis de un Manipulador 6-RKS

V.4.2 – Condiciones de restricción

Como condiciones de restricción se tendrá:

Para las longitudes constantes de las manivelas en la primera posición:

( ) ( ) ( ) 0RZZYYXX 21

201A11

201A11

201A11 =−−+−+− (V-73)

( ) ( ) ( ) 0RZZYYXX 22

202A12

202A12

202A12 =−−+−+− (V-74)

( ) ( ) ( ) 0RZZYYXX 23

203A13

203A13

203A13 =−−+−+− (V-75)

( ) ( ) ( ) 0RZZYYXX 24

204A14

204A14

204A14 =−−+−+− (V-76)

( ) ( ) ( ) 0RZZYYXX 25

205A15

205A15

205A15 =−−+−+− (V-77)

( ) ( ) ( ) 0RZZYYXX 26

206A16

206A16

206A16 =−−+−+− (V-78)

Para las longitudes constantes de las manivelas en la segunda posición:

( ) ( ) ( ) 0RZZYYXX 21

201B11

201B11

201B11 =−−+−+− (V-79)

( ) ( ) ( ) 0RZZYYXX 22

202B12

202B12

202B12 =−−+−+− (V-80)

( ) ( ) ( ) 0RZZYYXX 23

203B13

203B13

203B13 =−−+−+− (V-81)

( ) ( ) ( ) 0RZZYYXX 24

204B14

204B14

204B14 =−−+−+− (V-82)

( ) ( ) ( ) 0RZZYYXX 25

205B15

205B15

205B15 =−−+−+− (V-83)

( ) ( ) ( ) 0RZZYYXX 26

206B16

206B16

206B16 =−−+−+− (V-84)

Para las longitudes constantes de las manivelas en la tercera posición:

( ) ( ) ( ) 0RZZYYXX 21

201C11

201C11

201C11 =−−+−+− (V-85)

( ) ( ) ( ) 0RZZYYXX 22

202C12

202C12

202C12 =−−+−+− (V-86)

( ) ( ) ( ) 0RZZYYXX 23

203C13

203C13

203C13 =−−+−+− (V-87)

( ) ( ) ( ) 0RZZYYXX 24

204C14

204C14

204C14 =−−+−+− (V-88)

( ) ( ) ( ) 0RZZYYXX 25

205C15

205C15

205C15 =−−+−+− (V-89)

( ) ( ) ( ) 0RZZYYXX 26

206C16

206C16

206C16 =−−+−+− (V-90)

126

Page 147: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Para las longitudes constantes de las bielas en la primera posición:

( ) ( ) ( ) 0LZZYYXX 21

2A11A161

2A11A161

2A11A161 =−−+−+− (V-91)

( ) ( ) ( ) 0LZZYYXX 22

2A12A123

2A12A123

2A12A123 =−−+−+− (V-92)

( ) ( ) ( ) 0LZZYYXX 23

2A13A123

2A13A123

2A13A123 =−−+−+− (V-93)

( ) ( ) ( ) 0LZZYYXX 24

2A14A145

2A14A145

2A14A145 =−−+−+− (V-94)

( ) ( ) ( ) 0LZZYYXX 25

2A15A145

2A15A145

2A15A145 =−−+−+− (V-95)

( ) ( ) ( ) 0LZZYYXX 26

2A16A161

2A16A161

2A16A161 =−−+−+− (V-96)

Para las longitudes constantes de las bielas en la segunda posición:

( ) ( ) ( ) 0LZZYYXX 21

2B11B161

2B11B161

2B11B161 =−−+−+− (V-97)

( ) ( ) ( ) 0LZZYYXX 22

2B12B123

2B12B123

2B12B123 =−−+−+− (V-98)

( ) ( ) ( ) 0LZZYYXX 23

2B13B123

2B13B123

2B13B123 =−−+−+− (V-99)

( ) ( ) ( ) 0LZZYYXX 24

2B14B145

2B14B145

2B14B145 =−−+−+− (V-100)

( ) ( ) ( ) 0LZZYYXX 25

2B15B145

2B15B145

2B15B145 =−−+−+− (V-101)

( ) ( ) ( ) 0LZZYYXX 26

2B16B161

2B16B161

2B16B161 =−−+−+− (V-102)

Para las longitudes constantes de las bielas en la tercera posición:

( ) ( ) ( ) 0LZZYYXX 21

2C11C161

2C11C161

2C11C161 =−−+−+− (V-103)

( ) ( ) ( ) 0LZZYYXX 22

2C12C123

2C12C123

2C12C123 =−−+−+− (V-104)

( ) ( ) ( ) 0LZZYYXX 23

2C13C123

2C13C123

2C13C123 =−−+−+− (V-105)

( ) ( ) ( ) 0LZZYYXX 24

2C14C145

2C14C145

2C14C145 =−−+−+− (V-106)

( ) ( ) ( ) 0LZZYYXX 25

2C15C145

2C15C145

2C15C145 =−−+−+− (V-107)

( ) ( ) ( ) 0LZZYYXX 26

2C16C161

2C16C161

2C16C161 =−−+−+− (V-108)

127

Page 148: Tesis

Síntesis de un Manipulador 6-RKS

Para la perpendicularidad de las circunferencias descritas por los extremos de las manivelas con los ejes de los actuadores respectivos, en la primera posición:

(V-109) 0YY 01A11 =−0YY 02A12 =− (V-110)

( ) ( 0YYXX3 03A1303A13 =−−−⋅ ) (V-111) ( ) ( 0YYXX3 04A1404A14 =−−−⋅ ) (V-112) ( ) ( 0YYXX3 05A1505A15 =−−−⋅ ) (V-113) ( ) ( 0YYXX3 06A1606A16 =−−−⋅ )

(V-116)

(V-114)

Para la perpendicularidad de las circunferencias descritas por los extremos de las manivelas con los ejes de los actuadores respectivos, en la segunda posición:

0YY 01B11 =− (V-115) 0YY 02B12 =−

( ) ( 0YYXX3 03B1303B13 =−−−⋅ ) (V-117) ( ) ( 0YYXX3 04B1404B14 =−−−⋅ ) (V-118) ( ) ( 0YYXX3 05B1505B15 =−−−⋅ ) (V-119) ( ) ( 0YYXX3 06B1606B16 =−−−⋅ ) (V-120)

Para la perpendicularidad de las circunferencias descritas por los extremos de las manivelas con los ejes de los actuadores respectivos, en la tercera posición:

0YY 01C11 =− (V-121) 0YY 02C12 =− (V-122)

( ) ( 0YYXX3 03C1303C13 =−−−⋅ ) (V-123) ( ) ( 0YYXX3 04C1404C14 =−−−⋅ ) (V-124) ( ) ( 0YYXX3 05C1505C15 =−−−⋅ ) (V-125) ( ) ( 0YYXX3 06C1606C16 =−−−⋅ ) (V-126)

128

Page 149: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Para la condición de que el eje del actuador, la manivela y la biela de cada cadena deben estar contenidas en un plano, para la primera posición de la plataforma móvil:

( ) ( ) ( ) ( ) 0ZZXXXXZZ A11A16101A11A11A16101A11 =−⋅−−−⋅− (V-127) ( ) ( ) ( ) ( ) 0ZZXXXXZZ A12A12302A12A12A12302A12 =−⋅−−−⋅− (V-128)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

A13A12303A13A13A12303A13

A13A12303A13A13A12303A13

=−−+−−

+−−−−−− (V-129)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

A14A14504A14A14A14504A14

A14A14504A14A14A14504A14

=−−+−−

+−−−−−− (V-130)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

A15A14505A15A15A14505A15

A15A14505A15A15A14505A15

=−−+−−

+−−−−−− (V-131)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

A16A16106A16A16A16106A16

A16A16106A16A16A16106A16

=−−+−−

+−−−−−− (V-132)

Para la condición de que el eje del actuador, la manivela y la biela de

cada cadena deben estar contenidas en un plano, para la segunda posición de la plataforma móvil:

( ) ( ) ( ) ( ) 0ZZXXXXZZ B11B16101B11B11B16101B11 =−⋅−−−⋅− (V-133) ( ) ( ) ( ) ( ) 0ZZXXXXZZ B12B12302B12B12B12302B12 =−⋅−−−⋅− (V-134)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

B13B12303B13B13B12303B13

B13B12303B13B13B12303B13

=−−+−−

+−−−−−− (V-135)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

B14B14504B14B14B14504B14

B14B14504B14B14B14504B14

=−−+−−

+−−−−−− (V-136)

129

Page 150: Tesis

Síntesis de un Manipulador 6-RKS

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

B15B14505B15B15B14505B15

B15B14505B15B15B14505B15

=−−+−−

+−−−−−− (V-137)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

B16B16106B16B16B16106B16

B16B16106B16B16B16106B16

=−−+−−

+−−−−−− (V-138)

Para la condición de que el eje del actuador, la manivela y la biela de

cada cadena deben estar contenidas en un plano, para la tercera posición de la plataforma móvil:

( ) ( ) ( ) ( ) 0ZZXXXXZZ C11C16101C11C11C16101C11 =−⋅−−−⋅− (V-139) ( ) ( ) ( ) ( ) 0ZZXXXXZZ C12C12302C12C12C12302C12 =−⋅−−−⋅− (V-140)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

C13C12303C13C13C12303C13

C13C12303C13C13C12303C13

=−−+−−

+−−−−−− (V-141)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

C14C14504C14C14C14504C14

C14C14504C14C14C14504C14

=−−+−−

+−−−−−− (V-142)

( ) ( ) ( ) ( )( ) ( ) ( ) ( ) 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

C15C14505C15C15C14505C15

C15C14505C15C15C14505C15

=−−+−−

+−−−−−− (V-143)

( ) ( ) ( ) ( )( ) ( ) ( ) ( 0ZZ·XXZZ·YY3

YY·ZZ3XX·ZZ

C16C16106C16C16C16106C16

A16C16106C16C16C16106C16

=−−+−−

+−−−−−−

)

(V-144)

V.4.3 – Resolución del sistema

Resolviendo este sistema de 72 ecuaciones (V-73) a (V-144) por el método de Newton-Raphson para las 262.144 combinaciones de valores iniciales por medio del programa "TRESINSENSI" realizado en MATLAB, tomando como variables las 54 coordenadas de los extremos de las manivelas, las doce longitudes de manivelas y bielas y las seis coordenadas "X" de los actuadores, se han conseguido 1701 combinaciones diferentes de longitudes de manivelas y bielas y coordenadas "X" de los actuadores.

130

Page 151: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

V.4.4 – Soluciones

De las 262.144 iteraciones realizadas en muchos casos no converge a una solución, y en otros muchos casos converge a una de las 1701 soluciones citadas.

Cabe resaltar que se han obtenido 1.701 soluciones diferentes en vez

de las 198.144 teóricamente posibles. Esto es lógico ya que como se ha visto en el caso de dos posiciones prefijadas, no todas las combinaciones teóricamente posibles son posibles en la realidad.

Una de estas soluciones es por ejemplo:

Longitudes de las manivelas:

R1 = 0.0065 metros. R4 = 0.0066 metros. R2 = 0.0014 " R5 = 0.0094 " R3 = 0.0123 " R6 = 0.0141 "

Longitudes de las bielas:

L1 = 0.6960 metros. L4 = 0.7317 metros. L2 = 0.6625 " L5 = 0.7579 " L3 = 0.8765 " L6 = 0.7308 "

Coordenadas "X" de los actuadores:

X01 = 0.1471 metros. X04 = -0.2488 metros. X02 = -0.0348 " X05 = 0.0115 " X03 = -0.1552 " X06 = 0.2690 "

En la mayoría de las soluciones, la posición de los actuadores es tal que se pueden producir interferencias entre las bielas de distintas cadenas cinemáticas. Habría que estudiar más a fondo este problema, haciendo variar por ejemplo las coordenadas "Y" ó "Z" de los actuadores para ver que otras soluciones aparecen, también se puede prefijar de otra forma diferente las tres posiciones de la plataforma móvil, ya que lo importante es la posición relativa entre las tres posiciones prefijadas.

131

Page 152: Tesis

Síntesis de un Manipulador 6-RKS

V.5 - CONCLUSIONES El Manipulador Paralelo 6-RKS puede alcanzar 64 configuraciones de

insensitividad de posición (CIP) y, dadas las ventajas de estas configuraciones expuestas en el Capítulo IV, resulta interesante poder sintetizar este tipo de mecanismos de forma que la posición de la plataforma móvil, en varias de estas configuraciones, coincida con unas posiciones deseadas.

En este capítulo, se ha puesto de manifiesto que conseguir que las 64

CIP posibles coincidan con posiciones predeterminadas es muy difícil por la gran cantidad de variables que habría que introducir en cada cadena cinemática (actuador-manivela-biela) de unión de la plataforma fija con la móvil.

También se ha visto que para conseguir dos posiciones de la

plataforma móvil estando el manipulador en CIP es necesario que puedan variar las longitudes de las manivelas y de las bielas. Si se desea conseguir tres posiciones predeterminadas en CIP habrá que añadir otra variable más por cada cadena, por ejemplo, las coordenadas "X" de los actuadores, y así sucesivamente. Cuantas más posiciones predeterminadas se desee lograr, estando el manipulador en CIP, más variables se deberán introducir en el proceso de síntesis.

Se ha propuesto un método numérico para la obtención de los valores

de las variables de diseño de forma que las posiciones deseadas se consigan en CIP, poniendo de manifiesto que hay muchas combinaciones de valores de las variables que lo cumplen. A estos diferentes valores se llega dependiendo de los valores iniciales de cada proceso iterativo utilizando el método de Newton-Raphson. Por ello, se toman como valores iniciales de iteración todas las posibles combinaciones de valores de las 64 CIP alcanzadas por el manipulador paralelo del ejemplo del Capítulo IV.

Si las posiciones predeterminadas son en número superior a tres, el

número de combinaciones de valores iniciales, correspondientes a las CIP del manipulador del ejemplo del Capítulo IV, es tan grande que en este caso es interesante tomar de forma aleatoria valores entre todas las combinaciones posibles y aplicar el proceso iterativo hasta que se consigan unos valores de las variables de diseño que resulten aceptables.

En el ejemplo numérico, para conseguir que dos posiciones prefijadas

de la plataforma móvil se consigan estando el manipulador en CIP, se han conseguido 68 combinaciones diferentes de longitudes de manivelas y bielas.

132

Page 153: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Para tres posiciones de la plataforma móvil estando el manipulador en CIP, se han obtenido 1.701 soluciones diferentes de longitudes de manivelas y bielas y coordenadas "X" de los actuadores. En estas soluciones, la posición de los actuadores es tal que se pueden producir interferencias entre las bielas de distintas cadenas cinemáticas, por lo que se deberá estudiar más a fondo esta síntesis.

133

Page 154: Tesis

Síntesis de un Manipulador 6-RKS

134

Page 155: Tesis

CAPÍTULO VI

COMPROBACIÓN DEL GIRO DE MANIVELAS

Page 156: Tesis

Comprobación del giro de manivelas

136

Page 157: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

CAPÍTULO VI - COMPROBACIÓN DEL GIRO

DE MANIVELAS

VI.1 - INTRODUCCIÓN

En los capítulos anteriores, se ha visto que el manipulador paralelo

6-RKS de Hunt tiene 64 configuraciones de insensitividad de posición (CIP) de la plataforma móvil, las ventajas de estas configuraciones, y que se puede diseñar un manipulador de forma que se consiga que varias posiciones predeterminadas de la plataforma móvil se consigan estando el manipulador en CIP. Esto se logra a base de construir el manipulador con unas determinadas longitudes para las manivelas y bielas y unas coordenadas "X" e "Y" para los actuadores sobre la plataforma fija.

En este capítulo, se estudiará un proceso, siguiendo unas reglas que

tienen cierta similitud con las leyes Grashof, para comprobar si las seis manivelas de un manipulador, con unas determinadas dimensiones, son capaces de dar vueltas completas y, por lo tanto, la plataforma móvil es capaz de alcanzar todas las configuraciones de insensitividad de posición posibles.

VI.2 - SITUACIÓN ACTUAL En el mecanismo plano formado por el cuadrilátero articulado, la ley

de Grashof [GRA. 1883] indica que para que uno de los eslabones sea capaz de dar vueltas completas y, por lo tanto, pueda ser un mecanismo de manivela oscilador, alcanzando dos posiciones de insensitividad del eslabón oscilador, se debe cumplir que la suma de las longitudes del eslabón más largo y del más corto debe ser menor que la suma de las longitudes de los eslabones de longitud intermedia.

De forma similar, la movilidad del cuadrilátero articulado espacial, ha

sido estudiada, entre otros, por Hunt [HUN. 59], Harrisberger [HAR. 64], Skreiner [SKR. 67], Freudenstein y Kiss [FRE. 69], Sticher [STI. 70], Bottema [BOT. 71], Gupta y Radcliffe [GUP. 71], Freudenstein y Primrose [FRE. 76], Söylemez y Freudenstein [SOY. 82], Gupta y Kazerounian [GUP. 83], Sandor y Zhuang [SAN. 84], Alizade y Sandor [ALI. 85] y Williams y Reinholtz [WIL. 87]. Y en otros tipos de mecanismos por Rastegar y Deravi [RAS. 87-1] y [RAS. 87-2] y Rastegar [RAS. 88], [RAS. 89] y [RAS. 92]. En estos estudios,

137

Page 158: Tesis

Comprobación del giro de manivelas

se llega a la conclusión que no se puede definir una ley tan sencilla como la de Grashof y que se debe seguir un determinado proceso para determinar si el eslabón de entrada será capaz de dar vueltas completas.

VI.3 - PROCESO A SEGUIR Para comprobar si se pueden obtener las 64 CIP, de forma similar al

cuadrilátero articulado espacial, se establecerá un proceso que se debe seguir para determinar si es posible o no alcanzar todas las configuraciones de insensitividad.

VI.3.1 - Dimensiones previas En este capítulo, con el fin de simplificar los cálculos y sin perder

generalidad en el proceso, se considerará que los ejes de los actuadores del manipulador, al igual que el considerado en el Capítulo V, forman un triángulo equilátero.

Fig. VI-1 Longitudes de manivelas para evitar interferencias

138

Page 159: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Por conveniencia constructiva, para que no interfieran las distintas manivelas, se tomarán éstas con unas longitudes de forma que no lleguen a las bisectrices de los ángulos del triángulo que forman los ejes de los actuadores sobre la plataforma fija (Fig. VI-1).

Teniendo en cuenta las consideraciones anteriores, resulta que las

longitudes de las manivelas deberán ser:

R1 < 63 (L-2E1) (VI-1)

R2 < 63 (L-2E2) (VI-2)

R3 < 63 (L-2E3) (VI-3)

R4 < 63 (L-2E4) (VI-4)

R5 < 63 (L-2E5) (VI-5)

R6 < 63 (L-2E6) (VI-6)

Por ejemplo, suponiendo que la longitud del lado del triángulo

formado por los ejes de los actuadores "L" sea 1 metro y el descentramiento del actuador respecto del eje de simetría "E" sea 0.05 metros, resulta que la longitud de las manivelas debe ser menor de 0.2598 metros.

R

Para que la plataforma móvil esté siempre por encima de la plataforma

fija, aunque las manivelas den vueltas completas, se debe cumplir que la longitud de la manivela sea siempre inferior al de la biela correspondiente:

R1 < L1 (VI-7)

R2 < L2 (VI-8)

R3 < L3 (VI-9)

4 < L4 (VI-10)

R5 < L5 (VI-11)

R6 < L6 (VI-12)

139

Page 160: Tesis

Comprobación del giro de manivelas

VI.3.2 - Comprobación de la longitud de las bielas Según se ve en la figura VI-2, las bielas "2" y "3" se unen a la

plataforma móvil en el punto "123", las bielas "4" y "5" en el punto "145" y las bielas "6" y "1" en el punto "161". Para que las dos bielas correspondientes a un vértice de la plataforma móvil se puedan unir a ese punto, y además las manivelas correspondientes a esas bielas puedan dar vueltas completas se deberán cumplir ciertas condiciones.

Analizando la figura VI-2 se observa que, por ejemplo, para que las

bielas "2" y "3" lleguen a poder conectarse al punto "123" de la plataforma móvil es necesario que las bielas, conectadas entre ellas, sean capaces de unir los puntos "12" y "13". De forma similar, las bielas "4" y "5" deberán ser capaces de unir los puntos "14" y "15" y las bielas "1" y "6" deberán poder unir los puntos "11" y "16".

Fig. VI-2 Uniones de bielas y manivelas

140

Page 161: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

VI.3.2.1 - Comprobación de la longitud de las bielas "2" y "3" Centrándose en las bielas "2" y "3" (Fig. VI-3), para que puedan

conectar los puntos "12" y "13" se debe cumplir que: - La suma de las longitudes de las dos bielas sea mayor que la mínima

distancia entre estos dos puntos. - El módulo de la diferencia de las longitudes de las dos bielas sea menor que

la distancia máxima entre estos dos puntos. Para ver que son necesarias estas dos condiciones basta con considerar

que los puntos "12", "13" y "123" forman un triángulo y por lo tanto se debe de cumplir que la suma de las longitudes de dos lados sea mayor que la longitud del otro lado.

Fig. VI-3 Conjunto de manivelas y bielas "2" y "3"

Fig. VI-4 Sentido del ángulo de las manivelas

141

Page 162: Tesis

Comprobación del giro de manivelas

Para determinar las distancias máxima y mínima entre los puntos "12" y "13", teniendo en cuenta que los ejes de los actuadores forman un triángulo equilátero, tomando el origen de los ángulos de las manivelas en el interior del triángulo formado por los ejes de los actuadores y sentido según se indica en la figura VI-4, siendo el origen de coordenadas el baricentro del triángulo formado por los ejes de los actuadores, con los ejes "X" e "Y" contenidos en el plano de los ejes de los actuadores, con el eje "Y" paralelo a los ejes de los actuadores "1" y "2" y el eje "Z" hacia arriba, se plantean las coordenadas de estos puntos, que serán:

Z θ

X12 = X02 + R2 cos θ2 (VI-13) Y12 = Y02 (VI-14)

12 = Z02 + R2 sin 2 (VI-15)

X13 = X03 – 1/2 R3 cos θ3 (VI-16) Y13 = Y03 – 3 /2 R3 cos θ3 (VI-17) Z θ

13 = Z03 + R3 sin 3 (VI-18) Las coordenadas de los puntos "12" y "13" irán variando al girar las

manivelas "2" y "3" y el cuadrado de la distancia entre ellos será:

(X03 – 1/2 R3 cos θ3 - X02 - R2 cos θ2)2 + (Y03 – 3 /2 R3 cos θ3 - Y02)2 +

+ (Z03 + R3 sin θ3 - Z02 - R2 sin θ2)2 = D2 (VI-19)

La distancia será máxima si es máximo su cuadrado y lo mismo ocurrirá con la distancia mínima. Para hallar las distancias máxima y mínima al variar los ángulos "θ2" y "θ3", se deriva la distancia al cuadrado respecto de estos ángulos y se iguala a cero.

Derivando la ecuación (VI-19) respecto de "θ2" e igualando a cero

δθ

δ

2

2D = 2 (X03 – 1/2 R3 cos θ3 - X02 - R2 cos θ2) R2 sin θ2 –

- 2 (Z03 + R3 sin θ3 - Z02 - R2 sin θ2) R2 cos θ2 = 0 (VI-20)

Simplificando

(X03 – 1/2 R3 cos θ3 - X02 - R2 cos θ2) sin θ2 – - (Z03 + R3 sin θ3 - Z02 - R2 sin θ2) cos θ2 = 0 (VI-21)

142

Page 163: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Dividiendo por "cos θ2" resulta que, para que la derivada sea cero y por lo tanto la distancia sea máxima o mínima, "θ2" debe ser tal que:

tg θ2 =θ−−θ−

θ−−θ+

22023303

22023303

cosRXcosR2/1XsinRZsinRZ =

XXZZ

1213

1213

−−

(VI-22)

Esta ecuación representa, ver figura VI-5, que para un determinado ángulo "θ3" y, por lo tanto, una determinada posición del punto del "13", para que la distancia entre los puntos "12" y "13" sea máxima o mínima, la manivela "2" deberá estar contenida en el plano formado por el eje del actuador "2" y el punto "13". Dicho de otra forma, el eje del actuador "2", el punto "12" y el punto "13" deberán estar contenidos en un mismo plano.

Fig. VI-5 Distancias mínima y máxima entre los puntos "12" y "13" para un determinado punto "13"

143

Page 164: Tesis

Comprobación del giro de manivelas

Derivando la ecuación (VI-19) respecto de "θ3" e igualando a cero

δθ

δ

3

2D = 2 (X03 – 1/2 R3 cos θ3 - X02 - R2 cos θ2) 1/2 R3 sin θ3 +

+ 2 (Y03 – 3 /2 R3 cos θ3 - Y02) 3 /2 R3 sin θ3 +

+ 2 (Z03 + R3 sin θ3 - Z02 - R2 sin θ2) R3 cos θ3 = 0 (VI-23) Simplificando

(1/2 (X03 – 1/2 R3 cos θ3 - X02 - R2 cos θ2) + + 3 /2 (Y03 – 3 /2 R3 cos θ3 - Y02)) sin θ3 + + (Z03 + R3 sin θ3 - Z02 - R2 sin θ2) cos θ3 = 0 (VI-24)

Poniendo esta ecuación en función de las coordenadas de los puntos

"12" y "13", ecuaciones (VI-13) a (VI-18), resulta:

(1/2 (X13 – X12) + 3 /2 (Y13 Y12)) sin θ3 + (Z13 – Z12) cos θ3 = 0 (VI-25)

Dividiendo por "cos θ3"resulta que, para que la derivada sea cero y por lo tanto la distancia sea máxima o mínima, "θ3" debe ser tal que:

tg θ3 = )YY(2/3)XX(2/1

ZZ12131213

1312

−+−−

(VI-26)

De forma análoga al caso anterior, de esta expresión se deduce que para un determinado ángulo "θ2" y, por lo tanto, un determinado punto "12", la manivela "3" debe estar contenida en un plano formado por el eje del actuador "3" y el punto "12". Dicho de otra forma, el eje del actuador "3", el punto "12" y el punto "13" deberán estar contenidos en el mismo plano (Fig. VI-6).

144

Page 165: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Fig. VI-6 Distancias mínima y máxima entre los puntos "12" y "13" para un

determinado punto "12"

- - -

En un manipulador paralelo, con una geometría como la que se está considerando, donde "Z03" = "Z02", para que se cumplan las ecuaciones (VI-22) y (VI-26), se deberá dar, por la primera, que el eje del actuador "2", el punto "12" y el punto "13" estén en un plano y, por la segunda, que el eje del actuador "3" y los puntos "12" y "13" estén en otro plano.

Para que ambas condiciones se cumplan a la vez, los ejes de los actuadores "2" y "3" y los puntos "12" y "13" deberán estar contenidos todos en un mismo plano, que será el plano de los ejes de los actuadores. Si sucede esto, los ángulos de las manivelas "θ2" y "θ3" serán iguales a 0º ó a 180º.

Con los ángulos de las manivelas "θ2" y "θ3" y los valores de 0º y 180º se tendrá cuatro combinaciones donde las distancias serán máximas o mínimas (Fig. VI-7), estas serán:

Una distancia máxima entre "12" y "13" (Dmax) cuando θ2 = θ3 = 180º. Una distancia mínima entre "12" y "13" (Dmin) cuando θ2 = θ3 = 0º. Una distancia máxima o mínima relativa entre "12" y "13" (Dm1) cuando θ2 =0º y θ3 = 180º.

- Una distancia máxima o mínima relativa entre "12" y "13" (Dm2) cuando θ2 =180º y θ3 = 0º.

145

Page 166: Tesis

Comprobación del giro de manivelas

- Fig. 43 Distancias máxima, mínima y distancias extremas intermedias.

En la figura VI-8 se representan las curvas de equidistancia y las posiciones donde las distancias entre los puntos "12" y "13" son máxima, mínima o extremas intermedias, en función de los ángulos de las manivelas "θ y "θ .

2"3"

Fig. VI-8 Distancias máxima, mínima y extremas intermedias en función de los

ángulos de las manivelas "2" y "3"

146

Page 167: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Con la geometría propuesta para este manipulador, expuesta al inicio del apartado VI.3.1, las cuatro distancias definidas entre los puntos "12" y "13" pueden expresarse:

Dmax = )R2/3YY()R2/1RXX( 302032

3202032 +−+++− (VI-27)

Dmin = )R2/3YY()R2/1RXX( 302032

3202032 +−+−−− (VI-28)

Dm1 = )R2/3YY()R2/1RXX( 302032

3202032 +−++−− (VI-29)

Dm2 = )R2/3YY()R2/1RXX( 302032

3202032 −−+−+− (VI-30)

-

Una vez determinadas las distancias máxima, mínima y máximas o

mínimas intermedias podrán tener lugar, entre otras, las siguientes posibilidades:

Si L2 + L3 > Dmín y LL 32 − < Dmax, las bielas "2" y "3" se podrán ensamblar.

- Si L 2 y 2 + L3 > Dm LL 32 − < Dm1, la manivela "2" podrá dar vueltas completas, si la manivela "3" está en una posición conveniente.

- Si L2 + L3 > Dm1 y LL 32 − < Dm2, la manivela "3" podrá dar vueltas completas, si la manivela "2" está en una posición conveniente.

- Si L2 + L3 > Dmax y LL 32 − < Dmin, las manivelas "2" y "3" podrán dar vueltas completas.

De estas cuatro condiciones, como en este capítulo se está estudiando

un método para comprobar que todas las manivelas puedan dar vueltas completas, las realmente importantes serán:

- La primera, que garantiza que las dos bielas correspondientes a un vértice

de la plataforma móvil se podrán ensamblar entre ellas en dicho vértice. - La cuarta, que garantiza que cada manivela pueda dar vueltas completas

independientemente de la posición de las otras.

147

Page 168: Tesis

Comprobación del giro de manivelas

VI.3.2.2 - Comprobación de la longitud de las bielas "4" y "5"

En este subapartado, se comprobará las dimensiones que deben tener las bielas "4" y "5" para que se puedan conectar entre ellas y permitan que las manivelas correspondientes puedan girar completamente.

Fig. VI-9 Distancias máxima y mínima entre los puntos “14“ y “15“

Siguiendo para las bielas y manivelas "4" y "5", (Fig. VI-9), un razonamiento similar al establecido en el apartado anterior, se llegara a la conclusión de que: - Para que las bielas "4" y "5" se puedan ensamblar entre ellas, se deberá

cumplir que: - L4 + L5 > Dmin entre los puntos "14" y "15". - LL 54 − < Dmax entre los puntos "14" y "15".

- Para que las manivelas "4" y "5" puedan girar vueltas completas, se deberá cumplir que: - L4 + L5 > Dmax entre los puntos "14" y "15". - LL 54 − < Dmin entre los puntos "14" y "15".

siendo:

Dmax = )R2/3R2/3YY()R2/1R2/1XX( 450405

2450405

2−−−+−+− (VI-31)

Dmin = )R2/3R2/3YY()R2/1R2/1XX( 450405

2450405

2++−++−− (VI-32)

148

Page 169: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

VI.3.2.3 - Comprobación de la longitud de las bielas "6" y "1"

En este subapartado, se comprobará las dimensiones que deben tener las bielas "6" y "1" para que se puedan conectar entre ellas y permitan que las manivelas correspondientes puedan girar completamente.

Fig. VI-10 Distancias máxima y mínima entre los puntos "11" y "16"

Siguiendo el mismo razonamiento de los apartados anteriores, para las manivelas "1" y "6" (Fig. VI-10), se tendrá:

- Para que las bielas "6" y "1" se puedan ensamblar entre ellas, se deberá

cumplir que: - L1 + L6 > Dmin entre los puntos "11" y "16". - LL 61 − < Dmax entre los puntos "11" y "16".

- Para que las manivelas "6" y "1" puedan girar vueltas completas, se deberá cumplir que: - L1 + L6 > Dmax entre los puntos "11" y "16". - LL 61 − < Dmin entre los puntos "11" y "16".

siendo:

Dmax = )R2/3YY()R2/1RXX( 601062

6101062 −−+++− (VI-33)

Dmin = )R2/3YY()R2/1RXX( 601062

6101062 +−+−−− (VI-34)

149

Page 170: Tesis

Comprobación del giro de manivelas

VI.3.2.4 - Conclusiones sobre las longitudes de las bielas Al calcular las distancias máximas y mínimas entre los extremos de

manivelas cuyas bielas correspondientes van unidas a un vértice de la plataforma móvil, se observa que estas distancias se producen en puntos de "insensitividad de distancia" respecto de los ángulos de las manivelas, ya que sus derivadas respecto de dichos ángulos deben ser cero en los máximos y mínimos.

Como resumen de este apartado se puede afirmar que:

- Para que dos bielas contiguas se puedan ensamblar en un vértice de la plataforma móvil, se debe cumplir que: - La suma de las longitudes de esas bielas sea mayor que la distancia

mínima entre los puntos extremos de las manivelas a las que van acopladas.

- El módulo de la diferencia de las longitudes de las bielas sea menor

que la distancia máxima entre los extremos de las manivelas.

- Para que dos bielas contiguas se ensamblen en un vértice de la plataforma

móvil y permitan, en cualquier posición, que sus dos manivelas correspondientes den vueltas completas se debe cumplir que:

- La suma de las longitudes de las dos bielas sea mayor que la distancia

máxima entre los puntos extremos de las manivelas.

- El módulo de la diferencia de longitudes de las bielas sea menor que la distancia mínima entre los extremos de las manivelas correspondientes.

Por ejemplo, para un manipulador en que el lado del triángulo

equilátero formado por los ejes de los actuadores sea de 1 metro y el descentramiento de los actuadores de 0.05 metros, para unas longitudes de manivelas iguales a 0.1 metros, las bielas, si son iguales, deberán tener unas longitudes mayores de 0.3116 metros.

150

Page 171: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

VI.3.3 - Dimensiones de las aristas de la plataforma móvil

En los apartados anteriores se ha estudiado la influencia de las longitudes de las bielas para permitir su ensamble y que sus manivelas correspondientes puedan dar vueltas completas. En este apartado se tratará la influencia de las dimensiones de la plataforma móvil, (Fig. VI-11), comprobando si:

- La arista "A12" de la plataforma móvil es capaz de ensamblar los puntos "123" y "161".

- La arista "A34" es capaz de ensamblar los puntos "123" y "145".

- La arista "A56" es capaz de unir los puntos "145" y "161". Permitiendo en todo momento que todas las manivelas puedan girar

vueltas completas.

Fig. VI-11 Nomenclatura del Manipulador Paralelo 6-RKS de Hunt

151

Page 172: Tesis

Comprobación del giro de manivelas

VI.3.3.1 - Comprobación de la longitud de la arista "A12"

-

-

-

-

-

-

En este subapartado se tratará de determinar las dimensiones de la arista "A12" de la plataforma móvil para que sea capaz de ensamblar los puntos "123" y "161", permitiendo el giro completo de las manivelas "1", "2", "3" y "6".

Para unas posiciones determinadas de los puntos "12" y "13", el punto

"123" se hallará sobre una circunferencia cuyo eje de revolución será la recta que pasa por los puntos "12" y "13".

De forma similar, para unas posiciones determinadas de los puntos

"11" y "16", el punto "161" se hallará sobre una circunferencia cuyo eje de revolución será la recta que pasa por los puntos "11" y "16".

Para que la arista "A12" de la plataforma móvil sea capaz de ensamblar los puntos "123" y "161", para una posición determinada de las manivelas "1", "2", "3" y "6", sin tener en cuenta si las manivelas pueden girar, se deberá cumplir que la longitud de la arista sea:

Mayor que la distancia mínima entre los puntos a unir, (A12 > D123-161 min). - Menor que la distancia máxima entre los puntos a unir, (A12 < D123-161 max).

Al ir girando las 4 manivelas, los puntos "11", "12", "13" y "16" van

variando de posición. Por lo tanto, irán variando las distancias máxima y mínima entre los puntos "123" y "161" y apareciendo más posibilidades que se analizan a continuación:

Para que la arista "A12" sea capaz de ensamblar los puntos "123" y "161", aunque las manivelas no giren 360º, se deberá cumplir que la longitud de la arista sea:

Mayor que el mínimo de la distancia mínima entre los puntos "123" y "161", (A12 > (D123-161 min) min). Menor que el máximo de la distancia máxima entre dichos puntos, ( A12 < (D123-161 max) max).

Para que las cuatro manivelas sean capaces de girar vueltas completas y en todo momento la arista "A12" llegue a ensamblar los puntos "123" y "161" se deberá cumplir que la longitud de la arista sea:

Mayor que el máximo de las distancias mínimas entre los puntos "123" y "161", (A12 > (D123-161 min) max).

- Menor que el mínimo de las distancias máximas entre dichos puntos, (A12 < (D123-161 max) min).

152

Page 173: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

VI.3.3.2 - Distancias de los puntos "123" y "161" analíticamente En el proceso de determinación de las distancias máxima y mínima

entre los puntos "123" y "161", con unas posiciones determinadas de los puntos "11", "12", "13" y "16", para el punto "123" se pueden plantear las ecuaciones de restricción siguientes:

(X123 - X12)2 + (Y123 - Y12)2 + (Z123 - Z12)2 - = 0 (VI-35) L22

(X123 - X13)2 + (Y123 - Y13)2 + (Z123 - Z13)2 - = 0 (VI-36) L23

Éstas son las ecuaciones de dos superficies esféricas, con centros en

los puntos "12" y "13", cuya intersección será una circunferencia, contenida en un plano perpendicular a la recta que pasa por dichos puntos, sobre la que se encontrará el punto "123".

Despejando "X123" en la ecuación (VI-35) se tiene

X123 = X12 ± ZYZYZZ2YY2L 2123

2123

212

2121212312123

22 −−−−++ (VI-37)

Sustituyendo este valor en la ecuación (VI-36) y despejando "Y123" se obtiene

Y123 = ±−+−

−+−

))XX()YY((2)XX(Y2a)YY(

13122

13122

13122

121213

))XX()YY((2

)b4a)()YY()XX(())XX(Y2a)YY((

13122

13122

21312

21312

21312

2121312

2

−+−

+−+−−−−− (VI-38)

siendo:

a = (VI-39) XX2ZZ2ZZ2LZYXZYXL 12131312312123

23

213

213

213

212

212

212

22 −−+−+++−−+

b = (VI-40) )ZZ2LZZY·()XX( 12123

22123

212

2121312

2−−++−

153

Page 174: Tesis

Comprobación del giro de manivelas

Comenzando ahora por despejar "Y123" de la ecuación (VI-35) se tiene

Y123 = Y12 ± ZXZXZZ2XX2L 2123

2123

212

2121212312123

22 −−−−++ (VI-41)

Sustituyendo este valor en la ecuación (VI-36) y despejando después "X123" se obtiene

X123 = ±−+−

−+−

))XX()YY((2)YY(X2c)XX(

13122

13122

13122

121213

))XX()YY((2

)d4c)()XX()YY(())YY(X2c)XX((

13122

13122

21312

21312

21312

2121312

2

−+−

+−+−−−−− (VI-42)

siendo:

c = (VI-43) YY2ZZ2ZZ2LZYXZXYL 12131312312123

23

213

213

213

212

212

212

22 −−+−+++−−+

d = ( (VI-44) )ZZ2LZZX()YY 12123

22

2123

212

2121312

2 −−++−

Con las ecuaciones (VI-38) y (VI-42) se obtiene las coordenadas "X"

e "Y" del punto "123" en función de las coordenadas de los puntos "12" y "13", de las longitudes de las bielas "2" y "3" y de la coordenada "Z" del punto "123".

Siguiendo el mismo proceso que para el punto "123", para determinar

la posición del punto "161" se pueden plantear las siguientes condiciones de restricción:

(X161 - X11)2 + (Y161 - Y11)2 + (Z161 - Z11)2 - = 0 (VI-45) L21

(X161 - X16)2 + (Y161 - Y16)2 + (Z161 - Z16)2 - = 0 (VI-46) L26

Que son las ecuaciones de dos superficies esféricas con centros en los

puntos "11" y "16" cuya intersección será la circunferencia donde se deberá encontrar el punto "161".

154

Page 175: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Operando de forma similar a lo realizado anteriormente, para el punto "161" se obtendrá:

Y161 = ±−+−

−+−

))XX()YY((2)XX(Y2e)YY(

16112

16112

16112

111116

))XX()YY((2

)f4e)()YY()XX(())XX(Y2e)YY((

16112

16112

21611

21611

21611

2111611

2

−+−

+−+−−−−− (VI-47)

siendo:

e = (VI-48) XX2ZZ2ZZ2LZYXZYXL 11161616111161

26

216

216

216

211

211

211

21 −−+−+++−−+

f = (VI-49) )ZZ2LZZY()XX( 11161

21

2161

211

2111611

2 −−++−

De forma similar, para "X161" se obtendrá

X161 = ±−+−

−+−

))XX()YY((2)YY(X2g)XX(

16112

16112

16112

111116

))XX()YY((2

)h4g)()XX()YY(())YY(X2g)XX((

16112

16112

21611

21611

21611

2111611

2

−+−

+−+−−−−− (VI-50)

siendo:

g = (VI-51) YY2ZZ2ZZ2LZYXZXYL 111611616111161

26

216

216

216

211

211

211

21 −−+−+++−−+

h = ( (VI-52) )ZZ2LZZX()YY 11161

21

2161

211

2111611

2 −−++−

Con las ecuaciones (VI-47) y (VI-50) se obtienen las coordenadas "X" e "Y" del punto "161" en función de las coordenadas de los puntos "11" y "16", de las longitudes de las bielas "1" y "6" y de la coordenada "Z" del punto "161".

Una vez determinadas las coordenadas de los puntos "123" y "161",

ecuaciones (VI-38), (VI-42), (VI-47) y (VI-50), la distancia entre dichos puntos al cuadrado será:

(D123-161)2 = (X123 – X161)2 + (Y123 – Y161)2 + (Z123 – Z161)2 (VI-53)

155

Page 176: Tesis

Comprobación del giro de manivelas

En este punto, se debería:

-

-

- Sustituir "X123", "X161", "Y123" e "Y161" por las expresiones deducidas anteriormente, teniendo en cuenta que cada coordenada puede tener dos valores.

- Comprobar para los puntos "123" y "161", cual de los dos valores de la coordenada "Y" se corresponde con cada uno de los valores de la coordenada "X". Obtener cuatro ecuaciones diferentes para las distancias una vez sustituidas las expresiones correspondientes.

- Derivar las 4 ecuaciones de la distancia respecto de "Z123" y de "Z161", igualar a cero ambas derivadas parciales de cada ecuación y determinar para que coordenadas "Z123" y "Z161" la distancia entre los puntos "123" y "161" es máxima y mínima.

- Una vez determinadas las coordenadas "Z" de los dos puntos, calcular sus correspondientes coordenadas "X" e "Y". Finalmente, determinar las distancias máximas y mínimas, absolutas y relativas, entre los puntos "123" y "161".

Teniendo en cuenta que el proceso expuesto en el párrafo anterior se

realizaría para unas posiciones fijas de los puntos "11", "12", "13" y "16", ahora, habría que derivar las expresiones de las distancias extremas respecto de los ángulos de las cuatro manivelas para hallar los máximos y mínimos de las distancias extremas al ir girando las manivelas, lo que resultaría a todas luces poco operativo.

El proceso expuesto en los párrafos anteriores se ha intentado

implementar por medio de programas como Matlab y Mathematica, resultando que estos programas son incapaces de resolver el problema.

Por todo ello, y como conclusión de este subapartado, se puede llegar

a afirmar que el tratamiento analítico de las distancias máximas y mínimas entre los dos puntos de unión de cuatro bielas correspondientes a dos vértices de la plataforma móvil, resulta extremadamente complicado. Esto es debido a que el lugar geométrico donde se puede encontrar cada uno de los dos puntos, cuyas distancias máximas y mínimas se pretende determinar, es la intersección de dos superficies toroidales. En la superficie de cada toro, para unas determinadas coordenadas "X" e "Y", la coordenada "Z" puede tomar cuatro valores diferentes, resultando que el número de combinaciones de posibles soluciones es muy grande, perdiéndose el concepto físico de las mismas.

156

Page 177: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

IV-3-3-3. - Distancias de los puntos "123" y "161" por el método numérico de Newton-Raphson.

En el subapartado anterior se ha concluido que, para determinar las distancias máximas y mínimas absolutas y relativas entre los puntos "123" y "161", el método analítico resulta extremadamente engorroso. Por ello, a continuación se expondrá un proceso numérico con apoyo gráfico, basado en el método de Newton-Raphson, que facilitará su estudio.

Fig. VI-12 Distancias máximas y mínimas absolutas y relativas.

157

Page 178: Tesis

Comprobación del giro de manivelas

Para simplificar la nomenclatura (Fig. VI-12) las distancias extremas entre los puntos "123" y "161" se denominarán de la forma siguiente: - Distancia máxima absoluta (Dmáx). - Distancia mínima absoluta (Dmín). - Distancia máxima o mínima intermedia "1", (Dm1). - Distancia máxima o mínima intermedia "2", (Dm2).

Teóricamente pueden existir más distancias extremas intermedias, por

ejemplo, cuando las bielas "2" y "3" están cruzadas con las bielas "1" y "6" o cuando las bielas "2" y "3" están sobre la plataforma fija y las bielas "1" y "6" por debajo. Como estas posibilidades no tienen utilidad en un manipulador real, no se considerarán.

En el subapartado (VI.3.2.1), cuando se estudiaron analíticamente las

distancias (Dmáx), (Dmín), (Dm1) y (Dm2) entre los puntos "12" y "13", se llegó a la conclusión de que, para un determinado punto "12", la distancias extremas se producían cuando el punto "13" estaba en una posición tal que el eje del actuador "3", el punto "13" y el punto "12" estaban en el mismo plano; y para un determinado punto "13", la distancias extremas se producían cuando el punto "12" estaba en una posición tal que el eje del actuador "2", el punto "12" y el punto "13" estaban en un mismo plano.

Fig. VI-13 Posición de los puntos "123" y "161" con distancias máximas y

mínimas entre ellos

158

Page 179: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Por analogía con este caso, ahora se afirma que, para unos determinados puntos "12", "13" y "161", la distancia entre los puntos "123" y "161" será máxima o mínima cuando el punto "123" sea tal que los puntos "12", "13", "123" y "161" estén contenidos en el mismo plano (Fig. VI-13).

Para demostrar la afirmación del párrafo anterior se tiene que, para

unos determinados puntos "12", "13" y "161", el punto "123" puede describir una circunferencia contenida en un plano perpendicular a la recta que une los puntos "12" y 13". Si se hace girar a este plano alrededor de su eje arrastrando al punto "123" a lo largo de la circunferencia y se va proyectando continuamente el punto "161" sobre el plano giratorio se tendrá que las proyecciones del punto forman otra circunferencia concéntrica con la anterior. En la figura (VI-14), se puede observar que las distancias extremas se darán cuando la proyección del punto "161" y el punto "123" estén sobre el mismo diámetro de las circunferencias. Como la recta proyectante del punto 161 y el eje de giro que une los puntos "12" y "13" son paralelos queda demostrado geométricamente que los puntos "12", "13", "123" y "161" se encuentran en el mismo plano cuando la distancia entre un determinado punto "161" y el punto "123" es máxima o mínima.

Fig. VI-14 Distancias máxima y mínima entre los vértices "123" y "161" para

unos puntos "12", "13" y "161" dados

159

Page 180: Tesis

Comprobación del giro de manivelas

Haciendo el mismo razonamiento para unos determinados puntos "11", "16" y "123", la distancia entre los vértices "123" y "161" será máxima o mínima cuando los puntos "11", "16", "161" y "123" se encuentren en el mismo plano.

Juntando las dos condiciones anteriores se tendrá que, la distancia

entre los puntos "123" y "161" será máxima o mínima cuando por un lado los puntos "12", "13", "123" y "161" estén en un plano, y por otro lado los puntos "11", "16", "123" y "161" estén contenidos en otro plano. Es decir, los puntos "123" y "161" estarán contenidos en la recta intersección de dos planos: uno que contiene a los puntos "12" y "13" y otro que contiene a los puntos "11" y "16" (Fig. VI-15).

Fig.VI-15 Intersección del plano formado por los puntos "12", "13" y "123" y el

formado por los puntos "11", "16" y "161" Al combinar las distancias máximas y mínimas de las dos condiciones

anteriores aparecerán las distancias extremas siguientes: Dmáx, Dmín, Dm1, Dm2 y, si las bielas correspondientes a los actuadores "2" y "3" se cruzan con las bielas correspondientes a los actuadores "1" y "3" se tendrá una distancia extrema de bielas cruzadas (Dmc), que no tiene utilidad en el manipulador.

En este punto se puede observar que la distancia entre los puntos

"123" y "161" presenta una insensitividad con respecto a pequeños giros de los puntos "123" y "161" alrededor de los ejes que pasan por los puntos "12" y "13" y por los puntos "11" y "16" respectivamente.

160

Page 181: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Al ir girando las manivelas "1", "2", "3" y "6", las distancias máxima y mínima entre los puntos "123" y "161" irán variando y se producirá que las distancias máxima y mínima tendrán sus máximos y mínimos respectivos.

Para que las cuatro manivelas puedan dar vueltas completas, con la

arista "A12" acoplada, se deberá cumplir que: - (Dmáx)mín entre los puntos "123" y "161" > "A12". -

(Dmín)máx entre los puntos "123" y "161" < "A12".

Para determinar el mínimo de la distancia máxima y el máximo de la distancia mínima, apoyándose en un método geométrico, se inicia observando que el extremo de cada biela se puede mover en el interior de un volumen toroidal, (Fig.VI-16), cuyo eje será el eje del actuador correspondiente. La sección del toro será una circunferencia cuyo radio será la longitud de la biela y el centro de esta sección será la circunferencia descrita por el extremo de la manivela. Para un punto determinado del extremo de la manivela, el extremo de la biela estará en una superficie esférica que será tangente a la superficie toroidal. Esta tangencia se producirá cuando la biela esté contenida en un plano perpendicular a la circunferencia descrita por el extremo de la manivela, por lo tanto, cuando la biela, la manivela y el eje del actuador estén comprendidos en el mismo plano. O sea que el extremo de la biela alcanzará las posiciones extremas, estará sobre la superficie toroidal, cuando el eje del actuador, la manivela y la biela estén contenidas en el mismo plano.

Fig. VI-16 Lugar geométrico del extremo de una biela.

161

Page 182: Tesis

Comprobación del giro de manivelas

Tomando, por ejemplo el punto "123", como este punto es el extremo de las bielas "2" y "3", deberá estar en el interior de dos toros cuyos ejes serán: el eje del actuador "2" y el eje del actuador "3". Por lo tanto, el punto "123" estará en el interior de un volumen que será la intersección de estos dos toros, y para simplificar su denominación, debido a su forma, se le llamará "BANANA" (Fig. VI-17)

Fig. VI-17 Banana, lugar geométrico de un extremo de la plataforma móvil

La sección aproximadamente normal de esta "banana" será un

polígono de cuatro lados en el que los lados serán arcos de circunferencia de las superficies de los toros (Fig. VI-18).

Fig. VI-18 Polígono sección de la banana

162

Page 183: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Al ir girando las manivelas "2" y "3", si el punto "123" se encuentra en esta sección, se moverá por ella y alcanzará sus posiciones extremas sobre los arcos del polígono cuando alguna de las cadenas cinemáticas eje del actuador, manivela y biela estén en el mismo plano, es decir, se encuentre en posición de insensitividad (PI).

Las condiciones, que una cadena cinemática se encuentre en PI o que el extremo de la biela se encuentre sobre la superficie toroidal, son equivalentes.

El punto "123" se encontrará en uno de los cuatro vértices del polígono sección de la banana cuando: - El eje del actuador "2", la manivela "2" y la biela "2" estén en un plano. - El eje del actuador "3", la manivela "3" y la biela "3" estén en un plano.

Todo lo dicho para el punto "123" es aplicable para el punto "161", el cual se encontrará en el interior de la "banana" correspondiente a los actuadores "1" y "6".

El punto "161" se encontrará en uno de los cuatro vértices de su polígono respectivo cuando: - El eje del actuador "1", la manivela "1" y la biela "1" estén en un plano. - El eje del actuador "6", la manivela "6" y la biela "6" estén en un plano.

Cuando el manipulador se encuentre en alguna configuración de insensitividad de posición (CIP), los puntos "123" y "161" se encontrarán en alguno de los cuatro vértices de los polígonos respectivos, ya que todas las cadenas cinemáticas de unión de las plataformas se encontrarán en posición de insensitividad (PI).

Fig. VI-19 Zonas de distancias extremas entre los puntos "123" y "161"

163

Page 184: Tesis

Comprobación del giro de manivelas

Teniendo en cuenta la forma de los polígonos secciones de las bananas en los que se pueden encontrar los puntos "123" y "161", parece lógico suponer que los máximos y los mínimos de las distancias máxima y mínima se producirán cuando los puntos "123" y "161" se encuentren en algún vértice de su polígono correspondiente y estos polígonos se encuentren lo más alejados o lo más próximos posible (Fig. VI-19).

Las condiciones del párrafo anterior se pueden expresar como:

- Los puntos "12", "13", "123" y "161" estarán en el mismo plano.

- - Los puntos "11", "16", "123" y "161" estarán en el mismo plano.

Cada una de las cadenas cinemáticas correspondientes a los actuadores "1", "2", "3" y "6" estará contenida en un plano.

Las dos primeras condiciones imponen que las distancias entre los

puntos "123" y "161" sean extremas para unas posiciones determinadas de las manivelas, y la tercera impone que estas distancias extremas sean máximas o mínimas al variar los ángulos de las manivelas.

En este subapartado, tal como se indicó anteriormente, solo interesará

la mínima de las distancias máximas y la máxima de las distancias mínimas, para comprobar que la longitud del lado correspondiente de la plataforma móvil se encuentra entre ellas y de ese modo se pueda ensamblar permitiendo el giro de todas las manivelas.

Fig. VI-20 (Dmáx)mín y (Dmín)máx entre vértices de polígonos curvos.

164

Page 185: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

En la figura VI-20, que representa dos secciones de la figura VI-19 donde se encuentrarán las distancias máximas y mínimas. Se comprueba gráficamente que en ambos casos, las (Dmáx)mín y (Dmín)máx se producen entre vértices de los polígonos secciones de las bananas, lo que confirma la suposición inicial de que estas distancias se producirían estando las cuatro cadenas cinemáticas en posición de insensitividad.

Para determinar las posiciones de los puntos "123" y "161" para los

cuales las distancias entre ellos serán extremas, se utilizará el método iterativo de Newton-Raphson, por medio un programa realizado en MATLAB.

Suponiendo que los ejes de los actuadores forman un triángulo

equilátero, para simplificar las expresiones sin perder generalidad, las condiciones de restricción serán las siguientes:

- Para que las cadenas cinemáticas "1", "2", "3" y "6" se encuentren en

posición de insensitividad, en cada cadena, el producto mixto de los vectores en la dirección del eje del actuador, de la manivela y de la biela debe ser cero:

(X123 - X12)·(Z12 - Z02) - (X12 – X02)·(Z123 – Z12) = 0 (VI-54)

3 (Y13 – Y03)(Z123 – Z13) - 3 (Y123 – Y13)(Z13 – Z03) + (X13 – X03)(Z123 – Z13) - (X123 – X13)(Z13 – Z03) = 0 (VI-55)

3 (Y16 – Y06)(Z161 – Z16) - 3 (Y161 – Y16)(Z16 – Z06) - (X16 – X06)(Z161 – Z16) + (X161 – X16)(Z16 – Z06) = 0 (VI-56)

-

(X161 - X11)(Z11 - Z01) - (X11 – X01)(Z161 – Z11) = 0 (VI-57)

Para que el punto "161" se encuentre en el plano formado por los puntos "12", "13" y "123", el producto mixto de los vectores de dirección del punto "12" al "13", del "12" al "123" y del "12" al "161" debe ser cero.

(X13 - X12)[(Y123 - Y12)(Z161 – Z12) - (Y161 – Y12)(Z123 – Z12)]+ (Y13 - Y12)[(X161 - X12)(Z123 – Z12) - (X123 – X12)(Z161 – Z12)]+ (VI-58) (Z13 - Z12)[(X123 - X12)(Y161 – Y12) - (X161 – X12)(Y123 – Y12)] = 0

165

Page 186: Tesis

Comprobación del giro de manivelas

- Para que el punto "123" se encuentre en el plano formado por los puntos "11", "16" y "161", el producto mixto de los vectores de dirección del punto 11 al 16, del "11" al "161" y del "11" al "123" debe ser cero.

-

-

(X16 - X11)[(Y123 - Y11)(Z161 – Z11) - (Y161 – Y11)(Z123 – Z11)]+ (Y16 - Y11)[(X161 - X11)(Z123 – Z11) - (X123 – X11)(Z161 – Z11)]+ (VI-59) (Z16 - Z11)[(X123 - X11)(Y161 – Y11) - (X161 – X11)(Y123 – Y11)] = 0

Para indicar la longitud constante de las manivelas:

(X12 – X02)2 + - = 0 (VI-60) Z212 R2

2

(X13 – X03)2 + (Y13 – Y03)2 + - = 0 (VI-61) Z213 R2

3

(X16 – X06)2 + (Y16 – Y06)2 + - = 0 (VI-62) Z216 R2

6

(X11 – X01)2 + - = 0 (VI-63) Z211 R2

1

Para indicar que los extremos de las manivelas giran en unos planos perpendiculares a los ejes de los actuadores, el producto escalar de los vectores en la dirección del eje del actuador y de la manivela debe ser cero:

Y12 – Y02 = 0 (VI-64)

3 (X13 – X03) – (Y13 – Y03) = 0 (VI-65)

3 (X16 – X06) + (Y16 – Y06) = 0 (VI-66)

-

Y11 – Y01 = 0 (VI-67)

Para indicar las longitudes constantes de las bielas:

(X123 - X12)2 + (Y123 - Y12)2 + (Z123 - Z12)2 - L = 0 (VI-68) 22

(X123 - X13)2 + (Y123 - Y13)2 + (Z123 - Z13)2 - L = 0 (VI-69) 23

(X161 - X16)2 + (Y161 - Y16)2 + (Z161 - Z16)2 - L = 0 (VI-70) 26

(X161 - X11)2 + (Y161 - Y11)2 + (Z161 - Z11)2 - L = 0 (VI-71) 21

166

Page 187: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Las condiciones de restricción (VI-54) a (VI-71) forman un sistema de 18 ecuaciones, donde las longitudes de las manivelas y las bielas "2", "3", "6" y "1" y las posiciones de los puntos "02", "03", "06" y "01" serán datos, y las 18 incógnitas serán las coordenadas de los puntos "12", "13", "16", "11", "123" y "161". Este sistema se resolverá por el método iterativo de Newton-Raphson partiendo de unas coordenadas aproximadas de los puntos "12", "13", "16", "11", "123" y "161" para iniciar la primera iteración.

Por ejemplo, tomando un manipulador en el que los ejes de los actuadores formen un triángulo equilátero de 1 metro de lado, con un descentramiento de los actuadores de 0.05 metros, unas longitudes de las cuatro manivelas de 0.1 metros y unas longitudes de las cuatro bielas de 0.6 metros, resulta que la distancia mínima de las máximas es 1.22807 metros y la máxima de las mínimas es 0.2226 metros. Entre estas dos dimensiones deberá estar comprendida la longitud de la arista de la plataforma móvil para que se pueda ensamblar y permita el giro completo de las cuatro manivelas.

Al resolver el sistema de 18 ecuaciones de restricción por el método

de Newton-Raphson, la solución converge, en principio, a cualquiera de las soluciones posibles. Por ejemplo, en la zona de distancias mínimas, converge a cualquiera de las dieciséis combinaciones de distancia entre los vértices de los dos polígonos sección de las bananas, y lo mismo ocurre en la zona de distancias máximas y distancias extremas intermedias. El converger a una solución u otra dependerá de las coordenadas iniciales que se introduzcan para iniciar la primera iteración.

En el programa realizado con Matlab, para poder analizar todas las distancias, se sigue un proceso de paso de un vértice a otro del polígono sección de la banana haciendo girar las manivelas de una posición de insensitividad a otra, similar al seguido en el Capítulo IV para la determinación de las CIP.

Como conclusión de este subapartado se puede expresar que los

máximos y mínimos de las distancias extremas (Dmáx, Dmín, Dm1, Dm2 y Dmc) se producirán cuando: - Las cuatro cadenas cinemáticas actuador-manivela-biela estén en PI. - El punto "123" se encuentre el plano formado por las bielas "1" y "6". - El punto "161" se encuentre el plano formado por las bielas "2" y "3".

Las soluciones de las condiciones anteriores son numerosas, lo que

obliga a tener que analizarlas todas. En estas posiciones se produce insensitividad de los máximos y mínimos de las distancias extremas respecto de los giros de las manivelas y, de los giros de las bielas alrededor de los extremos de las manivelas.

167

Page 188: Tesis

Comprobación del giro de manivelas

IV.3.3.4 - Distancias de los puntos "123" y "161" gráficamente

En el subapartado anterior se ha expuesto que los máximos y mínimos de las distancias extremas son numerosos y que el método iterativo de Newton-Raphson puede converger a cualquiera de ellos dependiendo de las coordenadas con las que se inicie cada iteración. Por ello, en este subapartado se expondrá un método gráfico con el fin de lograr unos valores iniciales de las coordenadas próximas a la solución deseada, y así garantizar la convergencia a ella.

También se utilizará el programa CATIA para representar las bananas

y poder determinar gráficamente el mínimo de la distancia máxima y el máximo de la distancia mínima entre los puntos "123" y "161" que son los valores que realmente son interesantes.

Fig. VI-21 Determinación de las aristas de las bananas por puntos

168

Page 189: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

En la figura VI-21 se expone un método para localizar las líneas intersección de las superficies toroidales, es decir, las aristas de las bananas entre las que se producirán los máximos y mínimos de las distancias extremas.

Se trazan las secciones de los toros correspondientes a los actuadores "2" y "3" sobre el plano formado por los ejes de los actuadores. Haciendo centro en el vértice "A", punto de corte de los ejes de los actuadores cuya banana se pretende determinar, se traza el arco "JDEI". Al girar las secciones anteriores alrededor de sus respectivos ejes se generarán los toros y, debido a que están sobre las superficies exteriores de los toros y equidistantes del punto "A", los puntos "D" y "E" trazarán unas trayectorias que se cortarán en la arista superior de la banana. La proyección del punto de corte sobre el plano de los ejes de los actuadores será "F". Siguiendo el mismo procedimiento se encontrarán los puntos "K", "M" y "L" como proyecciones de las intersecciones en las aristas laterales e inferior de la banana de las trayectorias de los puntos "J", "I", "D" y "E" pertenecientes a las superficies exterior e interior de los toros. Por abatimiento de un plano perpendicular al eje del actuador "2", se determinará la cota "Z" de una de las intersecciones anteriores.

EL método expuesto en párrafo anterior resulta muy laborioso, ya que se determinan las aristas de las bananas por puntos, y son necesarios muchos puntos para poder analizar las zonas donde se producirán las distancias extremas.

Fig. VI-22 Bananas correspondientes a los puntos "123" y "161"

169

Page 190: Tesis

Comprobación del giro de manivelas

Con el fin de lograr un método gráfico más rápido para determinar las aristas de las bananas se utiliza el programa CATIA. Con este programa se dibuja los toros y se obtienen rápidamente las aristas de las bananas como intersección de las superficies de toroidales, pudiéndose determinar fácilmente las distancias entre puntos de dichas aristas.

Analizando las bananas correspondientes a los vértices "123" y "161" (Fig. VI-22) se observa que el mínimo de las distancias máximas se produce entre las intersecciones de las bananas con el plano de los ejes de los actuadores y el máximo de las distancias mínimas en la zona de corte de las bananas.

Para la geometría del manipulador que se esta considerando, con los

manipuladores formando un triángulo equilátero de un metro de lado, con un descentramiento de los puntos "01", "02", "03", "04", "05" y "06" de 0.05 metros respecto de los ejes de simetría del citado triángulo, con las seis manivelas iguales de 0.1 metros y con las seis bielas iguales de 0.6 metros, el mínimo de la distancias máximas y el máximo de las distancias mínimas son, al igual que los determinados por el método numérico, 1.22807 y 0.2226 metros. VI.3.3.5 - Distancias entre los puntos "123" y "145" y entre los puntos "145" y "161"

Para la determinación del mínimo de las distancias máximas y el máximo de las distancias mínimas entre los puntos "123" y "145" y entre los puntos 145 y 161 se seguirá el mismo proceso expuesto para los puntos "123" y "161", ya que el vértice "145" de la plataforma móvil se encontrará en el interior de otra banana similar a las correspondientes a los vértices "123" y "161". VI.3.3.6 - Conclusiones sobre la longitud de una arista

Para que una arista de la plataforma móvil sea capaz de unir los puntos extremos de las cuatro bielas correspondientes, permitiendo el giro completo de sus cuatro manivelas, sin tener en cuenta las longitudes de las otras aristas, se deberá cumplir que la longitud de arista esté comprendida entre el mínimo de las distancias máximas y el máximo de las distancias mínimas entre los puntos a unir.

El mínimo de las distancias máximas y el máximo de las distancias

mínimas se producen entre las aristas de las bananas, es decir, con las cadenas cinemáticas en PI.

170

Page 191: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

De los métodos utilizados, el más rápido para determinar los valores extremos de la longitud de una arista ha sido el gráfico por medio del programa CATIA.

En el ejemplo de manipulador que se ha expuesto, la longitud de una arista de la plataforma móvil debe estar comprendida entre 1.22807 y 0.2226 metros. VI.3.4 - Dimensiones de la plataforma móvil

En los apartados anteriores se ha analizado cuales deben ser las dimensiones máxima y mínima de una arista de la plataforma móvil por separado. Si se analiza ahora, por ejemplo, los máximos de las distancias mínimas entre las bananas "123" y la "161" y entre la "123" y la "145", resultará que los puntos sobre la banana "123" en los que se producen los dos máximos no coincidirán, y por lo tanto, si se pretende ensamblar dos aristas simultáneamente permitiendo el giro completo de todas las manivelas, al menos la dimensión de una de esas dos aristas deberá ser mayor que el máximo de los mínimos correspondiente a esa arista.

Fig. VI-23 Conjunto de las tres bananas.

171

Page 192: Tesis

Comprobación del giro de manivelas

Fig. VI-24 Esfera que corta simultáneamente a todas las aristas de las bananas.

172

Page 193: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Para garantizar que una plataforma móvil triangular será capaz de unir simultáneamente tres aristas de tres bananas (Fig. VI-23), se debería estudiar las 43 = 64 combinaciones de máximos de distancias mínimas, como esto resultaría muy engorroso, por medio del programa CATIA, se dibujará una esfera que incluya o sea tangente a las doce aristas de las tres bananas simultáneamente (Fig. VI-24) y se dimensionará una plataforma móvil que sea triángulo equilátero con una longitud de lado igual al diámetro de la esfera.

En la mayoría de los casos tomando como lado del triángulo el diámetro de la esfera será suficiente, no obstante, si se quisiera ajustar más las dimensiones de la plataforma móvil, se puede analizar los puntos de tangencia de las aristas de las bananas con la esfera y comprobar si el lado del triángulo puede ser menor o debe ser mayor que el diámetro de la esfera.

En el ejemplo que se ha estudiando, debido a la simetría que supone que las longitudes de las manivelas sean iguales y de las bielas por otra parte también sean iguales. Se producen tres puntos de tangencia en la esfera sobre su diámetro máximo, repartidos a 120º, por lo que el lado del triángulo puede ser A = D cos 30º.

Con las dimensiones del manipulador que se han considerando en los ejemplos anteriores, el diámetro de la esfera que contacta con todas las aristas de las bananas es de 0.52076 metros, por lo que la longitud mínima de la arista de una plataforma móvil triángulo equilátero debe ser de 0.451 metros. Como se puede observar la lóngitud mínima considerando los tres lados (0.451 m), es mayor que la longitud mínima considerando un solo lado (0.2226 m).

En cuanto a las dimensiones máximas de las aristas, si se toma un triángulo equilátero para plataforma móvil, su lado deberá ser menor que el menor de los tres mínimos de las distancias máximas, en el ejemplo que se viene considerando, debido a la simetría del manipulador, el lado del triángulo de longitud máxima podría ser 1.22807 metros. Estas dimensiones máximas no tienen excesiva utilidad ya que si se diseñara un manipulador con la longitud de las aristas de la plataforma móvil muy próxima a las máximas el manipulador tendría poca movilidad y, por tanto, poco espacio de trabajo.

Cuando las manivelas y bielas tengan longitudes diferentes, se podría dar el caso de que la mínima longitud del lado del triángulo equilátero sea mayor que el menor de los mínimos de las distancias máximas, entonces no se podría diseñar el manipulador con plataforma móvil triángulo equilátero.

173

Page 194: Tesis

Comprobación del giro de manivelas

VI.4 - CONCLUSIONES

Para garantizar que las seis manivelas del Manipulador Paralelo 6-RKS con una determinada posición de los actuadores sobre la plataforma fija, puedan dar vueltas completas se sigue el proceso siguiente: - Aunque no sea estrictamente necesario, se fijan unas dimensiones máximas

de las manivelas para que no interfieran entre ellas, por ejemplo, se hace que no puedan llegar a las bisectrices de los ángulos del triángulo formado por los ejes de los actuadores. Se toman unas longitudes de las manivelas mayores que las de sus manivelas correspondientes con el fin de evitar interferencias de la plataforma móvil con la fija.

- Una vez hechas esas consideraciones preliminares y escogidas las

longitudes de manivelas y bielas, para verificar si las bielas se pueden ensamblar y las manivelas pueden dar vueltas completas, se calcula si la suma de las longitudes de las dos bielas que se unen a un determinado vértice de la plataforma móvil es mayor que la distancia máxima de los extremos de las manivelas correspondientes y si el módulo de la diferencia de las longitudes de esas bielas es menor que la distancia mínima entre los extremos de las manivelas. Si se cumplen las dos condiciones, las bielas se podrán ensamblar y las dos manivelas correspondientes, en principio, podrán dar vueltas completas.

- Después de comprobar, por lo que respecta a las longitudes de las bielas,

que las manivelas pueden dar vueltas completas, se determinan las longitudes mínima y máxima de cada lado de la plataforma móvil. Si se desea una plataforma móvil con forma de triángulo equilátero deberá tener una longitud de lado mayor que la longitud mínima y que, en principio, se puede tomar como el diámetro de una esfera que contacte con las doce aristas de las bananas calculadas por puntos o por medio de un programa gráfico como CATIA.

Si las longitudes de las manivelas o de las bielas fueran diferentes, se

podría dar el caso de no poder diseñarse un manipulador con plataforma móvil triángulo equilátero en el que las manivelas diesen vueltas completas. En este caso, por medio del programa CATIA se podría analizar las 64 combinaciones de unión de las aristas de las tres bananas y se diseñaría una plataforma móvil con diferentes longitudes de lados que permitiera a las manivelas dar vueltas completas.

Con las longitudes de las aristas de la plataforma móvil próximas a las máximas, el manipulador tendrá poco espacio de movilidad. Si hubiera alguna

174

Page 195: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

arista de la plataforma móvil que tuviera su longitud mínima, se tendría riesgo de que se produzca alguna CIN, ya que la distancia mínima entre aristas de las bananas se producen cuando la arista de la plataforma móvil esta contenida en el plano formado por dos bielas y en este caso se podría producir una configuración de incertidumbre de posición.

En principio, lo ideal es que la plataforma móvil tenga la forma de triángulo equilátero y que la longitud del lado sea la mínima, así se consigue que sea mayor que la distancia mínima para un solo lado, evitando la aparición de CIN y se logra que el espacio de trabajo sea amplio.

Analizando experimentalmente el movimiento del manipulador se observa que al girar una manivela cualquiera, el manipulador realiza un movimiento de oscilación, de forma que, cuando la manivela pasa por las configuraciones de insensitividad de posición, el manipulador se encuentra en los extremos de la oscilación, de aquí se llega a la conclusión de que "el manipulador Paralelo 6-RKS tendrá las 64 CIP, si y solo si, las seis manivelas son capaces de dar vueltas completas en cualquier posición".

175

Page 196: Tesis

Comprobación del giro de manivelas

176

Page 197: Tesis

CONCLUSIONES GENERALES

Page 198: Tesis

Conclusiones generales

178

Page 199: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

CONCLUSIONES GENERALES

C.1 - SÍNTESIS DE MECANISMOS

En el Capítulo I y en los Anexos I y II, para mostrar el proceso a seguir en la síntesis de mecanismos, se ha expuesto tres tipos de síntesis sobre mecanismos planos: - Síntesis estructural o elección del tipo de mecanismo para desarrollar un

determinado trabajo. - Síntesis de puntos de precisión para lograr que un determinado punto del

eslabón acoplador de un mecanismo manivela-oscilador pase por cinco puntos predeterminados.

- Optimización dinámica para conseguir que el par motor máximo durante una revolución de la manivela en un mecanismo manivela-oscilador accionado por un motor asíncrono sea mínimo.

C.2 - MANIPULADORES PARALELOS

Al intentar aplicar el proceso de síntesis expuesto en el Capítulo II a mecanismos espaciales, resulta que hay gran cantidad de dichos mecanismos, con unas características cinemáticas y dinámicas propias de cada uno. Por ello se ha optado por iniciar la síntesis de un tipo de mecanismos, el manipulador paralelo 6-RKS, estudiando algunas de sus características cinemáticas.

En el Capítulo III se ha realizado una aproximación al arte de los

manipuladores paralelos, sobre todo a las configuraciones singulares de los del tipo 6-RKS, no habiéndose encontrado ninguna cita sobre las ventajas de un tipo de configuraciones singulares que en esta tesis se han definido como configuraciones de insensitividad de posición (CIP).

C.3 - CONFIGURACIONES DE INSENSITIVIDAD DE POSICIÓN En el Capítulo IV, como una generalización de la utilidad de las

configuraciones de insensitividad de posición de los mecanismos planos de pistón-biela-manivela y manivela-oscilador, se ha expuesto la utilidad de las configuraciones de insensitividad de posición "CIP" del manipulador paralelo 6-RKS propuesto por Hunt para posicionar piezas, herramientas o utillajes en máquina-herramienta.

179

Page 200: Tesis

Conclusiones generales

Estudiando los toros, lugares geométricos de los extremos de las bielas, se ha demostrado que un vértice de la plataforma móvil se encuentra en la intersección de los toros correspondientes a las cadenas cinemáticas actuador-manivela-biela que van unidas a dicho vértice.

Una cadena cinemática se halla en posición de insensitividad (PI)

cuando el eje del actuador, la manivela y la biela se encuentran en un plano. En esta posición, el extremo de la biela se encontrará sobre la superficie de la intersección de los toros. Si las dos cadenas correspondientes a un vértice están en PI, dicho vértice se encontrará sobre una de las cuatro aristas de la intersección.

En función del número de cadenas cinemáticas que están en PI, se ha

determinado que existen: 12 CIP-1, 60 CIP-2, 120 CIP-3, 240 CIP-4 y 192 CIP-5 configuraciones de insensitividad parcial y (64 CIP-6) de insensitividad total del manipulador respecto del giro de las manivelas.

Las 64 CIP-6, que se han llamado solamente CIP, son configuraciones

puntuales de gran precisión de posición para la plataforma móvil. En estas configuraciones, pequeños errores en la posición de los actuadores no afectan a la posición de la plataforma.

Al pasar de una CIP a otra, la velocidad cuando se llegue a la nueva

posición será nula, por lo que las fuerzas de inercia, si el manipulador se detiene en esa posición, serán muy reducidas, permitiendo la utilización de motores eléctricos asíncronos, más económicos que los motores que permiten un control de su velocidad, y que sería necesario utilizar si se produjesen detenciones del manipulador fuera de sus CIP.

En estas configuraciones, los pares a aplicar a los actuadores para

equilibrar a las fuerzas y pares aplicados sobre la plataforma móvil serán nulos. Ello es debido a que las fuerzas que aparecen en los extremos de las manivelas cortan a los ejes de los actuadores.

Se ha expuesto un método numérico para la obtención de una de estas

configuraciones y a partir de ella, las 63 restantes. Observando el sistema de ecuaciones que relaciona las velocidades de

los extremos de las manivelas y de los vértices de la plataforma móvil, se ha comprobado que si en todas las cadenas cinemáticas se cumple que el eje del actuador, la manivela y la biela están en el mismo plano, el manipulador se encuentra en una CIP.

180

Page 201: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

En el ejemplo numérico del Capítulo IV, se han determinado las 64 CIP para un manipulador de unas dimensiones determinadas, comprobándose numéricamente que las configuraciones obtenidas son realmente CIP. C.4 - SÍNTESIS DE UN MANIPULADOR PARALELO 6-RKS

Teniendo en cuenta las ventajas de las configuraciones de insensitividad de posición, en el Capítulo V se ha expuesto un método numérico y se han realizado ejemplos para lograr que dos y tres posiciones predeterminadas de la plataforma móvil se consigan estando el manipulador en CIP.

Como valores iniciales para las iteraciones del método numérico, se

han tomado combinaciones de las posiciones que alcanza un manipulador en el que sus manivelas tienen la misma longitud y las bielas también tienen la misma longitud. Estas posiciones se han determinado en el ejemplo numérico de Capítulo IV.

Al aumentar el número de posiciones predeterminadas de la

plataforma móvil, debe ir aumentando el número de variables de diseño, así se han tomado como variables las longitudes de la manivelas y de las bielas y las coordenadas "X" de los actuadores sobre la plataforma fija.

Al diseñar el manipulador para tres CIP, en la mayoría de las soluciones que se han obtenido, la posición de los actuadores es tal que se pueden producir interferencias entre las bielas de distintas cadenas cinemáticas. Habrá que estudiar más a fondo este problema, haciendo variar por ejemplo las coordenadas "Y" ó "Z" de los actuadores para ver que otras soluciones aparecen, o prefijar de forma diferente las tres posiciones de la plataforma móvil. C.4 - COMPROBACIÓN DEL GIRO DE LAS MANIVELAS

Puestas de manifiesto las ventajas de las CIP, en el Capítulo VI se ha propuesto un proceso para comprobar si se pueden alcanzar las 64 posibles.

Al principio, se han propuesto unas precauciones, que no son estrictamente necesarias pero si son convenientes, sobre las medidas de las manivelas para evitar interferencias entre ellas y una relación entre medidas de las bielas y las manivelas para evitar que la plataforma móvil interfiera con la fija.

181

Page 202: Tesis

Conclusiones generales

Una vez fijadas las longitudes de manivelas y bielas, para que dos bielas se puedan ensamblar a un vértice de la plataforma móvil y a sus manivelas respectivas, permitiendo el giro de éstas, se debe cumplir que la suma de las longitudes de las dos bielas sea mayor que la distancia máxima entre los extremos de sus manivelas correspondientes y que el módulo de la diferencia de sus longitudes sea menor que la distancia mínima entre los extremos de dichas manivelas.

También se han comprobado las dimensiones de la plataforma móvil para que las seis manivelas puedan girar vueltas completas. La longitud de cada lado, analizado por separado, debe estar comprendida entre unos valores mínimo y máximo. Pero si se toma la plataforma móvil como un triángulo equilátero, resulta que las longitudes mínimas de los lados deben ser mayores que las longitudes mínimas calculadas por separado.

El extremo de cada biela queda limitado por una superficie toroidal. Al unir dos bielas en un vértice de la plataforma móvil, este vértice se encontrará en un volumen intersección de los dos toros correspondientes. A este volumen intersección se le ha llamado banana por su similitud de forma. Cuando el manipulador se encuentra en alguna CIP, todos los vértices de la plataforma móvil se encuentran sobre las aristas de las bananas. Se ha comprobado que las distancias máximas y mínimas posibles entre vértices de la plataforma móvil se producen entre aristas de las bananas.

Por medio del programa gráfico CATIA se ha dibujado una esfera que contacta a la vez con las doce aristas de las tres bananas. En la mayoría de los casos, con tomar como longitud del lado del triángulo equilátero de la plataforma móvil, la longitud del diámetro de la esfera es suficiente.

Si los ejes de los actuadores forman un triángulo equilátero y su descentramiento respecto de los ejes de simetría del triángulo es el mismo, las manivelas son iguales y las bielas, por otro lado, también son iguales, en ese caso, la longitud del lado del triángulo de la plataforma móvil puede ser A = D cos 30º.

Si las longitudes de las manivelas entre si y de las bielas por otro lado son muy diferentes, es conveniente analizar los puntos de corte y de tangencia de las aristas de las bananas con la esfera para poder determinar con mayor seguridad las dimensiones de la plataforma móvil que permita que las seis manivelas giren vueltas completas.

Con las longitudes de las aristas de la plataforma móvil próximas a las máximas, el manipulador tendrá poco espacio de trabajo. Si hubiera alguna

182

Page 203: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

arista de la plataforma móvil que tuviera su longitud mínima, se tendría riesgo de que se produzca alguna CIN, ya que la distancia mínima entre aristas de las bananas se producen cuando la arista de la plataforma móvil esta contenida en el plano formado por dos bielas, y en este caso se podría producir una configuración de incertidumbre de posición.

En principio, lo ideal es que la plataforma móvil tenga la forma de

triángulo equilátero y que la longitud del lado sea la mínima, así se consigue que sea mayor que la distancia mínima para un solo lado, evitando la aparición de CIN y se logra que el espacio de trabajo sea amplio.

Las distancias máximas y mínimas, tanto entre los extremos de las manivelas como entre los puntos de unión de las bielas entre si, se producen cuando los elementos que intervienen se encuentran en posición de insensitividad. Esto ha hecho suponer que las CIP serán configuraciones en las que la posición de la plataforma móvil es extrema. Analizando experimentalmente el movimiento del manipulador se observa que al girar una manivela cualquiera, el manipulador realiza un movimiento de oscilación, de forma que, cuando la manivela pasa por las posiciones de insensitividad, el manipulador se encuentra en alguno de los extremos de la oscilación, de aquí se ha llegado a la conclusión de que "el manipulador Paralelo 6-RKS tendrá las 64 CIP, si y solo si, las seis manivelas son capaces de dar vueltas completas en cualquier posición".

183

Page 204: Tesis

Conclusiones generales

184

Page 205: Tesis

LÍNEAS DE INVESTIGACIÓN ABIERTAS

Page 206: Tesis

Líneas de investigación abiertas

186

Page 207: Tesis

Sintesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

LÍNEAS DE INVESTIGACIÓN ABIERTAS

Después de la realización de esta tesis se considera que hay temas en

los que no se ha profundizado todo lo necesario y otros que han quedado fuera del alcance de este trabajo, y que pueden ser futuras líneas de investigación.

L.1 - SÍNTESIS DE UN MANIPULADOR PARALELO 6-RKS En la síntesis de un manipulador paralelo 6-RKS para lograr que

varias posiciones prefijadas de la plataforma móvil se consigan estando el manipulador en CIP, se puede continuar investigando sobre: - Las variables más convenientes a introducir en el método de obtención de

las dimensiones del manipulador. - La forma de predeterminar las posiciones de la plataforma móvil necesarias

para posicionar las piezas o utillajes. - La consecución de más de tres posiciones prefijadas de la plataforma móvil. - La utilización de configuraciones de insensitividad de posición parciales. L.2 - DIMENSIONES DEL MANIPULADOR

Sobre las dimensiones de la plataforma fija, manivelas, bielas y plataforma móvil se puede continuar investigando acerca de las dimensiones más convenientes para lograr que todas las manivelas puedan girar vueltas completas y así conseguir las 64 CIP.

L.3 - ESPACIO DE TRABAJO En los manipuladores paralelos es muy importante el estudio del

espacio de trabajo que es capaz de alcanzar la plataforma móvil. Se puede estudiar el espacio de trabajo teniendo en cuenta que los vértices de la plataforma se encuentran en el interior de sus bananas correspondientes.

Como las CIP son, en cierto modo, configuraciones extremas, se

puede estudiar el espacio de trabajo como espacio limitado por las CIP.

187

Page 208: Tesis

Líneas de investigación abiertas

L.4 - CONFIGURACIONES DE INCERTIDUMBRE

Si las dimensiones de la plataforma móvil se acercan a las mínimas posibles, se pueden producir CIN que sería conveniente estudiarlas.

L.5 - DINAMICA DEL MANIPULADOR Se puede realizar un estudio sobre las fuerzas estáticas y dinámicas

que aparecerán en los distintos puntos del manipulador utilizando coordenadas naturales.

L.5 - OPTIMIZACIÓN DEL MANIPULADOR

Otra línea de investigación puede ser la optimización de las dimensiones del manipulador con el fin de que sea óptimo bajo algún punto de vista.

Finalmente, como los diversos programas realizados en Matlab se han

implementado de una forma muy sencilla, se puede continuar optimizando los programas y generalizándolos para otros mecanismos.

188

Page 209: Tesis

ANEXO I

SÍNTESIS DE PUNTOS DE PRECISIÓN

Page 210: Tesis

Anexo I

190

Page 211: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

ANEXO I - SINTESIS DE PUNTOS DE

PRECISIÓN AI.1 - EJEMPLO NUMÉRICO

En este anexo se diseñará un cuadrilátero articulado en el que el punto "A", eje de giro de la manivela, sea el origen de coordenadas, el eslabón fijo tenga una longitud de 650 milímetros y el punto "3" del eslabón acoplador pase por los puntos "P1", "P2", "P3", "P4", y "P5" (Fig. AI-1). AI.1.1 - Introducción de datos

P1 = (X31, Y31) = (440, 440) P2 = (X32, Y32) = (390, 480) P3 = (X33, Y33) = (310, 500) P4 = (X34, Y34) = (220, 490) P5 = (X35, Y35) = (130, 440)

Fig. AI-1 Cuadrilátero articulado

191

Page 212: Tesis

Anexo I

AI.1.2 - Condiciones de restricción

Las condiciones de restricción según se presentaron en el apartado II.2.2 son:

φ4 = + - (AI-10)

φ6 = (X11 - X21) 11 - Y21)2 - (AI-12)

φ8 = (X13 - X23) 13 - Y23)2 - (AI-14)

φ13 = (X23 - L0) - (AI-19)

φ1 = (X1 - XA)2 + (Y1 - YA)2 - = 0 (AI-1) L21

φ2 = (X1 - X2)2 + (Y1 - Y2)2 - = 0 (AI-2) L22

φ3 = (X2 - XB)2+ (Y2 - YB)2 - = 0 (AI-3) L23

φ4 = X3 - X1 - (X2 - X1) · L4 / L2 + (Y2 - Y1) · L5 / L2 = 0 (AI-4) φ5 = Y3 - Y1 - (Y2 - Y1) · L4 / L2 - (X2 - X1) · L5 / L2 = 0 (AI-5) φ6 = X3 - Xp = 0 (AI-6) φ7 = Y3 - Yp = 0 (AI-7)

Tomando las cinco primeras condiciones de restricción para las cinco

posiciones a alcanzar, (las dos últimas condiciones de restricción no son necesarias, ya que basta con tomar para el punto "3" las coordenadas que se desea que alcance dicho punto), resultan las 25 ecuaciones de restricción siguientes:

φ1 = + - (AI-8) X211 Y2

11 L21

φ2 = + - (AI-9) X212 Y2

12 L21

φ3 = + - (AI-9) X213 Y2

13 L21

X214 Y2

14 L21

φ5 = + - (AI-11) X215 Y2

15 L21

2 + (Y L22

φ7 = (X12 - X22)2 + (Y12 - Y22)2 - (AI-13) L22

2 + (Y L22

φ9 = (X14 - X24)2 + (Y14 - Y24)2 - (AI-15) L22

φ10 = (X15 - X25)2 + (Y15 - Y25)2 - L (AI-16) 22

φ11 = (X21 - L0)2+ - (AI-17) Y221 L2

3

φ12 = (X22 - L0)2+ - (AI-18) Y222 L2

32+ Y2

232

L232φ14 = (X24 - L0)2+ - (AI-20) Y24

2

L32φ15 = (X25 - L0)2+ - (AI-21) Y25 L3

192

Page 213: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

φ16 = X31 - X11 - (X21 - X11) · L4 / L2 + (Y21 - Y11) · L5 / L2 (AI-22) φ17 = X32 - X12 - (X22 - X12) · L4 / L2 + (Y22 - Y12) · L5 / L2 (AI-23) φ18 = X33 - X13 - (X23 - X13) · L4 / L2 + (Y23 - Y13) · L5 / L2 (AI-24) φ19 = X34 - X14 - (X24 - X14) · L4 / L2 + (Y24 - Y14) · L5 / L2 (AI-25) φ20 = X35 - X15 - (X25 - X15) · L4 / L2 + (Y25 - Y15) · L5 / L2 (AI-26)

Las condiciones de restricción anteriores se pueden expresar de forma compacta como:

φ21 = Y31 - Y11 - (Y21 - Y11) · L4 / L2 - (X21 - X11) · L5 / L2 (AI-27) φ22 = Y32 - Y12 - (Y22 - Y12) · L4 / L2 - (X22 - X12) · L5 / L2 (AI-28) φ23 = Y33 - Y13 - (Y23 - Y13) · L4 / L2 - (X23 - X13) · L5 / L2 (AI-29) φ24 = Y34 - Y14 - (Y24 - Y14) · L4 / L2 - (X24 - X14) · L5 / L2 (AI-30) φ25 = Y35 - Y15 - (Y25 - Y15) · L4 / L2 - (X25 - X15) · L5 / L2 (AI-31)

Los valores (X11, Y11), (X12, Y12), (X13, Y13), (X14, Y14) y (X15, Y15)

son las coordenadas de las diferentes posiciones que alcanzará el punto "1" cuando el punto "3" logre las posiciones "P1", "P2", "P3", "P4" y "P5" respectivamente, y de forma similar se denominan las coordenadas para el punto "2".

Φ(q, t) = 0 (AI-32)

donde el vector "q", en este caso, representa no solamente las

coordenadas dependientes, sino también las variables de diseño.

AI.1.3 - Resolución del sistema

Para resolver este sistema de ecuaciones se utiliza el método iterativo de Newton-Raphson, basado en la linealización de las ecuaciones, consistente en la sustitución de estas ecuaciones por los dos primeros términos del desarrollo en serie de Taylor, que se pueden escribir:

Φ(q, t) = Φ(qi) + Φq(qi) · (q - qi) = 0 (AI-33)

Tomando este sistema y partiendo de un valor inicial del vector "qi", se obtiene una solución aproximada para el valor de "q" que se denomina "qi+1", ahora se vuelve a resolver el sistema tomando como valor inicial "qi+1", y así sucesivamente hasta que el valor obtenido para "q" cumpla las condiciones de restricción cometiendo un error menor que una cantidad predeterminada.

193

Page 214: Tesis

Anexo I

Para aplicar el método de Newton-Raphson descrito en el párrafo anterior, se utiliza el programa "PUNPRECI" realizado en MATLAB partiendo de un valor inicial del vector "q" que tenga los valores siguientes:

L1 = 150; L2 = 800; L3 = 400; L4 = 400; L5 = 250

X11 = 130; Y11 = 80 X12 = 80; Y12 = 130

X13 = 0; Y13 = 150 X14 = -80; Y14 = 130 X15 = -130; Y15 = 80 X21 = 890; Y21 = 320 X22 = 850; Y22 = 350 X23 = 770; Y23 = 380 X24 = 680; Y24 = 390 X25 = 600; Y25 = 400

AI.1.4 - Solución

Aplicando el programa, al cabo de seis iteraciones, resultan las dimensiones de los eslabones siguientes:

L1 = 134.238 mm. L2 = 828.363 " L3 = 407.887 " L4 = 422.664 " L5 = 248.306 "

El método de Newton-Raphson tiene el inconveniente de que si no se

parte de unos valores iniciales apropiados, no converge. Por ello, en la mayoría de los casos, se debe probar con varios grupos de valores iniciales hasta conseguir la convergencia a una solución real y por lo tanto a los valores finales de diseño. En este ejemplo se ha probado con cinco conjuntos de valores iniciales para conseguir finalmente la convergencia.

Unos buenos valores iniciales suelen ser los correspondientes a un cuadrilátero en el que el punto "3" por lo menos alcance una o dos de las cinco posiciones prefijadas. Esto es fácil de lograr dibujando el cuadrilátero en esas posiciones por medio de algún programa gráfico.

194

Page 215: Tesis

ANEXO II

OPTIMIZACIÓN DE UN CUADRILÁTERO ARTICULADO

Page 216: Tesis

Anexo II

196

Page 217: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

ANEXO II - OPTIMIZACIÓN DE UN

CUADRILÁTERO ARTICULADO

En este anexo se presentará un método de optimización de las dimensiones de un cuadrilátero articulado para que el valor máximo del par motor durante un ciclo, es decir una revolución completa de la manivela, sea mínimo. Como condiciones de restricción se tomarán el ángulo girado por el eslabón oscilador, su longitud y la relación de tiempos entre las carreras de ida y de retorno. Al final se realizará la optimización para ejemplo numérico determinado.

AII.1 - EJEMPLO NUMÉRICO

Se pretende optimizar las dimensiones de un mecanismo manivela-oscilador (Fig. AII-1) en el que el eslabón seguidor, que es una plataforma de 500 milímetros de radio, debe realizar una oscilación de 45º con una relación entre el tiempo de la carrera de ida y la de retorno de 1.25. El mecanismo se mueve por medio de un motor asíncrono de 1.1 Kw. de potencia, con velocidad nominal de 1500 r.p.m. y un reductor con relación de reducción de 25. El criterio para optimizar es que el par máximo durante un ciclo completo, es decir una vuelta completa de la manivela, sea mínimo, teniendo en cuenta que el par depende del deslizamiento del campo magnético del motor.

Fig. AII-1 Cuadrilátero articulado a optimizar.

197

Page 218: Tesis

Anexo II

AII.1.1 - Datos del mecanismo

Como datos del mecanismo se tienen los siguientes: -

- -

- - - - -

Longitud del eslabón seguidor "L4"igual al radio de la plataforma 500 mm. - Masa de la plataforma "m4" 123 Kg.

Centro de gravedad de la plataforma en el punto "B". Momento de inercia de la plataforma respecto del punto "2" 46 Kg.m2.

- Masa de la manivela "m2" 16.5 Kg. Centro de gravedad de la manivela en el punto "A". Momento de inercia de la manivela respecto del punto "A" 0.2 Kg.m2. Momento de inercia del motor reducido al eje de la manivela 1.9 Kg.m2. Momento de inercia del reductor reducido al eje de la manivela 0.4 Kg.m2. Masa del eslabón acoplador "m3" 15 · L3 Kg.

- Momento de inercia del eslabón acoplador respecto al punto "1" I1 = 3Lm 2

3

- El momento motor de un motor asíncrono de una potencia de 1.1 Kw. es:

1S56.12S4S67.117S1.33

24

3

++−+M = (AII-1)

S = (1500-Velocidad del motor)/1500. (AII-2)

Para obtener la anterior ecuación del par motor, se parte de considerar que la ecuación del par motor de un motor asíncrono ideal es:

siendo el deslizamiento

M = XSR

SRK 22

222

2

+ (AII-3)

siendo "K" una constante que depende de las características físicas del

motor y de la tensión de la red, "R2" la resistencia del rotor, "X2" la reactancia del rotor y "S" el deslizamiento.

Dividiendo numerador y denominador por " ", la ecuación del momento se puede expresar como:

R22

M = 1Sf

eS2 +

(AII-4)

198

Page 219: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Tomando de un catálogo el par de un motor real, se comprueba que es imposible ajustarlo por medio de esta ecuación. Esto es debido a que un motor real tiene en el bobinado del estator una posición de las espiras por toda la ranura de alojamiento, quedando repartidas desde la superficie del entrehierro hasta lo más profundo de la ranura. Para ajustar el par real por medio de una ecuación se supone que el motor real está formado de dos motores ideales, uno con espiras superficiales y otro con espiras profundas, así la ecuación del par quedará:

M = M1 + M2 = 1Sf

eS2 +

+ 1Sh

gS2 +

= 1S)hf(SfhS)ge(S)gfhe(

24

3

++++++ (AII-5)

en la que se pueden simplificar los coeficientes y expresar como:

M = 1SdSc

bSSa24

3

+++ (AII-6)

ecuación que se puede ajustar perfectamente al diagrama del par del

motor real dado por catálogo.

La ecuación del par es una función impar, por lo tanto el par es una función simétrica respecto del origen de coordenadas (S = 0; n = 1500 r.p.m.).

Fig. AII-2 Diagrama del par motor.

199

Page 220: Tesis

Anexo II

Para ajustar los valores de los coeficientes de la ecuación (AII-6), partiendo de la gráfica real del par (Fig.AII-2) se toman los valores siguientes: Par nominal a 1400 r.p.m., S = 0.06666, M = 7.5 Nm. Par de arranque a 0 r.p.m., S = 1, 2.1 del par nominal, M = 15.75 " Par máximo, S = 0.3, 2.3 del par nominal, M = 17.25 " Par mínimo, S = 0.8, 2 del par nominal, M = 15 "

Con los cuatro valores de par para otros tantos valores de deslizamiento se obtienen los valores de los coeficientes de la ecuación (AII-6): a = 33.1, b = 117.67 c = - 4 y d = 12.56

AII.1.2 - Estudio cinemático

Siguiendo el proceso expuesto en el apartado II.2.3 para el mecanismo de manivela oscilador de la Fig. AII-1, suponiendo en principio que los puntos "A" y "B" y las longitudes de los eslabones son fijos y conocidos, se tendrá como vector de coordenadas dependientes:

qT = { X1, Y1, X2, Y2 } (AII-7)

y como vector de parámetros, el vector de las longitudes del eslabón fijo, manivela y eslabón acoplador:

bT = { L1, L2, L3 } (AII-8)

Las condiciones de restricción "Φ(q, b, t) = 0" en el cuadrilátero articulado se expresan como:

(XB-XA)2 + (YB-YA) 2 - = 0 (AII-9) L21

(X1-XA)2 + (Y1-YA) 2 - = 0 (AII-10) L22

(X2-X1)2 + (Y2-Y1) 2 - = 0 (AII-11) L232(X2-XB)2 + (Y2-YB) 2 - = 0 (AII-12) L4

De momento, para los estudios cinemático y dinámico, la primera

condición de restricción no es necesaria ya que los puntos "A" y "B" se consideran fijos. Posteriormente, será necesaria al realizar el estudio de sensibilidad, ya que la distancia entre los puntos "A" y "B", así como las longitudes de la manivela y del eslabón acoplador serán las variables diseño.

200

Page 221: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

AII.1.2.1 - Cálculo de posición

Para definir la posición del mecanismo, se fija el ángulo " θ " que forma el eslabón de entrada "2" con el eslabón fijo "1", quedando entonces definida la posición del punto "1" como:

2

X1= XA + L2 cos( θ2 ) (AII-13) Y1 = YA + L2 sin( θ2 ) (AII-14)

Al estar definida la posición del punto "1", tampoco es necesaria de

momento la segunda condición de restricción, ya que ésta se cumplirá siempre, por lo tanto, para resolver el problema cinemático y dinámico inverso sólo serán necesarias las condiciones de restricción:

φ 3 = (X2-X1)2 + (Y2-Y1) 2 - = 0 (AII-15) L23

φ 4 = (X2-XB)2 + (Y2-YB) 2 - = 0 (AII-16) L24

En el cuadrilátero articulado, la posición del punto "2" se puede obtener analíticamente de forma directa, no obstante como en mecanismos más complejos es muy difícil obtener la posición de los diversos puntos de forma directa, aquí se resuelve la posición del punto "2" por el método iterativo de Newton-Raphson (Fig. AII-3), que será el que se utilizará en los mecanismos complejos, y que se basa en el sistema de ecuaciones:

(AII-17) )qq)·(q()q( 1iiiqi +−Φ=Φ

Fig. AII-3.Método iterativo de Newton-Raphson.

201

Page 222: Tesis

Anexo II

Con el sistema de ecuaciones (AII-17), dando unas coordenadas iniciales " q " se obtienen unas coordenadas " q " para el punto "2"; ahora, tomando éstas como iniciales se va iterando hasta que el valor de "Φ" sea menor que un valor prefijado de antemano, momento en el que se considera que se cumplen las condiciones de restricción.

i 1i+

En el cuadrilátero articulado en estudio, el sistema de ecuaciones (AII-17) tomará la forma siguiente:

−−−−

)YY(2)XX(2)YY(2)XX(2

B2B2

1212

i

−−

+

+

YYXX

)1i(2)i(2

)1i(2)i(2 = (AII-18)

φφ

4

3

i

Con este sistema de ecuaciones, dando unos valores iniciales a las coordenadas del punto "2" [X2(i), Y2(i)], se obtendrán unas nuevas coordenadas para el punto "2" [X2(i+1), Y2(i+1)]. Tomando éstas como iniciales, se seguirá iterando hasta que los valores de φ 3 y φ 4, al sustituir en ellas los valores de X2 e Y2, sean menores que un valor prefijado de antemano, momento en el que X2 e Y2, serán solución del problema de posición.

AII.1.2.2 - Cálculo de velocidades

Una vez resuelto el problema de posición, se cumplen las condiciones de restricción:

Φ(q, b, t) = 0 (AII-19)

Derivando las condiciones de restricción respecto del tiempo se tendrá:

Φq q& + Φt = 0 (AII-20)

Este sistema de ecuaciones que relaciona las velocidades, en el cuadrilátero articulado será:

=

−−

−−−−

−−

0

0

0

Y

X

Y

X

·

)YY(2)XX(200

)YY(2)XX(2)YY(2)XX(2

00)YY(2)XX(2

2

2

1

1

B2B2

12122121

A1A1

&

&

&

&

(AII-21)

202

Page 223: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

En este caso " 0t =Φ " porque no hay condiciones de restricción que dependan del tiempo.

sistema de ecuaciones que relaciona las aceleraciones de las coordenadas dependientes, y que en el cuadrilátero articulado serán:

= (AII-26)

Para definir el movimiento del cuadrilátero articulado se introduce una velocidad angular "ω2" a la manivela, entonces se tendrá que las componentes de la velocidad del punto "1" serán:

X1& = - ω2 L2 sin( θ ) (AII-22) 2

Y1& = ω2 L2 cos( ) (AII-23) θ2

En el sistema de ecuaciones (AII-21), pasando los términos conocidos

al segundo miembro y despreciando la primera ecuación, ya que al ser conocidas las componentes de la velocidad del punto "1" esta ecuación se cumplirá siempre, quedará:

−−

−−

Y

)YY(2)XX(2

)YY(2)XX(2

2

2

B2B2

1212

&

&= - (AII-24)

−−

Y

00

)YY(2)XX(2

1

12121

&

&

Resolviendo este sistema de ecuaciones se calcularán las velocidades

del punto "2" siendo conocidas las del punto "1". AII-1-2-3. - Cálculo de aceleraciones.

Derivando respecto del tiempo el sistema de ecuaciones (AII-20) que relaciona las velocidades se obtendrá:

Φq q&& + + = 0 (AII-25) qq &&Φ Φ& t

qq &&Φ

−−

−−−−

Y

X

Y

X

·)YY(2)XX(200

)YY(2)XX(2)YY(2)XX(2

2

2

1

1

B2B2

12122121

&&

&&

&&

&&

203

Page 224: Tesis

Anexo II

qq &&Φ = - (AII-26)

- (AII-30)

−−−−

Y

X

Y

X

·Y2X200

)YY(2)XX(2)YY(2)XX(2

2

2

1

1

22

12122121

&

&

&

&

&&

&&&&&&&&

0t =Φ& (AII-27)

Para que el estudio cinemático del cuadrilátero articulado quede totalmente definido es necesario conocer la aceleración angular "α2" de la manivela. En tal caso, las aceleraciones del punto "1" serán:

X1&& = - L2 cos( ) - αω22 θ2 2 L2 sin( θ ) (AII-28) 2

Y1&& = - L2 sin( θ ) + αω22 2 2 L2 cos( ) (AII-29) θ2

Al ser conocidas las aceleraciones del punto "1", se pasan al segundo miembro, quedando el sistema de ecuaciones (AII-25) de la forma siguiente:

−−

−−

Y

)YY(2)XX(2

)YY(2)XX(2

2

2

B2B2

1212

&&

&& = - -

−−

Y

00

)YY(2)XX(2

1

12121

&&

&&

−−−−

Y

X

Y

X

·Y2X200

)YY(2)XX(2)YY(2)XX(2

2

2

1

1

22

12122121

&

&

&

&

&&

&&&&&&&&

Resolviendo el sistema de ecuaciones (AII-30) se obtienen las aceleraciones del punto "2", siendo conocidas las velocidades y aceleraciones del punto "1" y las velocidades del punto "2"

204

Page 225: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

AII.1.3 - Cálculo dinámico

donde:

Para resolver el problema dinámico se aplicará el sistema de ecuaciones:

M & + λ = Q (AII-31) q& qTΦ

- M es la matriz de masas del conjunto del mecanismo. Teniendo en cuenta que el eslabón "2" tiene su centro de gravedad en el punto "A", su longitud es "L2", su masa "m2" y su momento de inercia respecto del punto "A" es "IA2", el eslabón "3" tiene su centro de gravedad en el centro de su longitud, una longitud "L3", una masa "m3" y su momento de inercia respecto del punto "1" es "I13" y el eslabón "4" tiene su centro de gravedad en el punto "B", una longitud "L4", una masa "m4" y su momento de inercia respecto del punto "2" es "I24", resultará:

M =

+−−

+−−

−+

−+

LIm

LI0

LI

2m0

0LIm

LI0

LI

2m

LI

2m0

LI

LI0

0LI

2m0

LI

LI

24

2442

3

1323

133

24

2442

3

1323

133

23

13323

1322

2A

23

13323

1322

2A

(AII-32)

- " q& ", vector de las aceleraciones de los puntos representados por las coordenadas dependientes será: &

q&& = (AII-33)

Y

X

Y

X

2

2

1

1

&&

&&

&&

&&

205

Page 226: Tesis

Anexo II

- " ", traspuesta de la matriz jacobiana de las condiciones de restricción respecto de las coordenadas dependientes en este caso será:

ΦTq

ΦTq = (AII-34)

−−

−−

−−

−−

)YY(2)YY(20

)XX(2)XX(20

0)YY(2)YY(2

0)XX(2)XX(2

B212

B212

21A1

21A1

- "λ", vector de los multiplicadores de Lagrange será:

Q =

λ = (AII-35)

λ

λ

λ

3

2

1

- "Q" será el vector de las fuerzas exteriores que actúan en los puntos "1" y "2" y que en este ejemplo serán nulas. No obstante, como con este método no se pueden introducir los pares como tales, el par motor se establece mediante una fuerza perpendicular al eslabón "2" en el punto "A" y otra del mismo módulo y dirección y sentido contrario, en el punto "1", de forma que el par de estas dos fuerzas sea igual al par motor.

0

0L

XXL

YY

22

A1

22

1A

·PAR (AII-36)

Con el sistema de ecuaciones (AII-31), desarrollado para el cuadrilátero articulado de (AII-32) a (AII-36), se pueden resolver dos tipos de problemas: el dinámico inverso, cuando se conocen las velocidades y aceleraciones y se trata de calcular el PAR, y el dinámico directo, cuando se conocen las velocidades y el PAR y se trata de calcular las aceleraciones.

206

Page 227: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

AII.1.3.1 - Simulación dinámica

= - (AII-37)

En este caso, para poder determinar el par motor máximo con el fin de hacerlo mínimo, se debe realizar una simulación dinámica de, al menos, una vuelta de la manivela. Para realizar esta simulación dinámica se comienza poniendo unas condiciones iniciales de posición y velocidad del mecanismo, a partir de estas condiciones y del par motor correspondiente a esas condiciones se resuelve el problema dinámico directo y se obtienen las aceleraciones, se fija un incremento de tiempo para realizar la integración numérica y se calculan las nuevas velocidades y las nuevas posiciones a partir de las anteriores.

En el cálculo dinámico directo utilizado para realizar la simulación dinámica, como las aceleraciones que se irán calculando también deberán cumplir las ecuaciones cinemáticas, al sistema de ecuaciones (AII-31) se le añadirán las ecuaciones:

qq &&Φ Φβ−Φ+Φα−Φ−Φ2

tqtq )q(2q &&&&

En el sistema (AII-37), se ha introducido la corrección de Baumgarte

expuesta en el apartado (II.3.3.3) tomando α = β = 20. Con esta corrección se realizará la simulación dinámica disminuyendo el riesgo de divergencia en la solución.

Los términos de la ecuación (AII-37) serán los siguientes:

qq &&Φ = (AII-38)

−−

−−−−

−−

Y

X

Y

X

·

)YY(2)XX(200

)YY(2)XX(2)YY(2)XX(2

00)YY(2)XX(2

2

2

1

1

B2B2

12122121

A1A1

&&

&&

&&

&&

qq &&Φ = - (AII-39)

−−−−

Y

X

Y

X

·

Y2X200

)YY(2)XX(2)YY(2)XX(2

00Y2X2

2

2

1

1

22

12122121

11

&

&

&

&

&&

&&&&&&&&

&&

0tt =Φ=Φ & (AII-40)

207

Page 228: Tesis

Anexo II

)q(2 tq Φ+Φα & =40 (AII-41)

−−−−−−

−−

YXYX

·)YY(2)XX(200)YY(2)XX(2)YY(2)XX(2

00)YY(2)XX(2

2

2

1

1

B2B2

12122121

A1A1

&

&

&

&

−−+−

−−+−

−−+−

=Φβ

L)YY()XX(L)YY()XX(L)YY()XX(

·40024

2B2

2B2

23

212

212

22

2A1

2A1

2 (AII-42)

Una vez obtenidas para un instante determinado, las aceleraciones de

los puntos "1" y "2", para obtener las nuevas velocidades y posiciones en el instante siguiente se aplicarán las ecuaciones:

δ

+

=

t

2

2

1

1

2

2

1

1

2

2

1

1

Y

X

Y

X

Y

X

Y

X

Y

X

Y

X

&&

&&

&&

&&

&

&

&

&

&

&

&

&

(AII-43)

δ

+

=

t

2

2

1

1

2

2

1

1

2

2

1

1

Y

X

Y

X

Y

X

Y

X

Y

X

Y

X

&

&

&

&

(AII-44)

En este ejemplo del cuadrilátero articulado, se ha tomado como

aceleraciones y velocidades para realizar la integración numérica las medias entre las aceleraciones y velocidades actuales y las del paso anterior. De esta forma, la simulación se ajusta más a la realidad. Esta comprobación se ha realizado haciendo girar la manivela del mecanismo una vuelta completa aplicando un par nulo, resultando al final de la vuelta unos valores de posición, velocidad y aceleración que coinciden con los iniciales, tal como sucede en el mecanismo sin rozamiento.

La simulación dinámica se podría haber resuelto por medio de las rutinas de integración numérica OD23 ó OD45 de Matlab, pero en esta tesis se ha preferido realizar los programas en Matlab de la forma más simple posible.

208

Page 229: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

AII.1.4 - Cálculo de sensibilidad cinemática

Para conseguir que el momento motor máximo durante un ciclo del mecanismo sea mínimo, se estudiará la sensibilidad del momento motor frente a las variables de diseño, que en este caso serán las longitudes de los eslabones. Una vez determinada la sensibilidad del par motor en la posición del mecanismo en el que el par es máximo, ésta indicará el sentido en el que se deben modificar las dimensiones del mecanismo para disminuir el par máximo.

AII.1.4.1 - Sensibilidad de posición

Para estudiar la sensibilidad del par motor, como éste depende de la cinemática y la dinámica del mecanismo, se inicia con el estudio de la sensibilidad de la posición respecto de las variables de diseño.

Para el estudio de la sensibilidad de la posición del cuadrilátero

articulado las condiciones de restricción serán:

Φ (q, b, t) = 0 (AII-45)

siendo el vector de coordenadas naturales:

q = (AII-46)

X

Y

X

Y

X

B

2

2

1

1

y las variables de diseño:

b = (AII-46)

L

L

L

3

2

1

En este caso, las condiciones de restricción no dependen del tiempo y

la longitud del eslabón "4" es fija. Con estas hipótesis y suponiendo que la

209

Page 230: Tesis

Anexo II

variación de longitud del eslabón "2" se producirá en la dirección de dicho eslabón, se podrá escribir:

Φ (q, b) = = (AII-47)

−−−−+−−−+−

θ−−θ−−

LXXL)YY()XX(L)YY()XX(

sinLYYcosLXX

1AB

24

2B2

2B2

23

212

212

22A1

22A1

0

0

0

0

0

Para calcular la sensibilidad de posición, primero se calcula la

posición del mecanismo para un determinado ángulo " θ " del eslabón de entrada y después, derivando la ecuación (AII-47) respecto de los parámetros, se tendrá:

2

0q bbq =Φ+Φ (AII-48)

siendo:

−−−−−−−=Φ

10000)XX(2)YY(2)XX(200

0)YY(2)XX(2)YY(2)XX(20001000001

2BB2B2

12122121q (AII-49)

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

=

LX

LX

LX

LY

LY

LY

LX

LX

LX

LY

LY

LY

LX

LX

LX

q

3

B

2

B

1

B

3

2

2

2

1

2

3

2

2

2

1

2

3

1

2

1

1

1

3

1

2

1

1

1

b (AII-50)

210

Page 231: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

−θ−θ−

001000

L2000sin00cos0

3

2

2

b (AII-51)

Resolviendo el sistema de ecuaciones (AII-48), desarrollado de (AII-49) a (AII-51), se obtendrá " " que es la sensibilidad de las coordenadas dependientes respecto de las longitudes de los eslabones.

qb

AII.1.4.2 - Sensibilidad de velocidades

Una vez calculadas las velocidades, derivando respecto del tiempo el sistema de ecuaciones (AII-48), se obtendrá:

0qq bbqbq =Φ+Φ+Φ &&& (AII-52)

donde:

Φq = (AII-53)

−−

−−−−

)YY(2)XX(200

)YY(2)XX(2)YY(2)XX(2

0010

0001

B2B2

12122121

Esta matriz jacobiana, debería ser la misma que la (AII-49)

correspondiente a la sensibilidad de posición. Pero en ésta, se ha eliminado la quinta fila y quinta columna al no ser necesarias, ya que se sabe de antemano que la sensibilidad de la velocidad del punto "B" es cero al ser éste un punto fijo durante el funcionamiento del mecanismo.

211

Page 232: Tesis

Anexo II

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

=

LY

LY

LY

LX

LX

LX

LY

LY

LY

LX

LX

LX

q

3

2

2

2

1

2

3

2

2

2

1

2

3

1

2

1

1

1

3

1

2

1

1

1

b

&&&

&&&

&&&

&&&

& (AII-54)

Φ& q = (AII-55)

−−−−

X2Y2X200

0)YY(2)XX(2)YY(2)XX(2

00000

00000

222

12122121

&&&

&&&&&&&&

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

=

LX

LX

LX

LY

LY

LY

LX

LX

LX

LY

LY

LY

LX

LX

LX

q

3

B

2

B

1

B

3

2

2

2

1

2

3

2

2

2

1

2

3

1

2

1

1

1

3

1

2

1

1

1

b (AII-56)

θω−θω

0000000cos00sin0

22

22

b& (AII-57)

Resolviendo el sistema de ecuaciones (AII-52), desarrollado de

(AII-53) a (AII-57), se obtendrá " " que es la sensibilidad de las velocidades con respecto a las longitudes de los eslabones.

qb&

212

Page 233: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

AII.1.4.3 - Sensibilidad de aceleraciones

Una vez calculadas las aceleraciones, bien sea al estudiar el problema cinemático o al resolver el problema dinámico, derivando respecto del tiempo el sistema de ecuaciones (AII-52), se obtendrá:

0qq2q bbqbqbq =Φ+Φ+Φ+Φ &&&&&&&& (AII-58)

donde:

= (AII-59)

Φq

−−

−−−−

)YY(2)XX(200

)YY(2)XX(2)YY(2)XX(2

0010

0001

B2B2

12122121

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

=

LY

LY

LY

LX

LX

LX

LY

LY

LY

LX

LX

LX

q

3

2

2

2

1

2

3

2

2

2

1

2

3

1

2

1

1

1

3

1

2

1

1

1

b

&&&&&&

&&&&&&

&&&&&&

&&&&&&

&& (AII-60)

= (AII-61)

Φ& q

−−−−

Y2X200

)YY(2)XX(2)YY(2)XX(2

0000

0000

22

12122121

&&

&&&&&&&&

213

Page 234: Tesis

Anexo II

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

=

LY

LY

LY

LX

LX

LX

LY

LY

LY

LX

LX

LX

q

3

2

2

2

1

2

3

2

2

2

1

2

3

1

2

1

1

1

3

1

2

1

1

1

b

&&&

&&&

&&&

&&&

& (AII-62)

Φ&& q = (AII-63)

−−−−

X2Y2X200

0)YY(2)XX(2)YY(2)XX(2

00000

00000

222

12122121

&&&&&&

&&&&&&&&&&&&&&&&

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

=

LX

LX

LX

LY

LY

LY

LX

LX

LX

LY

LY

LY

LX

LX

LX

q

3

B

2

B

1

B

3

2

2

2

1

2

3

2

2

2

1

2

3

1

2

1

1

1

3

1

2

1

1

1

b (AII-64)

θα−θωθα+θω

0000000cossin00sincos0

22222

22222

b&& (AII-65)

Resolviendo el sistema de ecuaciones (AII-58), desarrollado de

(AII-59) a (AII-65), se obtendrá la sensibilidad de las aceleraciones " q& " respecto de las longitudes de los eslabones.

b&

214

Page 235: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

AII.1.5 - Cálculo de sensibilidad dinámica

Una vez estudiado el problema dinámico, bien sea directo o inverso, se habrá resuelto el sistema de ecuaciones , derivando este sistema respecto de las longitudes de los eslabones se obtendrá:

(AII-66)

donde:

QqM Tq =λΦ+&&

QqMqM b

Tqbb

Tqbb =λΦ+λΦ++ &&&&

M =

+−−

+−−

−+

−+

LIm

LI0

LI

2m0

0LIm

LI0

LI

2m

LI

2m0

LI

LI0

0LI

2m0

LI

LI

24

2442

3

1323

133

24

2442

3

1323

133

23

13323

1322

2A

23

13323

1322

2A

(AII-67)

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

=

LY

LY

LY

LX

LX

LX

LY

LY

LY

LX

LX

LX

q

3

2

2

2

1

2

3

2

2

2

1

2

3

1

2

1

1

1

3

1

2

1

1

1

b

&&&&&&

&&&&&&

&&&&&&

&&&&&&

&& (AII-68)

=

" " será una hipermatriz. Al hacer el producto , la primera columna de la matriz será el producto de la sensibilidad de la matriz de masas respecto de la longitud del eslabón "1" por " ", la segunda columna será el producto de la sensibilidad de la matriz de masas respecto de la longitud del eslabón "2" por " " y la tercera columna será el producto sensibilidad de la matriz de masas respecto de la longitud del eslabón "3" por " & ", resultando:

Mb qMb &&

q&

qMb &&

q&&

q&&

qMb && [ ]qMqMqM 321 LLL &&M&&M&& (AII-69)

215

Page 236: Tesis

Anexo II

siendo:

·

0000

0000

0000

0000

qM 1L

=&&

Y

X

Y

X

2

2

1

1

&&

&&

&&

&&

(AII-70)

·

0000

0000

00L

M0

000LM

qM2

22

2

11

L2

δδ

δδ

=&&

Y

X

Y

X

2

2

1

1

&&

&&

&&

&&

(AII-71)

·

LM0

LM0

0L

M0L

ML

M0L

M0

0L

M0L

M

qM

3

44

3

42

3

33

3

31

3

24

3

22

3

13

3

11

L3

δδ

δδ

δδ

δδ

δδ

δδ

δδ

δδ

=&&

Y

X

Y

X

2

2

1

1

&&

&&

&&

&&

(AII-72)

donde, teniendo en cuenta que "IA2" es constante y "m3" es

proporcional a "L3", resultará:

LI2

LM

32

2A

2

11 −=δ

δ (AII-73)

LI2

LM

32

2A

2

22 −=δ

δ (AII-74)

L3m

LM

LM

LM

LM

3

3

3

44

3

33

3

22

3

11 =δ

δ=δ

δ=

δδ=

δδ (AII-75)

L6m

LM

LM

LM

LM

3

3

3

42

3

31

3

24

3

13 =δ

δ=δ

δ=

δδ=

δδ (AII-76)

216

Page 237: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

−−

−−

−−

−−

)YY(2)YY(20

)XX(2)XX(20

0)YY(2)YY(2

0)XX(2)XX(2

B212

B212

21A1

21A1

Tq (AII-77)

δλδ

δλδ

δλδ

δλδ

δλδ

δλδ

δλδ

δλδ

δλδ

LLL

LLL

LLL

3

3

2

3

1

3

3

2

2

2

1

2

3

1

2

1

1

1

b (AII-78)

" " será una hipermatriz. Al hacer el producto , la primera

columna de la matriz será el producto de la sensibilidad de la matriz jacobiana traspuesta respecto de la longitud del eslabón "1" por "

ΦTqb λΦT

qb

λΦTqb

λ ", la segunda columna será el producto de la sensibilidad de la matriz jacobiana traspuesta respecto de la longitud del eslabón "2" por " λ ", y la tercera columna será el producto de la sensibilidad de la matriz jacobiana traspuesta respecto de la longitud del eslabón "3" por " λ ", resultando:

λΦT

qb = [ ]λΦλΦλΦ Tql

Tql

Tql 321

MM (AII-79)

donde:

λ

λ

λ

δδ

δδ

−δδ

δδ−

δδ

δδ−

δδ

δδ−

δδ

δδ

δδ

−δδ

δδ

=λΦ

3

2

1

1

2

1

1

1

2

1

B

1

2

1

1

1

2

1

2

1

1

1

1

1

2

1

1

1

1

Tql ·

LY2)

LY

LY(20

)LX

LX(2)

LX

LX(20

0)LY

LY(2

LY2

0)LX

LX(2

LX2

1 (AII-80)

217

Page 238: Tesis

Anexo II

λ

λ

λ

δδ

δδ

−δδ

δδ−

δδ

δδ−

δδ

δδ−

δδ

δδ

δδ

−δδ

δδ

=λΦ

3

2

1

2

2

2

1

2

2

2

B

2

2

2

1

2

2

2

2

2

1

2

1

2

2

2

1

2

1

Tql ·

LY2)

LY

LY(20

)LX

LX(2)

LX

LX(20

0)LY

LY(2

LY2

0)LX

LX(2

LX2

2 (AII-81)

λ

λ

λ

δδ

δδ−

δδ

δδ

−δδ

δδ

−δδ

δδ

−δδ

δδ

δδ−

δδ

δδ

=λΦ

3

2

1

3

2

3

1

3

2

3

B

3

2

3

1

3

2

3

2

3

1

3

1

3

2

3

1

3

1

Tql ·

LY2)

LY

LY(20

)LX

LX(2)

LX

LX(20

0)LY

LY(2

LY2

0)LX

LX(2

LX2

3 (AII-82)

siendo:

δδ

δδ

δδ

δδ

δδ

δδ

=

000

000LQ

LQ

LQ

LQ

LQ

LQ

Q3

Y1

2

Y1

1

Y1

3

X1

2

X1

1

X1

b (AII-83)

donde:

LY·

LPAR

LPAR·

LYY

LQ

1

1221

22

1A

1

X1

δδ−

δδ−

δ (AII-84)

LX·

LPAR

LPAR·

LXX

LQ

1

1221

22

A1

1

Y1

δδ+

δδ−

δ (AII-85)

218

Page 239: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

L)YY(PAR2

LY·

LPAR

LPAR·

LYY

LQ

32

1A

2

1222

22

1A

2

X1 −−

δδ−

δδ−

=δδ

(AII-86)

L)XX(PAR2

LX·

LPAR

LPAR·

LXX

LQ

32

A1

2

1222

22

A1

2

Y1 −−

δδ+

δδ−

=δδ

(AII-87)

LY·

LPAR

LPAR·

LYY

LQ

3

1223

22

1A

3

X1

δδ−

δδ−

δ (AII-88)

LX·

LPAR

LPAR·

LXX

LQ

3

1223

22

A1

3

Y1

δδ+

δδ−

δ (AII-89)

El sistema de ecuaciones (AII-66), desarrollado de (AII-67) a

(AII-89), es un sistema de 12 ecuaciones, en las que en el problema dinámico directo durante una simulación, se conocen: la matriz de masas "M", la sensibilidad de la matriz de masas respecto de las longitudes de eslabones " M ", la posición, velocidad, PAR, y matriz jacobiana traspuesta en un instante. Una vez resuelto el problema dinámico directo en ese instante, se conocerán los multiplicadores de Lagrange "

b

λ ", las aceleraciones " & " y con éstas las velocidades " ", las posiciones "q" y el "PAR" en el instante siguiente. Con las nuevas posiciones, velocidades y aceleraciones se calcularán las sensibilidades de posición " q ", de velocidad " " y aceleración " q& ", la nueva matriz jacobiana traspuesta y la sensibilidad de la matriz jacobiana transpuesta. Finalmente, al resolver el sistema, se obtendrán las sensibilidades de los tres multiplicadores de Lagrange y del PAR respecto de las tres longitudes variables.

q&q&

b qb& b&

Por lo tanto, el sistema de ecuaciones de sensibilidad dinámica

(AII-66) permite determinar la sensibilidad del PAR respecto de las longitudes de los eslabones del cuadrilátero articulado, teniendo de esta manera información para saber como variar dichas dimensiones con el fin de disminuir el PAR.

219

Page 240: Tesis

Anexo II

AII.2 - RESOLUCIÓN DEL EJEMPLO NUMÉRICO

En el mecanismo manivela-oscilador que se pretende optimizar la relación de tiempos es 1.25, de donde se deduce, aplicando la ecuación (AII-90), que el ángulo "α" formado por las posiciones del eslabón acoplador cuando el mecanismo se encuentra en configuración de insensitividad de posición es 20º.

Qt = 25.1180180 =

α−α+ (AII-90)

En este ejemplo, como el ángulo girado y la longitud del eslabón

seguidor son constantes, resultará que, al ir variando las longitudes de los eslabones cumpliendo las restricciones impuestas, el punto "A", punto de giro de la manivela, se desplazará sobre una circunferencia que pasa por los puntos extremos del eslabón seguidor (Fig. AII-4). Esto es debido a la propiedad geométrica de que una determinada cuerda de una circunferencia se ve bajo el mismo ángulo desde cualquier punto de una circunferencia y además este ángulo es la mitad del ángulo con que se ve dicha cuerda desde el centro de la circunferencia.

Fig. AII-4 Circunferencia, lugar geométrico de la articulación de la manivela.

220

Page 241: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

AII.2.1 - Longitudes de los eslabones

De la figura (AII-4) se obtiene que la longitud de la cuerda será:

'22 = 2 x 0.5 sin 22.5º = 0.38268 m. (AII-91)

El radio de la circunferencia lugar geométrico del punto "A" centro de giro de la manivela será:

55945.0º20sin2

'22sin2

'22 ==α

(AII-92) R =

El ángulo bajo el que se verá la cuerda " 2A " será:

R22Asin.arc=β (AII-93)

Tomando el triángulo A2’C se obtendrá la distancia " '2A " como:

'2A = 2Rsin2

40 β+ (AII-94)

Como " 2A " es "L3 – L2" y " '2A " es "L3 + L2", resultará:

L2 = 2

2A'2A − (AII-95)

L3 = '2A - L2 (AII-96)

La longitud del eslabón fijo "L1" = " AB " se determinará como lado

del triángulo A2B.

L1 = )2/5.290·cos(BA·25.02A 22 β−+−+ (AII-97)

Con las ecuaciones anteriores se pueden calcular las longitudes de los eslabones fijo, manivela y acoplador para una longitud de 0.5 m. del eslabón seguidor, una relación de tiempos de 1.25, un ángulo de oscilación del eslabón seguidor de 45º y una determina distancia " 2A ".

221

Page 242: Tesis

Anexo II

Partiendo de una distancia mínima entre los puntos "A" y "2" de 0.2 metros para evitar interferencias de la manivela con eslabón seguidor y aumentando esta distancia en incrementos de 0.008 metros, se obtiene la relación de posibles longitudes de los eslabones siguiente:

Longitud del eslabón fijo "L1"

Longitud de la manivela "L2"

Longitud del eslabón acoplador "L3"

1 0.5134 0.1817 0.3897 2 0.514 0.1812 0.3972 3 0.5147 0.1807 0.4047 4 0.5154 0.1802 0.4122 5 0.5161 0.1797 0.4197 6 0.5169 0.1791 0.4271 7 0.5176 0.1785

0.178 9 0.5191 0.1774 0.4494 10 0.5198 0.1768 0.4568 11 0.5206 0.1762 0.4642 12 0.5214 0.1756 0.4716 13 0.5222 0.175 0.479 14 0.523 0.4863 0.1743 15 0.5238 0.1737 0.4937 16 0.5246 0.173 0.501 17 0.5254 0.1724 0.5084 18 0.5263 0.1717 0.5157 19 0.5271 0.171 0.523 20 0.528 0.1703 0.5303 21 0.5288 0.1696 0.5376 22 0.5297 0.1689 0.5449 23 0.5306 0.1681 0.5521 24 0.5315 0.1674 0.5594

0.1666 0.5666 26 0.5333 0.1659 0.5739 27 0.5342 0.1651 0.5811 28 0.5351 0.1643 0.5883 29 0.5361 0.1635 0.5955 30 0.537 0.1627 0.6027 31 0.538 0.1618 0.6098 32 0.5389 0.161 0.617 33 0.5399 0.1601 0.6241 34 0.5409 0.1593 0.6313 35 0.5418 0.1584 0.6384 36 0.5428 0.1575 0.6455

0.4345 8 0.5183 0.442

25 0.5324

222

Page 243: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

37 0.5438 0.1566 0.6526 38 0.5448 0.1556 0.6596 39 0.5458 0.1547 0.6667 40 0. 5469 0.1537 0.6737 41 0.5479 0.1528 0.6808 42 0.5489 0.1518 0.6878 43 0.5499 0.1508 0.6948 44 0.551 0.1498 0.7018 45 0.552 0.1488 0.7088 46 0.5531 0.1477 0.7157 47 0.5541 0.1467 0.7227 48 0.5552 0.1456 0.7296 49 0.5563 0.1445 0.7365 50 0.5574 0.1434 0.7434 51 0.5584 0.1423 0.7503 52 0.5595 0.1412 0.7572 63 0.5606 0.14 0.764 54 0.5617 0.1388 0.7708 55 0.5628 0.1377 0.7777 56 0.5639 0.1364 0.7844 57 0.565 0.1352 0.7912 58 0.5662 0.134 0.798 59 0.5673 0.1327 0.8047 60 0.5684 0.1314 0.8114 61 0.5695 0.1301 0.8181 62 0.5707 0.1288 0.8248 63 0.5718 0.1275 0.8315 64 0.5729 0.1261 0.8381

0.1248 0.8448 66 0.5752 0.1233 0.8513 67 0.5764 0.1219 0.8579 68 0.5775 0.1205 0.8645 69 0.5787 0.119 0.871 70 0.5798 0.1175 0.8775 71 0.581 0.116 0.884 72 0.5821 0.1144 0.8904 73 0.5833 0.1129 0.8969 74 0.5845 0.1113 0.9033 75 0.5856 0.1097 0.9097 76 0.5868 0.108 0.916 77 0.5879 0.1063 0.9223 78 0.5891 0.1046 0.9286 79 0.5903 0.1028 0.9348 80 0.5914 0.1011 0.9411

65 0.5741

223

Page 244: Tesis

Anexo II

81 0.5926 0.0993 0.9473 82 0.5937 0.0974 0.9534 83 0.5949 0.0955 0.9595 84 0.5961 0.0936 0.9656 85 0.5972 0.0916 0.9716 86 0.5984 0.0896 0.9776 87 0.5995 0.0876 0.9836 88 0.6006 0.0855 0.9895 89 0.6018 0.0834 0.9954 90 0.6029 0.0812 1.0012 91 0.604 0.0789 1.0069 92 0.6052 0.0766 1.0126 93 0.6063 0.0743 1.0183 94 0.6074 0.0718 1.0238 95 0.6085 0.0693 1.0293 96 0.6095 0.0668 1.0348 97 0.6106 0.0641 1.0401 98 0.6117 0.0614 1.0454 99 0.6127 0.0586 1.0506

100 0.6137 0.0557 1.0557

Tabla AII-1 Relación de posibles longitudes de los eslabones del cuadrilátero.

AII.2.2 - Simulación dinámica

Una vez determinada en la tabla (AII-1) una serie de valores de longitudes de los eslabones que cumplen las condiciones propuestas para el problema, longitud del eslabón seguidor, ángulo de oscilación y relación de tiempos entre carrera de ida y retorno, se tratará de determinar la combinación de longitudes que hagan que el par máximo durante una revolución, sea mínimo.

Para una determinada combinación de longitudes de eslabones, por

medio del programa "SENCUADRIL" realizado en MATLAB se hará una simulación dinámica hasta calcular el par máximo durante un giro completo de la manivela. En esa posición del mecanismo, se calculará la sensibilidad del par respecto de las longitudes del eslabón fijo "L1", de la manivela "L2" y del eslabón acoplador "L3". Como al variar la longitud de un eslabón, las de los otros dos vendrán impuestas, se calculará la sensibilidad del par al cambiar de una combinación de longitudes a la siguiente de la tabla (AII-1), sumando los productos de la sensibilidad del par respecto de cada longitud por su respectivo incremento, obteniéndose la sensibilidad total.

224

Page 245: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

Partiendo de una fila cualquiera de la tabla, se realizará una simulación dinámica, calculando el par máximo y la sensibilidad total del par en esa posición del mecanismo. Según sea el signo de la sensibilidad, se tomará otra combinación de valores de longitudes de eslabones en el sentido, indicado por la sensibilidad, que haga disminuir el par. Así sucesivamente, se irán realizando simulaciones dinámicas, con nuevas longitudes de eslabones, hasta conseguir una serie de longitudes con las que la sensibilidad total del par máximo respecto de la variación de las longitudes de los eslabones sea cero, momento en el que se habrá obtenido el objetivo de que el par máximo durante una revolución de la manivela, sea mínimo. AII.2.3 - Resultados

Llevando a cabo el proceso descrito, para los datos de este ejemplo, se ha llegado a una solución en que la sensibilidad del par se hace cero para la combinación de longitudes correspondiente a la fila 70 de tabla (AII-1), y que son los siguientes:

L1 = 0.5798 m. L2 = 0.1175 m. L3 = 0.8775 m.

siendo el par máximo:

M = -135.83 Nm.

Por otro lado, realizando una comprobación exhaustiva del par máximo para todas las combinaciones de longitudes de la tabla (AII-1), se llega a determinar que el mínimo par máximo se produce para la combinación de longitudes correspondientes a la fila 56, y que son:

L1 = 0.5639 m. L2 = 0.1364 m. L3 = 0.7844 m.

siendo el par máximo:

M = -133.68 Nm.

225

Page 246: Tesis

Anexo II

AII.2.4 - Diagramas del par motor

En la figura (AII-5), se puede ver el diagrama del par motor a lo largo de una revolución de la manivela para un cuadrilátero articulado sin optimizar; por ejemplo para las longitudes de los eslabones correspondientes a la fila 1 de la tabla (AII-1).

Fig. AII-5 Diagrama del par motor durante una revolución de la manivela con la combinación de longitudes de eslabones correspondientes a la fila 1 de la tabla

(AII-1).

Fig. AII-6 Diagrama del par motor durante una revolución de la manivela con la combinación de longitudes de eslabones que hacen que el par máximo sea

mínimo.

226

Page 247: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

En la figura (AII-6) se representa el diagrama del par motor para el mecanismo optimizado. Se puede observar, que el par motor máximo ha pasado de –181.54 Nm. a –133.68 Nm, para unas longitudes de los eslabones correspondientes a la fila 56 de la tabla (AII-1).

AII.3 - CONCLUSIONES

En este anexo se ha realizado una optimización paso a paso de las dimensiones de un cuadrilátero articulado, por el método de las sensibilidades, para conseguir que el par motor máximo sea mínimo y se ha comprobado el par máximo para una serie de longitudes de eslabones propuesta.

Como se puede apreciar en los resultados, existe una pequeña

diferencia en las longitudes de los eslabones correspondientes al mecanismo que precisa mínimo par máximo según sea el método utilizado. No obstante, cabe resaltar que la diferencia del par entre estas dos combinaciones de longitudes es realmente pequeña, (1.6 %), y puede provenir de que el par máximo para cada combinación de longitudes se obtiene por medio de una simulación dinámica que puede ir acumulando pequeños errores.

227

Page 248: Tesis

Anexo II

228

Page 249: Tesis

REFERENCIAS

Page 250: Tesis

Referencias

230

Page 251: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

REFERENCIAS

[AIT. 93] Ait-Ahmed M. Contribution à la Modélisation Géométrique et Dynamique des Robots Parallèles.

Singularity Analysis of Platform-Type Multi-Loop Spatial Mechanisms.

High-Precision, High-Speed Insertion With a 6 d-o-f Parallel Robot.

Thesis Doctoral en L’Université Paul Sabatier de Toulouse, 1993.

[ALI. 85] Alizade R. I. and Sandor G. N. Determination of the Condition of Existence of Complete Crank Rotation and of the Instantaneous Efficiency of Spatial Four-Bar Mechanisms. Mechanisms and Machine Theory, Vol. 20, Nº. 3, pp. 155-163, Pergamos Press, 1985.

[BAS. 95] Basu D. and Ghosal A.

Mechanisms and Machine Theory, Vol. 32, Nº. 3, pp. 375-389, Pergamos Press, 1997.

[BAU. 72] Baumgarte J.

Stabilization of Constraints and Integral of Motion in Dynamical Systems. Computer Methods in Applied Mechanics and Engineering, Vol. 1, pp. 1-16, 1972.

[BEG. 93] Begon P., Pierrot F. and Dauchez P.

24th. Int. Symposium on Industrial Robots, pp. 145-152, 1993. [BEG. 95-1] Begon P., Pierrot F. and Dauchez P.

Insertions Rapides Avec un Robot Parallèle à Six Degrés de liberté. Revue d’Automatique et de Productique Appliquées, Vol. 8, Nº. 4, pp. 513-527, 1995.

231

Page 252: Tesis

Referencias

[BEG. 95-2] Begon P. Commande des Robots Parallèles Rapides, Application au Robot Hexa. Tesis Doctoral en la Université de Montpellier II, 1995.

[BEN. 96-1] Benea R. and Giordano M. Dynamical Simulation for a Parallel Manipulator Applied to the 6-RKS Structure. Int. Symposium on Industrial Robots, pp. 689-694, 1996.

[BEN. 96-2] Benea R.

Contribution à l’Étude des Robots Pleinement Parallèles de Type 6-R-RR-S. Tesis Doctoral en la Universidad de Savoia (Francia), 1996.

[BOT. 71] Bottema O. The Motion of the Skew Four-Bar. Jnl. Mechanisms, Vol. 6, pp. 69-79, Pergamon Press, 1971. [BUR. 79] Burton P. Kinematics and Dinamics of Planar Machinery. Prentice Hall, 1979. [CHA. 96] Chablat D. and Wenger P. Domaines d’Unicité pour les Robots Parallèles. Rapport Interne LAN-ECN nº : 96.13, Laboratoire

d’Automatique de Nantes, 1996. [CLA. 88] Clavel R. Delta, a Fast Robot With Parallel Geometry. Proc. of the 18th. Int. Symposium on Industrial Robots, pp.

91-100, IFS Publications, 1988. [CLA. 89] Clavel R. Une Nouvelle Structure de Manipulateur Parallèle pour la

Robotique Légère. APII, Robotique, Vol. 23, pp. 501-519, Gauthiers-Villars, 1989. [CLA. 91] Clavel R. Conception d’un Robot Parallèle Rapide à 4 Degrés de Liberté. Tesis Doctoral en la École Polytechnique Fédérale de Lausanne,

1991.

232

Page 253: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

[CLA. 94] Clavel R. Robots Parallèles. Techniques de l’Ingénieur, Traité Mesures et Contrôle,

R 7710-1, 1994 [COL. 94] Collins C. L. and Long G. L. Line Geometry and the Singularity Analysis of an In-Parallel

Hand Controller for Force-reflected Teleoperation. DE-Vol. 72, Robotics: Kinematics, Dynamics and Controls, pp.

361-369, ASME, 1994. [COL. 97-1] Collins C. L. and McCarthy J. M. The Quartic Singularity Surfaces of Planar Parallel

Manipulators. Proceedings of the 1997 IASTED International Conference on

Robotics and Manufacturing, 1997. [COL. 97-2] Collins C. L. and McCarthy J. M. The Singular Loci of Two Triangular Paralle Manipulators. Proceeding of the 8th. International Conference on Avanced

Robotics. 1998. [COL. 97-3] Collins C. L. and McCarthy J. M. The Quartic Singularity Surfaces of Planar Platforms in the

Clifford Algebra of the Projective Plane. Mechanisms and Machine Theory, Vol. 33, Nº. 7, pp. 931-944,

Pergamos Press, 1998. [DAF. 98] Dafaoui El-M., Amirat Y., Pontnau J. and François C. Analysis and Desing of a Six-DOF Parallel Manipulator,

Modeling, Singular Configurations, and Workspace. Transactions on Robotics and Automation, Vol. 14, Nº. 1,

IEEE, 1998. [DAS. 98-1] Dasgupta B. and Mruthyunjaya T.S. Singularity-Free path Planning for the Stewart Platform

Manipulator. Mechanisms and Machine Theory, Vol. 33, Nº. 6, pp. 711-725,

Pergamos Press, 1998.

233

Page 254: Tesis

Referencias

[DAS. 98-2] Dasgupta B. and Mruthyunjaya T.S. Force Redundancy in Parallel Manipulators: Theoretical and

Practical Issues. Mechanisms and Machine Theory, Vol. 33, Nº. 6, pp. 727-742,

Pergamos Press, 1998. [ERD. 91] Erdman A.G. and Sandor G.N. Mechanisms Desing Analysis and Syntesis. Prentice Hall, 1991 [FER. 95] Ferrand A. and Renaud M. Analyse des Points Morts d’Une Plate-Forme Dite de Stewart. Rapport LAAS Nº. 95020, Laboratoire d’Analyse et

d’Architecture des Systèmes, Toulouse, France, 1995. Mechanisms and Machine Theory, Vol. 33, Nº. 4, pp. 409-424, Pergamos Press, 1998.

[FIO. 94] Fioretti A. Implementation-Oriented Kinematic Analysis of a 6 D.O.F.

Parallel Robotic Platform. IFAC Robot Control, pp. 31-38, Capri, Italy, 1994. [FRE. 69] Freudenstein F. and Kiss I. S. Type Determination of Skew Four-Bar Mechanisms. Journal of Engineering for Industry, Vol. 91, pp. 220-224,

Asme 1969. [FRE. 76] Freudenstein F. and Primrose E. J. F.

On the Criteria for the Rotatability of the Cranks of a Skew Four-Bar Linkage. Journal of Engineering for Industry, Vol. 98B, pp. 1285-1288, Asme 1976.

[FUN. 91] Funabashi H., Horie M., Kubota T. and Takeda Y. Development of Spatial Parallel Manipulators With Six

Degrees of Freedom. JSME International Journal, Series III, Vol. 34, Nº. 3, pp. 382-

387, 1991.

234

Page 255: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

[FUN. 95] Funabashi H. and Takeda Y. Determination of Singular Points and Their Vicinity in Parallel Manipulators Based on the Transmission Index. World Congress on the Theory of Machines and Mechanisms. pp. 1977-1981, 1995.

[GAR. 94] García de Jalón J. y Bayo E. Kinematic and Dynamic Simulation of Multibody System. Springer-Verlag, 1994. [GIO. 95] Giordano M. and Benea r. On the Dynamics of a 6-RKS Fully-Parallel Robot Manipulator

Structure. World Congress on the Theory of Machines and Mechanisms.

pp. 1729-1733, 1995. [GOS. 90-1] Gosselin C. M. and Ángeles J. Singular Analysis of Closed-Loop Kinematic Chains. Transactions on Robotics and Automation, Vol.6, Nº. 3, pp.

281-290, IEEE, 1990. [GOS. 90-2] Gosselin C. M. Stiffness Mapping for Parallel Manipulators. Transactions on Robotics and Automation, Vol.6, Nº. 3, pp.

377-382, IEEE, 1990. [GOS. 95] Gosselin C. M. and Wang J. Singularity Loci of Planar Parallel Manipulators. World Congress on the Theory of Machines and Mechanisms,

pp. 1982-1986, 1995. [GOS. 97] Gosselin C. M. and Wang J. Singularity Loci of Planar Parallel Manipulators With Revolute

Actuators. Robotics and Autonomous Systems, Vol. 21, pp.377-398,

Elsevier Science, 1997. [GOU. 62] Goug V.E. and Whitehall S.G. Universal Tyre Test Machine. Intl. Automobile Technical Congress: Papers and Discussions,

Vol. 117, pp 117-131, 1962.

235

Page 256: Tesis

Referencias

[GRA. 1883] Grashof F. Theoretische Maschinenlehre: Theorie der Getriebe. pp. 111-118. Leipzig 1883. [GUP. 71] Gupta V. K. and Radcliffe C. W. Mobility Analysis of Plane and Spatial Mechanisms. Journal of Engineering for Industry, Vol. 93, pp. 125-130,

Asme 1971. [GUP. 83] Gupta V. K. and Kazerounian S. M. K.

Synthesis of Fully Rotatable R-S-S-R Linkages. Mechanisms and Machine Theory, Vol. 18, Nº. 3, pp. 199-205, Pergamos Press, 1983.

[HAO. 98] Hao F. and McCarthy J. M. Conditions for Line-Based Singularities in Spatial Platform

Manipulators. Journal of Robotics Systems, Vol. 15, Nº. 1, pp. 43-55, John

Wiley & Sons, 1998. [HAR. 64] Harrisberguer L. Mobility Analysis of a Three-Dimensional Four-Link

Mechanism. ASME. Paper 64-WA/MD-16, 1964. [HUN. 59] Hunt K. H. Mechanisms and Motion. The English Universities Press Ltd., Londres 1959. [HUN. 78/90] Hunt K. H. Kinematic Geometry of Mechanisms. Oxford University Press, New York 1978/1990. [HUN. 82] Hunt K. H.

Geometry of Robotic Devices. Mechanical Engineering Transactions, Vol. 7, Nº. 4, pp. 213-220, The Institution of Engineers, Australia, 1982.

[HUN. 83] Hunt K. H. Structural Kinematics of In-Parallel-Actuated Robot-Arms. Journal of Mechanisms, Transmissions, and Automation in

Desing, Vol. 105, Nº 4, pp. 705-712, Asme, 1983.

236

Page 257: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

[HUN. 87] Hunt K. H. Spetial Configurations of Robot-Arms Via Screw Theory. Robotica, Vol. 5, pp. 17-22, Cambridge University Press, 1987. [HUN. 91] Hunt K. H., Samuel A. E. and McAree P. R. Special Configurations of Multi-Finger Multi-Freedom

Grippers- A Kinematic Study. The International Journal of Robotics Research, Vol. 10, Nº. 2,

pp. 123-134, MIT, 1991. [INN. 92] Innocenti C. and Parenti-Castelli V. Singularity-Free Evolution From One Configuration to Another

in Serial and Fully-Parallel Manipulators. DE-Vol 45, Robotics, Spatial Mechanisms and Mechanical

Systems, pp. 553-560, ASME 1992. Journal of Mechanical Desing, Vol. 120, pp. 73-79, ASME,

1998. [JIM. 97] Jiménez J.M., Álvarez G., Cardenal J. and Cuadrado J. A Simple and General Method for Kinematic Synthesis of

Spatial Mechanisms. Mechanisms and Machine Theory, Vol. 32, Nº. 3, pp. 323-341, Pergamos Press, 1997.

[KOK. 88] Kokkinis T. and Stougton R. Optimal Parallel Actuation Linkage for 3 DOF Elbow

Manipulators. Trends and Developments in Mechanisms, Machines and

Robots, Vol. 15, Nº. 3, pp. 465-472, 1988. [KUM. 92] Kumar V. Characterization of Workspaces of Parallel Manipulators. Journal of Mechanical Desing, Vol. 114, pp. 368-375, ASME,

1992. [LEE. 93] Lee S. and Kim S. Kinematic Analysis of Generalized Parallel Manipulator

Systems. Proceedings of the 32nd Conference on Decision and Control,

pp. 1097-1102, IEEE, 1993.

237

Page 258: Tesis

Referencias

[LIU. 93] Liu K., Lewis F., Lebret G. and Taylor D. The Singularities and Dynamics of a Stewart Platform

Manipulator. Journal of Intelligent and Robotics System, Vol. 8, pp. 287-308,

Kluwer Academic Publishers, 1993. [LON. 97] Long G. L. Use of the Cylindroid for the Singularity Analysis of Rank 3

Robot Manipulators. Mechanisms and Machine Theory, Vol. 32, Nº. 3, pp. 391-404,

Pergamos Press, 1997. [MER. 87] Merlet J.P. Parallel Manipulators, Parte 1, theory. Technical Report 646, INRIA, Mars 1987. [MER. 88] Merlet J.P. Parallel Manipulators, Parte 2, Singular Configurations and

Grassmann Geometry. Technical Report 791, INRIA, Février 1988. [MER. 89-1] Merlet J.P. Manipulateurs Parallèles, 3eme Partie: Applications. Technical Report 1003, INRIA, Mars 1989. [MER. 89-2] Merlet J.P. Manipulateurs Parallèles, 4eme Partie, Mode d’Assemblage et

Cinématique directe sous Forme Polynomiale. Technical Report 1135, INRIA, Décembre 1989. [MER. 90] Merlet J.P. An Algorithm for the Forward Kinematics of General 6 D.O.F.

Parallel Manipulators. Technical Report 1331, INRIA, Novembre 1990. [MER. 92] Merlet J.P. Manipulateurs Parallèles, 5eme Partie: Détermination de

l’Espace de Travail à Orientation Constante. Technical Report 1645, INRIA, Mars 1992.

238

Page 259: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

[MER. 93-1] Merlet J.P. Manipulateurs Parallèles, 6eme partie: Détermination des

Espaces de Travail en Orientation. Technical Report 1921, INRIA, Mai 1993. [MER. 93-2] Merlet J.P. Manipulateurs Parallèles, 7eme partie: Vérification et

planification de trajectorie dans l’Espace de travail. Technical Report 1940, INRIA, Juin 1993. [MER. 94] Merlet J.P. and Mouly N. Espaces de Travail et Planification de Trajectorie des Robots

Parallèles Plans. Technical Report 2291, INRIA, Mai 1994. [MER. 95] Merlet J.P. Designing a Parallel Robot for a Specific Workspace. Technical Report 2527, INRIA, Avril 1995. [MER. 96] Merlet J.P. Some Algebraic Geometry Problems Arising in the Field of

Mechanism Theory. Progress in Mathematics, Vol. 143, pp. 271-283, Birkhäuser

Verlag Basel, 1996. [MER. 97] Merlet J.P. Estimation Efficace des Caractéristiques de Robots Parallèles:

Extremums des Raideurs et des Coordonnées, Vitesses, Forces Articulaires et Singularités dans un Espace de Travail en Translation.

Technical Report 3243, INRIA, Septembre 1997. [MER. 90/97] Merlet J.P. Les Robots Parallèles. Hermes, 1990 y 1997. [MOH. 95] Mohammadi Daniali H. R., Zsombor-Murray P. J. and

Ángeles J. Singularity Analysis of a General Class of Planar Parallel

Manipulators. International Conference on Robotics and Automation, pp.

1547-1552, IEEE, 1995.

239

Page 260: Tesis

Referencias

[MOU. 93] Mouly N. Développement d’une Famille de Robots Paralléles à

Motorisation Électrique. Tesis Doctoral en L’École des Mines de Paris, 1993. [NEN. 97-1] Nenchev D. N. and Uchiyama M. Singularity-Consistent Path Planing and Motion Control

Through Instanteneous Self-Motion Singularities of Parallel-Link Manipulators.

Journal of Robotic System, Vol. 14, Nº. 1, pp. 27-36, John Wiley & Sons, 1997.

[NEN. 97-2] Nenchev D. N., Bhattacharya S. and Uchiyama M. Dynamic Analysis of Parallel Manipulators Under the

Singularity-Consistent Parametrization. Robotica, Vol. 15, pp. 375-384, Cambridge University Press,

1997. [NEN. 98] Nenchev D. N. and Uchiyama M. Para-Arm: A Five-Bar Parallel Manipulator With Singularity-

Perturbed Desing. Mechanisms and Machine Theory, Vol. 33, Nº. 5, pp. 453-462,

Pergamos Press, 1998. [NIE. 78] Nieto J.

Síntesis de Mecanismos. Editorial AC, Madrid, 1978.

[NOM. 93] Nombrail N. Analyse et Commande d’une Famille de Robots Manipulateurs

à Structure Parallèle et Redondante. Tesis Doctoral en L’École Nationale Supérieure de

L’Aéronautique et de L’Espace, 1993. [NOT. 94] Notash l. and Podhorodeski R. P. Uncertainty Configurations of Three-Branch Parallel

Manipulators:Identification and Elimination. DE-Vol. 72, Robotics: Kinematics, Dynamics and Controls, pp.

459-466, ASME, 1994.

240

Page 261: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

[NOT. 98] Notash l. Uncertainty Configurations of Parallel Manipulators. Mechanisms and Machine Theory, Vol. 33, Nº. 1/2, pp. 123-

138, Pergamos Press, 1998. [PAS. 94] Pasqui-Boutard V. Méthodes Systématiques pour la Modélisation et l’Analyse

Cinématiques des Mécanismes Complexes. Tesis Doctoral en L’Université Pierre et Marie Curie. 1994. [PIE. 90] Pierrot F., Uchiyama M., Dauchez P. and Fourier A. A New Desing of a 6-DOF Parallel Robot. Journal of Robotics and Mechatronics, Vol. 2, Nº. 4, pp.308-

315, 1990. [PIE. 91-1] Pierrot F., Dauchez P. and Fourier A. Fast Parallel Robots. Journal of Robotics Systems, Vol. 8, Nº. 6, pp.829-840, Jonh

Wiley & Sons, 1991. [PIE. 91-2] Pierrot F., Dauchez P. and Fourier A. HEXA: A Fast Six-DOF Fully-Parallel Robot. International Conference on Advanced Robotics (ICAR), Vol.

2, pp.1158-1163, IEEE, 1991. [PIE. 91-3] Pierrot F., Fourier A. and Dauchez P. Towards a Fully-Parallel 6 DOF Robot for High-Speed

Applications. Proceeding of the International Conference on Robotics and

Automation, pp.1288-1293, IEEE, 1991. [PIE. 91-4] Pierrot F. Robots Pleinement Parallèles Légers: Conception,

Modélisation et Commande. Tesis Doctoral en la Université de Montpellier II, 1991. [PIE. 92-1] Pierrot F., Fraisse P., Delabarre X. and Dauchez P. Manipulations Robotiques à Haute Vitesse: Une Solution

Pleinement Parallèle. APII, Robotique Industrielle, Vol. 26, Nº. 1, pp. 3-14, Gauthier-

Villars, 1992.

241

Page 262: Tesis

Referencias

[PIE. 92-2] Pierrot F., Dauchez P. and Uchiyama M. Robots Parallèle. Du Laboratoire à l’Atelier. Revue d’Automatique et de Productique Appliquées, Vol. 5 Nº.

2, pp. 49-55, 1992. [PLI. 94] Plitea N., Benea R. and Giordano M. 6-RKS: An Architecture for a 6 d. o. f. Fully-Parallel Robot

Manipulator. Advances on Robots Kinematics, Proceedings of 4th. ARK

Conference, pp. 522-532, 1994. [RAS. 87-1] Rastegar J. and Deravi P. Methods to Determine Workspace, Its Subspaces With Different

Numbers of Configurations and All the Possible Configurations of a Manipulator. Mechanisms and Machine Theory, Vol. 22, Nº. 4, pp. 343-350, Pergamos Press, 1987.

[RAS. 87-2] Rastegar J. and Deravi P. The Efect of Joint Motion Constraints on the Workspace and

Number of Configurations of Manipulators. Mechanisms and Machine Theory, Vol. 22, Nº. 5, pp. 401-409, Pergamos Press, 1987.

[RAS. 88] Rastegar J. Workspace Analysis of 4R Manipulators With Various Degrees

of Dexterity. Journal of Mechanisms, Transmissions, and Automation in

Desing, Vol. 110, pp. 42-47, Asme, 1988. [RAS. 89] Rastegar J. On the Derivation of Grashof-Type Movability Conditions With

Transmission Angle Limitations for Spatial Mechanisms. Journal of Mechanisms, Transmissions, and Automation in

Desing, Vol. 111, pp. 519-523, Asme, 1989. [RAS. 92] Rastegar J. and Tu Q.

Approximated Grashof-Type Movability Conditions for RSSR Mechanisms With Force Transmission Limitatons. Journal of Mechanical Desing, Vol. 114, pp. 74-81, Asme 1992.

242

Page 263: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

[SAN. 84] Sandor G. N. and Zhuang X. On the Elimination of the Branching Problem in the Synthesis of Spatial Motion Generators With Spheric Joints. Part 1: Theory. Journal of Mechanisms, Transmissions, and Automation in Desing, Vol. 106, pp. 312-318, Asme, 1984.

[SEF. 93] Sefrioui J. and Gosselin C. M. Étude et Représentation des Lieux de Singularité des

Manipulateurs Paralléles Sphériques a Trois Degrés de Liberté Avec Actionneurs Prismatiques.

Mechanisms and Machine Theory, Vol. 29, Nº. 4, pp. 559-579, Pergamos Press, 1994.

[SEF. 95] Sefrioui J. and Gosselin C. M. On the Quadratic Nature of the Singularity Curves of Planar

Three-Degree-Freedom Parallel Manipulators. Mechanisms and Machine Theory, Vol. 30, Nº. 4, pp. 533-551,

Pergamos Press, 1995. [SHI. 80] Shigley J.E. and Uicker J.J. Theory of Machines and Mechanisms. McGraw-Hill, 1980. [SKR. 67] Skreiner M. Methods to Identify the Mobility Regions of a Spatial Four-link

Mechanism. Jnl. Mechanisms, Vol. 2, pp. 415-427, Pergamon Press, 1967. [SOY. 82] Söylemez E. and Freudenstein F.

Transmission Optimization of Spatial 4-Link Mechanisms. Mechanisms and Machine Theory, Vol. 17, Nº. 4, pp. 263-283, Pergamos Press, 1982.

[ST-O. 96] St-Onge B. M. and Gosselin C. M. Syngularity Analysis and Representation of Spatial Six-DOF

Parallel Manipulators. Recent Advances in Robot Kinematics, (5th Symposium ARK),

pp. 389-398, Kluwer Academic Publishers, 1996.

243

Page 264: Tesis

Referencias

[STA. 97] Stamper R.E. A Three Degree of Freedom Parallel Manipulator with Only

Translational Degree of Freedom. Thesis Doctoral en University of Maryland, 1997. [STE. 65] Stewart D. A Platform With Six Degrees of Freedom. Proc. Instn. Mech. Engrs. Vol. 180, Pt. 1, Nº. 15, pp. 371-386,

1965-66. [STI. 69] Sticher F. C. O. Mobility Limit Analysis of R-S-S-R Mechanisms by “Ellipse

Diagram”. Jnl. Mechanisms, Vol. 5, pp. 393-415, Pergamon Press, 1969. [SUG. 82] Sugimoto K., Duffy J. and Hunt K. H. Spetial Configurations of Spatial Mechanisms and Robot Arms.

Mechanisms and Machine Theory, Vol. 17, Nº. 2, pp. 119-132, Pergamos Press, 1982.

[TAD. 94] Tadokoro S Control of Parallel Mechanisms.

Advanced Robotics, Vol. 8, Nº. 6, pp. 559-571, VSP and Robotics Society of Japan, 1994.

[TAH. 93] Tahamasebi F. and Tsai L-W. Workspace and Singularity Analysis of a Novel Six-DOF

Parallel Minimanipulator. Technical Research Report, T. R. 93-55, Institute for Systems

Research, University of Mariland, 1993. [TAK. 95] Takeda Y. and Funabashi H. Motion Transmissibility of In-Parallel Actuated Manipulators. JSME International Journal, Series C, Vol. 38, Nº. 4, pp.749-

755, JSME, 1995. [TAK. 96] Takeda Y. and Funabashi H. Kinematics and Static Characteristics of In-Parallel Actuated

Manipulators at Singular Points and in Their Neighborhood. JSME International Journal, Series C, Vol. 39, Nº. 1, pp. 85-93,

JSME, 1996.

244

Page 265: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

[TAK. 97] Takeda Y., Funabashi H. and Ichimaru H. Development of Spatial In-Parallel Actuated Manipulators With

Six Degrees of Freedom With High Motion Transmissibility. JSME International Journal, Series C, Vol. 40, Nº. 2, pp. 299-

308, JSME, 1997. [TIN. 84] Tinubu S. O. and Gupta K. C.

Optimal Syntesis of Function Generators Without the Branch Defect. Journal of Mechanisms, Transmissions, and Automation in Desing, Vol. 106, pp. 348-354, Asme, 1984.

[TOY. 93] Toyama O., Uchiyama M. and Pierrot F. Parallel Robot. Patente Nº. 5333514, 1994. [UCH. 79] Uchiyama M. A Study of Computer Control of Motion of a Mechanical Arm

(1st. Report, Calculation of Coordinative Motion Considering Singular Points).

Bulletin of de JSME, Vol. 22, Nº. 173, pp. 1640-1647, 1979. [UCH. 92] Uchiyama M., Iimura K., Pierrot F., Dauchez P., Unno K.

and Toyama O. A New Desing of a Very Fast 6-DOF Parallel Robot. 23rd. Int. Symposium of Industrial Robots, pp. 771-776, 1992. [UCH. 94] Uchiyama M. Structures and Characteristics of Parallel Manipulators. Advances Robotics, Vol. 8, Nº. 6, pp. 545-557, VSP and

Robotics Society of Japan, 1994. [VIS. 95] Vischer P. Argos: A Novel Parallel Spherical Structure. Technical Report Nº. 95-03, École Polytechnique Fédérale de

Lausanne, 1995. [WAN.J. 97] Wang J. Gosselin C. M. Kinematic Analysis and Singularity Representation of Spatial

Five-Degree-of-Freedom Parallel Mechanisms. Journal of Robotic System, Vol. 14, Nº. 12, pp. 851-869, John

Wiley & Sons, 1997.

245

Page 266: Tesis

Referencias

[WAN.S. 94] Wang S. L. Singularity and Duality of Parallel Robots. DE-Vol. 72, Robotics: Kinematics, Dynamics and Control, pp.

451-458, ASME, 1994. [WIL. 87] Willians II R. L. and Reinholtz C. F.

Mechanism Link Rotatability and Limit Position Analysis Using Polynomial Discriminants. Journal of Mechanisms, Transmissions, and Automation in Desing, Vol. 109, pp. 178-182, Asme, 1987.

[ZAB. 99] Zabalza I., Pintor J. M., Ros J. and Jiménez J.M.

Evaluation of the 64 "Insensitivity" Positions for a 6-RKS Hunt-Type Parallel Manipulator. Tenth World Congres on the Theory of Machine and Mechanisms, pp. 1152-1157, Oulu, Finland, June 20-24, 1999.

[ZAN. 97] Zanganeh K. E., Sinatra R. and Angeles J.

Kinematics and Dynamics of a Six-Degree-of-Freedom Parallel Manipulator With Revolute Legs. Robotica, Vol. 15, pp. 385-394, Cambridge University Press, 1997.

[ZLA. 94-1] Zlatanov D., Fenton R. G. and Benhabib B.

Singularity Analysis of Mechanisms and Robots Via a Velocity-Ecuation Model of the Instantaneous Kinematics. Int. Conf. on Robotics and Automatión, Vol. 2, pp. 986-991, IEEE, 1994.

[ZLA. 94-2] Zlatanov D., Fenton R. G. and Benhabib B. Singularity Analysis of Mechanisms and Robots Via a Motion-Space Model of the Instantaneous Kinematics. Int. Conf. on Robotics and Automatión, Vol. 2, pp. 980-985, IEEE, 1994.

[ZLA. 94-3] Zlatanov D., Fenton R. G. and Benhabib B. Analysis of the Instantaneous Kinematics and Singular Configurations of Hibrid-Chain Manipulators. DE-Vol. 72, Robotics: Kinematics, Dynamics and Controls, pp. 467-476, ASME, 1994.

246

Page 267: Tesis

Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS

[ZLA. 95-1] Zlatanov D., Fenton R. G. and Benhabib B. Identification and Classification of the Singular Configurations of Mechanisms. Computational Kinematics, pp. 163-172, Kluwer Academic Publishers, 1995.

[ZLA. 95-2] Zlatanov D., Fenton R. G. and Benhabib B.

A Unifying Framework for Classification and Interpretation of Mechanisms Singularities. Journal of Mechanical Desing, Vol. 117, pp. 566-572, ASME, 1995.

[ZLA. 98] Zlatanov D., Fenton R. G. and Benhabib B.

Identification and Classification of the Singular Configurations of Mechanisms. Mechanisms and Machine Theory, Vol. 33, Nº. 6, pp. 743-760, Pergamos Press, 1998.

[ZSO. 95] Zsombor-Murray P., Husty M. and Hartmann D.

Singular Stewart-Gough Platforms With Spherocycindrical and Spheroconical Hip Jiunt Trajectories. 9th. World Congress on the Theory of Machines and Mechanisms, pp. 1886-1890, 1995.

247