Working and Assembly Modes of The Agile Eye: Ilian - Bonev@etsmtl - Ca
Working and Assembly Modes of The Agile Eye: Ilian - Bonev@etsmtl - Ca
Working and Assembly Modes of The Agile Eye: Ilian - Bonev@etsmtl - Ca
r
X
i
v
:
0
7
0
8
.
3
9
3
6
v
1
[
c
s
.
R
O
]
2
9
A
u
g
2
0
0
7
Working and Assembly Modes of the Agile Eye
Ilian A. Bonev Damien Chablat and Philippe Wenger
D epartement de g enie de la production automatis ee Institut de Recherche en Communications
1
0
0
, u
2
=
0
1
0
, u
3
=
0
0
1
. (1)
Similarly, the axes of the platform joints are dened by the
following unit vectors expressed in the mobile reference frame:
v
1
=
0
1
0
, v
2
=
0
0
1
, v
3
=
1
0
0
. (2)
The rotation matrix R describes the orientation of the
mobile frame with respect to the base frame. The ZYX Euler-
angle convention is used here because it simplies greatly the
kinematic analysis. In the base frame, the axes of the platform
joints are dened as follows
v
i
= Rv
i
= R
z
()R
y
()R
x
()v
i
, (3)
where i = 1, 2, 3, which yields
v
1
=
,
v
2
=
,
v
3
=
cos cos
sincos
sin
. (4)
Finally, the axes of the intermediate joints are dened by the
following unit vectors expressed in the base reference frame:
w
1
=
0
sin
1
cos
1
, w
2
=
cos
2
0
sin
2
, w
3
=
sin
3
cos
3
0
, (5)
where
i
is the active-joint variable for leg i (in this paper
i = 1, 2, 3).
III. INVERSE KINEMATICS AND WORKING MODES
Although very simple, the solutions to the inverse kinemat-
ics of the Agile Eye will be presented for completeness [10].
For a given orientation of the mobile platform, each leg admits
two solutions for
i
in (, ] obtained from
tan
1
=
cos sin
cos cos + sinsin sin
, (6)
tan
2
=
sin sin + cos sin cos
cos cos
, (7)
tan
3
= tan . (8)
Thus, the inverse kinematic problem usually admits eight
real solutions or working modes for any (non-singular) orien-
tation of the mobile platform. It is very important to note that
for both solutions for
i
, vector w
i
is along the same axis but
with opposite directions. When a leg is fully extended or fully
folded, the corresponding equation from the above three ones
does no hold true and the corresponding active-joint variable
i
can be arbitrary.
IV. DIRECT KINEMATICS AND ASSEMBLY MODES
The Agile Eye was optimized to have maximum workspace
and global dexterity [9]. Incidentally, such properties also
yield great simplication in the direct kinematic problem
because the eight solutions for a general 3-RRR parallel wrists
degenerate to four trivial and four nontrivial ones. The direct
kinematics of the Agile Eye was solved in [10] and will be
reformulated and further analyzed here.
The following constraint equations are written:
w
T
i
v
i
= 0, (9a)
thus
sin (sin
1
sin sin cos cos
1
) +
cos sin
1
cos = 0, (9b)
cos (cos
2
sin cos cos sin
2
) +
sin cos
2
sin = 0, (9c)
sin(
3
) cos = 0. (9d)
From Eq. (9d), the direct kinematic problem is found to admit
two sets of solutions, dened by
cos = 0, and (10a)
sin(
3
) = 0. (10b)
In the next two subsections, these two equations will be solved.
A. First Set of Solutions Trivial Solutions
Equation (10a) gives two solutions for the angle ,
= /2 and = /2, (11)
which both correspond to a representation singularity in the
XY Z Euler angles. From the rst solution and after sim-
plication of Eq. (9b), the following condition is found for
arbitrary active-joint variables,
cos( ) = 0, (12)
and from the second solution,
cos( +) = 0. (13)
In both cases, each of these two equations lead to two
solutions. Thus, because of the representation singularity, only
four rotation matrices describe the corresponding orientations
of the mobile platform:
R
TO1
=
0 1 0
0 0 1
1 0 0
, R
TO2
=
0 1 0
0 0 1
1 0 0
,
R
TO3
=
0 1 0
0 0 1
1 0 0
, R
TO4
=
0 1 0
0 0 1
1 0 0
.
Figure 2 depicts the four trivial solutions (orientations) to
the direct kinematic problem. It may be seen geometrically, as
well as from Eqs. (9b-d), that when the platform is at one of
these four orientations, all three legs are at a singularity (fully
extended or folded) and can freely rotate about their base joint
(a) = /2, = /2 (b) = /2, = /2
(c) = /2, + = /2 (d) = /2, + = /2
Fig. 2. The four trivial solutions to the direct kinematic problem valid for
any set of active-joint variables but shown with
1
= 0,
2
= 0 and
3
= 0.
axes. Thus, these four orientations are trivial solutions to the
direct kinematic problem of the Agile Eye and exist for any set
of active-joint variables. These four families of congurations
will be discussed further in the section on singularity analysis.
B. Second Set of Solutions Nontrivial Solutions
Equation (10b) gives two solutions for the angle :
=
3
and =
3
. (14)
However, in the ZYX Euler-angle convention, the triplets
{, , } and { , , } both correspond to the
same orientation. This means that the above two solutions will
lead to the same orientation of the mobile platform. Hence,
only the rst solution will be used in this paper.
Substituting =
3
in Eqs. (9b-c), a new system of two
equations is obtained:
p
1
cos +p
2
sin = 0, (15a)
p
3
cos +p
4
sin = 0, (15b)
where
p
1
= sin
1
cos
3
, (15c)
p
2
= sin
1
sin sin
3
cos cos
1
, (15d)
p
3
= cos
2
sin cos
3
cos sin
2
, (15e)
p
4
= cos
2
sin
3
. (15f)
Since the terms cos and sin cannot vanish simultaneously,
Eqs. (15a-b) lead to
p
1
p
4
p
2
p
3
= 0. (16)
Solution 1
Solution 2 +
Solution 3 +
Solution 4 + +
TABLE I
THE FOUR NONTRIVIAL SOLUTIONS TO THE DIRECT KINEMATIC PROBLEM
Hence, substituting Eqs. (15c-f) into the above equation gives
cos (q
1
cos +q
2
sin ) = 0, (17a)
where
q
1
= sin
1
cos
2
cos
3
sin
3
cos
1
sin
2
, (17b)
q
2
= sin
1
sin
2
sin
3
+ cos
1
cos
2
cos
3
. (17c)
Equation (17a) leads to two possibilities:
cos = 0 and (18a)
q
1
cos +q
2
sin = 0. (18b)
Equation (18a) is the same as Eq. (10a) and will therefore be
discarded. Equation (18b) gives two solutions in (, ]:
= tan
1
(q
1
/q
2
) +k with k = 0, 1. (19)
Equations (15a-b) can now be used to nd :
= tan
1
(p
1
/p
2
) +k with k = 0, 1, or
= tan
1
(p
3
/p
4
) +k with k = 0, 1,
which gives two values for in (, ] for each .
Table I summarizes the solutions to the direct kinematic
problem, where a number to each solution is arbitrarily as-
signed. An example of four nontrivial solutions to the direct
kinematic problem of the Agile Eye is given in Fig. 3 for the
active-joint variables
1
= 0.3,
2
= 0.7 and
3
= 0.1.
Later, a method will be presented to identify these nontrivial
solutions based on the working mode. For now, note by
solely observing Fig. 3 that these four nontrivial solutions
are obtained from each other by rotating the mobile platform
about a platform joint axis at 180 degrees (in fact, the same
is true for the four trivial solutions). Thus, if for a given
set of active-joint variables, there is one nontrivial solution,
then there are (at least) three other nontrivial solutions. The
important question whether there are always four nontrivial
solutions was not answered in [11] and will be given special
attention now.
C. Degenerate Cases
The second set of solutions will become the same as the rst
set of solutions when Eq. (18b) degenerates and q
2
= q
1
= 0.
It can be shown that q
2
= q
1
= 0 if and only if sin
2
= 0
and cos
3
= 0, or sin
3
= 0 and cos
1
= 0. In that case,
can be anything, which is one of the self-motions of the
mobile platform. If q
2
= 0 but q
1
= 0, Eq. (18b) becomes
w
1
w
2
w
3
(a) = 0.100, = 0.672,
= 0.383
w
1
w
2
w
3
(b) = 0.100, = 0.672,
= 2.759
w
1
w
2
w
3
(c) = 0.100, = 2.470,
= 0.383
w
1
w
2
w
3
(d) = 0.100, = 2.470,
= 3.525
Fig. 3. The four nontrivial solutions to the direct kinematic problem of the
Agile Eye for
1
= 0.3,
2
= 0.7 and
3
= 0.1.
identical with Eq. (18a), meaning that = /2. Substituting
= /2 into Eqs. (15a-b) yields
sin
1
cos( ) = 0 and cos
2
cos( ) = 0. (20)
If sin
1
= 0 and cos
2
= 0, ( ) is arbitrary, meaning
that the platform can undergo a self motion. If, however, these
two conditions are not satised, then cos( ) = 0, which
means that the only direct kinematic solutions are the trivial
ones.
Thus, in summary, the Agile Eye will have only the four
trivial solutions to its direct kinematic problem if and only if
q
2
= sin
1
sin
2
sin
3
+ cos
1
cos
2
cos
3
= 0, (21)
but neither of the following three pairs of conditions is true:
sin
2
= 0 and cos
3
= 0, or (22a)
sin
3
= 0 and cos
1
= 0, or (22b)
sin
1
= 0 and cos
2
= 0. (22c)
Taking the rst pair yields q
2
= 0 and q
1
= 0, meaning that
can take any value. This means that there is a self motion
even if all actuators are xed, the platform can freely
move. Substituting
2
= 0 or
2
= , and
3
= /2 into
Eqs. (15a-b), yields sin = 0. In addition, cos = cos
3
= 0.
Similarly, for the second pair of conditions, it can be proved
that can have any value, while cos = 0 and sin = 0.
Finally, taking the third pair of conditions, q
2
= 0 but q
1
= 0,
Eq. 17a implies that cos = 0. If this pair of conditions is
substituted into Eqs. (15a-b), it is reached to the conclusion
(a) (b)
Fig. 4. The two self motions of the mobile platform where leg 3 is singular.
that sin() can be anything in the case of = /2 or that
sin( +) can be anything in the case of = /2.
Thus, it can be easily shown that Eqs. (22ac) correspond to
six self motions represented by the following rotation matrices
(where angles are arbitrary):
R
SM1a
=
0 1 0
cos 0 sin
sin 0 cos
, (23a)
R
SM1b
=
0 1 0
cos 0 sin
sin 0 cos
, (23b)
R
SM2a
=
cos sin 0
0 0 1
sin cos 0
, (23c)
R
SM2b
=
cos sin 0
0 0 1
sin cos 0
, (23d)
R
SM3a
=
0 sin( ) cos( )
0 cos( ) sin( )
1 0 0
, (23e)
R
SM3a
=
0 sin( +) cos( +)
0 cos( +) sin( +)
1 0 0
. (23f)
Now, note that each of the pairs of conditions imposes a
constraint on two of the active-joint variables, while the third
one can take any value, without inuencing the orientation
of the mobile platform. This means, that in the above self-
motions, there is a leg in singularity. In fact, the self-motion
of the platform is about the axis of the base joint of the leg
in singularity. The above self motions are divided into pairs,
where in each pair, one of the motions correspond to a fully
extended leg (the ones with the b index), while the other to a
fully folded one. Figure 4 shows the two self motions (SM3a
and SM3b) for which leg 3 is singular, corresponding to the
pair of conditions of Eq. (22c). In this gure, legs 1 and 2 are
each shown in one of the possible two congurations per leg.
As will be seen in the next section, all singular cong-
urations were found in this section by purely studying the
degeneracies of the direct kinematics of the Agile Eye.
V. SINGULARITY ANALYSIS
The relationship between the active-joint rates,
, and the
angular velocity of the mobile platform, , can be written as:
A +B
= 0 (24)
where A and B are Jacobian matrices and can be written as
A =
(w
1
v
1
)
T
(w
2
v
2
)
T
(w
3
v
3
)
T
T
1
T
2
T
3
, (25a)
B =
(w
1
v
1
)
T
u
1
0 0
0 (w
2
v
2
)
T
u
2
0
0 0 (w
3
v
3
)
T
u
3
. (25b)
Type 2 singularities are characterized by studying matrix
A and occur whenever the three vectors
i
are coplanar or
collinear. For the Agile Eye, these vectors cannot be collinear.
Thus, when these three vectors are coplanar, the platform
can rotate (innitesimally or nitely) about the axis passing
through the center O and normal to the plane of the vectors.
Substituting the nontrivial solution set for the direct kine-
matics of the Agile Eye into the determinant of A of Eq. (25a)
and simplifying, it is obtained that the expression in the active-
joint space for Type 2 singularities is:
det(A) = sin
1
sin
2
sin
3
+cos
1
cos
2
cos
3
= 0. (26)
Substituting the trivial solution set yields the same expres-
sion but with a negative sign. Note that the determinant of A
is the same for all four assembly modes. This is not surprising
since from the geometric interpretation of the four assembly
modes, it can be seen that between any two assembly modes,
two pairs of vectors
i
have opposite directions and the third
pair is the same.
Type 1 singularities are characterized by studying matrix B
and occur whenever a leg is fully extended or folded. For a
general 3-RRR spherical parallel mechanism with legs of other
than 90 degrees, Type 1 singularities are two-dimensional
entities. In other words, for such a general parallel wrist,
when a single leg is singular, the platform remains with two
degrees of freedom. In the Agile Eye, however, when a leg is
singular, the axes of the base and platform joints coincide and
the mobile platform has a single degree of freedom, whereas
the leg can freely rotate without affecting the orientation of the
mobile platform. Therefore, Type 1 singularities of the Agile
Eye are only six curves in the orientation space.
Substituting the nontrivial solution set for the direct kine-
matics of the Agile Eye into B of Eq. (25b) and simplifying
yields the following three expressions in the active-joint space,
corresponding to Type 1 singularities occurring in leg 1, 2, and
3, respectively:
B
11
=
sin
1
sin
2
sin
3
+ cos
1
cos
2
cos
3
1 cos
2
3
sin
2
1 cos
2
1
sin
2
2
=0, (27)
B
22
=
sin
1
sin
2
sin
3
+ cos
1
cos
2
cos
3
1 cos
2
2
sin
2
1 cos
2
1
sin
2
2
=0, (28)
B
33
=
sin
1
sin
2
sin
3
+ cos
1
cos
2
cos
3
1 cos
2
2
sin
2
1 cos
2
3
sin
2
1
=0, (29)
where B
ii
is the i-th diagonal element of B, and the plus-
minus sign depends on which of the four nontrivial direct
solutions is used, i.e., on the assembly mode.
Substituting the trivial solution set for the direct kinematics
of the Agile Eye into B and simplifying yields as expected:
B
11
= B
22
= B
33
= 0. (30)
Indeed, at the trivial orientations all three legs are singular.
From Eqs. (2729), it follows that if a conguration cor-
responds to a Type 2 singularity, then it should inevitably
correspond to a Type 1 singularity too. However, the opposite
is not necessarily true. In other words, if there is a Type 1
singularity, the Agile Eye is not necessarily at a Type 2
singularity too. Indeed, investigating the four orientations
shown in Fig. 2, it can be seen that the legs can be orientated
in such a way that the vectors normal to the last two joint axes
in each leg are not coplanar. Such a conguration is called a
lockup conguration, since the mobile platform is completely
restrained even if the actuators are removed. For these four
orientations, Eqs. (2729) are replaced by Eq. (30).
Finally, it should be veried what happens, when the de-
nominators of the expressions in Eqs. (2729) are zeroed. This
basically occurs when from the reference conguration, a leg
is turned at 90
3
det( )>0 A
det( )<0 A
( ) +++ ( ) +
( ) + ( ) +
( ) ++ ( ) ++
( ) ++ ( )
Fig. 5. The eight assembly modes characterized by the working mode
space by anything but Eq. (26). At these Type 1 sin-
gular congurations, the mobile platform cannot move
even under external force. For the active joint variables
corresponding to these singular congurations, the direct
kinematic problem has eight solutions.
VI. WORKING MODES AND ASSEMBLY MODES
As was mentioned before, a particularity of the Agile Eye is
that the determinant of matrix A, Eq. (26), is a function of the
active-joint variables only and has the same value for all four
nontrivial assembly modes. Equation (26) represents a surface
that divides the active-joint space into two domains where
det(A) is either positive or negative. A connectivity analysis
was made on these two domains to prove this property.
The images of these two domains in the workspace yield
eight identical domains (the whole orientation space without
the singularity curves), each one being associated with one of
the eight working modes. It can been seen geometrically, or
proved algebraically, that each of the four nontrivial assembly
modes correspond to a different working mode. Therefore,
changing an assembly mode inevitably requires a singularity
to be crossed. Hence, the Agile Eye is not cuspidal, meaning
that as long as it does not cross a singularity, it remains in a
single working mode and in a single assembly mode.
The eight working modes are divided into two groups.
Depending on the sign of det(A), the four assembly modes
each correspond to a working mode from one of these groups.
In Table II, it is assumed that for the rst solution of the direct
kinematic problem the sign of B
ii
given in Eqs. (2729) is
negative. For the other solutions, {, , } are replaced by the
value given in Table I and the inuence on the sign of B
ii
is
shown using simple trigonometric properties. Recall that |B
ii
|
does not change when an assembly mode is changed.
Figure 5 summarizes the behavior of the direct kinematic
problem where a solution can be chosen according to the sign
of B
ii
= (+ + +) for example and the sign of det(A).
Similarly, when the inverse kinematic model is solved, the
working mode is easily characterized by the sign of B
ii
.
VII. CONCLUSIONS
An in-depth kinematic analysis of a special spherical par-
allel wrist, called the Agile Eye, was done, pinpointing some
important facts that were previously overlooked. It was demon-
strated that the workspace of the Agile Eye is unlimited and
awed only by six singularity curves (rather than surfaces).
Furthermore, these curves were shown to correspond to self-
motions of the mobile platform. It was also proved that the
four assembly modes of the Agile Eye are directly related to
the eight working modes and the sign of the determinant of
one of the Jacobian matrices. It was shown that as long as the
Agile Eye does not cross its singularity curves, it remains in
a single working mode and in a single assembly mode.
REFERENCES
[1] C. Gosselin and J. Angeles, The Optimum Kinematic Design of
a Planar Three-Degree-of-Freedom Parallel Manipulator, Journal of
Mechanisms, Transmissions, and Automation in Design, Vol. 110, 1988.
[2] J.-P. Merlet, Parallel robots, Kluwer Academic, The Netherlands,
2000.
[3] C. Gosselin and J. Angeles, Singularity Analysis of Closed-Loop
Kinematic Chains, IEEE Transactions on Robotics and Automation,
Vol. 6, No. 3, 1990.
[4] D. Chablat and P. Wenger, Working Modes and Aspects in Fully-
Parallel Manipulator, IEEE International Conference on Robotics and
Automation, pp. 19641969, May 1998.
[5] C. Innocenti and V. Parenti-Castelli, Singularity-Free Evolution from
one Conguration to Another in Serial and Fully-Parallel Manipulators,
ASME Robotics, Spatial Mechanisms and Mechanical Systems, 1992.
[6] P. Wenger, A New General Formalism for the Kinematic Analysis
of all Nonredundant Manipulators, IEEE International Conference on
Robotics and Automation, pp. 442447, 1992.
[7] P. Wenger and D. Chablat, Denition Sets for the Direct Kinematics
of Parallel Manipulators, 8th International Conference in Advanced
Robotics, pp. 859-864, 1997.
[8] M. Karouia, Conception structurale de mecanismes parall` eles
sph eriques, PhD Thesis, RI 2003-26,
Ecole Centrale de Paris, 2003.
[9] C. Gosselin,
E. St-Pierre, and M. Gagn e, On the Development of the
Agile Eye: Mechanical Design, Control Issues and Experimentation,
IEEE Robotics and Automation Magazine, Vol. 3, No. 4, pp. 2937,
1996.
[10] C. Gosselin and M. Gagn e, A Closed-Form Solution for the Di-
rect Kinematics of a Special Class of Spherical Three-Degree-of-
Freedom Parallel Manipulators, Workshop on Computational Kinemat-
ics, pp. 231240, 1995.
[11] C. Gosselin and J. Wang, Singularity Loci of a Special Class of
Spherical Three-Degree-of-Freedom Parallel Mechanisms with Revolute
Actuators, International Journal of Robotics Research, Vol. 21, No. 7,
pp. 649659, 2002.
Note: This service is not intended for secure transactions such as banking, social media, email, or purchasing. Use at your own risk. We assume no liability whatsoever for broken pages.
Alternative Proxies: