Next Article in Journal
A Semi-Empirical Model for Sound Absorption by Perforated Plate Covered Open Cell Foam and Improvements from Optimising the Perforated Plate Parameters
Next Article in Special Issue
Model-Assisted Online Optimization of Gain-Scheduled PID Control Using NSGA-II Iterative Genetic Algorithm
Previous Article in Journal
Hydroxyapatite Growth on Activated Carbon Surface for Methylene Blue Adsorption: Effect of Oxidation Time and CaSiO3 Addition on Hydrothermal Incubation
Previous Article in Special Issue
Hybrid Adaptive Dynamic Inverse Compensation for Hypersonic Vehicles with Inertia Uncertainty and Disturbance
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Robust Feedback Linearization Control Design for Five-Link Human Biped Robot with Multi-Performances

1
Department of Electrical Engineering, National Yunlin University of Science and Technology, 123 University Road, Section 3, Douliou 64002, Taiwan
2
Graduate School of Engineering Science and Technology, National Yunlin University of Science and Technology, 123 University Road, Section 3, Douliou 64002, Taiwan
3
Department of Electrical Engineering, National Chiayi University, 300 Syuefu Road, Chiayi City 60004, Taiwan
*
Author to whom correspondence should be addressed.
Appl. Sci. 2023, 13(1), 76; https://doi.org/10.3390/app13010076
Submission received: 22 November 2022 / Revised: 16 December 2022 / Accepted: 19 December 2022 / Published: 21 December 2022
(This article belongs to the Special Issue Research and Application of Intelligent Control Algorithm)

Abstract

