You are on page 1of 6

Design and Robust Control of a 2 DOFs Lower

Limb Exoskeleton
Mohamed Ghezal, Mohamed Guiatni, Ismail Boussioud, Cherif Sofiane Renane
Complex Systems Control & Simulators Laboratory
Ecole Militaire Polytechnique
Algiers, Algeria

Abstract—For the past few decades, robotic exoskeletons have A lower limb exoskeleton is a wearable robot that physically
been the subject of extensive research in research laboratories. assists disabled people to regain their normal daily activity
The level of performance and reliability of these systems has such as walking, standing up, sitting or climbing stairs.
steadily increased. Today, these applications involve neuromotor
rehabilitation and, more marginally, support for patients suf- A state-of-the-art recent and a survey and on lower limb
fering from motor impairments. In this context, we designed exoskeletons for different applications is compiled in [5] in
and built a motorized exoskeleton with two degrees of freedom which more than 80 references and 46 devices have been
for the functional support of the lower limbs. The design was compared, in a holistic manner, in terms of end-users and also
developed taking into account the different constraints related to through different parameters such as cost, safety, number of
the anatomy of the human being lower limb and the kinematic-
static compatibility and the transparency of the structure. Elastic degrees of freedom (DOF), control, sensors, materials, joint
actuators, which combine deformable elements and conventional mechanisms and battery details. The majority of the presented
DC motors have been produced and associated with the me- devices are achieved and are commercialized. Thus, their
chanical structure. The electronic part was also developed to usefulness in the real life is actually is limited due to some
instrument and control the joints of the exoskeleton. After the social and technical issues. Among the technical limitations
modeling, we have synthesized and implemented several control
approaches, namely PID and Twisting second order sliding mode. we have the complex sensing and actuation technology, weight
The results obtained showed the capacity of the exoskeleton to constraints of the structure, the slow response of the exoskele-
perform walking cycles and its robustness with regard to external tons dynamic compared to humans, the energy autonomy when
disturbances. used outdoors and comfort issues for wearability. The social
Index Terms—Lower limb exoskeleton, Rotary Series Elastic issues concern mainly the hesitation against the use of new
actuator, Robust control, Mechatronics design, Motion control,
Twisting Algorithm.
assistive technology and the high costs and poor human-
exoskeleton interactivity [6]. This statement shows that there
is still need for efficiency improvement and cost reduction of
I. I NTRODUCTION these devices in order to make this technology accessible.
In applications where human is interacting with robots,
Aging of populations, weakness of elderly people, stroke special consideration must be respected such as the user safety,
and locomotion system diseases make necessary the devel- the compliance of the robot joints, energy saving and the
opment of wearable robots to improve the quality of life of impedance of the actuators.
people. This work aims to propose a new exoskeleton for the lower
An exoskeleton is a wearable robot that complements or limb rehabilitation which mirrors the skeletal structure of pa-
replaces a human body limb function [1]. Wearable robots can tients lower limb. The use of exoskeleton-based rehabilitation
be classified, according to the task they fulfill in coordination allows for independent and concurrent control of particular
with human limbs, into three classes [1] : movement of patients lower limb (fig. 1) in the three joints
• Amplification exoskeletons : amplification is meant to (hip, knee and ankle). In order to avoid patient injury, it will
give a human with low physical characteristics, abilities be necessary to take care in our device in adjusting lengths of
that he doesn’t have without the exoskeleton. Many segments of the exoskeleton to the lengths of the segments of
amplification exoskeletons have already been brought to the patient’s limb.
an end purchased such as the BLEEX [2] and the HAL In this paper, we have designed a 2 DOFs lower limb
[3]. exoskeleton actuated using compliant series elastic actuator.
• Orthotic exoskeletons : these are mechatronic devices A control scheme based on dynamic modeling and PID
used in the stabilization, restoration and reenforcement controller and a robust second order sliding mode controller
of human limb motion for people with reduced mobility are developed and implemented. In section II, an overview of
[4]. the mechanical design of the exoskeleton and the compliant
• Prosthetic exoskeletons : these devices are used to replace elastic actuator is given. Section III, IV and V describes the
the whole human limb of amputees to restore the motion modeling, identification and control respectively. The exper-
dynamics using inertial or electromyographic sensors. imental results are presented and discussed in section VI.

978-1-7281-0112-5/18/$31.00 ©2018 IEEE


