ieee/asme transactions on mechatronics, vol. 13, …

10
IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, NO. 4, AUGUST 2008 441 Adaptive Robust Posture Control of Parallel Manipulator Driven by Pneumatic Muscles With Redundancy Xiaocong Zhu, Guoliang Tao, Bin Yao, Member, IEEE, and Jian Cao Abstract—This paper presents an adaptive robust posture con- troller for a parallel manipulator driven by pneumatic muscles (PMDPM) with a redundant DOF. Rather severe parametric un- certainties and uncertain nonlinearities exist in the dynamics of the PMDPM. To deal with these uncertainties effectively, the recently developed adaptive robust control strategy is applied. Further- more, the developed control strategy explicitly takes into account the particular physical properties of the system studied. Specifi- cally, the symmetric geometric structure of the parallel manipu- lator driven by identical pneumatic muscles and no external mo- ments around symmetry-axis direction of the parallel manipulator make the rotation angle of the parallel manipulator around its symmetry axis direction negligible and a nonfactor during normal operations. As such, the axial rotation angle is not measured and controlled when the PMDPM are used in practice, leading to a single-DOF redundancy in synthesizing the precise posture con- troller for rotation angles around other axes. To make full use of this redundancy, an equivalent average-stiffness-like desired con- straint is introduced in the development of the adaptive robust posture controller to achieve precise posture tracking while reduc- ing control input chattering caused by measurement noise. Exper- imental results are obtained to verify the validity of the proposed controller for the redundant PMDPM. Index Terms—Adaptive robust control (ARC), parallel manipu- lator, pneumatic muscle, redundancy, uncertainties. I. INTRODUCTION P NEUMATIC muscle is made up of a flexible rubber tube braided with cross-weave sheath material and two connec- tion flanges. When the rubber tube is inflated with compressed air, the cross-weave sheath experiences lateral expansion, re- sulting in axial contractive force and the change of the end point position of pneumatic muscle. Thus, the position or force control of the pneumatic muscle along its axial direction can be real- ized by regulating the inner pressure of its rubber tube [1]. The Manuscript received January 21, 2007; revised January 30, 2008. Published August 13, 2008 (projected). Recommended by Technical Editor Z. Lin. This work was supported by the National Natural Science Foundation of China (NSFC) (50775200). The work of B. Yao was supported by the NSFC under the Joint Research Fund (50528505) for Overseas Chinese Young Scholars. The material in this paper was presented in part at the 2007 American Control Conference, New York, NY, July 11–13, 2007. X. Zhu, G. Tao, and J. Cao are with the State Key Laboratory of Fluid Power Transmission and Control, Zhejiang University, Hangzhou 310027, China (e-mail: [email protected]; [email protected]; caojianjiaowang@ sina.com.cn). B. Yao is with the State Key Laboratory of Fluid Power Transmission and Control, Zhejiang University, Hangzhou 310027, China, and also with Purdue University, West Lafayette, IN 47907-2040 USA (e-mail: [email protected]). Color versions of one or more of the figures in this paper are available online at http://ieeexplore.ieee.org. Digital Object Identifier 10.1109/TMECH.2008.2000825 Fig. 1. Structure of the PMDPM. parallel manipulator driven by pneumatic muscles (PMDPM) studied in this paper consists of three pneumatic muscles con- necting the moving platform of the parallel manipulator to its base platform, as shown in Fig. 1. By controlling the lengths of three pneumatic muscles, 3 DOF rotation motion of the par- allel manipulator can be realized. Such a parallel manipulator combines the advantages of compact structure of parallel mech- anisms with the adjustable stiffness and a high power/volume ratio of pneumatic muscles, which will have promising applications in robotics, industrial automation, and bionic devices [2]. Due to the symmetric geometric structure of the parallel ma- nipulator, the identical properties of the pneumatic muscles used, and no external moments around symmetry-axis direc- tion of the parallel manipulator (i.e., z-axis in Fig. 1) acting on the moving platform, the rotation angle around z-axis is nearly close to zero during normal operations. Thus, this angle is not measured and controlled to save cost when using these types of parallel manipulators in practice, leading to a DOF redun- dancy in synthesizing posture controllers for the rotation angles around the other two axes. Such an added design freedom is not utilized in our previous study where an adaptive robust posture controller was developed for the PMDPM [3]. To make full use of this redundancy when the precise control of the rotation angle around z-axis is not needed, this paper will introduce an equiv- alent average-stiffness-like desired constraint in the adaptive 1083-4435/$25.00 © 2008 IEEE

Upload: others

Post on 01-Dec-2021

4 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, …

IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, NO. 4, AUGUST 2008 441

Adaptive Robust Posture Control of ParallelManipulator Driven by Pneumatic

Muscles With RedundancyXiaocong Zhu, Guoliang Tao, Bin Yao, Member, IEEE, and Jian Cao

Abstract—This paper presents an adaptive robust posture con-troller for a parallel manipulator driven by pneumatic muscles(PMDPM) with a redundant DOF. Rather severe parametric un-certainties and uncertain nonlinearities exist in the dynamics of thePMDPM. To deal with these uncertainties effectively, the recentlydeveloped adaptive robust control strategy is applied. Further-more, the developed control strategy explicitly takes into accountthe particular physical properties of the system studied. Specifi-cally, the symmetric geometric structure of the parallel manipu-lator driven by identical pneumatic muscles and no external mo-ments around symmetry-axis direction of the parallel manipulatormake the rotation angle of the parallel manipulator around itssymmetry axis direction negligible and a nonfactor during normaloperations. As such, the axial rotation angle is not measured andcontrolled when the PMDPM are used in practice, leading to asingle-DOF redundancy in synthesizing the precise posture con-troller for rotation angles around other axes. To make full use ofthis redundancy, an equivalent average-stiffness-like desired con-straint is introduced in the development of the adaptive robustposture controller to achieve precise posture tracking while reduc-ing control input chattering caused by measurement noise. Exper-imental results are obtained to verify the validity of the proposedcontroller for the redundant PMDPM.

Index Terms—Adaptive robust control (ARC), parallel manipu-lator, pneumatic muscle, redundancy, uncertainties.

I. INTRODUCTION

PNEUMATIC muscle is made up of a flexible rubber tubebraided with cross-weave sheath material and two connec-

tion flanges. When the rubber tube is inflated with compressedair, the cross-weave sheath experiences lateral expansion, re-sulting in axial contractive force and the change of the end pointposition of pneumatic muscle. Thus, the position or force controlof the pneumatic muscle along its axial direction can be real-ized by regulating the inner pressure of its rubber tube [1]. The

Manuscript received January 21, 2007; revised January 30, 2008. PublishedAugust 13, 2008 (projected). Recommended by Technical Editor Z. Lin. Thiswork was supported by the National Natural Science Foundation of China(NSFC) (50775200). The work of B. Yao was supported by the NSFC underthe Joint Research Fund (50528505) for Overseas Chinese Young Scholars.The material in this paper was presented in part at the 2007 American ControlConference, New York, NY, July 11–13, 2007.

X. Zhu, G. Tao, and J. Cao are with the State Key Laboratory of FluidPower Transmission and Control, Zhejiang University, Hangzhou 310027,China (e-mail: [email protected]; [email protected]; [email protected]).

B. Yao is with the State Key Laboratory of Fluid Power Transmission andControl, Zhejiang University, Hangzhou 310027, China, and also with PurdueUniversity, West Lafayette, IN 47907-2040 USA (e-mail: [email protected]).

Color versions of one or more of the figures in this paper are available onlineat http://ieeexplore.ieee.org.

Digital Object Identifier 10.1109/TMECH.2008.2000825

Fig. 1. Structure of the PMDPM.

parallel manipulator driven by pneumatic muscles (PMDPM)studied in this paper consists of three pneumatic muscles con-necting the moving platform of the parallel manipulator to itsbase platform, as shown in Fig. 1. By controlling the lengthsof three pneumatic muscles, 3 DOF rotation motion of the par-allel manipulator can be realized. Such a parallel manipulatorcombines the advantages of compact structure of parallel mech-anisms with the adjustable stiffness and a high power/volumeratio of pneumatic muscles, which will have promisingapplications in robotics, industrial automation, and bionicdevices [2].

Due to the symmetric geometric structure of the parallel ma-nipulator, the identical properties of the pneumatic musclesused, and no external moments around symmetry-axis direc-tion of the parallel manipulator (i.e., z-axis in Fig. 1) acting onthe moving platform, the rotation angle around z-axis is nearlyclose to zero during normal operations. Thus, this angle is notmeasured and controlled to save cost when using these typesof parallel manipulators in practice, leading to a DOF redun-dancy in synthesizing posture controllers for the rotation anglesaround the other two axes. Such an added design freedom is notutilized in our previous study where an adaptive robust posturecontroller was developed for the PMDPM [3]. To make full useof this redundancy when the precise control of the rotation anglearound z-axis is not needed, this paper will introduce an equiv-alent average-stiffness-like desired constraint in the adaptive

1083-4435/$25.00 © 2008 IEEE

Page 2: IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, …

442 IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, NO. 4, AUGUST 2008

robust posture controller design to improve posture control per-formance while reducing control input chattering caused bymeasurement noise.

The utilization of adjustable stiffness concept in the controlof pneumatic muscle systems is not new and has received greatattention recently. Specifically, Sui et al. analyzed the dynamicand static stiffness of both single pneumatic muscle and antago-nistic muscle actuators [4]. Tondu and Lopez explained the nat-ural compliant characteristics (associated with stiffness) of theactuator consisting of two pneumatic muscles set in antagonismand verified such feature by experiments on a 2 DOF selectivecompliant assembly robot arm (SCARA) robot prototype [5].Liu and Zong presented the stiffness control on a manipulatordriven by rubber actuators through adjusting p0 and ∆p, andfurthermore, studied the compliance control of a five-bar par-allel manipulator driven by rubber actuators [6], [7]. Toniettiand Bicchi employed the adaptive simultaneous position andstiffness control for a serial robot arm driven by antagonisticpneumatic muscles [8]. van der Linde [9] and Hildebrandt et al.[10], respectively, developed some optimization strategies onthe adjustable stiffness of two opposite pneumatic muscles.

In the earlier pneumatic muscle systems with a single or an-tagonistic muscles, the average pressure scalar with respect tothe entire stiffness of the system is adjusted to improve perfor-mance. However, especially for the PMDPM, not only it is verydifficult to control the posture precisely in the presence of var-ious parametric uncertainties and uncertain nonlinearities thatare inherited to the pneumatic muscle system, but also there areadded difficulties in utilizing the adjustable stiffness in the pos-ture controller for the PMDPM with multi-input multi-output(MIMO) complex dynamics since it requires finding a uniformequivalent average stiffness scalar from the inherent multiple-dimension coupling stiffness matrix of the PMDPM.

In this paper, the adaptive robust control (ARC) strategy[11]–[13] is used to effectively deal with large extent of para-metric uncertainties and uncertain nonlinearities to achieve ac-curate posture tracking control. In addition, with the guaranteedsmall tracking errors of the proposed adaptive robust posturecontroller, the method of adjusting the prior equivalent averagestiffness is developed to eliminate the redundant DOF as wellas to reduce control input chattering caused by measurementnoise.

II. PRINCIPLE OF POSTURE CONTROL WITH

A REDUNDANT DOF

A. Dynamics of the PMDPM With Redundancy

The PMDPM is shown in Fig. 1, which consists of a movingplatform, a base platform, a central pole, and three pneumaticmuscles connected by six ball joints that are evenly distributedon the respective platforms [2]. Define the posture vector asθ = [θx, θy , θz ]T and the pressure vector as p = [p1 , p2 , p3 ]T ,then the dynamics of the parallel manipulator is [3]

M a(θ)θ + Ca(θ, θ)θ + Ga(θ)

+ F fa(θ, θ) + dta(θ, θ, t) = τ a (1)

