1. Introduction
Nowadays, for many industrial and medical applications, the five-link human biped robot (FLHBR) has become an interesting and significant topic for many researchers [
1,
2,
3,
4,
5]. The important research of FLHBR systems is to design and manufacture more efficient artificial limbs with good driving abilities for handicapped patients and implement devices to perform difficult tasks in hazardous environments or onerous reiterative works [
6,
7]. Investigations of dynamic modeling and robust control for FLHBR system have recently attracted increased attention due to their higher mobility than traditional wheeled robots. Although wheeled vehicles are very popular, they suffer from many limitations which destroy their efficiency. For instance, they can only reliably move in some special limited types of terrain. In contrast, FLHBR systems give great flexibility in selecting the type of the proceeded terrain [
6,
7]. The FLHBR system has many theoretical and practical limitations including nonlinear dynamics, inherent instability and robust control in a given time. Controlling the global stability of FLHBR systems during walking is a difficult issue. Several widely used effective control methods have been proposed in the literature to address the global stability, dynamic model and robust control of FLHBR systems such as the proportional-integral-derivative (PID) control [
8], the model predictive control [
3], the adaptive control [
5,
9] and the sliding mode control [
6,
10]. The PID control method requires to transform the original, highly nonlinear model of the FLHBR system into an empirically “linearized” model which inevitably limits the locomotion mobility. By assuming small body angular velocity, which is effective for certain FLHBR systems, the centroidal dynamics can be “linearized” and utilized in a model predictive control fashion that works only in areas near the equilibrium point [
3,
11]. Recently, researches on adaptive control have focused on FLHBR control tasks to solve real-life applications [
4]. However, the adaptive control is largely limited due to the complex updating rule. A sliding mode control with appealing robust performance is proposed to track pre-specified gait trajectories for the FLHBR system while climbing stairs [
6]. However, the inevitable chattering phenomenon limits the locomotion stability of the FLHBR system.
For the locomotion tracking control of the FLHBR system, both the disturbance rejection ability and the global stability performance need to be simultaneously achieved [
12], and then some effective methods have been widely applied such as the model predictive control [
3], the deep reinforcement learning [
4], and backstepping control [
13]. Nevertheless, the aforementioned controls applied the Jacobian linearization technique to obtain the linearized model of the nonlinear FLHBR system which is only effective in areas near the equilibrium point. To well address the severe limitation of FLHBR systems, many researches apply function approximators to solve it, such as the neural network technique [
4,
14] and the fuzzy logic technique [
15,
16]. The neural network technique for robust controlling FLHBR systems has outstanding advantages and features [
4]. However, it has the following inevitably impractical limitations: (1) the interconnected neural network rules are complex; (2) the neural network technique is a supervised learning technique and requires many sampling points; (3) the necessary input variable of the FLHBR system is built only by current states of neural network. The fuzzy logic technique is mainly limited by the fact that the fuzzy rules are constructed by the experience of many experts accumulated in the past [
16]. Motivated by the above analysis and investigation, the robust locomotion control of the FLHBR system is still a challenging issue for the disturbance rejection ability and global stability performance. In this paper, we first apply a feedback linearization technique to well address above limitations with multi-performances including the almost disturbance rejection performance, the global stability, adjustable convergence rate and convergence radius. Recently, the feedback linearization technique has attracted many researches such as the autonomous arm [
17], the swash mass helicopter [
18], the wheeled inverted pendulum mobile robot [
19], the bending soft pneumatic actuators [
20], the cascaded power electronic transformer [
21] and the grid-tied synchronverter [
22].
Practical industrial systems are always corrupted by different types of unknown disturbances, and one important issue in robust controller design is to attenuate their influence on the output terminal as much as possible, since it is difficult to realize exact disturbance decoupling. When “exact” disturbance decoupling performance fails, it is natural to investigate the almost disturbance decoupling performance, which is to design a robust control that attenuates the influence of the unknown disturbance on the output terminal up to an arbitrary degree. Stricter definition of almost disturbance decoupling performance with simultaneous absolute-value sense, integration-value sense and input-to-state stable sense had been exploited in [
23,
24,
25]. However, refs. [
23,
24] have shown the fact that some specific control systems cannot achieve the almost disturbance decoupling performance subject to one sufficient condition that the discriminant functions should possess a “complete” condition such as the following control system:
,
,
, where
and
denote the unknown disturbance, input and output, respectively. In contrast, this article applies the feedback linearization approach to address the almost disturbance decoupling performance for FLHBR systems. Finally, we perform a simulation by the traditional PID control in the simulation section to exploit the fact that the transient dynamics of the proposed feedback linearization approach such as the peak time, the rise time, the settling time and the maximum overshoot specifications is better than the traditional PID approach.
The main contributions of the proposed approach in this study are summarized as follows:
(1) The study first proposes the complete derivations of a mathematical model for highly nonlinear FLHBR systems.
(2) This article first gives the formulas of exponential convergent rate and convergent radius for the FLHBR system.
(3) The FLHBR system is addressed well by using the feedback linearization technique to take the place of traditional singular perturbation technique without the limitation that the discriminant function requires a complete condition [
23,
24].
(4) The exponential stability of FLHBR systems is guaranteed in this study without solving the troublesome Hamilton–Jacobi equation which is critical work for the traditional H-infinity approach [
26].
(5) The article proposes a one-controller design of FLHBR systems to improve the severe shortcomings of traditional function approximators such as the fuzzy control approach and neural network control approach without relying on the experience of many experts accumulated in the past and complex interconnected neural network rules, respectively.
(6) The proposed stability theorem of FLHBR systems in this article is global for whole state space and takes the place of the traditional Jacobian linearization technique that is only local for areas near the equilibrium point [
27].
(7) This article designs a powerful human–machine interface of robust controller design for FLHBR systems using Python and dynamically shows the convergent trajectory of the system states.
2. Complete Mathematical Model of the FLHBR System
Based on the FLHBR system considered in this study, the FLHBR kinematic model is completely derived via the Lagrange equation that mainly investigates the energy analysis. The schematic diagram of the FLHBR is shown in
Figure 1 and the Lagrange equation is written by
and
where
denotes the kinetic energy of the FLHBR system;
is the potential energy of the FLHBR system;
denotes the Lagrange function of the FLHBR system;
is the
i-joint torque;
denotes the angle of link1~link5;
is the velocity of link1~link5,
kg,
are the masses of link1~link5,
denote the masses of exoskeleton thighs,
denote the masses of legs,
denotes the mass of torso,
m,
m are the lengths of link1, 2, 4, 5,
m,
m,
m are the distances between the mass centers of link1, 2, 3, 4, 5 and those lower joint,
kg·m
2,
kg·m
2,
kg·m
2, are the moments of rotational inertias for link1, 2, 3, 4, 5 and
m/s
2 is the acceleration of gravity.
Define the input, output, state, noise and matched uncertainty variables of the FLHBR to be
,
,
,
,
,
,
,
,
,
,
,
,
,
,
. The complete derivations of mathematical dynamical model and the related definitions of variables
are sown in
Appendix A. Then the dynamic equation of the FLHBR system can be derived as
where
First, define the nominal system of the FLHBR system to be
with the well-defined relative degree [
28]
that meets
<i> the following Lie differential equation holds:
for
,
, where the symbol
L denotes the Lie differentiation operation [
28,
29].
<ii> the following Lie differentiation matrix possesses the nonsingular performance:
and the following function
is an involutive distribution [
30].
3. Robust Control Design of the FLHBR System
Since the FLHBR system has the well-defined relative degree property and involutive distribution performance, a differentiable, smooth and bijective function
defined by
is a smooth and bijective function that transforms the highly nonlinear FLHBR to be a linear subsystem [
30].
In (60)~(69), there are ten variables due to the relative degree vector of the nonlinear FLHBR system described by (3)~(8), then the FLHBR system is fully feedback linearizable. An important achievement was pioneered by [
30], namely, that under the assumption of the fully linearizable feedback, the function defined as
transforms the original FLHBR system into a linear subsystem as follows:
Since
then the transformed subsystem is written as
hence
To construct the desired feedback linearization controller
we apply the vector
and the virtual input [
30]
Then we can transform the original FLHBR system into the following model
From (76), (78) and (85), we obtain
We construct the feedback linearization controller by
with almost disturbing decoupling performance to be [
30]
where
is the desired tracking signal and
are elements of the Hurwitz matrix shown by
Based on a feedback linearization approach, we propose the robust controller with the pre-specified tracking signals
as follows:
For the convenience of the following discussions, let’s define some related parameters as
where the Lyapunov system matrix
is a Hurwitz matrix whose eigenvalues lie in the left half coordinate plane and one can use Matlab to obtain the adjoining Lyapunov system matrix
of the following Lyapunov equation [
31]:
and
To demonstrate further the complete control design of nonlinear FLHBR systems, let us make two definitions as
Definition 1. The nonlinear control system with the input , the state and the smooth function is called to have the input-to-state stable performance ifwhere , are -class function, -class function, respectively [32]. Definition 2. A nonlinear control system with the external disturbance input is called to have the almost disturbance decoupling property if
- (a)
The nonlinear control system possesses the input-to-state stable performance.
- (b)
The following two inequalities hold:andwhere denotes the initial state of the control system, is -class function, , are -class functions and [25,33].
It is worth mentioning that the aforementioned definition (hypothesis) of the almost disturbance decoupling property is more stringent in many ways when compared with the earlier definitions shown first for linear control engineering systems and then inherited for nonlinear control systems which are needed for closed-loop feedback systems:
(Case 1) input-to-state stable performance when the initial state of control system is zero;
(Case 2) globally asymptotical stability of the equilibrium point when the external disturbance input is set to be zero;
Moreover, the above definition of the almost disturbance decoupling property possesses three features as follows [
24]:
The first feature of the above definition is the demand of input-to-state stable performance. In fact, while for linear control systems the input-to-state stable performance is implied by (120), this is not met for nonlinear control systems. The second feature is the appearance of function r33 for (120). While for earlier definitions the function is set to be r33 (x) = x, in fact, this flexibility is required only for special cases including linear cases. The third feature lies in the input-to-state stable performance that needs the asymptotical stability for the equilibrium point corresponding to the tracking signal and the origin point. As we shall see, for linear control systems, once the stabilization problem is addressed, the tracking problem is solved, this is not so for nonlinear ones. Based on the more stringent definition of the almost disturbance decoupling property, the robustness of the proposed feedback linearization approach is stronger. Moreover, according to
, it is easy to obtain
and
Therefore, we can conclude the fact that the root mean square error can be implied by the almost disturbance decoupling condition (121).
From (106), (108) and (122), we obtain
Substituting (87) and (88) into (123) obtains
Then, we verify the fact that the feedback linearization control achieves the almost disturbance decoupling performance, and the globally exponential stability of the FLHBR system in
Appendix B. Therefore, the proposed feedback linearization control (89) will indeed drive the output state tracking errors of the FLHBR system (3)–(8), starting from pre-specified initial conditions, to the global ultimate attractor.
It is worth noting that we can extend the above overall design process to achieve two more general theorems for general nonlinear control systems with uncertainties and disturbances as follows:
i.e.,
where
,
,
,
,
are vectors of states, inputs, disturbance-adjoining terms, outputs, and disturbances, respectively, for the nonlinear system. We consider the relating vectors
,
and
to be smooth functions. The uncertain vector
is considered to be matched uncertainty as
,
Assumption 1. The following inequality holds:
where , . Define the nominal system of the nonlinear system to be
with the well-defined relative degree
that meets
<i> the following Lie differentiation equation holds:
for
,
, where
is the input (or output) number and the symbol
L denotes the Lie differentiation operation.
<ii> the following Lie differentiation matrix possesses the nonsingular performance:
and the following function
is an involutive distribution.
Based on the property that the nonlinear system has the well-defined relative degree and involutive distribution, the following mapping defined as
and
is a smooth and bijective function that transforms the highly nonlinear system to be a nonlinear
subsystem and a linear subsystem
, respectively.
Properly design the Lyapunov functions
and
for the nonlinear subsystem equation and linear subsystem equation, respectively, and then obtain the composite Lyapunov function
of the transformed system to be
and
Theorem 1. There exists a differentiable, smooth and bijective function for the transformed nonlinear subsystem and the linear subsystem such that the following inequalities hold:and the proposed robust control is constructed bywhere the identifying matrix is a positive definite matrix and the identifying parameter passes through the origin and meets the following condition Then the nonlinear system based on the proposed robust control possesses the almost disturbance decoupling property and the tracking errors are globally reduced by the condition
with the exponential convergent rate
and the exponential convergent radius
It is worth noting that if the nonlinear system is fully feedback linearizable [
33], i.e., the dimension of the nonlinear system is equal to the relative degree parameter, then the simplified version of Theorem 1 can be presented as Theorem 2.
Theorem 2. The almost decoupling disturbance and robust tracking problems of the nonlinear system can be well addressed via the proposed controller by changing the inequality with Moreover, the tracking errors of the nonlinear system is globally reduced with the exponentially convergent rate
where
and the exponentially convergent radius
FLHBRs have good mobility and can easily move in different road environments, including up and down slopes, regions containing obstacles or rough terrains. However, since almost all of them are high order, highly nonlinear control systems, their global stability and robust control approach are important issues. In this study, an effective algorithm and block diagram of robust tracking control design shown in
Figure 2 are summarized as follows, and its human–machine interface via the Python program is shown to design the robust control in
Section 4.
(Step 1) First calculate the relative degree according to the known outputs of the FLHBR system.
(Step 2) Use (57) to derive the differentiable, smooth and bijective transformation of the FLHBR system.
(Step 3) With the aid of Matlab, design matrices to be Hurwitz according to (88) (113) and obtain the positive definite matrix .
(Step 4) Apply (A90)~(A91) to design the Lyapunov function of the transformed subsystem.
(Step 5) Apply (A93) and (A95)~(A98) to design parameters such that the condition is satisfied.
(Step 6) Once all the above conditions are tested, we can directly design the controller via (89).
5. Comparisons to Traditional Approaches
We make some comparisons between the new feedback linearization approach and the traditional singular perturbation method that pioneered the almost disturbance decoupling issue [
23,
24] in this section. The impractical shortcoming of the traditional singular perturbation method requires to meet the sufficient condition that the system dynamics multiplied by the external disturbance should satisfy the annoying “structural triangle condition” for the almost disturbance decoupling issue. The pioneering work carried out by [
23,
24] points out the fact that the following nonlinear control system cannot well address the almost disturbance decoupling issue:
From (177) and (178), we can apply Lie differentiation to derive the following results:
,
,
,
and
Since
is not a complete distribution, the critical condition of [
23,
24] is not well addressed. In contrast, the following proposed feedback linearization control can well solve the almost disturbance decoupling issue:
The output state trajectory of the above investigated control system with the proposed feedback linearization control described by (180) is shown in
Figure 8. Based on the observation of
Figure 8, the proposed robust control can indeed drive the output state trajectory to track the desired signal
.
To show the superiority of the proposed feedback linearization control, we compare the convergence rate performance with traditional PID control [
34] shown by (181)
Next, we compare the proposed feedback linearization approach with the traditional PID control. In what follows, manual adjusting of the traditional PID control for the FLHBR system is shown. The manual adjusting of the related KP, KI, KD gains is executed by trial and error. We first set the related KP, KI, KD gains to be zero and then increase the proportional gain KP until the output of the loop is motivated. This is followed by the adjustment for the integral gain KI to optimize the output tracking error response. Finally, the differential gain KD is adjusted, together with the optimized KP, KI gains until a desired output tracking error response is achieved. Output tracking errors responses for pre-specified outputs x1 to x5 are shown in
Figure 9.
Comparing
Figure 9 with
Figure 3 proves the fact that the convergence rate with our proposed feedback linearization controller is better than the conventional PID control. From
Figure 3 and
Figure 9, we can summarize a numerical evaluation shown in
Table 2 which reports the quantitative comparison in terms of transient dynamics for the proposed approach and the PID approach. Observing the data shown in
Table 2 yields the fact that the transient dynamics of the proposed feedback linearization approach is better that the PID approach.