Finally, in section VII, we give a conclusion about the present • The exoskeleton must have an ergonomic structure and
work results. its actuators must be compliant.
• since the security of the wearer is very important in
the design of the exoskeleton, hardware and software
constraints will be implemented.
The selection of actuators, torque amplification and move-
ment transmission mechanism must take into account a trade-
offs between the required power, weight and volume. We
have used the MotionWorks plug-in of Solidworks in order
to calculate the required performances of the actuators.

B. Design of the elastic actuator


Elastic actuators are used in the exoskeleton design for their
compliance. They consist of motors combined with springs.
Fig. 1. Lower limb joints description. The selection of electric motors among other actuators is based
on the facility of control and maintenance. A torsion spring
is integrated between the motor and the transmission chain.
II. D ESIGN OF THE EXOSKELETON It is intended to store the force applied by human joint and
A. Exoskeleton mechanical structure diminish the transmitted torque to the actuator. Table I gives
the main characteristics of the torsional spring [7].
The designed exoskeleton is intended to the functional A rotary series elastic actuator (RSEA) [8] offers a mechan-
assistance of lower limbs. Its motion is simplified to be only ical protection against clash thanks to the elastic element in
in the sagittal plane. Thus, the ball joints are replaced by series between the motor and the structure of the actuator. By
cylindrical joints. The adopted structure ad the Computer measuring the deflection of the spring, it is possible to deter-
Aided Design (CAD) model of the designed exoskeleton is mine the actuator’s torque. Figure 3 represents thekinematic
shown in Fig 2. scheme of the designed elastic actuator.
The design of the actuator and the definition of its required
specification is based on human joint properties. In [7], a study
was carried out to find the relationship between the torque
of the knee joint and the angular speed produced during a
step of normal gait. We consider a 70 kg body weight male
subject which need a 80 Watts power to make the knee joint
movement [9]. Maxon RE40 brushed DC motors are selected.
These actuators are suitable for this kind of devices since they
have a low friction and low inertia,
In our design, light materials were used in order to minimize
the weight and the stiffness of the linkages and stainless steel
ball bearings were used in order to overcome joint backlash
and friction (see fig. 4).
TABLE I
C HARACTERISTICS OF THE TORSIONAL SPRING .

Characteristics Values
Max deflection ±5.24 rad. (±300 deg.)
Fig. 2. CAD model of the exoskeleton Max torque ±1.67 Nm.
Mean diameter 18 mm.
Wire diameter 1.50 mm.
Many constraints are taken into account in the design of the Number of turns 9
exoskeleton: Spring constant 0.30 Nm/rad.
• The weight/power ratio must be optimized in order to
make a light weight exoskeleton which guarantees a
sufficient assistance. III. E XOSKELETON M ODELING
• the structure of the exoskeleton must be made of a
material that resists to different applied forces. A. Kinematic model of the exoskeleton
• Friction, interaction between partsand inertia must be The kinematic model describes the relationship between
minimized to improve the transparency of the exoskele- the spatial and articular coordinates. The kinematics of the
ton. designed exoskeleton is described in fig 5.
TABLE II
T HE E XOSKELETON MDH PARAMETERS .

j δ αj dj θj rj
1 0 0 0 θ1 0
2 0 0 l1 θ2 0
E / 0 l2 0 0

⎛ ⎞
C12 −S12 0 L1 C1 + L2 C12
Fig. 3. Kinematic scheme of the designed elastic actuator. ⎜ S12 C12 0 L1 S1 + L2 S12 ⎟
0
TE = ⎜
⎝ 0


0 1 0
0 0 0 1
with : S1 = sin(θ1 ), C1 = cos(θ1 ), C12 = cos(θ1 + θ2 ),
S12 = sin(θ1 + θ2 )
Finally, the generalized coordinates [Px Py ] are given as
follows :

Px = L1 C1 + L2 C12
(1)
Py = L1 S1 + L2 S12

B. Inverse Kinematics of the Exoskeleton


Fig. 4. Designed elastic actuator.
The inverse kinematic model gives the joint angles vector
from the spatial coordinate. It consists of solving equation (1)
The direct kinematic model is obtained using the modified to find θ1 and θ2 . Multiple solutions can be found. In the
Denavit-Hardenberg (MDH) parameters’ method [10] and the present case, the solution is as follows:
transformation matrix between frame Ri−1 (xi−1 , yi−1 , zi−1 )
and frame Ri (xi , yi , zi ), i.e. ⎧ √ 
⎛ ⎞ ⎪
⎪ −B ± B 2 + A2 − C 2

