Abstract

This paper presents a unique ESO-based fuzzy sliding-mode controller (FSMC-ESO) for a 3-DOF serial-parallel hybrid humanoid arm (HHA) for the trajectory tracking control problem. The dynamic model of the HHA is obtained by Lagrange method and is nonlinear in dynamics with inertia uncertainty and external disturbance. The FSMC-ESO is based on the combination of the sliding-mode control (SMC), extended state observer (ESO) theory, and fuzzy control (FC). The SMC is insensitive to both internal parameter uncertainties and external disturbances. The motivation for using ESO is to estimate the disturbance in real-time. The fuzzy parameter self-tuning strategy is proposed to adjust the switching gain on line according to the running state of the system. The stability of the system is guaranteed in the sense of the Lyapunov stability theorem. The effectiveness and robustness of the designed FSMC-ESO are illustrated by simulations.

1. Introduction

The 3-DOF serial-parallel hybrid humanoid arm (HHA) [1, 2] is composed of a 2-DOF parallel mechanism and a 1-DOF serial mechanism, as shown in Figure 1, can be used in humanoid robots or automated production lines. Because of the special structure, the HHA combines the characteristics of series and parallel robot and is discovered in high speed and high positioning accuracy. The special structure introduces complexity in kinematics, dynamic equations, and coupling of the system and places greater demands on control methods.

Since HHA is a very complicated multiple-input multiple-output (MIMO) nonlinear system with time-varying, strong-coupling characteristics, the design of robust controllers which is suitable for real-time control of HHA is one of the most challenging tasks, especially when HHA within inertia uncertainty and external disturbance. Advanced controller of robotic is a hot field in robotic research in recent years. Various advanced control strategies, either model-based control or model-free control, have been researched to improve the motion performance of the robotics [39]. The current trend of control approaches focuses on integrating conventional control techniques (e.g., adaptive control [6, 7] and sliding-mode control [36]) with intelligent schemes (e.g., fuzzy theory [7, 8] and neural network [5]) in order to improve the performance of classical controllers.

About the control theory, the sliding-mode control is a useful and effective control scheme and is an efficient method to deal with uncertainties, time varying properties, nonlinearities, and bounded externals disturbances [35]. However, traditional SMC always has an undesired chattering phenomenon, which will inspire high-frequency unmodeled dynamics of the system and will eventually cause the loss of stability of system. Many methods are proposed to solve the chatting problem, like using saturation function instead of sign function [6], using fuzzy logic control [7, 8], and using new Lyapunov function having no discontinuous mathematical expressions [9].

Extended state observer (ESO) which is rooted in the active disturbance rejection control [10] regards all the unknown factors as disturbance and can observe and compensate the disturbance. In order to suppress the disturbance with removing its impact on the choice of the switching gain of sliding-mode control, ESO can be used here to make the disturbance estimated and compensated in the control input, which implies a smaller switching gain and chattering phenomenon. The original concept of ESO is proposed for the nonlinear structure by Han [1113] and further simplified and parameterized by Gao [14] Tian and Gao [15], which significantly simplifies the tuning of ESO parameters and makes ESO more suitable for practical applications [16, 17].

With the continuous development of the fuzzy logic control theory, its application on robots received more and more attentions [79]. The fuzzy logic can be used to improve the transient process of the robot system, which means the short transient time and small overshoot [1820]. The knowledge about system characteristics coming from experts can be expressed by fuzzy logic rules, which makes this control method practical and simple for engineers.

In this paper, new design methods are developed that combine the advantages of sliding-mode control and ESO technique; the disturbance can be estimated by ESO and compensated by control law. To enhance the dynamic performance of HHA system, fuzzy control strategy is proposed to adjust the switching gain on line according to the running state of the system [20]. This control algorithm can be applied to manipulator systems with unmodeled dynamics, unstructured uncertainties, decoupling, and external disturbance.

The remainder of the paper is organized as follows. In Section 2, the structure of 3-DOF HHA is analyzed and the mathematical modeling of HHA is presented. In Section 3, the SMC, SMC-ESO, and FSMC-ESO for the HHA are proposed. Computer simulation results of the proposed SMC, SMC-ESO, and FSMC-ESO for the HHA are given in Section 4. Finally, Section 5 concludes the paper.

2. 3-DOF Serial-Parallel Hybrid Humanoid Arm

2.1. The Structure of 3-DOF HHA

This 3-DOF serial-parallel hybrid humanoid arm is composed of a 2-DOF parallel mechanism which forms the upper arm of HHA and a 1-DOF serial mechanism which forms the forearm of HHA.

