Escolar Documentos
Profissional Documentos
Cultura Documentos
13th World Congress in Mechanism and Machine Science, Guanajuato, Mxico, 19-25 June, 2011
J. A. Pamanes
Autonomous University of Coahuila
Torreon, Mexico
2 dof PKM
Actuated
Prismatic Joint
Workpiece
End Effector
I. Introduction
Translational table
hmoreno@etsii.upm.es
apamanes@mail.uadec.mx
A7_278
13th World Congress in Mechanism and Machine Science, Guanajuato, Mxico, 19-25 June, 2011
II. Preliminaries
The kinematic scheme of the 2 dof Orthoglide is
shown in Figure 2. As can be observed, the PKM is
composed of two actuated sliding blocks which are
coupled to the fixed frame by prismatic joints. On the
other hand, the blocks are connected to the links AC and
BC by the revolute joints A and B, respectively. Lastly,
such links are connected by the revolute joint C. All the
revolute joints are passives. The axes of the prismatic
joints are orthogonal.
0 2 1.5 m
- 1 3 1 m
0 3 1.5 m
x0
C
0
rc
1
lt
y0
(a)
rc
At = B&
2
3
r4
r3
y1
r5
2
x0
(1)
x1
(b)
0 r T
A o = 0 4T
r5
r1
0
Bo = T
r2 r5
r2
Fig. 3. Kinematic scheme of the 2 dof Orthoglide with the cooperative
table.
2
r1T r4
(2)
(3)
A7_278
13th World Congress in Mechanism and Machine Science, Guanajuato, Mxico, 19-25 June, 2011
& 2
(a)
C
C
(b)
A
(4)
A, B
Fig. 5. Parallel (a) and serial (b) singularities.
0
B op = T
r2 r5
r1T r4
0
r3T r4
r3T r5
t = J&
(5)
(6)
where J = A 1B .
On the other hand, since the assisted PKM can be
considered as a redundant one, the general solution of the
inverse kinematic problem is written as follows:
& = J + t + ( I J + J ) z
(7)
(J) =
M
m
(8)
A7_278
13th World Congress in Mechanism and Machine Science, Guanajuato, Mxico, 19-25 June, 2011
J o = A o 1B o
B op
(11)
(12)
(9)
0
cos( 2 ) cos( 1 3 ) cos( 3 ) cos( 1 2 )
J op = d
sin(
)
cos(
sin(
)
cos(
)
sin(
+
)
2
1
3
3
1
2
2
3
sin( 2 ) cos( 2 )
A op =
sin( 3 ) cos( 3 )
0
cos( 1 2 ) cos( 2 )
=
0
cos( 3 )
cos( 1 3 )
(13)
where d = 1/ sin( 2 + 3 ) .
If we let K be defined in the following way :
(10)
K = J op J Top
(14)
K =I
(15)
k12
k22
where:
k11 = d 2 cos( 3 ) 2 cos( 1 2 ) 2 + cos( 2 ) 2 cos( 1 3 ) 2
k22 = d 2 sin( 2 + 3 )2 + sin( 3 )2 cos( 1 2 )2 + sin( 2 )2 cos( 1 3 )2
k12 = k21
(16 a-d)
The
isotropic
conditions
from
(15)
are
k12 = k21 = 0 and k11 = k22 = . It is easy to observe from
(16c), d that k12 and k21 become zero when 2 = 3 for
any value of 1 . On the other hand, if we regard 2 = 3
then the equality k11 = k22 = becomes :
2 cos( 2 ) 2 sin( 2 )2 cos( 1 2 )2 = sin(2 2 )2 (17)
resolving for 1 :
1 = 2 +acos
tan(2 2 )sin(2 2 )
(18)
13th World Congress in Mechanism and Machine Science, Guanajuato, Mxico, 19-25 June, 2011
A7_278
0.7071 0.7071 0
J op (1) =
,
0.7071 0.7071 1
1 (deg)
(19)
2 = 3 (deg)
1
0.9127 0.9127 0
J op (2) =
0.5771 0.5771 1
(20)
0.8660 0.8660 0
J op (3) =
0.5 1
0.5
In this case op = 1 is obtained.
(21)
A7_278
13th World Congress in Mechanism and Machine Science, Guanajuato, Mxico, 19-25 June, 2011
120
120
= 120
vector.
for = 0 to = 2 step
3
4
x& e ( i ) = J op ( i ) & e ( i )
x (i ) = x& r x& e (i )
8
9
end
end
Fig. 10. Pseudo-code for computing x (i ) for a given .
V. Case Study
In order to observe how a given error in the joint
velocities vector could affect the output velocities in the
end-efector, we implement the algorithm whose pseudocode is shown in Fig. 10. This algorithm computes the
absolute error of the operational velocity vector, x (i ) , for
x& r x& e
& r & e
x& r
& r
(rad)
angle are shown. In the three cases and for all the
orientations, the joint velocity absolute error was the
same and equal to = 0.866 . It can be observed that the
best case is the third, since in all the possible orientations
13th World Congress in Mechanism and Machine Science, Guanajuato, Mxico, 19-25 June, 2011
References
[1] Hemmerle J.S.,
1.25
Case 1
Case 2
Case 3
1.2
1.15
1.1
1.05
0.95
0
A7_278
(rad)
VI. Conclusions
In this paper we presented the isotropic design of a 2
dof PKM that works in cooperation with a translational
table. It was shown that the workspace is directly
proportional to the range of motion of the translational
table, and can be significantly amplified when the table is
added. For the kinematic analysis we used the condition
number of the Jacobian Matrix of the whole kinematic
chain. Three angles were used to characterize the design
and position of the assisted PKM in order to simplify the
analisys. A Jabobian matrix in function of these angles
was derived. By means of this analysis, we found the
geometric conditions to attain isotropic designs and
configurations. Three optimal designs were considered in
order to make a numerical study of the velocity errors
corresponding to each. In all cases, it is possible to
observe that if the PKMs joint velocities &1 and & 2
have the same value but in opposed direction, in other
words &1 = & 2 , the PKM end-effector will only move
in a parallel direction to x 0 . In this situation, the
motions of the PKM and the table are decoupled, since
each one only affects the velocity of the end-efector in an
orthogonal direction. A symmetric design was found, and
it was observed that if only one actuator moves, the endeffector will move instantaneously with the same velocity
and direction of the movement axis of the actuator that
generates the motion. There are three directions that are
parallel to the movement axis of the actuators, and their
velocity errors will only be the product of the velocity
error of the actuator that generates the motion. It was
shown that the Orthoglides isotropic configuration is not
valid when it works in cooperation with a translational
table. This work revealed the benefits of using a
7