⎨ θ1 = arctan2
cosθi −sinθi 0 di C −A
⎜cosαi sinθi cosαi cosθi −sinαi −ri sinαi ⎟   (2)
i−1
Ti = ⎜ ⎟ ⎪
⎪ Py − l 1 S 1 P x − l 1 C 1
⎝sinαi sinθi sinαi cosθi cosαi ri cosαi ⎠ ⎪
⎩ θ2 = −θ1 + arctan2 ,
0 0 0 1 l2 l2

with : with : A = 2l1 Py , B = 2l1 Px , C = l22 − l12 − Px2 − Py2


αi : angle between zi−1 and zi around xi−1 .
di : distance between zi−1 and zi along xi−1 . C. Dynamic Model of the Exoskeleton
θi : angle between xi−1 and xi around zi . In order to study the behavior of the exoskeleton, it is neces-
ri : distance between xi−1 and xi along zi . sary to establish its dynamic model. It consists of mathematical
The kinematic description of the exoskeleton, assumed to equations combining positions, velocities and accelerations to
be a two degrees of freedom (2 dof) open chain serial robot, determine the torques applied by the actuators to generate the
is given in Fig.5. The MDH parameters are given in Table II: motion. Several methods are used to calculate the dynamic
The total transformation matrix is : model but the Lagrange equations method is more suited to
describe dynamic model of open chain serial robots [10].
The Lagrange equation is :
 
d ∂L ∂L
Γi = − (3)
dt ∂ θ̇i ∂θi

with θi and Γi are the ith joint angle and torque respectively.
L is the Lagrangian function :

L = Ke − K p (4)

where Ke and Kp are the kinetic and potential energies of


the whole system (human limb + exoskeleton). Ke and Kp
Fig. 5. Kinematic model of the exoskeleton. can be calculated using the following equations :
 
• G
m1 = −  m21 + m2 + k1 mcui + mjam gl1 s1 −
   2 +m
1

1 2 1 1 2 1 jam k2 gl2 s12 


Ke = l1 m1 + m2 l2 + l12 + l1 l2 cos θ2 + msh • G2 = − m21 + mjam k2 gl2 s12
8 4 4 2
2  1 1 IV. I NSTRUMENTATION AND M ODEL I DENTIFICATION
l1 + l22 k22 + 2l1 l2 k2 cos θ2 + k12 l12 mth + (I1 + I2 + Ish
 2 2 A. Instrumentation and Control Electronics
 
1 1   1
+Ith ) θ̇1 + m2 l2 + msh l1 + l2 k2 + (I1 + Ish ) θ̇22
2 2 2 2 2 Two encoders from Maxon type HEDS 5540 are used
8 2 2 for each actuator. These encoders provide 500 pulsations
  
1 1 2 1   per revolution. Thus, the position measurement resolution is
+ l + l1 l2 cos θ2 m2 + msh l22 k22 + 2l1 l2 k2 cos θ2 computed by taking into account, the reduction ratio. In order
2 2 2 2
  to estimate the actuator’s torque using the torque constant of
the actuators, current sensors are also integrated (type LTS
+ (I2 + Ish ) θ̇1 θ̇2 (5)
15-NP).
We have used a low cost real-time control and measurement
m  board (Arduino Mega Control Board). OPA541 power ampli-
1
Kp = + m2 + k1 mth + msh gl1 cos θ1 fiers from Burr-Brown are used to design the power stages
2 m 
1 which may provide a current about 10 for RE40 motors (Fig.
+ + k2 msh gl2 cos (θ1 + θ2 ) (6)
2 6).
with : m1 , m2 , l1 , l2 are the mass and length of thigh
and shank segments of the exoskeleton respectively. mth , msh
: are the mass of thigh and shank of human limb. k1 , k2
are constants that indicate the position the center of mass
of thigh and shank segments respectively. I1 , I2 , Ith , Ish
are the moments of inertia of thigh and shank segments of
the exoskeleton and human limb respectively. g is the gravity
acceleration.
Finally, the dynamic model can be written as follows :

Γ = H(θ)θ̈ + B(θ, θ̇) + C(θ)θ̇2 + G(θ) + F (θ) (7)


Fig. 6. Instrumentation and control electronics
with : Γ : torque vector, H : inertia matrix, B : Coriolis
matrix, C : centrifugal coefficients matrix, G : gravity vector,
F : external forces and friction vector. They are computed as
B. Model identification
follows:
  The dynamic model parameters have been identified using
H11 H12 least square method. However, human lower limb parameters
H= (8)
H21 H22 are calculated using results in [12] and [13]. The dynamic
1 2 1
1 2 2
 model is assumed to be linear with respect to the parameters,
• H11 =
 8 l1 m1 + 4 m2 4l2 + l1 + l1 l2 cos2 +
1 2 2 2
2 mjam l1 + l2 k2 + 2l1 l2 k2 cos2 + 12 k12 l12 mcui + it can be written as follows:
1
2 (I1 + I2 + Icui + Ijam )
1 2 1 2 2 2 1 Γ = W (θ, θ̇, θ̈) · X + ρ
• H22 = 8 m2 l2 + 2 mjam l1 + l2 k2 + 2 (I2 + Ijam ) (12)
1 2 1
• H12 = H21 = 2 l2 + l1 l2 cos2 2 m2 +
2 2 
1 where Γ is the measured torque vector, X is the model
2 mjam l2 k2 + 2l1 l2 k2 cos2 + (I2 + Ijam )
  parameters to be identified, W is the observation matrix, ρ
B11 0 the measurement error vector. X can be estimated using least
B= (9)
0 0 square method by :
1 
• B112 = 2 m2 + mjam k2 l1 l2 s2
  X̂ = argX min  ρ = W + Γ (13)
0 C12
C= (10)
C21 0 with :
1 
• C12 = − 2 m2 + mjam k2 l1 l2 s2
1 
1
• C21 = 4 m2 + 2 mjam k2 l1 l2 s2 W + = (W T W )−1 W T (14)
 
G1 For a model given by equation (15), the identified parame-
G= (11)
G2 ters are shown in Table III.
B. Twisting Algorithm Control
In order to achieve finite time stabilization of the state
Γ = a1 θ̈ + a2 θ̇θ + a3 θ̇ + a4 θ + a5 θ cos θ when exoskeleton in the case of external disturbance, we have
+ a6 θ̇ cos θ + a7 sin θ + a8 cos θ (15) designed a simplified 2nd order sliding mode (SOSM) control
namely the Twisting Algorithm proposed by Levant [14].
This controller is known to be robust against external
TABLE III disturbances and to be able to remove the chattering problem.
DYNAMIC MODEL IDENTIFIED PARAMETERS
The controlled system will achieve finite time stabilization and
a1 a2 a3 a4 the state will remain bounded around origin.
4.48 × 10−4 −0.021 −3.224 5.195 The SOSM Twisting algorithm is given as follows. Consider
a5 a6 a7 a8
5.002 2.512 −10.531 −2.622
a class of uncertain system given by:

Figure 7 shows the validation result obtained for the torque ẋ(1) = x(2) (17)
model. We observe that the model response is close to the ẋ(2) = ϕ(x, t) + γ(x, t)u(t) (18)
actual response. Figure 8 shows the validation result obtained s(t, x) = x(1) (19)
for the position model. A very interesting is obtained since
we observe that the model and the actual responses are very where x(t) represents the state variable, ϕ(x, t) and γ(x, t)
close. represent smooth uncertainty items, u(t) represents the control
input, and s(t, x) represents the defined sliding surface. It is
assumed that: |ϕ(x, t)|  C and 0<Km  γ  KM .
where C, Km , and KM are positive constants. The control
algorithm is then defined as follows:

uT = −r1 sgn(s) − r2 sgn(ṡ) (20)


Consequeltly, in order to the reach finite-time convergence,
sufficient conditions are:
Fig. 7. Torque model validation. (r1 + r2 )Km − C > (r1 − r2 )KM − C, (r1 − r2 )Km >C.
(21)
C. Results and Discussion
The results shown in Fig. 9 and Fig. 10 are obtained for
the following set of gain parameters : Kp = 0.7, Ki = 0.35,
Kd = 0.01. Reference curve of Fig.9 uses the CGA (Clinical
Gait Analysis) data available in the literature [15]. The results
show a good reference tracking with an error less than 0.85
deg (RM S). The rise time is approximately 0.5 s which
is relatively acceptable for such applications. In terms of
Fig. 8. Position model validation.
robustness, a disturbance rejection test shows that the PID
controller is sensitive to external distubances.
Figures 11 and 12 present the results of the implementa-
tion of the twisting algorithm control technique for KM =
V. M OTION C ONTROL
3.8, Km = 1.5, λ = 4. These results show excellent tracking
A. PID Controller Implementation performances which overperform those obtained using the
PID controller. Figure 13 presents the result of the controller
A classical control scheme based on PID (Proportional,
robustness evaluation. Form this figure, we can observe that
Integral, Derivative) controller is used on the designed ex-
the position remains stable even in the presence of external
oskeleton actuator. this type of controller is widely chosen in
disturbance (an external applied force).
industrial processes because of its implementation ease and its
good performance. The control law is obtained from the error VI. C ONCLUSION
between the reference and the measured signal as : For assistance purposes, an exoskeleton equipped with ro-
ki
tary series elastic actuators has been designed and built. The
u(p) = (kp + + kd p)e(p) (16) diffent models of this later have been also derived considering
p
the Exoskeleton–Human coupling. The Twisting Algorithm
u(p) is the control law, kp , ki , kd are the PID parameters. has been implemented experimentally and successfuly in order
to control the position of the knee joint. The effectiveness of
controller has been verified by applying external disturbances.
The structure of the exoskeleton as well as the actuator are to
be improved in our future works. More improvements to the
control scheme taking into account the targeted application
conditions will be done.
R EFERENCES
[1] J. L. Pons, Wearable Robots: Biomechatronic Exoskeletons. John Wiley
  & Sons, Ltd, 2008.