where θ, θ, θ ∈ R3 are the posture vector, velocity vector, andacceleration vector of the parallel manipulator, respectively,M a(θ) is the 3 × 3 rotational inertia matrix, Ca(θ, θ)θ isthe 3-vector of centripetal and Coriolis torques [with Ca(θ, θ)being a 3 × 3 matrix], F fa(θ, θ) refers to all kinds of fric-tion force torques originating from the pneumatic muscles andspherical joints, Ga(θ) is the 3-vector of gravitational torques,dta(θ, θ, t) is the disturbance vector in task space, and τ a is thecalculable 3-vector of torques acting on the parallel manipulator,which is given by

τ a = JTa (θ)F m (2)

where Ja(θ) is the Jacobian transformation matrix, F m =[Fm1 , Fm2 , Fm3]T is the calculable contractive force vector ofpneumatic muscles, and Fm i(i = 1, 2, 3) is obtained by the fol-lowing integrated model that is derived from literature [14]and [15]

Fm i(xm i , pi) = pi [a(1 − kεεm i)2 − b] + Fri(xm i) (3)

Fri(xm i) = −πD0L0δ0E(1 − εm i)2

×(

1sin α0

− 1sin αi(xm i)

)cos α0 (4)

where xm i is the contractive length of pneumatic muscle, pi isthe pressure inside the pneumatic muscle, a and b are constantsrelated to the structure of pneumatic muscle, kε is a factor ac-counting for the side effect, εi is the contractive ratio given byεi = xm i/L0 , L0 is the initial length of pneumatic muscle, Friis the rubber elastic force, D0 is the initial diameter of pneu-matic muscle, δ0 is the thickness of shell and bladder, E is thebulk modulus of elasticity of the rubber tube with cross-weavesheath, α0 is the initial braided angle of pneumatic muscle,and αi is the current braided angle of pneumatic muscle. Notethat model errors of τ a from incalculable part of contractiveforces are lumped into disturbances dta and will be attenuatedby robust feedback later.

Substituting (3) into (2), the drive moment can be describedas follows:

τ a(θ,p) = f τ a(θ)p + gτ a(θ). (5)

Two fast switching valves are used to regulate the pressureinside each pneumatic muscle, and this combination is subse-quently referred to as a driving unit. And the pressure dynamicsof the ith driving unit is [3], [16]

pi = −λaipiVi

Vi+

λbiRTiqm i

Vi+ dm i (6)

where λai and λbi are different polytropic exponents, Vi is thepneumatic muscle’s inner volume that is a function of xm i , Ris the gas constant, Ti is the thermodynamic temperature insidethe pneumatic muscle, qm i is the calculable air mass flow ratethrough fast switching valve, and dm i represents all disturbancesin muscle space.

Mass flow rate qm i is a function of the duty cycle, i.e., controlinput ui given by [3]

qm i(ui) = Kqi(pi, sign(ui))ui (7)

Page 3: IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, …

ZHU et al.: ADAPTIVE ROBUST POSTURE CONTROL OF PARALLEL MANIPULATOR DRIVEN 443

where Kqi(pi, sign(ui)) is a nonlinear flow gain function givenby Kqi(pi, sign(ui)) = Aei(pui/

√RTui)f(pdi/pui) with

f

(pdi

pui

)

=

√k

(2

k + 1

) k + 1k −1

, when 0 ≤ pdipui

< 0.528√2k

k−1

[(pdipui

) 2k −

(pdipui

) k + 1k

], when 0.528 ≤ pdi

pui≤ 1

Aei is the effective orifice area of fast switching valve, pui is theupstream pressure, pdi is the downstream pressure, Tui is theupstream temperature, and k is the ratio of specific heat.

Due to the symmetric distribution of spherical joints, respec-tively, on moving platform and base platform and the identicalproperties of pneumatic muscles used, θz is nearly close to zerowhen no external moments around z-axis (see Fig. 1) are actingon the parallel manipulator in normal operations. Moreover, itis observed that θz is less than 0.2 while θx and θy normallyapproach 10 in simulation and experiments. For this reason,the rotation angle of z-axis is not measured and controlled inpractice. Normally, θz is assumed to be zero in the controllerdesign. With this assumption, the system dynamics for rotationangles around the other two axes can be written in the followingform according to (1), (6), and (7):

M(x)x + C(x, x)x + G(x)+F f (x, x) + dt(x, x, t) = τ

= f τ (x)p + gτ (x)p = fm(x)qm + gm(x, x,p) + dm(x, x, t)qm = Kq(p, sign(u))u

(8)

where x = [θx, θy ]T ∈ R2 , M(x) and C(x, x) are the corre-sponding 2 × 2 components of M a(θ) and Ca(θ, θ), respec-tively, G(x), F f (x, x), dt(x, x, t), τ , and gτ (x) are the corre-sponding 2 × 1 components of Ga(θ), F fa(θ, θ), dta(θ, θ, t),τ a , and gτ a(θ), respectively, f τ (x) is the corresponding 2 × 3component of f τ a(θ), and

fm(x) = diag

([kb1RT1

V1(xm1),

kb2RT2

V2(xm2),

kb3RT3

V3(xm3)

]T)

gm(x, x,p) =

[−ka1p1 V1(xm1 , xm1)

V1(xm1),−ka2p2 V2(xm2 , xm2)

V2(xm2),

−ka3p3 V3(xm3 , xm3)V3(xm3)

]T

.

B. Utilization of Equivalent Average Stiffness

Since the rotation around z-axis is not controlled in normaloperations for the PMDPM, there exists a DOF redundancy insynthesizing the posture controller for rotation angles around theother two axes. Therefore, an equivalent average-stiffness-likeconstraint, which is related to the multiple-dimension equivalentstiffness matrix of the PMDPM, is introduced into the posturecontroller for removing such a DOF redundancy.

With the backstepping design procedure, the desired drivemoment τ d in the task space can be calculated by desired andactual postures under certain control strategy. And then, accord-ing to the first equation of (8), the desired pressure vector pdcan be derived from the following equation:

τ d(x, x,xd , xd , xd) = f τ (x)pd + gτ (x). (9)

However, the solution of pd from τ d along (9) is not uniquesince f τ (x) is a 2 × 3 matrix while pd is a 3 × 1 vectorand τ d is a 2 × 1 vector. That is, the system possesses a DOFredundancy. Therefore, an extra constraint related to the pressurevector p is introduced into the posture controller for removingthe redundancy.

