Professional Documents
Culture Documents
1, FEBRUARY 2009
Abstract—This paper deals with the experimental study of a redundantly actuated parallel manipulators such that only a few
redundantly actuated parallel manipulator for a 5-DOF hybrid control strategies have been proposed. For example, Muller [9]
machine tool. Based on the kinematics of the redundantly actu- developed an open-loop preload control and applied it to the
ated parallel manipulator, the inverse dynamics is derived by using
the virtual work principle. A position and force switching control elimination of backlash for redundantly actuated parallel ma-
strategy is used for the two extendible chains of the parallel ma- nipulators. Chakarov [10] developed a stiffness control scheme
nipulator. Further, the difference predictive control is presented of parallel manipulators with actuation redundancy. Ganovski
for the extendible chain with force mode. The parallel manipula- et al. [11] introduced a feedforward controller to control the re-
tor is incorporated into a 5-DOF hybrid machine tool. Linear and dundantly actuated parallel mechanisms. Liu et al. [12] looked at
circular contouring experiments of both the hybrid machine tool
as well as its corresponding nonredundant counterpart with the both kinematic and dynamic control algorithms for redundantly
redundant limb removed are conducted to evaluate the machine actuated parallel manipulators [13]. Fang [14] adopted feedfor-
performance. Finally, the machine experiment is used to demon- ward control for a tendon-based parallel manipulator. However,
strate the machine’s applicability. these control methods were tested only by simple tests or com-
Index Terms—Actuation redundancy, parallel manipulator, po- puter simulation experiments. Further, the experimental results
sition and force switching control, predictive control. of some control methods were not ideal. Although the advan-
tages of actuation redundancy have been discussed widely in
theory, there is lack of experimental study to verify these ad-
I. INTRODUCTION
vantages.
ARALLEL manipulators have been studied intensely by
P many researchers [1], [2]. The reason is their advantages
compared to serial ones. However, like every other type of mech-
In this paper, the experimental study of a 3-DOF redundantly
actuated parallel manipulator is investigated. Based on the dy-
namic formulation of the redundant parallel manipulator, the
anism, these manipulators have some drawbacks, which include position and force switching control method is presented for the
small workspace, reduced dexterity, and abundant singularity. two extendible chains. Further, the difference predictive con-
Most of the research that has been done for parallel manipulators trol is presented for the extendible chain with force mode. The
has focused on nonredundant manipulators [3]. Redundant par- control strategies are applied to the control system. Finally, a
allel manipulators have been designed to overcome some of the set of experiments including circular contouring experiments,
aforementioned disadvantages of parallel manipulators, such as positioning accuracy, and cutting test are conducted to evalu-
robot hands [4], wrist [5], and parallel machining centers [6]. ate the hybrid machine performance. The experimental results
The use of redundant actuation also gives rise to more homoge- show that the hybrid machine tool is suitable for machining the
neous output forces and minimized internal loading torques of blades of gas turbines.
the actuators of a manipulator [7].
A redundantly actuated manipulator is a manipulator with
more actuators than the required number of controlled DOFs. II. STRUCTURE DESCRIPTION AND KINEMATICS ANALYSIS
As more actuators are added, the generating internal forces are A. Structure Description
possibly introduced, which lead to challenging control issues.
The redundantly actuated parallel manipulator is composed of
It means that the use of mere position control is no longer
a gantry frame, a moving platform, two constant length chains,
possible [8]. At present, there are only a few prototypes of
and two extendible chains, as shown in Fig. 1. Two sliders drive
two constant length chains when they slide along the vertical
Manuscript received January 15, 2008; revised May 2, 2008 and October 16,
guideways. The whole construction enables movement of the
2008. Current version published February 13, 2009. Recommended by Tech-
nical Editor S. Chiaverini. This work was supported in part by the Scientific moving platform in two directions (Y - and Z-axes) and its rota-
and Technical Supporting Program under Grant 2006BAF01B09, in part by the tion about the axis norm to the O–YZ-plane. From the viewpoint
China Postdoctoral Science Foundation, and in part by the National 973 Pro-
of mechanism, only one extendible chain is enough for the ma-
gram of China under Grant 2006CB705400.
The authors are with the Department of Precision Instruments and nipulator to be capable of the rotational motion. The reason
Mechanology, Tsinghua University, Beijing 100084, China (e-mail: wu-j03@ behind adding an additional extendible link is to introduce the
mails.tsinghua.edu.cn).
advantages of redundant mechanisms to the parallel manipula-
Color versions of one or more of the figures in this paper are available online
at http://ieeexplore.ieee.org. tor. In practical application, the spindle unit is an electric spindle
Digital Object Identifier 10.1109/TMECH.2008.2008096 and a cutter is mounted on the end of the main spindle.
1083-4435/$25.00 © 2009 IEEE
WANG et al.: EXPERIMENTAL STUDY OF A REDUNDANTLY ACTUATED PARALLEL MANIPULATOR FOR A 5-DOF HYBRID MACHINE TOOL 73
Fig. 1. Kinematic model. where l6 is the distance between joint points E1 and D1 , qi =
zD i , yB 1 = y − sin αd0 − l5 sin α, and zB 1 = z + cos αd0 +
l5 cos α. It can be concluded that when one of chains A1 D1 and
B. Inverse Kinematics A2 D2 is in a horizontal position and/or chain A1 D1 is parallel
to chain A2 D2 , singularity occurs. To avoid the singularity, it is
The kinematic model of the parallel manipulator is shown in
obvious that 0 < |βi | , |φi | < π/2. Thus, the “±” of (5) should
Fig. 1. The base coordinate system O–YZ is identical to the real
be only “+.”
machine coordinate system of the hybrid machine tool such that
the kinematic and dynamic models can be applied directly to
C. Jacobian Matrix
the control system. The base coordinate system is placed in the
center of the machine. A moving coordinate system ON –YN ZN The velocity of point Ai can be expressed as
is fixed at the tip point of cutter with the ZN -axis along the vector
vA i = v + ω × RrN N
A i = v + α̇ERrA i , i = 1, 2 (6)
from point A2 to B2 . Let the position vector of the cutter center
point be rO N = [ y z ]T in the base coordinate system. The where v is the velocity of the cutter center point with respect to
position vector of point Ai and Bi (i = 1, 2) can be expressed O–YZ , ω is the angular velocity of the
moving platform with
as 0 −1
respect to O–Y Z, and E = .
1 0
rA i = [yA i zA i ]T = rO N + RrN
Ai, i = 1, 2 (1) Similarly, the velocity of point Bi can be obtained as
rB i = [yB i zB i ]T = rO N + RrN
Bi, i = 1, 2 (2) vB i = v + α̇ERrN
Bi, i = 1, 2. (7)
where R is the rotation matrix Taking the time derivative of (3) and (4) leads to
from coordinate system
cos α sin α ẏA i
ON –YN ZN to O–YZ and R = , where α β̇i = (8)
− sin α cos α (l cos βi )
is the rotation angle of the moving platform, rN N
A i and rB i
are the position vectors of points Ai and Bi in ON –YN ZN , q̇i = żD i = żA i − l sin βi β̇i (9)
T T
rN N
A i = [ 0 d0 ] , and rB i = [ 0 d0 + l5 ] , l5 is the length of l˙i = ẏB i sin φi + (q̇i − żB i ) cos φi (10)
the moving platform, and d0 is the cutter length.
From Fig. 1, the following equations can be obtained: [ẏB i cos φi − (q̇i − żB i ) sin φi ]
φ̇i = . (11)
li
yB i − yE i zE i − zB i Equation (9) can be rewritten as
sin φi = cos φi = , i = 1, 2 (3)
li li
sin βi sin βi
yA i − yD i zD i − zA i q̇i = − ẏ + ż − sin α + cos α do α̇ = Ji ṗ
sin β i = cos β i = , i = 1, 2 (4) cos βi cos βi
l l
(12)
where φi is the angle between chain Ei Bi and a vertical axis where
parallel to the Z-axis, 0 ≤ φ1 ≤ π, −π ≤ φ2 ≤ 0; βi is the sin βi sin βi
angle between chain Ai Di and a vertical axis parallel to the Ji = − 1 − sin α + cos α do
cos βi cos βi
Z-axis, 0 ≤ β1 ≤ π, −π ≤ β2 ≤ 0; d is the distance between
two columns, qi and z B i are the Z coordinates of points Di and ṗ = [ ẏ ż α̇ ]T .
Bi , respectively; li is the length of the ith extendible chain; l is Equation(10) can be rewritten as
the length of the constant length chain; and y E i , y D i , and y B i
are the Y coordinates of points Ei , Di , and Bi in O–YZ . l˙i = Ji+2 ṗ (13)
74 IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 14, NO. 1, FEBRUARY 2009
where Let Hi3 , Hi4 , Hi5 , and HN denote the partial velocity matrix of
T point Ei , Bi , mass center of the counterweight, and point ON ,
Ji+2 = [ sin φi − cos φi ] [ e1 e2 ] +ERrN T
B i e3 +Ji cos φi ,
and Gi3 , Gi4 , Gi5 , and GN denote the partial angular velocity
T T T matrix of the upper part and the lower part of chain Ei Bi ,
e1 = [ 1 0 0 ] , e2 = [ 0 1 0 ] , e3 = [ 0 0 1 ] .
counterweight, and moving platform that can be achieved in the
The velocity equation of the redundant parallel manipulator same way.
can be written in the form
q̇ = Jṗ (14) B. Inertia Forces and Moments of Moving Parts
where q̇ = [ q̇1 q̇2 l˙1 l˙2 ]T , and J is the inverse kinematic Taking the time derivative of (8)–(11), the angular accelera-
Jacobian matrix. tions β̈i and φ̈i , and the accelerations q̈i and ¨li can be deter-
Thus, the inverse kinematic Jacobian matrix of the redun- mined. Thus, the accelerations of point Ei and Di can be written
dantly actuated parallel manipulator can be expressed as as
In order to obtain a more compact form of the dynamic model Fi1 = −mi1 (aEi − g) Mi1 = 0 (23)
for real-time implementation in the control system, the virtual where mi1 is the mass of slider Ei Di , Mi1 is the moment of the
work principle is employed to derive the dynamic model. Thus, slider, and g is the gravitational acceleration vector.
the partial velocity and partial angular velocity matrices [15], The inertia force and moment of the constant length chain
which are used in dynamic modeling, should be determined. about point Di can be expressed as
Based on the mapping relationship shown in (14), the partial
velocity matrix can be derived as sin βi
Fi2 = −mi2 aD i + si2 β̈i E
T − cos βi
∂vq i ∂vq i ∂vq i
Hi = ··· (16) sin βi
∂ ṗ1 ∂ ṗ2 ∂ ṗn −si2 β̇i
2
−g (24)
− cos βi
where vq i is the pivotal point velocity, pn is the Cartesian coor-
dinate, and n is the DOF number of a manipulator. Mi2 = −β̈i Ii2 +mi2 si2 [ sin βi − cos βi ] E (aD i − g) (25)
Accordingly, the partial angular velocity can be derived as where mi2 is the mass of the constant length chain Ai Di , Mi2
T is the moment of the constant length chain, si2 is the distance
∂ω q i ∂ω q i ∂ω q i
Gi = ··· (17) between the mass center of the constant length chain and point
∂ ṗ1 ∂ ṗ2 ∂ ṗn
Di , and Ii2 is the moment of inertia of chain Ai Di about point
where ω q i is the angular velocity of ith rigid body. Di .
To find the partial velocity matrix, a pivotal point should be Here, we suppose that Fi3 , Mi3 , Fi4 , Mi4 , Fi5 , Mi5 , FN ,
selected. In this paper, the point Ei is regarded as the pivotal and MN denote the inertia force and moment of the upper part
point of the slider and the upper part of the extendible chain. of chain Ei Bi about point Ei , inertia force and moment of
Points Bi , Di , and A1 are the pivotal points of the lower part of the lower part of chain Ei Bi about point Bi , inertia force and
the extendible chain, the constant length chain, and the moving moment of the counterweight about its mass center, and inertia
platform in modeling, respectively. force and moment of the moving platform about point ON ,
Since the slider has only the translational capability, the partial respectively. Accordingly, Fi3 , Mi3 , Fi4 , Mi4 , Fi5 , Mi5 , FN ,
angular velocity matrix is given by and MN can be determined.
Gi1 = 0. (18)
C. Dynamic Model
According to (9), the partial velocity matrix of point Ei can be
expressed as Based on the virtual work principle, the dynamic formula-
tion of the redundantly actuated parallel manipulator can be
Hi1 = [ 0 1 ]T Ji . (19) expressed as
Based on (9) and (11), the partial angular velocity matrix of the
2
5
T Fij Fij
constant length chain and partial velocity matrix of point Di can JT τ + Hij GTij + HTN GTN =0
Mij Mij
be written as i=1 j =1
(26)
1
Gi2 = 0 [ e1 e2 ]T + ERrN T
A i e3 (20) where τ = [ F1 F2 F3 F4 ]T , F1 , F2 , F3 , and F4 are the
cos βi l driving forces that act on sliders E1 D1 and E2 D2 , extendible
Hi2 = Hi1 . (21) chains E1 B1 and E2 B2 , respectively.
WANG et al.: EXPERIMENTAL STUDY OF A REDUNDANTLY ACTUATED PARALLEL MANIPULATOR FOR A 5-DOF HYBRID MACHINE TOOL 75
Since the parallel manipulator has one redundant actuator The difference between the force computed by the dynamic
and JT is nonsquare, the driving force τ in (26) has infinite model and that from the force sensor can be expressed as
solutions. Let
eF (t) = Ft (t) − Fa (t) (29)
2
5
Fij Fij where Ft (t) is the computed force at time step t, Fa (t) is the
Ω=− HTij GTij − HTN T
GN .
i=1 j =1
Mij Mij feedback force from the force sensor at time step t, and eF (t)
is the difference between Ft (t) and Fa (t).
To obtain a unique solution, by using the least-square method, In the difference predictive control, the input force of the
the solution of (24) is determined by extendible chain with force mode at time step t + T can be
expressed as
−1
τ = J JT J Ω. (27)
Fi (t + T ) = Ft (t + T ) + eF (t) (30)
IV. DIFFERENCE PREDICTIVE CONTROL where Fi (t + T ) is the input force of the chain with force mode
at time step t + T .
If all kinematic chains are controlled by the position mode,
the interference among the two extendible chains and the mov- V. APPLICATION OF DIFFERENCE PREDICTIVE CONTROL
ing platform will be caused since there is a difference between
the actual length of the chain and desired length due to manu- A. Position and Force Switching Control
facturing error. Thus, great internal forces are introduced. As a From the earlier analysis, it can be seen that the control strat-
result, the use of mere position control is no longer possible for egy that chain E1 B1 is controlled by the force mode and chain
the parallel manipulator with actuation redundancy. E2 B2 is the position mode is feasible. However, this control
When only the redundant servomotor rotates and other ser- strategy cannot be implemented in the whole workspace. The
vomotors are locked, the moving platform cannot move unless reasons are as follows. The configuration that chain E2 B2 and
the machine reaches its singular configuration. Thus, actuation the moving platform A2 B2 are collinear is the singular config-
redundancy is force redundancy in some sense. A simple and uration of the nonredundant manipulator without chain E1 B1 .
effective control strategy for the redundantly actuated parallel Although the singular configuration cannot occur in the redun-
manipulator is that the redundant chain is controlled by the dant manipulator, it is very difficult to assure the position ac-
force mode and other chains by the position mode. When the curacy of chain E2 B2 with position mode when the redundant
manipulator reaches the configuration that chain E2 B2 and manipulator is near the configuration. In order to pass the con-
the moving platform A2 B2 are collinear, the redundant chain figuration, a force, which is provided by chain E1 B1 , should act
can drive chain E2 B2 to pass the configuration. Moreover, there on the joint point B1 (B2 ). But the position accuracy of chain
are clearance, deflection, and vibration in the manipulator. The E1 B1 cannot be assured by the force mode such that the motion
internal force of redundant chain can be utilized effectively to accuracy of the manipulator near this configuration is worse.
optimize them. In order to ensure the position and orientation accuracy of
The input of the redundant chain with force mode is the force the redundant manipulator and pass the configuration that chain
computed by the inverse dynamic model. However, the actual E1 B1 or E2 B2 and the moving platform A2 B2 are collinear, a
internal force does not equal the force from dynamic model position and force switching control strategy is proposed for the
due to clearance and deformation of the redundant chain. In redundantly actuated parallel manipulator. In this control strat-
addition, in the discrete system, there is often a one-period time egy, the two extendible chains are controlled by the position and
delay for the actuator that also causes the difference between force modes, respectively. When one of the extendible chains
the computed force and the actual force. reaches or approaches the configuration that it and the moving
Difference predictive control is proposed for planning the platform A2 B2 are collinear, the extendible chain is controlled
input force of the redundant chain with force mode [16]. The by the force mode and the other extendible chain is the position
difference between the driving force computed by the dynamic mode. At one time, one of the extendible chains is the force
model in the current period and the actual force from the force mode and the other chain must be the position mode. The differ-
sensor is regarded as one part of the input force in the next ence predictive control is applied to the extendible chain with
period. Namely, the input force of the chain with force mode is force mode.
the sum of the force computed by the dynamic model at current
time step and the difference between the computed force at the
B. Critical Angle for Switching the Control Modes
last time step and feedback force at the last time step.
Let the sample period for sampling the feedback force be T in It can be concluded that the control mode of each extendible
the discrete system. Then, the time step at each sampling point chain will change in the whole workspace. This involves the crit-
can be expressed as ical value of α where the control modes of the extendible chains
are switched. Since the redundant manipulator is symmetrical,
t = t0 + kT, k = 0, 1, 2, . . . (28) it would be ideal to select α = 0 as the critical angle. However,
if α = 0 is the critical angle, the switching of control modes
where t0 is the time at the starting sample point. would be much more frequent since the manipulator may have
76 IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 14, NO. 1, FEBRUARY 2009
TABLE I module of the control system, the theoretical length in the cur-
CONDITION FOR SWITCHING CONTROL MODES
rent interpolation period is regarded as the benchmark to plan
the length of extendible chain in the next period. Thus, in one
period, it is possible that the extendible chain lengthens/shortens
a long distance to the theoretical length when the control mode
changes from force mode to position mode. If the moving dis-
tance of the extendible chain is larger than the allowable value
in one period, the control system does not permit the extendible
chain to move. Therefore, after the control mode of the ex-
tendible chain changes from the force mode to position mode,
the difference between the theoretical length and actual length
a reciprocating motion in α = 0. Furthermore, the switching of of the extendible chain should be compensated. It is aimed to
control mode brings different reference benchmarks for posi- adjust the extendible distance of the extendible chain in a few
tion mode and results in some errors that are caused by different periods such that the actual length approaches the theoretical
benchmarks. length.
Thus, the critical angle for switching the control modes should Let the actual length and theoretical length of the extendible
be planned to reduce the switching number of the control mode. chain with force mode be l0 and lT . Then, the difference be-
In the meantime, the configuration in the critical angle should tween l0 and lT can be expressed as
be far from the configuration that chain E1 B1 or E2 B2 and
el = lT − l0 . (31)
the moving platform A2 B2 are collinear. In addition, consid-
ering the symmetry of the parallel manipulator, the critical an- The lengthened or shortened length of the chain in one interpo-
gles should be symmetrical about the Z-axis. Based on these lation period can be written as
considerations, in this paper, three critical angles are specified.
Namely, α = 0, α = 5◦ , and α = −5◦ . It should be pointed out l∆ = vT (32)
that the control modes are not always switched when the moving
platform rotates to one of the critical angles. where l∆ is the lengthened or shortened length, v is the moving
The numerical control system of the redundantly actuated velocity, and T is the interpolation period.
parallel manipulator can be divided mainly into postprocessing, In one period, the maximum lengthened or shortened length
trajectory planning, interpolation, and real-time module. In tra- can be written as
jectory planning phase, an input trajectory may be separated into lm ax = vm ax T (33)
many trajectory segments. It is necessary to determine whether
the control modes of the extendible chains in each trajectory where vm ax is the maximum moving velocity that can be given
segment should be switched. The switching of control modes is in the servodriver.
related to the control mode of the last trajectory segment, the In one period, the difference between the maximum ex-
start value αs , and the end value αe of the rotation angle α in tendible length and actual extendible length of the extendible
the current trajectory segment. The switching rule is given as chain can be expressed as
follows.
1) The control mode remains unchanged when the rotation e∆ = lm ax − l∆ . (34)
angle α ranges from −5◦ to 5◦ . In this range, the orienta-
If the control modes are switched when l0 < lT and the ex-
tion has little effect on the performance of the redundant
tendible chain would lengthen, the chain should move with the
parallel manipulator.
maximum velocity vm ax in the n1 periods after the control
2) When α > 5◦ , chain E1 B1 is controlled by the force
modes are switched. The variable n1 can be expressed as
mode and chain E2 B2 is the position mode. On the con-
trary, chain E1 B1 is the position mode and chain E2 B2 is |el |
the force mode when α < −5◦ . n1 = . (35)
e∆
3) When the chain E1 B1 is controlled by the force mode, it
is assumed that m = 1. The position mode corresponds to The moving distance in the (n1 + 1)th period can be expressed
m = −1. as
According to the aforementioned rules, the condition for
s1 = vT + |el | − n1 (vm ax T − vT ) . (36)
switching the control modes is determined as shown in Table I.
On the contrary, if the control modes are switched when l0 < lT
C. Position Compensation and the chain would shorten, the extendible chain should not
move in n2 periods after the control modes are switched. The
When the extendible chain is under force mode, the length-
variable n2 can be expressed as
ened or shortened deformation would be produced such that
there is a difference between the theoretical length of extendible |el |
chain and actual length. In the trajectory plan and interpolation n2 = . (37)
vT
WANG et al.: EXPERIMENTAL STUDY OF A REDUNDANTLY ACTUATED PARALLEL MANIPULATOR FOR A 5-DOF HYBRID MACHINE TOOL 77
C. Cutting Tests
Cutting tests are used to assess the behavior of the machine
during the actual cutting operations. A cutting test that machines
a blade of gas turbine has been conducted. The raw materials
are a cuboid workpiece with stainless steel. Fig. 12 shows the
machined blade with roughing cut.
In conclusion, the contour error and bidirection repeata- Fig. 11. Bidirection repeatability of Z -axis of redundant hybrid machine tool.
bility of the hybrid machine tool are similar to that of its (a) P z 1 . (b) P z 2 .
80 IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 14, NO. 1, FEBRUARY 2009
Jinsong Wang received the B.S., M.S., and Ph.D. Zheng You received the B.S., M.S., and Ph.D. de-
degrees in mechanical engineering from Tsinghua grees in instruments science and technology from
University, Beijing, China, in 1986, 1988, and 1990, Huazhong University of Science and Technology,
respectively. Wuhan, China, in 1985, 1987, and 1990, respectively.
From 1997 to 1998, he was a Visiting Professor From 1990 to 1992, he was a Postdoctoral
at the University of Michigan, Ann Arbor. He is cur- Researcher in the Department of Precision In-
rently a Professor and the Vice President of Tsinghua struments and Mechanology, Tsinghua University,
University. His current research interests include ad- Beijing, China, where he is currently a Professor
vanced manufacturing technology, robots, and green and the Dean. His current research interests in-
manufacturing. clude micronanotechnology and micronanosatellite
technology.