dŝŵĞ;ƐͿ
[2] H. Kazerooni, J.-L. Racine, L. Huang, and R. Steger, “On the control of
the berkeley lower extremity exoskeleton (bleex),” in Robotics and au-
tomation, 2005. ICRA 2005. Proceedings of the 2005 IEEE international
conference on, pp. 4353–4360, IEEE, 2005.
[3] Y. Sankai, “Hal: Hybrid assistive limb based on cybernics,” in Robotics
Research, pp. 25–34, Springer, 2010.
Fig. 9. Gait cycle tracking of knee joint using PID controller. [4] S. Mefoued, S. Mohammed, Y. Amirat, and G. Fried, “Sit-to-stand move-
ment assistance using an actuated knee joint orthosis,” in Biomedical
Robotics and Biomechatronics (BioRob), 2012 4th IEEE RAS & EMBS
International Conference on, pp. 1753–1758, IEEE, 2012.
[5] B. S. Rupal, S. Rafique, A. Singla, E. Singla, M. Isaksson, and G. S.
Virk, “Lower-limb exoskeletons: Research trends and regulatory guide-
lines in medical and non-medical applications,” International Journal of
Advanced Robotic Systems, vol. 14, no. 6, pp. 1–27, 2017.
[6] B. Chen, H. Ma, L.-Y. Qin, F. Gao, K.-M. Chan, S.-W. Law, L. Qin, and
W.-H. Liao, “Recent developments and challenges of lower extremity
exoskeletons,” Journal of Orthopaedic Translation, vol. 5, pp. 26–37,
2016.
[7] E. Baek, S.-k. Song, S. Oh, S. Mohammed, D. Jeon, and K. Kong,
“A motion phase-based hybrid assistive controller for lower limb ex-
Fig. 10. Tracking error.
oskeletons,” in Advanced Motion Control (AMC), 2014 IEEE 13th
International Workshop on, pp. 197–202, IEEE, 2014.
[8] K. Kong, J. Bae, and M. Tomizuka, “A compact rotary series elastic
actuator for human assistive systems,” IEEE/ASME transactions on
mechatronics, vol. 17, no. 2, pp. 288–297, 2012.
[9] J. Bae, K. Kong, and M. Tomizuka, “Control algorithms for prevention of
impacts in rehabilitation systems,” in Advanced Intelligent Mechatronics
(AIM), 2011 IEEE/ASME International Conference on, pp. 128–133,
IEEE, 2011.
[10] W. Khalil and E. Dombre, Modeling, identification and control of robots.
Butterworth-Heinemann, 2004.
[11] W. Zhang, M. Tomizuka, and J. Bae, “Time series prediction of knee
joint movement and its application to a network-based rehabilitation
Fig. 11. Gait cycle tracking of knee joint using SOSM-TA controller. system,” in American Control Conference (ACC), 2014, pp. 4810–4815,
IEEE, 2014.
[12] D. A. Winter, Biomechanics and motor control of human movement.
John Wiley & Sons, 2009.
[13] V. Zatsiorsky, “The mass and inertia characteristics of the main segment
of human body,” Biomechanics, pp. 1152–1159, 1983.
[14] A. Levant, “Sliding order and sliding accuracy in sliding mode control,”
International journal of control, vol. 58, no. 6, pp. 1247–1263, 1993.
[15] R. Baker, “Pelvic angles: a mathematically rigorous definition which is
consistent with a conventional clinical understanding of the terms,” Gait
& posture, vol. 13, no. 1, pp. 1–6, 2001.

Fig. 12. Tracking error using SOSM-TA controller.

Fig. 13. Controller Robusteness test.

You might also like