Under the condition of the parallel manipulator being at theequilibrium state (x = x = x = [0, 0]T ) and ∂p/∂θ ≈ 0, anequivalent stiffness is described as (10) according to (5), whichis the posture derivative of the drive moment [6], [17]

K(p,θa) =∂f τ a

∂θap +

∂gτ a

∂θa. (10)

It can be seen from this equation that the equivalent stiff-ness is mainly dependent on the inner pressures of pneumaticmuscles and the posture vector of the PMDPM. Due to thesymmetric distribution of spherical joints on moving platformand base platform as well as the identical properties of pneu-matic muscles, the equivalent stiffness is a principle diagonalmatrix, whose components have the feature that magnitudes ofthe equivalent stiffness around x- and y-axes are at the samelevel and larger than that around z-axis.

Then, an equivalent average stiffness of the parallel manip-ulator is defined as Kd = (Kx + Ky )/2 and expressed as thefollowing equation, which is also dependent on inner pressuresof three pneumatic muscles:

Kd = fk(x)p + gk(x). (11)

Therefore, integrating with (9) and (11), the desired pressurevector in the task space is uniquely determined by

pd = ψ−11 (x)[υ − ψ2(x)] (12)

where

ψ1(x) =[

f τ (x)fk(x)

], ψ2(x) =

[gτ (x)gk(x)

], υ =

[τ dKd

].

In the following design, for notation simplicity, the variableM(x) is expressed by M , and other variables are analogicalwhen no confusions on the function variables are concerned.

III. CONTROLLER DESIGN

A. Schematic Diagram of the Posture Controller

The posture controller for the PMDPM is composed of twoparts: the ARC design and the equivalent average stiffness de-sign. The ARC is adopted to deal with rather severe parametricuncertainties and uncertain nonlinearities existing in the dynam-ics of the PMDPM [3], [11], [13], both due to the time-varyingfriction forces and the static force modeling errors of pneumatic

Page 4: IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, …

444 IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, NO. 4, AUGUST 2008

Fig. 2. Schematic diagram of the posture controller.

muscles and due to the inherent complex nonlinearities and un-known disturbances of the parallel manipulator. Meanwhile, theequivalent average stiffness is employed to make full use of theredundancy of the PMDPM for reducing control input chatteringcaused by measurement noise. It is noted that since there existunmatched model uncertainties in the dynamics of the PMDPM,the backstepping design is adopted consisting of desired drivemoment design and desired flow rate design along with parame-ter adaptation to compensate for large parametric uncertainties.The schematic diagram of the adaptive robust posture controllerwith adjustable equivalent average stiffness is shown in Fig. 2.

B. Assumption and Projection Mapping

In general, the system is subjected to parametric uncertain-ties due to unknown values of λa , λb , the unknown parametersin M(x), C(x, x), G(x), F f (x, x), and the unknown nomi-nal value of the lumped disturbance vector represented by dt0and dm0 . Thus, let β be the unknown parameter vector whosecomponents are the aforementioned unknown parameters. In ad-dition, there exist uncertain nonlinearities represented by dt anddm in the system (dt = dt0 + dt , dm = dm0 + dm ). Assumethat the extents of the parametric uncertainties and uncertainnonlinearities are known as

β ∈ Ωβ = β : βmin ≤ β ≤ βmax

|dt | ≤ dtmax , |dm | ≤ dmmax (13)

where βmax = [β1max , . . . , βnmax]T is the maximum parametervector, βmin = [β1min , . . . , βnmin ]T is the minimum parametervector, and dtmax and dmmax are known vectors.

Let β denote the estimate of β and β = β − β the estimationerror. In view of (13), a discontinuous projection can be definedas (14) in order to guarantee that the parameter estimates givenby (15) remain in the known bounded region all the time [11],[13]:

Projβ(•i) =

0, if βi = βimax and •i > 00, if βi = βimin and •i < 0•i , otherwise .

(14)

The adaptation law is given by

˙β = Projβ(Γσ), β(0) ∈ Ωβ (15)

where Γ > 0 is a diagonal matrix and σ is a parameter adap-tation function to be synthesized later. It can be shown that forany adaptation function, the projection mapping used in (15)guarantees

β ∈ Ωβ = β : βmin ≤ β ≤ βmax

βT[Γ−1Projβ(Γσ) − σ] ≤ 0 ∀σ.

(16)

C. Design of ARC

In this section, the ARC will be synthesized using the re-cursive backstepping procedure for the system (8) to achieve aguaranteed transient and final tracking accuracy [3], [11], [13].

1) Design of Desired Drive Moment: Define a switching-function-like quantity as

z2 = z1 + Kcz1 (17)

where z1 = x − yd is the trajectory tracking error vector andKc is a positive diagonal feedback matrix. If z2 converges to asmall value or zero, then z1 will converge to a small value or zerosince the transfer function from z2 to z1 G(s) = I(s + Kc)−1

is globally asymptotically stable. Thereby, the next objective isto design the drive moment τ for making z2 as small as possible.

Defining xr = yd − Kcz1 , the terms including parametricuncertainties in the task space can be described as (18) with aset of unknown parameter vector βt in the task space:

Mxr + Cxr + F f + G + dt0

= ϕT2 (x, x, xr , xr)βt + f c2(x, x, xr , xr) (18)

where ϕT2 (x, x, xr , xr) is the corresponding regressor of βt

and f c2(x, x, xr , xr) is the known nonlinear term.The following equation could be obtained along the solution

of (8) and (18):

Mz2 + Cz2 = τ − ϕT2 βt − f c2 + ϕT

2 βt − dt . (19)

The desired drive moment τ d is given by

τ d = τ da + τ ds , τ da = ϕT2 βt + f c2 (20)

where τ da functions as the adaptive control part used to achievean improved model compensation through online parameteradaptation via βt , and τ ds is a robust control law to be synthe-sized later. βt is updated by a discontinuous projection-based

adaptation law of the form (15), i.e., ˙βt = Projβ (Γ2σ2) withthe parameter adaptation function σ2 = −ϕ2z2 . τ ds consistsof two parts