As shown in Figure 1, the 2-DOF parallel mechanism is composed of linear motors 14 and 15 and their movers 16 and 17, upper arm orbits 3 and 5, upper arm slip tubes 1 and 4, elbow handspike 2, and upper arm pedestal 13. The 1-DOF serial mechanism is composed of linear motor 11 and its mover 12, forearm pedestal 6, wrist handspike 8, wrist 7, forearm orbit 10, and forearm slip tube 9. The motors 14 and 15 and upper arm orbit are fixed on upper arm pedestal. The motor 11 is fixed on forearm pedestal. The movers P1, P2, and P3 move forwards or backwards relatively to its main-body motors M1, M2, and M3, and the movement of motors drives the other components to achieve the desired action through the rotation axes.

The coordinates and   are shown in Figure 2. is the fixed reference coordinate system and is attached to the upper arm of HHA. Referenced to the horizontal position, the upward inclination of the upper arm is up about 20°. Under the assumption of the regular shape, smooth surface and linear density steady of every component, the sketch of HHA in and is shown in Figure 2. The dot , , is the center of mass of the motors M1, M2, and M3 and their pedestals, respectively. The dot , , is the center of mass of the slip tubes S1, S2, and S3, respectively. The lengths of and are both , and the lengths of , , , , , , , , , are , , , , , , , , , and , respectively. The lengths of , , and are defined as , , and , respectively.

2.2. Dynamic Modeling for HHA

Using the Lagrange approach, the dynamic model of the HHA [4] can be written as where , , and are the vectors of slip tubes position, velocity, and acceleration, respectively. is the inertia matrix, is the centripetal and Coriolis terms, is the vector of gravitational force, is the vector of generalized input due to external disturbance with , and is the input force vector. Here, , , and are the nominal parts calculated by Lagrange method, where is a symmetric positive definite matrix. , , and represent the perturbations in the system matrices. Then the dynamic model of HHA can be rewritten as where is the system uncertainty and satisfies [5, 21].

3. ESO-Based Self-Tuning Sliding-Mode Control (FSMC-ESO) for HHA

In this section, to ensure that the motion of the HHA can follow the desired trajectory, three dynamic controllers are introduced. First, we design a conventional sliding-mode controller (SMC) for the HHA in the thrust level. Second, the SMC-ESO is proposed for solving the chatting problem. Finally, the FSMC-ESO is proposed to enhance the dynamic performance and further solve the chattering problem of HHA system. The convergence of the complete equations of motion of the FSMC-ESO based HHA is confirmed by the Lyapunov stability theorem.

3.1. SMC Design

This section describes the SMC that is applied to the HHA. Sliding-mode control (SMC) is one of the effective nonlinear robust control approaches since it provides system dynamics with an invariance property to uncertainties once the system dynamics are controlled in the sliding mode. The SMC design can be decoupled in two steps. The first step is the selection of an appropriate sliding surface. The second step, an approaching law, is designed so that it will drive the system state toward sliding surface and guarantee the stability of the system.

The realistic model (2) can be reformulated as where .

Assuming is the upper bound of , then we can get .

For 3-DOF HHA, define the tracking error: where is the desired position trajectory of slip tubes.

The sliding surface in the space of tracking error is defined as where , , and .

Select the approaching law as where , , and .

For the 3-DOF HHA system (4), the sliding-mode control law is design as where, is equivalent control, that can make the system state remain on the sliding surface with no disturbance and is switching control, that can drive the system state to the sliding surface.

If is chosen as the tracking error will asymptotically converge to zero.

However, the upper bound of uncertainties, which is required in the conventional SMC system, is difficult to obtain precisely in advance for practical applications. If the switching gains are selected too large, the sign function will result in serious chattering phenomena in the control efforts. The undesired chattering control efforts will wear the bearing mechanism and might excite unstable system dynamics. Hence, the ESO can be adopted here to make the total disturbance estimated and compensated in the control input, which implies the decrease of the chattering and control power.

3.2. ESO-Based SMC Design

The ESO views the system model uncertainties and external disturbances as the extended state to be estimated. Here, the ESO can be designed for estimating the total disturbances existing in system (4). The block diagram of the SMC-ESO is shown in Figure 3.

Let , assuming is differentiable and . Let , , , the augmented model of (4) is

The ESO of system (11) can be designed as where is the estimation error of the ESO, , , and are the observer outputs, and , , and are the observer gains. With the disturbances estimated by the ESO, the control law (8) is modified as

Theorem 1. For the 3-DOF HHA (4), if the sliding surface is chosen as (6), the reaching law is chosen as (7) and the control law is designed as (13), there exist observer gains , ,  and and switching gains such that the tracking error and the estimation error asymptotically converge to zero.

