Documente Academic
Documente Profesional
Documente Cultură
= = =
= = =
t t t
t W W t V V t U U
P P P P P P
P P P P P P
q q q
q q q
| | o o
(1)
where q(t)=[u
7
(t), s
7
(t), u
8
(t), s
8
(t), u
9
(t), s
9
(t),]
T
- a vector of
the input generalized coordinates;
0P
, o
0P
|
0P
- the
components of relative orientation of coordinate systems
PX
P
Y
P
Z
P
and OU
o
V
o
W
o
.
Fig. 1. Parallel manipulator with cylindrical joints PM 3CCC
For definition of constant and variable parameters of
parallel manipulator we fixed the right Cartesian coordinate
systems UVW and XYZ to each element of each joint. The
axes W and Z of coordinate systems UVW and XYZ are
directed on a axis of rotation and translation of cylindrical
joints.
Transformation matrix
jk
T between coordinate systems
UjVjWj and
k k k
Z Y X
fixed on the ends of binary link jk has a
view (Fig. 2)
= = ) , , , , , (
jk jk jk jk jk jk jk jk
c b a | o T T
Singularity Analysis of a Parallel Manipulator
with Cylindrical Joints
Zhumadil Zh. Baigunchekov, and Myrzabay B. Izmambetov
U
0
V
0
W
0
O
A 0
5
2
6
4
3
9
u
8
u
9
s
8
s
7
s
1
7
B
C
D
E
F
G
H
I
7
u
X
P
Y
P
Z
P
Proceedings of the World Congress on Engineering 2012 Vol III
WCE 2012, July 4 - 6, 2012, London, U.K.
ISBN: 978-988-19252-2-0
ISSN: 2078-0958 (Print); ISSN: 2078-0966 (Online)
WCE 2012
Fig. 2. Binary link jk of kind CC
=
(
(
(
(
44 43 42 41
34 33 32 31
24 23 22 21
14 13 12 11
t t t t
t t t t
t t t t
t t t t
=
(
k
j
k
j
R
0 1
, (2)
where 1
11
= t , 0
14 13 12
= = = t t t ,
jk jk jk jk jk
b a t o sin sin cos
21
+ = ,
jk jk jk jk jk
t | o | sin cos sin cos cos
22
= ,
jk jk jk jk jk
t | o | cos cos sin sin cos
23
= ,
jk jk
t o sin sin
24
= ,
jk jk jk jk jk
b a t o sin cos sin
31
= ,
jk jk jk jk jk
t | o | sin cos cos cos sin
32
+ = ,
jk jk jk jk jk
t | | o sin sin cos cos cos
33
= ,
jk jk
t o sin cos
34
= ,
jk jk jk
b c t o cos
41
+ = ,
jk jk
t | o sin sin
42
= ,
jk jk
t | o cos sin
43
= ,
jk
t o cos
44
= .
The following six parameters define the relative positions
of the two coordinate systems
j j j
W V U and
k k k
Z Y X :
jk
a -
a distance from axis Wj to axis Zk which is measured along the
direction of tjk; tjk a common perpendicular between axes Wj
and Zk;
jk
o - an angle between positive directions of axes Wj
and Zk which is measured counter clockwise relatively to
positive direction of tjk; bjk - a distance from direction of tjk to
direction of the axis Xk which is measured along positive
direction of an axis Zk;
jk
| - an angle between positive
directions of tjk and axis Xk which is measured counter
clockwise relatively t positive direction of axis Zk; cjk- a
distance from direction of an axis Uj to direction of tjk which
is measured along positive direction of an axis Wj;
jk
- an
angle between positive directions of axis Uj and tjk which is
measured counter clockwise relatively to positive direction
of an axis Wj.
III. GENERATION OF JACOBIAN MATRICES
3PMCCC has same three legs of kind CCC. Lets consider
the i-th leg which has a kinematic chain
P O O O O O O OO
i i i i i i i 3
'
2 2
'
1 1
'
7 7
(Fig. 3). A loop-closure
equation for the kinematic chain
PO O O O O O O OO
i i i i i i i 3
'
2 2
'
1 1
'
7 7
can be written as
i i i i i i O P
i
g s a s a s r r + + + + + =
2 12 1 71 7
7
, 3 , 2 , 1 = i , (3)
Fig. 3. Geometry of the i-th leg of a PM 3CCC
where
(
(
(
(
=
(
(
(
(
=
(
=
(
P
P P
P P
P
P
P P
P
c
a
a
0
0 0
0 0
0 0
sin
cos
1
0
0
0
1
1 1
T
r
T
r
(4)
k
Y
) (
jk k
t
l
jk
o k
j
W //
jk
k
j
j
U
j
j
V
k
Z
j
W
Proceedings of the World Congress on Engineering 2012 Vol III
WCE 2012, July 4 - 6, 2012, London, U.K.
ISBN: 978-988-19252-2-0
ISSN: 2078-0958 (Print); ISSN: 2078-0966 (Online)
WCE 2012
=
(
=
(
= + = =
i
P P
i
i P i P i i
PO
g
T
g
a c g
1 1
0 2 2
'
2
=
(
(
(
(
=
(
(
(
(
i P
i P i P
i P i P
P i P P
c
a
a
2
2 2
2 2
0 2 0
sin
cos
1
0
0
0
1
T T T (5)
Differentiating (3) with respect to time, we obtain
+ + + + =
i i i i i i i i P
s s
12 1 1 1 7 7 7 7
a e r e r
3 , 2 , 1 ,
2 2
= + i s
i P i i
f e (6)
where | |
T
P P
P
T
P P P
P
W V
U
W V U
(
= =
0 0
0
, , , ,
0 0 0
0 0 0
r - a vector
of velocity of a point ;
i i i
s
7 7 7
e s = ,
i i i 7 7 7
e =u
-
vectors of velocity of the active joints;
i i i i 12 1 71 7
a s a r + + = ; ,
1 1 i i
s e
i i i 1 1 1
e =u
,
i i
s
2 2
e -
vectors of velocity of the passive joints;
| |
T
P P P P
W V U
0 0 0
, , e e e e = - a vector of angular velocity of a
mobile platform;
i i i i
PO
2 2
s g f = = .
Dot-multiplying both sides of (6) by
i 12
a leads to
+ = ) (
7 12 7 12 i
T
i i P
T
i
s e a r a
3 , 2 , 1 ), ( ) (
12 12 7 7 7
= + i
i i
T
P i i
T
i i
a f a r e e
(7)
Equation (7) can be presented in the matrix form
q J x J
q x
= (8)
by using the notation
| |
T
T
P
T
P
e , r x = , | |
T
s s s
73 73 72 72 71 71
, , , , , u u u
= q ,
where the Jacobian matrices J
x
and J
q
are defined as follows
,
) (
) (
) (
3 , 12 3 3 , 12
2 , 12 2 2 , 12
1 , 12 1 1 , 12
(
(
(
=
T T
T T
T T
a f a
a f a
a f a
J
x
T
T
T
T
T
T
T
(
(
(
(
(
(
(
(
(
=
) ( 0 0
0 0
0 ) ( 0
0 0
0 0 ) (
0 0
3 , 12 73 73
73 3 , 12
2 , 12 72 72
72 2 , 12
1 , 12 71 71
71 1 , 12
a r e
e a
a r e
e a
a r e
e a
J
q
IV. SINGULARITY ANALYSIS OF THE PM WITH 6 DOF
For a PM 3CCC the first type of singularity corresponds to
the case when the matrix J
q
has rank deficiency, i.e. when at
least the elements one of the rows of this matrix are zero.
Then shall be fulfilled the following conditions
0
7 12
=
i
T
i
e a , (9)
0 ) (
12 7 7
=
i i
T
i
a r e . (10)
From the first condition (9)
i
i
7
12
e a is followed i.e. the
vector
i 12
a determining the shortest distance between the
axes of passive cylindrical joints is perpendicular to the axis
of the input cylindrical joint. It is easy to see that this is
possible in cases
) if t o or 0
71
=
i
, in always, (11)
b) if t o < <
i 71
0 , in only 0
1
=
i
u or t . (12)
The case (11) defines the third type of singularity
configuration when a finite change of the coordinate s
7i
has
no effect on the movement of the platform (Fig. 4).
Fig. 4. The third type of singularity of the PM 3CCC
The case (12) implies that
i i 71 12
|| a a . At the same time the
condition (10) implies that the three vectors
i i i 12 7 7
, , a r e
must lie either in parallel planes or in the same plane. This
arrangement of these vectors, subject to (12) holds only when
the point
i
O
2
defining the end of the vector
i 7
r lies in the
plane
i i i
W U O
7 7
'
7
(this plane is denoted by o
i
) (Fig. 5).
'
7i
O
U
7
u
7i
a
71i
O
7i
||X
7i
Z
7i
, W
7i
O
1i
s
7i
a
12i
Z
1i
, W
1i
'
1i
O
'
2i
O
s
2i
O
2i
||X
7i
Proceedings of the World Congress on Engineering 2012 Vol III
WCE 2012, July 4 - 6, 2012, London, U.K.
ISBN: 978-988-19252-2-0
ISSN: 2078-0958 (Print); ISSN: 2078-0966 (Online)
WCE 2012
Fig. 5. The first type of singularity of the PM 3CCC
Since the vectors
i i 71 12
, a a determine the shortest
distance between the cylindrical joints, in this type of
configuration the i-th leg is fully stretched or folded position.
Therefore the set of Cartesian velocities of platform which
corresponds to the velocities of point
i
O
2
parallel to the
vectors
i i 71 12
, a a may not be reproduced. This set of the
Cartesian velocities is given by the set of rotation of platform
around an arbitrary line in the plane containing the point
i
O
2
and orthogonal to the vectors
i i 71 12
, a a . In addition,
any force applied to the platform and line of action which lies
in the o
i
, and a pair of forces applied parallel to this plane do
not affect the rotational component of the i-th cylindrical
actuator. This is explained by the fact that the moments of
force and a pair of forces with respect to the axis
i i
Z O
7 7
, i.e.
relative to the axis of rotation of the input joint are zero.
The second type of singularity occurs when matrix J
x
lacks
the range, that is when rows or columns of this matrix are
linearly dependent. This type of singularities in contrast to
the first is located inside the workspace. For the
corresponding configuration of the PM3CCC the nonzero
output Cartesian velocities x of the platform are displayed in
the zero vector by conversion J
x
. These speeds of platform
are possible even in still actuators of input joints. Lets
rewrite the matrix J
x
in the form
(
(
(
=
Z Y X Z Y X
Z Y X Z Y X
Z Y X Z Y X
n n n a a a
n n n a a a
n n n a a a
3 3 3 3 , 12 3 , 12 3 , 12
2 2 2 2 , 12 2 , 12 2 , 12
1 1 1 1 , 12 1 , 12 1 , 12
x
J , (13)
where the elements of the first three columns are the
components of one group of vectors
i 12
a , and elements of
the last three columns - the second group of components of
the vectors
i i i 12
a f n = relative to an inertial coordinate
system, i.e.
T
iZ iY iX i
a a a ] , , [
12 12 12 12
= a ,
T
iZ iY iX i i i
n n n ] , , [
12
= = a f n , 3 , 2 , 1 = i ., (14)
For definiteness assume that the vectors
i
g lie in a plane
perpendicular to the axes of the platform and kinematic
cylindrical joints of platform.
Consider the case where the three columns of vectors are
linearly dependent. This case means that all the vectors of
this group are parallel to each other and parallel to a common
plane.
Lets assume without proof the the following theorem.
Theorem. Two vectors laying in different and mutually
intersecting planes are parallel if and only if each of these
vectors are parallel to the line along which their planes are
intersected.
The statement 1. The parallelism of all vectors
i
n ,
3 , 2 , 1 = i is possible only if each of these vectors are parallel
to the axis PZ
P
of the coordinate system PX
P
Y
P
Z
P
associated
with the mobile platform.
This statement means that in this case the vectors
i
f
and
i 12
a , 3 , 2 , 1 = i according to the definition of the vector
product of two vectors must lie in the plane
. Then all
cylindrical joints axis of the platform must also lie in the
plane
12,1
P
12,2
12,3
g
3
g
1
X
P
Y
P
Z
P
g
1
12,1
P
g
2
12,2
g
3
12,3
Proceedings of the World Congress on Engineering 2012 Vol III
WCE 2012, July 4 - 6, 2012, London, U.K.
ISBN: 978-988-19252-2-0
ISSN: 2078-0958 (Print); ISSN: 2078-0966 (Online)
WCE 2012