τ ds = τ ds1 + τ ds2 , τ ds1 = −K2z2 (21)

where K2 is a positive definite feedback gain matrix and τ ds2 issynthesized to dominate the uncompensated model uncertainties

Page 5: IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, …

ZHU et al.: ADAPTIVE ROBUST POSTURE CONTROL OF PARALLEL MANIPULATOR DRIVEN 445

coming from both parametric uncertainties and uncertain non-linearities, which is chosen to satisfy the following conditions:

zT2 (τ ds2 + ϕT

2 βt − dt) ≤ ε2

zT2 τ ds2 ≤ 0

(22)

where ε2 is a positive design parameter. For example, τ ds2 maybe chosen as [13]

τ ds2 = −K2s tanh (z2/ε2) (23)

where K2s is a positive definite diagonal matrix dependent onuncertain nonlinearities in the task space.

As analyzed in Section II, according to the desired drivemoment τ d and the desired equivalent average stiffness Kddesigned later, the desired pressure vector pd can be obtainedfrom (12).

Define the positive semidefinite Lyapunov function V2 =(1/2)zT

2 Mz2 and let the input discrepancy be z3 = p − pd .The time derivative of V2 along the solution of (19) is

V2 = − zT2 K2z2 + zT

2 f τ z3

+ zT2 (τ ds2 + ϕT

2 βt − dt). (24)

2) Design of Desired Flow Rate: Next, the mass flow rateqm is synthesized so that z3 converges to a small value or zerowith a guaranteed transient performance. With a set of unknownparameter vector βm in muscle space, the terms including para-metric uncertainties in muscle space are described as

fm(x)qm + gm(x, x,p) + dm0

= ϕT3 (x, x,p)βm + f c3(x, x,p) (25)

where ϕT3 (x, x,p) is the corresponding regressor of βm and

f c3(x, x,p) is the known nonlinear term.The time derivative of the input discrepancy along the solution

of (8) and (12) is

z3 = p − pd = fmqm + gm + dm0

+ dm − pdc − pdu (26)

where pdc = ∂pd/∂t + (∂pd/∂x)ˆx + (∂pd/∂x)ˆx + (∂pd/

∂βt)˙βt and pdu = (∂pd/∂x)(x − ˆx) + (∂pd/∂x)(x − ˆx) in

which ˆx and ˆx are obtained from x by a second-order differen-tial filter as [3], pdc represents the calculable part of pd and canbe used to design control input u, but pdu cannot due to variousuncertainties.

The desired mass flow rate qmd is

qmd = qmda + qmds ,

qmda = f−1m (−fT

τ z2 − gm − dm0 + pdc) (27)

where qmda is used for adaptive model compensation throughonline parameter adaptation via βm , and qmds is the robustcontrol law to be synthesized later. βm is updated by a dis-continuous projection-based adaptation law of the form (15),

i.e., ˙βm = Projβ(Γ3σ3) with the parameter adaptation func-tion σ3 = ϕ3z3 .

The robust control law qmds consists of the following twoparts:

qmds = qmds1 + qmds2 , qmds1 = −f−1m K3z3 (28)

where K3 is a positive definite feedback gain matrix and qmds2is synthesized to dominate the uncompensated model uncertain-ties and chosen to satisfy the following conditions:

zT

3 (fmqmds2 − ϕT3 βm + dm − pdu) ≤ ε3

zT3 fmqmds2 ≤ 0

(29)

where ε3 is a positive design parameter that may be arbitrarilysmall. For example, qmds2 may be chosen as [13]

qmds2 = −f−1m K3s tanh (z3/ε3) (30)

where K3s is a positive definite diagonal matrix dependent onuncertain nonlinearities in muscle space.

To see how this control function works, define a positivesemidefinite (p.s.d.) function V3 = V2 + (1/2)zT

3 z3 , its timederivative along the solution of (22), (24), (26), and (29) is

V3 ≤ −zT2 K1z2 − zT

3 K3z3 + ε2 + ε3 . (31)

According to comparison lemma [18], the solution of (31) is

V3(t) ≤ exp(−λv t)V3(0) +εv

λv[1 − exp(−λv t)] (32)

where λv = 2 × minK2 ,K3 and εv = ε2 + ε3 .As can be seen from (32), the output tracking error vector

z = [zT2 ,zT

3 ]T is bounded above by

‖z(t)‖2 < exp(−λv t) ‖z(0)‖

+2εv

λv[1 − exp(−λv t)]. (33)

Specifically, asymptotic output tracking (or zero final trackingerror) is obtained in the presence of parametric uncertaintiesonly.

3) Design of Control Input Vector: Once the desired massflow rate qmd is synthesized, the inverse flow rate mappingis used to calculate the specific duty cycle commands of fastswitching valves. The control input vector is

u = K−1q qmd . (34)

D. Design of Equivalent Average Stiffness

The equivalent average stiffness Kd in (12) is adjustable andcan be further designed to reduce control input chattering.

1) Permissible Equivalent Average Stiffness: The equivalentaverage stiffness Kd is constrained by the minimum and max-imum permissible inner pressures of three pneumatic muscles.

Page 6: IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, …

446 IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, NO. 4, AUGUST 2008

For this purpose, (3) can be written in another form as

Fm i(xm i , pi) = Ai(xm i)pi + Fri(xm i) (35)

where Ai(xm i) is the equivalent acting area of the pneumaticmuscle.

For a single pneumatic muscle, the minimum inner pressure ispmini = −Fri(xm i)/Ai(xmi) since pneumatic muscle can onlygenerate positive contractive force. Meanwhile, the maximuminner pressure is pmaxi = min(pmi, ps) in which pmi is the per-missible maximum inner pressure of the pneumatic muscle andps is the supply pressure. Let pmin be the vector consisting ofsuch three pmini and pmax be the vector consisting of such threepmaxi .

According to (12), the permissible desired pressure vectorshould satisfy the following inequality:

pmin ≤ pd = ψ−11 (υ − ψ2) ≤ pmax . (36)

Let ψ−11 υ = aτ τ d + akKd in which aτ is a 3 × 2 matrix