:
The study first proposes the difficult nonlinear convergent radius and convergent rate formulas and the complete derivations of a mathematical model for the nonlinear five-link human biped robot (FLHBR) system which has been a challenge for engineers in recent decades. The proposed theorem simultaneously has very distinctive superior advantages including the stringent almost disturbance decoupling feature that addresses the major deficiencies of the traditional singular perturbation approach without annoying “complete” conditions for the discriminant function and the global exponential stability feature without solving the impractical Hamilton–Jacobi equation for the traditional H-infinity technique. This article applies the feedback linearization technique to globally stabilize the FLHBR system that greatly improved those shortcomings of nonlinear function approximator and make the effective working range be global for whole state space, whereas the traditional Jacobian linearization technique is valid only for areas near the equilibrium point. In order to make some comparisons with traditional approaches, first example of the representative ones, that cannot be addressed well for the pioneer paper, is shown to demonstrate the fact that the effectiveness of the proposed main theorem is better than the traditional singular perturbation technique. Finally, we execute a second simulation example to compare the proposed approach with the traditional PID approach. The simulation results show that the transient behaviors of the proposed approach including the peak time, the rise time, the settling time and the maximum overshoot specifications are better than the traditional PID approach.

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: x ˙ s e _ 1 ( t ) = tan 1 ( x s e _ 2 ) + Ω n ( t ) , x ˙ s e _ 2 ( t ) = u i p , y o p _ 1 = x s e _ 1 u o p _ 1 , where Ω n ,   u i p and u o p _ 1 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
L a = E k i n e t i c E p o t e n t i a l
and
τ i = d d t ( L a θ ˙ i ) ( L a θ i ) , i = 1 , 2 , 3 , 4 , 5
where E k i n e t i c denotes the kinetic energy of the FLHBR system; E p o t e n t i a l is the potential energy of the FLHBR system; L a denotes the Lagrange function of the FLHBR system; τ i , i = 1 , 2 , 3 , 4 , 5 is the i-joint torque; θ i , i = 1 , 2 , 3 , 4 , 5 denotes the angle of link1~link5; θ ˙ i , i = 1 , 2 , 3 , 4 , 5 is the velocity of link1~link5, M 1 = M 5 = 4.55 kg, M 2 = M 4 = 7.63 kg , M 3 = 49.00 kg are the masses of link1~link5, M 2 , M 4 denote the masses of exoskeleton thighs, M 1 , M 5 denote the masses of legs, M 3 denotes the mass of torso, L 1 = L 5 = 0.502 m, L 2 = L 4 = 0.431 m are the lengths of link1, 2, 4, 5, D 1 = D 5 = 0.247 m, D 2 = D 4 = 0.247 m, D 3 = 0.280 m are the distances between the mass centers of link1, 2, 3, 4, 5 and those lower joint, I 1 = I 5 = 0.105 kg·m2, I 2 = I 4 = 0.089 kg·m2, I 3 = 2.350 kg·m2, are the moments of rotational inertias for link1, 2, 3, 4, 5 and G = 9.8 m/s2 is the acceleration of gravity.
Define the input, output, state, noise and matched uncertainty variables of the FLHBR to be u i p [ τ 1 τ 5 ] T = [ u i p _ 1 u i p _ 5 ] T , u o p [ θ 1 θ 5 ] T , x s e [ x s e _ 1 x s e _ 10 ] T , x s e _ 1 = θ 1 , x s e _ 2 = θ ˙ 1 , x s e _ 3 = θ 2 , x s e _ 4 = θ ˙ 2 , x s e _ 5 = θ 3 , x s e _ 6 = θ ˙ 3 , x s e _ 7 = θ 4 , x s e _ 8 = θ ˙ 4 , x s e _ 9 = θ 5 , x s e _ 10 = θ ˙ 5 , j = 1 p q n o i s e _ j * Ω n _ j , j = 1 p q n o i s e _ j * Ω u n _ j . The complete derivations of mathematical dynamical model and the related definitions of variables D i j , H i , h i j j , G i , 1 i , j 5 are sown in Appendix A. Then the dynamic equation of the FLHBR system can be derived as
[ x ˙ se _ 1 x ˙ se _ 10 ] T = [ f 1 f 10 ] T + g uip _ 1 u i p _ 1 + g uip _ 2 u i p _ 2 + g uip _ 3 u i p _ 3 + g uip _ 4 u i p _ 4 + g uip _ 5 u i p _ 5 + j = 1 p q n o i s e _ j * Ω n _ j + j = 1 p q n o i s e _ j * Ω u n _ j
u o p _ 1 = x s e _ 1 = θ 1
u o p _ 2 = x s e _ 3 = θ 2
u o p _ 3 = x s e _ 5 = θ 3
u o p _ 4 = x s e _ 7 = θ 4
u o p _ 5 = x s e _ 9 = θ 5
where
f 1 x s e _ 2
f 2 ( DI 11 ) ( H 1 G 1 ) + ( DI 12 ) ( H 2 G 2 ) + ( DI 13 ) ( H 3 G 3 ) + ( DI 14 ) ( H 4 G 4 ) + ( DI 15 ) ( H 5 G 5 )
f 3 x s e _ 4
f 4 = ( DI 21 ) ( H 1 G 1 ) + ( DI 22 ) ( H 2 G 2 ) + ( DI 23 ) ( H 3 G 3 ) + ( DI 24 ) ( H 4 G 4 ) + ( DI 25 ) ( H 5 G 5 )
f 5 x s e _ 6
f 6 = ( DI 31 ) ( H 1 G 1 ) + ( DI 32 ) ( H 2 G 2 ) + ( DI 33 ) ( H 3 G 3 ) + ( DI 34 ) ( H 4 G 4 ) + ( DI 35 ) ( H 5 G 5 )  
f 7 x s e _ 8
f 8 = ( DI 41 ) ( H 1 G 1 ) + ( DI 42 ) ( H 2 G 2 ) + ( DI 43 ) ( H 3 G 3 ) + ( DI 44 ) ( H 4 G 4 ) + ( DI 45 ) ( H 5 G 5 )  
f 9 x s e _ 10
f 10 = ( DI 51 ) ( H 1 G 1 ) + ( DI 52 ) ( H 2 G 2 ) + ( DI 53 ) ( H 3 G 3 ) + ( DI 54 ) ( H 4 G 4 ) + ( DI 55 ) ( H 5 G 5 )
DETD = ( D 33 D 12 2 D 45 2 D 33 D 44 D 55 D 12 2 2 D 12 D 13 D 23 D 45 2 + 2 D 44 D 55 D 12 D 13 D 23 + 2 D 33 D 55 D 12 D 14 D 24 2 D 33 D 12 D 14 D 25 D 45 2 D 33 D 12 D 15 D 24 D 45 + 2 D 33 D 44 D 12 D 15 D 25 + D 55 D 13 2 D 24 2 2 D 13 2 D 24 D 25 D 45 + D 44 D 13 2 D 25 2 + D 22 D 13 2 D 45 2 D 22 D 44 D 55 D 13 2 2 D 55 D 13 D 14 D 23 D 24 + 2 D 13 D 14 D 23 D 25 D 45 + 2 D 13 D 15 D 23 D 24 D 45 2 D 44 D 13 D 15 D 23 D 25 + D 55 D 14 2 D 23 2 + D 33 D 14 2 D 25 2 D 22 D 33 D 55 D 14 2 2 D 14 D 15 D 23 2 D 45 2 D 33 D 14 D 15 D 24 D 25   + 2 D 22 D 33 D 14 D 15 D 45 + D 44 D 15 2 D 23 2 + D 33 D 15 2 D 24 2 D 22 D 33 D 44 D 15 2 + D 11 D 23 2 D 45 2 D 11 D 44 D 55 D 23 2 D 11 D 33 D 55 D 24 2 + 2 D 11 D 33 D 24 D 25 D 45   D 11 D 33 D 44 D 25 2 D 11 D 22 D 33 D 45 2 + D 11 D 22 D 33 D 44 D 55 )
DI 11 = (   D 23 2 D 45 2 + D 44 D 55 D 23 2 + D 33 D 55 D 24 2 2 D 33 D 24 D 25 D 45 + D 33 D 44 D 25 2 + D 22 D 33 D 45 2   D 22 D 33 D 44 D 55 ) / ( DETD )
DI 12 = ( D 13 D 23 D 45 2 D 12 D 33 D 45 2 + D 14 D 25 D 33 D 45 + D 15 D 24 D 33 D 45   D 15 D 25 D 33 D 44 D 14 D 24 D 33 D 55 D 13 D 23 D 44 D 55 + D 12 D 33 D 4 4 D 55 ) / ( DETD )
DI 13 = ( D 13 D 22 D 45 2 D 12 D 23 D 45 2 + D 13 D 25 2 D 44 + D 13 D 24 2 D 55 2 D 13 D 24 D 25 D 45 + D 14 D 23 D 25 D 45 + D 15 D 23 D 24 D 45 D 15 D 23 D 25 D 44 D 14 D 23 D 24 D 55 + D 12 D 23 D 4 4 D 55 D 13 D 22 D 44 D 55 ) / ( DETD )
DI 14 = ( D 14 D 25 2 D 33 D 15 D 23 2 D 45 + D 14 D 23 2 D 55 D 15 D 24 D 25 D 33 + D 13 D 23 D 25 D 45 D 12 D 25 D 33 D 45 D 13 D 23 D 24 D 5 5 + D 15 D 22 D 33 D 45 + D 12 D 24 D 33 D 55 D 14 D 2 2 D 33 D 5 5 ) / ( DETD )
DI 15 = ( D 15 D 24 2 D 33 D 14 D 23 2 D 45 + D 15 D 23 2 D 44 D 14 D 24 D 25 D 33 + D 1 3 D 23 D 2 4 D 45 D 13 D 23 D 25 D 44 D 12 D 24 D 33 D 45 + D 12 D 25 D 33 D 44 + D 14 D 22 D 33 D 45 D 15 D 22 D 33 D 4 4 ) / ( DETD )
DI 21 = ( D 13 D 23 D 45 2 D 12 D 33 D 45 2 + D 14 D 25 D 33 D 45 + D 15 D 24 D 33 D 4 5 D 15 D 25 D 33 D 44 D 14 D 24 D 33 D 55 D 13 D 23 D 44 D 55 + D 12 D 33 D 44 D 55 ) / ( DETD )
DI 22 = ( D 13 2 D 45 2 + D 44 D 55 D 13 2 + D 33 D 55 D 14 2 2 D 33 D 14 D 15 D 4 5 + D 33 D 44 D 15 2 + D 11 D 33 D 45 2 D 11 D 33 D 44 D 55 ) / ( DETD )
DI 23 = ( D 11 D 23 D 45 2 D 12 D 13 D 45 2 + D 15 2 D 23 D 44 + D 14 2 D 23 D 55 + D 13 D 1 4 D 2 5 D 4 5 + D 13 D 15 D 24 D 45 D 13 D 15 D 25 D 44 2 D 14 D 15 D 23 D 45 D 13 D 14 D 24 D 55 + D 12 D 13 D 44 D 55 D 11 D 23 D 4 4 D 55 ) / ( DETD )
DI 24 = ( D 15 2 D 24 D 33 D 13 2 D 25 D 45 + D 13 2 D 24 D 55 D 14 D 15 D 25 D 33 + D 13 D 15 D 23 D 45 D 12 D 15 D 33 D 45 D 13 D 14 D 23 D 55 + D 11 D 25 D 33 D 45 + D 12 D 14 D 33 D 55 D 11 D 24 D 33 D 55 ) / ( DETD )
DI 25 = ( D 14 2 D 25 D 33 D 13 2 D 24 D 45 + D 13 2 D 25 D 44 D 14 D 15 D 24 D 33 + D 13 D 14 D 23 D 45 D 13 D 15 D 23 D 44 D 12 D 14 D 33 D 45 + D 12 D 15 D 33 D 44 + D 11 D 24 D 33 D 45 D 11 D 25 D 33 D 44 ) / ( DETD )
DI 31 = ( D 13 D 22 D 45 2 D 12 D 23 D 45 2 + D 13 D 25 2 D 44 + D 13 D 24 2 D 55 2 D 13 D 24 D 25 D 45 + D 14 D 23 D 25 D 45 + D 1 5 D 23 D 24 D 45 D 15 D 23 D 25 D 44 D 14 D 23 D 24 D 55 + D 12 D 23 D 44 D 55 D 13 D 22 D 44 D 55 ) / ( DETD )
DI 32 = ( D 11 D 23 D 45 2 D 12 D 13 D 45 2 + D 15 2 D 23 D 44 + D 14 2 D 23 D 55 + D 13 D 14 D 25 D 45 + D 13 D 15 D 24 D 45 D 13 D 15 D 2 5 D 44 2 D 14 D 1 5 D 2 3 D 45 D 13 D 14 D 24 D 55 + D 12 D 13 D 44 D 55 D 11 D 23 D 4 4 D 55 ) / ( DETD )
DI 33 = ( D 12 2 D 45 2 + D 44 D 55 D 12 2 2 D 55 D 12 D 14 D 24 + 2 D 1 2 D 14 D 25 D 4 5 + 2 D 12 D 15 D 24 D 45 2 D 44 D 12 D 15 D 25 D 14 2 D 25 2 + D 22 D 5 5 D 2 2 + 2 D 14 D 15 D 24 D 25 2 D 22 D 14 D 15 D 45 D 15 2 D 24 2 + D 22 D 44 D 15 2 + D 11 D 55 D 24 2 2 D 11 D 24 D 25 D 45 + D 11 D 44 D 25 2 + D 11 D 22 D 45 2 D 11 D 22 D 44 D 55 ) / ( DETD )
DI 34 = ( D 13 D 14 D 25 2 + D 15 2 D 23 D 24 D 13 D 15 D 24 D 25 D 14 D 15 D 23 D 25 D 12 D 13 D 25 D 45 D 12 D 15 D 23 D 45 + D 13 D 15 D 22 D 45 + D 11 D 2 3 D 25 D 45 + D 12 D 1 3 D 24 D 5 5 + D 12 D 14 D 23 D 5 5 D 13 D 14 D 22 D 55 D 11 D 23 D 24 D 55 ) / ( DETD )
DI 35 = ( D 13 D 15 D 24 2 + D 14 2 D 23 D 25 D 13 D 14 D 24 D 2 5 D 14 D 15 D 2 3 D 24 D 12 D 13 D 24 D 45 + D 1 D 13 D 25 D 44 D 12 D 14 D 23 D 45 + D 12 D 15 D 23 D 4 4 + D 13 D 14 D 22 D 45 D 13 D 15 D 22 D 44 + D 11 D 23 D 24 D 45 D 11 D 23 D 25 D 4 4 ) / ( DETD )
DI 41 = ( D 14 D 25 2 D 33 D 15 D 23 2 D 45 + D 14 D 23 2 D 55 D 15 D 24 D 25 D 33 + D 13 D 23 D 25 D 45 D 12 D 25 D 33 D 45 D 13 D 23 D 24 D 55 + D 15 D 22 D 33 D 45 + D 12 D 24 D 33 D 55 D 14 D 22 D 33 D 55 ) / ( DETD )
DI 42 = ( D 15 2 D 24 D 33 D 13 2 D 2 5 D 45 + D 13 2 D 24 D 55 D 14 D 15 D 25 D 33 + D 13 D 15 D 23 D 45 D 12 D 15 D 33 D 45 D 13 D 14 D 23 D 55 + D 1 1 D 25 D 33 D 45 + D 12 D 14 D 33 D 55 D 11 D 24 D 33 D 55 ) / ( DETD )
DI 43 = ( D 13 D 14 D 25 2 + D 15 2 D 23 D 24 D 13 D 15 D 24 D 25 D 14 D 15 D 23 D 25 D 12 D 13 D 25 D 45 D 12 D 15 D 23 D 45 + D 13 D 15 D 22 D 45 + D 1 1 D 23 D 25 D 45 + D 12 D 13 D 24 D 55 + D 12 D 14 D 23 D 55 D 13 D 14 D 2 2 D 55 D 11 D 23 D 24 D 55 ) / ( DETD )
DI 44 = ( D 33 D 55 D 12 2 2 D 55 D 12 D 13 D 23 2 D 33 D 1 2 D 15 D 25 D 13 2 D 25 2 + D 22 D 55 D 13 2 + 2 D 13 D 15 D 23 D 25 D 15 2 D 23 2 + D 22 D 33 D 15 2 + D 11 D 55 D 23 2 + D 11 D 33 D 25 2 D 1 1 D 22 D 33 D 55 ) / ( DETD )
DI 45 = ( D 11 D 23 2 D 45 D 13 2 D 24 D 25 D 14 D 15 D 23 2 + D 13 2 D 22 D 45 + D 12 2 D 33 D 45 + D 13 D 14 D 23 D 25 + D 13 D 15 D 23 D 24 D 12 D 14 D 25 D 33 D 12 D 15 D 24 D 33 + D 14 D 15 D 22 D 33 + D 11 D 24 D 25 D 33 2 D 12 D 13 D 23 D 45 D 11 D 22 D 33 D 45 ) / ( DETD )
DI 51 = ( D 15 D 24 2 D 33 D 14 D 23 2 D 45 + D 15 D 23 2 D 44 D 14 D 24 D 25 D 33 + D 13 D 23 D 24 D 45 D 13 D 23 D 25 D 44 D 12 D 24 D 33 D 45 + D 12 D 25 D 33 D 44 + D 14 D 22 D 33 D 45 D 15 D 22 D 33 D 44 ) / ( DETD )
DI 52 = ( D 14 2 D 25 D 33 D 13 2 D 24 D 45 + D 13 2 D 25 D 44 D 14 D 15 D 24 D 33 + D 13 D 14 D 23 D 45 D 13 D 15 D 23 D 44 D 12 D 14 D 33 D 45 + D 12 D 15 D 33 D 44 + D 11 D 24 D 33 D 45 D 11 D 25 D 33 D 44 ) / ( DETD )
DI 53 = ( D 13 D 15 D 24 2 + D 14 2 D 23 D 25 D 13 D 14 D 24 D 25 D 14 D 15 D 23 D 24 D 12 D 13 D 24 D 45 + D 12 D 13 D 25 D 44 D 12 D 14 D 23 D 45 + D 12 D 15 D 23 D 44   + D 13 D 14 D 22 D 45 D 13 D 15 D 22 D 44 + D 11 D 23 D 24 D 45 D 11 D 23 D 25 D 44 ) / ( DETD )
DI 54 = ( D 11 * D 23 2 D 45 D 13 2 D 24 D 25 D 14 D 15 * D 23 2 + D 13 2 D 22 D 45 + D 12 2 D 33 D 45 + D 13 D 14 D 23 D 25 + D 13 D 15 D 23 D 24 D 12 D 14 D 25 D 33 D 12 D 15 D 24 D 33 + D 14 D 15 D 22 D 33 + D 11 D 24 D 25 D 33 2 D 12 D 13 D 23 D 45 D 11 D 22 D 33 D 45 ) / ( DETD )
DI 55 = ( D 33 D 44 D 12 2 2 D 44 D 12 D 13 D 23 2 D 33 D 12 D 14 D 24 D 13 2 D 24 2 + D 22 D 44 D 13 2 + 2 D 13 D 14 D 23 D 24 D 14 2 D 23 2 + D 22 D 33 D 14 2 + D 11 D 4 4 D 23 2 + D 11 D 33 D 24 2 D 11 D 22 D 33 D 44 ) / ( DETD )
g uip _ 1 = [ 0 DI 11 0 DI 21 0 DI 31 0 DI 41 0 DI 51 ] T
g uip _ 2 = [ 0 DI 12 0 DI 22 0 DI 32 0 DI 42 0 DI 52 ] T
g uip _ 3 = [ 0 DI 13 0 DI 23 0 DI 33 0 DI 43 0 DI 53 ] T
g uip _ 4 = [ 0 DI 14 0 DI 24 0 DI 34 0 DI 44 0 DI 54 ] T
g uip _ 5 = [ 0 DI 15 0 DI 25 0 DI 35 0 DI 45 0 DI 55 ] T
q n o i s e _ 1 * = [ 0 0.1 0 0 ] T
Ω n _ 1 = sin t
First, define the nominal system of the FLHBR system to be
x ˙ s e ( t ) = f ( x s e ) + g ˜ uip ( x s e ) u i p
y o p ( t ) = u o p (   x s e )
with the well-defined relative degree [28] { d r d _ 1 , d r d _ 2 , , d r d _ 5 } = { 2 2 2 2 2 } that meets
<i> the following Lie differential equation holds:
L g u i p _ j L f k u o p _ i ( x s e ) = 0
for 1 i 5 , 1 j 5 , k < d r d _ i 1 , where the symbol L denotes the Lie differentiation operation [28,29].
<ii> the following Lie differentiation matrix possesses the nonsingular performance:
A s y s t e m [ L g u i p _ 1 L f d r d _ 1 1 u o p _ 1 ( x s e ) L g u i p _ 5 L f d r d _ 1 1 u o p _ 1 ( x s e ) L g u i p _ 1 L f d r d _ 5 1 u o p _ 5 ( x s e ) L g u i p _ 5 L f d r d _ 5 1 u o p _ 5 ( x s e ) ] = [ D I 11 D I 12 D I 13 D I 14 D I 15 D I 21 D I 22 D I 23 D I 24 D I 25 D I 31 D I 32 D I 33 D I 34 D I 35 D I 41 D I 42 D I 43 D I 44 D I 45 D I 51 D I 52 D I 53 D I 54 D I 55 ]
and the following function
s p a n { g uip _ 1 , g uip _ 2 , , g uip _ 5 }
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 φ : n n defined by
Τ l _ i [ Τ l _ 1 i Τ l _ d r d _ i i ] T [ φ l _ 1 i φ l _ d r d _ i i ] T [ L f 0 u o p _ i ( x s e ) L f d r d _ i 1 u o p _ i ( x s e ) ] T , 1 i 5
Τ l [ Τ l _ 1 Τ l _ 2 Τ l _ d r d ] T
d r d d r d _ 1 + d r d _ 2 + + d r d _ 5
Τ l _ 1 1 = ϕ l _ 1 1 L f 0 u o p _ 1 = x s e _ 1 ,
Τ l _ d r d _ 1 2 = Τ l _ 2 1 = ϕ l _ 2 1 L f 1 u o p _ 1 L f 1 x s e _ ! = f 1 = x s e _ 2
Τ l _ 1 2 = ϕ l _ 1 2 L f 0 u o p _ 2 = x s e _ 3 ,
Τ l _ d r d _ 2 2 = Τ l _ 2 2 = ϕ l _ 2 2 L f 1 u o p _ 2 L f 1 x s e _ 3 = f 3 = x s e _ 4
Τ l _ 1 3 = ϕ l _ 1 3 L f 0 u o p _ 3 = x s e _ 5 ,
Τ l _ d r d _ 3 2 = Τ l _ 2 3 = ϕ l _ 2 3 L f 1 u o p _ 3 L f 1 x s e _ 5 = f 5 = x s e _ 6
Τ l _ 1 4 = ϕ l _ 1 4 L f 0 u o p _ 4 = x s e _ 7 ,
Τ l _ d r d _ 4 2 = Τ l _ 2 4 = ϕ l _ 2 4 L f 1 u o p _ 4 L f 1 x s e _ 7 = f 7 = x s e _ 8
Τ l _ 1 5 = ϕ l _ 1 5 L f 0 u o p _ 5 = x s e _ 9 ,
Τ l _ d r d _ 5 2 = Τ l _ 2 5 = ϕ l _ 2 5 L f 1 u o p _ 5 L f 1 x s e _ 9 = f 9 = x s e _ 10
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:
Τ ˙ l _ 1 1 = u o p _ 1 x s e [ f + g ˜ uip u i p + j = 1 p q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) ] = Τ l _ 2 1 + j = 1 p ( u o p _ 1 x s e q n o i s e _ j * ) ( Ω u n _ j + Ω n _ j )
Τ ˙ l l _ d r d _ 1 1 = Τ ˙ l l _ 2 1 = L f d r d _ 1 1 u o p _ 1 x s e [ f + g ˜ uip u i p + j = 1 p q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) ] = L f d r d _ 1 u o p _ 1 + L g u i p _ 1 L f d r d _ 1 1 u o p _ 1 u i p _ 1 + + L g u i p _ 5 L f d r d _ 1 1 u o p _ 1 u i p _ 5 + j = 1 p ( L f d r d _ 1 1 u o p _ 1 x s e q n o i s e _ j * ) ( Ω u n _ j + Ω n _ j )
Τ ˙ l _ 1 5 = u o p _ 5 x s e [ f + g ˜ uip u i p + j = 1 p q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) ] = Τ l _ 2 5 + j = 1 p ( u o p _ 5 x s e q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) )
Τ ˙ l l _ d r d _ 5 5 = Τ ˙ l l _ 2 1 = L f d r d _ 5 1 u o p _ 5 x s e [ f + g ˜ uip u i p + j = 1 p q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) ] = L f d r d _ 5 u o p _ 5 + L g u i p _ 1 L f d r d _ 5 1 u o p _ 5 u i p _ 1 + + L g u i p _ 5 L f d r d _ 5 1 u o p _ 5 u i p _ 5 + j = 1 p ( L f d r d _ 5 1 u o p _ 5 x s e q n o i s e _ j * ) ( Ω u n _ j + Ω n _ j )
Since
u i p _ c i L f d r d _ i u o p _ i
u i p _ d i j L g uip _ j L f d r d _ i 1 u o p _ i , 1 i , j 5
then the transformed subsystem is written as
Τ ˙ l _ 1 1 ( t ) = Τ l _ 2 1 ( t ) + j = 1 p ( x s e L f 1 1 u o p _ 1 ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j )
Τ ˙ l l _ d r d _ 1 1 = Τ ˙ l _ 2 1 = u i p _ c 1 + u i p _ d 11 u i p _ 1 + + u i p _ d 15 u i p _ 5 + j = 1 p ( x s e L f d r d _ 1 1 u o p _ 1 ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j )
Τ ˙ l _ 1 5 = Τ l _ 2 5 + j = 1 p ( x s e L f 1 1 u o p _ 5 ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j )
Τ ˙ l l _ d r d _ 5 1 = Τ ˙ l _ 2 5 = u i p _ c 5 + u i p _ d 51 u i p _ 1 + + u i p _ d 55 u i p _ 5 + j = 1 p ( x s e L f d r d _ 5 1 u o p _ 5 ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j )
u o p _ i = Τ l _ 1 i , 1 i 5
hence
[ Τ ˙ l _ d r d _ 1 1 Τ ˙ l _ d r d _ 2 2 Τ ˙ l _ d r d _ 5 5 ] = [ Τ ˙ l _ 2 1 Τ ˙ l _ 2 2 Τ ˙ l _ 2 5 ] = [ u i p _ c 1 u i p _ c 2 u i p _ c 5 ] + [ u i p _ d 11 u i p _ d 12 u i p _ d 15 u i p _ d 21 u i p _ d 22 u i p _ d 25 u i p _ d 51 u i p _ d 52 u i p _ d 55 ] [ u i p _ 1 u i p _ 2 u i p _ 5 ] + [ j = 1 p ( x s e L f d r d _ 1 1 u o p _ 1 ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) j = 1 p ( x s e L f d r d _ 2 1 u o p _ 2 ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) j = 1 p ( x s e L f d r d _ 5 1 u o p _ 5 ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) ]
To construct the desired feedback linearization controller
u i p = A s y s t e m 1 { u i p _ b + u i p _ v }
we apply the vector
u i p _ b [ u i p _ b 1 u i p _ b 2 u i p _ b 5 ] T [ L f d r d _ 1 u o p _ 1 L f d r d _ 2 u o p _ 2 L f d r d _ 5 u o p _ 5 ] T = [ u i p _ c 1 u i p _ c 2 u i p _ c 5 ] T u i p _ c
and the virtual input [30]
u i p _ v [ u i p _ v 1 u i p _ v 2 u i p _ v 5 ] T
Then we can transform the original FLHBR system into the following model
[ Τ ˙ l _ d r d _ 1 1 Τ ˙ l _ d r d _ 2 2 Τ ˙ l _ d r d _ 5 5 ] = [ Τ ˙ l _ 2 1 Τ ˙ l _ 2 2 Τ ˙ l _ 2 5 ] = [ u i p _ v 1 u i p _ v 2 u i p _ v 5 ] + [ j = 1 p ( x s e L f d r d _ 1 1 u o p _ 1 ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) j = 1 p ( x s e L f d r d _ 2 1 u o p _ 2 ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) j = 1 p ( x s e L f d r d _ 5 1 u o p _ 5 ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) ]
From (76), (78) and (85), we obtain
[ Τ ˙ l _ 1 i ( t ) Τ ˙ l _ d r d _ i i ] = [ 0 1 0 0 ] [ Τ l _ 1 i ( t ) Τ l _ d r d _ i i ] + [ 0 1 ] u i p _ v i + [ j = 1 p ( x s e L f 1 1 u o p _ i ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) j = 1 p ( x s e L f d r d _ i 1 u o p _ i ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) ] , d r d _ i = 2 , i = 1 , , 5
We construct the feedback linearization controller by u i p = A s y s t e m 1 { u i p _ b + u i p _ v } with almost disturbing decoupling performance to be [30]
u i p _ v i u o p _ t r a c k i ( d r d _ i ) ε d r d _ i α 1 i [ L f 0 u o p _ i u o p _ t r a c k i ] ε 1 d r d _ i α 2 i [ L f 1 u o p _ i u o p _ t r a c k i ( 1 ) ] ε 1 α d r d _ i i [ L f d r d _ i 1 u o p _ i u o p _ t r a c k i ( d r d _ i 1 ) ] , 1 i 5
where u o p _ t r a c k i is the desired tracking signal and α d r d _ i i are elements of the Hurwitz matrix shown by
A L i [ 0 1 0 0 0 0 1 0 0 0 0 1 α 1 i α 2 i α 3 i α d r d _ i i ] d r d _ i × d r d _ i = [ 0 1 1000 1000 ] i = 1 , , 5
Based on a feedback linearization approach, we propose the robust controller with the pre-specified tracking signals u o p _ t r a c k 1 = u o p _ t r a c k 2 = u o p _ t r a c k 3 = u o p _ t r a c k 4 = u o p _ t r a c k 5 = 0 as follows:
u i p = A s y s t e m 1 ( u i p _ b + u i p _ v ) = A s y s t e m 1 ( [ u i p _ b 1 u i p _ b 5 ] T + [ u i p _ v 1 u i p _ v 5 ] T )
A s y s t e m 1 [ D 11 D 12 D 13 D 14 D 15 D 12 D 22 D 23 D 24 D 25 D 13 D 23 D 33 0 0 D 14 D 24 0 D 44 D 45 D 15 D 25 0 D 45 D 55 ]
u i p _ b 1 = f 2
u i p _ b 2 = f 4
u i p _ b 3 = f 6
u i p _ b 4 = f 8
u i p _ b 5 = f 10
u i p _ v 1 = 0 1000 ( 1 / ε ) 2 ( x s e _ 1 0 ) 1000 ( 1 / ε ) 1 ( x s e _ 2 0 )
u i p _ v 2 = 0 1000 ( 1 / ε ) 2 ( x s e _ 3 0 ) 1000 ( 1 / ε ) 1 ( x s e _ 4 0 )
u i p _ v 3 = 0 1000 ( 1 / ε ) 2 ( x s e _ 5 0 ) 1000 ( 1 / ε ) 1 ( x s e _ 6 0 )
u i p _ v 4 = 0 1000 ( 1 / ε ) 2 ( x s e _ 7 0 ) 1000 ( 1 / ε ) 1 ( x s e _ 8 0 )
u i p _ v 5 = 0 1000 ( 1 / ε ) 2 ( x s e _ 9 0 ) 1000 ( 1 / ε ) 1 ( x s e _ 10 0 )
u i p _ 1 = ( D 11 ) ( u i p _ b 1 + u i p _ v 1 ) + ( D 12 ) ( u i p _ b 2 + u i p _ v 2 ) + ( D 13 ) ( u i p _ b 3 + u i p _ v 3 ) + ( D 14 ) ( u i p _ b 4 + u i p _ v 4 ) + ( D 15 ) ( u i p _ b 5 + u i p _ v 5 )
u i p _ 2 = ( D 21 ) ( u i p _ b 1 + u i p _ v 1 ) + ( D 22 ) ( u i p _ b 2 + u i p _ v 2 ) + ( D 23 ) ( u i p _ b 3 + u i p _ v 3 ) + ( D 24 ) ( u i p _ b 4 + u i p _ v 4 ) + ( D 25 ) ( u i p _ b 5 + u i p _ v 5 )
u i p _ 3 = ( D 31 ) ( u i p _ b 1 + u i p _ v 1 ) + ( D 32 ) ( u i p _ b 2 + u i p _ v 2 ) + ( D 33 ) ( u i p _ b 3 + u i p _ v 3 ) + ( D 34 ) ( u i p _ b 4 + u i p _ v 4 ) + ( D 35 ) ( u i p _ b 5 + u i p _ v 5 )
u i p _ 4 = ( D 41 ) ( u i p _ b 1 + u i p _ v 1 ) + ( D 42 ) ( u i p _ b 2 + u i p _ v 2 ) + ( D 43 ) ( u i p _ b 3 + u i p _ v 3 ) + ( D 44 ) ( u i p _ b 4 + u i p _ v 4 ) + ( D 45 ) ( u i p _ b 5 + u i p _ v 5 )
u i p _ 5 = ( D 51 ) ( u i p _ b 1 + u i p _ v 1 ) + ( D 52 ) ( u i p _ b 2 + u i p _ v 2 ) + ( D 53 ) ( u i p _ b 3 + u i p _ v 3 ) + ( D 54 ) ( u i p _ b 4 + u i p _ v 4 ) + ( D 55 ) ( u i p _ b 5 + u i p _ v 5 )
For the convenience of the following discussions, let’s define some related parameters as
e t r _ j i Τ l _ j i u o p _ t r a c k i ( j 1 )
e t r _ t r a c k i [ e t r _ 1 i e t r _ 2 i e t r _ d r d _ i i ] T d r d _ i
e t r _ j i ¯ ε j 1 e t r _ j i , i = 1 , 2 , , 5 , j = 1 , 2 , , d r d _ i
e t r _ t r a c k i ¯ [ e t r _ 1 i ¯ e t r _ 2 i ¯ e t r _ d r d _ i i ¯ ( t ) ] T d r d _ i
e ¯ t r _ t r a c k [ e t r _ t r a c k 1 ¯ e t r _ t r a c k 2 ¯ e t r _ t r a c k 5 ¯ ] T d r d
B i [ 0 0 0 1 ] T d r d _ i × 1 , 1 i 5
e t r _ t r a c k i ¯ ¯ α 1 i e t r _ 1 i ¯ + α 2 i e t r _ 2 i ¯ + + α d r d _ i i e t r _ d r d _ i i ¯
where the Lyapunov system matrix A L i 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 E L i > 0 of the following Lyapunov equation [31]:
( A L i ) T E L i + E L i A L i = I
λ max ( E L i )   max .   eigenvalue   of   the   system   matrix   E L i
λ min ( E L i )   min .   eigenvalue   of   the   system   matrix   E L i
λ max * max { λ max ( E L 1 ) , λ max ( E L 2 ) , , λ max ( E L 5 ) } max { 0.005 , 0.005 , , 0.005 } = 0.005
λ min * min { λ max ( E L 1 ) , λ max ( E L 2 ) , , λ max ( E L 5 ) } min { 1.0005 , 1.0005 , , 1.0005 } = 1.0005
and
E L 1 = E L 2 = E L 3 = E L 4 = E L 5 = [ 1.0005 0.0005 0.0005 0.0005 ]
To demonstrate further the complete control design of nonlinear FLHBR systems, let us make two definitions as
Definition 1.
The nonlinear control system x ˙ s e = f ( t , x s e , u i p ) with the input u i p , the state x s e and the smooth function f : [ 0 , ) × n × n n is called to have the input-to-state stable performance if
x s e ( t ) γ 1 ( x s e ( t 0 ) , t t 0 ) + γ 2 ( sup t 0 τ t u i p ( τ ) )
where γ 1 , γ 2 are K -class function, K L -class function, respectively [32].
Definition 2.
A nonlinear control system with the external disturbance input u i p 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:
| u o p _ i ( t ) u o p _ t r a c k i ( t ) | γ 11 ( x s e ( t 0 ) , t t 0 ) + 1 γ 22 γ 33 ( sup t 0 τ t u i p ( τ ) )
and
t 0 t [ u o p _ i ( τ ) u o p _ t r a c k i ( τ ) ] 2 d τ 1 γ 44 [ γ 55 ( x s e ( t 0 ) ) + t 0 t γ 33 ( u i p ( τ ) 2 ) d τ ]
where x s e ( t 0 ) denotes the initial state of the control system, γ 11 is K L -class function, γ 33 , γ 55 are K -class functions and γ 22 > 0 , γ 44 > 0 [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 a 1 2 + a 2 2 + + a m 2 | a 1 | + | a 2 | + + | a m | , it is easy to obtain
t 0 t a 1 2 + a 2 2 + + a m 2 d τ t 0 t | a 1 | + | a 2 | + + | a m | d τ
and
t 0 t [ u o p _ 1 ( τ ) u o p _ t r a c k 1 ( τ ) ] 2 + + [ u o p _ m ( τ ) u o p _ t r a c k m ( τ ) ] 2 d τ t 0 t { | u o p _ 1 ( t ) u o p _ t r a c k 1 ( t ) | + + | u o p _ m ( t ) u o p _ t r a c k m i ( t ) | } d τ
Therefore, we can conclude the fact that the root mean square error can be implied by the almost disturbance decoupling condition (121).
From (86), we obtain
[ Τ ˙ l _ 1 i u ˙ o p _ t r a c k i Τ ˙ l _ d r d _ i i u ˙ o p _ t r a c k i ( d r d _ i 1 ) ] = [ 0 1 0 0 ] [ Τ l _ 1 i u o p _ t r a c k i Τ l _ d r d _ i i u o p _ t r a c k i ( d r d _ i 1 ) ] + [ 0 1 ] ( u i p _ v i u o p _ t r a c k i ( d r d _ i ) ) + [ j = 1 p ( x s e L f 1 1 u o p _ i ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) j = 1 p ( x s e L f d r d _ i 1 u o p _ i ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) ] , d r d _ i = 2 , i = 1 , , 5
From (106), (108) and (122), we obtain
[ e t r _ 1 i ¯ ε 1 d r d _ i e t r _ d r d _ i i ¯ ] = [ ε 1 e t r _ d r d _ i i ¯ 0 ] + [ 0 1 ] ( u i p _ v i u o p _ t r a c k i ( d r d _ i ) ) + [ j = 1 p ( x s e L f 1 1 u o p _ i ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) j = 1 p ( x s e L f d r d _ i 1 u o p _ i ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) ]
Substituting (87) and (88) into (123) obtains
ε [ e t r _ 1 i ¯ . e t r _ d r d _ i i ¯ . ] = [ 0 1 α 1 i α d r d _ i i ] [ e t r _ 1 i ¯ e t r _ d r d _ i i ¯ ] + [ ε j = 1 p ( x s e L f 1 1 u o p _ i ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) ε d r d _ i j = 1 p ( x s e L f d r d _ i 1 u o p _ i ) q n o i s e _ j * ( Ω u n _ j + Ω n _ j ) ]
Then, we obtain
ε e t r _ t r a c k i ¯ . = A L i e t r _ t r a c k i ¯ + φ Τ l i ( Ω u n + Ω n ) , i = 1 , , 5
u o p _ i = Τ l _ 1 i , i = 1 , , 5
where
φ Τ l i ( ε ) [ ε ( x s e u o p _ i ) q n o i s e _ 1 * ε ( x s e u o p _ i ) q n o i s e _ p * ε d r d _ i ( x s e L f d r d _ i 1 u o p _ i ) q n o i s e _ 1 * ε d r d _ i ( x s e L f d r d _ i 1 u o p _ i ) q n o i s e _ p * ]   i = 1 , , 5
Ω n [ Ω n _ 1 ( t ) Ω n _ p ( t ) ] T
Ω u n [ Ω u n _ 1 Ω u n _ p ] T
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:
[ x ˙ se _ 1 x ˙ se _ n ] T = [ f 1 ( x s e ) f n ( x s e ) ] T + [ g uip _ 1 ( x s e ) g uip _ _ m ( x s e ) ] [ u i p _ 1 ( x s e ) u i p _ m ( x s e ) ] T + [ δ f u n _ 1 ( x s e ) δ f u n _ n ( x s e ) ] T + j = 1 p q n o i s e _ j * Ω n _ j
[ y o p _ 1 ( x s e ) y o p _ m ( x s e ) ] T = [ u o p _ 1 ( x s e ) u o p _ m ( x s e ) ] T
i.e.,
x ˙ s e ( t ) = f ( x s e ) + g ˜ uip ( x s e ) u i p + δ f u n + j = 1 p q n o i s e _ j * Ω n _ j
y o p ( t ) = u o p ( x s e )
where x s e ( t ) [ x se _ 1 ( t ) x se _ n ( t ) ] T , u i p [ u i p _ 1 u i p _ m ] T , q n o i s e _ j * , y o p [ y o p _ 1 y o p _ m ] T , Ω n [ Ω n _ 1 ( t ) Ω n _ p ( t ) ] T are vectors of states, inputs, disturbance-adjoining terms, outputs, and disturbances, respectively, for the nonlinear system. We consider the relating vectors f [ f 1 f n ] T , g ˜ uip [ g uip _ 1 g uip _ m ] T and u o p [ u o p _ 1 u o p _ m ] T to be smooth functions. The uncertain vector δ f u n is considered to be matched uncertainty as δ f u n j = 1 p q n o i s e _ j * Ω u n _ j , Ω u n [ Ω u n _ 1 Ω u n _ p ] T .
Assumption 1.
The following inequality holds:
β n _ t ( t , Τ n , e t r _ t r a c k ¯ ) β n _ t ( t , Τ n , 0 ) M n ( e t r _ t r a c k ¯ )
where M n > 0 , β n _ t ( t , Τ n , e t r _ t r a c k ¯ ) β n ( Τ l , Τ n ) .
Define the nominal system of the nonlinear system to be
x ˙ s e ( t ) = f ( x s e ) + g ˜ uip ( x s e ) u i p
y o p ( t ) = u o p (   x s e )
with the well-defined relative degree { d r d _ 1 , d r d _ 2 , , d r d _ m } that meets
<i> the following Lie differentiation equation holds:
L g u i p _ j L f k u o p _ i ( x s e ) = 0
for 1 i m , 1 j m , k < d r d _ i 1 , where m 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:
A s y s t e m [ L g u i p _ 1 L f d r d _ 1 1 u o p _ 1 ( x s e ) L g u i p _ m L f d r d _ 1 1 u o p _ 1 ( x s e ) L g u i p _ 1 L f d r d _ m 1 u o p _ m ( x s e ) L g u i p _ m L f d r d _ m 1 u o p _ m ( x s e ) ]
and the following function
s p a n { g uip _ 1 , g uip _ 2 , , g uip _ m }
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
ϕ : n n
Τ l _ i [ Τ l _ 1 i Τ l _ d r d _ i i ] T [ φ l _ 1 i φ l _ d r d _ i i ] T [ L f 0 u o p _ i ( x s e ) L f d r d _ i 1 u o p _ i ( x s e ) ] T
d r d d r d _ 1 + d r d _ 2 + + d r d _ m
ϕ n _ k ( x s e ) Τ n _ k ( t ) , k = d r d + 1 , d r d + 2 , , n
and
L g u i p _ j ϕ n _ k ( x s e ) = 0 , k = d r d + 1 , d r d + 2 , , n , 1 j m
is a smooth and bijective function that transforms the highly nonlinear system to be a nonlinear Τ n _ k subsystem and a linear subsystem Τ l _ i , respectively.
Properly design the Lyapunov functions L f _ n and L f _ l for the nonlinear subsystem equation and linear subsystem equation, respectively, and then obtain the composite Lyapunov function L f _ l + n of the transformed system to be
L f _ l + n L f _ n + k ( ε ) L f _ l
L f _ l = L f _ l 1 + + L f _ l m
and
L f _ l i 1 2 e t r _ t r a c k i ¯ T E L i e t r _ t r a c k i ¯
Theorem 1.
There exists a differentiable, smooth and bijective function L y _ n : n r + for the transformed nonlinear subsystem Τ n _ k and the linear subsystem Τ l _ i such that the following inequalities hold:
( a )    Δ n _ 1 Τ n 2 L y _ n Δ n _ 2 Τ n 2
( b )    t L y _ n + ( Τ n L y _ n ) T β n ( t , Τ n , 0 ) 31 α x L y _ n
( c )    Τ n L y _ n Δ n _ 3 Τ n , Δ n _ 3 > 0
and the proposed robust control is constructed by
u i p = A s y s t e m 1 { u i p _ b + u i p _ v }
u i p _ b [ u i p _ b 1 u i p _ b 2 u i p _ bm ] T [ L f d r d _ 1 u o p _ 1 L f d r d _ 2 u o p _ 2 L f d r d _ m u o p _ m ] T
u i p _ v [ u i p _ v 1 u i p _ v 2 u i p _ vm ] T
u i p _ v i u o p _ t r a c k i ( d r d _ i ) ε d r d _ i α 1 i [ L f 0 u o p _ i ( x s e ) u o p _ t r a c k i ] ε 1 d r d _ i α 2 i [ L f 1 u o p _ i ( x s e ) u o p _ t r a c k i ( 1 ) ] ε 1 α d r d _ i i [ L f d r d _ i 1 u o p _ i ( x s e ) u o p _ t r a c k i ( d r d _ i 1 ) ]
P = [ P 11 P 12 P 12 P 22 ]
P 11 = 31 α x 529 46 Δ n _ 3 2 Δ n _ 1 φ Τ n 2
P 12 = [ Δ n _ 3 M n 2 k ( ε ) Δ n _ 1 λ min * ]
P 22 = 1 ε λ max * ( 529 46 ) k ( ε ) φ Τ l 1 2 E L 1 2 1 2 ε 2 λ min ( E L 1 ) ( 529 46 ) k ( ε ) φ Τ l m 2 E L m 2 1 2 ε 2 λ min ( E L m )
α s ( ε ) P 11 + P 22 [ ( P 11 P 22 ) 2 + 4 P 12 2 ] 1 2 4
S 2 α s ( ε )
S 1 m + 1 46 ( sup t 0 τ t Ω u n + Ω n ) 2
S 2 min { Δ n _ 1 , k ( ε ) 2 λ min * }
φ Τ l i ( ε ) [ ε ( x s e u o p _ i ) q n o i s e _ 1 * ε ( x s e u o p _ i ) q n o i s e _ p * ε d r d _ i ( x s e L f d r d _ i 1 u o p _ i ) q n o i s e _ 1 * ε d r d _ i ( x s e L f d r d _ i 1 u o p _ i ) q n o i s e _ p * ]
φ Τ n ( ε ) [ ( x s e φ n _ d r d + 1 ) q n o i s e _ 1 * ( x s e φ n _ d r d + 1 ) q n o i s e _ p * ( x s e φ n _ n ) q n o i s e _ 1 * ( x s e φ n _ n ) q n o i s e _ p * ]
where the identifying matrix P is a positive definite matrix and the identifying parameter k ( ε ) passes through the origin and meets the following condition
lim ε 0 ε / k ( ε ) 0
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 S S 2 > 1 with the exponential convergent rate
S S 2 Q max , Q max max { Δ n _ 2 , k 2 λ max * }
and the exponential convergent radius
S 1 S S 2 r _
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 S S 2 > 1 with
P = 1 ε λ max * ( 529 46 ) k ( ε ) φ Τ l 1 2 E L 1 2 1 2 ε 2 λ min ( E L 1 ) ( 529 46 ) k ( ε ) φ Τ l m 2 E L m 2 1 2 ε 2 λ min ( E L m ) > 0
α s ( ε ) P 2
S 2 α s ( ε )
S 1 m + 1 46 ( sup t 0 τ t ( Ω u n + Ω n ) ) 2
S 2 k ( ε ) 2 λ min *
φ Τ l i ( ε ) [ ε ( u o p _ i x s e ) q n o i s e _ 1 * ε ( u o p _ i x s e ) q n o i s e _ p * ε d r d _ i ( L f d r d _ i 1 u o p _ i x s e ) q n o i s e _ 1 * ε d r d _ i ( L f d r d _ i 1 u o p _ i x s e ) q n o i s e _ p * ]
Moreover, the tracking errors of the nonlinear system is globally reduced with the exponentially convergent rate
S S 2 Q max
where
Q max k 2 λ max *
and the exponentially convergent radius
r _ = S 1 S S 2
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 d r d _ 1 , , d r d _ m 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 A L i to be Hurwitz according to (88) (113) and obtain the positive definite matrix E L i .
(Step 4) Apply (A90)~(A91) to design the Lyapunov function L f _ l of the transformed subsystem.
(Step 5) Apply (A93) and (A95)~(A98) to design parameters k , α s ( ε ) , ε such that the condition S S 2 > 1 is satisfied.
(Step 6) Once all the above conditions are tested, we can directly design the controller via (89).

4. Simulation of the FLHBR System

Proper designing ε = 0.1 , k = 200 ε , d r d _ 1 = 2 , d r d _ 2 = 2 , d r d _ 3 = 2 , d r d _ 4 = 2 , d r d _ 5 = 2 , α s = 4.961 , P = 9.922 , S = 9.922 , S 1 = 0.1304 , S 2 = 0.158 , S S 2 = 1 . 56 > 1 proves the fact that all the conditions of Theorem 2 are satisfied. The output state trajectories of the FLHBR system for ε = 0.1 and ε = 0.2 are shown in Figure 3 and Figure 4, respectively, with the aid of Matlab, where the related simulation parameters are shown in Table 1. Noting that the proposed feedback linearization control indeed makes the outputs of the FLHBR system track the desired tracking signals u o p _ t r a c k 1 = u o p _ t r a c k 2 = u o p _ t r a c k 3 = u o p _ t r a c k 4 = u o p _ t r a c k 5 = 0 . Based on the comparison of Figure 3 and Figure 4, it is evident to see that the convergent rates of output tracking errors for the FLHBR system with small ε are better than large ε .
To allow researchers to systematically design the proposed feedback linearization control, we apply “Python” to build a human–machine interface system. The necessary inputs of the human–machine interface system include: (i) the dynamic equation of the nonlinear FLHBR system; (ii) the numbers of states, outputs, inputs and the desired tracking signals of the nonlinear FLHBR system; (iii) the external disturbances, the Lyapunov functions for transformed subsystems. The human–machine interface system of the controller design takes advantage of its symbol-operation feature for “Python” to produce two executable Matlab files including cytquadff_new1.m and cytquadsimulation_new1.m for the FLHBR system. Therefore, we can execute these two executable Matlab files to dynamically show the output state trajectories before, on and after entering the convergent radius r _ 0.288 of the global ultimate attractor symbolized by blue circles shown in Figure 5, Figure 6 and Figure 7, respectively.

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:
[ x ˙ s e _ 1 ( t ) x ˙ s e _ 2 ( t ) ] = [ tan 1 ( x s e _ 2 ) 0 ] + [ 0 1 ] u i p + [ 1 0 ] Ω n
u o p _ 1 = x s e _ 1 , Ω n ( t ) = 0.8 sin 2 t
From (177) and (178), we can apply Lie differentiation to derive the following results:
L f 0 u o p _ 1 = u o p _ 1 = x s e _ 1 , L g u i p L f 0 u o p _ 1 = 0 , L f 1 u o p _ 1 = tan 1 ( x s e _ 2 ) , L g u i p L f 1 u o p _ 1 = 1 1 + x s e _ 2 2 and
g ˜ uip [ 0 1 L g u i p L f 1 u o p _ 1 ] = [ 0 1 + x s e _ 2 2 ]
Since g ˜ uip 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:
u i p = ( x s e _ 2 2 + 1 ) [ ( cos t ) 256 ( x s e _ 1 ( cos t ) ) 16 ( tan 1 x s e _ 2 ( sin t ) ) ]
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 cos t .
To show the superiority of the proposed feedback linearization control, we compare the convergence rate performance with traditional PID control [34] shown by (181)
u P I D = K P [ y o 1 y o d 1 y o 2 y o d 2 y o 3 y o d 3 y o 4 y o d 4 ] + K I [ ( y o 1 y o d 1 ) d t ( y o 2 y o d 2 ) d t ( y o 3 y o d 3 ) d t ( y o 4 y o d 4 ) d t ] + K D [ d d t ( y o 1 y o d 1 ) d d t ( y o 2 y o d 2 ) d d t ( y o 3 y o d 3 ) d d t ( y o 4 y o d 4 ) ]
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.

6. Conclusions

The FLHBR system possesses highly nonlinear dynamics and many degrees of freedom that are not easy to manipulate. The FLHBR system is also unavoidably subjected to all kinds of external disturbances such as contact with the ground and different ground situations. As a result, accurately modeling the dynamics and walking stability of FLHBR systems are greatly difficult. The study first presents the complete derivations of a mathematical model for highly nonlinear FLHBR systems, and proposes the robust control by the feedback linearization technique to greatly improve the shortcoming of the traditional singular perturbation approach that requires to meet the difficult complete condition for the discriminant function, and the restriction of the traditional H-infinity technique that needs to solve the Hamilton–Jacobi equation.
This study first proposes the very valuable formulas of nonlinear exponential convergence rate and convergent radius for the highly nonlinear FLHBR system. Finally, through the demonstration of the Matlab simulation, the responses are shown to have good tracking performance as well as better robustness performance as compared with the traditional singular perturbation method. In the final section, we compare some simulations of the proposed feedback linearization approach with the traditional PID approach. The simulation results show that the transient dynamics of the proposed approach including the peak time, the rise time, the settling time and the maximum overshoot specifications is superior to the traditional PID approach.
In future works, we hope that a real FLHBR system using the proposed main theorem can be implemented via hardware devices. Based on the important contribution that this article has first proposed on the convergence rate formula of the general nonlinear system, we may use the particle swarm optimization and linear quadratic regulator algorithms to achieve the more optimal performances for nonlinear FLHBR system under the guarantee of globally exponential stability in the near future.

Author Contributions

Conceptualization, K.-H.C.; methodology, C.-C.C.; software, Y.-F.H.; validation, Y.-F.H.; formal analysis, Y.-F.H.; investigation, Y.-F.H.; resources, K.-H.C.; data curation, K.-H.C.; writing—original draft preparation, C.-C.C.; writing—review and editing, K.-H.C. and Y.-F.H.; visualization, Y.-F.H.; project administration, Y.-F.H. All authors have read and agreed to the published version of the manuscript.

Funding

This research received no external funding.

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

Not applicable.

Conflicts of Interest

The authors declare no conflict of interest.

Appendix A

In this appendix, we show the complete derivations of the mathematical model for nonlinear FLHBR system. Based on the geometric coordinate of the FLHBR system shown in Figure 1, the coordinate ( x c i , y c i ) and velocity ( x ˙ c i , y ˙ c i ) , i = 1 , 2 , 3 , 4 , 5 of each link is written as
x c 1 = D 1 sin θ 1
y c 1 = D 1 cos θ 1
x c 2 = L 1 sin θ 1 + D 2 sin θ 2
y c 2 = L 1 cos θ 1 + D 2 cos θ 2
x c 3 = L 1 sin θ 1 + L 2 sin θ 2 + D 3 sin θ 3
y c 3 = L 1 cos θ 1 + L 2 cos θ 2 + D 3 cos θ 3
x c 4 = L 1 sin θ 1 + L 2 sin θ 2 + ( L 4 D 4 ) sin θ 4
y c 4 = L 1 cos θ 1 + L 2 cos θ 2 ( L 4 D 4 ) cos θ 4
x c 5 = L 1 sin θ 1 + L 2 sin θ 2 + L 4 sin θ 4 + ( L 5 D 5 ) sin θ 5
y c 5 = L 1 cos θ 1 + L 2 cos θ 2 L 4 cos θ 4 ( L 5 D 5 ) cos θ 5
According to (A1)~(A10), the kinetic energy and the potential energy of the FLHBR system, and related differentiations can be derived as
E p o t e n t i a l = M 1 D 1 G ( cos θ 1 ) + M 2 G ( L 1 cos θ 1 + D 2 cos θ 2 ) + M 3 G ( L 1 cos θ 1 + L 2 cos θ 2 + D 3 cos θ 3 ) + M 4 G ( L 1 cos θ 1 + L 2 cos θ 2 ( L 4 D 4 ) cos θ 4 ) + M 5 G ( L 1 cos θ 1 + L 2 cos θ 2 L 4 cos θ 4 ( L 5 D 5 ) cos θ 5 )
E p o t e n t i a l θ 1 G 1 = G sin θ 1 [ M 1 D 1 + ( M 2 + M 3 + M 4 + M 5 ) L 1 ]
E p o t e n t i a l θ 2 G 2 = G sin θ 2 [ M 2 D 2 + ( M 3 + M 4 + M 5 ) L 2 ]
E p o t e n t i a l θ 3 G 3 = G sin θ 3 [ M 3 D 3 ]
E p o t e n t i a l θ 4 G 4 = G sin θ 4 [ M 4 ( L 4 D 4 ) + M 5 L 4 ]
E p o t e n t i a l θ 5 G 3 = G sin θ 5 [ M 5 ( L 5 D 5 ) ]
K k i n e t i c _ 1 1 2 M 1 ( v c 1 ) 2 + 1 2 I 1 ( θ ˙ 1 ) 2 = 1 2 M 1 ( x ˙ c 1 ) 2 + 1 2 M 1 ( y ˙ c 1 ) 2 + 1 2 I 1 ( θ ˙ 1 ) 2 = 1 2 M 1 ( D 1 cos θ 1 ( θ ˙ 1 ) ) 2 + 1 2 M 1 ( D 1 sin θ 1 ( θ ˙ 1 ) ) 2 + 1 2 I 1 ( θ ˙ 1 ) 2 = 1 2 ( M 1 D 1 2 + I 1 ) ( θ ˙ 1 ) 2
K k i n e t i c _ 2 1 2 M 2 ( v c 2 ) 2 + 1 2 I 2 ( θ ˙ 2 ) 2 = 1 2 M 2 ( x ˙ c 2 ) 2 + 1 2 M 2 ( y ˙ c 2 ) 2 + 1 2 I 2 ( θ ˙ 2 ) 2 = 1 2 ( M 2 D 2 2 + I 2 ) ( θ ˙ 2 ) 2 + 1 2 ( M 2 L 1 2 ) ( θ ˙ 1 ) 2 + ( M 2 D 2 L 1 ) cos ( θ 1 θ 2 ) ( θ ˙ 1 ) ( θ ˙ 2 )
K k i n e t i c _ 3 1 2 M 3 ( v c 3 ) 2 + 1 2 I 3 ( θ ˙ 3 ) 2 = 1 2 M 3 ( x ˙ c 3 ) 2 + 1 2 M 3 ( y ˙ c 3 ) 2 + 1 2 I 3 ( θ ˙ 3 ) 2 = 1 2 ( M 3 D 3 2 + I 3 ) ( θ ˙ 3 ) 2 + 1 2 M 3 { L 1 2 ( θ ˙ 1 ) 2 + L 2 2 ( θ ˙ 2 ) 2 + 2 L 1 L 2 cos ( θ 1 θ 2 ) ( θ ˙ 1 ) ( θ ˙ 2 ) + 2 L 1 D 3 cos ( θ 1 θ 3 ) ( θ ˙ 1 ) ( θ ˙ 3 ) + 2 L 2 D 3 cos ( θ 2 θ 3 ) ( θ ˙ 2 ) ( θ ˙ 3 )
K k i n e t i c _ 4 1 2 M 4 ( v c 4 ) 2 + 1 2 I 4 ( θ ˙ 4 ) 2 = 1 2 M 4 ( x ˙ c 4 ) 2 + 1 2 M 4 ( y ˙ c 4 ) 2 + 1 2 I 4 ( θ ˙ 4 ) 2 = 1 2 ( M 4 ( L 4 D 4 ) 2 + I 4 ) ( θ ˙ 4 ) 2 + 1 2 M 4 { L 1 2 ( θ ˙ 1 ) 2 + L 2 ( θ ˙ 2 ) 2 + 2 L 1 L 2 cos ( θ 1 θ 2 ) ( θ ˙ 1 ) ( θ ˙ 2 ) + 2 L 1 ( L 4 D 4 ) cos ( θ 1 + θ 4 ) ( θ ˙ 1 ) ( θ ˙ 4 ) + 2 L 2 ( L 4 D 4 ) cos ( θ 2 θ 4 ) ( θ ˙ 2 ) ( θ ˙ 4 )
K k i n e t i c _ 5 1 2 M 5 ( v c 5 ) 2 + 1 2 I 5 ( θ ˙ 5 ) 2 = 1 2 M 5 ( x ˙ c 5 ) 2 + 1 2 M 5 ( y ˙ c 5 ) 2 + 1 2 I 5 ( θ ˙ 5 ) 2 = 1 2 ( M 5 ( L 5 D 5 ) 2 + I 5 ) ( θ ˙ 5 ) 2 + 1 2 M 5 { L 1 2 ( θ ˙ 1 ) 2 + L 2 ( θ ˙ 2 ) 2 + 2 L 1 L 2 cos ( θ 1 θ 2 ) ( θ ˙ 1 ) ( θ ˙ 2 ) + 2 L 1 L 4 cos ( θ 1 + θ 4 ) ( θ ˙ 1 ) ( θ ˙ 4 ) + 2 L 2 L 4 cos ( θ 2 + θ 4 ) ( θ ˙ 2 ) ( θ ˙ 4 ) + 2 L 1 ( L 5 D 5 ) cos ( θ 1 + θ 5 ) ( θ ˙ 1 ) ( θ ˙ 5 ) + 2 L 2 ( L 5 D 5 ) cos ( θ 2 + θ 5 ) ( θ ˙ 2 ) ( θ ˙ 5 ) + 2 L 4 ( L 5 D 5 ) cos ( θ 4 θ 5 ) ( θ ˙ 4 ) ( θ ˙ 5 )
E k i n e t i c = K k i n e t i c _ 1 + K k i n e t i c _ 2 + K k i n e t i c _ 3 + K k i n e t i c _ 4 + K k i n e t i c _ 5
d d t ( E k i n e t i c θ ˙ 1 ) = D 11 θ ¨ 1 + D 12 θ ¨ 2 + D 13 θ ¨ 3 + D 14 θ ¨ 4 + D 15 θ ¨ 5 + H 122 ( θ ˙ 2 ) 2 + H 133 ( θ ˙ 3 ) 2 + H 144 ( θ ˙ 4 ) 2 + H 155 ( θ ˙ 5 ) 2 [ M 2 D 2 L 1 + ( M 3 + M 4 + M 5 ) L 1 L 2 ] sin ( θ 1 θ 2 ) ( θ ˙ 1 ) ( θ ˙ 2 ) [ M 3 L 1 D 3 ] sin ( θ 1 θ 3 ) ( θ ˙ 1 ) ( θ ˙ 3 ) [ M 4 L 1 ( L 4 D 4 ) + M 5 L 1 L 4 ] sin ( θ 1 + θ 4 ) ( θ ˙ 1 ) ( θ ˙ 4 ) [ M 5 L 1 ( L 5 D 5 ) ] sin ( θ 1 + θ 5 ) ( θ ˙ 1 ) ( θ ˙ 5 )
D 11 [ I 1 + M 1 D 1 2 + ( M 2 + M 3 + M 4 + M 5 ) L 1 2 ]
D 12 [ M 2 D 2 L 1 + ( M 3 + M 4 + M 5 ) L 1 L 2 ] cos ( θ 1 θ 2 )
D 13 [ M 3 L 1 D 3 ] cos ( θ 1 θ 3 )
D 14 [ M 4 L 1 ( L 4 D 4 ) + M 5 L 1 L 4 ] cos ( θ 1 + θ 4 )
D 15 [ M 5 L 1 ( L 5 D 5 ) ] cos ( θ 1 + θ 5 )
H 122 [ M 2 D 2 L 1 + ( M 3 + M 4 + M 5 ) L 1 L 2 ] sin ( θ 1 θ 2 )
H 133 [ M 3 L 1 D 3 ] sin ( θ 1 θ 3 )
H 144 [ M 4 L 1 ( L 4 D 4 ) + M 5 L 1 L 4 ] sin ( θ 1 + θ 4 )
H 155 [ M 5 L 1 ( L 5 D 5 ) ] sin ( θ 1 + θ 5 )
E k i n e t i c θ 1 = [ M 2 D 2 L 1 + ( M 3 + M 4 + M 5 ) L 1 L 2 ] sin ( θ 1 θ 2 ) ( θ ˙ 1 ) ( θ ˙ 2 ) [ M 3 L 1 D 3 ] sin ( θ 1 θ 3 ) ( θ ˙ 1 ) ( θ ˙ 3 ) [ M 4 L 1 ( L 4 D 4 ) + M 5 L 1 L 4 ] sin ( θ 1 + θ 4 ) ( θ ˙ 1 ) ( θ ˙ 4 ) [ M 5 L 1 ( L 5 D 5 ) ] sin ( θ 1 + θ 5 ) ( θ ˙ 1 ) ( θ ˙ 5 )
d d t ( E k i n e t i c θ ˙ 2 ) = D 21 θ ¨ 1 + D 22 θ ¨ 2 + D 23 θ ¨ 3 + D 24 θ ¨ 4 + D 25 θ ¨ 5 + H 211 ( θ ˙ 1 ) 2 + H 233 ( θ ˙ 3 ) 2 + H 244 ( θ ˙ 4 ) 2 + H 255 ( θ ˙ 5 ) 2 + [ M 2 L 1 D 2 + ( M 3 + M 4 + M 5 ) L 1 L 2 ] sin ( θ 1 θ 2 ) ( θ ˙ 1 ) ( θ ˙ 2 ) [ M 3 L 2 D 3 ] sin ( θ 2 θ 3 ) ( θ ˙ 2 ) ( θ ˙ 3 ) [ M 4 L 2 ( L 4 D 4 ) + M 5 L 2 L 4 ] sin ( θ 2 + θ 4 ) ( θ ˙ 2 ) ( θ ˙ 4 ) [ M 5 L 2 ( L 5 D 5 ) ] sin ( θ 2 + θ 5 ) ( θ ˙ 2 ) ( θ ˙ 5 )
D 21 [ M 2 L 1 D 2 + ( M 3 + M 4 + M 5 ) L 1 L 2 ] cos ( θ 1 θ 2 ) = D 12
D 22 [ I 2 + M 2 D 2 2 + ( M 3 + M 4 + M 5 ) L 2 2 ]
D 23 [ M 3 L 2 D 3 ] cos ( θ 2 θ 3 )
D 24 [ M 4 L 2 ( L 4 D 4 ) + M 5 L 2 L 4 ] cos ( θ 2 + θ 4 )
D 25 [ M 5 L 2 ( L 5 D 5 ) ] cos ( θ 2 + θ 5 )
H 211 [ M 2 L 1 D 2 + ( M 3 + M 4 + M 5 ) L 1 L 2 ] sin ( θ 1 θ 2 )
H 233 [ M 3 L 2 D 3 ] sin ( θ 2 θ 3 )
H 244 [ M 4 L 2 ( L 4 D 4 ) + M 5 L 2 L 4 ] sin ( θ 2 + θ 4 )
H 255 [ M 5 L 2 ( L 5 D 5 ) ] sin ( θ 2 + θ 5 )
E k i n e t i c θ 2 = [ M 2 L 1 D 2 + ( M 3 + M 4 + M 5 ) L 1 L 2 ] sin ( θ 1 θ 2 ) ( θ ˙ 1 ) ( θ ˙ 2 ) [ M 3 L 2 D 3 ] sin ( θ 2 θ 3 ) ( θ ˙ 2 ) ( θ ˙ 3 ) [ M 4 L 2 ( L 4 D 4 ) + M 5 L 2 L 4 ] sin ( θ 2 + θ 4 ) ( θ ˙ 2 ) ( θ ˙ 4 ) [ M 5 L 2 ( L 5 D 5 ) ] sin ( θ 2 + θ 5 ) ( θ ˙ 2 ) ( θ ˙ 5 )
d d t ( E k i n e t i c θ ˙ 3 ) = D 31 θ ¨ 1 + D 32 θ ¨ 2 + D 33 θ ¨ 3 + D 34 θ ¨ 4 + D 35 θ ¨ 5 + H 311 ( θ ˙ 1 ) 2 + H 322 ( θ ˙ 2 ) 2 + H 344 ( θ ˙ 4 ) 2 + H 355 ( θ ˙ 5 ) 2 + [ M 3 L 1 D 3 ] sin ( θ 1 θ 3 ) ( θ ˙ 1 ) ( θ ˙ 3 ) + [ M 3 L 2 D 3 ] sin ( θ 2 θ 3 ) ( θ ˙ 2 ) ( θ ˙ 3 )
D 31 [ M 3 L 1 D 3 ] cos ( θ 1 θ 3 ) = D 13
D 32 [ M 3 L 2 D 3 ] cos ( θ 2 θ 3 ) = D 23
D 33 [ I 3 + M 3 D 3 2 ]
D 34 0
D 35 0
H 311 [ M 3 L 1 D 3 ] sin ( θ 1 θ 3 )
H 322 [ M 3 L 2 D 3 ] sin ( θ 2 θ 3 )
H 344 0
H 355 0
E k i n e t i c θ 3 = [ M 3 L 1 D 3 ] sin ( θ 1 θ 3 ) ( θ ˙ 1 ) ( θ ˙ 3 ) + [ M 3 L 2 D 3 ] sin ( θ 2 θ 3 ) ( θ ˙ 2 ) ( θ ˙ 3 )
d d t ( E k i n e t i c θ ˙ 4 ) = D 41 θ ¨ 1 + D 42 θ ¨ 2 + D 43 θ ¨ 3 + D 44 θ ¨ 4 + D 45 θ ¨ 5 + H 411 ( θ ˙ 1 ) 2 + H 422 ( θ ˙ 2 ) 2 + H 433 ( θ ˙ 3 ) 2 + H 455 ( θ ˙ 5 ) 2 [ M 4 L 1 ( L 4 D 4 ) + M 5 L 1 L 4 ] sin ( θ 1 + θ 4 ) ( θ ˙ 1 ) ( θ ˙ 4 ) [ M 4 L 2 ( L 4 D 4 ) + M 5 L 2 L 4 ] sin ( θ 2 + θ 4 ) ( θ ˙ 2 ) ( θ ˙ 4 ) [ M 5 L 4 ( L 5 D 5 ) ] sin ( θ 4 θ 5 ) ( θ ˙ 4 ) ( θ ˙ 5 )
D 41 [ M 4 L 1 ( L 4 D 4 ) + M 5 L 1 L 4 ] cos ( θ 1 + θ 4 ) = D 14
D 42 [ M 4 L 2 ( L 4 D 4 ) + M 5 L 2 L 4 ] cos ( θ 2 + θ 4 ) = D 24
D 43 0 = D 34
D 44 [ I 4 + M 4 ( L 4 D 4 ) 2 + M 5 L 4 2 ]
D 45 [ M 5 L 4 ( L 5 D 5 ) ] cos ( θ 4 θ 5 ) = D 54
H 411 [ M 4 L 1 ( L 4 D 4 ) + M 5 L 1 L 4 ] sin ( θ 1 + θ 4 )
H 422 [ M 4 L 2 ( L 4 D 4 ) + M 5 L 2 L 4 ] sin ( θ 2 + θ 4 )
H 433 0
H 455 [ M 5 L 4 ( L 5 D 5 ) ] sin ( θ 4 θ 5 )
E k i n e t i c θ 4 = [ M 4 L 1 ( L 4 D 4 ) + M 5 L 1 L 4 ] sin ( θ 1 + θ 4 ) ( θ ˙ 1 ) ( θ ˙ 4 ) [ M 4 L 2 ( L 4 D 4 ) + M 5 L 2 L 4 ] sin ( θ 2 + θ 4 ) ( θ ˙ 2 ) ( θ ˙ 4 ) [ M 5 L 4 ( L 5 D 5 ) ] sin ( θ 4 θ 5 ) ( θ ˙ 4 ) ( θ ˙ 5 )
d d t ( E k i n e t i c θ ˙ 5 ) = D 51 θ ¨ 1 + D 52 θ ¨ 2 + D 53 θ ¨ 3 + D 54 θ ¨ 4 + D 55 θ ¨ 5 + H 511 ( θ ˙ 1 ) 2 + H 522 ( θ ˙ 2 ) 2 + H 533 ( θ ˙ 3 ) 2 + H 544 ( θ ˙ 4 ) 2 [ M 5 L 1 ( L 5 D 5 ) ] sin ( θ 1 + θ 5 ) ( θ ˙ 1 ) ( θ ˙ 5 ) [ M 5 L 2 ( L 5 D 5 ) ] sin ( θ 2 + θ 5 ) ( θ ˙ 2 ) ( θ ˙ 5 ) [ M 5 L 4 ( L 5 D 5 ) ] sin ( θ 4 θ 5 ) ( θ ˙ 4 ) ( θ ˙ 5 )
D 51 [ M 5 L 1 ( L 5 D 5 ) ] cos ( θ 1 + θ 5 ) = D 15
D 52 [ M 5 L 2 ( L 5 D 5 ) ] cos ( θ 2 + θ 5 ) = D 25
D 53 0 = D 35
D 54 [ M 5 L 4 ( L 5 D 5 ) ] cos ( θ 4 θ 5 ) = D 45
D 55 [ I 5 + M 5 ( L 5 D 5 ) 2 ]
H 511 [ M 5 L 1 ( L 5 D 5 ) ] sin ( θ 1 + θ 5 )
H 522 [ M 5 L 2 ( L 5 D 5 ) ] sin ( θ 2 + θ 5 )
H 533 0
H 544 [ M 5 L 4 ( L 5 D 5 ) ] sin ( θ 4 θ 5 )
where M 1 = M 5 = 4.55 kg, M 2 = M 4 = 7.63 kg , M 3 = 49.00 kg are the masses of link1~link5, M 2 , M 4 denote the masses of exoskeleton thighs, M 1 , M 5 denote the masses of legs, M 3 denotes the mass of torso, L 1 = L 5 = 0.502 m, L 2 = L 4 = 0.431 m are the lengths of link1, 2, 4, 5, D 1 = D 5 = 0.247 m, D 2 = D 4 = 0.247 m , D 3 = 0.280 m are the distances between the mass centers of link1, 2, 3, 4, 5 and those lower joints, I 1 = I 5 = 0.105 kg·m2, I 2 = I 4 = 0.089 kg·m2, I 3 = 2.350 kg·m2, are the moments of rotational inertias for link1, 2, 3, 4, 5 and G = 9.8 m/s2 is the acceleration of gravity.
Substituting (A12)~(A76) into (1)~(2) yields
[ D ˜ ( θ ) ] θ ¨ + [ H ˜ ( θ , θ ˙ ) ] + G ˜ ( θ ) = [ τ ( θ , θ ˙ , θ ¨ ) ]
where
D ˜ ( θ ) [ D 11 D 12 D 13 D 14 D 15 D 12 D 22 D 23 D 24 D 25 D 13 D 23 D 33 0 0 D 14 D 24 0 D 44 D 45 D 15 D 25 0 D 45 D 55 ]
H ˜ ( θ , θ ˙ ) [ H 1 H 2 H 3 H 4 H 5 ] T
H 1 = H 122 ( θ ˙ 2 ) 2 + H 133 ( θ ˙ 3 ) 2 + H 144 ( θ ˙ 4 ) 2 + H 155 ( θ ˙ 5 ) 2
H 2 = H 211 ( θ ˙ 1 ) 2 + H 233 ( θ ˙ 3 ) 2 + H 244 ( θ ˙ 4 ) 2 + H 255 ( θ ˙ 5 ) 2
H 3 = H 311 ( θ ˙ 1 ) 2 + H 322 ( θ ˙ 2 ) 2 + H 344 ( θ ˙ 4 ) 2 + H 355 ( θ ˙ 5 ) 2
H 4 = H 411 ( θ ˙ 1 ) 2 + H 422 ( θ ˙ 2 ) 2 + H 433 ( θ ˙ 3 ) 2 + H 455 ( θ ˙ 5 ) 2
H 5 = H 511 ( θ ˙ 1 ) 2 + H 533 ( θ ˙ 2 ) 2 + H 533 ( θ ˙ 3 ) 2 + H 544 ( θ ˙ 4 ) 2
G ˜ ( θ ) [ G 1 G 2 G 3 G 4 G 5 ] T
θ [ θ 1 θ 2 θ 3 θ 4 θ 5 ] T
θ ¨ [ θ ¨ 1 θ ¨ 2 θ ¨ 3 θ ¨ 4 θ ¨ 5 ] T
θ ˙ [ θ ˙ 1 θ ˙ 2 θ ˙ 3 θ ˙ 4 θ ˙ 5 ] T
τ [ τ 1 τ 2 τ 3 τ 4 τ 5 ] T
Define the input, output, state, noise and matched uncertainty variables of the FLHBR to be u i p [ τ 1 τ 5 ] T = [ u i p _ 1 u i p _ 5 ] T , u o p [ θ 1 θ 5 ] T , x s e [ x s e _ 1 x s e _ 10 ] T , x s e _ 1 = θ 1 , x s e _ 2 = θ ˙ 1 , x s e _ 3 = θ 2 , x s e _ 4 = θ ˙ 2 , x s e _ 5 = θ 3 , x s e _ 6 = θ ˙ 3 , x s e _ 7 = θ 4 , x s e _ 8 = θ ˙ 4 , x s e _ 9 = θ 5 , x s e _ 10 = θ ˙ 5 , j = 1 p q n o i s e _ j * Ω n _ j , j = 1 p q n o i s e _ j * Ω u n _ j . Then the dynamic equation of the FLHBR system can be derived shown in (3)~(51).

Appendix B

In this appendix, we prove that the proposed feedback linearization control can achieve the almost all disturbance decoupling performance. Properly design the composite Lyapunov functions [35] L f _ l for transformed subsystem (125)~(126) to be
L f _ l = k [ L f _ l 1 + + L f _ l 5 ]
and
L f _ l i 1 2 e t r _ t r a c k i ¯ T E L i e t r _ t r a c k i ¯
Then, the differentiation of the composite Lyapunov function is given by
d d t ( L f _ l ) = k 2 [ ( e t r _ t r a c k 1 ¯ ) T E L 1 e t r _ t r a c k 1 ¯ + ( e t r _ t r a c k 1 ¯ ) T E L 1 ( e t r _ t r a c k 1 ¯ ) + + ( e t r _ t r a c k 5 ¯ ) T E L 5 e t r _ t r a c k 5 ¯ + ( e t r _ t r a c k 5 ¯ ) T E L 5 ( e t r _ t r a c k 5 ¯ ) ] = k 2 ε ( e t r _ t r a c k 1 ¯ ) T [ E L 1 ( A L 1 ) + ( A L 1 ) T E L 1 ] e t r _ t r a c k 1 ¯ + + k 2 ε ( e t r _ t r a c k 5 ¯ ) T [ E L 5 ( A L 5 ) + ( A L 5 ) T E L 5 ] e t r _ t r a c k 5 ¯ + k ε { ( Ω u n + Ω n ) T [ ( φ Τ l 1 ) T E L 1 e t r _ t r a c k 1 ¯ + + ( φ Τ l 5 ) T E L 5 e t r _ t r a c k 5 ¯ ] } + k ε { ( Ω u n + Ω n ) T [ ( φ Τ l 1 ) T E L 1 e t r _ t r a c k 1 ¯ + + ( φ Τ l 5 ) T E L 5 e t r _ t r a c k 5 ¯ ] } k 2 ε [ e t r _ t r a c k 1 ¯ 2 + + e t r _ t r a c k 5 ¯ 2 ] + k ε { ( Ω u n + Ω n ) T [ ( φ Τ l 1 ) T E L 1 e t r _ t r a c k 1 ¯ + + ( φ Τ l 5 ) T E L 5 e t r _ t r a c k 5 ¯ ] } k 2 ε [ e t r _ t r a c k 1 ¯ 2 + + e t r _ t r a c k 5 ¯ 2 ] + k ε [ ( Ω u n + Ω n ) ( φ Τ l 1 E L 1 e t r _ t r a c k 1 ¯ + + φ Τ l 5 E L 5 e t r _ t r a c k 5 ¯ ) ] k ε [ L f _ l i λ max ( E L 1 ) + + L f _ l 5 λ max ( E L 5 ) ] + 529 46 k 2 ε 2 φ Τ l 1 2 E L 1 2 e t r _ t r a c k 1 ¯ 2 + 1 46 ( Ω u n + Ω n ) 2 + + 529 46 k 2 ε 2 φ Τ l 5 2 E L 5 2 e t r _ t r a c k 5 ¯ 2 + 1 46 ( Ω u n + Ω n ) 2 k ε 1 λ max * L f _ l + 529 46 k 2 ε 2 φ Τ l 1 2 E L 1 2 e t r _ t r a c k 1 ¯ 2 + 1 46 ( Ω u n + Ω n ) 2 + + 529 46 k 2 ε 2 φ Τ l 5 2 E L 5 2 e t r _ t r a c k 5 ¯ 2 + 1 46 ( Ω u n + Ω n ) 2 ( 1 ε λ max * 529 46 k φ Τ l 1 2 E L 1 2 1 2 ε 2 λ min ( E L 1 ) 529 46 k φ Τ l 5 2 E L 5 2 1 2 ε 2 λ min ( E L 5 ) ) ( k ( L f _ l ) ) 2 + 0.1304 ( Ω u n + Ω n ) 2 = P ( k ( L f _ l ) ) 2 + 0.1304 ( Ω u n + Ω n ) 2
where
P = 1 ε λ max * ( 529 46 ) k ( ε ) φ Τ l 1 2 E L 1 2 1 2 ε 2 λ min ( E L 1 ) ( 529 46 ) k ( ε ) φ Τ l 5 2 E L 5 2 1 2 ε 2 λ min ( E L 5 ) > 0
i.e.,
d d t ( L f _ l ) P L f _ l + 0.1304 ( Ω u n + Ω n ) 2
Define
α s ( ε ) P 2
S 2 α s ( ε )
S 1 0.1304 ( sup t 0 τ t ( Ω u n + Ω n ) ) 2
S 2 k ( ε ) 2 λ min *
Then
d d t ( L f _ l ) 2 α s L f _ l + 0.1304 ( Ω u n + Ω n ) 2 S S 2 ( e t r _ t r a c k ¯ 2 ) + 0.1304 ( Ω u n + Ω n ) 2
Let the tracking error e t r _ t r a c k ¯ of the transformed system be
e t r _ t r a c k ¯ [ e t r _ t r a c k 1 ¯ e t r _ t r a c k 5 ¯ ] T [ e t r _ 1 1 ¯ e t r _ r e m 1 ¯ ] T , e t r _ r e m 1 ¯ d v r f 1
Then we obtain
d d t ( L f _ l ) S S 2 ( e t r _ 1 1 ¯ 2 + e t r _ r e m 1 ¯ 2 ) + 0.1304 ( Ω u n + Ω n ) 2
Firstly, applying (A101) easily yields
d d t ( L f _ l ) + S S 2 e t r _ 1 1 ¯ 2 S S 2 ( e t r _ r e m 1 ¯ 2 ) + 0.1304 ( Ω u n + Ω n ) 2 0.1304 ( Ω u n + Ω n ) 2
i.e.,
d d t ( L f _ l ) + S S 2 e t r _ 1 1 ¯ 2 0.1304 ( Ω u n + Ω n ) 2
Integrate both sides of (A103) to obtain
L f _ l ( t ) L f _ l ( t 0 ) + S S 2 t 0 t ( u o p _ 1 ( τ ) u o p _ t r a c k 1 ( τ ) ) 2 d τ 0.1304 t 0 t ( Ω u n + Ω n ) 2 d τ
i.e.,
S S 2 t 0 t ( u o p _ 1 ( τ ) u o p _ t r a c k 1 ( τ ) ) 2 d τ L f _ l ( t 0 ) + 0.1304 t 0 t ( Ω u n + Ω n ) 2 d τ
hence
t 0 t ( u o p _ 1 ( τ ) u o p _ t r a c k 1 ( τ ) ) 2 d τ L f _ l ( t 0 ) S S 2 + 0.1304 S S 2 t 0 t ( Ω u n + Ω n ) 2 d τ
Similarly, we obtain the tracking error for u o p _ i , 2 i 5 as
t 0 t ( u o p _ i ( τ ) u o p _ t r a c k i ( τ ) ) 2 d τ L f _ l ( t 0 ) S S 2 + 0.1304 S S 2 t 0 t ( Ω u n + Ω n ) 2 d τ , 2 i 5
Therefore, we verify the significant result that the third condition of the almost disturbance decoupling performance is well proved.
Next, we need to prove that the first condition of the almost disturbance decoupling performance holds. From (A101), we can obtain
d d t ( L f _ l ) S S 2 ( e t r _ t r a c k ¯ 2 ) + 0.1304 ( Ω u n + Ω n ) 2
Define
u o p _ t r a c k t o t a l 2 e t r _ t r a c k ¯ 2
From (A108) and (A109), we obtain
d d t ( L f _ l ) S S 2 ( u o p _ t r a c k t o t a l 2 ) + 0.1304 ( Ω u n + Ω n ) 2
i.e.,
d d t ( L f _ l ) ( S S 2 1 ) ( u o p _ t r a c k t o t a l 2 ) u o p _ t r a c k t o t a l 2 + 0.1304 ( Ω u n + Ω n ) 2
According to the following inequality, the output state trajectory is located in the outside of the global ultimate attractor:
u o p _ t r a c k t o t a l 2 + 0.1304 ( Ω u n + Ω n ) 2 < 0
We obtain
d d t ( L f _ l ) ( S S 2 1 ) ( u o p _ t r a c k t o t a l 2 )
From (A90) and (A91), we obtain
L f _ l = k [ L f _ l 1 + + L f _ l 5 ] k 1 2 { λ max ( E L 1 ) e t r _ t r a c k 1 ¯ + + λ max ( E L 5 ) e t r _ t r a c k 5 ¯ } k 1 2 λ max * { e t r _ t r a c k 1 ¯ + + e t r _ t r a c k 5 ¯ }
Let Q max k 2 λ max * and we obtain
L f _ l Q max ( u o p _ t r a c k t o t a l 2 )
Similarly, we obtain
L f _ l = k [ L f _ l 1 + + L f _ l 5 ] k 1 2 { λ min ( E L 1 ) e t r _ t r a c k 1 ¯ + + λ min ( E L 5 ) e t r _ t r a c k 5 ¯ } k 1 2 λ min * { e t r _ t r a c k 1 ¯ + + e t r _ t r a c k 5 ¯ }
Let Q min k 2 λ min * and we obtain
L f _ l Q min ( u o p _ t r a c k t o t a l 2 )
Combining (A115) and (A117) yields
Q min ( u o p _ t r a c k t o t a l 2 ) L f _ l Q max ( u o p _ t r a c k t o t a l 2 )
(A112), (A113) and (A118) imply that the system is in the input-to-state stable state for the disturbance input. Then the input-to-state stable theorem in [32] concludes the significant result that the first condition of the almost disturbance decoupling performance is completely verified.
Next, we need to prove that the second condition of the almost disturbance decoupling performance holds.
Combining (A108), (A109), (A118) and (A97) yields
d d t ( L f _ l ) S S 2 Q max L f _ l + S 1
Use the comparison theorem in [33] for (A119) to obtain
L f _ l ( t ) L f _ l ( t 0 ) exp ( S S 2 Q max ( t t 0 ) ) + Q max S 1 S S 2 , t t 0
Then, we obtain the tracking error with integral sense to be
| u o p _ 1 ( t ) u o p _ t r a c k 1 ( t ) | 2 L f _ l ( t 0 ) k λ min * exp ( S S 2 2 Q max ( t t 0 ) ) + 2 Q max S 1 k λ min * S S 2
and
| u o p _ i ( t ) u o p _ t r a c k i ( t ) | 2 L f _ l ( t 0 ) k λ min * exp ( S S 2 2 Q max ( t t 0 ) ) + 2 Q max S 1 k λ min * S S 2 , 2 i 5
So, we can prove that the second condition of the almost disturbance decoupling performance holds, and the convergent rate is given by S S 2 / 2 Q max .
Combining (A108) and (A109) yields
d d t (   L f _ l ) S S 2 ( u o p _ t r a c k t o t a l 2 ) + S 1
Let us consider the range u o p _ t r a c k t o t a l > r _ , r _ S 1 S S 2 . It is an easy routine to obtain d d t ( L f _ l ) < 0 , and then the global ultimate attractor of the transformed system is written by
B r _ { [ e t r _ t r a c k ¯ ] : e t r _ t r a c k ¯ 2 r _ }
with the convergent radius _ r _ S 1 S S 2 .
Next, we need to prove the globally exponential stability of the transformed system. Combining (A118) and (A120) obtains
L f _ l ( t ) L f _ l ( t 0 ) exp ( S S 2 Q max ( t t 0 ) ) + Q max S 1 S S 2
and
Q min u o p _ t r a c k t o t a l 2 L f _ l L f _ l ( t 0 ) exp ( S S 2 Q max ( t t 0 ) ) + Q max S 1 S S 2 Q max u o p _ t r a c k t o t a l ( t 0 ) 2 exp ( S S 2 Q max ( t t 0 ) ) + Q max S 1 S S 2
Then
u o p _ t r a c k t o t a l 2 Q max Q min u o p _ t r a c k t o t a l ( t 0 ) 2 exp ( S S 2 Q max ( t t 0 ) ) + S 1 S S 2 Q max Q min
Then we can conclude the significant result that the globally exponential stability of the transformed system is well proved.

References

  1. Vatankhah, M.; Kobravi, H.; Ritter, A. Bio-inspired Model of Humanoid Robot for Ascending Movement. In Proceedings of thein 2019 41st Annual International Conference of the IEEE Engineering in Medicine and Biology Society (EMBC), Berlin, Germany, 23–27 July 2019; pp. 5287–5290. [Google Scholar]
  2. Seleem, I.A.; Assal, S.F.M.; Mohamed, A.M. Cyclic gait planning and control of underactuated five-link biped robot during single support and impact phases for normal walking. In Proceedings of the 2018 IEEE International Conference on Industrial Technology (ICIT), Lyon, France, 20–22 February 2018; pp. 123–128. [Google Scholar]
  3. Shen, J.; Hong, D. A Novel Model Predictive Control Framework Using Dynamic Model Decomposition Applied to Dynamic Legged Locomotion. In Proceedings of the 2021 IEEE International Conference on Robotics and Automation (ICRA), Xi’an, China, 30 May–5 June 2021; pp. 4926–4932. [Google Scholar]
  4. Yuan, H.; Song, S.; Du, R.; Zhu, S.; Gu, J.; Zhao, M.; Pang, J. A Capturability-based Control Framework for the Underactuated Bipedal Walking. In Proceedings of the 2021 IEEE International Conference on Robotics and Automation (ICRA), Xi’an, China, 30 May–5 June 2021; pp. 6804–6810. [Google Scholar]
  5. Yang, W.; Posa, M. Impact Invariant Control with Applications to Bipedal Locomotion. In Proceedings of the 2021 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Prague, Czech Republic, 27 September–1 October 2021; pp. 5151–5158. [Google Scholar]
  6. Seleem, I.A.; Assal, S.F.M. Sliding mode control of underactuated five-link biped robot for climbing stairs based on real human data. In Proceedings of the 2017 IEEE International Conference on Industrial Technology (ICIT), Toronto, ON, Canada, 22–25 March 2017; pp. 878–883. [Google Scholar]
  7. Fevre, M.; Lin, H.; Schmiedeler, J.P. Stability and Gait Switching of Underactuated Biped Walkers. In Proceedings of the 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Macau, China, 3–8 November 2019; pp. 2279–2285. [Google Scholar]
  8. Tabar, A.F.; Khoogar, A.R.; Vali, A.R. Neural Network Control of a New Biped Robot Model with Back Propagation Algorithm. In Proceedings of the 16th IEEE International Symposium on Robot and Human Interactive Communication, Jeju, Republic of Korea, 26–29 August 2007; pp. 1191–1196. [Google Scholar]
  9. Vaghei, Y.; Ghanbari, A.; Noorani, S.M.R.S. Actor-critic neural network reinforcement learning for walking control of a 5-link bipedal robot. In Proceedings of the 2014 Second RSI/ISM International Conference on Robotics and Mechatronics (ICRoM), Tehran, Iran, 15–17 October 2014; pp. 773–778. [Google Scholar]
  10. Saglam, C.O.; Byl, K. Stability and gait transition of the five-link biped on stochastically rough terrain using a discrete set of sliding mode controllers. In Proceedings of the 2013 IEEE International Conference on Robotics and Automation, Karlsruhe, Germany, 6–10 May 2013; pp. 5675–5682. [Google Scholar]
  11. Naimi, A.; Deng, J.; Vajpayee, V.; Becerra, V.; Shimjith, S.R.; Arul, A.J. Nonlinear Model Predictive Control Using Feedback Linearization for a Pressurized Water Nuclear Power Plant. IEEE Access 2022, 10, 16544–16555. [Google Scholar] [CrossRef]
  12. Post, D.C.; Schmiedeler, J.P. Velocity disturbance rejection for planar bipeds walking with HZD-based control. In Proceedings of the 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems, Chicago, IL, USA, 14–18 September 2014; pp. 4882–4887. [Google Scholar]
  13. Huang, T.Y.; Wu, S.H.; Tran, H.K. Gait control of a biped robot using an exact limit cycle trajectory and the backstepping method. In Proceedings of the SICE Annual Conference 2010, Taipei, Taiwan, 18–21 August 2010; pp. 1819–1824. [Google Scholar]
  14. Juang, J.-G. Fuzzy neural network approaches for robotic gait synthesis. IEEE Trans. Syst. Man Cybern. Part B (Cybernetics) 2000, 30, 594–601. [Google Scholar] [CrossRef] [PubMed]
  15. Wu, H.M.; Hwang, C.L. Trajectory-based control under ZMP constraint for the 3D biped walking via fuzzy control. In Proceedings of the 2011 IEEE International Conference on Fuzzy Systems (FUZZ-IEEE 2011), Taipei, Taiwan, 27–30 June 2011; pp. 706–712. [Google Scholar]
  16. Imani, B.; Ghanbari, A.; Noorani, S. Modeling, path planning and control of a planar five-link bipedal robot by an adaptive fuzzy computed torque controller (AFCTC). In Proceedings of the 2013 First RSI/ISM International Conference on Robotics and Mechatronics (ICRoM), Tehran, Iran, 13–15 February 2013; pp. 49–54. [Google Scholar]
  17. Zaoui, C.; Abrougui, H.; Meftah, M.A.; Hachicha, S.; Moulhi, A.; Dallagi, H. Mechanical Design and Control of an Arm with Two Degrees of Freedom for Inspection and Cleaning Operations. In Proceedings of the 2022 5th International Conference on Advanced Systems and Emergent Technologies (IC_ASET), Hammamet, Tunisia, 22–25 March 2022; pp. 532–537. [Google Scholar]
  18. Rouch, T.B.; Allahverdy, D.; Fakharian, A. Adaptive Controller for Swash Mass Helicopter based on Reinforcement Learning Algorithm. In Proceedings of the 2022 8th International Conference on Control, Instrumentation and Automation (ICCIA), Tehran, Iran, 2–3 March 2022; pp. 1–6. [Google Scholar]
  19. Lu, T.; Itagaki, F.; Nagatsu, Y.; Hashimoto, H. Dynamics and transformation control of a wheeled inverted pendulum mobile robot. In Proceedings of the 2022 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM), Sapporo, Japan, 11–15 July 2022; pp. 463–468. [Google Scholar]
  20. Xavier, M.S.; Fleming, A.J.; Yong, Y.K. Nonlinear Estimation and Control of Bending Soft Pneumatic Actuators Using Feedback Linearization and UKF. IEEE/ASME Trans. Mechatron. 2022, 27, 1919–1927. [Google Scholar] [CrossRef]
  21. Sun, Y.; Zhu, J.; Fu, C.; Chen, Z. Decoupling Control of Cascaded Power Electronic Transformer Based on Feedback Exact Linearization. IEEE J. Emerg. Sel. Top. Power Electron. 2022, 10, 3662–3676. [Google Scholar] [CrossRef]
  22. Busada, C.A.; Jorge, S.G.; Solsona, J.A. Feedback Linearization of a Grid-Tied Synchronverte. IEEE Trans. Ind. Electron. 2023, 70, 147–154. [Google Scholar] [CrossRef]
  23. Marino, R.; Respondek, W.; Schaft, A.J.V.D. Almost disturbance decoupling for single-input single-output nonlinear systems. IEEE Trans. Automat. Contr. 1989, 34, 1013–1017. [Google Scholar] [CrossRef] [Green Version]
  24. Marino, R.; Tomei, P. Nonlinear output feedback tracking with almost disturbance decoupling. IEEE Trans. Automat. Contr. 1999, 44, 18–28. [Google Scholar] [CrossRef]
  25. Zhang, C.H.; Wang, Z.; Cai, B.; Sun, Z.Y.; Tan, Q.Q. Adaptive almost disturbance decoupling for a class of uncertain nonlinear systems. In Proceedings of the 2017 36th Chinese Control Conference (CCC), Dalian, China, 26–28 July 2017; pp. 644–649. [Google Scholar]
  26. Ito, Y.; Fujimoto, K.; Tadokoro, Y. Kernel-Based Hamilton–Jacobi Equations for Data-Driven Optimal and H-Infinity Control. IEEE Access 2020, 8, 131047–131062. [Google Scholar] [CrossRef]
  27. Rotondo, D. Weighted Linearization of Nonlinear Systems. IEEE Trans. Circuits Syst. II Express Briefs 2022, 69, 3239–3243. [Google Scholar] [CrossRef]
  28. Drexler, D.A.; Ghita, M.; Kovács, L. On the relative degree of perturbed nonlinear systems. In Proceedings of the 2022 13th Asian Control Conference (ASCC), Jeju, Republic of Korea, 4–7 May 2022; pp. 1759–1764. [Google Scholar]
  29. Willigenburg, L.G.V.; Stigter, J.D.; Molenaar, J. Establishing local strong accessibility of large-scale nonlinear systems by replacing the Lie algebraic rank condition. In Proceedings of the 2021 European Control Conference (ECC), Rotterdam, The Netherlands, 29 June–2 July 2021; pp. 2645–2650. [Google Scholar]
  30. Isidori, A. Nonlinear Control System; Springer: New York, NY, USA, 1989. [Google Scholar]
  31. Yuan, S.; Lv, M.; Baldi, S.; Zhang, L. Lyapunov-Equation-Based Stability Analysis for Switched Linear Systems and Its Application to Switched Adaptive Control. IEEE Trans. Autom. Control 2021, 66, 2250–2256. [Google Scholar] [CrossRef]
  32. Zhang, K.K.; Zhou, B.; Duan, G.R. Prescribed-Time Input-to-State Stabilization of Normal Nonlinear Systems by Bounded Time-Varying Feedback. IEEE Trans. Circuits Syst. I Regul. Pap. 2022, 69, 3715–3725. [Google Scholar] [CrossRef]
  33. Khalil, H.K. Nonlinear Systems; Prentice-Hall: Hoboken, NJ, USA, 1996. [Google Scholar]
  34. Sharkawy, A.N.; Koustoumpardis, P.N. Dynamics and Computed-Torque Control of a 2-DOF manipulator: Mathematical Analysis. Int. J. Adv. Sci. Technol. 2019, 28, 201–212. [Google Scholar]
  35. Immanuel, G.Y.; Abate, M.; Feron, E. Lyapunov Differential Equation Hierarchy and Polynomial Lyapunov Functions for Switched Implicit Systems. In Proceedings of the 2021 American Control Conference (ACC), New Orleans, LA, USA, 25–28 May 2021; pp. 2309–2314. [Google Scholar]
Figure 1. The schematic diagram of a five-link human biped robot.
Figure 1. The schematic diagram of a five-link human biped robot.
Applsci 13 00076 g001
Figure 2. Block diagram for the proposed algorithm of designing the feedback linearization control.
Figure 2. Block diagram for the proposed algorithm of designing the feedback linearization control.
Applsci 13 00076 g002
Figure 3. The output state trajectories for ε = 0.1 .
Figure 3. The output state trajectories for ε = 0.1 .
Applsci 13 00076 g003
Figure 4. The output state trajectories for ε = 0.2 .
Figure 4. The output state trajectories for ε = 0.2 .
Applsci 13 00076 g004
Figure 5. Output state values before entering the convergent radius.
Figure 5. Output state values before entering the convergent radius.
Applsci 13 00076 g005
Figure 6. Output state values on entering the convergent radius.
Figure 6. Output state values on entering the convergent radius.
Applsci 13 00076 g006
Figure 7. Output state values after entering the convergent radius.
Figure 7. Output state values after entering the convergent radius.
Applsci 13 00076 g007
Figure 8. The system output trajectory for (177).
Figure 8. The system output trajectory for (177).
Applsci 13 00076 g008
Figure 9. The output trajectories by using PID controller.
Figure 9. The output trajectories by using PID controller.
Applsci 13 00076 g009
Table 1. The related simulation parameters.
Table 1. The related simulation parameters.
ParametersValue or Type
Step sizeauto
Numerical methodode45 (Dormand–Prince)
Solver optionsVariable step
Relative tolerance 1 × 10 3
Absolute tolerance 1 × 10 6
Output functionRefine output
Table 2. Comparison of transient dynamics for proposed approach and PID approach.
Table 2. Comparison of transient dynamics for proposed approach and PID approach.
Peak TimeSettling TimeRise TimeMaximum Overshoot
PID approachx10.43.50.23.8
x20.054.50.022.1
x30.15.80.053.7
x403.400
x50.43.80.33.8
Proposed approachx100.7500
x200.7500
x300.800
x400.800
x500.900
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Chi, K.-H.; Hsiao, Y.-F.; Chen, C.-C. Robust Feedback Linearization Control Design for Five-Link Human Biped Robot with Multi-Performances. Appl. Sci. 2023, 13, 76. https://doi.org/10.3390/app13010076

AMA Style

Chi K-H, Hsiao Y-F, Chen C-C. Robust Feedback Linearization Control Design for Five-Link Human Biped Robot with Multi-Performances. Applied Sciences. 2023; 13(1):76. https://doi.org/10.3390/app13010076

Chicago/Turabian Style

Chi, Kuang-Hui, Yung-Feng Hsiao, and Chung-Cheng Chen. 2023. "Robust Feedback Linearization Control Design for Five-Link Human Biped Robot with Multi-Performances" Applied Sciences 13, no. 1: 76. https://doi.org/10.3390/app13010076

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop