Академический Документы
Профессиональный Документы
Культура Документы
( )
(1)
y
1
x
1
z
1
y
2
x
2
z
2
A
o
2
S
1
S
2
S
3
R
2
R
1
P
3
P
1
P
2
y
6
z
6
y
5
x
5
z
5
y
4
x
4
z
4
o
1
R
3
x
6
x
3
y
3
z
3
o
3
Mesa X-Y
Y
X
Z
Mecanismo
3-PRS
Mecanismo
Paralelo
Mesa X-Y
Apellido Autor et al / Titulo del Articulo
3
Figura 3. Mecanismo 3-PRS
2.1. Cinematica Inversa
Para determinar la posicin del punto A
i
que
representa la punta de la herramienta se realiza el
clculo cinemtico inverso. Cada uno de los lazos
PRS est restringido en su movimiento a un plano
definido por o
1
R
i
S
i
como se puede apreciar en la
figura 4.
Figura 4. Mecanismo 3-PRS
En la plataforma fija se coloca un sistema de
referencia fijo o
1
(x
1
,y
1
,z
1
), con el eje z
1
normal a la
plataforma fija. En la plataforma mvil se coloca
un sistema de referencia o
2
(x
2
,y
2
,z
2
) situado en el
punto central y un sistema de referencia en el
punto o
3
(x
3
,y
2
,z
3
) que representa la punta de la
herramienta.
La orientacin de la plataforma mvil y de la
punta de la herramienta de corte con un sistema de
referencia asociado o
2
(x
2
,y
2
,z
2
) y o
3
(x
3
,y
2
,z
3
)
respectivamente respecto a la plataforma fija se
determina por medio de la matriz de rotacin R.
[
]
(2)
Donde s, s, s representa la funcin seno
de los ngulos de euler y c, c, c la funcin
coseno.
Siendo |
| |
| |
| corresponde al
mdulo del vector correspondiente
que se
obtiene de la distancia del lado del tringulo de la
plataforma fija
(3)
Las posiciones de los puntos P
i
respecto al
sistema o
1
(x
1
,y
1
,z
1
) son:
[
]
(4)
Las posiciones de los puntos R
i
respecto al
sistema o
1
(x
1
,y
1
,z
1
) donde |
es el mdulo
del vector
(5)
y
1
x
1
z
1
y
2
x
2
z
2
A
o
2
S
1
S
2
S
3
R
2
R
1
P
3
P
1
P
2
Plataforma
Fija
Plataforma
Mvil
Junta
Prismtica
Junta
Rotatoria
Junta
Esfrica
Lazo PRS
y
6
z
6
y
5
x
5
z
5
y
4
x
4
z
4
o
1
Brazo R
3
x
6
x
3
y
3
z
3
o
3
y
1
x
1
z
1
y
2
z
2
A
o
2
S
1
S
2
S
3
P
3
P
1
o
1
P
2
R
1
R
2
R
3
z
3
x
3
x
2
o
3
y
3
L
l
4
|
| |
| |
| corresponde al mdulo de
los vectores correspondientes
el cual se obtiene
de la distancia del lado del tringulo de la
plataforma mvil
(6)
Si |
[ ]
(7)
Para continuar se emplea la matriz de
transformacin homognea correspondiente.
*
+
[
] [
]
(8)
R
3x3
corresponde a la matriz de rotacin, los
vectores orientacin [
,
[
, [
,
son los cosenos directores de los ejes u, v, w con
respecto al sistema de coordenadas XYZ.
corresponde al vector de
traslacin, f
1x3
representa la matriz de cambio de
perspectiva y w
1x1
representa un escalado global.
Para efectos prcticos solo interesa conocer el
valor de R
3x3
y
, considerndose las
componentes de f nulas y la de w
1x1
igual a la
unidad. Por lo tanto las coordenadas de las juntas
esfricas en el sistema de referencia fijo
o
1
(x
1
,y
1
,z
1
) son:
*
+ [
] [
] [] [
] (9)
Sustituyendo (7) en (9) se obtiene:
[
] (10)
[
(11)
[
(12)
Las restricciones de los planos o
1
R
i
S
i
que son
los planos en los cuales se mueve cada uno de los
lazos PRS en el sistema o
1
(x
1
,y
1
,z
1
).
Empleando las ecuaciones (10), (11), (12) de
la posicin de las juntas esfricas.
(13)
)
(14)
Apellido Autor et al / Titulo del Articulo
5
)
(15)
Sumando las ecuaciones (14) y (15) y
reemplazando en (13) se obtienen:
(16)
Restando (14) y (15):
(17)
Reemplazando (2) en (16):
(
) (18)
En (18) se muestra que es funcin de y ,
en (13) y (17) se aprecia que
son funcin
de los cosenos directores por lo que se pueden
expresar como funcin de los ngulos de Euler.
(19)
(
)
(20)
Considerando que , y
son datos se
puede determinar
. Conociendo que el
modulo del vector
| es constante y
corresponde a la longitud del brazo se puede
determinar los mdulos de los vectores
(21)
Empleando (21) se determina als posiciones
de las 3 correderas del mecanismo 3-PRS,
conocidos los ngulos , y la posicin
de la
herramienta de corte. Se determina los
movimientos parsitos