and ak is a 3 × 1 matrix from ψ−11 , and substitute it into (36),

then

pmin + ψ−11 ψ2 − aτ τ d ≤ akKd ≤ pmax + ψ−1

1 ψ2 − aτ τ d .(37)

Hence, the permissible equivalent average stiffness for thedesired posture is obtained:

Kdmax = min(

χr1

ak1

),

(χr2

ak2

),

(χr3

ak3

)

Kdmin = max(

χl1

ak1

),

(χl2

ak2

),

(χl3

ak3

)(38)

where χr = pmax + ψ−11 ψ2 − aτ τ d = [χr1 , χr2 , χr3 ]T and

χl = pmin + ψ−11 ψ2 − aτ τ d = [χl1 , χl2 , χl3 ]T .

2) Optimal Equivalent Average Stiffness: Generally, theequivalent average stiffness of the PMDPM has arbitrarinesswithin the permissible range when not controlled, which indi-cates that it may be used as a constraint to tune system perfor-mance. Concretely, the velocity and acceleration of the PMDPMwould be needed in the calculation of the control input vector.Though these signals may be obtained from the posture througha second-order differential filter, measurement noise may beamplified resulting in severe control input chattering. Thus, itis necessary to find an optimal equivalent average stiffness fordecreasing the gain from noise to control input vector, and con-sequently, reducing control input chattering.

The acceleration in control input vector consists of the fol-lowing two parts:

ˆx = ˆx0 + n(t) (39)

where ˆx0 is the noise-free signal and n(t) is the measurementnoise. When the trajectory tracking error is small, pd is nearlyequal to p and the robust control part is neglected. With thisapproximation, the control input vector in (34) can be rewrittenas

u = K−1q (pd(Kd))f

−1m

∂pd(Kd)∂x

[ˆx0 + n(t)

]+ κ(x, ˆx, t)

(40)

Fig. 3. Permissible and optimal equivalent average stiffness along a sinusoidaltrajectory.

Fig. 4. Relation between Jopt and Kd at different posture points in the processof tracking the trajectory. Note: θ1 , θ2 , θ3 , θ4 , and θ5 represent differentposture points. θ1 = [2.8229, 2.2583]T , θ2 = [4.9134, 3.9308]T , θ3 =[0.9213, 0.7370]T , θ4 = [−2.8229,−2.2583]T , and θ5 = [−4.9134,−3.9308]T .

where κ(x, ˆx, t) is a nonlinear function given by

κ(x, ˆx, t)=K−1q f

−1m

[∂pd

∂t+

∂pd

∂xˆx +

∂pd

∂βt

˙βt−gm−dm0

].

In order to obtain the optimal equivalent average stiffness,the gain from noise to control input vector should be as small aspossible. Thus, the objective function to be minimized is

Jopt =∣∣∣∣K−1

q (pd(Kd))f−1m

∂pd(Kd)∂x

∣∣∣∣ . (41)

The permissible and optimal equivalent average stiffnessalong a desired sinusoidal trajectory (amplitude θx = 5 andθy = 4, period 20 s) are shown in Fig. 3. And Fig. 4 showsthe relation between Jopt and Kd at different posture points inthe process of tracking the trajectory. It can be seen from Fig. 4

Page 7: IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, …

ZHU et al.: ADAPTIVE ROBUST POSTURE CONTROL OF PARALLEL MANIPULATOR DRIVEN 447

that the objective function near the optimal equivalent averagestiffness changes mildly, which indicates that the slight changeof equivalent average stiffness in the small neighborhood of theoptimal equivalent average stiffness will have slight change onreducing control input chattering. Therefore, the optimal valuein practice can be a smaller constant value than the averagedvalue of the optimal equivalent average stiffness along certaintrajectory to decrease air consumption, and consequently, saveenergy.

E. Some Issues on Posture Control With Redundant DOF

Remark (i). The posture controller of the PMDPM with re-dundancy could be flexibly designed. Besides the ARC adoptedin this paper, other control methods such as PID, adaptive con-trol, sliding-mode control, or deterministic robust control canalso be used to obtain the desired drive moment. And then, theequivalent average-stiffness-like desired constraint according todifferent requirements is integrated into the posture controllerfor effectively improving tracking accuracy or reducing controlinput chattering.

Remark (ii). Only the value of equivalent average stiffness uti-lized by the controller is almost invariant in the aforementionedsinusoidal trajectory, while the equivalent stiffness around x-andy-axes fluctuate, respectively, due to the posture variations.

Remark (iii). The desired pressure vector pd can also beobtained from (9):

pd = f+τ (x)(τ d − gτ ) + [I3 × 3 − f+

τ (x)f τ (x)]p0 (42)

where p0 is called as the equivalent average pressure vector,which is related to the equivalent average stiffness and an arbi-trary 3 × 1 vector within the permissible range.

Substitute this pd as p into (11), then the relation between theequivalent average pressure vector and the equivalent averagestiffness becomes

Ak (x)p0 = Bk (x,Kd) (43)

where Ak (x) = f k (x)[I3 × 3 − f+τ (x)f τ (x)], Bk (x,Kd) =

Kd − gk (x) − f k (x)f+τ (x)(τ d − gτ ) in which f+

τ (x) is thepseudoinverse of f τ (x).

As can be seen from (43), the equivalent average stiffnesscorresponds to multivalued vector p0 . If three components ofthe vector p0 are set to the same value represented by the equiv-alent average pressure scalar p0 , a unique mapping betweenthe equivalent average stiffness Kd and the equivalent averagepressure scalar p0 will be established. Generally, the methodsof adjusting equivalent average stiffness and regulating equiv-alent average pressure scalar almost have the same effects oncontrol performance, but the method of regulating equivalentaverage pressure scalar is simple and explicit when applied inthe posture control of the PMDPM with redundancy. In addi-tion, it is noted that the equivalent average pressure scalar ofthe PMDPM takes the similar function as the average pressurescalar of antagonistic pneumatic muscle systems mentioned inprevious literature [5]–[7].

Fig. 5. Experimental test rig of the PMDPM.

