Você está na página 1de 7

A7_278

13th World Congress in Mechanism and Machine Science, Guanajuato, Mxico, 19-25 June, 2011

Isotropic Design of a 2 dof Parallel Kinematic Machine with a Translational


Workpiece Table
H. A. Moreno*
Technical University of Madrid
Madrid, Spain

J. A. Pamanes
Autonomous University of Coahuila
Torreon, Mexico

AbstractParallel Kinematic Machines (PKMs)


usually have the disadvantage of a reduced workspace.
This problem can be solved by adding a moving table
that relocates the workpiece for the PKM. In this paper
we present the isotropic design of a 2 degrees of freedom
PKM that works in cooperation with a moving table. For
the analysis we used the condition number of the
Jacobian Matrix of the whole kinematic chain (PKMtable). This work reveals the benefits of using a
performance index, which considers the kinematics of
both components together and not separately.

2 dof PKM

Actuated
Prismatic Joint
Workpiece

End Effector

Keywords: Kinematic redundancy, Isotropic design, Condition


number.

I. Introduction

Translational table

Although PKMs have interesting features for


machining applications, in many cases they do not have
sufficient workspace for machining large workpieces.
This handicap, however, can be overcame by
incorporating a secondary cooperative manipulator to aid
the main one (the PKM) to achieve the task. The
secondary manipulator should continuously relocate the
work-piece to the main one in such a way that the
kinematic performance of the chain is enhanced. In this
paper, the isotropic design of a system with the
previously cited characteristics is presented.
The strategy in which a positional device is
incorporated to aid the main manipulator has been
applied in previous works. In one paper [1] the main
manipulator was redundant, and the secondary was nonredundant. Both manipulators cooperate to achieve a
welding task: the main one (right hand) moves the
welding torch and the positioner (left hand) continuously
relocates the work-pieces.
In this paper, we present the isotropic design of a 2PRR type PKM that works in cooperation with a
translational table, see Figure 1.
*

Fig. 1. 2 dof PKM and translational table

The PKM presented here is termed 2 dof Orthoglide,


[2][3]. The 2 dof Orthoglide can be used for machining
applications such as milling.
On the other hand, the translational table moves the
workpiece in such a way that the Orthoglides end
effector is enabled to reach task points that could not be
reached otherwise. The translational table moves only in
one direction, even though the workspace is significantly
increased, as it will be demonstrated later.
In this paper we analyze the benefits of using a
kinematic performance index obtained from coupled
manipulator kinematics. In consequence, the optimal
configurations from the point of view of the condition
number are obtained regarding the Jacobian matrix of the
whole kinematic chain.
We consider three optimal configurations and analyze
errors corresponding to each, in order to numerically

hmoreno@etsii.upm.es
apamanes@mail.uadec.mx

A7_278

13th World Congress in Mechanism and Machine Science, Guanajuato, Mxico, 19-25 June, 2011

revealing and contrasting the PKMs performance during


a task.

In the following, we consider lengths of bars AC and


BC as being L = 1m ; besides, we maintain the angle
1 = 45 , since the workspace reaches its maximum at
this value.
It can be observed in Figure 4 that the PKMs
workspace Wo is increased by incorporating a
cooperative table. If lt was the length of the largest
transversal line that the PKM is able to draw on the table,
then the assisted PKMs workspace is given by :
Wop = Wo + lt 3 with 3 = 3max 3min .

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)

Figure 4. Workspace of the 2 dof Orthoglide. (a) Without cooperative


table, (b) Assisted PKM

A. Kinematics of the assisted PKM


The joint and operational velocity vectors, and t,
respectively, of a parallel manipulator are related as
follows:

Fig. 2. Kinematic scheme of the 2 dof Orthoglide.

Figure 3 shows a kinematic scheme of the Orthoglide


and the cooperative table with translational motion. We
name this system (Orthoglide and table) assisted PKM.
The direction of motion of the table is defined by the
angle 1 . On the other hand, 1 is half of the angle
between the sliding blocks movement axes. By
definition, for the Orthoglide we have 1 = 45 .

rc

At = B&

vector is given by & = [ &1

2
3

r4

r3

y1

r5
2

& 2 ] and the operational


T

velocity vector is t = [r&cx r&cy ]T . The scalars r&cx and r&cy


are the orthogonal components of the position vector 0rc
(corresponding to point C) referred to a frame x0-y0, (Fig.
1.) For the Orthoglide we have:

x0

(1)

In (1), A and B are, respectively, the parallel and serial


Jacobian matrices, [4]. The entries of these matrices
depend on both the design variables and manipulator
pose.
For the Orthoglide without table, the joint velocity

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

For the assisted PKM (Figure 3), the joint velocity


