Professional Documents
Culture Documents
High-Precision Motion Control of A Lower-Limb Wearable Robot For People With Walking Disability by Hybrid Filtered Disturbance Observer
High-Precision Motion Control of A Lower-Limb Wearable Robot For People With Walking Disability by Hybrid Filtered Disturbance Observer
Abstract: Control of lower-limb wearable robots has focused on high-precision. As motion references for assistance are
optimally designed to the users, exact realization of the intended ones is directly related to the effectiveness of assistance.
Precise walking assistance, however, is a challenging task since the system is involved with time-varying uncertainties
from humans. Since the disturbance observer (DOB) has shown exceptional performance in robustness, in this paper, an
algorithm named gait assistive control toward practical preciseness (GACPP) is proposed. The GACPP attacks severe
limitations in applying the DOB to waling assistance. As the dynamics of exoskeletal joints varies significantly during
walking as the load side alters from a free leg to the body. a hybrid identification loop is adopted. The joints are
modeled differently along the gait phases, and they form a new control framework that online reshape its characteristics.
In consideration of the digitization of controllers, the hybrid models are also allowance-filtered and nominalized. In this
paper, the GACPP is verified by experiments with the powered exoskeleton, WalkON Suit.
3ODQW
the user’s body and transfers the his/her lower limb freely
(a) (b)
in the air for the stance and swing phase, respectively.
The dynamic equations of the powered exoskeleton
3ODQW shown in Fig. 1 can be arranged as follows. In Fig.
1(c), the angular displacement is induced by the thigh
# ! link since the shank link is attached to the ground with
infinity-stiffness. Therefore, the load side dynamics is
expressed as follows:
! +%(
0 1
" ẋ = x + T + Gst (1)
0 − BJstst
)%( *
$%(
'%( x1 θ 0
where x = = ∈R , T=
⊭ ∈ R⊭ , Gst =
x2 θ̇ τk
Load ! 3ODQW "
0
∈ R⊭ , θ is the angular displacement, Jst
(c) (d) mst glst sin x1
Fig. 1. Gait phases during paraplegic walking. (a) Stance is the load inertia for the stance phase, Bst is the damping
phase. (b) Free body diagram of the stance phase. (c) coefficient for the stance phase, and g is the gravitational
Swing phase. (d) Free body diagram of the swing acceleration, respectively.
phase. During the swing phase shown in Fig. 1(d), on the
other hand, the shank link is dominantly actuated by τk
rather than the thigh link, because the thigh link is con-
2. DEVELOPMENT OF A DYNAMIC GAIT nected to the relatively heavier object, i.e., the human
MODEL body. Thus, the dynamic equation in the load side can
be obtained as follows:
2.1 Powered Exoskeletons for People with Walking
Disability
0 1
ẋ = sw x + T − Gsw (2)
In this paper. WalkON Suit [1] is utilized as an ex- 0 − BJsw
ample of the lower-limb wearable robots. Among the ex-
oskeletal joints, the knee joint is selected to be controlled 0
where Gsw = ∈ R⊭ , θ is the angular dis-
whose dynamic characteristics alters most violently dur- msw glsw sin x1
ing walking. Experiments for system identification and placement, Jsw is the load inertia for the swing phase, Bsw
verification of the proposed algorithm are carried out us- is the damping coefficient for the swing phase, respec-
ing the joint of WalkON Suit. tively.
1219
Authorized licensed use limited to: Sejong Univ. Downloaded on February 10,2022 at 00:24:36 UTC from IEEE Xplore. Restrictions apply.
! (") ! (")
(")
(a) (b)
Fig. 4. Allowance filtering. (a) serial switching, and (b)
parallel switching.
(a) (b)
Fig. 3. Pole-zero maps of the transfer functions in z
domain. (a) Open-loop transfer functions and (b) tained from (4) is expressed as G(z) = BAoo (z)(z) , and α0 is
compensated transfer functions with reasonable vari- the static gain. To curtail the effect of the sampling zero,
ations in model parameters. the control input is filtered by (5) and fedforward to the
output, generating the adjusted output θ̂ as shown in Fig.
4.
equations:
The simulational result of the zero dynamics adjust-
ment is represented in Fig. 3(b), by the pole-zero map
0 0 µ
Tcomp = · st (3) of the transfer functions from u to θ̂ . For simplicity, α0
T + Gst T + Gsw µsw
has been determined to be -1 here. The uncontrollable or
where Tcomp ∈ R⊭ is the compensated torque vector, unobservable states are eliminated by pole-zero cancella-
physically representing the joint torque to only overcome tion in advance. By the proposed compensation method,
the inertia and the damping of the system. µst and µsw the sampling zeros can be totally transferred to a constant
represent the information of which phase the joint torque value, which is allowable.
was measured, e.g., µst = 1 and µsw = 0 at the stance.
3.2 Hybrid Control Framework
Based on the adjusted plant models, a hybrid control
framework that repeatedly re-shape its form accompanied
3. GAIT ASSISTIVE CONTROL TOWARD
PRACTICAL PRECISENESS to the gait cycle of the user is developed. In Fig. 4, the
allowance filtering has been chosen as an example to ex-
3.1 Nominal Model Manipulation plain the basic concepts of the block switching. Ψα (z)
The gravity term is generally recognized as an ex- and Ψβ (z) are individually developed by (5) based on
ogenous disturbance and is completely rejected by the their nominal models (i.e., Gα (z) and Gβ (z)). There are
DOB. Therefore, each plant dynamics is represented as two possible ways for the block swithcing, which are se-
the second-order system which has one integrator, i.e., rial switching and parallel switching, as represented in
the most typical way to establish the plant model by des- Fig. 4. Commonly for both cases, the current gait phase
ignating the inertia and damping: (i.e., µk ) selects the output calculated from the current
nominal model. The main difference between Figs. 4(a)
1 and 4(b) is from the utilization of the memory. The se-
G(s) = . (4)
Js2 + Bs rial switching uses the switched output as the previous
The discretization of the plant models is characterized value to calculate the current output, while the paral-
by the ZOH equivalence. Fig. 3(a) show the pole-zero lel switching iterates its own loop for Ψα (z) and Ψβ (z)
maps after the ZOH equivalence, with reasonable model but only their seperate results are interchanged. That is,
parameters (which will be discussed in Section 4.). No- the switching process is either regarded as an integrated
tice Fig. 3(a) that the sampling zeros have emerged in the block (i.e., Ψ̄(z)) in Fig. 4(a), or as a coincident operation
discretized models due to the ZOH. As they are arranged of a couble of controllers in Fig. 4(b). Even if the model
on the highest frequency grid, the inverse form of the dis- parameters have changed during walking, the previous
cretized plant model may excite the unmodeled dynamics output should be corresponded to the previous model pa-
and make its response to chatter severely. Either the in- rameters. Therefore, the serial switching is selected in
crease of the load inertia or the decrease of the damping this paper to incorporate with the physical situation.
coefficient of the physical system worsens the situation. 3.3 Robustness Enhancement
This paper removes the sampling zero by directly de-
signing a filter named an allowance filter, which is The robustness of the control algorithm is enhanced
by the DOB. The unique point is that the DOB is ap-
Bo (0) plied to the adjusted output θ̂ , of which the filtered out-
Ψ(z) = α0 · , (5) put is feedforwardly added. The allowance filtering leads
Ao (z)
[G(z) + Ψ(z)]−1 not to have highly-vibrating modes. Al-
where the discretized open-loop transfer function ob- though the DOB is applied to θ̂ , in this paper, the per-
1220
Authorized licensed use limited to: Sejong Univ. Downloaded on February 10,2022 at 00:24:36 UTC from IEEE Xplore. Restrictions apply.
!(") !(", #) !
"# (s) $(s) Physical ! "# ($)
System
$ +
! + " + + '& ! (") 0 Physical
D/A "(,- .) Sampler '$* (&) ! System
- + + + Intention !" - + + + '&
recognition
Switch #$% (&) D/A , /)
"(-.
# + - + Sampler +
!" ($)
$% Error
Feedforward Feedback $%
! (") Switch Filtering
! (") Switch
!
!
! -
$
"# (!) + %(!)
! +
$
"# (!) + %(!) (!) Switch
- + !
(!) Switch
$
"* (!) + %(!)
!
$
"* (!) + %(!) Discretized Domain with Fast Sampling Disturbance Estimation
Disturbance Observer
Fig. 6. Block diagram of the GACPP.
Fig. 5. Robustness enhancement by disturbance ob- Table 1. Details of Wearer
server. Sex Male Age 46 SCI level T9
AIS A Weight (kg) 77 Height (m) 1.72
formance of the DOB is evaluated by the actual output 3.4.1 Feedforward filters
θ̃ , which is the physical joint angle compensated by the As the DOB can gaurantee the effectiveness of the per-
algorithm as, fect tracking control, the feedforward filter is designed as
follows:
θ̃ = Zu (z)uc + Zd (z)d (6)
Ff (z) = G∗ (z)GClosed
−1
(z) (12)
where G(z)C (z)
where GClosed (z) = 1+G(z)Cf b (z) . The inverse of the trans-
fb
G̃(z)[Gβ (z) + µk ∆G (z) + Ψ̄(z)] fer function is usually unrealizable, so G∗ (z) has been
Zu (z) = ,
[Gβ (z) + µk ∆G (z)][1 − Q(z)] + Ψ̄(z) + G̃(z)Q(z) introduced to make the filter realizable.
(7)
G̃(z)[Gβ (z) + µk ∆G (z)][1 − Q(z)] + Ψ̄(z) 3.4.2 Feedback controller
Zd (z) = . To fulfill the function of error-feedback, the PD control
[Gβ (z) + µk ∆G (z)][1 − Q(z)] + Ψ̄(z) + G̃(z)Q(z)
is introduced to the GACPP. The stability of the feedback
(8)
controller is guaranteed when the following
condition is
uc , d, ∆G (z), and G̃(z) represent the control input from
satisfied: ∀pi ∈ z | 1 + G(z)C f b (z) = 0 < 1 where pi
tracking controllers (i.e., C f b (s), Ff (s) to be discussed
represents the i-th pole of the closed loop transfer func-
in the next section), exogenous disturbance, model dis-
tion and C f b (z) represent the feedback controller.
crepancies between the discretized nominal models (i.e.,
Gα (z) − Gβ (z)), and actual model, respectively. Ψ̄(z) = Another consideration of the gain selection is the at-
µk Ψα (z) + (1 − µk )Ψβ (z), which is the serial switching tenuation of the switching effects. In this paper, the
shown in Fig. 4(a). That is, µk = 1 at the stance and gains for the PD control are remained identical even if
µk = 0 at the swing phase. the gait phase has changed to avoid the production of
abrupt uc . On the other hand, the filtered outputs should
In the certain frequency range that meets both condi- be developed approximately same at the instance of the
tions that are, β
block changing, i.e., Ffα (z) ≈ Ff (z) which are the feed-
forward filter blocks shown in Fig. 6. In fact, the gains
|Q(e jwT )| ≈ 1, |Ψ̄(e jwT )| ≪ 1, (9) of feedback controllers are also the control variables for
the feedforward filters. Not sacrificing the error reduction
the exogenous disturbance is fully rejected and the actual
function, therefore, the PD gains can be selected as,
plant is nominalized, i.e.,
|C f b (e jwT )| ≫ 1. (13)
Zu (z) ≈ Gα (z), or Zu (z) ≈ Gβ (z), (10)
and
Zd (z) ≈ 0. (11) 4. EXPERIMENTAL RESULTS
The disturbance not only contains the external forces but 4.1 Experimental Setup
also includes the model discrepancies, therefore, the ro- To verify the performance of the GACPP, the WalkON
bustness is enhanced by the DOB. Suit shown in Fig. 7 is utilized. The hip and knee joints of
the WalkON Suit are actuated by brushless torque motors
3.4 Tracking Controllers (MF0127020, Alliedmotion Co.) equipped with a set of
cycloidal gears (maximum joint torque: 115N·m). The
The control framework of the GACPP is shown in Fig. details of the participant is summarized in Table 1.
6. Feedforward filters and feedback controller are ap- To evaluate the performance of the GACPP, the fol-
pended to the algorithm with hybridity. lowing experiments had been conducted in this paper:
1221
Authorized licensed use limited to: Sejong Univ. Downloaded on February 10,2022 at 00:24:36 UTC from IEEE Xplore. Restrictions apply.
User display & controller
Wrist bands Table 2. Identified Physical Parameters from Human
Walking
Stance Swing
Units Model Parameters
Brushless torque motor Load side encoder kg · m2 , Mean 0.036548 0.0049783
Load
Cycloidal reducer kg · m2 , Max 0.037462 0.0069679
Inertia (J)
Motor side encoder kg · m2 , Min 0.035649 0.0036194
N · m · srad, Mean 76.587 4.9100
Crutchs Damping
Safety parts N · m · srad, Max 84.397 5.7227
Coefficients (B)
N · m · srad, Min 65.541 4.4496
Flat ground
0.03
Load inertia (kg m 2 )
0.025
0.015
0.01
0.005
0
0 20 40 60 80 100
Progress (%)
(b)
(a) Fig. 9. Experimental results of conventional DOB: Q-
filter bandwidth of 45 Hz. (a) Reference and joint
75 8
output. (b) Joint torque and estimated disturbance.
Stance
Swing 7.5
Damping coefficient for Stance
70 7
6.5
4.3 Performance Enhancement of the DOB-control
(N m s/rad)
(N m s/rad)
65
6
Swing Stance Swing Stance Swing Stance
60
5.5 To demonstrate the contributions of this paper, sev-
5
eral controllers were applied to the WalkON Suit: 1)
55 4.5
4
the conventional DOB, 2) the hybrid DOB-control with-
50
0 20 40 60 80
3.5
100
out allowance filtering, and 3) the GACPP. For all the
Progress (%) cases, the feedback controller was designed by, C f b (z) =
(b) −1
Fig. 8. Progress of parameter adaptation: (a) load inertia, K p + Kd 1−zT , where K p = 600, Kd = 0.6. Also, the cut-
and (b) damping coefficient. off frequency of the Q-filter was equally set to be 45 Hz,
and the duration of each gait phase was 1s at this section.
Fig. 9 shows the experimental results with the conven-
1. Identification of model parameters for both gait tional DOB. The excessive cut-off frequency of the Q-
phases. filter could not ensure the robustness; the result exhibited
2. Performance verification of the proposed methods. the unstable aspect. The estimated disturbance in Fig.
9(b) were severely vibrated so as the joint torque, while
4.2 Hybrid System Identification being saturated at the maximum joint torque.
First, the wearer had been assisted to walk with the To resolve this problem, the concept of the hybridity
feedback control algorithm in advance. Fig. 8 shows the has been adopted to the DOB. The inverse models as well
progress of the model parameter adaptation. The physical as the feedforward filters were continuously switched in-
parameters in (1) and (2) were determined by the human side the algorithm. In Fig. 10, the result of the feed-
factors as follows: mst = 70.5 kg, lst = 0.457 m, msw = forward filtering in the hybridity is represented. Note
11.0 kg, lsw = 0.237 m. that the discontinuity at the switching instances were con-
The result is shown in Fig. 8. Because of the arbitrary
disturbance from human (e.g., usage of crutch, upper
Switching
body slanting, etc.), the parameters did not finally con- instances
verge to a specific value (especially for the stance in Fig. Swing Stance Swing Stance Swing Stance
8(b)), however, it can be said that those variations of the
model parameters exist within a reasonable extent. The
detailed results are summarized in Table 2; mean, max-
imum and minimum model parameters obtained from a Fig. 10. Reference θd and filtered reference r in the hy-
total of 40 continous steps are provided. brid control framework.
1222
Authorized licensed use limited to: Sejong Univ. Downloaded on February 10,2022 at 00:24:36 UTC from IEEE Xplore. Restrictions apply.
even if the characteristics of the Q-filter was equal.
5. CONCLUSIONS
This paper introduced a model-based control frame-
(a) work for the lower-limb wearable robots assisting the
people with disabilities. To achieve both the high-
precision and the robust stability in gait assistance, this
paper firstly divided the dynamic model of the system
into the representative gait phases and incorporated them
in a hybrid control framework. Also, considering the im-
plementation process of the controller, a novel filtering
(b)
process and the regarding DOB-method were proposed.
Fig. 11. Experimental results of only hybrid DOB: Q- The experimental results verified the performance of the
filter bandwidth of 45 Hz without allowance filtering. proposed methods by various tests. It can be seen that
(a) Reference and joint output. (b) Joint torque and the GACPP is practically meaningful and superior com-
estimated disturbance. pared to the conventional methods, which shows the pos-
80
sibility of the disabled people being safely and effectively
Reference
assisted following the intended trajectories.
Joint angle (deg.)
Output
60
40
20
6. ACKNOWLEDGEMENT
0 1 2 3 4 5
Time (sec.)
This work was supported by the Technology Innova-
(a)
tion Program [or Industrial Strategic Technology Devel-
opment Program (20003914)] funded by the Ministry of
Trade, Industry and Energy (MOTIE, South Korea).
REFERENCES
(b)
[1] J. Choi, B. Na, P.-G. Jung, D.-w. Rha, and K. Kong,
Fig. 12. Experimental results of GACPP: Q-filter band- “Walkon suit: A medalist in the powered exoskeleton
width of 45 Hz with allowance filtering. (a) Refer- race of cybathlon 2016,” IEEE Robotics & Automa-
ence and joint output. (b) Joint torque and estimated tion Magazine, vol. 24, no. 4, pp. 75–86, 2017.
disturbance. [2] Ekso Bionics. [Online]. Available: http:
//eksobionics.com
[3] S. Wang, L. Wang, C. Meijneke, E. Van Asseldonk,
stantly ignorable. The experimental results of control are T. Hoellinger, G. Cheron, Y. Ivanenko, V. La Scaleia,
shown in Fig. 11. Even though the instability was re- F. Sylos-Labini, M. Molinari et al., “Design and con-
solved by the hybrid control, the tracking performance trol of the mindwalker exoskeleton,” IEEE transac-
was still not satisfied (RMS error : 1.6040). It is resulted tions on neural systems and rehabilitation engineer-
from both the joint torque and the estimated disturbance ing, vol. 23, no. 2, pp. 277–286, 2014.
in Fig. 11(b) that chattered at a considerably-high fre- [4] K. Suzuki, G. Mito, H. Kawamoto, Y. Hasegawa,
quency. and Y. Sankai, “Intention-based walking support for
The GACPP utilizes both the allowance filtering and paraplegia patients with robot suit hal,” Advanced
the hybrid control, as shown in Fig. 6. Ψα (z) and Ψβ (z) Robotics, vol. 21, no. 12, pp. 1441–1469, 2007.
were developed based on Gα (z) and Gβ (z), respectively. [5] J. N. Yun, J. Su, Y. I. Kim, and Y. C. Kim, “Robust
The experimental results of the GACPP in walking is disturbance observer for two-inertia system,” IEEE
plotted in Fig. 12, which shows the best performance Transactions on Industrial Electronics, vol. 60, no. 7,
among others (RMS error: 0.30886). The adjustment pp. 2700–2710, 2012.
of the sampling zero allowed the estimated disturbance [6] J. I. Yuz and G. C. Goodwin, Sampled-data models
not excited while the joint output better follows the refer- for linear and nonlinear systems. Springer, 2014.
ence input (RMS error decreased by 80.74%). Because of
the integrator inside the physical model at (4), the magni-
tude characteristics always decreases along the frequen-
cies. Therefore, the conditions in (9) are easily satisfied if
the Q-filter is designed appropriately. In the experiment
with GACPP, the precision was meaningfully improved
1223
Authorized licensed use limited to: Sejong Univ. Downloaded on February 10,2022 at 00:24:36 UTC from IEEE Xplore. Restrictions apply.