Академический Документы
Профессиональный Документы
Культура Документы
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
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.
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.
ii
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
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
Índice
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
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
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
CONCLUSIONES GENERALES
v
Índice
REFERENCIAS
Referencias..................................................................................................... 231
vi
NOMENCLATURA
Nomenclatura
viii
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.
M b ......... Sensibilidad de la matriz de masas respecto de las variables de
diseño.
PI............ Posición de insensitividad.
Q............ Vector de fuerzas exteriores.
ix
Nomenclatura
x
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
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
Nomenclatura
xii
CAPÍTULO I
INTRODUCCIÓN
Introducción
2
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
CAPÍTULO I - INTRODUCCIÓN
I.1 – INTRODUCCIÓN
3
Introducción
4
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
5
Introducción
6
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
7
Introducción
- 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.
8
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
9
Introducción
10
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.
11
Introducción
12
CAPÍTULO II
SÍNTESIS DE MECANISMOS
Síntesis de Mecanismos
14
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
- Síntesis dimensional
15
Síntesis de Mecanismos
- Síntesis de Chebyshev
- Síntesis cinemáticas
16
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
- Síntesis exactas
- Síntesis aproximadas
- Síntesis óptima
- Optimización dinámica
17
Síntesis de Mecanismos
18
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
- Estructural.
- De puntos de precisión.
- Dinámica óptima.
19
Síntesis de Mecanismos
20
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
21
Síntesis de Mecanismos
22
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
23
Síntesis de Mecanismos
de que las coordenadas del punto “3“ deben ser las coordenadas de los puntos
“P“ que se desean conseguir.
24
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
25
Síntesis de Mecanismos
Φ(q, b, t) = 0 (II-10)
Φ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.
Φq &q& + Φ
& q q& Φ
&t=0 (II-12)
26
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
M &q& + Φ Tq λ = Q (II-13)
M Φ Tq &q& Q
· = (II-14)
Φ q 0 λ − Φq q − Φ t
& & &
27
Síntesis de Mecanismos
Φ(q, t) = 0
Φq q& + Φt = 0
Φq q&& + Φ &t=0
& q q& + Φ
Φ=0 (II-15)
Φ& =0 (II-16)
&& = 0
Φ (II-17)
&& + 2 α Φ
Φ & + β2 Φ = 0 (II-18)
28
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
M Φ Tq &q& Q
· = (II-19)
Φ q 0 λ g
- siendo:
g=- Φ & t − 2α(Φ q q& + Φ t ) − β2 Φ
& q q& − Φ (II-20)
Φqqb + Φb = 0 (II-21)
29
Síntesis de Mecanismos
M Φ Tq &q&b Q
· = (II-25)
Φ q 0 λ b g
30
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
donde:
g = - Φqqqb &&
q - Φqb &&
q - Φ& qq qb q& - Φ& qb q& - Φ& q q& b - Φ& tq qb - Φtb (II-27)
II.4 CONCLUSIONES
31
Síntesis de Mecanismos
32
CAPÍTULO III
MANIPULADORES PARALELOS
Manipuladores Paralelos
34
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
III.1 – INTRODUCCIÓN
35
Manipuladores Paralelos
36
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
37
Manipuladores Paralelos
38
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
39
Manipuladores Paralelos
40
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
Sobre este tipo de robots aparte del diseño realizado por Hunt
[HUN. 83] se han realizado algunos estudios, conociéndose los realizados por:
41
Manipuladores Paralelos
42
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
43
Manipuladores Paralelos
44
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
45
Manipuladores Paralelos
46
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
47
Manipuladores Paralelos
III.3 – CONCLUSIONES
48
CAPÍTULO IV
CONFIGURACIONES DE
INSENSITIVIDAD
Configuraciones de Insensitividad.
50
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
CAPÍTULO IV - CONFIGURACIONES DE
INSENSITIVIDAD
IV.1 – INTRODUCCIÓN
51
Configuraciones de Insensitividad.
52
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
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.
53
Configuraciones de Insensitividad.
54
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
55
Configuraciones de Insensitividad.
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
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.
57
Configuraciones de Insensitividad.
58
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
59
Configuraciones de Insensitividad.
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
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
61
Configuraciones de Insensitividad.
62
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
63
Configuraciones de Insensitividad.
64
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
65
Configuraciones de Insensitividad.
66
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
67
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:
(IV-22)
68
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
(IV-23)
(IV-24)
(IV-25)
(IV-26)
(IV-27)
Φ(q) = 0 (IV-28)
69
Configuraciones de Insensitividad.
70
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
X 123 − X 145 Y123 − Y145 Z123 − Z145 X 145 − X123 Y145 − Y123 Z145 − Z123 0 0 0 &
Y
161
0 0 0 & 161
X145 − X161 Y145 − Y 161 Z145 − Z161 X 161 − X 145 Y161 − Y145 Z161 − Z145 Z
71
Configuraciones de Insensitividad.
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.
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
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
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)
73
Configuraciones de Insensitividad.
74
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
− (Z16 − Z 06 )(
· X161 − X 16 ) − 3 (Z16 − Z 06 )(
· Y161 − Y16 ) +
(IV-58)
3 (Y16 − Y06 )(
· Z161 − Z16 ) + (X 16 − X 06 )(
· Z161 − Z16 ) = 0
IV.4.1.2 - Solución
75
Configuraciones de Insensitividad.
76
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
77
Configuraciones de Insensitividad.
78
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
79
Configuraciones de Insensitividad.
80
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
81
Configuraciones de Insensitividad.
82
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
83
Configuraciones de Insensitividad.
84
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
85
Configuraciones de Insensitividad.
86
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
87
Configuraciones de Insensitividad.
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)
88
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
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
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)
89
Configuraciones de Insensitividad.
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
IV.5 - CONCLUSIONES
90
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
91
Configuraciones de Insensitividad.
92
CAPÍTULO V
SÍNTESIS DE UN MANIPULADOR
6-RKS
Síntesis de un Manipulador 6-RKS
94
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
95
Síntesis de un Manipulador 6-RKS
96
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
97
Síntesis de un Manipulador 6-RKS
98
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
99
Síntesis de un Manipulador 6-RKS
100
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
101
Síntesis de un Manipulador 6-RKS
102
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
103
Síntesis de un Manipulador 6-RKS
104
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
105
Síntesis de un Manipulador 6-RKS
106
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
107
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).
108
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
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)
R1 = R2 = R3 = R4 = R5 = R6 = 0.1 metros.
L1 = L2 = L3 = L4 = L5 = L6 = 0.6 metros
109
Síntesis de un Manipulador 6-RKS
110
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
111
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:
− (Z13 A − Z 03 )(
· X123A − X 13A ) − 3 (Z13 A − Z 03 )(
· Y123A − Y13A ) +
(V-63)
3 (Y13A − Y03 )(
· Z123A − Z13A ) + (X 13A − X 03 )·(Z123A − Z13A ) = 0
− (Z14 A − Z 04 )(
· X 145A − X 14 A ) − 3 (Z14 A − Z 04 )(
· Y145 A − Y14 A ) +
(V-64)
3 (Y14 A − Y04 )·(Z145A − Z14 A ) + (X 14 A − X 04 )·(Z145A − Z14 A ) = 0
− (Z15 A − Z 05 )(
· X145A − X 15 A ) − 3 (Z15 A − Z 05 )(
· Y145A − Y15A ) +
(V-65)
3 (Y15 A − Y05 )(
· Z145A − Z15 A ) + (X 15 A − X 05 )·(Z145A − Z15 A ) = 0
− (Z16 A − Z 06 )(
· X 161A − X 16 A ) − 3 (Z16 A − Z 06 )(
· Y161A − Y16 A ) +
(V-66)
3 (Y16 A − Y06 )(
· Z161A − Z16 A ) + (X16 A − X 06 )(
· Z161A − Z16 A ) = 0
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:
− (Z14 B − Z 04 )(
· X145 B − X 14 B ) − 3 (Z14 B − Z 04 )·(Y145B − Y14 B ) +
(V-70)
3 (Y14 B − Y04 )(
· Z145 B − Z14 B ) + (X14 B − X 04 )(
· Z145 B − Z14 B ) = 0
112
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
− (Z16 B − Z 06 )(
· X 161B − X 16 B ) − 3 (Z16 B − Z 06 )(
· Y161B − Y16 B ) +
(V-72)
3 (Y16 B − Y06 )(
· Z161B − Z16 B ) + (X 16 B − X 06 )·(Z161B − Z16 B ) = 0
113
Síntesis de un Manipulador 6-RKS
V.3.4 – Soluciones
114
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
115
Síntesis de un Manipulador 6-RKS
116
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
117
Síntesis de un Manipulador 6-RKS
118
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
119
Síntesis de un Manipulador 6-RKS
120
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
121
Síntesis de un Manipulador 6-RKS
Longitudes de manivelas:
R1 = 0.0537 metros.
R2 = 0.0536 "
R3 = 0.0528 "
R4 = 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
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
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.
123
Síntesis de un Manipulador 6-RKS
124
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
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)
R1 = R2 = R3 = R4 = R5 = R6 = 0.1 metros.
L1 = L2 = L3 = L4 = L5 = L6 = 0.6 metros
125
Síntesis de un Manipulador 6-RKS
126
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
127
Síntesis de un Manipulador 6-RKS
128
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
− (Z13 A − Z 03 )(
· X123A − X 13A ) − 3 (Z13 A − Z 03 )(
· Y123A − Y13A ) +
(V-129)
3 (Y13A − Y03 )(
· Z123A − Z13A ) + (X 13A − X 03 )·(Z123A − Z13A ) = 0
− (Z14 A − Z 04 )(
· X 145A − X 14 A ) − 3 (Z14 A − Z 04 )(
· Y145 A − Y14 A ) +
(V-130)
3 (Y14 A − Y04 )·(Z145A − Z14 A ) + (X 14 A − X 04 )·(Z145A − Z14 A ) = 0
− (Z15 A − Z 05 )(
· X145A − X 15 A ) − 3 (Z15 A − Z 05 )(
· Y145A − Y15A ) +
(V-131)
3 (Y15 A − Y05 )(
· Z145A − Z15 A ) + (X 15 A − X 05 )·(Z145A − Z15 A ) = 0
− (Z16 A − Z 06 )(
· X 161A − X 16 A ) − 3 (Z16 A − Z 06 )(
· Y161A − Y16 A ) +
(V-132)
3 (Y16 A − Y06 )(
· Z161A − Z16 A ) + (X16 A − X 06 )(
· Z161A − Z16 A ) = 0
− (Z14 B − Z 04 )(
· X145 B − X 14 B ) − 3 (Z14 B − Z 04 )·(Y145B − Y14 B ) +
(V-136)
3 (Y14 B − Y04 )(
· Z145 B − Z14 B ) + (X14 B − X 04 )(
· Z145 B − Z14 B ) = 0
129
Síntesis de un Manipulador 6-RKS
− (Z16 B − Z 06 )(
· X 161B − X 16 B ) − 3 (Z16 B − Z 06 )(
· Y161B − Y16 B ) +
(V-138)
3 (Y16 B − Y06 )(
· Z161B − Z16 B ) + (X 16 B − X 06 )·(Z161B − Z16 B ) = 0
− (Z14 C − Z 04 )(
· X145C − X 14C ) − 3 (Z14C − Z 04 )·(Y145C − Y14 C ) +
(V-142)
3 (Y14 C − Y04 )(
· Z145C − Z14C ) + (X14 C − X 04 )(
· Z145C − Z14C ) = 0
− (Z16 C − Z 06 )(
· X161C − X 16C ) − 3 (Z16C − Z 06 )(
· Y161C − Y16 A ) +
(V-144)
3 (Y16 C − Y06 )(
· Z161C − Z16 C ) + (X 16C − X 06 )(
· Z161C − Z16 C ) = 0
130
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
V.4.4 – Soluciones
131
Síntesis de un Manipulador 6-RKS
V.5 - CONCLUSIONES
132
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
133
Síntesis de un Manipulador 6-RKS
134
CAPÍTULO VI
136
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
VI.1 - INTRODUCCIÓN
137
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.
138
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
3
R1 < (L-2E1) (VI-1)
6
3
R2 < (L-2E2) (VI-2)
6
3
R3 < (L-2E3) (VI-3)
6
3
R4 < (L-2E4) (VI-4)
6
3
R5 < (L-2E5) (VI-5)
6
3
R6 < (L-2E6) (VI-6)
6
R1 < L1 (VI-7)
R2 < L2 (VI-8)
R3 < L3 (VI-9)
R4 < L4 (VI-10)
R5 < L5 (VI-11)
R6 < L6 (VI-12)
139
Comprobación del giro de manivelas
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".
140
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
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.
141
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:
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á:
δ D2
= 2 (X03 – 1/2 R3 cos θ3 - X02 - R2 cos θ2) R2 sin θ2 –
δθ2
- 2 (Z03 + R3 sin θ3 - Z02 - R2 sin θ2) R2 cos θ2 = 0 (VI-20)
Simplificando
142
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 =
Z03 + R 3 sin θ3 − Z02 − R 2 sin θ2 Z − Z12
= 13 (VI-22)
X03 − 1 / 2 R 3 cos θ3 − X02 − R 2 cos θ2 X13 − X12
Fig. VI-5 Distancias mínima y máxima entre los puntos "12" y "13" para un
determinado punto "13"
143
Comprobación del giro de manivelas
δ D2
= 2 (X03 – 1/2 R3 cos θ3 - X02 - R2 cos θ2) 1/2 R3 sin θ3 +
δθ3
+ 2 (Y03 – 3 /2 R3 cos θ3 - Y02) 3 /2 R3 sin θ3 +
Simplificando
(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 =
Z12 − Z13 (VI-26)
1 / 2(X13 − X12) + 3 / 2(Y13 − Y12)
144
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"
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
Comprobación del giro de manivelas
-
Fig. 43 Distancias máxima, mínima y distancias extremas intermedias.
146
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
2 2
Dmax = ( X03 − X02 + R 2 + 1 / 2 R 3) + (Y03 − Y02 + 3 / 2 R 3) (VI-27)
2 2
Dmin = ( X03 − X02 − R 2 − 1 / 2 R 3) + ( Y03 − Y02 + 3 / 2 R 3) (VI-28)
2 2
Dm1 = ( X03 − X02 − R 2 + 1 / 2 R 3) + (Y 03 − Y02 + 3 / 2 R 3) (VI-29)
2 2
Dm2 = ( X03 − X02 + R 2 − 1 / 2 R 3) + (Y 03 − Y02 − 3 / 2 R 3) (VI-30)
147
Comprobación del giro de manivelas
Fig. VI-9 Distancias máxima y mínima entre los puntos “14“ y “15“
siendo:
2 2
Dmax = (X 05 − X 04 + 1 / 2 R 5 − 1 / 2 R 4) + (Y05 − Y04 − 3 / 2 R 5 − 3 / 2 R 4 ) (VI-31)
2 2
Dmin = (X 05 − X 04 − 1 / 2 R 5 + 1 / 2 R 4) + (Y05 − Y04 + 3 / 2 R 5 + 3 / 2 R 4) (VI-32)
148
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
Fig. VI-10 Distancias máxima y mínima entre los puntos "11" y "16"
- 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".
- L1 − L 6 < 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".
- L1 − L 6 < Dmin entre los puntos "11" y "16".
siendo:
2 2
Dmax = ( X06 − X01 + R1 + 1 / 2 R 6) + ( Y06 − Y01 − 3 / 2 R 6) (VI-33)
2 2
Dmin = ( X06 − X01 − R1 − 1 / 2 R 6) + (Y 06 − Y01 + 3 / 2 R 6) (VI-34)
149
Comprobación del giro de manivelas
- La suma de las longitudes de las dos bielas sea mayor que la distancia
máxima entre los puntos extremos de las manivelas.
150
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
151
Comprobación del giro de manivelas
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
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
X123 = X12 ± L2 + 2 Y123 Y12 + 2 Z123 Z12 − Y12 − Z12 − Y123 − Z123
2 2 2 2 2
(VI-37)
2 2 2
(( Y12 − Y13)a − 2 Y12 (X12 − X13) ) − ((X12 − X13) + (Y12 − Y13) )(a + 4b)
2 2
2 2
(VI-38)
2((Y12 − Y13) + (X12 − X13) )
siendo:
a = L 22 + X12
2
− Y12
2
− Z12
2
+ X13
2
+ Y13
2
+ Z13
2
− L32 + 2 Z123 Z12 − 2 Z123 Z13 − 2 X13 X12 (VI-39)
2
b = ( X 12 − X13) ·(Y12
2
+ Z12
2
+ Z123 − L 22 − 2 Z123 Z12) (VI-40)
153
Comprobación del giro de manivelas
2 2 2
(( X12 − X13)c − 2 X12 (Y12 − Y13)2) − ((Y12 − Y13) + (X12 − X13) )(c 2 + 4d)
2 2
(VI-42)
2((Y12 − Y13) + (X12 − X13) )
siendo:
c = L 22 + Y12
2
− X12
2
− Z12
2
+ X13
2
+ Y13
2
+ Z13
2
− L32 + 2 Z123 Z12 − 2 Z123 Z13 − 2 Y13 Y12 (VI-43)
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
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
2 2 2
((Y11 − Y16)e − 2 Y11 (X11 − X16)2) − ((X11 − X16) + (Y11 − Y16) )(e 2 + 4f )
2 2
(VI-47)
2((Y11 − Y16) + (X11 − X16) )
siendo:
e = L12 + X11
2
− Y11
2
− Z11
2
+ X16
2
+ Y16
2
+ Z16
2
− L62 + 2 Z161 Z11 − 2 Z161 Z16 − 2 X16 X11 (VI-48)
2 2 2 2
((X11 − X16)g − 2 X11 (Y11 − Y16)2) − ((Y11 − Y16) + (X11 − X16) )(g + 4h )
2 2
(VI-50)
2((Y11 − Y16) + (X11 − X16) )
siendo:
g = L12 + Y11
2
− X11
2
− Z11
2
+ X16
2
+ Y16
2
+ Z16
2
− L 26 + 2 Z161 Z11 − 2 Z161 Z16 − 2 Y161 Y11 (VI-51)
155
Comprobación del giro de manivelas
156
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
157
Comprobación del giro de manivelas
Fig. VI-13 Posición de los puntos "123" y "161" con distancias máximas y
mínimas entre ellos
158
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).
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
Comprobación del giro de manivelas
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"
160
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".
161
Comprobación del giro de manivelas
162
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
Fig. VI-19 Zonas de distancias extremas entre los puntos "123" y "161"
163
Comprobación del giro de manivelas
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.
164
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
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.
- 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:
- 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.
165
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.
- 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:
166
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
167
Comprobación del giro de manivelas
168
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
169
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.
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.
170
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
171
Comprobación del giro de manivelas
Fig. VI-24 Esfera que corta simultáneamente a todas las aristas de las bananas.
172
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.
173
Comprobación del giro de manivelas
VI.4 - CONCLUSIONES
174
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
175
Comprobación del giro de manivelas
176
CONCLUSIONES GENERALES
Conclusiones generales
178
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
CONCLUSIONES GENERALES
179
Conclusiones generales
180
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
181
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.
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 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.
182
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
183
Conclusiones generales
184
LÍNEAS DE INVESTIGACIÓN
ABIERTAS
Líneas de investigación abiertas
186
Sintesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
187
Líneas de investigación abiertas
188
ANEXO I
SÍNTESIS DE PUNTOS DE
PRECISIÓN
Anexo I
190
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
191
Anexo I
φ1 = X11
2 2
+ Y11 - L12 (AI-8)
φ2 = X12
2 2
+ Y12 - L12 (AI-9)
φ3 = X13
2 2
+ Y13 - L12 (AI-9)
φ4 = X14
2 2
+ Y14 - L12 (AI-10)
φ5 = X15
2 2
+ Y15 - L12 (AI-11)
192
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
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)
193
Anexo I
AI.1.4 - Solución
L1 = 134.238 mm.
L2 = 828.363 "
L3 = 407.887 "
L4 = 422.664 "
L5 = 248.306 "
194
ANEXO II
OPTIMIZACIÓN DE UN
CUADRILÁTERO ARTICULADO
Anexo II
196
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
ANEXO II - OPTIMIZACIÓN DE UN
CUADRILÁTERO ARTICULADO
197
Anexo II
33.1S3 + 117.67S
M= (AII-1)
− 4 S4 + 12.56 S2 + 1
siendo el deslizamiento
M= K R2S (AII-3)
2
R2 + S2 X 22
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.
eS
M= (AII-4)
f S2 + 1
198
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
eS gS ( he + gf ) S3 + (e + g)S
M = M1 + M2 = + = (AII-5)
f S2 + 1 h S2 + 1 fh S4 + (f + h ) S2 + 1
a S3 + bS
M= (AII-6)
c S4 + d S2 + 1
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.).
199
Anexo II
200
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
Para definir la posición del mecanismo, se fija el ángulo " θ2 " que
forma el eslabón de entrada "2" con el eslabón fijo "1", quedando entonces
definida la posición del punto "1" como:
201
Anexo II
Φ(q, b, t) = 0 (AII-19)
Φq q& + Φt = 0 (AII-20)
X
& 1
2( X1 − X A ) 2(Y1 − Y A) 0 0 0
& 1
Y
2 ( X1 − X 2 ) 2 ( Y1 − Y 2 ) 2 ( X 2 − X 1) 2 ( Y 2 − Y 1) = 0
· (AII-21)
& 2
X
0 0 2 ( X 2 − X B ) 2 ( Y 2 − Y B ) 0
& 2
Y
202
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
& 1 = - ω2 L2 sin( θ2 )
X (AII-22)
& 1 = ω2 L2 cos( θ2 )
Y (AII-23)
Φq &q& + Φ
& q q& + Φ
&t=0 (AII-25)
X&& 1
2( X1 − X 2 ) 2( Y1 − Y2 ) 2( X 2 − X1) 2(Y 2 − Y1) Y && 1
Φ q &q& = · (AII-26)
0 0 2( X 2 − X B) 2(Y 2 − Y B) X
&& 2
&&
Y 2
203
Anexo II
X& 1
&1− X
2( X &1− Y
& 2 ) 2( Y &2−X
& 2 ) 2( X &2−Y
& 1) 2( Y & 1) Y
& 1
Φ& q q& = - · (AII-26)
0 0 &2
2X & 2 X
2Y & 2
&
Y2
&t=0
Φ (AII-27)
X& 1
&1− X
2( X &1− Y
& 2 ) 2( Y &2−X
& 2 ) 2( X &2−Y
& 1) 2( Y & 1) Y
& 1
- · (AII-30)
0 0 &2
2X & 2 X
2Y & 2
&
Y2
204
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
donde:
I A 2 I13 m3 I13
2 + 2 0 −
2 L23
0
L 2 L3
0 IA 2 + I13 0
m3 I13
− 2
2
L2 L3
2 2 L3
M= (AII-32)
m3 − I132 0 I13 − I 24
m4 + 2 0
2 L3
2
L3 L4
m3 I13 I13 I 24
0 − 0 − m4 + 2
2 L32 L3
2
L4
- " &q& ", vector de las aceleraciones de los puntos representados por las
coordenadas dependientes será:
X&& 1
Y&&
&q& = 1 (AII-33)
X&& 2
&&
Y 2
205
Anexo II
2( X1 − X A ) 2(X1 − X 2) 0
T 2( Y1 − Y A ) 2(Y1 − Y 2) 0
Φq = (AII-34)
0 2(X 2 − X1) 2( X2 − X B)
0 2(Y 2 − Y1) 2( Y2 − Y B)
λ1
λ = λ 2 (AII-35)
λ3
- "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.
Y A − Y1
2
L2
X1 − X A
Q= ·PAR (AII-36)
L2
2
0
0
206
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
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.
X
&& 1
2( X1 − X A ) 2(Y1 − Y A ) 0 0
&& 1
Y
Φ q &q& = 2(X1 − X 2) 2( Y1 − Y 2) 2( X 2 − X1) 2( Y 2 − Y1) · (AII-38)
&& 2
X
0 0 2 ( X 2 − X B ) 2( Y 2 − Y B )
&& 2
Y
X
& 1
2X &1 &1
2Y 0 0
Y& 1
&
Φq &
q = - 2 ( &
X1 X 2− & ) 2 ( & − &
Y1 Y 2 ) 2 ( & −
X 2 X1& ) 2 ( & − &
Y 2 Y1 (AII-39)
) ·
X& 2
0 0 &
2X 2 &
2Y2
& 2
Y
Φt = Φ
& t =0 (AII-40)
207
Anexo II
X& 1
2(X1 − X A) 2(Y1 − Y A ) 0 0
Y &
2α(Φ q q& + Φ t ) =40 2(X1 − X 2) 2(Y1 − Y 2) 2(X 2 − X1) 2(Y 2 − Y1) · 1 (AII-41)
X&
0 0 2(X 2 − X B) 2(Y 2 − Y B) 2
& 2
Y
( X1 − XA ) 2 + ( Y1 − YA ) 2 − L22
2
β Φ = 400· (X 2 − X1) 2 + ( Y 2 − Y1) 2 − L32 (AII-42)
2 2
(X 2 − X B) + ( Y 2 − Y B) − L4
2
X1 X1 X
& 1
& 1
Y1 Y1 Y
= + & δt (AII-44)
X 2 X 2 X 2
&
Y 2 Y 2 Y 2
208
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
Φ (q, b, t) = 0 (AII-45)
X1
Y1
q = X2 (AII-46)
Y2
X B
L1
b = L2 (AII-46)
L3
209
Anexo II
0
X1 − X A − L 2 cos θ2
0
Y1 − Y A − L 2 sin θ2
Φ (q, b) = ( X 2 − X1) 2 + ( Y2 − Y1) 2 − L32 = 0 (AII-47)
2 2 2
( X 2 − X B ) + ( Y 2 − Y B ) − L 4 0
X B − X A − L1
0
Φq q b + Φ b = 0 (AII-48)
siendo:
1 0 0 0 0
0 1 0 0 0
Φ q = 2(X1 − X 2) 2(Y1 − Y 2 ) 2(X 2 − X1) 2(Y 2 − Y1) 0 (AII-49)
0 0 2(X 2 − X B) 2(Y 2 − Y B) 2(X B − X 2)
0 0 0 0 1
δ X1 δ X1 δ X1
δ L1 δ L2 δ L3
δ δ Y1 δ Y1
Y1
δ L1 δ L2 δ L3
δ X2 δ X2 δ X2
qb = (AII-50)
δ δ L2 δ L3
L1
δ
Y2 δ Y2 δ Y2
δ L1 δ L2 δ L3
δ XB δ XB δ XB
δ δ L2 δ L3
L1
210
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
0 − cos θ2 0
0 − sin θ2 0
Φb = 0 0 − 2 L3 (AII-51)
0 0 0
− 1 0 0
Φ q q& b + Φ
& q qb + Φ
&b=0 (AII-52)
donde:
1 0 0 0
0 1 0 0
Φq = (AII-53)
2( X1 − X 2 ) 2( Y1 − Y 2) 2(X 2 − X1) 2( Y 2 − Y1)
0 0 2(X 2 − X B) 2( Y 2 − Y B)
211
Anexo II
0 0 0 0 0
0 0 0 0 0
& q=
Φ (AII-55)
&1− X
2( X &1− Y
& 2 ) 2( Y &2−X
& 2 ) 2( X &2−Y
& 1) 2( Y & 1) 0
0 0 &2 &2 & 2
2X 2Y − 2X
δ X1 δ X1 δ X1
δ δ L2 δ L3
L1
δ Y1 δ Y1 δ Y1
δ L1 δ L2 δ L3
δ X2 δ X2 δ X2
qb = (AII-56)
δ L1 δ L2 δ L3
δ Y2 δ Y2 δ Y2
δ δ L2 δ L3
L1
δ XB δ XB δ XB
δ L1 δ L2 δ L3
0 ω2 sin θ2 0
0 0
& = − ω2 cos θ2 (AII-57)
Φb
0 0 0
0 0 0
212
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
Φ q &q&b + 2 Φ
& q q& b + Φ
&& q q b + Φ
&& b = 0 (AII-58)
donde:
1 0 0 0
0 1 0 0
Φq = (AII-59)
2( X1 − X 2 ) 2( Y1 − Y 2) 2(X 2 − X1) 2( Y 2 − Y1)
0 0 2(X 2 − X B) 2( Y 2 − Y B)
0 0 0 0
0 0 0 0
&q =
Φ (AII-61)
& 1− X
2( X &1−Y
& 2 ) 2( Y & 2−X
& 2 ) 2( X & 2−Y
& 1) 2(Y & 1)
0 0 &2 & 2
2X 2Y
213
Anexo II
0 0 0 0 0
0 0 0 0 0
&& q =
Φ (AII-63)
&& 1 − X
2( X && 1 − Y
&& 2 ) 2( Y && 2 − X
&& 2) 2(X && 2 − Y
&& 1) 2( Y && 1) 0
0 0 && 2 && 2 && 2
2X 2Y − 2X
δ X1 δ X1 δ X1
δ L1 δ L2 δ L3
δ δ Y1 δ Y1
Y1
δ L1 δ L2 δ L3
δ X2 δ X2 δ X2
qb = (AII-64)
δ δ L2 δ L3
L1
δ
Y2 δ Y2 δ Y2
δ L1 δ L2 δ L3
δ XB δ XB δ XB
δ δ L2 δ L3
L1
214
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
donde:
I A 2 I13 m3 I13
2 + 2 0 −
2 L23
0
L2 L3
0 IA 2 + I13 0
m3 I13
− 2
2
L2 L3
2 2 L3
M= (AII-67)
m3 − I132 0 I13 − I 24
m4 + 2 0
2 L3
2
L3 L4
m3 I13 I13 I 24
0 − 0 − m4 + 2
2 L32 L3
2
L4
[
Mb &q& = M L1 &q& M M L2 &q& M ML3 &q& ] (AII-69)
215
Anexo II
siendo:
0 0 0 0 X && 1
0 0 0 0 Y && 1
M L1 &q& = · && (AII-70)
0 0 0 0 X 2
0
0 0 0 Y&& 2
δ M11
δ L2 0 0 0 X&& 1
δ M 22 Y&& 1
M L2 q = 0
&&
δ L2
0 0 ·
&& (AII-71)
0 0 0 0 X 2
&&
Y 2
0 0 0 0
δ M11 δ M13
δ L3 0 0
δ L3 X&& 1
δ M22 δ M 24
0 0
δ L3 δ L3 Y&& 1
M L3 q&& = δ δ M33
· && (AII-72)
M31
δ 0 0 X 2
δ L3
L3 &&
Y 2
0 δ M42 δ M 44
0
δ L3 δ L3
δ M11 2
= − IA3 2 (AII-73)
δ L2 L2
δ M22 2
= − IA3 2 (AII-74)
δ L2 L2
δ M11 δ M 22 δ M33 δ M 44 m3
= = = = (AII-75)
δ L3 δ L3 δ L3 δ L3 3L3
δ M13 δ M 24 δ M31 δ M 42 m3
= = = = (AII-76)
δ L3 δ L3 δ L3 δ L3 6L3
216
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
2( X1 − X A) 2( X1 − X 2 ) 0
2( Y1 − Y A) 2( Y1 − Y 2 ) 0
Φq =
T
(AII-77)
0 2( X 2 − X1) 2( X 2 − X B)
0 2( Y 2 − Y1) 2( Y 2 − Y B)
δ λ1 δ λ1 δ λ1
δ L1 δ L2 δ L3
δ δ λ2 δ λ 2
λ2
λb = (AII-78)
δ L1 δ L2 δ L3
δ λ3 δ λ3 δ λ3
δ δ L2 δ L3
L1
" ΦTqb " será una hipermatriz. Al hacer el producto Φ Tqb λ , la primera
columna de la matriz Φ Tqb λ será el producto de la sensibilidad de la matriz
jacobiana traspuesta respecto de la longitud del eslabón "1" por " λ ", 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 λ = Φ ql1 λ M Φql 2 λ M Φ ql3 λ
T T T
] (AII-79)
donde:
δ X1 δ δ
2 δ L1 2( X1 − X2 ) 0
δ L1 δ L1
δ δ δ
2 Y1 2( Y1 − Y2 ) 0 λ1
δ L1 δ L1 δ L1 ·
Φ ql1 λ =
T
(AII-80)
δ δ δ δ λ 2
0 2( X 2 − X1 ) 2( X 2 − X B )
δ L1 δ L1 δ L1 δ L1 λ3
δ Y 2 δ Y1 δ
0 2( − ) 2 Y2
δ L1 δ L1 δ L1
217
Anexo II
δ X1 δ δ
2 δ L2 2( X1 − X 2 ) 0
δ L2 δ L 2
δ δ δ
2 Y1 2( Y1 − Y 2 ) 0 λ1
δ L2 δ L2 δ L 2 ·
Φ ql2 λ =
T
(AII-81)
δ X 2 δ X1 δ X 2 δ X B λ 2
0 2( − ) 2( − )
δ L 2 δ L2 δ L2 δ L 2 λ3
0 δ Y 2 δ Y1 δ Y2
2( − ) 2
δ L 2 δ L2 δ L2
δ X1 δ δ
2 δ L3 2( X1 − X 2 ) 0
δ L 3 δ L3
δ δ δ
2 Y1 2( Y1 − Y 2 ) 0 λ1
δ L3 δ L 3 δ L3 ·
Φ ql3 λ =
T
(AII-82)
δ X 2 δ X1 δ X 2 δ X B λ 2
0 2( − ) 2( − )
δ L3 δ L3 δ L 3 δ L3 λ 3
δ δ δ
0 2( Y 2 − Y1 ) 2 Y2
δ L3 δ L3 δ L3
siendo:
donde:
218
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
219
Anexo II
180 + α
Qt = = 1.25 (AII-90)
180 − α
220
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
22' 22'
R= = = 0.55945 (AII-92)
2sinα 2sin 20º
A2
β = arc.sin (AII-93)
2R
40 + β
A 2' = 2Rsin (AII-94)
2
Como " A 2 " es "L3 – L2" y " A 2' " es "L3 + L2", resultará:
A 2' − A 2
L2 = (AII-95)
2
L3 = A 2' - L2 (AII-96)
La longitud del eslabón fijo "L1" = " AB " se determinará como lado
del triángulo A2B.
2
L1 = A2 + 0.5
2
− 2·AB·cos(90 + 2.5 − β / 2) (AII-97)
221
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:
222
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
223
Anexo II
224
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
AII.2.3 - Resultados
L1 = 0.5798 m.
L2 = 0.1175 m.
L3 = 0.8775 m.
M = -135.83 Nm.
L1 = 0.5639 m.
L2 = 0.1364 m.
L3 = 0.7844 m.
M = -133.68 Nm.
225
Anexo II
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
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
AII.3 - CONCLUSIONES
227
Anexo II
228
REFERENCIAS
Referencias
230
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
REFERENCIAS
231
Referencias
232
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
233
Referencias
234
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
235
Referencias
236
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
237
Referencias
238
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
239
Referencias
240
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
241
Referencias
242
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
243
Referencias
244
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
[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.
245
Referencias
[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.
246
Síntesis Cinemática y Dinámica de Mecanismos. Manipulador Paralelo 6-RKS
247