Proof. In order to examine the stability of the closed loop system, the stability of the ESO is demonstrated firstly. Let the estimation errors of ESO , , and , then the observer error dynamics are expressed as
By choosing appropriate observer gains , ,  and , the stability of the ESO can be guaranteed and illustrated in [16]. As the observer is stable, the derivative of errors , , and , then the errors of estimation can be written as
For the 3-DOF serial-parallel hybrid humanoid arm, is the upper bound of , even if the may contain large uncertainties, the observation error of the ESO can be down to the small enough by adjust the parameters , , and . Thus, via tuning these parameters properly, the estimation errors , , and can be limited to be small enough.
Having shown that the observer errors converge into the residual set of zero, it remains to show that the closed loop errors converge to zero. Considering the Lyapunov function candidate with the sliding surface given by (6), we obtain
Combine (13) and (17), we get
As we know converges into the residual set of zero finally, (18) becomes
Let , , we can conclude that is always satisfied. Thus the closed loop system is asymptotically stable and the error state trajectory converges to the sliding surface . As the disturbance is estimated and compensated by ESO, the switching gain can be selected in smaller values, which implies the decrease of the chattering and control power.

3.3. ESO-Based FSMC Design

In Section 3.2, with smaller values of switching gain , the chatting problem is solved, but the dynamic performance of the system will be influenced by small gains of SMC-ESO. In this section, the ESO-based FSMC with varying switching gain is presented (Table 1). The switching gain is changed dynamically by the fuzzy logic unit in order to improve the performance of the controller. The general structure of the proposed FSMC-ESO is given in Figure 4.

As shown in Figure 5, the membership functions are used for the fuzzification of the inputs, which are error and derivative of error . Here NB, NM, NS, ZO, PS, PM, and PB stand for negative big, negative medium, negative small, zero, positive small, positive medium, and positive big, respectively. Also VVS, VS, S, M, B, VB, and VVB stand for very very small, very small, small, medium, big, very big, and very very big.

For output, the membership functions are presented in Figure 5(c). The definition of the membership functions gives the ability to make the control gain value of the proposed controller smaller or bigger than the gain of the conventional sliding-mode controller whenever necessary.

Since the control gain is always satisfied during the fuzzy adaptation, so if we select , one can conclude that is always satisfied and the Lyapunov stability of the controlled system is preserved. Thus the closed loop system is asymptotically stable and tracking error will converge to zero finally. The positive definiteness of the control gain is guaranteed by defining the membership functions within the positive universe of discourse.

4. Simulation

A set of numerical simulations is used here to verify the effectiveness of the proposed SMC, SMC-ESO, and FSMC-ESO. The numerical values of parameters of the HHA are listed as follows:  m,   m,    m,    m,   m,   m,   m,   m,   m,   m,   kg/m,   kg/m,   kg/m,  kg,  and  m/s2.

Normally, the distributed noise and the parameter uncertainties of the system always exist, which can be thought as disturbing thrust acting on the slip tubes, and are assumed to be time-varying as

The desired trajectory used here is given as , , and . The parameters of the sliding surface are . For the conventional SMC, and . For SMC-ESO, and . For FSMC-ESO, is adjusted by fuzzy logic, . For the ESO used in SMC-ESO and FSMC-ESO, and . Figure 6 shows the tracking position error of slip tubes 1, 2, and 3. Figure 7 shows the disturbance estimation of , ,  and . Figure 8 shows the variety of self-turning gains , ,  and . Figure 9 shows the input thrust of , ,  and .

From the simulation results, it is concluded that our proposed FSMC-ESO shows superior performance for each of the three slip tubes. Simulation results show that the proposed FSMC-ESO has smaller overshoot error values than both conventional SMC and SMC-ESO. From Figure 9 it is observed that both FSMC-ESO and SMC-ESO have smaller chatting problems in input thrust than the conventional method dealt with in this paper. It is observed that the proposed FSMC-ESO has the smallest chatting problem and best performance among the three controllers we proposed, which proves the efficiency of the proposed controller.

5. Conclusion

This present paper has described the development of ESO-based self-tuning sliding-mode control (FSMC-ESO) where it has been successfully applied for the motion control of a serial-parallel hybrid humanoid arm (HHA) in the presence of uncertainties and disturbances. The ESO can estimate the disturbance in real-time and does not require the detailed information of uncertainty and disturbance, the ESO only needs the upper bound of the uncertainty and disturbance, and the switching gain is adjusted by the fuzzy logic on line according to the running state of the system. The FSMC-ESO, with the advantages of SMC, ESO, and parameter self-tuning strategy, has shown a significant improvement over the conventional SMC under the same conditions. Meanwhile, the chattering phenomenon that frequently appears in the conventional SMC is also weakened by the fuzzy control. The effectiveness of the designed FSMC-ESO strategy was illustrated by simulation examples.

Conflict of Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.