Model-based tracking control design, implementation of embedded digital
Model-based tracking control design, implementation of embedded digital
Mechatronics
journal homepage: www.elsevier.com/locate/mechatronics
A R T I C LE I N FO A B S T R A C T
Keywords: In this paper, the tracking control problem of a biomimetic exoskeleton powered by a pair of pneumatic artificial
Model-based control muscles is considered. The antagonistic configuration of the pair of pneumatic muscles, which is biologically
Trajectory tracking control inspired, enables safe and reliable actuation in applications of orthopaedic rehabilitation. However, during the
Pneumatic artificial muscles inflation-deflation process, the pneumatic muscles introduce nonlinearity and hysteresis which deteriorate the
Rehabilitation robotics
control performance. A model of the antagonistic artificial muscles is adopted to develop a computed-torque
control for feedforward compensation of the nonlinear dynamics of the actuated joint. A PID control action is
used in combination with the feedforward compensation to achieve fast and accurate tracking control perfor-
mance. The model, which possesses a reduced set of parameters as functions of the inflation/deflation phase,
enables efficient nonlinear compensation. The experimental tests on the biomechatronic device, compared with
other state-of-the-art approaches for controlling pneumatic artificial muscles, show better tracking performance
in terms of convergence rate and robustness, justifying the convenience of using the proposed control metho-
dology in the design of tracking controllers for exoskeletal biomechatronic devices.
1. Introduction Some control techniques have been developed to solve the problems
of regulation and trajectory tracking for PAMs-driven robots. Prior re-
The emerging field of soft robotics is currently covering novel ap- sults focus on variable structure control [8], gain scheduling [9],
plications in rehabilitation robotics, prosthetics and surgical robotics adaptive backstepping [10], sliding mode [11] and PID neural network
and, more in general, several safety-critical applications involving in- control [12]. The sliding mode control strategy recently proposed in
teractions between robots and human operators. The main require- [13] is aimed at the enhancement of the safety during collision with
ments for safe human-robot interactions [1] can be fulfilled through the obstacles. Therefore, the sliding mode tracking controller is com-
inherent (and adaptable) compliance of soft actuators. Moreover, the plemented by a joint compliance controller, which meets the safety
adaptation mechanisms of the compliance of soft robotic and bio- requirements during collision.
mechatronic devices can mimic the behaviour of the biological mus- Model-based compensation strategies are originally proposed in
culo-skeletal system [2,3]. [14,15], where the compensation of the hysteresis in the force char-
As an example of biomimetic and soft actuation, pneumatic artificial acteristics of pneumatic muscles is achieved on the basis of generalized
muscles (PAMs) have been employed in the realization of rehabilitation models of the hysteresis in the mechanical response of PAMs. A feed-
robots, wearable exoskeleton robots and energy-efficient walking hu- forward compensation is implemented into the feedback control
manoids (see [4–6]). More recently, pneumatic muscle actuation tech- schemes of linear positioning stages implementing backstepping [15]
nologies are developed towards the realization of miniaturized bio- and cascade control [14] strategies. More recently, in [16,17], the au-
mechatronic devices. For instance, the work [7] focuses on the thors show how the guaranteed-cost control approach can be effectively
characterization of pneumatic muscles for set-point regulation of the applied to the solution of a regulation problem for a PAMs-driven robot
motion of a biomechatronic finger. whose dynamics can be described through uncertain (bilinear and
Together with their advantages, PAMs offer some challenges in the quadratic) systems.
design and implementation of the tracking control, since the controller To foster the efficient implementation of model-based control stra-
has to handle the strong nonlinearity of the PAMs dynamics. tegies for PAMs-driven robots, lumped parameter models of the
☆
This paper was recommended for publication by Associate Editor Prof Kong Kyoungchul.
⁎
Corresponding author.
E-mail addresses: [email protected] (A. Merola), [email protected] (D. Colacino), [email protected] (C. Cosentino), [email protected] (F. Amato).
https://doi.org/10.1016/j.mechatronics.2018.04.006
Received 12 June 2017; Received in revised form 16 February 2018; Accepted 25 April 2018
0957-4158/ © 2018 Published by Elsevier Ltd.
A. Merola et al. Mechatronics 52 (2018) 70–77
71
A. Merola et al. Mechatronics 52 (2018) 70–77
Table 1
Model parameters.
Parameter Value
where p denotes the pressure at which the PAM is inflated and s is the
contraction length. The model parameters follow the constitutive laws
Fig. 2. CoRAnT performing a rehabilitation task on the patient. (a) Lateral f (p)= f0 + f1 p [N]
view. (b) Front view.
b0i + b1i p [N/m/s] inflation
b (p)= b0 + b1 p = ⎧
⎩ b0d + b1d p [N/m/s] deflation
⎨
k (p)= k 0 + k1 p [N/m]
The values of the parameters of the damping function b(p) vary de-
pending on the phase of inflation/deflation.
Concerning the values of the model parameters, we refer both to
Table 1 and to the identification procedure described in [18]. The va-
lues listed in Table 1 are taken from [13], where the model parameters
have been identified for the same FESTO fluidic muscles adopted in
CoRAnT. The parameters of the elastic and damping functions of the
pressure can be identified from the step response of the actuator at
constant pressure and subject to a step change of the applied load. The
contractile (active force) element function is determined by a step
change to the inflation pressure of the actuator under constant load.
The model of the actuated joint requires the moment of inertia of
CoRAnT. The estimated moment of inertia amounts to Il = 0.0023
kg m2. This value can be obtained from the CAD 3D model of CoRAnT
after specifying the materials of the parts of the model.
Fig. 3. Actuation scheme of CoRAnT. The torque of the actuated joint reads
τ = τb − τt = (ϕb − ϕt ) r , (1)
the robot and the patient, e.g., through the measurement of the torque
where τb and τt are the torques generated by each PAM, as in
opposed by the patient during the motion cycle. For instance, the pa-
tient’s participation to the rehabilitation task could be estimated τb= (fb − bb s˙b − kb sb) r (2a)
through the measured data.
The regulation of the pressure of the PAMs, involved in the trajec- τt = (ft − bt s˙t − kt st ) r . (2b)
tory control of the joint, is obtained through two proportional pressure
In (2), sb and st denote the contraction length of biceps and triceps,
regulators FESTO MPPE-3-1/8-6-010-B. The implementation of the
respectively. From the antagonistic configuration of Fig. 3, a positive
pressure regulation into the motion control system of the exoskeleton is
rotation is obtained through the active force generated by the inflation
discussed in detail in Section 4.
of the biceps, whereas the triceps deflates without active contribution
to motion. For a negative rotation, it is required that the triceps gen-
3. Derivation of the equations of motion including actuator erates the force driving the joint rotation, whereas the biceps is passive.
dynamics The total torque can be expressed in terms of the joint angle θ, using
the kinematic relations
Starting from the kinematic scheme of Fig. 3, the equations of mo-
π π
tion of CoRAnT are derived. sb = r ⎛θ + ⎞, st = r ⎛ − θ ⎞.
⎝ 6⎠ ⎝6 ⎠
Following the notation of Fig. 3, clockwise rotations are positive,
whereas the upright vectors ϕb and ϕt denote the forces exerted by bi- In a first stage of the actuation strategy, each PAM is inflated at the
ceps and triceps, respectively. In Fig. 3, the force vectors point upward initial positive pressure p0. Thereafter, the joint rotation is obtained
since each PAM generates its (actuation or resistance) force only in the through the antagonistic control of the pressure of the pair of PAMs. A
72
A. Merola et al. Mechatronics 52 (2018) 70–77
positive/negative rotation of the joint requires an increment/decrement approach of the computed-torque control (see [20], Ch. 6.6). The
of the pressure pb of the biceps and a decrement/increment of the control input can be computed in real time according to the feedfor-
pressure pt of the triceps. Therefore, the antagonistic actuation can be ward-feedback scheme, after measuring both the kinematic variables
formulated as and the model parameters of the actuated joint.
pb = p0 + Δp , pt = p0 − Δp , The tracking control system, following a time-varying reference
trajectory θd(t), requires the derivation of the tracking error dynamics
where p0 is the initial pressure and Δp is the pressure difference from p0 as a function of the error e : =θd − θ and its successive derivative
used as manipulated variable in the antagonistic pressure control. It is e˙: =θ˙d − θ˙ and e¨: =θ¨d − θ¨ .
useful to note that the antagonistic strategy simplifies the motion The nonlinear compensation is achieved through the control input
control, since only one control variable, the pressure difference Δp, is
Il θ¨d + αθ + βθ˙ + τg (θ) + v
used for the actuation of the joint through two PAMs. u= ,
Therefore, the dynamics of the biomechatronic joint is described as δ + σθ˙ (6)
where v is an auxiliary control signal to be designed in order to achieve
Il θ¨ + ζθ˙ + τg (θ) + d = τ , (3)
robust tracking performance. To this end, v is taken as a PID control
where Il denotes the link inertia, ζ is the viscous friction coefficient at action in the form
the joint, τg(θ) denotes the gravity torque, τ is the control input torque
and d represents the unknown external input disturbance which embeds
v = kP e + kV e˙ + kI ∫ edt.
some external perturbations, e.g., load variations or disturbance torque, Let us define the state vector as
other than modelling mismatches, unknown parametric uncertainties,
friction nonlinearities, etc. ⎡ ∫ edt ⎤
Since the PAMs actuating the joint are identical, the spring element x: =⎢ e ⎥,
⎣ e˙ ⎥
⎢ ⎦
parameters are taken as k 0b = k 0t = k 0 and k1b = k1t = k1. The pressure
difference Δp is the control input of the closed-loop system, i.e. u = Δp. then the state space representation of the closed loop system yields
After introducing in (3) the constitutive laws of the actuators, the
equation of motion of the joint, including actuator dynamics, reads x˙ = Ax + Bw,
where
Il θ¨ + (ζ + β ) θ˙ + αθ + τg (θ ) + d = (δ + σθ˙ ) u, (4)
with ⎛ 0 1 0 ⎞ ⎛0 ⎞
A=⎜ 0 0 1 , B = ⎜ 0 ⎟,
⎜−I −1 k −I −1 k −I −1 k ⎟⎟ ⎜ I −1⎟
α = 2r 2 (k 0 + k1 p0 ) (5a) ⎝ l I l P l V ⎠ ⎝l ⎠
β = r 2 [b0b + b0t + p0 (b1b + b1t )] (5b) and w defines the disturbance which embodies friction effects, model
uncertainties and unknown interaction torque.
π The nominal value of the inertia and the measured values of θ and θ̇
δ = 2rf1 − k1 r 2
3 (5c) are introduced in the control action (6). Moreover, the value of the
σ = r 2 (b1t − b1b). parameters α, β and δ are computed offline after the regulation of the
(5d)
initial pressure to the desired value p0; only the parameter σ, which
Given the initial pressure p0, all the parameters defined in (5) do not depends on the inflation/deflation phase, requires an online computa-
vary during the motion, except for the value of σ which depends on the tion.
phase of inflation/deflation. The PID controller parameters, as shown in Table 2, are tuned and
The parameter α can be associated to a stiffness coefficient of the verified experimentally for optimal results.
elastic term αθ arising from the spring element of the three-element The tracking controller is implemented on 8-bit AVR RISC-based
phenomenological model of the PAM, whereas β can be viewed as an microcontroller ATmega 328; the control signal and the measurements
equivalent viscous friction factor depending on both the initial pressure are processed at 50 Hz. An I2C bus interconnects all the digital com-
and damping effects of the actuator. The parameters δ and σ describe ponents of the embedded control system: microcontroller, optical en-
the variability of the generated torque through the damping and active coder and digital-analog converter (DAC).
force elements of the actuator model. The pressures of the PAMs are regulated through two proportional
pressure regulators in the range 0–6 bar. Two complementary control
4. Model-based tracking control and digital implementation signals are generated to drive the pressure regulators associated to the
pair of antagonistic muscles. One signal inflates/deflates the biceps and
A satisfactory trajectory-tracking control performance can be the other one deflates/inflates the triceps in order to produce positive/
achieved through the combined feedforward-feedback control scheme negative rotations of the joint. The control signals in the range 0–10 V,
of Fig. 4, which takes into account the nonlinearity introduced by the which correspond to the pressure outputs 0–6 bar, are obtained after
pneumatic actuators. A control law, which attains a compensation of conversion of the control signals via a dual channel 12-bit DAC
the nonlinear terms of the dynamics (4), is developed through the TLV5618 and through amplification by a programmable
73
A. Merola et al. Mechatronics 52 (2018) 70–77
74
A. Merola et al. Mechatronics 52 (2018) 70–77
Fig. 5. Tracking of sinusoidal trajectory with amplitude range of 20° (reference signal in blue line and measured angle in red dashed line). (a) Frequency of 0.5 Hz.
(b) Frequency of 1 Hz. (For interpretation of the references to colour in this figure legend, the reader is referred to the web version of this article.)
Fig. 6. Tracking error with (blue line) and without (red dashed line) compensation action. (For interpretation of the references to colour in this figure legend, the
reader is referred to the web version of this article.)
Both a model of the PAMs-actuated joint and a nonlinear control The comparison of the experimental results to the respective ones
strategy are provided that enable reasonably accurate compensation of obtained via other nonlinear control techniques for PAMs-based exos-
the nonlinear dynamics while keeping the computational burden low. keletons reveals that the improved control performance can be
The model-based control law, achieving a balance between control achieved in all the scenarios of robotic rehabilitation where fast and
precision and computational requirements, allows the efficient im- robust trajectory tracking is required.
plementation of the tracking control on embedded digital controller. Future works will be directed to the control of the impedance of the
The experimental tests on the rehabilitation exoskeleton, following the robot joint using the viscoelastic properties of the PAMs. Attention will
digital implementation and tuning of the controller on embedded also be devoted to reference trajectory generation, e.g., using profiles
control unit, have shown good tracking performance and robustness. taken from gait analysis data.
75
A. Merola et al. Mechatronics 52 (2018) 70–77
Fig. 7. Setpoint tracking error of flexion (θref = +15∘ ) and extension movements (θref = −15∘ ).
Fig. 8. Commanded pressure on the PAMs pair for (a) flexion (θref = +15∘ ) and (b) extension movements (θref = −15∘ ).
References [6] Vanderborght B, Verrelst B, Van Ham R, Van Damme M, Lefeber D, Duran BMY,
et al. Exploiting natural dynamics to reduce energy consumption by controlling the
compliance of soft actuators. Int J Rob Res 2006;25(4):343–58. http://dx.doi.org/
[1] Ham R, Sugar T, Vanderborght B, Hollander K, Lefeber D. Compliant actuator de- 10.1177/0278364906064566.
signs. Robot Autom Mag IEEE 2009;16(3):81–94. http://dx.doi.org/10.1109/MRA. [7] Oliver-Salazar M, Szwedowicz-Wasika D, Blanco-Ortega A, Aguilar-Acevedo F, Ruiz-
2009.933629. Gonzalez R. Characterization of pneumatic muscles and their use for the position
[2] Repperger DW, Phillips CA, Neidhard-Doll A, Reynolds DB. Power/energy metrics control of a mechatronic finger. Mechatronics 2017;42:25–40.
for controller evaluation of actuators similar to biological systems. Mechatronics [8] Repperger D, Johnson K, Philips C. A VSC position tracking system involving a large
2005;15:459–69. http://dx.doi.org/10.1016/j.mechatronics.2004.10.002. scale pneumatic muscle actuator. Proceedings of of 37th IEEE inter-
[3] Caldwell DG, Tsagarakis N, Medrano-Cerda GA. Biomimetic actuators: polymeric nationalconference on decision and control, Tampa, FL, USA. 1998.
pseudo muscular actuators and pneumatic muscle actuators for biological emula- [9] Repperger D, Johnson K, Philips C. Nonlinear feedback controller design of a
tion. Mechatronics 2000;10:499–530. http://dx.doi.org/10.1016/S0957-4158(99) pneumatic muscle actuator system. Proceedings of 1999 American control con-
00071-9. ference, San Diego, CA, USA. 1999.
[4] Noritsugu T, Tanaka T. Application of rubber artificial muscle manipulator as a [10] Carbonell P, Jiang Z, Repperger D. Nonlinear control of a pneumatic muscle ac-
rehabilitation robot. IEEE/ASME Trans Mechatron 2002;2(4):259–67. tuator: backstepping vs. sliding-mode. Proceedings of of the 2001 IEEE inter-
[5] Xing K., Xu Q., He J., Wang Y., Liu Z., Huang X.. A wearable device for repetitive nationalconference on control applications, Mexico City, Mexico. 2001.
hand therapy. In: Proceedings of 2nd IEEE RAS-EMBS international conference on [11] Lilly J, Quesada P. A two-input sliding-mode controller for a planar arm actuated by
biomedical robotics and biomechatronics, Scottsdale, AZ, USA; 2008. four pneumatic muscle groups. IEEE Trans Neural Syst Rehabil Eng
76
A. Merola et al. Mechatronics 52 (2018) 70–77
77