Abstract
In response to the issue of the trajectory tracking control problem of manipulators with uncertain parameters and external disturbance, an adaptive fuzzy sliding mode robust control algorithm is proposed. Sliding mode control (SMC) is adopted to perform robotic manipulator trajectory tracking control. Then, a fuzzy logic system is used for adaptive adjustment of switching gain of the SMC and to reduce the buffeting problem. Next, compensation is made by using the robust controller in consideration of the impacts of unmodeled dynamics and external disturbance. The simulation experiment on a two axes robotic manipulator shows that, with the proposed control method, the sliding mode control input signal is kept smooth, and the manipulator has high trajectory tracking precision.
1. Introduction
The multijoint robotic manipulator system is strongly coupled, time-variant, and nonlinear. In the recent years, the high-precision control of a manipulator has attracted wide attention from the academia and the industrial circle. A series of achievements have been made in the research on the trajectory tracking of the manipulator’s joint space. Control algorithms such as sliding mode control [1–3], adaptive control [4–6], robust control [7, 8], and iterative learning control [9] have been proposed. Among them, the sliding mode control algorithm is simple and highly robust to parameter changes and disturbance, making it especially suitable for high-precision tracking control of nonlinear systems such as a robotic manipulator. However, high-frequency buffeting exists in SMC, and the vibration degree is affected by the switching gain. Normally, in order to ensure system stability, ample switching gain is selected, which aggravates the buffeting in sliding mode control. Such buffeting may cause the existence of unmodeled high-frequency components in the system or even cause system instability.
To overcome the chattering problem of sliding mode control, various methods have been proposed in the literature, among which the well-known method is to apply a saturation function to the SMC control gain when the sliding surface is located in the boundary of the sliding hyperplane [10, 11]. This method is simple; however, it cannot guarantee the output convergence. That is to say, there is a nonzero steady-state error in the output. Another common method is to use a disturbance observer to estimate and compensate the external disturbance and uncertainty, so as to solve the chattering problem of sliding mode control [12, 13]. However, it has high accuracy only for constant or slow changing disturbances. Another way to solve the chattering problem of sliding mode control is to apply fuzzy logic control. In the compact set, fuzzy control can approach any continuous function due to its characteristic of universal approximation and does not depend on the system model [14, 15]. So, it has gained wide applications in robot adaptive control. Thus, in this paper, a new adaptive fuzzy SMC algorithm is proposed for robotic manipulators. The adoption of the fuzzy logic system in adjusting the switching gain of SMC in an adaptive way can effectively eliminate the buffeting of the sliding mode control algorithm. At the same time, considering that uncertain parameters, unmodeled dynamics, and external disturbances will reduce the control performance of the system [16–18], a robust controller is used to compensate these uncertainties and achieve accurate tracking of the manipulator.
Additionally, most industrial robotic manipulators complete tasks within the task space through terminal actuators, and their expected trajectory is also described using the task space. So, to implement joint space control, it is necessary to convert the task space coordinate of the robotic manipulator into the joint space. Then, through high-performance joint space tracking control algorithm, the high precision tracking control of the manipulator is achieved.
The organization of the paper is as follows. The model descriptions are given in Section 2, including conversion between the task space coordinate and joint space angle position and manipulator dynamics model. The design of the control algorithm is detailed in Section 3, and an adaptive fuzzy sliding mode controller and robust controller are constructed. Simulation results are presented in Section 4. Finally, conclusions constitute Section 5.
2. Model Descriptions
Trajectory tracking in the task space refers to the tracking of the the desired trajectory by the end effector. However, as the actuators of most manipulators are installed on the manipulator body and their joints, the tracking of the trajectory of the manipulator within the joint space is to track the given expected joint angles of the manipulators one by one. Thus, in order to achieve control in joint space, the trajectory of the task space should be firstly converted into that of joint space.
2.1. Conversion between the Task Space Coordinate and Joint Space Angle
The movement coordinate at the terminal of the robotic manipulator in the task space is converted into the two-joint angle position [19].
According to Figure 1, the following formulas can be obtained:
Adding the square of and that of , we get
Thus, the following formula can be obtained:
Take or , , then
2.2. Manipulator Dynamics Model
A robotic manipulator is a kind of complex MIMO control system, with the characteristics of being nonlinear and time-varying. Its dynamic equation is described as follows [20]:
Here, means the joint position and , mean joint velocities and accelerations, respectively; inertia matrix , which is symmetric positive definite; means the centrifugal and Coriolis force matrix; and means the gravity matrix. means the external disturbance and means the control torque vector or control input of each joint.
The manipulator dynamics model has the following dynamics characteristics [20, 21]: Characteristic 1: the symmetric positive definite torque is consistent and bounded for all values of . For existing positive numbers and , that satisfies the following formula: Characteristic 2: , and the skew symmetric matrix meets the following relationships: Characteristic 3: for all , the is always bounded.
3. Control Algorithm Design
In this part, a control algorithm containing SMC, adaptive fuzzy control, and robust control is designed for robot trajectory tracking. The control structure of the proposed method is shown in Figure 2.
3.1. Design and Analysis of the Self-Adaptive Fuzzy SMC
In the actual robot system, parameter perturbation is inevitable. When the parameters of the object cannot be obtained accurately, we use to estimate the inertia matrix ; is used to estimate the centrifugal and Coriolis force matrix ; and is used to estimate the gravity matrix .
Letwhere means estimation error of the inertia matrix, means estimation error of the Coriolis force matrix, means estimation error of the gravity matrix.
Then, define the sliding function as follows:
Here, tracking error . means expected trajectory of the joint; means actual tracking trajectory; and means a diagonal matrix with the positive definite constant.
Choosing the auxiliary signal and is described as follows:where and mean expected joint speed and accelerations, respectively.
According to the theory of sliding mode control, the controller is designed as follows:
Here, and are positive definite matrixes.
By combining formulas (10) and (11) and substituting formula (12) into the robot dynamic equation (5), we obtain the following relationship:
Based on formula (8), the following formula can be obtained:where means unmodeled terms and disturbance terms.
We choosing the Lyapunov function as follows:
Taking the derivative of the expression and substituting formula (7) into the result, we get
Substituting formula (13) into the abovementioned expression, we get
Suppose that is bounded and satisfies the relationship ; then,
So, the system is stable.
Although the sliding mode controller is simple and effective, buffeting constitutes the main problem to be solved in the sliding control law. Also, the switching gain is the main reason for the buffeting problem. The larger the value of is, the more obvious the buffeting will appear. is used to compensate for the impact of external disturbance. For sufficient compensation, an enough large value of switching gain is required, which further aggravates the buffeting of the system.
In order to solve the buffeting problem caused by the SMC with fixed gain, a self-adaptive fuzzy scheme is added to the conventional SMC. The fuzzy controller is used for adjustment of the switching gain in an adaptive manner so that the switching gain of SMC can be adjusted with time so as to improve the buffeting problem.
Based on the product reasoning method and the central average antifuzzy controller, the fuzzy control system is designed for adaptive adjustment of switching gain of the SMC. Let , where denotes the fuzzy system’s output.
The output of the fuzzy system is described as follows:where means the parameter vector, means the regression vector, and means the number of fuzzy rules.
Define
As can be seen from formula (18), in order to satisfy , let , , and . Then, and should take the same positive and negative symbols, and , shall change by following the identical trend.
For the fuzzy system, we choose and switching gain as the input and output, whose value is described by using five variables. The fuzzy inference rule is shown as Table 1.
The membership function used to represent the fuzzy set is chosen as follows:
The output of the fuzzy system is expressed as follows:
Taking as the approximated value of and in view of the universal approximation theorem, there exists to satisfy the following:
The adaptive law is selected as follows:
Then, based on the switching gain adjusted by the adaptive fuzzy control, the SMC is expressed as follows:
3.2. Adaptive Robust Controller Design
In this part, for unmodeled dynamics and external disturbances , a robust control item is designed to eliminate their effects.
The robust controller is designed as follows:where means a tiny constant and means the upper limit for disturbance and uncertainties, which satisfy the following:where is a coefficient vector; is an uncertainty term of the system, and its value adopts the following adaptive algorithm for auto adjustment:where means a matrix with a positive definite constant and meeting the following relationships: , , and .
Thus, the adaptive robust controller can be further described as follows:
In summary, the overall control scheme is as follows:
4. Simulation Analysis
For the sake of demonstrating the validity and superiority of the control algorithm designed in this paper, simulation analysis is carried on the two-link manipulator. The specific expression for its dynamic equation is as follows:where , , , , , and , .
The simulation parameters of the manipulator are shown in Table 2.
Select the task space desired trajectory . The initial position is . Select the functions and for disturbance of both joints.
For the sake of implementing the tracking control in the joint space, based on the content described in Section 2.1, the expected trajectory and the initial joint angle of the joint are obtained by the inverse solution.
The sliding mode controller parameters are chosen as . The robust controller parameters are . Select the fuzzy membership function as shown in Figure 3.
First, conduct simulation by adopting the traditional SMC based on the fixed gain and SMC based on adaptive fuzzy gain adjustment so as to reflect the effect of switching gain adjustment by using fuzzy adaptive control on the improvement of sliding mode control buffeting. The adaptive gain changes of the two joints are shown in Figure 4.
In order to better compare the effect of sliding mode adaptive gain and fixed gain, for fixed gain, we adopt three different values (). The sliding mode control input signal chattering phenomenon of two joints with three different K values is shown in Figures 5 and 6. Figures 7 and 8 show the sliding mode control input signal with adaptive gain.
From the figures, we can see that the SMC input signal with fixed gain has obvious chattering, and the larger the K, the more obvious the chattering, while adoption of SMC based on fuzzy adaptive gain adjustment can effectively improve the chattering phenomenon and keep the input signal smooth.
The adaptive fuzzy sliding mode robust controller proposed in this paper is used for trajectory tracking of the two-joint manipulator. The simulation results are demonstrated in Figures 9–14. Among them, Figure 9 shows the position tracking of both joints. Figure 10 displays the tracking error of both joints. Figure 11 shows the velocity tracking of both joints. Figure 12 displays the velocity tracking error of both joints. Figure 13 displays the tracking trajectory at the terminal of the task space for the robotic manipulator. Figure 14 displays the pose trajectory of the manipulator.
It can be seen from the simulation results that the proposed robotic manipulator control method enjoys high trajectory tracking precision. In addition to the initial stage when there is a minor tracking error, it basically ensures high-precision tracking with tracking error being zero. Simulation error values of two axes are shown in Table 3.
5. Conclusions
This article proposes an adaptive fuzzy sliding mode robust trajectory tracking control algorithm for the robotic manipulator with uncertain parameters and external disturbance. The algorithm combines SMC tracking controller, switched gain adaptive fuzzy controller, and robust control algorithms to compensate for modeling error and disturbance, weakens the buffeting of SMC, and ensures high precision of robot trajectory tracking. The simulation results carried on a two-link robotic manipulator demonstrate the validity and superiority of the proposed method.
Data Availability
The data used to support the findings of this study are included within the article.
Conflicts of Interest
The authors declare that they have no conflicts of interest.
Acknowledgments
This research was supported by the Joint Fund of Zhejiang Provincial Natural Science Foundation (Grant no. LTY20E050001).