Documentos de Académico
Documentos de Profesional
Documentos de Cultura
MEMORIA
que para optar al Grado de Doctor Ingeniero Industrial
presenta
ISIDRO ZABALZA VILLAVA
Dirigida por
Jos Manuel Jimnez Bascones y Jess Mara Pintor Borobia
1
6-RKS - Manipulador paralelo, con las dos plataformas unidas por seis cadenas cinemticas,
conteniendo cada una: un par giratorio, una junta cardan y un par esfrico.
El Captulo IV comprende el estudio de las configuraciones de
insensitividad de posicin de la plataforma mvil. En un ejemplo numrico, se
determinan todas las configuraciones de insensitividad total para unas
determinadas dimensiones del manipulador.
ii
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
NDICE
CAPTULO I - INTRODUCCIN
I.1 - Introduccin............................................................................................... 3
I.2 - Situacin actual de la sntesis de mecanismos........................................... 5
I.3 - Objetivos de la tesis................................................................................... 7
I.4 - Proceso seguido en la realizacin de la tesis............................................. 8
III.1 - Introduccin.......................................................................................... 35
III.2 - Manipuladores paralelos....................................................................... 36
III.2.1 - Manipuladores paralelos 6-RKS................................................ 40
II.2.1.1 - Caractersticas de los manipuladores paralelos 6-RKS.... 47
III.3 - Conclusiones.......................................................................................... 48
iii
ndice
IV.1 - Introduccin.......................................................................................... 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 - Determinacin de las 64 CIP del manipulador 6-RKS............... 66
IV.3.3 - Comprobacin de las 64 configuraciones logradas.................... 70
IV.4 - Ejemplo numrico................................................................................. 72
IV.4.1 - Clculo de la primera configuracin de insensitividad.............. 74
IV.4.1.1 - Resolucin del sistema.................................................... 75
IV.4.1.2 - Solucin........................................................................... 75
IV.4.2 - Clculo de las CIP...................................................................... 76
IV.4.3 - Clculo de velocidades............................................................... 88
IV.4.3.1 - Comprobacin de las CIP................................................ 89
IV.5 - Conclusiones......................................................................................... 90
V.1 - Introduccin............................................................................................ 95
V.2 - Posiciones predeterminadas en CIP........................................................ 96
V.2.1 - Una posicin 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 numrico para dos CIP............................................................ 107
V.3.1 - Introduccin de datos.................................................................. 108
V.3.2 - Condiciones de restriccin.......................................................... 110
V.3.3 - Resolucin del sistema................................................................ 113
V.3.4 - Soluciones.................................................................................... 114
V.3.5 - Conclusiones de la sntesis para dos CIP..................................... 122
V.4 - Ejemplo numrico para tres CIP............................................................ 123
V.4.1 - Introduccin de datos.................................................................. 123
V.4.2 - Condiciones de restriccin.......................................................... 126
V.4.3 - Resolucin del sistema................................................................ 130
V.4.4 - Soluciones................................................................................... 131
V.5 - Conclusiones.......................................................................................... 132
iv
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
CONCLUSIONES GENERALES
v
ndice
REFERENCIAS
Referencias..................................................................................................... 231
vi
NOMENCLATURA
Nomenclatura
viii
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
NOMENCLATURA
Apq......... Longitud del lado de la plataforma mvil entre las bielas "p" y "q",
para pq = [12, 34, 56].
b.............. Vector de variables de diseo.
T
b ........... Vector "b" traspuesto.
CIN......... Configuracin de incertidumbre de posicin.
CIP.......... Configuracin de insensitividad de posicin total.
CIP-1...... Configuracin de insensitividad de posicin para una cadena
cinemtica.
CIP-2...... Configuracin de insensitividad de posicin para dos cadenas
cinemticas.
CIP-3...... Configuracin de insensitividad de posicin para tres cadenas
cinemticas.
CIP-4...... Configuracin de insensitividad de posicin para cuatro cadenas
cinemticas.
CIP-5...... Configuracin de insensitividad de posicin para cinco cadenas
cinemticas.
CIP-6...... Configuracin de insensitividad de posicin total (CIP).
Di-j.......... Distancia entre los puntos "i" y "j".
Dmax...... Distancia mxima entre dos puntos.
Dm1........ Distancia mxima o mnima relativa "1" entre dos puntos.
Dm2........ Distancia mxima o mnima relativa "2" entre dos puntos.
Dmc........ Distancia mxima o mnima entre dos puntos con las bielas
cruzadas.
Dmin....... Distancia mnima entre dos puntos.
(Dmax)max.. Mximo de las distancias mximas entre dos puntos.
(Dmin)max.. Mximo de las distancias mnimas entre dos puntos.
(Dmax)min.. Mnimo de las distancias mximas entre dos puntos.
(Dmin)min.. Mnimo de las distancias mnimas entre dos puntos.
Ei............ Descentramiento del actuador "i" respecto de los ejes de simetra del
tringulo formado por los ejes de los actuadores.
K............ Junta cardan.
Li............ Longitud del eslabn o de la biela "i".
M............ Matriz de masas referida a las coordenadas naturales.
M............ Par del motor elctrico.
M b ......... Sensibilidad de la matriz de masas respecto de las variables de
diseo.
PI............ Posicin de insensitividad.
Q............ Vector de fuerzas exteriores.
ix
Nomenclatura
x
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
2
Derivada implcita quiere decir que se derivan respecto de "t" todos los trminos que dependen
del tiempo.
3
Derivada explcita quiere decir que se derivan respecto de "t" solamente los trminos en los que
aparece la variable "t".
xi
Nomenclatura
xii
CAPTULO I
INTRODUCCIN
Introduccin
2
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
CAPTULO I - INTRODUCCIN
I.1 INTRODUCCIN
3
Introduccin
4
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
5
Introduccin
6
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
7
Introduccin
- Clculo de las posiciones de los puntos del mecanismo, definidos por las
coordenadas naturales, por el mtodo iterativo de Newton-Raphson de
linealizacin de las condiciones de restriccin.
8
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
9
Introduccin
10
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
nulos. Ello es debido a que las lneas de accin de las fuerzas que actan en los
extremos de las manivelas cortan a los ejes de sus actuadores correspondientes.
11
Introduccin
12
CAPTULO II
SNTESIS DE MECANISMOS
Sntesis de Mecanismos
14
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
- Sntesis dimensional
15
Sntesis de Mecanismos
- Sntesis de Chebyshev
- Sntesis cinemticas
16
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
- Sntesis exactas
- Sntesis aproximadas
- Sntesis ptima
- Optimizacin dinmica
17
Sntesis de Mecanismos
18
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
- Estructural.
- De puntos de precisin.
- Dinmica ptima.
19
Sntesis de Mecanismos
20
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
21
Sntesis de Mecanismos
22
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
23
Sntesis de Mecanismos
de que las coordenadas del punto 3 deben ser las coordenadas de los puntos
P que se desean conseguir.
24
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
25
Sntesis 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 posicin determinada del mecanismo.
q &q& +
& q q&
&t=0 (II-12)
26
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
M &q& + Tq = Q (II-13)
M Tq &q& Q
= & & & (II-14)
q 0 q q t
27
Sntesis de Mecanismos
(q, t) = 0
q q& + t = 0
&t=0
& q q& +
q &q& +
=0 (II-15)
& =0
(II-16)
&& = 0
(II-17)
& + 2 = 0
&& + 2 (II-18)
28
Sntesis Cinemtica y Dinmica 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
Sntesis de Mecanismos
M Tq &q&b Q
= (II-25)
q 0 b g
30
Sntesis Cinemtica y Dinmica 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
Sntesis de Mecanismos
32
CAPTULO III
MANIPULADORES PARALELOS
Manipuladores Paralelos
34
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
III.1 INTRODUCCIN
35
Manipuladores Paralelos
36
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
37
Manipuladores Paralelos
38
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
39
Manipuladores Paralelos
40
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
Sobre este tipo de robots aparte del diseo realizado por Hunt
[HUN. 83] se han realizado algunos estudios, conocindose los realizados por:
41
Manipuladores Paralelos
42
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
43
Manipuladores Paralelos
44
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
45
Manipuladores Paralelos
46
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
47
Manipuladores Paralelos
III.3 CONCLUSIONES
48
CAPTULO IV
CONFIGURACIONES DE
INSENSITIVIDAD
Configuraciones de Insensitividad.
50
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
CAPTULO IV - CONFIGURACIONES DE
INSENSITIVIDAD
IV.1 INTRODUCCIN
51
Configuraciones de Insensitividad.
52
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
El ser nula la velocidad del eslabn de salida en las CIP supone una
gran ventaja cuando con estos mecanismos se realiza una carrera que finaliza en
una detencin. As se aprovecha para detener el mecanismo en las CIP, cuando
el eslabn 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
aceleracin del eslabn de salida, por muy rpida que sea la detencin, ser la
misma que si pasase por esa configuracin sin detenerse; en cambio, la
detencin brusca del mecanismo en cualquier otra configuracin donde la
velocidad del eslabn de salida no es nula, producir una aceleracin muy
elevada.
53
Configuraciones de Insensitividad.
54
Sntesis Cinemtica y Dinmica 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
Sntesis Cinemtica y Dinmica 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 Franois [DAF. 98] y
Dasgupta y Mruthyunjaya [DAS. 98-1] y [DAS. 98-2], han estudiado por algn
mtodo las CIP y CIN de algn manipulador paralelo.
57
Configuraciones de Insensitividad.
58
Sntesis Cinemtica y Dinmica 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
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
61
Configuraciones de Insensitividad.
62
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
63
Configuraciones de Insensitividad.
64
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
65
Configuraciones de Insensitividad.
66
Sntesis Cinemtica y Dinmica 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 restriccin siguientes:
(IV-22)
68
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
(IV-23)
(X04 X 03)(Y13 Y03)( Z123 Z13) ( X04 X 03)( Z13 Z03)(Y123 Y13) +
(Y04 Y 03)( Z13 Z03)(X123 X13) ( Y04 Y 03)(X13 X03)( Z123 Z13) +
( Z04 Z03)(X13 X03)(Y123 Y13) ( Z04 Z03)(Y13 Y03)(X123 X13) = 0
(IV-24)
(X04 X 03)(Y14 Y 04)( Z145 Z14) (X04 X 03)( Z14 Z04)(Y145 Y14) +
(Y04 Y 03)( Z14 Z04)(X145 X14) (Y04 Y 03)(X14 X 04)( Z145 Z14) +
( Z04 Z03)(X14 X04)(Y145 Y14) ( Z04 Z03)(Y14 Y04)(X145 X14) = 0
(IV-25)
(IV-26)
(X06 X 05)(Y16 Y06)( Z161 Z16) ( X06 X 05)( Z16 Z06)(Y161 Y16) +
(Y06 Y 05)( Z16 Z06)(X161 X16) ( Y06 Y 05)(X16 X 06)( Z161 Z16) +
( Z06 Z05)(X16 X06)(Y161 Y16) ( Z06 Z05)(Y16 Y06)(X161 X16) = 0
(IV-27)
(q) = 0 (IV-28)
69
Configuraciones de Insensitividad.
( qi ) = q( qi )( qi - qi +1 ) (IV-29)
70
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
X123 X145 Y123 Y145 Z123 Z145 X145 X123 Y145 Y123 Z145 Z123 0 0 0 &
Y
161
0 0 0 X145 X161 Y145 Y161 Z145 Z161 X161 X145 Y161 Y145 Z161 Z145 Z& 161
(X123 X12)X
& 123 + (Y123 Y12)Y& 123 + ( Z123 Z12)Z& 123 =
(IV-31)
= (X123 X12)X& 12 + (Y123 Y12)Y& 12 + ( Z123 Z12)Z& 12
71
Configuraciones de Insensitividad.
Haciendo este mismo razonamiento con las seis primeras filas del
sistema de ecuaciones (IV-30) se llega a la conclusin que si el eje del actuador,
la manivela y la biela se encuentran en el mismo plano, esa cadena cinemtica
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 determinacin y comprobacin de las
configuraciones de insensitividad (CIP) por el mtodo iterativo de Newton-Raphson.
72
Sntesis Cinemtica y Dinmica 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.
(Z13 Z 03 )(
X 123 X 13 ) 3 (Z13 Z 03 )(
Y123 Y13 ) +
(IV-55)
3 (Y13 Y03 )(
Z123 Z13 ) + (X 13 X 03 )(
Z123 Z13 ) = 0
74
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
(Z14 Z 04 )(
X 145 X 14 ) 3 (Z14 Z 04 )(
Y145 Y14 ) +
(IV-56)
3 (Y14 Y04 )(
Z145 Z14 ) + (X 14 X 04 )(
Z145 Z14 ) = 0
(Z15 Z 05 )(
X 145 X 15 ) 3 (Z15 Z 05 )(
Y145 Y15 ) +
(IV-57)
3 (Y15 Y05 )(
Z145 Z15 ) + (X 15 X 05 )(
Z145 Z15 ) = 0
(Z16 Z 06 )(
X 161 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 - Solucin
75
Configuraciones de Insensitividad.
76
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
77
Configuraciones de Insensitividad.
78
Sntesis Cinemtica y Dinmica 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
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
81
Configuraciones de Insensitividad.
82
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
83
Configuraciones de Insensitividad.
84
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
85
Configuraciones de Insensitividad.
86
Sntesis Cinemtica y Dinmica 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
Sntesis Cinemtica y Dinmica 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
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
91
Configuraciones de Insensitividad.
92
CAPTULO V
SNTESIS DE UN MANIPULADOR
6-RKS
Sntesis de un Manipulador 6-RKS
94
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
CAPTULO V - SNTESIS DE UN
MANIPULADOR 6-RKS
V.1 INTRODUCCIN
95
Sntesis de un Manipulador 6-RKS
96
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
97
Sntesis de un Manipulador 6-RKS
98
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
99
Sntesis de un Manipulador 6-RKS
100
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
101
Sntesis de un Manipulador 6-RKS
102
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
103
Sntesis de un Manipulador 6-RKS
104
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
105
Sntesis de un Manipulador 6-RKS
106
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
107
Sntesis 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 mvil horizontal (Fig. V-7).
108
Sntesis Cinemtica y Dinmica 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
Sntesis de un Manipulador 6-RKS
110
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
111
Sntesis de un Manipulador 6-RKS
Para la condicin de que los ejes de los actuadores, las manivela y las
bielas en cada cadena deben estar contenidas en un plano, para la primera
posicin de la plataforma mvil:
(Z13A Z 03 )(
X 123A X 13A ) 3 (Z13A Z 03 )(
Y123A Y13A ) +
(V-63)
3 (Y13A Y03 )(
Z123A Z13A ) + (X 13A X 03 )(
Z123A Z13A ) = 0
(Z14 A Z 04 )(
X 145 A X 14 A ) 3 (Z14 A Z 04 )(
Y145 A Y14 A ) +
(V-64)
3 (Y14 A Y04 )(
Z145 A Z14 A ) + (X 14 A X 04 )(
Z145A Z14 A ) = 0
(Z15A Z 05 )(
X 145 A X 15A ) 3 (Z15A Z 05 )(
Y145 A Y15A ) +
(V-65)
3 (Y15A Y05 )(
Z145 A Z15A ) + (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 ) + (X 16 A X 06 )(
Z161A Z16 A ) = 0
Para la condicin de que los ejes de los actuadores, las manivela y las
bielas en cada cadena deben estar contenidas en un plano, para la segunda
posicin de la plataforma mvil:
(Z13B Z 03 )(
X 123B X 13B ) 3 (Z13B Z 03 )(
Y123B Y13B ) +
(V-69)
3 (Y13B Y03 )(
Z123B Z13B ) + (X 13B X 03 )(
Z123B Z13B ) = 0
(Z14 B Z 04 )(
X 145 B X 14 B ) 3 (Z14 B Z 04 )(
Y145 B Y14 B ) +
(V-70)
3 (Y14 B Y04 )(
Z145 B Z14 B ) + (X 14 B X 04 )(
Z145B Z14 B ) = 0
112
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
(Z15B Z 05 )(
X 145 B X 15B ) 3 (Z15B Z 05 )(
Y145 B Y15B ) +
(V-71)
3 (Y15 B Y05 )(
Z145 B Z15B ) + (X 15 B X 05 )(
Z145B Z15 B ) = 0
(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
Sntesis de un Manipulador 6-RKS
V.3.4 Soluciones
114
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
115
Sntesis de un Manipulador 6-RKS
116
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
117
Sntesis de un Manipulador 6-RKS
118
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
119
Sntesis de un Manipulador 6-RKS
120
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
121
Sntesis 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
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
La altura del baricentro de los tringulos, en todos los casos, debe ser
0.1 metros por encima del baricentro del tringulo de la plataforma mvil
correspondiente a la primera CIP del ejemplo del Captulo IV, es decir, a 0.7498
metros.
123
Sntesis de un Manipulador 6-RKS
124
Sntesis Cinemtica y Dinmica 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
Sntesis de un Manipulador 6-RKS
126
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
127
Sntesis de un Manipulador 6-RKS
128
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
(Z13A Z 03 )(
X 123A X 13A ) 3 (Z13A Z 03 )(
Y123A Y13A ) +
(V-129)
3 (Y13A Y03 )(
Z123A Z13A ) + (X 13A X 03 )(
Z123A Z13A ) = 0
(Z14 A Z 04 )(
X 145 A X 14 A ) 3 (Z14 A Z 04 )(
Y145 A Y14 A ) +
(V-130)
3 (Y14 A Y04 )(
Z145 A Z14 A ) + (X 14 A X 04 )(
Z145A Z14 A ) = 0
(Z15A Z 05 )(
X 145 A X 15A ) 3 (Z15A Z 05 )(
Y145 A Y15A ) +
(V-131)
3 (Y15A Y05 )(
Z145 A Z15A ) + (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 ) + (X 16 A X 06 )(
Z161A Z16 A ) = 0
(Z13B Z 03 )(
X 123B X 13B ) 3 (Z13B Z 03 )(
Y123B Y13B ) +
(V-135)
3 (Y13B Y03 )(
Z123B Z13B ) + (X 13B X 03 )(
Z123B Z13B ) = 0
(Z14 B Z 04 )(
X 145 B X 14 B ) 3 (Z14 B Z 04 )(
Y145 B Y14 B ) +
(V-136)
3 (Y14 B Y04 )(
Z145 B Z14 B ) + (X 14 B X 04 )(
Z145B Z14 B ) = 0
129
Sntesis de un Manipulador 6-RKS
(Z15B Z 05 )(
X 145 B X 15B ) 3 (Z15B Z 05 )(
Y145 B Y15B ) +
(V-137)
3 (Y15 B Y05 )(
Z145 B Z15B ) + (X 15 B X 05 )(
Z145B Z15 B ) = 0
(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
(Z13C Z 03 )(
X 123C X 13C ) 3 (Z13C Z 03 )(
Y123C Y13C ) +
(V-141)
3 (Y13C Y03 )(
Z123C Z13C ) + (X 13C X 03 )(
Z123C Z13C ) = 0
(Z14C Z 04 )(
X 145C X 14C ) 3 (Z14C Z 04 )(
Y145C Y14C ) +
(V-142)
3 (Y14C Y04 )(
Z145C Z14C ) + (X 14C X 04 )(
Z145C Z14C ) = 0
(Z15C Z 05 )(
X 145C X 15C ) 3 (Z15C Z 05 )(
Y145C Y15C ) +
(V-143)
3 (Y15C Y05 )(
Z145C Z15C ) + (X 15C X 05 )(
Z145C Z15C ) = 0
(Z16C Z 06 )(
X 161C X 16C ) 3 (Z16C Z 06 )(
Y161C Y16 A ) +
(V-144)
3 (Y16C Y06 )(
Z161C Z16C ) + (X 16C X 06 )(
Z161C Z16C ) = 0
130
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
V.4.4 Soluciones
131
Sntesis de un Manipulador 6-RKS
V.5 - CONCLUSIONES
132
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
133
Sntesis de un Manipulador 6-RKS
134
CAPTULO VI
136
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
VI.1 - INTRODUCCIN
137
Comprobacin del giro de manivelas
se llega a la conclusin 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
eslabn de entrada ser capaz de dar vueltas completas.
138
Sntesis Cinemtica y Dinmica 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
Comprobacin 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
mvil 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" debern ser
capaces de unir los puntos "14" y "15" y las bielas "1" y "6" debern poder unir
los puntos "11" y "16".
140
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
Centrndose 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 mnima
distancia entre estos dos puntos.
- El mdulo de la diferencia de las longitudes de las dos bielas sea menor que
la distancia mxima entre estos dos puntos.
Para ver que son necesarias estas dos condiciones basta con considerar
que los puntos "12", "13" y "123" forman un tringulo 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
Comprobacin del giro de manivelas
Para determinar las distancias mxima y mnima entre los puntos "12"
y "13", teniendo en cuenta que los ejes de los actuadores forman un tringulo
equiltero, tomando el origen de los ngulos de las manivelas en el interior del
tringulo formado por los ejes de los actuadores y sentido segn se indica en la
figura VI-4, siendo el origen de coordenadas el baricentro del tringulo 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 sern:
Las coordenadas de los puntos "12" y "13" irn 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
Sntesis Cinemtica y Dinmica 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 mxima o mnima, "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 mnima y mxima entre los puntos "12" y "13" para un
determinado punto "13"
143
Comprobacin 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 mxima o mnima, "3" debe ser tal que:
tg 3 =
Z12 Z13 (VI-26)
1 / 2(X13 X12) + 3 / 2(Y13 Y12)
144
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
Fig. VI-6 Distancias mnima y mxima 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 sern mximas o mnimas
(Fig. VI-7), estas sern:
- Una distancia mxima entre "12" y "13" (Dmax) cuando 2 = 3 = 180.
- Una distancia mnima entre "12" y "13" (Dmin) cuando 2 = 3 = 0.
- Una distancia mxima o mnima relativa entre "12" y "13" (Dm1) cuando
2 =0 y 3 = 180.
- Una distancia mxima o mnima relativa entre "12" y "13" (Dm2) cuando
2 =180 y 3 = 0.
145
Comprobacin del giro de manivelas
-
Fig. 43 Distancias mxima, mnima y distancias extremas intermedias.
146
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
2 2
Dmax = (X 03 X02 + R 2 + 1 / 2 R 3) + (Y 03 Y 02 + 3 / 2 R 3) (VI-27)
2 2
Dmin = (X 03 X02 R 2 1 / 2 R 3) + (Y 03 Y02 + 3 / 2 R 3) (VI-28)
2 2
Dm1 = (X 03 X02 R 2 + 1 / 2 R 3) + (Y 03 Y02 + 3 / 2 R 3) (VI-29)
2 2
Dm2 = (X 03 X02 + R 2 1 / 2 R 3) + (Y 03 Y02 3 / 2 R 3) (VI-30)
147
Comprobacin del giro de manivelas
siendo:
2 2
Dmax = (X 05 X 04 + 1 / 2 R 5 1 / 2 R 4) + (Y 05 Y 04 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) + (Y 05 Y 04 + 3 / 2 R 5 + 3 / 2 R 4) (VI-32)
148
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
Fig. VI-10 Distancias mxima y mnima 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 L6 < 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 L6 < Dmin entre los puntos "11" y "16".
siendo:
2 2
Dmax = (X 06 X01 + R1 + 1 / 2 R 6) + (Y06 Y 01 3 / 2 R 6) (VI-33)
2 2
Dmin = (X 06 X01 R1 1 / 2 R 6) + ( Y06 Y 01 + 3 / 2 R 6) (VI-34)
149
Comprobacin del giro de manivelas
- La suma de las longitudes de las dos bielas sea mayor que la distancia
mxima entre los puntos extremos de las manivelas.
150
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
151
Comprobacin del giro de manivelas
Al ir girando las 4 manivelas, los puntos "11", "12", "13" y "16" van
variando de posicin. Por lo tanto, irn variando las distancias mxima y
mnima entre los puntos "123" y "161" y apareciendo ms posibilidades que se
analizan a continuacin:
- 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 mnimo de la distancia mnima entre los puntos "123" y
"161", (A12 > (D123-161 min) min).
- Menor que el mximo de la distancia mxima 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 mximo de las distancias mnimas entre los puntos
"123" y "161", (A12 > (D123-161 min) max).
- Menor que el mnimo de las distancias mximas entre dichos puntos,
(A12 < (D123-161 max) min).
152
Sntesis Cinemtica y Dinmica 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) 2) ((X12 X13) + (Y12 Y13) )(a 2 + 4b)
(VI-38)
2((Y12 Y13) 2 + (X12 X13) 2)
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
Comprobacin del giro de manivelas
2 2 2
((X12 X13)c 2 X12 (Y12 Y13)2) ((Y12 Y13) + (X12 X13) )(c 2 + 4d )
(VI-42)
2((Y12 Y13)2 + (X12 X13)2)
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 esfricas con centros en los
puntos "11" y "16" cuya interseccin ser la circunferencia donde se deber
encontrar el punto "161".
154
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
2 2 2
((Y11 Y16)e 2 Y11 (X11 X16)2) ((X11 X16) + (Y11 Y16) )(e2 + 4f )
(VI-47)
2((Y11 Y16)2 + (X11 X16)2)
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 )
(VI-50)
2((Y11 Y16)2 + (X11 X16)2)
siendo:
g = L12 + Y11
2
X11
2
Z11
2
+ X16
2
+ Y16
2
+ Z16
2
L62 + 2 Z161 Z11 2 Z161 Z16 2 Y161 Y11 (VI-51)
155
Comprobacin del giro de manivelas
156
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
157
Comprobacin del giro de manivelas
Fig. VI-13 Posicin de los puntos "123" y "161" con distancias mximas y
mnimas entre ellos
158
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
Por analoga con este caso, ahora se afirma que, para unos
determinados puntos "12", "13" y "161", la distancia entre los puntos "123" y
"161" ser mxima o mnima cuando el punto "123" sea tal que los puntos "12",
"13", "123" y "161" estn contenidos en el mismo plano (Fig. VI-13).
Fig. VI-14 Distancias mxima y mnima entre los vrtices "123" y "161" para
unos puntos "12", "13" y "161" dados
159
Comprobacin del giro de manivelas
Fig.VI-15 Interseccin del plano formado por los puntos "12", "13" y "123" y el
formado por los puntos "11", "16" y "161"
160
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
Al ir girando las manivelas "1", "2", "3" y "6", las distancias mxima
y mnima entre los puntos "123" y "161" irn variando y se producir que las
distancias mxima y mnima tendrn sus mximos y mnimos respectivos.
Para que las cuatro manivelas puedan dar vueltas completas, con la
arista "A12" acoplada, se deber cumplir que:
- (Dmx)mn entre los puntos "123" y "161" > "A12".
- (Dmn)mx entre los puntos "123" y "161" < "A12".
161
Comprobacin del giro de manivelas
162
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
Fig. VI-19 Zonas de distancias extremas entre los puntos "123" y "161"
163
Comprobacin 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 mximas o
mnimas al variar los ngulos de las manivelas.
164
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
Para determinar las posiciones de los puntos "123" y "161" para los
cuales las distancias entre ellos sern extremas, se utilizar el mtodo iterativo
de Newton-Raphson, por medio un programa realizado en MATLAB.
- Para que las cadenas cinemticas "1", "2", "3" y "6" se encuentren en
posicin de insensitividad, en cada cadena, el producto mixto de los
vectores en la direccin 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 direccin del punto
"12" al "13", del "12" al "123" y del "12" al "161" debe ser cero.
165
Comprobacin 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 direccin 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 direccin del eje del actuador y de la manivela debe ser cero:
166
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
167
Comprobacin del giro de manivelas
168
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
169
Comprobacin del giro de manivelas
Para que una arista de la plataforma mvil 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
mnimo de las distancias mximas y el mximo de las distancias mnimas entre
los puntos a unir.
170
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
171
Comprobacin del giro de manivelas
Fig. VI-24 Esfera que corta simultneamente a todas las aristas de las bananas.
172
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
Para garantizar que una plataforma mvil triangular ser capaz de unir
simultneamente tres aristas de tres bananas (Fig. VI-23), se debera estudiar las
43 = 64 combinaciones de mximos de distancias mnimas, como esto resultara
muy engorroso, por medio del programa CATIA, se dibujar una esfera que
incluya o sea tangente a las doce aristas de las tres bananas simultneamente
(Fig. VI-24) y se dimensionar una plataforma mvil que sea tringulo
equiltero con una longitud de lado igual al dimetro de la esfera.
173
Comprobacin del giro de manivelas
VI.4 - CONCLUSIONES
174
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
175
Comprobacin del giro de manivelas
176
CONCLUSIONES GENERALES
Conclusiones generales
178
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
CONCLUSIONES GENERALES
179
Conclusiones generales
180
Sntesis Cinemtica y Dinmica 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 vrtice de la plataforma mvil 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 mxima entre los
extremos de sus manivelas correspondientes y que el mdulo de la diferencia de
sus longitudes sea menor que la distancia mnima entre los extremos de dichas
manivelas.
Por medio del programa grfico CATIA se ha dibujado una esfera que
contacta a la vez con las doce aristas de las tres bananas. En la mayora de los
casos, con tomar como longitud del lado del tringulo equiltero de la
plataforma mvil, la longitud del dimetro 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 mvil que permita que las seis
manivelas giren vueltas completas.
182
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
183
Conclusiones generales
184
LNEAS DE INVESTIGACIN
ABIERTAS
Lneas de investigacin abiertas
186
Sintesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
187
Lneas de investigacin abiertas
188
ANEXO I
SNTESIS DE PUNTOS DE
PRECISIN
Anexo I
190
Sntesis Cinemtica y Dinmica 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
Sntesis Cinemtica y Dinmica 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 - Solucin
L1 = 134.238 mm.
L2 = 828.363 "
L3 = 407.887 "
L4 = 422.664 "
L5 = 248.306 "
194
ANEXO II
OPTIMIZACIN DE UN
CUADRILTERO ARTICULADO
Anexo II
196
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
ANEXO II - OPTIMIZACIN DE UN
CUADRILTERO ARTICULADO
197
Anexo II
33.1S3 + 117.67S
M= (AII-1)
4 S4 + 12.56 S2 + 1
siendo el deslizamiento
M= K R2 S (AII-3)
2
R2 + S2 X 22
siendo "K" una constante que depende de las caractersticas fsicas del
motor y de la tensin 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
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
eS gS (he + gf ) S3 + (e + g)S
M = M 1 + 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 ecuacin del par es una funcin impar, por lo tanto el par es una
funcin simtrica respecto del origen de coordenadas (S = 0; n = 1500 r.p.m.).
199
Anexo II
200
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
Para definir la posicin del mecanismo, se fija el ngulo " 2 " que
forma el eslabn de entrada "2" con el eslabn fijo "1", quedando entonces
definida la posicin 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
Y& 1
2 ( X1 X 2 ) 2 ( Y1 Y 2 ) 2 ( X 2 X 1) 2 ( Y 2 Y 1) = 0
(AII-21)
X& 2
0 0 2 ( X 2 X B ) 2 ( Y 2 Y B ) & 0
Y 2
202
Sntesis Cinemtica y Dinmica 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 Y 2) 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 &2X
& 2) 2( X &2Y
& 1) 2(Y & 1) Y
& 1
& q q& = - (AII-26)
0 0 &2
2X & 2 X
2Y & 2
&
Y 2
&t=0
(AII-27)
& 1
X
&1 X
2( X &1 Y
& 2) 2(Y &2X
& 2) 2( X &2Y
& 1) 2(Y & 1) Y
& 1
- (AII-30)
0 0 &2
2X & 2 X
2Y & 2
&
Y 2
204
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
M &q& + Tq = Q (AII-31)
donde:
IA 2 I13 m3 I13
2 + 2 0
2 L32
0
L 2 L3
0 IA 2 + I13 0 m3 I13
2
L 2 L3
2 2 L32
M= (AII-32)
m3 I132 0 I13 I24
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(X 2 X B)
0 2(Y 2 Y1) 2(Y 2 Y B)
1
= 2 (AII-35)
3
- "Q" ser el vector de las fuerzas exteriores que actan en los puntos "1" y
"2" y que en este ejemplo sern nulas. No obstante, como con este mtodo
no se pueden introducir los pares como tales, el par motor se establece
mediante una fuerza perpendicular al eslabn "2" en el punto "A" y otra del
mismo mdulo y direccin 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
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
En este caso, para poder determinar el par motor mximo con el fin de
hacerlo mnimo, se debe realizar una simulacin dinmica de, al menos, una
vuelta de la manivela. Para realizar esta simulacin dinmica se comienza
poniendo unas condiciones iniciales de posicin y velocidad del mecanismo, a
partir de estas condiciones y del par motor correspondiente a esas condiciones
se resuelve el problema dinmico directo y se obtienen las aceleraciones, se fija
un incremento de tiempo para realizar la integracin numrica 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
Y&& 1
q &q& = 2(X1 X 2) 2(Y1 Y 2) 2( X 2 X1) 2(Y 2 Y1) (AII-38)
X&& 2
0 0 2 ( X 2 X B ) 2 ( Y 2 Y B ) &&
Y 2
& 1
X
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 &
2Y 2
& 2
Y
&t=0
t = (AII-40)
207
Anexo II
X& 1
2(X1 X A ) 2(Y1 Y A ) 0 0
&
2( q q& + t ) =40 2(X1 X 2) 2(Y1 Y 2) 2(X 2 X1) 2(Y 2 Y1) 1 (AII-41)
Y
X&
0 0 2(X 2 X B) 2(Y 2 Y B) 2
& 2
Y
& 1
X1 X1 X
& 1
Y1 Y1 Y
= + & t (AII-44)
X 2 X 2 X 2
&
Y 2 Y 2 Y 2
208
Sntesis Cinemtica y Dinmica 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 L2 cos 2
0
Y1 Y A L2 sin 2
(q, b) = (X 2 X1) 2 + (Y 2 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
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
0 cos 2 0
0 sin 0
2
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 &2X
& 2) 2(X &2Y
& 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
Sntesis Cinemtica y Dinmica 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 &2X
& 2) 2( X &2Y
& 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
0 22 cos 2 + 2 sin 2 0
0 2
sin cos 2 0
&& b = 2 2 2 (AII-65)
0 0 0
0 0 0
214
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
donde:
IA 2 I13 m3 I13
2 + 2 0
2 L32
0
L 2 L3
0 IA 2 + I13 0 m3 I13
2
L 2 L3
2 2 L32
M= (AII-67)
m3 I132 0 I13 I24
m4 + 2 0
2 L3
2
L3 L4
m3 I13 I13 I 24
0 0 m4 + 2
2 L32 L3
2
L4
[
M b &q& = M L1 &q& M M L 2 &q& M M L 3 &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 L 2 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
M 22 M 24
0 0
L3 L3 Y&& 1
M L3 &q& = M33
&& (AII-72)
M31
0 0 X 2
L3
L3 &&
Y 2
0 M 42 M 44
0
L3 L3
M11 2
= IA3 2 (AII-73)
L2 L2
M 22 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 6 L3
216
Sntesis Cinemtica y Dinmica 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 eslabn "1" por " ", la segunda
columna ser el producto de la sensibilidad de la matriz jacobiana traspuesta
respecto de la longitud del eslabn "2" por " ", y la tercera columna ser el
producto de la sensibilidad de la matriz jacobiana traspuesta respecto de la
longitud del eslabn "3" por " ", resultando:
T
[
qb = ql1 M ql2 M ql3
T T T
] (AII-79)
donde:
X1
2 L1 2( X1 X 2 ) 0
L1 L1
2 Y1 2( Y1 Y 2 ) 0 1
ql1 =
T L1 L1 L1 (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 L2
2 Y1 2( Y1 Y 2 ) 0 1
ql 2 =
T L2 L2 L2 (AII-81)
X 2 X1 X 2 X B 2
0 2( ) 2( )
L2 L2 L2 L2 3
0 Y 2 Y1 Y2
2( ) 2
L2 L2 L2
X1
2 L3 2( X1 X 2 ) 0
L3 L3
2 Y1 2( Y1 Y 2 ) 0 1
L3 L3 L3
ql3 =
T
(AII-82)
X 2 X1 X 2 X B 2
0 2( ) 2( )
L3 L3 L3 L3 3
0 2( Y 2 Y1 ) 2 Y2
L3 L3 L3
siendo:
donde:
218
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
219
Anexo II
180 +
Qt = = 1.25 (AII-90)
180
220
Sntesis Cinemtica y Dinmica 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 eslabn fijo "L1" = " AB " se determinar como lado
del tringulo A2B.
2
L1 = A2 + 0.5
2
2ABcos(90 + 2.5 / 2) (AII-97)
221
Anexo II
Partiendo de una distancia mnima entre los puntos "A" y "2" de 0.2
metros para evitar interferencias de la manivela con eslabn seguidor y
aumentando esta distancia en incrementos de 0.008 metros, se obtiene la
relacin de posibles longitudes de los eslabones siguiente:
222
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
223
Anexo II
224
Sntesis Cinemtica y Dinmica 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 revolucin de la manivela con la
combinacin de longitudes de eslabones correspondientes a la fila 1 de la tabla
(AII-1).
Fig. AII-6 Diagrama del par motor durante una revolucin de la manivela con la
combinacin de longitudes de eslabones que hacen que el par mximo sea
mnimo.
226
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
AII.3 - CONCLUSIONES
227
Anexo II
228
REFERENCIAS
Referencias
230
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
REFERENCIAS
231
Referencias
232
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
233
Referencias
234
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
235
Referencias
236
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
237
Referencias
238
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
239
Referencias
240
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
241
Referencias
242
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
243
Referencias
244
Sntesis Cinemtica y Dinmica 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 Jimnez 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
Sntesis Cinemtica y Dinmica de Mecanismos. Manipulador Paralelo 6-RKS
247