Download as pdf or txt
Download as pdf or txt
You are on page 1of 8

620 IEEE/CAA JOURNAL OF AUTOMATICA SINICA, VOL. 4, NO.

4, OCTOBER 2017

Continuous Robust Control for Series Elastic


Actuator With Unknown Payload Parameters
and External Disturbances
Meng Wang, Lei Sun, Member, IEEE, Wei Yin, Shuai Dong, and Jingtai Liu, Member, IEEE

Abstract—In this paper, the torque tracking control problem Wyeth [9] uses a PI (proportional-integral) velocity control
for a class of series elastic actuators (SEAs) in the presence loop to replace the inner position loop to improve the control
of unknown payload parameters and external disturbances is performance. Moreover, based on the passivity theory and
investigated. The uncertainties/disturbances rejection problem
for SEAs is addressed from the view of a continuous nonlinear the impedance control theory, the cascade control scheme is
robust control development. Specifically, based on the analysis further developed in [10], [11]. In [12], [13], LDOB (linear
of a nonlinear SEA, the generic dynamics of SEA systems is disturbance observer)-based control structures are proposed
described and a novel nonlinear control framework for SEAs to compensate for the model errors and plant variations. In
is constructed. Then a RISE (robust integral of the sign of the addition, other advanced control methods, such as sliding-
error)-based second-order filter is introduced to synthesize the
control law. Moreover, the control performance is theoretically mode control (SMC) [14], [15], model reference adaptive
ensured by Lyapunov analysis. Finally, some experimental results control (MRAC) [16], neural network based control [17],
are included to demonstrate the superior performance of the H2 -optimal control [18] and rapidly exponentially stabilizing
proposed control method, in terms of transient response and control Lyapunov function (REL-CLF) based controllers [19],
robustness. [20] have been applied for SEAs. Although the above control
Index Terms—Nonlinear robust control, torque control, series approaches achieve good performance, the common ground
elastic actuator. shared in those works is that the elastic mechanism of the
SEAs is regarded as a linear spring, i.e., the torque generated
I. I NTRODUCTION by SEAs is proportional to the position of the motor with
respect to the payload (we call such traditional SEAs as
W ITH advantages of intrinsic safety, accurate force/
torque output, low impedance, etc., series elastic ac-
tuators (SEAs) [1], [2] have shown great potential applica-
linear SEAs hereafter). However, in order to achieve higher
energy density and better bionic characteristics, the mechanical
tions in different human-robot interaction (HRI) systems such structure of SEAs tends to be more and more complex and it
as rehabilitation robots, exoskeletons, co-robotics and so on leads to nonlinear SEAs which are also referred to variable
[3]−[7]. The high-performance control design for SEAs is impedance/stiffness actuators (VIAs/VSAs) [21]−[24]. The
still a challenging problem, particularly in the presence of performance of the methods oriented to linear SEAs can be
unknown payload parameters and external disturbances, which degraded in the case of nonlinear ones.
are common in HRI systems. To deal with the challenge, many In recent years, a variety of different solutions for nonlinear
works have been conducted in the last decades. The traditional SEAs have been proposed, such as cascade PID control [25],
cascade proportional-integral-differential (PID) control, with [26], LDOB-based control [27], [28], optimal control [29],
model-independence and simple implementation, is a widely [30], sliding mode control [31], and so on. The control
used approach for SEA-based systems [8]−[11]. Pratt et al. performance of the aforementioned control laws is highlighted
[8] use an inner position control loop nested in an outer torque by experimental or simulation results, whereas most of them
control loop to construct a cascade PID controller. Later, are developed with little consideration of the uncertainties in
HRI systems, i.e., the variations of payload dynamics and
Manuscript received May 30, 2015; accepted September 11, 2016. This external disturbances. When SEAs are applied to robots that
work was supported in part by the National Natural Science Foundation of interact with human frequently, these systems are characterized
China(61573198), in part by the National High-tech R&D Program of China
(863 Program) (2012AA041403). Recommended by Associate Editor Zhijun by the presence of the “human in the loop” so that the system
Li. (Corresponding author: Lei Sun.) usually suffers uncertain human dynamics. Moreover, humans
Citation: M. Wang, L. Sun, W. Yin, S. Dong, and J. T. Liu, “Continuous typically change their dynamics in response to the environment
robust control for series elastic actuator with unknown payload parameters
and external disturbances,” IEEE/CAA J. of Autom. Sinica, vol. 4, no. 4, pp. and depending on the specific tasks. The variations of the
620−627, Oct. 2017. payload dynamics can be sufficiently large, which means
The authors are with the Institute of Robotics and Automatic that the payload parameters are totally unknown and can
Information System, and also the Tianjin Key Laboratory of
Intelligent Robotics, Nankai University, Tianjin 300071, China (e- not be used for controller design. For example leg dynamics
mail: sunl@nankai.edu.cn; wmkevin@mail.nankai.edu.cn; blackbirdon- dramatically changes between the swing and the stance phase.
tree@163.com; dongsh@mail.nankai.edu.cn; liujt@nankai.edu.cn). Also damping and stiffness can be increased by muscle co-
Color versions of one or more of the figures in this paper are available
online at http://ieeexplore.ieee.org. contraction, e.g., when we want to make a precise positioning
Digital Object Identifier 10.1109/JAS.2017.7510610 or when we hold heavy loads. Moreover, external disturbances
WANG et al.: CONTINUOUS ROBUST CONTROL FOR SERIES ELASTIC ACTUATOR WITH · · · 621