IV. EXPERIMENTAL RESULTS

The experimental test rig shown in Fig. 5 is used toevaluate the effectiveness of the proposed posture controllerwith the constraint of the equivalent average stiffness. Threepneumatic muscles used in experiments are fluidic mus-cles manufactured by Festo, Inc. The geometric parametersof the PMDPM in Fig. 1 are r = 0.2 m, R = 0.23 m, andh = 1.05 m. And the rotational inertia matrix of the mov-ing platform is I = diag([0.457, 0.457, 0.864]T). The exper-iments are conducted with the supply pressure 0.48 MPa.The online estimated parameters are βt = dt0 and βm = dm0since their values have vital influences on improving modelaccuracy and the rest parameters are preset offline. Espe-cially, friction force in (8) is neglected and the model erroris lumped into uncertain nonlinearities. Feedback gain ma-trices are K1 = diag([80, 80]T), K2 = diag([30, 30]T), andK3 = diag([5, 5, 5]T). And adaptation gain matrices are Γ2 =diag([70, 70]T) and Γ3 = diag([5, 5, 5]T).

The controller of the PMDPM is first tested for tracking asinusoidal desired posture trajectory with amplitude θx = 5,θy = 4, and period 20 s under the same conditions except differ-ent constant equivalent average stiffness shown in Fig. 6–8. Ascan be seen, larger equivalent average stiffness of the PMDPMrequires higher inner pressures of pneumatic muscles and largercontrol efforts while resulting in smaller control input chat-tering. Due to the larger time-varying friction forces caused bylarger pressures, the tracking errors increase slightly under largerequivalent average stiffness. On the contrary, smaller equivalentaverage stiffness results in lower inner pressures of pneumaticmuscles and smaller control efforts while brings much morecontrol input chattering due to the system’s sensitivity to dis-turbances and measurement noise under lower pressures. It isespecially noted that the optimal equivalent average stiffnessonly used in Fig. 7 greatly reduces control input chattering andsaves energy while the tracking errors are as small as those ofFigs. 6 and 8.

Page 8: IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, …

448 IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, NO. 4, AUGUST 2008

Fig. 6. Sinusoidal tracking results with Kd = 800 N · m/rad.

Fig. 7. Sinusoidal tracking results with Kd = 1500 N · m/rad.

The experimental result of time-varying equivalent averagestiffness is shown in Fig. 9 under the condition of tracking thesame trajectory as before. As can be seen, the time-varyingequivalent average stiffness has slight influences on trackingerrors during the control process. In other words, the addedequivalent average-stiffness-like desired constraint has slightinfluences on the tracking accuracy of posture control.

Fig. 8. Sinusoidal tracking results with Kd = 1650 N · m/rad.

Fig. 9. Sinusoidal tracking results with time-varying Kd .

To sum up, all results prove the original intention that theadaptive robust posture controller with equivalent average-stiffness-like desired constraint for the PMDPM with redun-dancy could not only achieve small tracking errors but alsoreduce control input chattering.

Page 9: IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, …

ZHU et al.: ADAPTIVE ROBUST POSTURE CONTROL OF PARALLEL MANIPULATOR DRIVEN 449

V. CONCLUSION

The adaptive robust posture control with adjustable equiv-alent average stiffness as a constraint is proposed for preciseplanar posture tracking control of a parallel manipulator drivenby three pneumatic muscles with a redundant design freedom.The equivalent average stiffness can be adjusted to reduce con-trol input chattering caused by measurement noise. An adaptiverobust posture controller has been developed to effectively dealwith the model uncertainties existing in the complex dynam-ics of such a system due to factors such as time-varying frictionforces, the large extent of modeling errors of pneumatic muscles,and the strong coupling and inherent nonlinearities of the par-allel manipulator dynamics. Meanwhile, to make full use of theadded design freedom of not controlling rotation angle aroundthe symmetry axis of parallel manipulator, the equivalent aver-age stiffness is introduced and its optimal value is determined toachieve the secondary objective of reducing control input chat-tering caused by measurement noise. Furthermore, the principleof selecting the equivalent average stiffness, the inherent char-acteristic of using equivalent average stiffness and equivalentaverage pressure scalar are discussed to provide instructions inapplication. Comparative experimental results are presented toillustrate the proposed control strategy as well.

ACKNOWLEDGMENT

The authors would like to thank the Festo(China) Ltd. fordonating pneumatic components used in experiments.

REFERENCES

[1] S. Davis and D. G. Caldwell, “Braid effects on contractile range andfriction modeling in pneumatic muscle actuators,” Int. J. Robot. Res.,vol. 25, no. 4, pp. 359–369, 2006.

[2] G. L. Tao, X. C. Zhu, and J. Cao, “Modeling and controlling of parallelmanipulator joint driven by pneumatic muscles,” Chin. J. Mech. Eng.(English Edition), vol. 18, no. 4, pp. 537–541, 2005.

[3] X. C. Zhu, G. L. Tao, J. Cao, and B. Yao, “Adaptive robust posturecontrol of a pneumatic muscles driven parallel manipulator,” in Proc. 4thIFAC Symp. Mechatron. Syst., Heidelberg, Germany, Sep. 12–14, 2006,pp. 764–769.

[4] L. M. Sui, Z. W. Wang, and G. Bao, “Analysis of stiffness characteristicsof the pneumatic muscle actuator,” China Mech. Eng., vol. 15, no. 3,pp. 242–244, 2004.

[5] B. Tondu and P. Lopez, “The McKibben muscle and its use in actuatingrobot-arms showing similarities with human arm behaviour,” Ind. Robot,vol. 24, no. 6, pp. 432–439, 1997.

[6] R. Liu, “On the compliant control of parallel mechanism and actuating withartificial muscle,” Ph.D. dissertation, Beijing Univ. Aeronaut. Astronaut.,Beijing, China, 1996.

[7] G. H. Zong and R. Liu, “On the implementation of stiffness control on amanipulator using rubber actuators,” in Proc. IEEE Int. Conf. Syst., ManCybern. Part 1, Vancouver, BC, Canada, Oct. 22–25, 1995, pp. 183–188.

