| Literature DB >> 34884104 |
Thanh Nguyen Truong1, Anh Tuan Vo1, Hee-Jun Kang1, Mien Van2.
Abstract
Many terminal sliding mode controllers (TSMCs) have been suggested to obtain exact tracking control of robotic manipulators in finite time. The ordinary method is based on TSMCs that secure trajectory tracking under the assumptions such as the known robot dynamic model and the determined upper boundary of uncertain components. Despite tracking errors that tend to zero in finite time, the weakness of TSMCs is chattering, slow convergence speed, and the need for the exact robot dynamic model. Few studies are handling the weakness of TSMCs by using the combination between TSMCs and finite-time observers. In this paper, we present a novel finite-time fault tolerance control (FTC) method for robotic manipulators. A finite-time fault detection observer (FTFDO) is proposed to estimate all uncertainties, external disturbances, and faults accurately and on time. From the estimated information of FTFDO, a novel finite-time FTC method is developed based on a new finite-time terminal sliding surface and a new finite-time reaching control law. Thanks to this approach, the proposed FTC method provides a fast convergence speed for both observation error and control error in finite time. The operation of the robot system is guaranteed with expected performance even in case of faults, including high tracking accuracy, small chattering behavior in control input signals, and fast transient response with the variation of disturbances, uncertainties, or faults. The stability and finite-time convergence of the proposed control system are verified that they are strictly guaranteed by Lyapunov theory and finite-time control theory. The simulation performance for a FARA robotic manipulator proves the proposed control theory's correctness and effectiveness.Entities:
Keywords: fault detection observer; fault tolerant control; finite-time control theory; robot manipulators; terminal sliding mode control
Year: 2021 PMID: 34884104 PMCID: PMC8659897 DOI: 10.3390/s21238101
Source DB: PubMed Journal: Sensors (Basel) ISSN: 1424-8220 Impact factor: 3.576
List of symbols.
| Notation | Description |
|---|---|
|
| |
|
| |
|
| absolute value of |
|
| vector of joint angular position, |
|
| vector of joint angular velocity, |
|
| vector of joint angular acceleration, |
|
| matrix of actual inertia, |
|
| matrix of the actual centrifugal and Coriolis force, |
|
| vector of actual gravity, |
|
| estimated matrix of |
|
| estimated matrix of |
|
| estimated matrix of |
|
| estimation error matrix of |
|
| estimation error matrix of |
|
| estimation error vector of |
|
| vector of the friction force, |
|
| vector of external disturbance, |
|
| vector of the control input torque, |
|
| matrix of fault time profile, |
|
| vector of the time when the faults occur, |
|
| the developing rate coefficient of the |
|
| matrix of the unexpected fault, |
|
| lumped nominal part of the robot, |
|
| a smooth function, |
|
| the whole uncertainties, external disturbances, and faults, |
| the bounded values of | |
|
| the estimated value of the position |
|
| the estimated value of the velocity |
|
| the estimated value of the whole uncertainty and fault |
|
| estimation error of position |
|
| estimation error of velocity |
|
| estimation error of the whole uncertainty and fault |
|
| positive matrices |
|
| bounded valued of the estimation error of the whole uncertainty and fault |
|
| desired position and desired velocity at |
| the actual position and actual velocity at | |
|
| tracking position error and the tracking velocity error at |
|
| sliding mode surface of |
|
| parameters of sliding mode surface of |
|
| parameters of reaching control law of |
|
| parameters of CTC-based FTC, |
|
| parameters of SMC-based FTC, |
| parameters of FTSMC-based FTC, | |
|
| the desired trajectory of the robot’s end-effector in XYZ-space |
|
| the root-mean-square errors of the robot’s end-effector in XYZ-space |
|
| the root-mean-square errors of the robot’s joints |
Figure 1The block diagram of the proposed control method.
Figure 2FARA ROBOT AT2 3-DOF robotic mechanical model in SOLIDWORK and its geometrical dimensions.
The designed parameters of the FARA robot system.
| Link 1 | Link 2 | Link 3 | ||
|---|---|---|---|---|
| Length (m) | 0.15 | 0.255 | 0.3 | |
| Weight (kg) | 37.985 | 21.876 | 16.965 | |
| Center of Mass (mm) |
| 68.067 | 95.045 | 71.496 |
|
| −1.185 | 5.399 | −72.007 | |
|
| 64.931 | −0.002 | −1.004 | |
| Inertia (kg·m2) |
| 0.252 | 0.359 | 0.306 |
|
| 0.395 | 0.623 | 0.853 | |
|
| 0.356 | 0.319 | 0.306 |
The selected parameters of three controllers.
| Controller | Symbol | Value |
|---|---|---|
| CTC |
|
|
| SMC |
|
|
| FTSMC |
|
|
| Proposed Method |
|
Note: .
RMSEs of four controllers in the first case.
| Controller | ||||||
|---|---|---|---|---|---|---|
| CTC |
|
|
|
|
|
|
| SMC |
|
|
|
|
|
|
| FTSMC |
|
|
|
|
|
|
| Proposed Method |
|
|
|
|
|
|
RMSEs of four controllers in the second case.
| Controller | ||||||
|---|---|---|---|---|---|---|
| CTC |
|
|
|
|
|
|
| SMC |
|
|
|
|
|
|
| FTSMC |
|
|
|
|
|
|
| Proposed Method |
|
|
|
|
|
|
Figure 3(a) The assumed value of uncertainty and its estimated value at joints; (b) the real velocity value and its estimated value at joints.
Figure 4The reference trajectory and real trajectory of the end-effector under four controllers.
Figure 5(a) The tracking errors of end-effector in X, Y, and Z direction; (b) the tracking errors of joint 1, joint 2, and joint 3.
Figure 6The tracking velocity errors of joint 1, joint 2, and joint 3.
Figure 7The control input torques at joints of four controllers.
Figure 8(a) The assumed value of uncertainty and fault, and its estimated value at joints; (b) the real velocity value and its estimated value at joints.
Figure 9The reference trajectory and real trajectory of the end-effector under four controllers.
Figure 10(a) The tracking errors of end-effector in X, Y, and Z direction.; (b) The tracking errors of joint 1, joint 2, and joint 3.
Figure 11The tracking velocity errors of joint 1, joint 2, and joint 3.
Figure 12The control input torques at joints under four controllers.