Nonlinear Control
Nonlinear Control
Techniques for
Electro-Hydraulic
Actuators in Robotics
Engineering
Nonlinear Control
Techniques for
Electro-Hydraulic
Actuators in Robotics
Engineering
CRC Press
Taylor & Francis Group
6000 Broken Sound Parkway NW, Suite 300
Boca Raton, FL 33487-2742
This book contains information obtained from authentic and highly regarded sources. Reasonable
efforts have been made to publish reliable data and information, but the author and publisher cannot
assume responsibility for the validity of all materials or the consequences of their use. The authors and
publishers have attempted to trace the copyright holders of all material reproduced in this publication
and apologize to copyright holders if permission to publish in this form has not been obtained. If any
copyright material has not been acknowledged please write and let us know so we may rectify in any
future reprint.
Except as permitted under U.S. Copyright Law, no part of this book may be reprinted, reproduced,
transmitted, or utilized in any form by any electronic, mechanical, or other means, now known or here-
after invented, including photocopying, microfilming, and recording, or in any information storage or
retrieval system, without written permission from the publishers.
For permission to photocopy or use material electronically from this work, please access www.
copyright.com (http://www.copyright.com/) or contact the Copyright Clearance Center, Inc. (CCC),
222 Rosewood Drive, Danvers, MA 01923, 978-750-8400. CCC is a not-for-profit organization that
provides licenses and registration for a variety of users. For organizations that have been granted a
photocopy license by the CCC, a separate system of payment has been arranged.
Trademark Notice: Product or corporate names may be trademarks or registered trademarks, and
are used only for identification and explanation without intent to infringe.
and my daughter.
Qing Guo
Contents
Foreword. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . ix
Preface. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . xi
List of Figures . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . xiii
List of Tables . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .xvii
Acknowledgement . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .xix
Authors . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .xxi
Symbols . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .xxiii
1. Introduction. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .1
References . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 121
Index . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 125
vii
Foreword
ix
x Foreword
control method does not have an ideal performance in special working con-
ditions, engineers cannot give up easily, that is, the issue is analyzed case by
case. Thus, in this book, many control methods handle many different con-
trol problems and conditions in electro-hydraulic system, which is only for
the reference of the reader.
Yan Shi
School of Automation Science and Electrical Engineering
Beihang University
Beijing, China
Preface
xi
xii Preface
violent control, and saturation. To address this problem, the dynamic surface
control (DSC) was proposed to design a stable dynamic surface [54] instead
of a virtual control derivative. The advantage of DSC is to eliminate the
severe proliferation and singularity of the nonlinear system and guarantee
fast state convergence and desirable dynamic performance [50]. The dynamic
surface is often designed as a linear filter to transform high-order deriva-
tions of virtual control variables into a different stable dynamic surface. If
the DSC is not considered in the backstepping controller, Guo et al. [18] pro-
posed another computation method of virtual control variable to avoid the
derivatives explosion. This virtual control variable can be directly filtered by
a linear decayed memory filter to smooth the high-order derivatives.
In this book, based on the aforementioned contributions of many
researchers, the authors have tried their best to apply some typical linear and
nonlinear control techniques into EHAs, which drive a two-DOF robotic arm,
for example. Some control ideas and motion mechanism are partially similar
to many references. Both theoretical proof and simulation and experimental
results are given to verify the corresponding control method in detail. The
authors hope that these points of view can benefit the reader to study the
electro-hydraulic control system in depth.
xiii
xiv List of Figures
xvii
Acknowledgement
Qing Guo and Dan Jiang acknowledge Professor Andrew Plummer, director
of Power Center for Power Transmission and Motion Control, Department
of Mechanical Engineering, University of Bath for the funding assistance and
previous work. They thank Dr. Tian Yu and Dr. Can Du from Power Center
for Power Transmission and Motion Control for their collaborative study in
related electrohydraulic work.
During the writing of the book, the authors were assisted by many
researchers from electrohydraulic engineering regarding some innovative
methods and techniques. Although some theoretical methods have a long
way to go in the application of electrohydraulic engineering, scholars did
not give up using new control methods and techniques, which is much
appreciated by them.
The study was supported by UK Engineering and Physical Sciences
Research Council project (No. EP/H024190/1), the National Natural Science
Foundation of China (Nos. 61305092 and 51205045), the Postdoctoral Science
Foundation of China (No. 2013M542487), the Fundamental Research Funds
for the Central Universities, China (Nos. 20160250331 and ZYGX2016J160),
and the Open Foundation of the State Key Laboratory of Fluid Power &
Mechatronic Systems (No. GZKF-201515).
xix
Authors
Qing Guo earned his B.E. in automation from Harbin Institute of Technology
(Harbin, China) in 2003, and went on to earn his M.S. and Ph.D. there, in 2005
and 2008, respectively. In 2009, he became a lecturer at the School of Aero-
nautics and Astronautics, University of Electronic Science and Technology of
China (ChengDu, China), and in 2013, he was promoted to associate profes-
sor. From December 2013 to December 2014, he served as an academic visitor
at the Center for Power Transmission and Motion Control, Department of
Mechanical Engineering, University of Bath, United Kingdom. Dr. Guo’s
research interests include robust and adaptive control, mechatronic systems,
and rehabilitation robots.
Dan Jiang earned her B.E. in mechanical engineering (2002), and M.S. (2005)
and Ph.D. (2009) in fluid power transmission and control from the Harbin
Institute of Technology (Harbin, China). Since April 2009, she has been with
the School of Mechatronics Engineering, University of Electronic Science and
Technology of China (ChengDu, China) as a lecturer. Her research interests
include hydraulic control and microfluidic technology, and she has published
several research papers in these areas.
xxi
Symbols
Two-DOF Two-degree-of-freedom
EHS Electro-hydraulic system
EHA Electro-hydraulic actuator
Ksv Gain of the servo valve
Tsv Time constant of the servo valve
u Input control voltage of the servo valve
Cd Discharge coefficient
w Area gradient of the servo valve spool
pL Load pressure of the servo valve
ps Supply pressure
xv Spool position of the servo valve
ρ Density of the hydraulic oil
y Displacement of the cylinder
yd Demand displacement
Ctl Total leakage coefficient of the cylinder
βe Effective bulk modulus
Ap Annulus area of the symmetrical chamber
Aa Annulus area of the single-rod chamber
Ab Annulus area of the no-rod chamber
Vt Half-volume of the cylinder
m Load mass
K Load spring constant
b Viscous damping coefficient
FL External load of the hydraulic actuator
k Positive constant in the hyperbolic tangent function
sgn(.) The sign function
tanh(.) The hyperbolic tangent function
zi System state error
xi System state
ϑi Parametric uncertainty
ϑ̂i Parametric estimation
ϑ̃i Parametric estimation error
θi Joint angle of the robotic arm
d Equivalent disturbance
d̂ Disturbance estimation
d̃ Disturbance estimation error
xxiii
1
Introduction
CONTENTS
1.1 Parametric Uncertainty Problem of EHS . . . . . . . . . . . . . . . . . . . . . . 3
1.2 Largely Unknown Load Disturbance of EHS . . . . . . . . . . . . . . . . . . . 4
1.3 Control Method Illustration in EHS . . . . . . . . . . . . . . . . . . . . . . . . . . 5
1
2 Nonlinear Control Techniques for EHAs in Robotics Engineering
x1 = x2
1
x2 = (–Kx1 – bx2 + Ap x3 – FL)
m
4βe Ap 4βe Ctl 4βe Cdw
x3 = x2 x3 + ps – tanh(kx4)x3x4 + Δf (t)
Vt Vt Vt ρ
Fo PAE—Parametric adaptive estimation
1 Ksvu δ(t) ur
x4 = – x + + EH prob ESO—Extended state observer
Tsv 4 Tsv Tsv S m lem HGOB—High-gain observer
od s in
el DOB—Disturbance observer
QFC—Quantitative feedback control
EHS control SPT—Singular perturbation theory
Problem 1: Problem 2:
Problem 3: Problem 4:
Parametric Unmodeled
uncertainty Unknown state External load
uncertainty
Geometric Output
Backstepping
PID, QFC,
Robust H∞ control regulation
SPT
approach control
FIGURE 1.1
Some typical problems and the corresponding solutions in the EHS model.
Introduction 3
controller design. The last problem is the external load on the EHA, which
is a largely unknown dynamic variable. To address the external load, a
simple method is adopted by the DO. In this book, we mainly consider
Problems 1 and 4, that is, parametric uncertainty and external load dis-
turbance. These two problems may degrade the dynamic behavior and
steady-state control accuracy of EHS and the robustness of the designed
controller.
the load torque disturbance was still assumed as zero. However, in engineer-
ing practice, the external load is often the largely unknown disturbance of
EHS. Thus, the designed controller would not only eliminate system state
error but also suppress the unknown disturbance of the external load. Even
though the EHS may be stable, it is clear that the dynamic performance will
be declined if the external load increases beyond a definite boundary [25].
Subsequently, Kim et al. [36] proposed a flatness-based nonlinear con-
troller to improve the position tracking performance while assuming the
known constant external load. Then his research team developed a HGDO
with backstepping control to compensate for the unknown external load
and guaranteed the position tracking accuracy. In this novel approach, the
DO had two different forms. One was a second-order high-pass filter [33]
to estimate a sinusoidal disturbance with unknown frequency. The other
was a HGDO [59] to estimate the largely unknown disturbance caused by
the friction, the load force, and the parameter uncertainties. Both the sim-
ulation and the experimental results indicated that the external load can
be well compensated, as well as the extended system state error was ulti-
mate boundedness. Chen proposed a nonlinear DO integrated with general
nonlinear controller [9]. In practice, the external load may be the largely
unknown structural disturbance of EHS, which should be compensated by
the constructed controller.
CONTENTS
2.1 Hydraulic Cylinder Model . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .7
2.1.1 Symmetrical Cylinder Model . . . . . . . . . . . . . . . . . . . . . . . . . .8
2.1.2 Asymmetrical Cylinder Model . . . . . . . . . . . . . . . . . . . . . . . .9
2.2 Servo Valve Model . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .9
2.2.1 Load Flow Model . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 10
2.2.2 Spool Position Response Model . . . . . . . . . . . . . . . . . . . . . . . 10
2.3 Parametric Uncertainty and Load Disturbance . . . . . . . . . . . . . . . . . 11
2.4 Nonlinear State-Space Model . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 12
2.5 Linearized Model of Electro-Hydraulic Actuator . . . . . . . . . . . . . . . 14
7
8 Nonlinear Control Techniques for EHAs in Robotics Engineering
Qa pa pb
Qb
Servo valve
Relief valve
ps pr
Pump
Tank
pa pb
Qa Qb
Servo valve
Relief valve
ps pr
Pump
Tank
FIGURE 2.1
Symmetrical and asymmetrical hydraulic cylinders: (a) the double-rod acting mechanism of the
symmetrical hydraulic cylinder and (b) the single-rod acting mechanism of the asymmetrical
hydraulic cylinder.
Vt
QL = Ap ẏ + Ctl pL + ṗL , (2.1)
4βe
Model Construction of Electro-Hydraulic Control System 9
where m is the load mass, K is the load spring constant, b is the viscous
damping coefficient, and FL is the external load on the hydraulic actuator.
where Qa and Qb are load flows with the spool position of the servo valve
xv ≥ 0 and xv < 0, respectively, pa and pb are the pressures inside the two
chambers of the cylinder, Aa and Ab are the ram areas of the two chambers,
and V 0a = V t /2 and V 0b = V t /2 are the initial total control volumes of the
two cylinder chambers, respectively.
Different from the symmetrical cylinder, the load pressure of the asym-
metrical cylinder pL = (pa Aa − pb Ab )/Aa , the mechanical dynamic equation
is described as follows:
where xv is the spool position of the servo valve, ps is the supply pressure
of the pump, Cd is the discharge coefficient, w is the area gradient of the
servo valve spool, and ρ is the density of the hydraulic oil, and sgn(.) is the
sign function, that is, sgn(x) = 1, if x > 0, else if x < 0, sgn(x) = − 1, else
sgn(x) = 0.
For the asymmetrical cylinder, the load flow of the valve cannot be
described as QL , and the flow in the two directions Qa and Qb is given by
Cd wxv 2(ps − pa )/ρ xv ≥ 0
Qa = ,
C wx 2(p − pr )/ρ xv < 0
d v a (2.6)
Cd wxv 2(pb − pr )/ρ xv ≥ 0
Qb = ,
Cd wxv 2(ps − pb )/ρ xv < 0
where Qa is the main load flow as xv ≥ 0, Qb is the main load flow xv < 0,
and pr is the return pressure of the tank.
where Ksv is the gain of the servo valve and u is the control voltage of the
servo valve.
For the one-order linear dynamic model, it is considered one time constant
in the spool position response to denote the command delay of the servo
valve, which is constructed as follows:
If both the delay and damping characteristics are considered in the spool
position response model of the servo valve, then the second-order dynamic
model is given by
2 2
ẍv + 2ζsv ωsv ẋv + ωsv xv = Ksv ωsv u, (2.9)
where C̄d , w̄, β̄e , C̄tl , ρ̄, and V̄t are known normal hydraulic parameters, and
their uncertainties are constrained as follows:
As shown in Equation 2.11, Cd min , Cd max , wmin , wmax , βe min , βe max ,
Ctl min , Ctl max , ρmin , ρmax , Vt min , and Vt max are unknown or known
boundaries of parametric uncertainties.
Remark 2.1
The above parametric uncertainties should be estimated in controller design.
Otherwise, the dynamic performance of the electro-hydraulic system will be
declined and the robustness of the designed controller will also be degraded.
Remark 2.2
By Equation 2.12, the boundary discussion of FL (t) can be transformed into
the direct state dynamics of y. Thus, the stability analysis of the electro-
hydraulic system model and the control design become easy.
Remark 2.3
The advantage of Equation 2.13 is very clear to denote the constraint of load
disturbance. However, if the boundary FL is unknown, the DO should be
used to estimate FL rather than to estimate the dynamic unknown vari-
able FL (t). Even though FL is a known value, the controller is relatively
conservative as FL is discussed as a direct uncertainty constraint in control
design.
where [x1 , x2 , x3 ]T = [y, ẏ, pL ]T are three state variables of the electro-
hydraulic actuator and u is the control variable of the servo valve.
Model Construction of Electro-Hydraulic Control System 13
where [x1 , x2 , x3 , x4 ]T = [y, ẏ, pL , xv ]T are four state variables of the electro-
hydraulic actuator.
If the asymmetrical cylinder model is considered with the second-order
spool position response model, then, according to Equations 2.3, 2.4, 2.6,
and 2.9, the electro-hydraulic actuator model is given by
⎧
⎪ ẋ1 = x2
⎪
⎪
⎪
⎪
⎪
⎪ ẋ2 = (x3 Aa − x4 Ab − Kx1 − bx2 − FL )/m
⎪
⎪
⎪
⎪
⎪ ẋ3 = h1 (−Aa x2 − Ctl (x3 − x4 ))
⎪
⎪
⎪
⎪
⎪
⎨ + h1 Cd wx5 2/ρ s1 ps − x3 + s2 x3 − pr
, (2.16)
⎪
⎪ ẋ4 = h2 (Ab x2 + Ctl (x3 − x4 ))
⎪
⎪
⎪
⎪
⎪
⎪ − h2 Cd wx5 2/ρ s1 x4 − pr − s2 ps − x4
⎪
⎪
⎪
⎪
⎪
⎪ ẋ5 = x6
⎪
⎪
⎪
⎩ 2 2
ẋ6 = −2ζsv ωsv x6 − ωsv x5 + Ksv ωsv u
βe βe
h1 = , h2 = ,
V0a + Aa x1 V0b − Ab x1
(2.17)
1 + sgn(x5 ) 1 − sgn(x5 )
s1 = , s2 = .
2 2
Remark 2.4
The above three models (2.14), (2.15), and (2.16) are all used in practical con-
trol design. The difference is the model accuracy. In conventional condition,
the model (2.14) is enough to describe the dynamics of the electro-hydraulic
system. However, in largely unknown load disturbance and parametric
uncertainty, the models (2.15) and (2.16) are necessary to be used in advanced
control method.
14 Nonlinear Control Techniques for EHAs in Robotics Engineering
QL = Kq xv + Kc pL , (2.18)
∂QL ps − pL
Kq = = Cd w ,
∂xv ρ
(2.19)
∂QL Cd wxv
Kc = = .
∂pL 2 ρ(ps − pL )
Second, from Equations 2.1, 2.2, 2.19, and 2.8, we can describe the linearized
model of the electro-hydraulic actuator as follows:
Thus, from Figure 2.2, the linearized model of the double-rod electro-
hydraulic actuator is given by
Kq Ksv 1 Vt
Ap (Tsv s+1) u(s) − A2p Kce + 4β e
s FL (s)
y(s) = , (2.20)
Vt m 3 mt Kce Be Vt bKce Vt K KKce
s + + s + 1+ 2 +
2 s+
4βe A2p A2p 2
4βe Ap Ap 2
4βe Ap A2p
where y(s), u(s), and FL (s) are frequency domain transformations, and
Kce = Kc + Ctl .
In terms of the single-rod electro-hydraulic actuator, the load pres-
sure pL is defined as pL = pa − υpb , and the load flow QL is defined as
QL = (Qa + υQb )/(1 + υ 2 ), where υ is the annulus area ratio between the
FL(t)
Ksv xv QL 1 pL – y
u 1
Kq Vt Ap
Tsvs + 1 Kc + Ctl + s ms2 + bs + K
– 4βe
Aps
FIGURE 2.2
Linearized model of the electro-hydraulic actuator.
Model Construction of Electro-Hydraulic Control System 15
cylinder with rod and the cylinder without rod. Thus, the load flow QL is
linearized as follows:
⎧
⎪
⎪ 2(ps − pL )
⎪
⎪ C wx , xv ≥ 0
⎪
⎨ d v ρ(1 + υ 3 )
QL = . (2.22)
⎪
⎪
⎪
⎪ 2(np s + pL )
⎪ Cd wxv
⎩ , xv < 0
ρ(1 + υ 3 )
2(ps − pL ) Cd wxv
Kqa = Cd w , Kca = ,
ρ(1 + υ 3 ) 2ρ(ps − pL )(1 + υ 3 )
(2.23)
2(αps + pL ) Cd wxv
Kqb = Cd w , Kcb = − .
ρ(1 + υ 3 ) 2ρ(υps + pL )(1 + υ 3 )
Then, like Equation 2.20, the linearized model of the single-rod electro-
hydraulic actuator is also obtained as follows:
Tsv s+1 Vt
Kqi Ksv u(s) − Aa Kcei + 2(1+υ 2 )βe
s FL (s)
y(s) = , (2.24)
Den
Vt m 3 mKcei bVt
Den =Aa (Tsv s + 1) s + + s2
2(1 + υ 2 )βe A2a A2a 2(1 + υ 2 )βe A2a
bKcei Vt K KKcei
+ 1+ 2 + s + .
Aa 2(1 + υ 2 )βe A2a A2a
(2.25)
16 Nonlinear Control Techniques for EHAs in Robotics Engineering
Remark 2.5
The two linearized models (2.20) and (2.24) can be used in classical control
design such as PID, robust H∞ , where a linear controller is obtained. This lin-
ear controller is relatively simple to guarantee the stability of the closed-loop
system and basic dynamic behavior. However, there exist unknown paramet-
ric uncertainty and load disturbance in the electro-hydraulic system, which
lead to the existing model error in linearized models. Thus, the two nonlinear
models (2.15) and (2.16) are adopted in the nonlinear controller design. Many
nonlinear controllers such as backstepping, adaptive, slide mode, etc. should
guarantee that the transient and steady behavior of the electro-hydraulic
system achieve the prescribe performance. Furthermore, the designed con-
troller must guarantee the global convergence or ultimate boundedness of
the generalized system state, including hydraulic state variable, parametric
estimation error, and DO error.
3
Linear PID Control Design
CONTENTS
3.1 Linear Feedback Control Loop . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 17
3.2 Mechatronics Plant Model Description . . . . . . . . . . . . . . . . . . . . . . . 20
3.2.1 Servo Valve Model Construction . . . . . . . . . . . . . . . . . . . . . . 20
3.2.2 Hydraulic Cylinder Model . . . . . . . . . . . . . . . . . . . . . . . . . . 23
3.2.3 Mechanical Motion Model . . . . . . . . . . . . . . . . . . . . . . . . . . . 24
3.3 System Performance Analysis . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 30
3.3.1 Motor Performance . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 30
3.3.2 Output Pressure Analysis of Pump . . . . . . . . . . . . . . . . . . . . 31
3.3.3 Dynamic Pressure of Cylinder with Load . . . . . . . . . . . . . . . 32
3.4 PID Controller Design . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 34
3.5 Experiment . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 41
The linear PID control is a classical control method, which is very easy to be
understood. The PID controller is designed in frequency domain based on the
linear model of the electro-hydraulic system. The main evaluation indexes
for the linear PID control design are relative stability margin and bandwidth.
This design idea is derived from the frequency design method in classical
control principle. In this chapter, the linear PID control design method is
introduced and the system stability and dynamic behavior are discussed.
17
18 Nonlinear Control Techniques for EHAs in Robotics Engineering
1 V FL
K + t s
Ap2 ce 4βe
Cylinder dynamics
Yexp Servo valve –
Control law Xv Kq/Ap Y
Gc(s) K Gcyd(s) =
– Gsv(s) = sv Vtmt 3 mtKce BeVt 2 B K KK KK
Tsv s+1 s + + s + 1 + e 2 ce + 2ce s + 2ce
4βe Ap2 Ap2 4βe Ap2 Ap Ap Ap
Y
Sensor model
Gsen(s)
FIGURE 3.1
Linear feedback control loop of the electro-hydraulic system.
of the position sensor model is not temporarily considered, that is, it is a unit
feedback, Gsen (s) = 1.
Consider the position demand Y exp as the system input, and the actual
cylinder position Y as the output. The open-loop transfer function of the
position feedback control loop is given by
Y(s)
Gol (s) = = Gc (s)Gsv (s)Gcyd (s)Gsen (s)
u(s)
Kq Ksv
Ap (Tsv s+1)
(3.1)
= .
Vt m 3 mt Kce Be Vt bKce Vt K KKce
s + + s2 + 1 + + s+
4βe A2p A2p 4βe A2p A2p 4βe A2p A2p
Remark 3.1
When the position feedback control loop is mainly considered, the external
load FL need not be substituted into Equation 3.1, which is different from
Equation 2.20. In other words, FL is compensated by the designed control u.
Now the effect of the external load FL to the closed loop is analyzed. Con-
sider FL as the load disturbance input, and the actual cylinder position Y as
the output. The closed loop from FL to Y is shown as Figure 3.2.
The closed-loop transfer function from FL to Y is given by
Y(s)
GyFL (s) =
FL (s)
− 1
(Kce + Vt (3.2)
A2p 4βe s)Gcyd (s)
= .
1 + Gc (s)Gsv (s)Gcyd (s)Gsen (s)
Linear PID Control Design 19
1 Vt FL
Kce + s
Ap2 4βe
Cylinder dynamics
Servo valve Xv –
Control law Kq/Ap Y
Gc(s) Ksv Gcyd(s) =
– Gsv(s) = Vtmt mt Kce BeVt BeKce KKce KKce
Tsv s+1 s3 + + s2 +1+ + s+
Y 4βe Ap2 Ap2 4βe Ap2 Ap2 Ap2 Ap2
Sensor model
Gsen(s)
FIGURE 3.2
Closed loop from the load disturbance FL to the cylinder position Y.
If the static gain of the controller Gc (s) is obviously larger than 1, then
Equation 3.2 can be simplified as follows:
1 1
− K − K
A2p ce A2p ce
GyFL (s) = = , s → 0 ⇔ t → ∞, (3.3)
Gc (s)Gsv (s) kp Ksv
Theorem 3.1
Consider the two transfer functions (3.1) and (3.2). There exists a linear
PID controller Gc (s) with sufficiently large static gain such that the closed-
loop feedback control system as shown in Figure 3.1 has enough global
stability margin and the external load disturbance FL (t) is suppressed into
a sufficiently small finite boundary.
ki
Gc (s) = kp + + kd s, (3.4)
s
20 Nonlinear Control Techniques for EHAs in Robotics Engineering
where Fmax
L is a finite boundary of FL (t).
TABLE 3.1
Servo Valve Parameters of Moog D633-R02K01M0NSM2
No. Name Symbol Value Unit
the hydraulic cylinder. From Equation 2.8, the math model is simplified as
follows:
xv Ksv
Gsv (s) = = , (3.7)
u Tsv s + 1
where xv is the spool position of the servo valve, u is the control voltage of
the servo valve, Ksv is the gain of the servo valve, and Tsv is the response time
constant of the servo valve.
According to the production of Moog D633-R02K01M0NSM2, some perfor-
mance parameters are shown in Table 3.1.
The maximal spool displacement is given by
Thus, the first-order transfer function model of this servo valve is con-
structed as
xv Ksv 3.95 × 10−4
= = . (3.10)
u Tsv s + 1 0.012s + 1
Owing to the servo valve hysteresis characteristics, the servo valve pres-
sure loss is computed by
ΔPAnschlüsse/connections
hose connections
ΔPSchlauch/hose(bar)
12 6 AnschluBtyp M
(bar)
Durchflu Bwiderstand
10 5
DurchfluB widerstand
Connection type M
ν = 55 mm2/s ν = 55 mm2/s
flow resistance for
AnschluBtyp 1
for 1 m schlauch
flow resistance
8 4
Connection type 1
1 m hose
6 3
AnschluBtyp 6
4 2 Connection type 6
2 1
0 0
0 0.5 1 1.5 2 0 0.5 1 1.5 2
DurchfluB Q (L/min) DurchfluB Q (L/min)
Flow rate Q (L/min) Flow rate Q (L/min)
Der gesamt-widerstand des schlauches errechnet sich nach folgender formel:
The total hose resistance is calculated by means of the formula:
ΔPsec = ΔPAnschlüsse 1 (bar) + ΔPSchlauch (bar) x L (m) + ΔPAnschlüsse 2 (bar)
ΔPtotal = ΔPConnection 1 (bar) + ΔPHose (bar) x L (m) + ΔPConnection 2 (bar)
FIGURE 3.3
Change of pipe pressure loss ptube from valve to cylinder.
where kp/Q = 5 is the approximate slope of the pipe pressure loss with
respect to flow, Qa = 3 L/min is the average flow of this hydraulic system,
and ltube = 0.5 m is the pipe length from valve to cylinder. Thus, ptube is
computed approximately by
If the maximal output pressure from the pump is the supply pressure ps ,
the maximal no-load flow of the servo valve is computed by
ps ps − pvloss − ptube
q0m = qn =5× L/min. (3.14)
pn 70
q0m 2
Kq0 = m /s. (3.15)
xvm
Linear PID Control Design 23
ps − pl − pvloss − ptube
Kq = Kq0 , (3.16)
ps
TABLE 3.2
Parameters of the Hydraulic Cylinder
No. Name Symbol Value Unit
1 Cylinder length Lc 91 mm
2 Piston stroke dr max 79 mm
3 Cylinder diameter Dc 16 mm
4 Rod diameter Drod 10 mm
5 Load mass of No. 2 cylinder m2f 1.778 kg
6 Load mass of No. 1 cylinder m1f 3.550 kg
7 Load spring stiffness K 0 N/m
8 Load damping Be 50 Ns/m
9 Elastic modulus βe 7000 bar
24 Nonlinear Control Techniques for EHAs in Robotics Engineering
⎧
⎪
⎪ 2
⎪
⎪ K = Kc ×
⎪
⎨ ca 1 + υ3
, (3.22)
⎪
⎪
⎪
⎪ 2(ps − pvloss − ptube − pl )
⎪
⎩ Kcb = Kc × (υ(ps − pvloss − ptube ) + pl )(1 + υ 3 )
where υ ≤ 1 is the annulus area ratio of two chambers, and the coefficient Kce
is rewritten as Kcea = Kca + Ctl , Kceb = Kcb + Ctl .
If the load mass is mf , the moment of inertia of the load rotation from the
elbow is given by
If the load mass is mf0 , the centroid distance from the elbow to the forearm
(including initial load) xc0 is P2 Pm2 . So the moment of inertia of the initial
load rotation from the elbow is
Elbow θ2 >0
ε22
l2(θ2) b2 c2(θ2)
Shoulder cylinder θ1 < 0 θ1 > 0 Elbow cylinder
Va Vb d21 a2
Aa Ab
Pb ε21 Shoulder
Pa
d22
Qa Qb c1(θ1)
b1
ε11 a1 l1(θ1)
Servo valve d12 d13 Servo valve
d11
Ps Pr
Pump
FIGURE 3.4
Motion control mechanism of the two-DOF robotic arm.
P3
Forearm
Pm2
θ2 > 0 Y
P2 Cylinder 2
Elbow θ1 < 0
Cylinder 1 Shoulder
O
P1
X
P0
FIGURE 3.5
General framework for the mechanical movement.
If the load is a spherical particle, the moment of inertia of the load rotation
from the elbow is proportional to the mass of the load. So it is computed by
mf 1.039
Ifp2 = Ifp20 = × 0.010018 = 0.1508573 kgm2 . (3.26)
mf 0 0.069
26 Nonlinear Control Techniques for EHAs in Robotics Engineering
TABLE 3.3
Mechanical Parameters of the Two-DOF Robotic Arm
No. Name Symbol Value Unit
When the current load is 1.039 kg, the distance from the centroid forearm
to the elbow (including the current load) is computed by
mf × P2 P3 + m2 × P2 Pm20
xc = = 0.23565 m. (3.27)
mf + m2
Substituting Ifp2 and xc into the above equation, the equivalent moment of
inertia of the forearm with the new load is computed by
I2f = 0.16911 kgm2 . (3.28)
The equivalent moment of inertia of the forearm with the new load rotated
at its centroid is computed by
I2fm = I2f − (m2 + mf )x2c = 0.07038 kgm2 . (3.29)
The equivalent moment of inertia of the upper arm with the cylinder
rotated at its centroid is computed by
L = KE − V, (3.31)
∂ ∂L ∂L
T= − , (3.32)
∂t ∂ q̇ ∂q
where T is the generalized force vectors including force and torque and q is
the generalized coordinates vector of the system.
The coordinate X-O-Y is constructed in Figure 3.5. The shoulder joint P1 is
the origin point. A hinge point P1 is fixed with the bedframe. The position
vector of P1 Pm1 is as follows:
T
roPm1/o = P1 Pm1 sin(−θ1 − εm1 ) P1 Pm1 cos(−θ1 − εm1 )
(3.33)
T
= −P1 Pm1 sin(θ1 + εm1 ) P1 Pm1 cos(θ1 + εm1 ) .
Then, the kinetic energy of the upper arm including cylinder 2 is com-
puted by
KEpm2 = 0.5m2f vPm2/o · vPm2/o + 0.5I2f (θ̇1 + θ̇2 ) · (θ̇1 + θ̇2 ). (3.40)
= 0.5m1 P1 P2m1 θ̇12 + 0.5I1 θ̇12 + 0.5m2f [P1 P22 θ̇12 + P2 P2m2 (θ̇12 + θ̇22 )
+ 2P1 P2 · P2 Pm2 θ̇1 (θ̇1 + θ̇2 ) cos(θ2 − εm1 )] + 0.5I2f (θ̇1 + θ̇2 )2 (3.43)
Using the Lagrange equation, if the angle vector q = [θ 1 , θ 2 ]T , then the kinetic
equation of the two-link system is given as follows:
where
H11 H12 C11 C12 G1 Tu
H= , C= , G= , T= , (3.45)
H21 H22 C21 C22 G2 Tf
Linear PID Control Design 29
After the kinetic model is constructed, according to the changes of the input
commands, a rate, and secondary rate of commands, two driving torques of
a two-link system are computed.
Then, two cylinder dynamic lengths are computed by
⎧
⎪
⎨ c1 (θ1 ) = a21 + b21 − 2a1 b1 cos(π/2 + θ1 + ε11 )
, (3.47)
⎪
⎩ c (θ ) = a2 + b2 − 2a b cos(π − θ − ε − ε )
2 2 2 2 2 2 2 21 22
⎧
⎪
⎪ a21 + c1 (θ1 )2 − b21
⎪
⎪ l (θ ) = a1 sin arccos
⎪
⎨ 1 1 2a1 c1 (θ1 )
, (3.48)
⎪
⎪ a22 + c2 (θ2 )2 − b22
⎪
⎪
⎩ l2 (θ2 ) = a2 sin arccos
⎪
2a2 c2 (θ2 )
where the ranges of two joint angles are − 70° ≤ θ 1 ≤ 50°, 20° ≤ θ 2 ≤ 140°.
In this robotic plant, the simulation results of two cylinder dynamic lengths
and force arms are as shown in Figure 3.6
30 Nonlinear Control Techniques for EHAs in Robotics Engineering
(a) (b)
0.37 0.045
0.36
0.35 0.04
0.34
0.035
0.33
c1 (m)
l1 (m)
0.32
0.03
0.31
0.3 0.025
0.29
0.02
–80 –60 –40 –20 0 20 40 60 –80 –60 –40 –20 0 20 40 60
θ1 (°) θ1(°)
(c) (d)
0.37 0.045
0.36
0.35 0.04
0.34
0.035
0.33
c2 (m)
l2 (m)
0.32
0.03
0.31
0.3 0.025
0.29
0.02
20 40 60 80 100 120 140 20 40 60 80 100 120 140
θ2 (°) θ2 (°)
FIGURE 3.6
Two cylinder dynamic lengths and force arms. (a) The dynamic length of the upper arm cylinder
c1 . (b) The dynamic force arm of the upper arm cylinder l1 . (c) The dynamic length of the forearm
cylinder c2 . (d) The dynamic force arm of the forearm cylinder l2 .
8
70
650 V
10
565 V
7
D
60
C BU
D
C BU
6
8
50
S
320 V
Current (Amps)
5
DC B
Torque (lb-in.)
Torque (Nm)
160 V
40
6
US
DC B
4
30
US
3
4
20
2
2
10
1
0
0
0 1 2 3 4 5 6 7
Speed (rpm) × 1000
FIGURE 3.7
Mechanical properties curve of the motor with load.
as shown in Figure 3.7. So, at this operated point, the motor rated power is
1.85 × 3000 × 2 × π
Pm = = 581 W. (3.49)
60
Tc × 2 × π × 10
Pn = × η = 39.7 bar,
ν
(3.50)
Tpeak × 2 × π × 10
Pmax = × η = 158.9 bar.
ν
The peak motor torque can stick about 2 s. This indicates only a short time
for the pump to provide a maximum pressure 158.9 bar. So the operated pres-
sure is no more than 40 bar long time. The maximum output flow of the pump
is computed by
Qmax = 3000 × ν × η = 8.95 L/min. (3.51)
Considering the servo valve and pipe pressure loss, the actual pressure of
cylinders is computed by
Considering the full efficiency of the pump ς , the output power of the
pump is computed by
Torque
Theta Theta Matrix Matrix Terminator
Force Force
Sub_Theta_Command Sub_Matrix
Theta
c_Theta c_Theta
Sub_Torque_Force Sub_Actuator_Flow
FIGURE 3.8
Simulation model for solvering the dynamic pressure of the cylinder with load.
Linear PID Control Design 33
Pf (bar)
0 20
10
–50
0
–100
–10
–150 –20
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
t (s) t (s)
(c) 700 (d) 1
0.8
600
0.6
500
0.4
Poweru (W)
400
Qf (L/min)
0.2
300 0
200 –0.2
–0.4
100
–0.6
0 –0.8
–100 –1
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
t (s) t (s)
(e) 4 (f) 1
0.8
3
0.6
0.4
2
Powerf (W)
Qu (L/min)
0.2
1 0
–0.2
0 –0.4
–0.6
–1
–0.8
–2 –1
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
t (s) t (s)
FIGURE 3.9
Simulation result with the elbow joint θ 2 = 140°, the sinusoidal input of the shoulder angle
f u = 1.05 Hz. (a) The pressure of the upper arm cylinder with load pu . (b) The pressure of the
forearm cylinder with load pf . (c) The flow of the upper arm cylinder with load Qu . (d) The flow
of the forearm cylinder with load Qf . (e) The power consumption of the upper arm cylinder with
load Poweru . (f) The power consumption of the forearm cylinder with load Powerf .
TABLE 3.4
Parametric Analysis of the Shoulder Hydraulic Actuator
Maximum Maximum Maximum Maximum
Condition Frequency Pressure Flow Power
arm cylinder is 3.75 L/min, which is less than the output flow of the pump
8.95 L/min. These results indicate that the frequency of the shoulder angle
should not exceed 1.05 Hz. The parametric analysis of the shoulder hydraulic
actuator is shown in Table 3.4.
Case 2: The pressure of the cylinder supporting the elbow
If the shoulder joint is fixed, θ1 = θ1 min = −70◦ and the load mf = 1.039 kg,
and the elbow angle is sinusoidal input, the simulation result is acquired as
shown in Figure 3.10.
As shown in Figure 3.10, if the condition of the frequency of θ 2 is 1.85 Hz,
the flow of the forearm cylinder with load is 150 bar. It reaches the maxi-
mum torque value. But the power of the forearm cylinder is 226 W, which
is less than the rated power 494 W. At this moment, the flow of the fore-
arm cylinder is 6.6 L/min, which is less than the output flow of the pump
8.95 L/min. These results indicate that the frequency of the elbow angle
should not exceed 1.85 Hz. The parametric analysis of the elbow hydraulic
actuator is shown in Table 3.5.
Case 3: The pressure of the cylinder with two joints in simultaneously motion
If two joints change simultaneously and the load mf = 1.039 kg, the simu-
lation results are acquired as shown in Figure 3.11.
As shown in these figures, if the condition of the frequency of θ 1 is 0.6 Hz
and θ 2 is 1 Hz, the flow of the upper arm cylinder with load is 150 bar. It
reaches the maximum torque value. But the power of the upper arm cylinder
is 70 W, which is less than the rated power 494 W. Also, the power of the
forearm cylinder is only 47 W. At this moment, the total flow of two cylinders
is 5 L/min, which is less than the output flow of the pump 8.95 L/min. These
results indicate that the frequencies of shoulder and elbow angles should not
exceed 0.6 and 1 Hz respectively. The parametric analysis of two hydraulic
actuators is shown in Table 3.6.
(a) (b)
200 250
200
150 150
100
100
Pu (bar)
Pf (bar)
50
0
50
–50
0 –100
–150
–50 –200
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
t (s) t (s)
(c) 1 (d) 7
0.8 6
0.6 5
0.4 4
Qf (L/min)
Qu (L/min)
0.2 3
0 2
–0.2 1
–0.4 0
–0.6 –1
–0.8 –2
–1 –3
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
t (s) t (s)
(e) 1
(f ) 200
0.8
0.6 0
0.4
Powerf (W)
–200
Poweru (W)
0.2
0 –400
–0.2
–600
–0.4
–0.6 –800
–0.8
–1 –1000
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
t (s) t (s)
FIGURE 3.10
Simulation result with the shoulder joint θ 1 = − 70°, the sinusoidal input of the elbow angle
f f = 1.85 Hz. (a) The pressure of the upper arm cylinder with load pu . (b) The pressure of the
forearm cylinder with load pf . (c) The flow of the upper arm cylinder with load Qu . (d) The flow
of the forearm cylinder with load Qf . (e) The power consumption of the upper arm cylinder with
load Poweru . (f) The power consumption of the forearm cylinder with load Powerf .
TABLE 3.5
Parametric Analysis of Elbow Hydraulic Actuator
Maximum Maximum Maximum Maximum
Condition Frequency Pressure Flow Power
The supply pressure ps is 150 bar. pl max is the maximal pressure of the cylin-
der with load. If the load mass is 3 kg, the value is 100 bar of the upper arm
cylinder, which satisfies this relation. So the load mass is chosen as 3 kg suffi-
ciently. Owing to the asymmetrical hydraulic cylinder, the open-loop transfer
function of this system is shown as follows:
Kqa Ksv
Gc (s)
A T s+1
Gol = a sv . (3.56)
Vt mt m t Kcea Be Vt
s +
3 + s2
2(1 + υ 2 )βe A2a A2a 2(1 + υ 2 )βe A2a
Be Kcea Vt K
+ 1+ + s + KK2cea
A2a 2(1 + υ 2 )βe A2a Aa
Kqb Ksv
Gc (s)
A T s+1
Gol = a sv , (3.57)
Vt mt mt Kceb Be Vt
s 3 + + s2
2(1 + υ 2 )βe A2a A2a 2(1 + υ 2 )βe A2a
Be Kceb Vt K KKceb
+ 1+ + s+
Aa 2 2(1 + υ )βe Aa
2 2 A2a
The maximal supply pressure ps is 150 bar and the maximal load mass mf
is 3 kg. The control law is designed by MATLAB/SISO tool like this
ki 1
Gc (s) = kp + × , (3.58)
s 1 + b1 s
where kp and ki are the proportional and integral control parameters, and
b1 is the lag parameter. This hysteresis element 1/(1 + b1 s) can improve the
dynamic quality of the control variable u and suppress the control saturation
as the initial large error existing in the system.
Linear PID Control Design 37
100 150
50 100
Pu (bar)
Pf (bar)
0 50
–50 0
–100 –50
–150 –100
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
t (s) t (s)
(c) 2.5 (d) 4
2 3
1.5
2
Qu (L/min)
Qf (L/min)
1
1
0.5
0
0
–0.5 –1
–1 –2
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
t (s) t (s)
(e) 500 (f) 50
0
400 –50
–100
300
Powerf (W)
Poweru (W)
–150
200 –200
–250
100 –300
–350
0
–400
–100 –450
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
t (s) t (s)
FIGURE 3.11
Simulation result with two sinusoidal inputs of the shoulder angle f u = 0.6 Hz and the elbow
angle f f = 1 Hz. (a) The pressure of the upper arm cylinder with load pu . (b) The pressure of the
forearm cylinder with load pf . (c) The flow of the upper arm cylinder with load Qu . (d) The flow
of the forearm cylinder with load Qf . (e) The power consumption of the upper arm cylinder with
load Poweru . (f) The power consumption of the forearm cylinder with load Powerf .
The designed results of control design for the upper arm cylinder is shown
as follows:
1. If the hydraulic cylinder is extended, that is, ẏ ≥ 0, the con-
trol parameters and the lag parameter are kp = 178.5, ki = 21, and
b1 = 0.073.
38 Nonlinear Control Techniques for EHAs in Robotics Engineering
TABLE 3.6
Parametric Analysis of Two Joint Angles Simultaneously Motion
Joint Maximum Frequency Maximum Pressure Maximum Flow Maximum Power
Root locus editor for open loop 1 (OL1) Open-loop bode editor for open loop 1 (OL1)
4000 200
2000 100
0 0
–100
–2000
–200 –180
–400 –270
0
–180 –360
–360 P.M.: 57°
Frequency: 7.02 rad/s
–540 –450
100 102 104 10–5 100 105
Frequency (rad/s) Frequency (rad/s)
FIGURE 3.12
Frequency domain characteristic of the open-loop control system for the shoulder actuator for
Equation 3.56.
Amplitude
0.05
4
0.04
0.03 2
0.02
0
0.01
0 –2
0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9
Time (s) Time (s)
FIGURE 3.13
Performance results of the PI controller design for the shoulder actuator for Equation 3.56. (a)
The step response of the upper arm cylinder for the maximal stroke y. (b) The voltage control
with respect to step response u.
Root locus editor for open loop 1 (OL1) Open-loop bode editor for open loop 1 (OL1)
4000 150
100
2000
50
0 0
–50
–2000
–100
G.M.: 18.6 dB
–4000 –150 Frequency: 33.3 rad/s
–4000 –2000 0 2000 4000 Stable loop
–200
Bode editor for closed loop 1 (CL1)
0 –90
–200 –180
–400 –270
0
–180 –360
–360 P.M.: 49.5°
Frequency: 9.08 rad/s
–540 –450
100 102 104 10–4 10–2 100 102 104
Frequency (rad/s) Frequency (rad/s)
FIGURE 3.14
Frequency domain characteristic of the open-loop control system for the shoulder actuator for
Equation 3.57.
0.06 3
0.05
0.04 2
0.03 1
0.02
0
0.01
0 –1
0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1 0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1
Time (s) Time (s)
FIGURE 3.15
Performance results of the PI controller design for the shoulder actuator for Equation 3.57. (a)
The step response of the upper arm cylinder for the maximal stroke y. (b) The voltage control
with respect to step response u.
Linear PID Control Design 41
TABLE 3.7
Control Parameters and Performance Design with Respect to Different Pressures of
the Upper Arm Cylinder with Different Loads in the Condition of Extended State
Load Pressure (bar) Kp /Ki Bandwidth (rad/s) Steady Time (s) Maximum Control (V)
TABLE 3.8
Control Parameters and Performance Design with Respect to Different Pressures of
the Upper Arm Cylinder with Different Loads in the Condition of Retracted State
Load Pressure (bar) Kp /Ki Bandwidth (rad/s) Steady Time (s) Maximum Control (V)
need to be adaptively regulated with the variable external load. Table 3.7
gives the control parameters and performance design with respect to differ-
ent pressures of the upper arm cylinder with different loads in the condition
of extended state.
As the hydraulic cylinder is controlled to be retracted, the control
parameters are also switched into the other designed interpolation table as
shown in Table 3.8. Obviously, the control parameters in the retracted condi-
tion are less than the corresponding parameters in the extended condition
because the external load of the retracted cylinder is negative where the
gravity of the load mass need not be compensated.
Similarly, the control parameters of the forearm cylinder is also designed
like the above two tables in the condition of extended and retracted states.
3.5 Experiment
To verify the PI controller, the experimental bench of the two-DOF robotic
arm driven by EHA is set up as shown in Figure 3.16 [11,12]. The two EHAs
include two servo valves (Moog D633-R02K01M0NSM2), two double-acting
cylinders (Hoerbiger LB6-1610-0080-4M), an axial piston pump (Takako TFH-
315), a servo motor (BALDOR BSM63N-375), and a relief valve. The angle
42 Nonlinear Control Techniques for EHAs in Robotics Engineering
11
1
3 10
8 9 4
5
6
FIGURE 3.16
Experimental equipment (1—robotic arm, 2—hydraulic cylinder, 3—servo valve, 4—pressure
gauge, 5—relief valve, 6—fixed displacement pump, 7—servo motor, 8—encoder, 9—pressure
sensor, 10—tank, 11—IPC).
TABLE 3.9
Hydraulic Parameters Used in Simulation and Experiment
Parameter Value Parameter Value
Cd 0.62 w 0.024 m
ps 40 bar Aa 2.01 cm2
Ab 1.25 cm2 ν 0.62
Vt 1.74 × 10−5 m3 βe 7 × 108 Pa
Ksv 7.9 × 10−5 m/V Lmax 58 mm
Tsv 12 ms umax 10 V
K 0 b 2200 N.s/m
Ctl 2.5 × 10−11 m3 /(s · Pa) ρ 850 kg/m3
Figures 3.17 and 3.18 show the position tracking results of the two
hydraulic cylinders. The magnitude of two sinusoidal demands is 29 mm,
and the two frequencies are 0.8 and 1 Hz. The two dynamic position errors
are less than 3 mm, that is, (yid − yi )/yid < 10%. The position errors of the
forearm cylinder is less than that of the upper arm cylinder, since the exter-
nal load of the upper arm hydraulic actuator is more violent than that of
forearm actuator from Figure 3.11. The two control variable u does not
exceed the control saturation ± 10 V, which means that the designed PI
controller can guarantee the stability of the closed-loop feedback control
10 1.5
1
0
0.5
–10 0
–0.5
–20
–1
–30 –1.5
0 5 10 15 0 5 10 15
Time (s) Time (s)
FIGURE 3.17
Position tracking results of the upper arm cylinder. (a) The upper arm position response y1 . (b)
The upper arm position error y1 .
(a)
y2d y2 (b) Δy2
30 3
20 2
Position (mm)
Position (mm)
10 1
0 0
–10 –1
–20 –2
–30 –3
0 5 10 15 0 5 10 15
Time (s) Time (s)
FIGURE 3.18
Position tracking results of the forearm cylinder. (a) The forearm position response y2 . (b) The
forearm position error y2 .
44 Nonlinear Control Techniques for EHAs in Robotics Engineering
(a) 8 (b) 8 u2
u1
6 6
4 4
Control (V)
Control (V)
2 2
0 0
–2 –2
–4 –4
–6 –6
–8 –8
0 5 10 15
0 5 10 15
Time (s)
Time (s)
FIGURE 3.19
Dynamic control voltages of two servo valves. (a) The upper arm control variable u1 . (b) The
forearm control variable u2 .
(a) 50 (b) 40
pa pb pa pb
35
40
Chamber pressure (bar)
30
pressure (bar)
30
25
20 20
15
10
10
0 5
–10 0
0 2 4 8 10 12 0 2 4 8 10 12
Time (s) Time (s)
FIGURE 3.20
Two chamber pressures of two cylinders. (a) The two chamber pressures of the upper arm
cylinder pa , pb . (b) The two chamber pressures of the forearm cylinder pa , pb .
4
Robust Control Method
CONTENTS
4.1 Linearized Hydraulic Model Construction . . . . . . . . . . . . . . . . . . . . 46
4.2 Analysis of Parametric Uncertainty . . . . . . . . . . . . . . . . . . . . . . . . . 47
4.3 Robust Model Construction . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 50
4.4 Robust Controller Design . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 54
4.4.1 Analysis of Open-Loop System . . . . . . . . . . . . . . . . . . . . . . . 54
4.4.2 Weight Function Design . . . . . . . . . . . . . . . . . . . . . . . . . . . . 55
4.4.3 Robust Controller Design . . . . . . . . . . . . . . . . . . . . . . . . . . . 58
4.4.4 Simulation and Experimental Result . . . . . . . . . . . . . . . . . . . 62
45
46 Nonlinear Control Techniques for EHAs in Robotics Engineering
Kqi
1 Vt
Aa xv (s) − A2a Kcei + 2(1+υ 2 )βe
s FL (s)
y(s) = , (4.1)
Vt mt mt Kcei bVt
s3 + + 2 s
2
2(1+υ 2 )βe A2a A2a 2(1+υ 2 )βe Aa
bKcei Vt K KKcei
+ 1+ + s+
A2a 2(1+υ 2 )βe A2a A2a
where y is the displacement of the piston, xv is the spool position of the servo
valve, Kqi , Kcei (i = a, b) are the flow gain of the servo valve and flow-pressure
coefficient, Aa and Ab are the annulus areas of the two chambers (υ = Aa/Ab ),
V t is the cylinder volume, β e is the effective bulk modulus, mt is the load
mass, K is the load spring constant, b is the viscous damping coefficient of
oil, and FL is the external load on the hydraulic actuator from the mechanical
structure of the two-DOF robotic arm.
Remark 4.1
From Equation 4.1, it is clear that the hydraulic cylinder model is simplified
as a third-order linear model. If there exist bounded uncertain parameters
such as V t , K, b, Kq , and Kce , this linear model is appropriately handled by the
robust control method, which obtains an H∞ suboptimal solution to preserve
a satisfactory dynamic control performance.
2 2
ẍv + 2ζsv ωsv ẋv + ωsv xv = Ksv ωsv u, (4.2)
where ζ sv is the damping ratio, ωsv is the natural frequency, Ksv is the servo
valve gain, and u is the control voltage.
According to Equations 4.1 and 4.2, the whole state-space model of the
electro-hydraulic actuator is five. The control input variable is u and the
output cylinder position is y.
Robust Control Method 47
ps − pl − pvloss − ptube
Kq = Kq0 ,
ps
2
Kqa = Kq , (4.3)
1 + υ3
2(υ(ps − pvloss − ptube ) + pl )
Kqb = Kq .
(ps − pvloss − ptube − pl )(1 + υ 3 )
The load mass is 1 kg and the motion frequency of the shoulder arm is
assumed to be no more than 0.5 Hz. Thus, the load pressure pL range of the
shoulder cylinder can be estimated by Lagrange equation. The maximum
value of pL is 40 bar. If some known parameters are substituted into Equa-
tion 4.3, the flow gain ranges of the rod chamber and non-rod chamber are
TABLE 4.1
Hydraulic Parameters Used in Simulation and
Experiments
Parameter Value Parameter Value
estimated as follows:
0.012 ≤ Kqa ≤ 0.02,
(4.4)
0.019 ≤ Kqb ≤ 0.027.
So the range of Kq can be considered as 0.012 < Kq < 0.027. The nominal
values K̄q of Kq is 0.02 m2 /s and the maximum relative uncertainty pKq is
0.375 with the relative variation. The flow gain of the servo valve Kq can be
represented as follows:
After the known parameters are substituted into Equation 4.8, the nom-
inal values V̄t of V t is 2.85e-5 m3 and the maximum relative uncertainty
pVt is 0.663 with the relative variation δ Vt . The cylinder volume V t can be
represented as follows:
b = b̄(1 + pb δb ), −1 ≤ δb ≤ 1. (4.10)
Now the external load FL is the maximum disturbance in the dynamic char-
acteristic of the cylinder. It can be considered as an unmodeled disturbance.
In this chapter, the quantitative relationship between the external load FL and
the position of the cylinder is analyzed to describe the structural uncertainty.
According to Equation 3.43, two torques on the upper arm and forearm Tu
and Tf are obtained by Lagrange method. Then, two external load forces FLu ,
FLf that change with the variation of two joint angles are computed by
⎧ Tu (θ1 , θ2 )
⎪
⎨ FLu (θ1 , θ2 ) = l (θ )
⎪
1 1
, (4.11)
⎪
⎪ T (θ ,θ )
⎩ FLf (θ1 , θ2 ) = f 1 2
l2 (θ2 )
where li (θ i )(i = 1, 2) are the force arms of the external load forces.
To consider the effect of the external load in the linear model (4.1) of EHS,
two fictitious proportional gains are defined as follows:
⎧
⎪ FLu (θ1 , θ2 ) Tu (θ1 , θ2 )
⎪
⎪ KFLu (θ1 ) = =
⎪
⎪ c1 (θ1 ) l1 (θ1 )c1 (θ1 )
⎪
⎪
⎪
⎪ FLu (θ1 , θ2 ) Tu (θ1 , θ2 )
⎪
⎪
⎨ KFLu (θ2 ) = c2 (θ2 )
⎪ =
l1 (θ1 )c2 (θ2 )
, (4.12)
⎪
⎪ FLf (θ1 , θ2 ) Tf (θ1 , θ2 )
⎪
⎪ KFLf (θ1 ) = =
⎪
⎪ c1 (θ1 ) l2 (θ2 )c1 (θ1 )
⎪
⎪
⎪
⎪
⎪
⎪ F (θ , θ ) Tf (θ1 , θ2 )
⎩ KFLf (θ2 ) = Lf 1 2 =
c2 (θ2 ) l2 (θ2 )c2 (θ2 )
The nominal values K̄FLu , K̄FLf of KFLu and KFLf are 0 N/m, which means
the no-load motion. The maximum relative uncertainties pKFLu and pKFLf are
50 Nonlinear Control Techniques for EHAs in Robotics Engineering
1500
KF (θ1)
Lu
KF (θ2)
Lu
KF (θ1)
Lf
1000
KF (θ2)
Lf
500
KF (N/m)
L
–500
–1000
0 0.5 1 1.5 2
t (s)
FIGURE 4.1
Dynamic ranges of KFLu and KFLf in one motion duration.
1200 and 300 with the relative variations δ KFLu and δ KFLf . The two fictitious
proportional gains and can be represented as follows:
KFLu = K̄FLu (1 + pKFLu δKFLu ), −1 ≤ δKFLu ≤ 1
. (4.14)
KFLf = K̄FLf (1 + pKFLf δKFLf ), −1 ≤ δKFLf ≤ 1
Remark 4.2
From Equations 4.5, 4.9, and 4.10, the three parametric uncertainties Kq , V t ,
and b are adopted by the multiplication uncertain expressions. However, KFL
is adopted by the addition uncertain expression.
0 K̄q
MKq = ,
pKq K̄q
−pVt 1/V̄t
MVt = , (4.15)
−pVt 1/V̄t
0 B̄e
MBe = .
pBe B̄e
0 1
MKFLu = ,
pKFLu K̄FLu
(4.16)
0 1
MKF = p K̄FLf .
Lf KF Lf
Taking the shoulder hydraulic actuator for example, the robust model with
parametric and structural uncertainties is shown in Figure 4.2. If some vec-
tors are defined as the state variable vector X = [x1 , x2 , x3 , x4 , x5 ]T , the control
inputs u(t) is the voltage of the servo valve, the vector of exogenous inputs
w(t) = [w1 , w2 , w3 , w4 , w5 , w6 ]T , the vector of measurements y(t), the reg-
ulated output vector z(t) = [z1 , z2 , z3 , z4 , z5 , z6 ]T , then the linear uncertain
state-space model is described as follows:
⎧
⎪
⎪ Ẋ(t) = AX(t) + B1 W(t) + B2 u(t)
⎨
Z(t) = C1 X(t) + D11 W(t) , (4.17)
⎪
⎪
⎩
Y(t) = C2 X(t) + Yd (t)
where
⎡ ⎤
0 1 0 0 0
⎢ ⎥
⎢ −ωsv 2 −2ζsv ωsv 0 0 0 ⎥
⎢ ⎥
⎢ ⎥
⎢ 0 0 0 1 0 ⎥
A =⎢
⎢
⎥,
⎥
⎢ 0 0 0 0 1 ⎥
⎢ ⎥
⎢ ⎥
⎣4K̄q βe Aa 4βe K̄FLu Kce 4βe A2a K̄F −4Kce βe ⎦
0 − − − b̄βe Kce − m Lu − mb̄
V̄t m1f V̄t m1f V̄t m1f V̄ m 1f V̄t 1f
t 1f
(4.18)
52 Nonlinear Control Techniques for EHAs in Robotics Engineering
δK w4
w1 FLu
δKq w6
z1 δV MK
t z6 FLu
1/m1f
xv 4β A MKq + −
e a
m1f − x⋅ 3 x⋅ 2 x⋅ 1 x1
−
MV
t ∫ ∫ ∫
− −
− δB
e w5
z5
MB 1/m1f
e
4Kcβe
4βe Aa2
m1f
w3
δB
z3 e
βe Kc
MB
e m1f
δK w2
FLu
z2
MK 4βe Kc
FLu m1f
FIGURE 4.2
Robust model with parametric and structural uncertainties.
⎡ ⎤
0 0 0 0 0 0
⎢ 0 0 0 0 0 0 ⎥
⎢ ⎥
⎢ 0 0 0 0 0 0 ⎥
B1 = ⎢
⎢ 0
⎥,
⎥ (4.19)
⎢ 0 0 0 0 0 ⎥
⎣ pKq pKFLu pBe ⎦
− − −pKFLu −pBe −pvt
V̄t V̄t V̄t
T
B2 = 0 Ksv ωsv
2 0 0 0 , (4.20)
⎡ ⎤
4K̄q βe Aa
⎢ m 0 0 0 0 ⎥
⎢ 1f ⎥
⎢ 4βe Kc ⎥
⎢ 0 0 0 0 ⎥
⎢ ⎥
⎢ m1f ⎥
⎢ ⎥
⎢ b̄βe Kc ⎥
⎢ 0 0 0 0 ⎥
⎢ m1f ⎥
C1 = ⎢
⎢ 1
⎥ , (4.21)
⎥
⎢ 0 0 0 0 ⎥
⎢ m1f ⎥
⎢ ⎥
⎢ B̄e ⎥
⎢ ⎥
⎢ 0 0 0 0 ⎥
⎢ m1f ⎥
⎢ ⎥
⎣ 4K̄q βe A 4βe K̄FLu Kc 4βe A2a B̄e βe Kc −4Kc βe ⎦
0 − − −
V̄t m1f V̄t m1f V̄t m1f V̄t m1f V̄t
Robust Control Method 53
eu
Wu
Uncertainty model
Δ
z
w
+
r + u Ghyd y ep
K Wp
− −
+
d −
Gd
FIGURE 4.3
Block diagram of the closed-loop system with robust performance requirements.
⎡ ⎤
0 0 0 0 0 0
⎢ 0 0 0 0 0 0 ⎥
⎢ ⎥
⎢ 0 0 0 0 0 0 ⎥
⎢ ⎥
D11 =⎢
⎢ 0 0 0 0 0 0 ⎥,
⎥ (4.22)
⎢ 0 0 0 0 0 0 ⎥
⎢ ⎥
⎣ pKq pKFLu pBe ⎦
− − 0 0 −pvt
V̄t V̄t V̄t
C2 = 0 0 1 0 0 . (4.23)
1 + 0.12s
Yd (s) = Gd (s)N(s), Gd (s) = 0.006 × , (4.24)
1 + 0.001s
Remark 4.3
The block diagram of the closed-loop system (Figure 4.3) involves two inputs
r and d, and two outputs ep and eu , where ep is the tracking error of the
54 Nonlinear Control Techniques for EHAs in Robotics Engineering
cylinder position and eu is the control variable. The objective of the robust
controller is to design K to guarantee the tracking error ep = W p (r − y)
achieving the required performance under the control saturation constraint
of the control variable eu and the existed external disturbance d.
(4.25)
100
Log magnitude (dB)
Nominal
Perturbed
10−2
10−4
0.1 1 6.28 10 100
0
Phase (degrees)
−50
−100
−150
−200
0.1 1 6.28 10 100
Frequency (rad/s)
FIGURE 4.4
Frequency response of the open-loop system with varying uncertainty parameters Kq , V t , b, and
KFLu .
duration in Section 4.2, the simplified linearized model (4.13) can be substi-
tuted into Equation 4.1, and the open-loop system of the EHS model (4.25) is
obtained.
s/Ms + ωc
Wp = . (4.26)
s + ωc Ae
where ∀e1 , e2 ∈ Lp , and γ 1 γ 2 < 1, then there exist two sufficiently large
constants γ and c such that
e1 u1
e2 ≤ γ u2 + c, (4.28)
y1 = H1 e1 , e1 = u1 − y2 ,
(4.29)
y2 = H2 e2 , e2 = u2 + y1 .
u1 + e1
H1
– y1
+
y2 u2
e2
H2
+
FIGURE 4.5
Cross-linked feedback system.
Robust Control Method 57
Thus, if two errors e1 and e2 are defined as the system outputs, and u1 , u2
are system inputs, then the following condition is satisfied:
e1 = u1 − H2 e2
. (4.30)
e2 = u2 + H1 e1
To address Equation 4.32, if the two sides of two equalities are multiplied by
γ 1 , γ 2 , respectively, and are incorporated together, we can obtain
⎧ 1
⎪
⎨ e1 ≤ 1 − γ γ (u1 + γ2 u2 + c2 + γ2 c1 )
⎪
1 2
. (4.33)
⎪
⎪ 1
⎩ e2 ≤ (u2 + γ1 u1 + c1 + γ1 c2 )
1 − γ1 γ2
Remark 4.4
Theorem 5.1 denotes that if the feedforward subsystem and feedback
subsystem H1 and H2 are L stable, and the gain γ 1 , γ 2 are bounded by
γ 1 γ 2 < 1, then the closed-loop system is a bounded-input-bounded-output
stable system.
101
100
Magnitude
10−1
μ(W −1
p )
10−2
μ(G cn)
10−3
10−4 10−3 10−2 10−1 100 101 102
Frequency (rad/s)
FIGURE 4.6
Singular values of the inverse function μ−1 Wp and the nominal closed-loop system μ Gnc .
Gic = Fu(Ghyd, Δ)
Δ
z Gc
w
u Ghyd y Gic
d ep
Gd Wp
K K
eu
Wu
FIGURE 4.7
Block diagram for the description of robust stability and robust performance.
outputs. After the robust stability is discussed, the robust performance of the
controller K is analyzed in the right figure. In this case, d is the input and the
dynamic tracking performance of position ep is the output. The robust sta-
bility of the designed controller is equivalent to the H∞ suboptimal control
problem as follows.
The subsystem Gic = Fu Ghyd , with the parametric uncertainty is con-
structed as a cross-link together with the controller K. According to Theo-
rem 5.1, a stabilizing controller K needs to be found such that the H∞ norm
of the closed-loop transfer function is less than a given positive number γ ,
that is,
Fl (Gic , K)∞ = Fl Fu Ghyd , , K ∞ < γ , (4.37)
Wp (I + Gic K)−1 Gd
< 1, (4.38)
Wu K(I + G K)−1
ic ∞
100
Upper bound
Low bound
10−1
μ(GicK)
10−2
10−3
10−3 10−2 10−1 100 101 102
Frequency (rad/s)
FIGURE 4.8
Maximum robust stability bound with varying uncertainty parameters Kq , V t , b, and KFLu .
100 Nominal
Upper bound
Low bound
10−0.1
μ
10−0.2
FIGURE 4.9
Maximum robust performance bound with varying uncertainty parameters Kq , V t , b, and KFLu .
Robust Control Method 61
102
Log |u|
7th orders u
4th orders u
100
10−4 10−2 100 102 104
Frequency (rad/s)
100
7th orders u
Phase (degrees)
4th orders u
−100
10−4 10−2 100 102 104
Frequency (rad/s)
FIGURE 4.10
Frequency domain result of the designed robust controller.
62 Nonlinear Control Techniques for EHAs in Robotics Engineering
0.08
0.06
0.04
y (m)
0.02
0
Response
Demand
−0.02
0 2 4 6 8 10 12
Time (s)
FIGURE 4.11
Cylinder position response in time domain by the designed robust controller.
n4 s4 + n3 s3 + n2 s2 + n1 s + n0
Ki (s) = yid − yi , i = 1, 2, (4.39)
d4 s + d3 s + d2 s + d1 s + d0
4 3 2
15
10
5
u (V)
−5
−10
0 2 4 6 8 10 12
Time (s)
FIGURE 4.12
Designed controller result in time domain.
the relative variations δ Vt , δ b , δ KFLu , and δ KFLf are all selected as 1, which means
the maximum uncertainties. Then, two simulation results about the square
response and the sinusoidal response of the maximum stroke are shown in
Figures 4.13 through 4.16.
Shoulder angle (degrees)
20 Demand
0 Simulation
−20 Experiment
−40
−60
−80
0 5 10 15 20 25
Elbow angle (degrees)
120
100
80
60
40
0 5 10 15 20 25
t (s)
FIGURE 4.13
Square response of two joint angles in simulation and experiment.
64 Nonlinear Control Techniques for EHAs in Robotics Engineering
10
Shoulder control (V)
−5 Simulation
Experiment
−10
0 5 10 15 20 25
10
Elbow control (V)
−5
−10
0 5 10 15 20 25
t (s)
FIGURE 4.14
Control voltage of two servo valves in simulation and experiment for square demand.
The two square frequencies are 0.1 and 0.1 Hz and the sinusoidal frequen-
cies are 0.3 and 0.5 Hz, respectively. Since the load on the shoulder joint
is heavier than the elbow joint, the sinusoidal frequency for the shoulder
motion is not allowed too high. The steady errors of two joint angles are less
than 2, 0.5, respectively, shown in Figure 4.13, which means that the relative
position errors are less than 5%. Owing to the small dynamic mechanical load
on the elbow arm, the tracking accuracy is higher than the shoulder arm. The
control voltages of two servo valves are no more than the control saturation
± 10 V as shown in Figure 4.14.
Similarly for the sinusoidal response, the maximum dynamic errors of two
joint angles are less than 3°, 3°, respectively, shown in Figure 4.15. These
steady errors are no more than the relative error 5% of demand input. The
control voltages are also no more than ± 10 V as shown in Figure 4.16. So the
two robust controllers of two hydraulic actuators can be validated effectively
in simulation.
In this experiment, the supply pressure ps is 40 bar, and the motor revo-
lution is fixed at 1000 rpm. The joint angle is measured by an encoder and
the control voltage is measured by a serial port terminal of the servo valve.
The experiment results are very close to the corresponding simulation results
as shown in Figures 4.13 through 4.16. The steady errors of two joint angles
are less than 2°, 2°, respectively, in square response results. The maximum
Robust Control Method 65
40
Demand
20 Simulation
0 Experiment
–20
–40
–60
–80
0 1 1.65 2 3 3.3 4 5 6 7 8 9 10
140
Elbow angle (degrees)
120
100
80
60
40
0 1 2 3 4 5 6 7 8 9 10
t (s)
FIGURE 4.15
Sinusoidal response of two joint angles in simulation and experiment.
dynamic errors of two joint angles are less than 4°, 4°, respectively, in sinu-
soidal response results, which are no more than the relative error 5% of
demand input. So the two robust controllers can guarantee the tracking posi-
tion accuracy and dynamic response performance in the case of the robust
stability. Furthermore, the control voltages of two servo valves are also no
2
Shoulder control (V)
–2
–3 Simulation
Experiment
–4
0 1 2 3 4 5 6 7 8 9 10
5
4
Elbow control (V)
–5
0 1 2 3 4 5 6 7 8 9 10
t (s)
FIGURE 4.16
Control voltage of two servo valves in simulation and experiment for sinusoidal demand.
66 Nonlinear Control Techniques for EHAs in Robotics Engineering
20
–45
0 –50
–55 20
–20 –60 18
–65
–40 16 Demand
14 PI control
–60 10 Robust control
0 5 10 15 20 25
Elbow angle (degrees)
120
100
80
40
60 5
40
0 5 10 15 20 25
t (s)
FIGURE 4.17
Square response of the experiment result by the two control methods.
more than the control saturation, which is reflected in the robust performance
requirement eu as shown in Equation 4.38.
The traditional PI control methods can also be used in this EHS. The experi-
ment result comparison for the two control methods is shown in Figures 4.17
and 4.18. In Figure 4.17, although the step response by PI control is faster
than by robust control, the transient chatter emerges in two responses of the
shoulder, especially in the retraction process of the shoulder actuator. This
chatter phenomenon is the main cause by the different hydraulic parameters,
rapid changes of load forces between actuator extension and retraction. It
shows that the robust H∞ control method can eliminate the transient chatter
Shoulder angle (degrees)
20 –40 Demand
PI control
0 –50 Robust control
–20 –60
5
–40
–60
0 1 2 3 4 5 6 7 8 9 10
140
Elbow angle (degrees)
120
100
80 130
120
60
110
40 5
0 1 2 3 4 5 6 7 8 9 10
t (s)
FIGURE 4.18
Sinusoidal response of the experiment result by the two control methods.
Robust Control Method 67
(a) (b)
(c) (d)
(e) (f )
FIGURE 4.19
Snapshots of the sinusoidal experiment process. (a) Two cylinders retracted entirely (t = 0 s). (b)
The elbow cylinder extended to the maximum stroke (t = 1 s). (c) The shoulder cylinder extended
to the maximum stroke (t = 1.65 s). (d) The elbow cylinder retracted entirely (t = 2 s). (e) The elbow
cylinder extended to the maximum stroke once again (t = 3 s). (f) The shoulder cylinder extended
to the maximum stroke once again (t = 3.3 s).
68 Nonlinear Control Techniques for EHAs in Robotics Engineering
CONTENTS
5.1 Output Feedback Control Model of EHS . . . . . . . . . . . . . . . . . . . . . 69
5.2 State Observer Design . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 72
5.2.1 Full-State Observer Construction . . . . . . . . . . . . . . . . . . . . . . 72
5.2.2 Observer Convergence . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 76
5.3 Nonlinear Backstepping Control . . . . . . . . . . . . . . . . . . . . . . . . . . . 81
5.3.1 Backstepping Procedure . . . . . . . . . . . . . . . . . . . . . . . . . . . . 82
5.3.2 Controller Design with Observer . . . . . . . . . . . . . . . . . . . . . . 84
5.3.3 Stability Discussion of EHS . . . . . . . . . . . . . . . . . . . . . . . . . . 86
5.4 Experiment . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 88
5.4.1 Result of the Proposed Method . . . . . . . . . . . . . . . . . . . . . . . 88
5.4.2 Compared Result . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 91
69
70 Nonlinear Control Techniques for EHAs in Robotics Engineering
load. The variable load Pl drives the two-DOF robotic arm manufactured by
Italian Institute of Technology, which is referred as the Robotic BigDog. In this
section, the nonlinear dynamic model of the single-rod hydraulic actuator
will be discussed.
The dynamics of the servo valve is adopted by a second-order linear model
mentioned in Equation 2.9 as follows:
2 2
ẍv + 2ζsv ωsv ẋv + ωsv xv = Ksv ωsv u, (5.1)
where xv is the spool position of the servo valve, ζ sv is the damping ratio, ωsv
is the natural frequency, and Ksv is the gain of control voltage u.
According to Equation 2.6, the flow equations of the single-rod cylinder
can be described as follows:
Cd wxv 2(ps − pa )/ρ xv ≥ 0
Qa = ,
Cd wxv 2(pa − pr )/ρ xv < 0
Cd wxv 2(pb − pr )/ρ xv ≥ 0
Qb = (5.2)
Cd wxv 2(ps − pb )/ρ xv < 0
where Qa is the main load flow as xv ≥ 0, Qb is the main load flow as xv < 0,
pa and pb are the pressure inside the two chambers of the cylinder, ps is the
supply pressure of the pump, Cd is the discharge coefficient, w is the area
gradient of the servo valve spool, and ρ is the density of the hydraulic oil.
The two load flows Qa and Qb are handled like the following uniform form:
⎧
⎪
⎪ 1 + sgn(xv ) 2
⎪
⎪ Q = Cd wxv (ps − pa )
⎪
⎪ a
ρ
⎪
⎪ 2
⎪
⎪
⎪
⎪
⎪
⎪ 1 − sgn(xv ) 2
⎪
⎪ + (pa − pr )
⎪
⎪
Cd wxv
⎨ 2 ρ
, (5.3)
⎪
⎪
⎪
⎪ 1 + sgn(xv ) 2
⎪
⎪ Q = Cd wxv (pb − pr )
⎪
⎪ b
ρ
⎪
⎪ 2
⎪
⎪
⎪
⎪
⎪
⎪ 1 − sgn(xv ) 2
⎪
⎪ + (ps − pb )
⎩ 2
Cd wxv
ρ
ekxv − e−kxv
sgn(xv ) ≈ tanh(kxv ) = , k 0. (5.5)
ekxv + e−kxv
where y is the displacement of the piston, Ctl is the coefficient of the total
leakage of the cylinder, β e is the effective bulk modulus, Aa and Ab are the
ram areas of the two chambers, and V 0a and V 0b are the initial total control
volumes of the two cylinder chambers, respectively.
From Equation 2.2, the mechanical dynamic equation is shown as follows:
where m is the load mass, K is the load spring constant, b is the viscous damp-
ing coefficient, Ff is the stick-slip friction caused by the viscous damp of oil,
and FL is the external load on the hydraulic actuator from the mechanical
structure of the two-DOF robotic arm.
The stick-slip friction often includes two items: a stick phase Ffstatic occurs
when the velocity is within a small critical velocity range and a slip fric-
tion Ffslip , which is the same as the Coulomb friction model [30]. Here, Ff
is defined as
⎧
⎪ ẋ1 = x2
⎪
⎪
⎪
⎪
⎪
⎪ 1
⎪
⎪ ẋ2 = (x3 Aa − x4 Ab − Kx1 − Ffstatic − b(1 + qb )x2 − FL )
⎪
⎪ m
⎪
⎪
⎪
⎪ βe Aa x2 βe Ctl
⎪
⎪ ẋ3 = − − (x3 − x4 )
⎪
⎪ +
⎪
⎪ V 0a A x
a 1 V 0a + Aa x1
⎪
⎪ ⎛ ⎞
⎪
⎪ 1 + tanh(kx5 ) 2
⎪
⎪ (p − x )
⎪
⎪ βe Cd wx5 ⎜ ρ
s 3 ⎟
⎪
⎪ ⎜ 2 ⎟
⎪
⎪ + ⎜ ⎟
⎪
⎪ V + A x ⎝ 1 − tanh(kx ) 2 ⎠
⎪
⎨
0a a 1
+
5
(x3 − pr )
2 ρ . (5.10)
⎪
⎪ β β
⎪
⎪ A
e b 2x C
e tl
⎪
⎪ ẋ = − (x3 − x4 )
⎪ 4
⎪ V0b − Ab x1 V0b − Ab x1
⎪
⎪ ⎛ ⎞
⎪
⎪
⎪
⎪ 1 + tanh(kx5 ) 2
⎪
⎪ (x4 − pr ) ⎟
⎪
⎪
⎪ βe Cd wx5 ⎜ ⎜ 2 ρ ⎟
⎪
⎪ − ⎜ ⎟
⎪
⎪ V − A x ⎝ 1 − tanh(kx ) 2 ⎠
⎪
⎪
0b b 1
+
5
(ps − x4 )
⎪
⎪ ρ
⎪
⎪ 2
⎪
⎪
⎪
⎪ ẋ5 = x6
⎪
⎪
⎪
⎩ 2 2
ẋ6 = −ωsv x5 − 2ζsv ωsv x6 + Ksv ωsv u
Ẋ = AX + φ(X) + Bu,
(5.11)
y = CX,
Output Feedback Control Method 73
where
⎡ ⎤
0 1 0 0 0 0
⎢ ⎥
⎢ Aa Ab ⎥
⎢0 0 − 0 0 ⎥
⎢ m m ⎥
⎢ ⎥
⎢ ⎥
⎢ βe Ctl βe Ctl ⎥
⎢0 0 − − 0 0 ⎥
⎢ V0a + Aa x1 V0a + Aa x1 ⎥
⎢ ⎥
A=⎢ ⎥, (5.12)
⎢ ⎥
⎢ βe Ctl βe Ctl ⎥
⎢0 0 − − 0 0 ⎥
⎢ V0b − Ab x1 V0b − Ab x1 ⎥
⎢ ⎥
⎢ ⎥
⎢0 0 0 0 0 1 ⎥
⎢ ⎥
⎣ ⎦
0 0 0 0 −ωv2 −2ζv ωv
T
B= 0 0 0 0 0 Ksv ωv2 , (5.13)
C= 1 0 0 0 0 0 , (5.14)
⎡ ⎤
0
⎢ ⎥
⎢ 1 ⎥
⎢ (−Kx1 − Ffstatic − bx2 − bpb x2 − FL ) ⎥
⎢ m ⎥
⎢ ⎥
⎢ ⎛ ⎞ ⎥
⎢ 1 + tanh(kx5 ) 2 ⎥
⎢ (ps − x3 )+⎟ ⎥
⎢ ⎜ 2 ρ ⎥
⎢ βe Cd wx5 ⎜ ⎟ β A x
e a 2 ⎥
⎢ ⎜ ⎟ − ⎥
⎢ V0a + Aa x1 ⎝ 1 − tanh(kx ) 2 ⎠ V0a + Aa x1 ⎥
⎢ 5 ⎥
⎢ (x3 − pr ) ⎥
φ(X) = ⎢
⎢
2 ρ ⎥.
⎥
⎢ ⎛ ⎞ ⎥
⎢ 1 + tanh(kx5 ) 2 ⎥
⎢ (x4 − pr )+⎟ ⎥
⎢ ⎥
⎢ βe Cd wx5 ⎜ ⎜ 2 ρ ⎟ βe Ab x2 ⎥
⎢− ⎟+ ⎥
⎢ V0b − Ab x1 ⎜⎝ 1 − tanh(kx ) 2 ⎠ V0b − Ab x1 ⎥
⎢ 5 ⎥
⎢ (ps − x4 ) ⎥
⎢ 2 ρ ⎥
⎢ ⎥
⎢ ⎥
⎣ 0 ⎦
0
(5.15)
74 Nonlinear Control Techniques for EHAs in Robotics Engineering
Since the leakage coefficient Ctl has a small value and hence little impact,
two items A0 (3, 3) and A0 (4, 3) are neglected in this chapter. Hence, A0 (3, 3) =
A0 (4, 3) = 0. To ensure the validation and convergence of the observer, two
items A0 (3, 5) and A0 (4, 5) are replaced by other nonzero items as follows:
βe 2
A0 (3, 5) = Cd w ps , (5.17)
V0a + Aa x1 ρ
βe 2λ
A0 (4, 5) = − Cd w ps , (5.18)
V0b − Ab x1 ρ
⎡ ⎤
0 1 0 0 0 0
⎢ ⎥
⎢0 0 a23 −a23 − a24 0 0 ⎥
⎢ ⎥
⎢ ⎥
⎢0 0 ⎥
⎢ 0 0 0 a35 ⎥
A1 = ⎢
⎢
⎥,
⎥ (5.19)
⎢0 0 0 0 −a45 0 ⎥
⎢ ⎥
⎢ ⎥
⎢0 0 0 0 0 1 ⎥
⎣ ⎦
0 0 0 0 0 0
Output Feedback Control Method 75
⎡ ⎤
0
⎢ ⎥
⎢ 1 ⎥
⎢ (−Kx1 − Ffstatic − bx2 − bpb x2 − FL ) ⎥
⎢ m ⎥
⎢ ⎛ ⎞ ⎥
⎢ 1 + tanh(kx ) 2 ⎥
⎢ 5
(ps − x3 ) ⎥
⎢ ⎜ ρ ⎟ ⎥
⎢ βe Cd wx5 ⎜⎜
2 ⎟ ⎥
⎟ ⎥
⎢
⎢ V0a + Aa x1 ⎜ 2 ⎟ ⎥
⎢ ⎝+ 1 − tanh(kx5 ) 2
(x3 − pr ) − Cd w ps ⎠ ⎥
⎢ ρ ρ ⎥
⎢ 2 ⎥
⎢ ⎥
⎢ βe Aa x2 ⎥
⎢ − ⎥
φ1 (X) = ⎢
⎢ V + A x ⎥,
⎞⎥
0a a 1
⎢ ⎛ ⎥
⎢ 1 + tanh(kx5 ) 2 ⎥
⎢ ⎜ (x4 − pr ) ⎟ ⎥
⎢ βe Cd wx5 ⎜ 2 ρ ⎟⎥
⎢ ⎜ ⎟ ⎥
⎢− ⎟⎥
⎢ V0b − Ab x1 ⎜
⎝+ 1 − tanh(kx ) 2 2λ ⎥
ps ⎠ ⎥
5
⎢ (ps − x4 ) − Cd w
⎢ 2 ρ ρ ⎥
⎢ ⎥
⎢ βe Ab x2 ⎥
⎢ ⎥
⎢ + ⎥
⎢ V0b − Ab x1 ⎥
⎢ ⎥
⎣ 0 ⎦
−ωv2 x5 − 2ζv ωv x6
(5.20)
where
Aa
a23 = , (5.21)
m
Ab
a24 = , (5.22)
m
βe 2
a35 = Cd w ps , (5.23)
V0a + Aa x1 ρ
βe 2λ
a45 = Cd w ps . (5.24)
V0b − Ab x1 ρ
˙
X̂ = A1 X̂ + φ1 (X̂) + Bu + (y − ŷ),
T (5.25)
= 1 2 3 4 5 6 , i > 0, i = 1, . . . , 6.
˙ = A X̃ + δ (X, X̃),
X̃ (5.26)
c φ
where
T
X̃ = x̃1 x̃2 x̃3 x̃4 x̃5 x̃6
T (5.27)
= x1 − x̂1 x2 − x̂2 x3 − x̂3 x4 − x̂4 x5 − x̂5 x6 − x̂6 ,
⎡ ⎤
− 1 1 0 0 0 0
⎢ ⎥
⎢− 0 a23 −a23 − a24 0 0⎥
⎢ 2 ⎥
⎢ ⎥
⎢− 3 0 0 0 a35 0⎥
Ac = A1 − LC = ⎢
⎢−
⎥, (5.28)
⎢ 4 0 0 0 −a45 0⎥
⎥
⎢ ⎥
⎢− 0 0 0 0 1⎥
⎣ 5 ⎦
− 6 0 0 0 0 0
det |sI − Ac | = s6 + 1s
5
+ 2s
4
+ [a23 3 + (a23 + a24 ) 4 ]s
3
2
+ [a23 a35 5 − (a23 + a24 )a45 5 ]s
Theorem 5.1
If the high gain of the observer is satisfied to the following condition (5.31),
then the matrix Ac is Hurwitz after removing the only one eigenvalue 0. In
Output Feedback Control Method 77
Proof. Equation 5.30 shows that one eigenvalue of the matrix Ac is 0 easily.
After removing the eigenvalue 0, Equation 5.30 can be simplified as
s5 + c4 s4 + c3 s3 + c2 s2 + c1 s + c0 = 0. (5.32)
According to Routh criterion, the necessary and sufficient conditions that all
characteristic roots have a negative real part must satisfy two properties as
follows:
I. All coefficients are greater than zero, which means ci > 0(i = 0, . . . ,4).
II. Arrange the coefficients ci in the following form:
s5 1 c3 c1
s4 c4 c2 c0
c 4 c 3 − c2 c 4 c 1 − c0
s3 0
c4 c4
c24 c1 − c4 c0
s2 c2 − c0 0
c 4 c 3 − c2 , (5.33)
c4 c 0 c 3 − c 2 c 0
c 4 c 1 − c0 c4
s1 − 0 0
c4 c c 1 − c4 c 0
2
c2 − 4
c 4 c 3 − c2
s0 c0 0 0
According to the fourth and fifth inequalities of Equation 5.31, the follow-
ing property is satisfied:
When Equations 5.23 and 5.24 are substituted into Equation 5.34, the
constant parameter is satisfied as follows:
A2a
λ< . (5.35)
A2a + A2b
After η̃ is substituted into Equation 5.26, the new error state equation is
described as
εη̃˙ = Aη η̃ + δφ (η, η̃, ε), (5.37)
where
⎡ ⎤
− 1 /ε 1 0 0 0 0
⎢ ⎥
⎢− 2 /ε
2 0 a23 −a23 − a24 0 0⎥
⎢ ⎥
⎢ ⎥
⎢− 3 /ε
3 0 0 0 a35 0⎥
Aη = ⎢
⎢
⎥,
⎥ (5.38)
⎢− 4 /ε
3 0 0 0 −a45 0⎥
⎢ ⎥
⎢− 1⎥
5 /ε
4
⎣ 0 0 0 0 ⎦
− 6 /ε
5 0 0 0 0 0
⎡ ⎤
0
⎢ ⎥
⎢εδ2 (η2 , η̂2 , ε)⎥
⎢ ⎥
⎢ ⎥
⎢ δ3 (η5 , η̂5 , ε) ⎥
⎢
δφ (η, η̂, ε) = ⎢ ⎥. (5.39)
⎥
⎢ δ4 (η5 , η̂5 , ε) ⎥
⎢ ⎥
⎢ 0 ⎥
⎣ ⎦
εδ6 (η6 , η̂6 , ε)
Theorem 5.2
If φ 1 (X) is continuous and differentiable, and its first-order derivative is
bounded, Equation 5.39 satisfies the following condition:
⎡ ⎤
0
⎢ ⎥
⎢ εδ2 (η2 , η̂2 , ε) ⎥
⎢ ⎥
⎢ 2 ⎥
⎢ε δ3 (η5 , η̂5 , ε)⎥
⎢
δφ (η, η̂, ε) = φ1 (η) − φ1 (η̂) = ⎢ ⎥. (5.41)
⎥
⎢ε2 δ4 (η5 , η̂5 , ε)⎥
⎢ ⎥
⎢ ⎥
⎣ 0 ⎦
εδ6 (η6 , η̂6 , ε)
Theorem 5.3
In Equation 5.37, if the positive constant ε satisfies the following condition
(5.45), then the error vector η̃ converges to 0, which means η → η̂:
1
0<ε< , (5.46)
2λmax (Pη )μδ
where Pη is a positive definite matrix and λmax (Pη ) is the maximum eigen-
values of matrix Pη .
I 0
ATη Pη + Pη Aη = − 5×5 . (5.48)
0 0
If Equation 5.37 is combined with Equations 5.47 and 5.48, then the
derivative of V η is
2
V̇η ≤ − η̃ 2 + 2η̃T Pη δφ (η, η̂, ε)
2 2
≤ − η̃ 2 + 2ελmax (Pη )μδ η̃ 2 (5.50)
2
≤ −(1 − 2ελmax (Pη )μδ ) η̃ 2.
If ε satisfies the condition shown in Equation 5.46, then V̇η < 0. Therefore,
the error vector η̃ converges to 0 and the system described by Equation 5.37
is exponentially stable.
ep = p − pd ,
Aa x3 − Ab x4
p= ,
Aa (5.51)
Kx1d (t) Ffstatic FL
pd (t) = + + ,
Aa Aa Aa
where pd is the virtual command of the load pressure and p is the actual load
pressure, and x1d is the displacement command of the system input.
The error of x5 is defined as
e5 = x5 − x5d , (5.52)
1
x5d = − (k1 ep − ṗd + g1 ), (5.53)
g2
βe Aa x2 βe Ctl βe A2b x2
g1 = − − (x3 − x4 ) −
V0a + Aa x1 V0a + Aa x1 Aa (V0b − Ab x1 )
βe Ab Ctl
+ (x3 − x4 ), (5.54)
Aa (V0b − Ab x1 )
⎛ ⎞
ekx5 2
⎜ ekx5 + e−kx5 Cd w ρ (ps − x3 ) ⎟
βe ⎜ ⎟
g2 = ⎜ ⎟
⎜
V0a + Aa x1 ⎝ ⎟
e−kx5 2 ⎠
+ kx Cd wx5 (x3 − pr )
e 5 + e−kx5 ρ
⎛ ⎞ (5.55)
ekx5 2
⎜ ekx5 + e−kx5 Cd w ρ (x4 − pr ) ⎟
βe Ab ⎜ ⎟
+ ⎜ ⎟.
⎜
Aa (V0b − Ab x1 ) ⎝ −kx ⎟
e 5 2 ⎠
+ kx −kx
Cd wx5 (p s − x4 )
e 5 +e 5 ρ
1 2
V3 = e . (5.56)
2 p
Output Feedback Control Method 83
e6 = x6 − x6d . (5.64)
The derivative of V 5 is
e6
V̇5 = V̇4 + ė6
k3
e25 e5 e6 e6
= −k1 e2p − + + (ẋ6 − ẋ6d ) (5.66)
k2 k2 k3
e25 e5 e6 e6
= −k1 e2p − + 2
+ (−ωsv 2
x5 − 2ζv ωsv x6 + Ksv ωsv u − ẋ6d ).
k2 k2 k3
So far, the recursive procedure for the third-order equivalent model of EHS
ends. By the construction of three Lyapunov functions, the stability of the
variable states xi (i = 3, 4, 5, 6) is analyzed from the third equation to the sixth
equation in Equation 5.10.
Aa p − Ffstatic − FL
ẍ1 + α1 ẋ1 + α2 x1 = , (5.69)
m
where
b(1 + pb ) K
α1 = , α2 = . (5.70)
m m
Then, pd is redesigned as
After Equation 5.71 or 5.73 is substituted into Equation 5.69, the model can
be described by Laplace transform as follows:
where
Aa (pds + ep ) − Ffstatic − FL
p (s) = . (5.75)
m
If p (s) is considered as the system input, and x1 (s) is the system output,
since α 1 + σ 1 > 0, α 2 > 0, the two characteristics roots of system (5.74) have
all negative real parts, which means x1 (t) is asymptotically stable.
When t → ∞, s → 0 in Equation 5.74. According to the backstepping pro-
cedure in section A, the pressure error ep converges to 0. Then, from
Equation 5.74, we see that
Aa pds − Ffstatic − FL
x1 (t) → . (5.76)
α2 m
86 Nonlinear Control Techniques for EHAs in Robotics Engineering
Now Equation 5.71 or 5.73 is substituted into Equation 5.76, we see that
The above equation shows that the system output x1 (t) can be controlled to
track its command x1d by the equivalent system input p (s). The parameter σ 1
is designed to make x1 fast converge to x1d .
According to the Lyapunov analysis in section A, the pressure error ep
converges to 0 exponentially, which means the dynamic response of load
pressure p can be satisfied to the system requirement by the regulation of
parameter k1 . In the expression of pds (t) shown in Equations 5.71 and 5.73,
the dynamic external load error FL (y, ẏ, ÿ) and FL exist. But this error has
little impact on the convergence of x1 .
Finally, the actual states xi (i = 2, . . . ,6) are replaced by their estimation and
the backstepping controller can be described as
⎧
⎪ 1 k3
⎪
⎪
⎪ û = 2
ωsv x̂5 + 2ζsv ωsv x̂6 + x̂˙ 6d − ê5 − ê6
⎪
⎪ Ksv ωsv
2 k2
⎪
⎪
⎪
⎪ Aa x̂3 − Ab x̂4
⎪
⎪
⎪
⎪ êp = − pd
⎪
⎪ Aa
⎪
⎨
1
⎪ x̂5d = − (k1 êp − ṗd + g1 ) , (5.78)
⎪
⎪ g2
⎪
⎪
⎪
⎪
⎪
⎪ x̂6d = −k2 g2 êp + x̂˙ 5d − ê5
⎪
⎪
⎪
⎪
⎪
⎪ ê5 = x̂5 − x̂5d
⎪
⎪
⎩
ê6 = x̂6 − x̂6d
Combined with Equations 5.10, 5.52, 5.53, 5.62, 5.64, and 5.67, the three state
errors satisfy the following conditions:
ėp = −k1 ep + g2 e5 ,
ė5 = −e5 − k2 g2 ep + e6 ,
(5.80)
k3
ė6 = − e5 − e6 .
k2
According to Equations 5.74 through 5.76, the state error x1 equation is
satisfied:
Aa ep
ë1 (s) + (α1 + σ1 )ė1 (s) + α2 e1 (s) = . (5.81)
m
If the full-state error is defined as
T
Z = z1 z2 z3 z4 z5
T (5.82)
= e1 e 2 ep e5 e6 ,
and combined with Equations 5.11, 5.79 through 5.81, we see that
Ż = Ae Z + Be Z + B(u − û)
(5.83)
= Ae Z + Be Z + Bũ(X, X̃, x1d ),
where ⎡ ⎤
−1
⎢−α2 −(α1 + σ1 ) ⎥
⎢ ⎥
Ae = ⎢
⎢ −k1 ⎥,
⎥ (5.84)
⎣ −1 ⎦
−1
' (T
Be = 0 Aa
m ep g2 e5 −k2 g2 ep + e6 − kk3 e5 , (5.85)
2
˙
X̂ = A1 X̂ + φ1 ( X̂ ) + B û + (y − ŷ). (5.87)
↓ ↓ ↓ ↓
Ẋ X X u
88 Nonlinear Control Techniques for EHAs in Robotics Engineering
The controller u can guarantee that the state errors ep , e5 , and e6 are asymp-
totic convergence to 0 after the Lyapunov candidate functions V 3 , V 4 , and
V 5 are constructed. Moreover, the state errors e1 and e2 are also asymptotic
convergence to 0 on the basis of Equation 5.81. Obviously, the matrix Ae in
Equation 5.84 is Hurwitz. Therefore, the full-state error dynamics shown in
Equation 5.83 is a quasi-steady-state model as follows:
t>ς
Ż = Ae Z + Be Z + B(u − û) ⇔ Ż = Ae Z + Be Z, (5.88)
5.4 Experiment
To test the proposed backstepping control method and the full-state
observer associated with the control of EHS, the experimental frame-
work of the model is presented as shown in Figure 3.16. Some of the
same hydraulic parameters are shown in Table 3.9. The other parameters
are V 0a = 1.74 × 10−5 m3 , V 0b = 8.66 × 10−6 m3 , Ksv = 7.9 × 10−4 m / V,
ωsv = 353.6 rad/s, ζ sv = 0.707, b = 2500 Ns/m, K = 1000 N/m, Ffstatic =
20 N, FL = 500 N, and pb = 20%. Since the stroke of the cylinder is 79 mm
and the shoulder angle of the upper arm is from − 70° to 50°, the range of
absolute coordinates position x1 is from − 0.0476 to 0.0303 m. However, in
the experiment, the displacement of the cylinder is not more than 58 mm to
avoid the boundary collision of the robotic arm.
The observer and control parameters are designed as follows:
into the controller (5.78) to compute the current control voltage. Here, the
displacement command is considered as two types: sinusoidal and step
demands. The amplitude of the sinusoidal command is 0.0289 m with fre-
quency 0.5 Hz. The step command also has the same amplitude. The actual
displacement can be obtained by trigonometry of the robotic arm according
to the angle measured by the relative encoder.
Figures 5.1 through 5.4 show the related results of the sinusoidal and
step experiment, respectively. In Figure 5.1a, after 1.27 s, the actual cylin-
der displacement has been close to the value 0.025 m when the steady error
is less than 5%. The maximum control voltage is 9 V, not more than its
saturation ± 10 V as shown in Figure 5.1b. When the displacement nears
the step command, the control voltage reduces to 0 quickly. The estima-
tion of x1 is a correct prediction for the actual cylinder displacement by
the designed observer as shown in Figure 5.2a. According to the estima-
tions of x3 and x4 as shown in Figure 5.2c and d, the dynamic estimation
is sharp due to the existing error of the high observer. Moreover, this
single-rod EHS has a one-dimensional internal dynamics, which results
in the rigid dynamic error of estimated state. This phenomenon is also
shown in the sinusoidal experiment, which means the estimation of load
pressure pL defined in Equation 5.51 is not smooth until the dynamic
response finishes. In step experiment, after approximately 3 s later, the esti-
mation of pL is smooth and is close to 30 bar shown in Figure 5.2c. The
estimation of spool position x5 is corresponded to the control voltage û,
which is not more than its saturation ± 7.9 mm shown in Figure 5.2e. In
the sinusoidal experiment, the maximum dynamic error of displacement
is less than 5.7 mm, which means the dynamic error is not more than
(a) (b)
0.08 10
Command
0.06 Actual 8
Error
Estimation of u (V)
0.04
0.0289 6
0.025
x1 (m)
0.02
4
0
2
–0.02
–0.04 0
–0.06 –2
0 1.27 2 3 4 5 6 7 8 9 10 0 2 4 6 8 10
t (s) t (s)
FIGURE 5.1
Step response experiment of the upper arm hydraulic actuator. (a) The position of the upper arm
cylinder. (b) The control voltage of the upper arm cylinder.
90 Nonlinear Control Techniques for EHAs in Robotics Engineering
Estimation of x2 (m/s)
0.02 0.05
Estimation of x1 (m)
0 0
–0.02 –0.05
–0.04 –0.1
–0.06 –0.15
0 2 4 6 8 10 0 2 4 6 8 10
t (s) t (s)
(c) × 106 (d) × 105
4 3.5
3
Estimation of x3 (Pa)
Estimation of x4 (Pa)
3 2.5
2
2
1.5
1 1
0.5
0 0
0 2 4 6 8 10 0 2 4 6 8 10
t (s) t (s)
(e) (f) 1.5
× 10–3
5
Estimation of x6 (m/s)
1
Estimation of x5 (m)
3 0.5
2 0
1 –0.5
0 –1
0 2 4 6 8 10 0 2 4 6 8 10
t (s) t (s)
FIGURE 5.2
State estimations by the high-gain state observer in step response experiment. (a) Estimation of
x1 in step response. (b) Estimation of x2 in step response. (c) Estimation of x3 in step response.
(d) Estimation of x4 in step response. (e) Estimation of x5 in step response. (f) Estimation of x6 in
step response.
10% when the sinusoidal frequency is 0.5 Hz. Owing to the initial posi-
tion error of x1 and dynamic estimated error for the sinusoidal command,
the control voltage is saturation in a short duration. When the actual dis-
placement tracks the command well, the control voltage is less than its
saturation.
Output Feedback Control Method 91
(a) (b)
0.06 10
Command
Actual 8
0.04 Error 6
Estimation of u (V)
0.02 4
2
x1 (m)
0 0
–2
–0.02
–4
–0.04 –6
–8
–0.06 –10
0 2 4 6 8 10 0 2 4 6 8 10
t (s) t (s)
FIGURE 5.3
Sinusoidal response experiment of the upper arm hydraulic actuator. (a) The position of the
upper arm cylinder. (b) The control voltage of the upper arm cylinder.
Estimation of x2 (m/s)
0.02 0
Estimation of x1 (m)
0 –0.2
–0.02 –0.4
–0.04 –0.6
–0.06 –0.8
0 2 4 6 8 10 0 2 4 6 8 10
t (s) t (s)
(b) × 106 (d) × 106
4 4
Estimation of x3 (Pa)
Estimation of x4 (Pa)
3 3
2 2
1 1
0 0
0 2 4 6 8 10 0 2 4 6 8 10
t (s) t (s)
(e) (f)
0.01 1.5
0.008
1
Estimation of x6 (m/s)
0.006
Estimation of x5 (m)
0.004 0.5
0.002
0 0
–0.002
–0.5
–0.004
–0.006 –1
–0.008
–0.01 –1.5
0 2 4 6 8 10 0 2 4 6 8 10
t (s) t ( s)
FIGURE 5.4
State estimations by the high-gain state observer in the sinusoidal response experiment. (a)
Estimation of x1 in the sinusoidal response. (b) Estimation of x2 in the sinusoidal response.
(c) Estimation of x3 in the sinusoidal response. (d) Estimation of x4 in the sinusoidal response.
(e) Estimation of x5 in the sinusoidal response. (f) Estimation of x6 in the sinusoidal response.
(a) 0.04
0.02
0
x1 (m)
–0.02
–0.04 Command
Backstepping
PI
–0.06
0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
t (s)
(b) 0.06
Backstepping
0.05 PI
0.04
Error of x1 (m)
0.03
0.02
0.01
–0.01
0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
t (s)
(c) 10
Backstepping
PI
5
Estimation of u (V)
–5
–10
0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
t (s)
FIGURE 5.5
Comparison result in condition (1). (a) The cylinder position response of the sinusoidal demand.
(b) The cylinder position error of the sinusoidal demand. (c) The control voltage estimation of
the sinusoidal demand.
94 Nonlinear Control Techniques for EHAs in Robotics Engineering
(a) 0.02
0.01
–0.01
x1 (m)
–0.02
–0.03
Command
–0.04 Backstepping
PI
–0.05
0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
t (s)
(b) 0.06
Backstepping
PI
0.04
Error of x1 (m)
0.02
–0.02
0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
t (s)
(c) 10
Backstepping
PI
5
Estimation of u (V)
–5
–10
0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
t (s)
FIGURE 5.6
Comparison result in condition (2). (a) The cylinder position response of the sinusoidal demand.
(b) The cylinder position error of the sinusoidal demand. (c) The control voltage estimation of
the sinusoidal demand.
Output Feedback Control Method 95
(a) 0.04
0.02
0
–0.005
–0.02
x1 (m)
–0.04
(b) 10
Shoulder control
Elbow control
5
u (V)
–5
–10
0 1 2 3 4 5
t (s)
FIGURE 5.7
The coordinated motion experiment results of the robotic arm joints, sinusoidal demand input
for the shoulder actuator, and step demand input for the elbow actuator. (a) The two cylinder
positions response of sinusoidal and step demands. (b) The two control voltages of sinusoidal
and step demands.
PI method. The two input displacement commands are sinusoidal and step,
respectively, which is the same command as section B. The displacement
response and the corresponding control voltage of two hydraulic actuators
are shown in Figure 5.7. At initial time 0 s, the two joints are all retracted.
Then, after 1.3 s, the joint angle of the elbow is extended to its maximum 130°
by the PI control and then the elbow joint will always keep this extended
state. After 1.5 s, the shoulder actuator is retracted to its minimum dis-
placement − 0.0289 m. After 2.5 s, the shoulder actuator is extended to its
96 Nonlinear Control Techniques for EHAs in Robotics Engineering
(a) (b)
(c) (d)
FIGURE 5.8
Experiment video of coordinated motion for the robotic arm joints. (a) t = 0 s. (b) t = 1.3 s.
(c) t = 1.5 s. (d) t = 2.5 s.
CONTENTS
6.1 Dynamic Model of EHS . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 98
6.2 Parametric Adaptive Backstepping Controller . . . . . . . . . . . . . . . . . 99
6.2.1 General Backstepping Control Design . . . . . . . . . . . . . . . . . 100
6.2.2 Decayed Memory Filter Design . . . . . . . . . . . . . . . . . . . . . . 104
6.2.3 Revised Parametric Adaptive Control Law . . . . . . . . . . . . . 106
6.3 Disturbance Observer Application . . . . . . . . . . . . . . . . . . . . . . . . . 108
6.4 Experiment . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 110
6.4.1 Result of the Proposed Controller . . . . . . . . . . . . . . . . . . . . 112
6.4.2 Comparison with Simplified Backstepping Controller . . . . . 114
6.5 Result of Disturbance Observer . . . . . . . . . . . . . . . . . . . . . . . . . . . 115
97
98 Nonlinear Control Techniques for EHAs in Robotics Engineering
Remark 6.1
In Equation 6.1, the function sgn(.) should be smoothed in the derivation of
backstepping control, which is replaced by the hyperbolic tangent function
tanh(.) as follows [35]:
ekxv − e−kxv
sgn(xv ) ≈ tanh(kxv ) = , k 0, (6.5)
ekxv + e−kxv
where k is a positive constant.
Parametric Adaptive Control Method 99
⎧
⎪
⎪ ẋ = x2
⎪ 1
⎪
⎪
⎪
⎪
⎪ 1
⎪
⎪ ẋ2 = (−Kx1 − bx2 + Ap x3 − FL )
⎪
⎪ m
⎨
4βe Ap 4βe Ctl 4βe Cd w . (6.6)
⎪
⎪ ẋ3 = − x2 − x3 + √ ps − tanh(kx4 )x3 x4
⎪
⎪ Vt ρ
⎪
⎪ Vt Vt
⎪
⎪
⎪
⎪
⎪
⎪ 1 Ksv
⎩ ẋ4 = − x4 + u
Tsv Tsv
The external load FL (t) is divided into two elements, which is mentioned in
Equation 4.11 as follows:
⎧
⎪ Tu (θ1 , θ2 )
⎪
⎨ FLu (θ1 , θ2 ) = l1 (θ1 )
⎪
, (6.7)
⎪
⎪ Tf (θ1 , θ2 )
⎪
⎩ FLf (θ1 , θ2 ) =
l2 (θ2 )
where FLu is the load force on the shoulder hydraulic actuator, FLf is
the load force on the elbow hydraulic actuator, and the dynamic force
arms li (θ i ), (i = 1, 2) are computed by triangle geometry mentioned in
Equation 3.48.
Remark 6.2
Owing to measurement noise and uncertainty disturbance in engineer-
ing practice, FLu , FLf are difficult to be obtained. The computed value in
Equation 6.7 may deviate from the true value. Thus, these values should be
handled by a filter before being used in parametric estimation law.
where x1d is the demand of cylinder displacement, α i is the ith virtual control,
and ϑ̂i is the estimation of ϑ i .
Theorem 6.1
Assuming that the unknown parameters ϑ i (i = 1, . . . , 6) are constant, if the
virtual control variables α i ∈ C1 (i = 1, 2, 3) and their derivatives α̇i (i = 1, 2, 3)
are smooth, then there exists a backstepping controller u, which guarantees
zi (t)(i = 1, . . . , 4) → 0, ϑ̃i (t)(i = 1, . . . , 6) → 0, as t → ∞.
1 ) 1 3 2
V2 = V1 + z22 + ϑi − ϑ̂i , (6.16)
2 2ki
i=1
If the parametric adaptive estimation laws and the virtual control α 2 are
designed as follows:
ϑ̂˙ 1 = −k1 x1 z2 /m, ϑ̂˙ 2 = −k2 x2 z2 /m, ϑ̂˙ 3 = −k3 z2 /m, (6.18)
m c2 m m
α2 = − z1 − z2 + ϑ̂1 x1 /m + ϑ̂2 x2 /m + ϑ̂3 /m − c1 x2 + c1 ẋ1d + ẍ1d ,
Ap Ap Ap
(6.19)
102 Nonlinear Control Techniques for EHAs in Robotics Engineering
1 ) 1 6 2
V3 = V2 + z23 + ϑi − ϑ̂i , (6.22)
2 2ki
i=4
m
Ap z2 + c3 z3 + ϑ̂4 x2 + ϑ̂5 x3 + α̇2
α3 = − , (6.25)
ϑ̂6 ps − tanh(kx4 )x3
we see that the derivative of V 3 is
V̇3 = −c1 z21 − c2 z22 − c3 z23 + z3 z4 ϑ̂6 ps − tanh(kx4 )x3 , (6.26)
1
V4 = V3 + z24 , (6.27)
2
m
α̇2 = − (z2 + α1 − ẋ1d ) − c2 z3 − c2 α2
Ap
c2 m c1 m ˆ
+ (−ϑ̂1 x1 /m − ϑ̂2 x2 /m − ϑ̂3 /m + c1 x2 − c1 ẋ1d − ẍ1d ) − ẋ2 ,
Ap Ap
(6.31)
z3 − m
Ap (c2 z2 + z1 ) + c3 (ẋˆ 3 − α̇2 ) + ϑ̂4 ẋˆ 2 + ϑ̂5 ẋˆ 3 + α̈2
α̇3 = − , (6.32)
ϑ̂6 ps − tanh(kx4 )x3
104 Nonlinear Control Techniques for EHAs in Robotics Engineering
⎧ Ap
⎪
⎨ ẋˆ 2 = x3 − ϑ̂1 x1 /m − ϑ̂2 x2 /m − ϑ̂3 /m
m . (6.33)
⎪
⎩ˆ
ẋ3 = −ϑ̂4 x2 − ϑ̂5 x3 +ϑ̂6 ps − tanh(kx4 )x3 x4
ˆ
where φ(k) is the kth calculated value of φ, φ̂(k) is the estimation of φ(k), φ̇(k)
is the kth estimation of the derivative φ̇, Tc is the interval of the controller, the
filter parameters G = 1 − λ2 , H = (1 − λ)2 , and the range of the filter factor
λ is (0, 1).
Since the calculated values of α 2 , α 3 are obtained by Equations 6.19
and 6.25, the estimation values α̂i , α̇ˆ i (i = 2, 3) are obtained by Equation 6.34.
From Equation 6.7, the calculated value of ϑ 3 is described as follows:
⎧
⎪ FLu (θ1 , θ2 ) Tu (θ1 , θ2 )
⎪
⎪ ϑ31 = =
⎨ m1f m1f l1 (θ1 )
, (6.35)
⎪
⎪ FLf (θ1 , θ2 ) Tf (θ1 , θ2 )
⎪
⎩ ϑ32 = =
m2f m2f l2 (θ2 )
as follows:
⎡ ⎤ ⎡ ⎤
α̂(k)
1−G (1 − G)Tc α̂(k − 1) G
= ⎣ H ⎦ + ⎣ H ⎦ α(k) . (6.36)
ˆ
α̇(k) − 1−H ˆ − 1)
α̇(k
Tc Tc
Theorem 6.2
The input α(k) is assumed to be the input of the discrete linear system (6.36),
ˆ
and α̂(k), α̇(k) are the outputs; then Equation 6.36 is input-to-state stable (ISS),
ˆ
and α̂(k) → α(k), α̇(k) → α̇(k), as k → ∞.
Proof.
ˆ − 1) + Gα(k) .
α̂(k) = (1 − G)α̂(k − 1) + (1 − G)Tc α̇(k (6.39)
When α̂(k) reaches its steady state, there exists a sufficiently large
ˆ
integer n0 , ∀k > n0 , α̇(k) → 0, and α̂(k) = α̂(k − 1). Substituting these
two conditions into Equation 6.39, we can obtain that α̂(k) → α(k).
ˆ
Second, from Equation 6.36, the dynamics of α̇(k) is given by
ˆ H ˆ − 1) + H α(k) .
α̇(k) = − α̂(k − 1) + (1 − H)α̇(k (6.40)
Tc Tc
106 Nonlinear Control Techniques for EHAs in Robotics Engineering
ˆ
When α̇(k) reaches its steady state, there exists a sufficiently large inte-
ˆ
ger n1 , ∀k > n1 , α̂(k − 1) → α(k − 1), and α̇(k) ˆ − 1). Simultaneously,
= α̇(k
we can see that (H/Tc )(α(k) − α(k − 1)) = Hα̇(k − 1). Substituting these three
ˆ
conditions into Equation 6.40, we can obtain that α̇(k) → α̇(k).
Theorem 6.3
Assuming that the unknown parameters ϑ 3 is variable but its derivative ϑ̇3 is
bounded, and the other unknown parameters ϑ i (i = 1, 2, 4, 5, 6) are constants,
if the virtual control variables α i ∈ C1 (i = 1, 2, 3), and their derivatives α̇i (i =
1, 2, 3) are bounded, then there exists a revised backstepping controller u that
guarantees zi (t)(i = 1, . . . , 4) → 0, ϑ̃i (t)(i = 1, . . . , 6) → 0, as t → ∞.
Proof. The parametric adaptive estimation law of ϑ̂˙ 3 in Equation 6.18 can be
revised as follows:
ϑ̂˙ 3 = −k3 z2 + ϑ̇ˆ 3 + ϑ̇3 max sgn(ϑ3 − ϑ̂3 ), (6.41)
where ϑ̇3 max is the bound of the filter error ϑ̇3 (i.e., ϑ̇3 = ϑ̇3 − ϑ̇ˆ 3 ), ϑ 3
is the calculated value from Equation 6.35, and ϑ̂3 , ϑ̇ˆ 3 are the filter outputs.
Owing to ϑ̇3 = 0, the Lyapunov function V 2 is rewritten as follows:
Ap Ap
V̇2 = −c1 z21 + z1 z2 + z2 z3 + α2 − ϑ̂1 x1 − ϑ̂2 x2 − ϑ̂3 + c1 x2 − c1 ẋ1d − ẍ1d
m m
Substituting Equation 6.41 and ϑ̂˙ 1 , ϑ̂˙ 2 in Equation 6.18 into Equation 6.42,
we can see that
Ap ϑ̃3
V̇2 = −c1 z21 − c2 z22 + z2 z3 + ( ϑ̇3 − | ϑ̇3 |max sgnϑ̃3 ). (6.43)
m k3
Substituting Equations 6.44 and 6.24 into V̇3 , the Lyapunov function V 3 is
rewritten as follows:
ϑ̃3
V̇4 = −c1 z21 − c2 z22 − c3 z23 − c4 z24 + ( ϑ̇3 − ϑ̇3 max sgnϑ̃3 )
k3 (6.47)
− z3 ( α̇2 + | α̇2 |max sgnz3 ) − z4 ( α̇3 + | α̇3 |max sgnz4 ) < 0.
By the parametric adaptive estimation law (6.41), the sign of the dynamic
element ϑ̃3 is guaranteed to be negative in V̇4 . Similarly, the signs of z3 and
z4 become negative by the virtual control (6.44) and the revised backstep-
ping controller (6.47). This iteration controller guarantees ϑ̃i (i = 1, . . . , 6) and
zi (i = 1, . . . , 4) converging to zero.
108 Nonlinear Control Techniques for EHAs in Robotics Engineering
FL
α
ˆ 2,αˆ 3
x
ϑ̂i, (i = 1,...,6) ˆ ,αˆ
α
α
ˆ 2,αˆ3 2 3
Parametric ˆ ,αˆ
α Filtering α2,α3 Virtual control
2 3
estimation laws estimation (6.13), (6.19),
ˆ ,ϑˆ
(6.18), (6.24), (6.41) ϑ (6.34) ϑ3 (6.44)
3 3
x z α1, α2, α3
Traditional ARC
x1d State errors
(6.9) z
FIGURE 6.1
Block diagram of the control system.
Remark 6.3
The constants | ϑ̇3 |max , | α̇2 |max , and | α̇3 |max need to be predefined
before the revised backstepping controller (6.46). From Equations 6.35
and 6.40, these three constants can be estimated by maxt→∞ {α̇id (t) − α̇ˆ i (t)},
max {ϑ̇ d (t) − ϑ̇ˆ (t)}, where α̇ d (t) = |α̇ |
t→∞ 3 3 isin 2πt for i = 2, 3, ϑ̇ d (t) =
i max 3
|ϑ̇3 |max sin 2πt. The constants |α̇i |max , |ϑ̇3 |max can be estimated in the follow-
ing simplified controller (6.49).
˙
d̂ = Kd (ẋ2 − f21 (x3 ) − ϑ̂1 f22 (x1 ) − ϑ̂2 f23 (x2 ) − d̂). (6.48)
Parametric Adaptive Control Method 109
c
kT
d̂(k) = Kd x2 − Kd (f21 (x3 ) + ϑ̂1 f22 (x1 ) + ϑ̂2 f23 (x2 ) + d̂)dt. (6.49)
(k−1)Tc
˙ x1 ϑ̃1 x2 ϑ̃2
d̃ = −Kd d̃ + ḋ + Kd + Kd , (6.51)
m m
where ϑ̃1 = ϑ1 − ϑ̂1 , ϑ̃2 = ϑ2 − ϑ̂2 .
Integrating the above equation, we can obtain
t
−Kd t −Kd (t−τ ) x1 (τ )ϑ̃1 (τ ) x2 (τ )ϑ̃2 (τ )
d̃(t) = e d̃(0) + e ḋ(τ ) + Kd + Kd dτ
m m
0
t
|ḋ|max (1 − e − Kd t ) x1 (τ )ϑ̃1 (τ ) + x2 (τ )ϑ̃2 (τ )
≤ e−Kd t d̃(0) + + Kd e−Kd (t−τ ) dτ .
Kd m
0
(6.52)
t
x1 (τ )ϑ̃1 (τ ) + x2 (τ )ϑ̃2 (τ )
+ Kd e−Kd (t−τ ) dτ
m
t1
|ḋ|max (1 − e−Kd t ) (|x1 |max |ϑ̃1 |max + |x2 |max |ϑ̃2 |max )e−Kd t
≤ e−Kd t d̃(0) + +
Kd m
ε(|x1 |max + |x2 |max )
+ . (6.53)
m
110 Nonlinear Control Techniques for EHAs in Robotics Engineering
Therefore, as t → ∞,
The large observer gain Kd can reduce the DO error d̃(t). Furthermore, t1 is
sufficiently large and is arbitrarily small, which means d̃(t) is arbitrarily
reduced by the observer and estimated gains parameters.
Remark 6.4
The DO d̂ (6.48) is not different from the parametric adaptive estimation law
ϑ 3 , since this DO is directly designed based on the state equations. How-
ever, the parametric adaptive estimation law is derived in the backstepping
controller iteration.
6.4 Experiment
In this chapter, the two-DOF robotic arm is employed to implement and
test the performance of the proposed control method. Meanwhile, several
working conditions will be considered when both robotic arms are driven
simultaneously, or either one joint is run instead. The specific parameters and
brands of the main components in the experimental architecture are listed in
Table 6.1.
Some hydraulic and mechanical parameters of this EHS are shown in
Table 6.2. Since the hydraulic parameters Cd , w, ρ, β e , K, b, and Ctl are
not obtained exactly, which have some uncertainties in different exper-
imental conditions, it is necessary to estimate the uncertain parameters
TABLE 6.1
Specific Parameters and Brand of Main Components
Element Type Marks Quantity
⎧
⎪ ϑ̄1 = K̄
⎪
⎪
⎪
⎪
⎪
⎪ ϑ̄2 = b̄
⎪
⎪
⎪
⎪
⎪
⎪ 4β̄e Ap
⎪
⎨ ϑ̄4 =
Vt . (6.55)
⎪
⎪
⎪
⎪ 4β̄e C̄tl
⎪
⎪ ϑ̄5 =
⎪
⎪ Vt
⎪
⎪
⎪
⎪
⎪
⎪ 4β̄ C̄ w̄
⎩ ϑ̄6 = e √d
Vt ρ̄
The stroke of the cylinder Smax is 79 mm, but in the experiment, the dis-
placement of the cylinder is not more than 58 mm to avoid the boundary
collision of the robotic arm.
The initial values of the estimated parameters are predefined as zero, that
is, ϑ̂i0 = 0, (i = 1, . . . , 6) to verify the convergence effectiveness of the para-
metric estimation laws. Some control parameters are designed as follows:
112 Nonlinear Control Techniques for EHAs in Robotics Engineering
TABLE 6.2
Hydraulic Parameters Used in Experiments
Parameter Value Parameter Value
(a) 50 (b)
30 0.1
x 2s (m/s)
x1 (mm)
0
–30 s 0
–50 x1d
x1s –0.1
0 5 10 15 20 0 5 10 15 20
t (s) t (s)
50 0.2
30
x1 (mm)
x 2e (m/s)
0 0.1
–30 0
–50 xe1d
xe1 –0.1
0 5 10 15 20 0 5 10 15 20
t (s) t (s)
(c) (d) 10
60 8
5
x 4s (mm)
x 3s (bar)
40 0
20 –5
0 –10
0 5 10 15 20 0 5 10 15 20
t (s) t (s)
60 10
8
x 4e (mm)
x 3e (bar)
40 5
20 0
0 –5
0 5 10 15 20 0 5 10 15 20
t (s) t (s)
FIGURE 6.2
Four state responses of the EHS by the proposed controller. (a) Cylinder displacement response
x1 . (b) Cylinder velocity x2 . (c) Load pressure of cylinder x3 . (d) Spool position of servo valve x4 .
ϑ̂2
ϑ1
600 1500
400 1000
200 ϑ̂1 500 ϑ̂1
– –
ϑ1 ϑ2
0 0
0 5 10 15 20 0 5 10 15 20
t (s) t (s)
ϑ̂4
600 6
400 4
200 2 ϑ̂4
–
ϑ4
0 0
0 5 10 15 20 0 5 10 15 20
t (s) t (s)
(e) × 1010
1500 (f ) 3
2.5
1000 2
ϑ̂6
1.5
ϑ̂5
500
1
ϑ̂5
– ϑ̂6
ϑ5 0.5 –
0 ϑ6
0 5 10 15 20 0
t (s) 0 5 10 15 20
t (s)
FIGURE 6.3
Six estimation values by parametric adaptive estimation laws. (a) Uncertainty parameter ϑ̂1 .
(b) Uncertainty parameter ϑ̂2 . (c) Uncertainty parameter ϑ̂3 . (d) Uncertainty parameter ϑ̂4 .
(e) Uncertainty parameter ϑ̂5 . (f) Uncertainty parameter ϑ̂6 .
(a) (b)
10 10
8
6
4
5
2
ue (V)
us (V)
0
–2
–4 0
–6
–8
–10 –5
0 5 10 15 20 0 5 10 15 20
t (s) t (s)
FIGURE 6.4
Control voltages of two hydraulic actuators by the proposed controller. (a) The control voltage
of shoulder controller us . (b) The control voltage of elbow controller ue .
α2
2 2
0 0
0 2 4 6 8 10 0 2 4 6 8 10
t (s) t (s)
× 108 2 × 10
9
1
1
0.5
0
α2
0
αˆ2
–0.5 –1
–1 –2
0 2 4 6 8 10 0 2 4 6 8 10
t (s) t (s)
(c) 1 × 10
–4 (d) 5 × 10
–4
0 0
α̂3
–1 α3 –5
–2 –10
–15
2 3 4 5 6 7 8 9 10 2 3 4 5 6 7 8 9 10
t (s) t (s)
0.01
0.05
0.005
0
α̂3
0
α3
–0.005
–0.01 –0.05
2 3 4 5 6 7 8 9 10 2 3 4 5 6 7 8 9 10
t (s) t (s)
(e) 20 (f ) 10 Proposed controller
15 Simplified controller
10 8
6
0 4
−10 2
x1 (mm)
us (V)
−15 0
−20 −2
−4
−30
−6
−40 Demand −8
Proposed controller
Simplified controller −10
−50
0 2 4 6 8 10 0 2 4 6 8 10
t (s) t (s)
FIGURE 6.5
Comparison result for the demand input xs1d = 14.5 sin(2π t) mm. (a) α 2 and α̇2 by the pro-
posed filter. (b) α 2 and α̇2 by Equation 6.56. (c) α 3 and α̇3 by the proposed filter. (d) α 3 and
α̇3 by Equation 6.56. (e) Cylinder displacement response x1 . (f) The control voltage of shoulder
controller us .
be selected as the demand of the DO. Then the external load disturbances
on two EHAs are estimated by the DO (6.48) as shown in Figure 6.7. This
high-gain observer guarantees the observer errors d̃1 and d̃2 convergence to
zero. If the observer error is obvious, the controller will degrade the dynamic
tracking performance.
The load disturbance estimations on two hydraulic actuators by the pro-
posed controller are shown in Figure 6.8, which shows that the external
Parametric Adaptive Control Method 117
α2
2 2
0 0
0 5 10 15 20 0 5 10 15 20
t (s) t (s)
× 108 × 109
1 2
0.5
0
0
αˆ2
α2
–0.5 –2
–1
0 5 10 15 20 0 5 10 15 20
t (s) t (s)
–2 α3 –4
–3 –6
–4 –8
2 4 6 8 10 12 14 16 18 20 2 4 6 8 10 12 14 16 18 20
t (s) t (s)
0.01
0.15
0.005 0.1
0
αˆ3
α3
0.05
–0.005 0
–0.01 –0.05
2 4 6 8 10 12 14 16 18 20 2 4 6 8 10 12 14 16 18 20
t (s) t (s)
(e) 40
(f ) Proposed controller
Simplified controller
30 10
20
10 5
us (V)
x1 (mm)
0
−10 0
−20
−30 –5
Demand
−40 Proposed controller
Simplified controller –10
−50
0 5 10 15 20 0 5 10 15 20
t (s) t (s)
FIGURE 6.6
Comparison result for the demand input xs1d = 29 sin(π t) mm. (a) α 2 and α̇2 by the proposed
filter. (b) α 2 and α̇2 by Equation 6.56. (c) α 3 and α̇3 by the proposed filter. (d) α 3 and α̇3
by Equation 6.56. (e) Cylinder displacement response x1 . (f) The control voltage of shoulder
controller us .
load on the upper arm is greater than that on the forearm, although the fre-
quency of the former is smaller than that of the latter. These two disturbance
estimations are similar to the simulation results.
The simulation results of position tracking error by two controllers are
shown in Figure 6.9. The proposed controller represents the proposed para-
metric adaptive controller (6.46) with the parametric estimation laws (6.18),
(6.24), and (6.41). The other controller combines the simplified backstepping
controller (6.56) with the DO (6.48) and the parametric estimation laws (6.18),
118 Nonlinear Control Techniques for EHAs in Robotics Engineering
200
d1
100
dˆ1
d1 (m/s2)
−100
−200
0 2 4 6 8 10
Time (s)
200
d2
100
dˆ2
d2 (m/s2)
−100
−200
0 2 4 6 8 10
Time (s)
10
d̃1
5
d˜ (m/s2)
d̃2
0
−5
−10
0 2 4 6 8 10
Time (s)
FIGURE 6.7
Simulation results of load disturbance estimation.
(6.24) as follows:
⎧
⎪ Tsv x4 Tsv Tsv
⎪
⎪ u=− c4 z4 + + α̇3 − z3 ϑ̂6 ps − tanh(kx4 )x3
⎪
⎪ Ksv Ksv Ksv Ksv
⎪
⎪
⎪
⎪ m
⎪
⎪ α̇2 = − (z2 + α1 − ẋ1d ) − c2 z3 − c2 α2
⎪
⎪
⎪
⎪ A p
⎪
⎪
⎪
⎪ c m c1 m ¯
⎪
⎪ +
2
(−ϑ̂1 x1 /m − ϑ̂2 x2 /m − d̂ + c1 x2 − c1 ẋ1d − ẍ1d ) − ẋ2
⎪
⎨ Ap Ap
.
⎪
⎪
⎪ z3 − Amp (c2 z2 + z1 ) + c3 (ẋ¯ 3 − α̇2 ) + ϑ̂4 ẋ¯ 2 + ϑ̂5 ẋ¯ 3 + α̈2
⎪
⎪ α̇3 = −
⎪
⎪
⎪
⎪ ϑ̂6 ps − tanh(kx4 )x3
⎪
⎪
⎪
⎪ Ap
⎪¯
⎪
⎪
⎪ ẋ2 = x3 − ϑ̂1 x1 /m − ϑ̂2 x2 /m − d̂
⎪
⎪ m
⎪
⎪
⎪
⎩ ẋ¯ = − ϑ̂ x − ϑ̂ x + ϑ̂ p − tanh(kx )x x
3 4 2 5 3 6 s 4 3 4
(6.57)
Parametric Adaptive Control Method 119
150
100
Disturbance estimation (m/s2)
50
−50
−100
−150 dˆ1
dˆ2
−200
0 2 4 6 8 10
Time (s)
FIGURE 6.8
Experimental results of the load disturbance estimation on two EHAs.
3
Controller 1
2 Controller 2
1
Δy1 (mm)
0
−1
−2
−3
0 2 4 6 8 10
Time (s)
3
Controller 1
2 Controller 2
1
Δy2 (mm)
0
−1
−2
−3
0 2 4 6 8 10
Time (s)
FIGURE 6.9
Simulation results of position tracking error by two controllers, y1 —upper arm error, y2 —
forearm error.
120 Nonlinear Control Techniques for EHAs in Robotics Engineering
Remark 6.5
It is to be noted that the controller (6.57) is different from the simplified
backstepping controller (6.56). In Equation 6.57, the parametric adaptive esti-
mation law can also be used to estimate ϑ i (i = 1, 2, 4, 5, 6). Furthermore, the
high-gain disturbance observer (6.48) can be adopted to estimate the distur-
bance d̂, which can be directly compensated in the backstepping design.
4
Controller 1
Controller 2
2
Δy1 (mm)
−2
−4
0 2 4 6 8 10
Time (s)
4
Controller 1
2 Controller 2
Δy2 (mm)
−2
−4
0 2 4 6 8 10
Time (s)
FIGURE 6.10
Experimental results of position tracking error by two controllers, y1 —upper arm error, y2 —
forearm error.
References
121
122 References
17. C. Guan and S. Pan. Nonlinear adaptive robust control of single-rod electro-
hydraulic actuator with unknown nonlinear parameters. IEEE Transactions on
Control System Technology, 16(3):434–445, 2008.
18. Q. Guo, P. Sun, J. Yin, T. Yu, and D. Jiang. Parametric adaptive estimation and
backstepping control of electro-hydraulic actuator with decayed memory filter.
ISA Transactions, 62(S1):202–214, 2016.
19. Q. Guo, T. Yu, and D. Jiang. High-gain observer-based output feedback con-
trol of single-rod electro-hydraulic actuator. IET Control Theory and Applications,
9(16):2395–2404, 2015.
20. Q. Guo, T. Yu, and D. Jiang. Robust H∞ positional control of 2-DOF robotic
arm driven by electro-hydraulic servo system. ISA Transactions, 59(11):55–64,
2015.
21. Q. Guo, Y. Zhang, B. Celler, and S. Su. Backstepping control of electro-
hydraulic system based on extended-state-observer with plant dynamics largely
unknown. IEEE Transactions on Industrial Electronics, 63(11):6909–6920, 2016.
22. Q. Guo, Y. Zhang, and D. Jiang. A control approach for human-mechatronic-
hydraulic-coupled exoskeleton in overload-carrying condition. International
Journal of Robotics and Automation, 31(8):272–280, 2016.
23. W. He, Y. Chen, and Z. Yin. Adaptive neural network control of an uncertain
robot with full-state constraints. IEEE Transactions on Cybernetics, 46(3):620–629,
2016.
24. W. He, Y. Dong, and C. Sun. Adaptive neural impedance control of a robotic
manipulator with input saturation. IEEE Transactions on Systems, Man, and
Cybernetics: Systems, 46(3):334–344, 2016.
25. W. He and S. Ge. Vibration control of a flexible string with both boundary
input and output constraints. IEEE Transactions on Control Systems Technology,
23(4):1245–1254, 2014.
26. W. He and S. Ge. Cooperative control of a nonuniform gantry crane with
constrained tension. Automatica, 66(4):146–154, 2016.
27. W. He and S. Zhang. Control design for nonlinear flexible wings of a robotic
aircraft. IEEE Transactions on Control Systems Technology, 25(1):351–357, 2017.
28. W. He, S. Zhang, and S. Ge. Adaptive control of a flexible crane system
with the boundary output constraint. IEEE Transactions on Industrial Electronics,
61(8):4126–4133, 2014.
29. W. He, S. Zhang, and S. Ge. Robust adaptive control of a thruster assisted
position mooring system. Automatica, 50(7):1843–1851, 2014.
30. C. Johnson and R. Lorenz. Experimental identification of friction and its com-
pensation in precise, position controlled mechanisms. IEEE Transactions on
Industry Applications, 28(6):1392–1398, 1992.
31. C. Kaddissi, J. Kenne, and M. Saad. Identification and real-time control of an
electrohydraulic servo system based on nonlinear backstepping. IEEE/ASME
Transactions on Mechatronics, 12(1):12–22, 2007.
32. H. Khalil. Nonlinear Systems (3rd edition). Prentice-Hall, Englewood Cliffs, NJ,
2001.
33. W. Kim, D. Shin, D. Won, and C. C. Chung. Disturbance-observer-based
position tracking controller in the presence of biased sinusoidal disturbance
for electrohydraulic actuators. IEEE Transactions on Control System Technology,
21(6):2290–2298, 2013.
References 123
34. W. Kim, D. Won, and C. Chung. High gain observer-based nonlinear posi-
tion control for electro-hydraulic servo systems. In Proceedings of 2010 American
Control Conference, Baltimore, MD, pp. 1440–1446, 2010.
35. W. Kim, D. Won, and C. Chung. Output feedback nonlinear control for electro-
hydraulic systems. Mechatronics, 22(6):766–777, 2012.
36. W. Kim, D. Won, and M. Tomizuka. Flatness-based nonlinear control for position
tracking of electrohydraulic systems. IEEE/ASME Transactions on Mechatronics,
20(1):197–206, 2015.
37. M. Krstic, I. Kanellakopoulos, and P. Kokotovic. Nonlinear and Adaptive Control
Design. John Wiley & Sons, Inc., New York, NY, 1995.
38. G. Liu and S. Daley. Optimal-tuning PID controller design in the frequency
domain with application to a rotary hydraulic system. Control Engineering
Practice, 7(7):821–830, 1999.
39. V. Lu, K. Zhou, and J. Doyle. Stabilization of uncertain linear systems: An LFT
approach. IEEE Transactions on Automatic Control, 41(1):50–65, 1996.
40. N. Manring. Hydraulic Control Systems. John Wiley & Sons, Inc., New York, NY,
2005.
41. H. Merritt. Hydraulic Control Systems. John Wiley & Sons, Inc., New York, NY,
1967.
42. V. Milić, Ž. Šitum, and M. Essert. Robust H∞ position control synthesis of an
electro-hydraulic servo system. ISA Transactions, 49(4):535–542, 2010.
43. M. Moradi. Self-tuning PID controller to three-axis stabilization of a satellite
with unknown parameters. International Journal of Non-Linear Mechanics, 49:700–
707, 2013.
44. P. Nakkarat and S. Kuntanapreeda. Observer-based backstepping force control
of an electrohydraulic actuator. Control Engineering Practice, 17(8):895–902, 2009.
45. N. Niksefat and N. Sepehri. Design and experimental evaluation of a robust
force controller for an electro-hydraulic actuator via quantitative feedback
theory. Control Engineering Practice, 8(12):1335–1345, 2000.
46. A. Packard, M. Fan, and J. Doyle. A power method for the structured singular
value. In Proceedings of the 27th Conference of Decision and Control, Austin, TX, pp.
2132–2137. IEEE, 1988.
47. H. Pan, W. Sun, H. Gao, and X. Jing. Disturbance observer-based adaptive track-
ing control with actuator saturation and its application. IEEE Transactions on
Automation, Science and Engineering, 13(2):868–875, 2016.
48. Y. Pi and X. Wang. Observer-based cascade control of a 6-DOF parallel hydraulic
manipulator in joint space coordinate. Mechatronics, 20(6):645–655, 2010.
49. A. Plummer and N. Vaughan. Robust adaptive control for hydraulic servo sys-
tems. ASME Journal of Dynamic System, Measurement, Control, 118(2):237–244,
1996.
50. Y. Qiu, X. Liang, and Z. Dai. Backstepping dynamic surface control for an anti-
skid braking system. Control Engineering Practice, 42:140–152, 2015.
51. C. Semini. The report of production display for “HyQ robot” made in the
Dynamic Legged Systems Lab, Istituto Italiano di Tecnologia (IIT), Genova, Italy,
http://www.iit.it/en/advrlabs/dynamic-legged-systems.html.
52. X. Song, Y. Wang, and Z. Sun. Robust stabilizer design for linear time-
varying internal model based output regulation and its application to an electro
hydraulic system. Automatica, 50(4):1128–1134, 2014.
124 References
53. H. Sun and G. Chiu. Nonlinear observer based force control of electro-hydraulic
actuators. In Proceedings of 1999 American Control Conference, San Diego, Califor-
nia, pp. 764–768, 1999.
54. D. Swaroop, P. Hedrick, J. Yip, and J. Gerdes. Dynamic surface control for a class
of nonlinear systems. IEEE Transactions on Automatic Control, 45(10):1893–1899,
2000.
55. I. Ursu, A. Toader, A. Halanay, and S. Balea. New stabilization and tracking
control laws for electrohydraulic servomechanisms. European Journal of Control,
19(1):65–80, 2013.
56. I. Ursu, F. Ursu, and F. Popescu. Backstepping design for controlling electrohy-
draulic. Journal of the Frankin Institute, 343(1):94–110, 2006.
57. W. Gawronski. Balanced systems and structures: Reduction, assignment, and
perturbations. Control and Dynamic Systems, 54:372–415, 1992.
58. D. Wang and J. Huang. Neural network-based adaptive dynamic surface con-
trol for a class of uncertain nonlinear systems in strict-feedback form. IEEE
Transactions on Neural Networks, 16(1):195–202, 2005.
59. D. Won, W. Kim, D. Shin, and C. Chung. High-gain disturbance observer-based
backstepping control with output tracking error constraint for electro-hydraulic
systems. IEEE Transactions on Control System Technology, 23(2):787–795, 2015.
60. B. Yao and F. Bu. Adaptive robust motion control of single-rod hydraulic
actuators theory and experiments. IEEE/ASME Transactions on Mechatronics,
5(1):79–91, 2000.
61. J. Yao, Z. Jiao, and D. Ma. Extended-state-observer-based output feedback non-
linear robust control of hydraulic systems with backstepping. IEEE Transactions
on Industrial Electronics, 61(11):6285–6293, 2014.
62. J. Yao, Z. Jiao, and D. Ma. High-accuracy tracking control of hydraulic rotary
actuators with modeling uncertainties. IEEE/ASME Transactions on Mechatronics,
19(2):633–641, 2014.
63. J. Yao, Z. Jiao, Y. Shang, and C. Huang. Adaptive nonlinear optimal compen-
sation control for electro-hydraulic load simulator. China Journal of Aeronautics,
23(6):720–733, 2010.
64. H. Yu, Z. Feng, and X. Wang. Nonlinear control for a class of hydraulic servo
system. Journal of Zhejiang University Science, 5(11):1413–1417, 2004.
65. P. Zarchan. Tactical and Strategic Missile Guidance. AIAA, Reston, VA, 1997.
66. J. Zhao, J. Wang, and S. Wang. Fractional order control to the electrohydraulic
system in insulator fatigue test device. Mechatronics, 23(7):828–839, 2010.
67. K. Zhou, J. Doyle, and K. Glover. Robust and Optimal Control. Prentice-Hall Inc.,
Englewood Cliffs, NJ, 1996.
Index
A D
Actuators, 1; see also Electro-hydraulic Decayed memory filter, 97
servo systems design, 104–106
Adaptive control, 2 Disturbance
Amplitude margin, 20 effect, 20
Arm hydraulic actuator rejection, 3
sinusoidal response of, 91 Disturbance observer (DO), 2
step response experiment, 89 with general nonlinear controller, 5
Asymmetrical cylinder model, 9 in parametric adaptive control
method, 115–120
DO, see Disturbance observer
B Double-rod acting mechanism, 8
Dynamic control voltages of two servo
Backstepping control, 4 valves, 44
controller, 86 Dynamic model of EHS, 98; see also
general, 100–104 Parametric adaptive control
procedure, 82 method
external load, 99
flow-pressure continuous equation of
C hydraulic cylinder, 98
fourth state space model, 99
Closed loop; see also Open-loop load flow of servo valve, 98
from load disturbance, 19 one-order linear model, 98
with robust performance sgn(.) function, 98
requirements, 53
transfer function, 18
Command delay, 10 E
Complementary sensitivity function, 61 EHA, see Electro-hydraulic actuator
Control method, 5; see also Parametric EHSs, see Electro-hydraulic servo
uncertainty problem systems
external load, 4–5 Electro-hydraulic actuator (EHA), 1
linear PID controller, 5 linearized model of, 14–16
output feedback control method, 6 Electro-hydraulic control system, 7; see
robust controller, 5 also Hydraulic cylinder model;
state feedback control method, 6 Servo valve
Control voltage of two servo valves nonlinear state-space model, 12–14
for sinusoidal demand, 65 parametric uncertainty and load
for square demand, 64 disturbance, 11–12
Coordinated motion experiment of Electro-hydraulic servo systems (EHSs),
robotic arm joints, 95, 96 1, 8, 69; see also Control method;
Cross-linked feedback system, 56 Parametric uncertainty
Cylinder problem
position feedback control loop; see adaptive control, 2
also Linear feedback control control methods, 5
loop external load on, 3
position response in time domain, 62 geometric control approach, 3
volume, 48 H∞ control methods, 3
125
126 Index