vector is given by & = [ &1

& 2

(a)

&3 ] and the operational


T

C
C

velocity vector is defined in the same way that the last


case. The corresponding Jacobian matrices are:
0 r T
A op = 0 4T
r5

(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

The symbol ^ on a vectorial term of these equations


designates unit vector. In matrices (4) and (5) the unit
vectors correspond to the position vectors associated with
PKMs links, as shown in Figure 2. The velocity of point
C (end-effector) of the Orthoglide relative to the table is
obtained from Equation 1 as:

When matrix B op is rank-deficient the PKM cannot


control its end-effector. Figure 5(b) shows a serial
singularity at which the PKM is unable to move point C;
in this case the relative movement, between point C and
the table, only can be in parallel direction to the table axis
of motion.
Note that vector r3 does not have any influence over
matrix A op . On the other hand, even though some entries

t = J&

of matrix B op depend on r3 , this vector cannot produce a


rank loss.

(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

III. Kinematic Performance Index

There are several works on indexes that evaluate the


kinematic performance of serial manipulators, for
example, those introduced in [5],[6],[7]. However, the
extension of those indexes for their application in parallel
manipulators is not immediate because of the existence of
two Jacobian matrices, each of them with a different
function in the PKM kinematic model. Therefore, the
performance evaluation through an arbitrary index used
in serial manipulators could produce undesirable results
in parallels.
In this article, the condition number is used as a
performance index, since it can be efficiently applied to
both serial and parallel manipulators [6].
The condition number of the Jacobian matrix is an
interesting index for evaluating the PKM kinematic
performance. This index measures the uniformity of the
velocities and forces distribution that could develop endeffector in all directions [8], this feature is a priority for
tasks such as machined processes [9, 10].
Besides, the condition number limits the error
propagation from the joint velocities to the end-effector
velocities. In consequence, it is necessary to maintain
that number in its lowest possible value for the purpose
of preserving an adequate precision level of the
manipulators movements. The condition number of a
matrix J is defined as

(7)

The term J + t is the least norm solution of the inverse


kinematic problem. The expression ( I J + J ) z , is the
homogenous solution, which represents the projection of
z on the null space of J .
B. Singular configurations
It can be shown that matrix A o and A op are singular

when vectors r4 and r5 (i.e. links AC and BC) are


parallel; in this case the PKM is on a parallel singularity.
Figure 5(a) show a configuration which corresponds to a
parallel singularity. It is possible to observe that the PKM
can not support any force perpendicular to links AC and
BC; consequently point C could be moved even if the
actuators are blocked. This situation is obviously
undesirable.
On the other hand, in (3) it can be observed that matrix
Bo is singular when vectors r1 and r4 , or r2 and r5 ,
become orthogonal. In this case the PKM is on a serial
singularity. In this situation, the PKM is not able to move
its end-effector.

(J) =

M
m

(8)

A7_278

13th World Congress in Mechanism and Machine Science, Guanajuato, Mxico, 19-25 June, 2011

where M and m are maximum and minimum


singular values of J, respectively. The minimum value
that could reach (J) is 1. When one configuration
reaches this ideal value, it is said that the configuration is
isotropic. On the other hand, (J) becomes infinite when
the PKM is in a singular configuration.
The condition number of the Othoglide o= (Jo), is
calculated from the next Jacobian matrix:

J o = A o 1B o

B op

(11)
(12)

hence, the Jacobian matrix J op is set in the following


way:

(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

On the other hand, the condition number of the assited


PKM op= (Jop), is determined by the following
Jacobian matrix:
1
J op = A op
B op

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

The matrixes A and B from the equation (9) and (10)


are defined in equations (2) to (5).

(14)

J op becomes isotropic when [15 ] :


IV. Isotropic Design and Configurations

K =I

Isotropic configurations are those whose condition


number is equal to the unit. In this kind of configuration,
the PKM is capable of displacing the end-effector in the
same extent in all directions. If a PKM is capable of
reaching an isotropic configuration, it is called isotropic.
Two degree of freedom planar manipulators are an
important type of robotic mechanism that can follow an
arbitrary planar curve. Because of their usefulness in
applications, these mechanisms have drawn the attention
of researches who have investigated their workspace and
design [2, 3, 13]. The robots taken into consideration
were not redundant in those works. In [14] an analysis
was developed to determine the isotropic design of a naxis planar serial manipulator, this manipulato was
intended for positioning the end-effector in the x-y plane.
In that work, Angeles pointed out that isotropic
conditions could be achieved in several ways. Because
the entries of the Jacobian matrices (4) and (5) are based
on five unit vectors, there are different ways to determine
an isotopic configuration.
The Jacobian matrices can be expressed in terms of
five angles that correspond to the unit vectors. For
simplicity and regarding the PKM structure, we choose
only three angles that characterize the design and position
of the assisted PKM. Those are 1 , 2 , and 3 , and
were previously shown in Fig 4. Those angles describe
the orientation of vectors r1 , r2 , r4 and r5 with respect
the motion axis of the table.
Regarding the angles 1 , 2 and 3 , the Jacobian
matrices (4) and (5) become:

(15)

the entries of K are given by


k
K = 11
k21

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 = d 2 cos( 2 ) cos( 1 3 ) 2 sin( 2 ) cos( 3 ) cos( 1 2 ) 2 sin( 3 )

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

observed that op 1, therefore this assisted PKM


configuration is not isotropic. In this configuration, the
Jacobian matrix of the whole kinematic chain is given by:

0.7071 0.7071 0
J op (1) =
,
0.7071 0.7071 1

1 (deg)

(19)

from which op = 1.4142 is obtained.


Isotropic
continuuum

2 = 3 (deg)
1

Fig. 6. Isotropic designs.

In Fig. 6 the values of 1 and 2 = 3 which provide


the isotropic design are shown. Fig. 6 shows that there
are several isotropic designs and their corresponding
poses. It is very important to note that when 2 = 0 the
links AB and BC are parallel and the PKM assumes a
singular configuration of parallel type (Fig. 5a). Even
though the Jacobian matrix (13) remains isotropic when
2 is close to zero, the PKM loses its ability to move in

Fig. 7. Orthoglide isotropic configuration

Case 2: Assisted PKM Isotropic Configuration


The minumum condition number that is obtained
inside the PKMs workspace is op = 1 . In Fig. 8, the
configuration corresponding to this value is shown. In
this configuration, the robot is Isotropic.
In the isotropic configuration the Jacobian is given by:

the y 0 direction. Therefore it is not advisable to choose


design variables when 2 is close to zero.
In the following subsections we use the results derived
in preceding paragraphs, and obtain from (18) an
isotropic configuration for the Orthoglide (it means
1 = 45 ). Furthermore, we derive an isotropic design
where the motion axes of the actuated joints are
symmetrically situated. We compare its performance
regarding the velocity error in the isotropic configuration.

0.9127 0.9127 0
J op (2) =

0.5771 0.5771 1

(20)

Case 1: Orthoglide Isotropic Configuration


The Orthoglide isotropic configuration is shown in
Fig. 6. In this configuration, the velocity r&cx is directly
proportional to the joint velocity & 2 , therefore the
velocity errors in the x 0 direction are only a product of
velocity errors in the actuator associated to & 2 , but not of
two actuators at the same time. The same occurs in the
case of r&cy , whose velocity is given by &1 .

Fig. 8. Assisted PKM isotropic configuration.

Case 3: Isotropic design of the assisted PKM


In Fig. 9, the isotropic design of the PKM can be seen
in an isotropic configuration. In this case the Jacobian
matrix results in:

On the other hand, the PKM has not only an isotropic


configuration, there are a set of isotropic configurations
that correspond to a continuum of workspace points
defined by a 45 straight line segment with respect to
the frame x0-y0 [15]. When the PKMs end-effector
reaches points over this line o = 1 ; but, even though the
singular values that correspond to one point in the line
are equal among them, the magnitudes of those values
change at different points in the line.
When the Orthoglide, under one configuration such as
o = 1 , is required to work with a moving table, it is

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

velocities were & e ( i ) , is computed. Finally in line 7 the


1 = 45

absolute error x ( i ) is computed by means of the norm of

120

the difference between the desired velocity x& r and the


erroneous velocity x& e (i ) for the same absolute error .
For the numerical computation we consider vr = 100 m/s
and f p1 = f p1 = f p1 = 0.5 m/s for the joint velocity error

120

= 120

vector.

Fig. 9. Isotropic design of the assisted PKM and isotropic


configuration

for = 0 to = 2 step

x& r = vr cos ( ) sin ( )


for i = 1 to i = 3
& r ( i ) = J +op ( i ) x& r ,

3
4

Physical Interpretation of the isotropic


configurations
In all cases, it is possible to observe that if the joint
velocities &1 and & 2 have the same value but in opposed
direction, in other words &1 = & 2 , the Othoglide endeffector will only move in a parallel direction to x 0 . In
this situation, the movements of the PKM and the table
are decoupled, since each one only affects the velocity of
the end-efector in an orthogonal direction.
On the other hand, as could be noted in (21), if only
one actuator moves, the end-effector 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.

& e ( i ) = & r ( i ) + & p

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 .

Figure 11 shows the ratios between the relative errors


of the operational velocities vector and the joint
velocities vector. The values of the ratios for different
values of are shown in this figure. It is possible to
observe that Cases 1 and 2 reach higher values than Case
3.

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

a given absolute error in the joint velocity vector . In


line 2, the velocity vector x& r , whose magnitude is vr and
its direction is given by , is computed. The vector x& r
is calculated for all possible orientations by changing the
value of in the for loop of line 1. By means of the for
loop in line 3, we compute, for the three cases presented
en the last section, the following vectors : & r ( i ) which is

Fig. 11. Relative errors ratios vs

(rad)

In figure 11 the absolute errors x ( i ) versus the

the joint velocity vector required to produce x& r for the


design and configuration in case i . In line 5, an
erroneous joint velocity vector & e ( i ) is computed by

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

adding a perturbation to the join velocity vector. Later,


the vector x& e (i ) , which would be produced if the joint
6

13th World Congress in Mechanism and Machine Science, Guanajuato, Mxico, 19-25 June, 2011

performance index, which considers the kinematics of


both components together and not separately. In this
paper we presented the isotropic design of a mechanical
system for a real aplication, the analsys provides
meaningful results at practical and conceptual levels.

it always preserves the lowest value of absolute error


x (i ) . On the other hand, the best second case is case 2. It
is possible to observe that cases 2 and 3 are closer than
cases 2 and 1. In conclusion, it is possible to observe that
the third case was the least affected by the errors in the
joint velocity vector.

References
[1] Hemmerle J.S.,

Prinz F.B, Optimal Path Placement for


Kinematically Redundant Manipulators, Proceedings of the 1991
IEEE International Conference of Robotics and Automation,
pp.1234-1243.
[2] Majou F., Wenger P., Chablat D., Design of 2-DOF Parallel
Mechanisms for Machining Applications, Advances in Robot
Kinematics: Theory and Applications; Kluwer Academic
Publishers. Edited by J. Lenarcic and F. Thomas; pp. 319-328,
2002.
[3] Wenger P., Gosselin C., Chablat D. A comparative study of
parallel kinematic architectures for machining applications, 2nd
Workshop on Computational Kinematics, Seoul South Korea; 2001.
[4] Gosselin C., Angeles J., Singularity analysis of closed-loop
kinematic chains, Proceedings of the 1990 IEEE International
Conference of Robotics and Automation.
[5] Yoshikawa T., Manipulability
of Robotics Mechanisms,
Robotics Research: The second International Symposium, pp.439446, 1984.
[6] Angeles J.,
Lpez-Cajn C., Kinematic Isotropy and
Conditioning Index of Serial Robotic Manipulators, Int. J.
Robotics Research; 11 (6), pp. 560-571 (1992).
[7] Chiu, S. L., Task compatibility of manipulators postures, Int.
J. Robotics Research, 7 (5), 13-21, 1988.
[8] Salisbury J.K., Craig J. J., Articulated hands: force and kinematic
issues, The Int. J. of Robotic Research, vol. 1(1), pp. 4-17, 1982.
[9] Chablat D., Wenger P., Architecture Optimization of a 3-DOF
Parallel Mechanism for Machining Applications, the Orthoglide,
IEEE Transactions on Robotics and Automation, vol. 19(3), pp
403-410, juin 2003.
[10]
Huang T., Whitehouse D., Local dexterity, optimal
architecture and optimal design of parallel machine tools, Ann.
CIRP, vol. 47, no. 1, pp. 347351, 1998.
[11]
Zanganeh K. E., Angeles J., Kinematic isotropy and the
optimum design of parallel manipulators, Int. J. Robot. Res., vol.
16, no. 2, pp. 185197, 1997.
[12] Baron L., Bernier G., The design of parallel manipulators of star
topology under isotropic constraint, Proc. DETC ASME,
Pittsburgh, PA, 2001.
[13] Tian Huang, Meng Li, Zhanxian Li, Derek G. Chetwynd, and
David
J. Whitehouse, Optimal Kinematic Design of 2-DOF
Parallel Manipulators With Well-Shaped Workspace Bounded by a
Specified Conditioning Index, IEEE Transactions On Robotics
And Automation, Vol. 20, No. 3, June 2004 pp 538 543.
[14]
Jorge Angeles, The Design of Isotropic Manipulator
Architectures in the presence of Redundancies, The International
Journal of Robotics Research. Vol. 11. No. 3. June 1992. pp. 196201.
[15]
Angeles J., Fundamentals of robotic mechanical systems,
Springer-Verlag, New York. 3rd ed., 2007.

1.25
Case 1
Case 2
Case 3

1.2

1.15

1.1

1.05

0.95
0

Fig. 11. Absolute errors vs

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

Você também pode gostar