widely exist in all practical systems and bring adverse effects to SEA torque control. The framework is suitable for both
on performance and even stability of control systems. It linear and nonlinear SEAs, which implies that it is more
would be dangerous for humans in HRI systems with less generic.
consideration of above uncertainties. In [25], [26], the cascade 2) The designed robust controller takes a continuous ex-
PID controller which can be seen as a simple and effective pression, which makes it more practical. The controller is
approach to complex systems is used to control nonlinear robust against unknown payload parameters and external dis-
SEAs. But there is a lack of theoretical convergence analysis. turbances.
The LDOB-based methodology is presented in [27], [28]. 3) Experimental results illustrate that the proposed con-
The nonlinear functions describing the nonlinear deflection- troller can achieve better control performance than the existing
torque relations are linearized. Then the controllers specific methods in a variety of interaction situations and show satis-
to the linearized systems are designed and the LDOBs are factory robustness.
constructed to compensate for the model errors. The passivity The remainder of this paper is organized as follows. A
of the system is ensured, making the controller stable even nonlinear control framework for SEA torque control is pro-
in the presence of unknown payload parameters, however, the posed in Section II. We present the controller development
main limitation of the method is that only the local stability and the stability analysis in Section III. Section IV exhibits the
of the controllers is guaranteed. Specific to particular tasks, hardware experiments to illustrate the superior performance of
optimal control approaches are presented in [29], [30]. But the proposed approach. The main work of this paper is finally
these methods, with the need of payload dynamics, are not summarized in Section V.
suitable for HRI systems. In our previous works, a sliding-
mode controller is proposed [31], but some disturbances, such II. A N ONLINEAR C ONTROL F RAMEWORK FOR SEA
as the model errors and the real friction, are not considered T ORQUE C ONTROL
and the chattering caused by the sliding-mode control scheme
A. Preliminary Work
may induce some discomforts to humans.
A new class of nonlinear controller, the robust integral of The nonlinear SEA studied in this paper which is inspired by
the sign of the error (RISE) control structure, is proposed in Wolf and Hirzinger [22] is shown in Fig. 1. The SEA mainly
[32] and further developed in [33]−[35]. The method shows consists of a DC servo motor and an elastic component. The
strong robustness with respect to system uncertainties and elasticity comes from three compressed springs. The springs
external disturbances, which depends on the integral of the will be compressed when a relative displacement between the
sign of the error term. Compared with traditional sliding-mode payload and the motor is induced, thus the roller rolls along
control approach, another advantage of the method is that it the circular surface. According to Fig. 1, the generated torque
reduces the chattering behavior, which makes it more attractive of the SEA can be worked out as follows:
in practical applications such as mechanical and electrical cϕ
sin θ = (1)
systems [34], [35]. Typically, the asymptotic convergence R−r
would be achieved by controllers, which maintains either ∆y = (R − r)(1 − cos ϕ) (2)
discontinuous feedback or discontinuous derivatives in the F = 3ks ∆y (3)
presence of absolutely unknown disturbances. Compared with
τSEA = F c tan θ = 3ks c(R − r)(tan θ − sin θ) (4)
the discontinues control method, the RISE design eliminates
the drawback of infinite bandwidth and infinitesimal switching
time due to the raised-order property (i.e., the integral of the
sign of the error). And in this paper, we will develop the
modified RISE controller to deal with the uncertainties in HRI
systems.
Based on the foregoing analysis, we will focus on the torque
control of SEAs used in HRI systems. Specifically, in view
of a state transformation, a nonlinear control framework for
SEA torque control is proposed, from which the relationship
between the motion of the payload and the control system
can be obtained. Then we construct a modified RISE control Fig. 1. Actuator setup.
law to compensate for the effect caused by the motion of the
payload and the controller is not associated with any payload where ϕ represents the relative displacement between the
parameters (inertia, gravity and so on). A new Lyapunov motor and the payload; R, r denote the radius of the circular
function is proposed to guarantee the close-loop dynamics to surface and the cam rollers, respectively; c is the radius relative
be exponentially stable for sufficiently smooth reference trajec- to the joint axis the cam rollers roll on; θ is the angle of
tories. Finally, some real-time experimental results for various cam rollers roll along the circular surface; ks denotes the
interaction cases are included to validate the performance of spring stiffness constant; ∆y represents the displacement of
the proposed control approach. The main contributions of the the cam rollers in the direction of the joint axis; F is the force
paper are summarized as follows: generated by the spring calculated by Hooke’s law and τSEA
1) A nonlinear control framework is described and applied is the centering torque generated by SEA. The parameters of
622 IEEE/CAA JOURNAL OF AUTOMATICA SINICA, VOL. 4, NO. 4, OCTOBER 2017