[8] G. Tonietti and A. Bicchi, “Adaptive simultaneous position and stiffnesscontrol for a soft robot arm,” in Proc. IEEE/RSJ Int. Conf. Intell. RobotsSyst., Lausanne, Switzerland, Sep. 30–Oct. 4, 2002, pp. 1992–1997.

[9] R. Q. van der Linde, “Design, analysis, and control of a low power jointfor walking robots by phasic activation of McKibben muscles,” IEEETrans. Robot. Autom., vol. 15, no. 4, pp. 599–604, Aug. 1999.

[10] A. Hildebrandt, O. Sawodny, R. Neumann, and A. Hartmann, “Cascadedcontrol concept of a robot with two degrees of freedom driven by four arti-ficial pneumatic muscle actuators,” in Proc. Amer. Control Conf., Portland,OR, Jun. 8–10, 2005, pp. 680–685.

[11] S. Liu and B. Yao, “Automated onboard modeling of cartridge valve flowmapping,” IEEE/ASME Trans. Mechatronics, vol. 11, no. 4, pp. 381–388,Aug. 2006.

[12] Y. Hong and B. Yao, “A globally stable high-performance adaptive robustcontrol algorithm with input saturation for precision motion control oflinear motor drive systems,” IEEE/ASME Trans. Mechatronics, vol. 12,no. 2, pp. 198–207, Apr. 2007.

[13] B. Yao and M. Tomizuka, “Adaptive robust control of SISO nonlinearsystems in a semi-strict feedback form,” Automatica, vol. 33, no. 5,pp. 893–900, 1997.

[14] B. Tondu and P. Lopez, “Modeling and control of McKibben artificialmuscle robot actuators,” IEEE Control Syst. Mag., vol. 20, no. 2, pp. 15–38, Apr. 2000.

[15] C. P. Chou and B. Hannaford, “Measurement and modeling of McKibbenpneumatic artificial muscles,” IEEE Trans. Robot. Autom., vol. 12, no. 1,pp. 90–102, Feb. 1996.

[16] A. Ilchmann, O. Sawodny, and S. Trenn, “Pneumatic cylinders: Modellingand feedback force control,” Int. J. Control, vol. 79, no. 6, pp. 650–661,2006.

[17] A. B. K. Rao, S. K. Saha, and P. V. M. Rao, “Stiffness analysis of hexaslidemachine tools,” Adv. Robot., vol. 19, no. 6, pp. 671–693, 2005.

[18] H. K. Khalil, Nonlinear Systems, 2nd ed. Englewood Cliffs, NJ:Prentice-Hall, 1996.

Xiaocong Zhu received the B.Eng. and Ph.D. degreesin mechanical engineering from Zhejiang University,Hangzhou, China, in 2002 and 2007, respectively.

She is currently a Postdoctoral Fellow in the StateKey Laboratory of Fluid Power Transmission andControl, Zhejiang University. Her current researchinterests include pneumatic servo control, nonlinearcontrol theory and applications, mechatronic control,etc.

Guoliang Tao received the B.Eng., M.Eng., andPh.D. degrees in mechanical engineering fromZhejiang University, Hangzhou, China, in 1985,1991, and 2000, respectively.

Since 1991, he has been with the State Key Lab-oratory of Fluid Power Transmission and Control,Zhejiang University, where he was promoted to anAssociate Researcher in 1997 and a Professor in2001. His current research interests include nonlin-ear control theory and applications, mechatronic con-trol, fluid power transmission and control, especially

pneumatic servo control, and novel pneumatic components.

Bin Yao (S’92–M’96) received the B.Eng. degreein applied mechanics from Beijing University ofAeronautics and Astronautics, Beijing, China, in1987, the M.Eng. degree in electrical engineeringfrom Nanyang Technological University, Singapore,in 1992, and the Ph.D. degree in mechanical engi-neering from the University of California, Berkeley,in 1996.

Since 1996, he has been with the School of Me-chanical Engineering, Purdue University, Lafayette,IN, where he was promoted to an Associate Professor

in 2002 and a Full Professor in 2007. He is also one of the Kuang-Piu Professorsat Zhejiang University, Hangzhou, China. His current research interests includethe design and control of intelligent high-performance coordinated control ofelectromechanical/hydraulic systems, optimal adaptive and robust control, non-linear observer design and neural networks for virtual sensing, modeling, faultdetection, diagnostics, and adaptive fault-tolerant control, and data fusion. Heis currently an Associate Editor of the ASME Journal of Dynamic Systems,Measurement, and Control.

Prof. Yao has been a member of various technical professional societiessuch as the American Society of Mechanical Engineers (ASME). He was theOrganizer/Chair of numerous sessions and a member of the International Pro-gram Committee of a number of conferences of the IEEE, ASME, and theInternational Federation of Automatic Control (IFAC). He was the Chair ofthe Adaptive and Optimal Control Panel from 2000 to 2002 and the Chair ofthe Fluid Control Panel of the ASME Dynamic Systems and Control Division

Page 10: IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, …

450 IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 13, NO. 4, AUGUST 2008

(DSCD) from 2001 to 2003, and is currently the Vice Chair of the MechatronicsTechnical Committee of the ASME DSCD that he initiated in 2005. He was aTechnical Editor of the IEEE/ASME TRANSACTIONS ON MECHATRONICS from2001 to 2005. He was a recipient of the Faculty Early Career Development (CA-REER) Award from the National Science Foundation (NSF) in 1998 for his workon the engineering synthesis of high-performance adaptive robust controllersfor mechanical systems and manufacturing processes, a Joint Research Fundfor Overseas Young Scholars from the National Natural Science Foundation ofChina (NSFC) in 2005, and the O. Hugo Schuck Best Paper (Theory) Awardfrom the American Automatic Control Council in 2004.

Jian Cao received the B.Eng. degree in fluid powertransmission and control from the Inner Mongo-lia University of Science and Technology, Baotou,China, in 2002. He is currently working toward thePh.D. degree in mechanical engineering at the StateKey Laboratory of Fluid Power Transmission andControl, Zhejiang University, Hangzhou, China.

His current research interests include fluid powertransmission and control, mechatronic control, etc.