the SEA are shown in Table I and the result of the model motor and the payload. Here, f (ϕ) is considered to be a more
verification is shown in Fig. 21 . As shown in the result, there generalized function as (1)−(4) instead of the traditional linear
exists a small hysteresis which may have caused by the friction function.
and the sensor hysteresis. However, the error between the
theoretical values and the values read from the torque sensor is
less than ±0.2 Nm and it can be concluded that the equations
(1)−(4) are valid. Moreover, the property of a class of SEAs
including both linear and nonlinear ones can be summarized
and stated as follows.
Property 1: There is a bijection f (ϕ) describing the rela-
tionship between the generated torque of the SEA and the
position of the motor with respect to the payload. Moreover, Fig. 3. Schematic representation of SEA systems.
f (ϕ) ∈ C2 .
TABLE I Based on Property 1, the SEA torque control problem can
I DENTIFIED PARAMETERS be converted to the relative position control problem, which
can be mathematically summarized as follows:
Parameter Value
ks 13600 N/m ϕ(t) → ϕd (t) ⇐⇒ τSEA (t) → τSEA,d (t) (6)
c 0.018 m
R 0.020 m where ϕd (t) denotes the desired relative position trajectory of
r 0.005 m motor and payload calculated by the desired torque trajectory
τSEA,d (t) through f −1 (τSEA ). Here, the reference trajectory
ϕd (t) is set to be sufficiently smooth such that ϕd (t) ∈ C3 .
In this paper, the SEAs are mainly considered to be applied
to robots that interact with humans frequently, and the vari-
ations of the payload parameters can be sufficiently large in
these systems [2]−[5]. Motivated by the desire to make the
controller be insensitive to these changes, the dynamic func-
tions are operated as follows: let x1 = ϕ, x2 = θ̇M = ẋ1 + θ̇L ,
be defined, the original SEA dynamics (1) can be rearranged
into (
ẋ1 = x2 − θ̇L
(7)
JM ẋ2 = τM − f (x1 ) − cM x2 − dM .
After the transformation, the effect caused by the motion of
the payload on the system becomes more clear and controllers
Fig. 2. Model verification of the nonlinear SEA. can be designed to compensate for that directly without
consideration of the payload parameters. Consequently, a
B. Nonlinear Control Framework novel nonlinear control framework is obtained and the SEA
A schematic diagram of SEA systems is depicted in Fig. 3, torque control problem can be stated as follows: design a
from which the following generic dynamics can be obtained: controller τM (t) to drive the system state x1 (t) to the desired
 value/trajectory x1,d (t). For the sake of analysis, the follow-
 τM = JM θ̈M + cM θ̇M + τSEA + dM
 ing assumptions are given here by considering the practical
τSEA = f (ϕ) = JL (θL )θ̈L + CL (θ̇L , θL ) + dL (5) application and physical constraints.


ϕ = θM − θL Assumption 1: The disturbances satisfy the following con-
dition dM (t), d˙M (t), d¨M (t) ∈ L∞ .
where JM , cM represent the inertia and damping coefficient Assumption 2: The motion signals of the payload satisfy the
of the geared motor, respectively; JL (θL ) is the inertia of (3) (4)
following condition θ̈L (t), θL (t), θL (t) ∈ L∞ .
the payload, CL (θ̇L , θL ) contains the centrifugal, coriolis and Remark 1: For SEA systems, impacts or step functions may
gravity forces of the payload; θM (t) is the motor position; happen during the interactions between humans and robots.
θL (t) is the payload position; τSEA (t) denotes the torque gen- However, it is noticed that humans always interact with the
erated by SEA; dM (t), dL (t) are regarded as the disturbances end-effector of the robots, thus these sudden changes should
including all other uncertain terms in the dynamics (such as only be generated by the payload side. The elastic component
model errors and friction) of the motor side and the payload which is in series with the motor could soften the effect before
side, respectively; τM (t) is the actuating torque provided by the impacts are transmitted to the motor side. Hence, the
motor. f (ϕ) denotes the function describing the relationship disturbance of the motor side dM will be smooth enough.
between the generated torque and the relative position of the For HRI systems, the motion of the payload side is mainly
1 The parameters identification has been completed in our previous work, dependent on humans. The explosive power of humans could
interested readers are recommended to [36] for more details. be large enough, but with the limitations of the biomechanics
WANG et al.: CONTINUOUS ROBUST CONTROL FOR SERIES ELASTIC ACTUATOR WITH · · · 623

constraints, from the conclusion of [12], the bandwidth up B. Stability Analysis


to the frequency range of human motions is about 4−8 Hz. To facilitate the subsequent analysis, the auxiliary signal
Hence, it is natural to have Assumption 2 since human motions r(t) is defined as follows:
in the real world are operating in a region whose bounds are
known and often positive. r = ė2 + α2 e2 . (14)
According to (12), it can be derived:
III. C ONTROLLER D ESIGN AND A NALYSIS ...
A. Control Law Development ṙ = e + α1 ë + α2 ė1 + ṙf . (15)
The control design for the SEA should account for two main Multiplying both sides with JM and substituting (11), (12)
issues: 1) the compensation for the motion of the payload and into the resulting equation, it can be obtained that
2) external disturbances. To quantify the tracking objective, a ...
JM ṙ = u̇um − d˙M − JM θ L + JM (α1 ë + α2 ė1 )
tracking error denoted by e(t) is defined as (16)
+ JM [−(k + 1)r − rf + e1 − e1f ] + e1 − e1 .
e = x1 − x1,d . (8)
In... order to simplify the notation, the terms d˙M and
Then, the dynamics of the error system is described as JM θ L are represented as a function of time t and ac-
follows: cording to assumptions from Section II, we know that
(
ė = x̃2 both of them are bounded signals. Then, by introducing
N (x1 , ẋ1 , ẍ1 , e1f , rf , r, t) as an auxiliary function to include
JM x̃˙ 2 = τM − f (x1 ) − cM x2 − JM ẍ1,d − dM − JM θ̈L
(9) all the uncertain parts in the above dynamic equation, it can
where x̃2 (t) = x2 (t)− θ̇L (t)− ẋ1,d . Thus, the proposed control be derived that
law is a combination of two parts, um to compensate for JM ṙ = N − JM (k + 1)r + u̇um − e1 . (17)
the measurable nominal parts and uum to compensate for the
unmeasurable variables. The function N (x1 , ẋ1 , ẍ1 , e1f , rf , r, t) is defined as
...
τM (t) = um (t) + uum (t) (10) N = − d˙M − JM θ L + JM (α1 ë + α2 ė)
(18)
+ JM [−rf + e1 − e1f ] + e1
where um (t) = f (x1 (t)) + cM x2 (t) + JM ẍ1,d (t) and uum (t)
is to be designed later. It can be obtained by substituting (10) and the last term −e1 (t) is separated from the grouped N (·)
into (9): ( to cancel the cross terms in the stability analysis and will be
ė = x̃2 used in the subsequent part.
(11) Integrated with (13) and (18), the ultimate close-loop error
JM x̃˙ 2 = uum − JM θ̈L − dM .
dynamics can be derived as
For the control design based on the close-loop dynamics
in (11), it is noticed that, not only the disturbance term of JM ṙ = Nd + Ñ + (k + 1)rf − 2βsign(e2 )
(19)
the motor side, but also the acceleration of the payload side − JM (k + 1)r − e1
need to be compensated. In order to deal with these terms,
where auxiliary functions Nd (t) and Ñ (·) have the following
the following second-order filter is designed using the system
form:
states that work in cascade with the revised RISE structure,
which is depicted as follows: Nd = N (x1,d , ẋ1,d , ẍ1,d , 0, 0, 0, t)
e1 = ė + α1 e Ñ = N − Nd + κ(|rf | + |e2 |). (20)
ė1f = −α2 e1f + rf In this way, N (·) is split into two terms, Ñ (·) and Nd (t), in
rf = −(k + 1)e2 + p which Nd (t) can be upper-bounded by a constant and Ñ (·) can
e2 = e1 + e1f be controlled by a state-error-dependent term. By applying the
mean value theorem, an inequality for Ñ (·) can be described
ṗ = −(k + 1)α2 e2 − rf + e1 − e1f (12) as
where α1 , α2 , k are positive constant gains. It can be found w k)kw
|Ñ | ≤ ρ(kw wk (21)
that, the inputs for the filters are the measurable signals e(t)
where k · k denotes the 2-norm of vectors and w ∈ R5
and ė(t), thus the filter’s outputs e1 (t), e1f (t) and rf (t) are
represents a group vector of the system errors and the filtered
all measurable and can be utilized in the controller.
errors as
Based on (12), the control input uum (t) can be designed as
w (t) = [e, e1 , e1f , rf , r]T (22)
follows:
and ρ(·) denotes a positive non-decreasing function. From As-
u̇um = κ(|rf | + |e2 |) + (k + 1)rf − 2βsign(e2 ). (13)
sumptions 1 and 2, the following inequalities can be developed
where β and κ denote a positive constant. Although the
kNd k ≤ δ1 , kṄd k ≤ δ2 (23)
derivative of uum (t) is discontinuous on e2 = 0, it is clear
that uum (t) maintains continuity for all the variables in their where δ1 , δ2 are two positive constants and the conclusions of
defined domains. (23) will be utilized to prove the following theorem.
624 IEEE/CAA JOURNAL OF AUTOMATICA SINICA, VOL. 4, NO. 4, OCTOBER 2017

Theorem 1: The proposed controller (10), guarantees that where Kw = 1/2 min {JM , α1 − 1/2, α2 − 1/2, 1}. Then it
the control error e(t), converges to zero exponentially, in the can be concluded that
sense that 1
p V̇ ≤ −Kw kw w k2 − α2 β|e2 | − (Kw − ρ2 (kw w k2 )
w k)kw
1 4JM k
ke(t)k ≤ V (0)/λ1 exp(− Kv t) (24)
2 1
≤ −Kv V − (Kw − ρ2 (kw w k2 )
w k)kw (31)
where λ1 and Kv are two positive constants and V (·) is a 4JM k
positive definite function that will be designed later, provided where Kv = min{Kw /2, α √2 β/(2β +kNd k∞ )}. Considering a
the gains introduced in (12) and (13) are chosen according to set Ω = {w w k ≤ ρ−1 (2 JM Kw )}, in which the inequality
w |kw
the sufficient conditions in the following: Kw − ρ2 (kw
w k)/4JM k ≥ 0 is satisfied. It can be derived
1 V̇ ≤ −Kv V, for w ∈ Ω. (32)
α1 >
2
1 Multiplying both sides of (32) by exp(Kv t) yields
α2 >
2 V̇ exp(Kv t) + Kv exp (Kv t) ≤ 0 (33)
1
β > δ1 + δ2 which leads to
α2
ρ2 (kw
w k) V exp(Kv t) − V (0) ≤ 0 for w ∈ Ω (34)
k> . (25)
4JM Kw In consequence, if the control gain k satisfies the condition
in which Kw is a positive constant that will be defined in the given in (25), it is concluded that
following analysis. p 1
Proof: Let V (t), which is positive definite, be defined in |e(t)| ≤ kww k ≤ V (0)/λ1 exp(− Kv t) (35)
2
the following form: ¥
1 1 1 1
V = JM r2 + e2 + e21 + e21f IV. E XPERIMENTAL R ESULT
2 2 2 2
1 2 In this section, some actual experiments are conducted on
+ rf + 2β|e2 | − Nd e2 . (26)
2 a self-built single-SEA-joint robot to further verify the actual
According to (23) and (25), the following inequality can be control performance of the proposed approach. In particular,
obtained the superior performance of the new method is exhibited by
comparing it with the traditional cascade-PID controller.
w k + β|e2 | ≤ V ≤ λ2 kw
λ1 kw w k + (2β + kNd k∞ )|e2 | (27)
where λ1 and λ2 are set as A. Experimental Configuration
1 1 The SEA experiment setup is shown in Fig. 4. It can be seen
λ1 = min{1, JM }, λ2 = max{1, JM }. (28) as a plane rotatory robot and the rotation axis is perpendicular
2 2
to the ground. Two encoders are installed to measure the
Taking the time derivative of (26), substituting (12) and (19)
angular displacement signals of the motor side and the payload
into the resulting formula and making some mathematical
side, respectively. The velocity signals are obtained by doing
arrangements lead to
numerical difference operations on the angle signals. The SEA
V̇ = r[Nd + Ñ + (k + 1)rf − 2βsign(e2 ) − JM (k + 1)r − e1 ] system is driven by a Maxon DC servo motor. For real-time
+ e(e1 − α1 e) + e1 ė1 + e1f (rf − α2 e1f ) implementation, the control period is set as 1 ms. The control
algorithm runs in the environment of Linux/Xenomai operating
+ rf [−rf − (k + 1)r + e1 − e1f ]
system to ensure real-time control and the control algorithm is
+ 2βsgn(e2 )ė2 − Ṅd e2 − Nd ė2 . (29) implemented in C programming language. An FPGA control
board is used to collect data from the sensors and convey
Note that r(t) = ė2 (t) + α2 e2 (t), then the following
the control commands, generated by the PC-104, to the servo
manipulations are carried out
actuators controlling the motor.
V̇ = − JM r2 − JM kr2 − α2 e21f − rf2 − α2 e21 − α1 e2
+ ee1 − 2α2 β|e2 | + α2 Nd e2 − Ṅd e2 + rÑ B. Experimental Results and Analysis
1 We have implemented three groups of experiments to com-
≤ − JM r2 − JM kr2 − α2 e21f − rf2 − (α1 − )e2 prehensively validate the performance of the proposed method
2
1 2 in the presence of three common human-robot interaction
− (α2 − )e1 − α2 β|e2 | + |r||Ñ | cases. Briefly speaking, in the first group, the payload is free
2
1 to rotate at the beginning, then it is caught by hands which
≤ − JM r2 − JM kr2 − α2 e21f − rf2 − (α1 − )e2 induces a collision and the payload is forced to stop. In the
2
1 2 second group, the payload is forced to stop at first, then it is
− (α2 − )e1 − α2 β|e2 | + |r|ρ(kw w k)kw wk
2 released to rotate around the axis freely. In the third group, the
1 payload is excited by hand and the zero-impedance control is
≤ − 2Kw kww k2 − α2 β|e2 | + ρ2 (kw w k2 (30)
w k)kw
4JM k used to test the performance of the proposed controller.
WANG et al.: CONTINUOUS ROBUST CONTROL FOR SERIES ELASTIC ACTUATOR WITH · · · 625

Fig. 4. The SEA experiment test bed.

In all three sets of experiments, the cascade-PID controller


is used as the comparative approach (note that the cascade
control method is widely used to control linear and nonlinear
SEAs [8]−[11], [24], [25]; hence, it is chosen here for com-
parison). Throughout the subsequent experiments, the control
parameters for our method are chosen as
α1 = 15, α2 = 10, β = 5
k = 100, kt = 0.5.
For the comparative cascade PID control method, the control
gains for outer loop and inner loop are selected, after careful
tuning, as
kop = 20, koi = 8, kod = 0.5
kip = 5, kii = 3, kid = 0.
It is worth mentioning that the torque data in the following
experiment results is directly calculated through (1)−(4).
Experiment Group 1: Catch. In the first group, the desired
torque is set as 0.2 Nm, i.e., τd (t) = 0.2 Nm. The obtained Fig. 5. Experiment results for Group 1.
experimental results are shown in Fig. 5. From the result, it can
be obtained that, for both controllers, the generated torque is
driven to reach the desired value accurately. However, it can
be seen that the proposed method has a faster convergence
rate without overshoot. Moreover, the impact caused by the
collision is canceled out rapidly and hardly influences the
output torque for the proposed control law, and at the same
time, the overall control performance is well guaranteed. But
the variations of the payload side leads to the degraded
performance of the cascade-PID controller in the sense that
it takes much more time for the cascade-PID method to make
the generated torque recover to the desired value. It can
be concluded that, the proposed approach achieves a better
control performance in terms of both transient response and
robustness. It is noticed that, for the two controllers, the
collisions do not happen at the same point, because it is hard
to guarantee the strict synchronization in the real experiments.
Experiment Group 2: Release. For the second group, the
desired torque is still set as τd = 2 Nm and the corresponding
experimental results are exhibited in Fig. 6. By observing these
results, it is clear that, at first, the proposed controller makes
Fig. 6. Experiment results for Group 2.
the SEA output torque converge to the desired value fast and
accurately. Then the payload is released to rotate freely, but the
overall control performance is not degraded. The effect caused proposed controller. For the cascade-PID controller, the con-
by the release is much better suppressed and eliminated by the vergence rate is slower and overshoot appears in the result.
626 IEEE/CAA JOURNAL OF AUTOMATICA SINICA, VOL. 4, NO. 4, OCTOBER 2017

In addition, the variations of the payload side, to some R EFERENCES


extent, degrades the control performance of the cascade-PID
[1] G. A. Pratt and M. M. Williamson, “Series elastic actuators,” in Proc.
method. Consequently, the proposed approach is better and the 1995 IEEE/RSJ Int. Conf. Intelligent Robots and Systems, Pittsburgh,
robustness shown from the experimental results is beneficial PA, USA, 1995, pp. 399−406.
since in practical HRI systems, the dynamics of the payload
[2] J. Pratt, B. Krupp, and C. Morse, “Series elastic actuators for high
side is usually different and the variations of that are inevitable. fidelity force control,” Ind. Robot, vol. 29, no. 3, pp. 234−241, Jun. 2002.
Experiment Group 3: Zero-impedance control. Zero- [3] J. F. Veneman, R. Ekkelenkamp, R. Kruidhof, F. C. T. van der Helm, and
impedance control mode plays an important role in HRI sys- H. van der Kooij, “A series elastic- and bowden-cable-based actuation
tems as a special case of torque control. This is an important system for use as torque actuator in exoskeleton-type robots,” Int. J.
Robot. Res., vol. 25, no. 3, pp. 261−281, Jan. 2006.
characteristic of an SEA joint because it makes it possible
for the joint to work as an ideal friction-free bearing, which [4] J. S. Sulzer, R. A. Roiz, M. A. Peshkin, and J. L. Patton, “A highly
leads the robot be transparent to persons. In this group, the backdrivable, lightweight knee actuator for investigating gait in stroke,”
IEEE Trans. Robot., vol. 25, no. 3, pp. 539−548, Jun. 2009.
desired torque is set to zero, i.e. τd = 0, while the end-effector
of the robot is actively perturbed by hand. Fig. 7 records the [5] F. Sergi, D. Accoto, G. Carpino, N. L. Tagliamonte, and E. Guglielmelli,
“Design and characterization of a compact rotary series elastic actuator
experimental results. As shown by the experimental data, the for knee assistance during overground walking,” in Proc. 4th IEEE RAS
control error of the proposed controller is less than ±0.03 Nm & EMBS Int. Conf. Biomedical Robotics and Biomechatronics, Rome,
and barely noticeable, while the control error of the cascade- 2012, pp. 1931−1936.
PID controller is much larger (more than ±0.1 Nm). Therefore, [6] G. Mathijssen, D. Lefeber, and B. Vanderborght, “Variable recruitment
it is evident that the proposed controller has a better ability of parallel elastic elements: Series-parallel elastic Actuators (SPEA)
with dephased mutilated gears,” IEEE/ASME Trans. Mechatron., vol. 20,
to make the actuator maintain the zero-impedance mode and no. 2, pp. 594−602, Apr. 2015.
proves its promising application prospect in HRI systems.
[7] S. Pfeifer, A. Pagel, R. Riener, and H. Vallery, “Actuator
with angle-dependent elasticity for biomimetic transfemoral prosthe-
ses,” IEEE/ASME Trans. Mechatron., vol. 20, no. 3, pp. 1384−1394,
Jun. 2015.
[8] G. A. Pratt, P. Willisson, C. Bolton, and A. Hofman, “Late motor
processing in low-impedance robots: impedance control of series-elastic
actuators,” in Proc. 2004 American Control Conf., Boston, MA, USA,
2004, pp. 3245−3251.
[9] G. Wyeth, “Demonstrating the safety and performance of a velocity
sourced series elastic actuator,” in Proc. IEEE Int. Conf. Robotics and
Automation, Pasadena, CA, USA, 2008, pp. 3642−3647.
[10] H. Vallery, R. Ekkelenkamp, H. Van Der Kooij, and M. Buss, “Pas-
sive and accurate torque control of series elastic actuators,” in Proc.
IEEE/RSJ Int. Conf. Intelligent Robots and Systems, San Diego, CA,
USA, 2007, pp. 3534−3538.
[11] N. L. Tagliamonte and D. Accoto, “Passivity constraints for the
impedance control of series elastic actuators,” Proc. Inst. Mech. Eng.
Part I: J. Syst. Control Eng., vol. 228, no. 3, pp. 138−153, Mar. 2014.
[12] K. Kong, J. Bae, and M. Tomizuka, “Control of rotary series elastic
actuator for ideal force-mode actuation in human-robot interaction ap-
plications,” IEEE/ASME Trans. Mechatron., vol. 14, no. 1, pp. 105−118,
Feb. 2009.
[13] K. Kong, J. Bae, and M. Tomizuka, “A compact rotary series elastic
Fig. 7. Experiment results for Group 3. actuator for human assistive systems,” IEEE/ASME Trans. Mechatron.,
vol. 17, no. 2, pp. 288−297, Apr. 2012.
[14] M. Grün, R. Müller, and U. Konigorski, “Model based control of series
V. C ONCLUSION elastic actuators,” in Proc. 4th IEEE RAS & EMBS Int. Conf. Biomedical
Robotics and Biomechatronics, Rome, 2012, pp. 538−543.
In this paper, based on the proposed control framework, [15] J. Bae, K. Kong, and M. Tomizuka, “Gait phase-based control for a
a practical rise-based control law has been suggested for rotary series elastic actuator assisting the knee joint,” J. Med. Devices,
a class of SEAs to track the time-varying reference torque vol. 5, no. 3, pp. 031010, Sep. 2011.
trajectory in the presence of unknown payload parameters and [16] A. Calanca and P. Fiorini, “Human-adaptive control of series elastic
external disturbances. The proposed controller only requires actuators,” Robotica, vol. 32, no. 8, pp. 1301−1316, Dec. 2014.
very limited knowledge of the payload dynamics and dis- [17] Y. C. Mao, R. Xiong, Q. G. Zhu, and J. Chu, “Velocity control of
turbance. The control performance is rigorously guaranteed serial elastic actuator based on EKF estimator and neural network,” in
with Lyapunov analysis. Experimental results are exhibited to Nature-Inspired Mobile Robotics, K. Waldron, M. O. Tokhi, G. S. Virk,
and K. J. Waldron, Eds. Singapore: World Scientific Publishing, 2013,
validate the feasibility and the superior control performance of pp. 729−739.
the proposed controller. Now, we are building a 3-DOFs robot
[18] B. J. E. Misgeld, A. Pomprapa, and S. Leonhardt, “Robust control of
which is comprised of three SEA-joints and in our future work, compliant actuators using positive real H2-controller synthesis,” in Proc.
we will apply the proposed approach to control the robot. American Control Conf., Portland, OR, USA, 2014, pp. 5477−5483.
WANG et al.: CONTINUOUS ROBUST CONTROL FOR SERIES ELASTIC ACTUATOR WITH · · · 627

[19] A. D. Ames and J. Holley, “Quadratic program based nonlinear em- Meng Wang is Ph.D. candidate at Nankai Uni-
bedded control of series elastic actuators,” in Proc. 53rd Annu. Conf. versity. He received the B.S. degree in intelligent
Decision and Control, Los Angeles, CA, USA, 2014, pp. 6291−6298. science and technology from Nankai University,
Tianjin, China, in 2012. He is currently working
[20] M. J. Powell and A. D. Ames, “Hierarchical control of series elastic ac- toward the Ph.D. degree in control theory and control
tuators through control Lyapunov functions,” in Proc. 53rd Annu. Conf. engineering in the Institute of Robotics and Auto-
Decision and Control, Los Angeles, CA, USA, 2014, pp. 2986−2992. matic Information System, Nankai University, Tian-
[21] A. Jafari, N. G. Tsagarakis, and D. G. Caldwell, “A novel intrinsically jin, China. His research interests include flexible-
energy efficient actuator with adjustable stiffness (AwAS),” IEEE/ASME joint robot and nonlinear control.
Trans. Mechatron., vol. 18, no. 1, pp. 355−365, Feb. 2013.
[22] S. Wolf and G. Hirzinger, “A new variable stiffness design: Matching
requirements of the next robot generation,” in Proc. IEEE Int. Conf.
Robotics and Automation, 2008, Pasadena, CA, USA, pp. 1741−1746.
[23] L. Mooney and H. Herr, “Continuously-variable series-elastic actuator,” Lei Sun is an Associate Professor at Nankai Uni-
in Proc. 2013 IEEE Int. Conf. Rehabilitation Robotics, Seattle, WA, versity. He received the B.E. and M.S. degrees in
USA, 2013. industry automation from Tianjin University, China,
[24] S. Ford, D. Rollinson, A. Willig, and H. Choset, “Online calibration in 1999 and 2002, and the Ph.D. degree in control
of a compact series elastic actuator,” in Proc. American Control Conf., theory and control engineering from Nankai Univer-
Portland, OR, USA, 2014, pp. 3329−3334. sity, China, in 2005. In 2005, he joined Nankai Uni-
versity, where he is currently an Associate Professor
[25] J. Austin, A. Schepelmann, and H. Geyer, “Control and evaluation of in the College of Computer and Control Engineering.
series elastic actuators with nonlinear rubber springs,” in Proc. IEEE/RSJ His research interests include robotics and automatic
Int. Conf. Intelligent Robots and Systems, Hamburg, Germany, 2015, control, teleoperation of robots in networks, wireless
pp. 6563−6568. sensor network, micro-electro-mechanical systems.

[26] M. Laffranchi, L. S. Chen, N. Kashiri, J. Lee, N. G. Tsagarakis, and


D. G. Caldwell, “Development and control of a series elastic actuator
equipped with a semi active friction damper for human friendly robots,”
Robot. Autonom. Syst., vol. 62, no. 12, pp. 1827−1836, Dec. 2014.
Wei Yin is a Ph.D. candidate at Nankai University.
[27] H. Y. Yu, S. Huang, G. Chen, Y. P. Pan, and Z. Guo, “Human-robot He received the B.S. degree in intelligent science and
interaction control of rehabilitation robots with series elastic actuators,” techonology from Nankai University, Tianjin, China,
IEEE Trans. Robot., vol. 31, no. 5, pp. 1089−1100, Oct. 2015. in 2013. He is currently working toward the Ph.D.
[28] J. Lee, M. Laffranchi, N. Kashiri, N. G. Tsagarakis, and D. G. Caldwell, degree in control science and control engineering in
“Model-free force tracking control of piezoelectric actuators: application the Institute of Robotics and Automatic Information
to variable damping actuator,” in Proc. 2014 IEEE Int. Conf. Robotics System, Nankai University, Tianjin, China. His re-
and Automation, 2014, Hong Kong, China, pp. 2283−2289. search interests include motion control of robotics
and control of series elastic actuators.
[29] M. Garabini, A. Passaglia, F. Belo, P. Salaris, and A. Bicchi, “Optimality
principles in stiffness control: The VSA kick,” in Proc. 2012 IEEE
Int. Conf. Robotics and Automation, Saint Paul, MN, USA, 2012,
pp. 3341−3346.
[30] J. Leavitt, F. Jabbari, and J. E. Bobrow, “Optimal performance of
variable stiffness devices for structural control,” J. Dyn. Sys. Meas. Shuai Dong is a M.S. student at Nankai University.
Control, vol. 129, no. 2, pp. 171−177, Mar. 2007. He received the B.S. degree in electrical automation
from Hangzhou Dianzi University, Zhejiang, China,
[31] M. Wang, L. Sun, W. Yin, S. Dong, and J. T. Liu, “A novel sliding in 2014. He is currently working toward the M.S.
mode control for series elastic actuator torque tracking with an extended degree in control science and control engineering in
disturbance observer,” in Proc. 2015 IEEE Int. Conf. Robotics and the institute of robotics and automatic information
Biomimetics, Zhuhai, China, 2015, pp. 2407−2412. System, Nankai University, Tianjin, China. His re-
[32] B. Xian, D. M. Dawson, M. S. de Queiroz, and J. Chen, “A continuous search interests include servo control and AGVs.
asymptotic tracking control strategy for uncertain nonlinear systems,”
IEEE Trans. Automat. Contr., vol. 49, no. 7, pp. 1206−1211, Jul. 2004.
[33] P. M. Patre, W. MacKunis, M. Johnson, and W. E. Dixon, “Composite
adaptive control for Euler-Lagrange systems with additive disturbances,”
Automatica, vol. 46, no. 1, pp. 140−147, Jan. 2010.
[34] J. Y. Yao, Z. X. Jiao, and D. W. Ma, “RISE-based precision motion Jingtai Liu is a Professor at Nankai University.
control of DC motors with continuous friction compensation,” IEEE He received the B.E. and M.S. degree in automa-
Trans. Indust. Electron., vol. 61, no. 12, pp. 7067−7075, Dec. 2014. tion from Tianjin University, China in 1983 and
1986, and the Ph.D. degree in robotics from Nankai
[35] Y. Zhang, B. Xian, and S. G. Ma, “Continuous robust tracking control for
University, China in 1998. His research interests
magnetic levitation system with unidirectional input constraint,” IEEE
include robotics and automatic control, teleoperation
Trans. Indust. Electron., vol. 62, no. 9, pp. 5971−5980, Sep. 2015.
of robots in networks, wireless sensor network,
[36] S. Dong, L. Zhou, M. Wang, W. Yin, J. T. Liu, and L. Sun, “Variable microelectro-mechanical systems (MEMS).
stiffness estimation of a Series Elastic Actuator,” in Proc. 35th Chinese
Control Conf., 2016, Chengdu, China, pp. 2114−2119.

You might also like