Next Article in Journal
Learning to Co-Embed Queries and Documents
Next Article in Special Issue
Integral Windup Resetting Enhancement for Sliding Mode Control of Chemical Processes with Longtime Delay
Previous Article in Journal
Consideration for Positive and Negative Effect of Multi-Sensory Environment Interventions on Disabled Patients through Electrocardiography
Previous Article in Special Issue
IM Fed by Three-Level Inverter under DTC Strategy Combined with Sliding Mode Theory
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Dynamic Fractional-Order Nonsingular Terminal Super-Twisting Sliding Mode Control for a Low-Cost Humanoid Manipulator

1
School of Mechanical and Electrical Engineering, Central South University, Changsha 410017, China
2
The State Key Laboratory of High Performance and Complex Manufacturing, Changsha 410083, China
*
Authors to whom correspondence should be addressed.
Electronics 2022, 11(22), 3693; https://doi.org/10.3390/electronics11223693
Submission received: 14 October 2022 / Revised: 7 November 2022 / Accepted: 8 November 2022 / Published: 11 November 2022
(This article belongs to the Special Issue Sliding Mode Control in Dynamic Systems)

Abstract

:
Prosthetic humanoid manipulators manufacturing requires light overall weight, small size, compact structure, and low cost to realize wearing purpose. These requirements constrain hardware configuration conditions and aggravate the nonlinearity and coupling effects of manipulators. A dynamic fractional-order nonsingular terminal super-twisting sliding mode (DFONTSM-STA) control is proposed to realize multi-joints coordination for a low-cost humanoid manipulator. This method combines a dynamic fractional-order nonsingular terminal sliding mode (DFONTSM) manifold with the super-twisting reaching law, which can enhance the entire control performance by dynamically changing the position of the sliding mode manifold. By hiding the sign function in a higher-order term, chattering can be effectively suppressed. The stability of the low-cost humanoid manipulator system has been proven based on the Lyapunov stability theory. Experimental results show that the terminal trajectory tracking accuracy of DFONTSM-STA control was promoted by 53.3% and 23.7% respectively compared with FONTSM control and FONTSM-STA control. Thus, the DFONTSM-STA controller is superior in error convergence speed, chattering suppression, and accurate position tracking performance.

1. Introduction

Humanoid manipulators have the characteristics of light weight, small size, strong nonlinearity, coupling, friction, and clearance [1,2,3]. Among them, friction and clearance are disturbances that significantly influence the control performances of humanoid manipulators. As sliding mode control has the excellent characteristic of efficiently disturbances settlement [4,5,6,7], it is widely used for humanoid manipulators’ position-tracking control [8,9,10]. A low-cost humanoid manipulator further constrains its hardware configuration conditions. Complex and high-precision sensors or motors cannot be used when designing a humanoid manipulator because they are generally large in volume. The sensors and motors with small volumes and high precision are generally quite expensive. Teleoperation systems are also not included for cost-saving purposes [11]. All the above features aggravate the nonlinearity, coupling, and complexity of the low-cost humanoid manipulator’s dynamics. Benefiting from their variable structure characteristics, sliding mode controllers possess excellent robustness and anti-disturbance ability [12,13]. However, the alternation between the reaching phase and the sliding phase of a sliding mode controller always accompanies by a phenomenon called chattering [14]. The production of the chattering is related to the sliding mode boundary layer thickness [15]. The system states trajectory always has a certain speed when reaching the manifold, and the inertia makes the system states move across the manifold. After that, the controller input generates a reverse signal to pull the system states back to the sliding mode manifold. However, it must take time. This time difference makes the system states trajectory deviate from the sliding mode manifold for a certain distance and intensifies the thickness of the boundary layer. In this way, the system states trajectory repeatedly passes through the sliding mode manifold, which is reflected in the macroscopic view as a chattering phenomenon [16,17]. Chattering may cause energy consumption and mechanical system damage problems. Therefore, the chattering problem must be first solved when designing sliding mode controllers, especially for a low-cost humanoid manipulator.
The sign function term in a sliding mode reaching law is not only the key to the rapid convergence of sliding functions but also one of the main causes of chattering [18]. Replacement of the sign function with the saturation function is one way to suppress chattering [19]. Hiding the sign function term in a higher-order term is another effective way to eliminate chattering [20,21,22,23,24]. As the system states enter the quasi-sliding mode, the super-twisting sliding mode (STSM) gains the characteristics of the sign function term and ensures that the sliding function and its derivative converge to zero within a limited time [25,26,27]. The STSM control which belongs to the second-order sliding mode control only requires information on the sliding function [28]. It contains a power rate term that can reduce the time of the system states arriving in quasi-sliding mode and suppress the chattering more effectively compared with the proportional term [29]. Moreno and Osorio used the Lyapunov stability theory to analyze the stability of the super-twisting algorithm (STA) [30]. The proof process has been used in many STSM controllers. Kali et al. proposed an STSM control for manipulators with uncertainties. [31]. Tayebi-Haghighi et al. designed a high-order STSM controller to address multiple control challenges of robots with verification. [20].
Apart from introducing super-twisting algorithms, adding a fractional-order operator to the sliding mode controller is also an effective way to suppress chattering and improve motion control performance [32]. Applying a fractional-order (FO) operator to a sliding mode controller can enhance the flexibility of the controller, and improve its control performances [32,33,34,35,36]. Among all the fractional-order controllers, fractional-order nonsingular terminal sliding mode (FONTSM) controllers are widely used in manipulators to obtain precise position-tracking performance [37,38,39,40,41,42,43]. Tran et al. designed an adaptive fuzzy FONTSM control strategy for a two-degree-of-freedom manipulator and used simulation results to illustrate its control performances. [40]. Nojavanzadeh et al. proposed an adaptive FONTSM controller to control robots with uncertainty and external interference and used simulation to verify its effectiveness [41]. Su et al. proposed an adaptive FONTSM controller for a cable-driven manipulator with external interferences, which was verified by simulations. [42]. Wang et al. formulated an adaptive sliding mode controller that integrates the advantages of PID and FOTNSM manifold [43]. However, most of the FONTSM controllers were verified by simulations. Only a few papers showed the experimental verification of the FONTSM control for manipulators [44,45,46]. In the previous work of the authors, a dynamic FONTSM controller was proposed for a class of second-order nonlinear systems with simulation verification [47].
To summarize, super-twisting sliding mode control can effectively accelerate the speed of system states reaching the quasi-sliding mode and suppress the chattering. FONTSM control has superiority in motion control accuracy. The fractional-order nonsingular super-twisting sliding mode (FONTSM-STA) control combines the advantages of the FONTSM manifold and the STA, which not only meets the demand for high tracking accuracy but also suppresses the chattering [45]. However, simply combining these two methods has little effect on the joint error converge speed which is a vital factor for humanoid manipulators to mimic arm movements.
Aiming at the above-mentioned problems, a dynamic fractional-order nonsingular terminal super-twisting sliding mode (DFONTSM-STA) control scheme is proposed for a low-cost humanoid manipulator in this study. The main contributions of this paper are summarized as follows:
(1)
A DFONTSM-STA controller is formulated for the control of the low-cost humanoid manipulator by combining the dynamic fractional-order nonsingular terminal sliding mode (DFONTSM) manifold with the super-twisting reaching law, which can effectively improve the control accuracy, quickly force the tracking error of each joint to converge and significantly suppress the chattering. The stability and convergence of the low-cost humanoid manipulator control system are proven based on the Lyapunov stability theory.
(2)
Experiments illustrate the superiority and feasibility of the proposed DFONTSM-STA control for the low-cost humanoid manipulator. Compared with FONTSM and FONTSM-STA control, the DFONTSM-STA controller has superior control performance. Its terminal position tracking accuracy is increased by 53.3% and 23.7% respectively. Its chattering of joints one to four is decreased by 54.1%, 51.1%, 46.2%, and 55.1% compared with FONTSM control. Its error convergence speed is accelerated significantly. Joints one and two are converged at the beginning, and joints three and four are accelerated by 43.5% and 33.6%, 72.7%, and 54.6% respectively compared with the FONTSM and FONTSM-STA control.

2. Model Description and Problem Analysis

The low-cost humanoid manipulator is limited by cost, size, and weight, which uses hall sensors that generate three pulses in one turn to read the angle position information. The position is detected by sensors whose resolution converted to the joint is 0.3°. Figure 1 shows the three dimensional (3D) model of the low-cost humanoid manipulator and the Denavit-Hartenberg (D-H) coordinate of each joint. Table 1 shows its D-H parameters. Coordinate x 0 y 0 z 0 represents the base coordinate; x 1 y 1 z 1 and x 2 y 2 z 2 represent the coordinate of shoulder joints one and two; x 3 y 3 z 3 and x 4 y 4 z 4 represent the coordinate of elbow joints three and four; x t y t z t represents the terminal coordinate. The dynamic equation of the four degrees-of-freedoms (DOFs) low-cost humanoid manipulator with friction model is described as follows:
M ( q ) q ¨ + C ( q , q ˙ ) + G ( q ) + f ( q , q ˙ ) = τ r
f ( q , q ˙ ) = f c s i g n ( q ˙ ) + f v q ˙
where q , q ˙ , and q ¨ ϵ R4 respectively represent the position, velocity, and acceleration vectors of every joint; M ( q ) R 4 × 4 is the non-singular inertia matrix; C ( q , q ˙ ) R 4 × 4 is the centrifugal and Coriolis matrix; G ( q ) R 4 represents the gravitational vector; f ( q , q ˙ ) R 4 is the vector of the viscous friction torque at joints; τ R 4 denotes the torque input vectors; f c = d i a g ( f c 1 , f c 2 , f c 3 , f c 4 ) denotes every joint coulomb friction torque; f v = d i a g ( f v 1 , f v 2 , f v 3 , f v 4 ) denotes every joint viscous friction coefficient.
The low-cost humanoid manipulator contains four joints to mimic shoulder and elbow movements. To suppress chattering and improve both the error convergence speed and the tracking accuracy, it is necessary to design a new sliding mode control method. As the STSM control hides the sign function in higher order, it possesses a better effect on chattering suppression. Apart from the chattering suppression requirement, the low-cost humanoid manipulator also needs precise trajectory tracking accuracy for mimicking human arm movements. The DFONTSM manifold can enhance the entire control performance by dynamically changing the position of the sliding mode manifold [47]. The steady-state accuracy can be improved because the fractional-order operator has the characteristics of heredity and memory, which can describe detailed information and increase the flexibility of the control law. Therefore, to solve the trajectory tracking performances of the low-cost humanoid manipulator, this paper proposes a DFONTSM-STA control method that combines a DFONTSM manifold with a super-twisting reaching law.

3. DFONTSM-STA Control for the Low-Cost Humanoid Manipulator

This section will briefly present some definitions and lemmas that are needed in the stability proof of the proposed DFONTSM-STA controller.
Definition 1. 
The general representation of the FO derivative-integral operator is expressed by Equation (3), [48]
D t λ t 0 = { d λ d t λ λ > 0 1 λ = 0 I λ = 0 t ( d t ) λ λ < 0
where λ is the FO and t0 is the initial time. The operator D t λ t 0 is the symbol for the FO, integral and constant operator.
Definition 2. 
The λ th-order Riemann–Liouville (RL) fractional and integral are presented as Equations (4) and (5) [48].
D λ f ( t ) = d λ f ( t ) d t λ = 1 Γ ( m λ ) d m d t m t 0 t f ( τ ) ( t τ ) λ m + 1 d τ
I t λ t 0 f ( t ) = 1 Γ ( α ) t 0 t f ( t ) ( t τ ) 1 λ d τ
wherem1 < λ < m, mN.
Property 1. 
[48] if α∈ C, β∈ C,ℜe(α) > 0,ℜe(β) > 0 and f(ɑ,b)∈ Lp(a,b) (1 ≤ p ≤ ∞), then I t α I t β f ( x ) = I t α + β f ( x ) , I t + α I t + β f ( x ) = I t + α + β f ( x ) ; D t α I t α f ( x ) = f ( x ) , D t + α I t + α f ( x ) = f ( x ) .
Lemma 1. 
[44]. Supposing parameters a 1 , a 2 , , a n ; 0 < p < 2 are positive, then the following inequality about a 1 , a 2 , , a n and p can be obtained:
( a 1 2 + a 2 2 + + a n 2 ) p ( a 1 p + a 2 p + + a n p ) 2
Lemma 2. 
[38,44]. For a Lyapunov function V(x), assuming that V0 is its initial value and α∈ C, β∈ C, then
V ˙ ( x ) + α V ( x ) + β V γ ( x ) 0 , α , β > 0 , 0 < γ < 1
The corresponding settling time can be calculated as
T α 1 ( 1 γ ) 1 ln ( 1 + α β 1 V 0 1 γ )
The FONTSM manifold parameter transforms into the function k that calculates the error by exponential function is designed as Equation (9). Then the DFONTSM manifold (8) is formulated for the system described in the model (1) [47].
s = e ˙ + k D λ 1 [ s i g ( e ) α ]
k = k 0 δ 0 + ρ 0 δ 0 exp α κ | e |
where 0 < λi < 1, i = 1∼4, Dλ is the FO operator; δ 0 = diag( δ 0 i ) is the diagonal matrix and δ 0 i ϵ (0,1); ρ 0 = diag( ρ 0 i ) and α κ = diag( α κ i ) are tuning matrices and ρ 0 i , α κ i ϵ(0, + ∞); e = [ q d 1 q 1 , q d 4 q 4 ] R 4 denotes the tracking error vector between the target joint rotation angle and the actual joint rotation angle. k 0 = d i a g ( k 0 i ) is a positive diagonal matrix. i can be chosen from one to four.
s i g ( e ) α = [ | e 1 | α 1 sgn ( e 1 ) , , | e 4 | α 4 sgn ( e 4 ) ] T
where α is the exponential parameter, which satisfies the relation: 1 > α > 0 . A super-twisting reaching law from [31] is adopted.
s ˙ = ρ 1 | s | 1 / 2 sgn ( s ) + ω ω ˙ = ρ 3 sgn ( s )
where k 1 = diag( k 1 i ), k 2 = diag( k 2 i ) are constant matrices and 0 < b = b1 = ··· = b4 < 1, i = 1∼4; With the above reaching law (10), the error vector ( e , e ˙ ) can be forced to zero. Derivating the DFONTSM manifold (8), we have:
s ˙ = e ¨ + k D λ [ s i g ( e ) α ] + k ˙ D λ 1 [ s i g ( e ) α ]
where:
k ˙ = ρ 0 δ 0 k 0 α κ e ˙ ( δ 0 + ρ 0 δ 0 exp α κ | e | ) 2 exp α κ | e | s i g n ( e )
Combining (11) with (10), the control law (14) can be obtained by Equation (13).
e ¨ + k D λ [ s i g ( e ) α ] + k ˙ D λ 1 [ s i g ( e ) α ] = ρ 1 | s | 1 / 2 sgn ( s ) + ω
τ r = M ( q ) ( q ¨ d + k D λ [ s i g ( e ) α ] + k ˙ D λ 1 [ s i g ( e ) α ] + ρ 1 | s | 1 2 s g n ( s ) + ρ 3 0 t sgn ( s ) d t ) + C ( q , q ˙ ) + G ( q )

4. Stability Proof of DFONTSM-STA Control

The states q ¨ can be obtained from the dynamic model (1):
q ¨ = M ( q ) 1 ( τ r C ( q , q ˙ ) G ( q ) f ( q , q ˙ ) )
where f ( q , q ˙ ) f max ( x , t ) F ¯ . The constant diagonal matrix of F ¯ represents the friction interference upper boundary. Substituting (14) and (15) into (13), yields:
( q ¨ d M ( q ) 1 ( M ( q ) ( q ¨ d + k D λ [ s i g ( e ) α ] + k ˙ D λ 1 [ s i g ( e ) α ] + ρ 1 | s | 1 / 2 sgn ( s ) + 0 t ρ 3 sgn ( s ) d t ) + C ( q , q ˙ ) + G ( q ) C ( q , q ˙ ) G ( q ) f ( q , q ˙ ) ) + k D λ [ s i g ( e ) α ] + k ˙ D λ 1 [ s i g ( e ) α ] = s ˙
By simplifying the above equation, error dynamics (16) can be determined:
M ( q ) 1 f ( q , q ˙ ) ρ 1 | s | 1 / 2 sgn ( s ) 0 t ρ 3 sgn ( s ) d t = s ˙
Rewrite error dynamics (16) as the form as follows:
s ˙ = ρ 1 | s | 1 / 2 sgn ( s ) + ω ω ˙ = ρ 3 sgn ( s ) + ε ˙
where ε is formulated from (16) and (17) as ε = M ( q ) 1 f ( q , q ˙ ) M ( q ) 1 F ¯ , satisfying the inequality equation | ε ˙ | δ ε , where δ ε > 0 . For each joint, the error dynamics can be written as:
s ˙ i = ρ 1 i | s i | 1 / 2 sgn ( s i ) + ω i ω ˙ i = ρ 3 i sgn ( s i ) + ε ˙ i
where ε i = M ( q i ) 1 f ( q i , q ˙ i ) , and ε ˙ i satisfying | ε ˙ i | δ ε i , where δ ε i > 0 . The following Lyapunov function is chosen:
V = 2 ρ 3 | s | + 1 2 ω 2 + 1 2 ( ρ 1 | s | 1 2 sgn ( s ) ω ) 2
Then the Lyapunov function V i of each joint of the low-cost humanoid manipulator can be determined as:
V i = 2 ρ 3 i | s i | + 1 2 ω i 2 + 1 2 ( ρ 1 i | s i | 1 2 sgn ( s i ) ω i ) 2
where i represents joint i, and V i satisfies V i 0 .
Supposing η i = [ | s i | 1 2 sgn ( s i ) ω i ] T and P i = [ 2 ρ 3 i + ρ 1 i 2 2 ρ 1 i 2 ρ 1 i 2 1 ] , then (20) can be rewritten as:
V i = η i T P i η i
V i satisfies the following inequality equation:
λ min { P i } η i 2 V i λ max { P i } η i 2
where λ min { P i } denotes minimum eigenvalues of P i and λ max { P i } denotes the maximum eigenvalue. η i is the Euclidean norm. By rearranging Equation (22), we obtain:
V i 1 2 λ max 1 2 { P i } η i V i 1 2 λ min 1 2 { P i }
Derivating the Lyapunov function, V ˙ i can be expressed as:
V ˙ i = 2 ρ 3 i s ˙ i sgn ( s i ) + ω i ω ˙ i + ( ρ 1 i | s i | 1 2 sgn ( s i ) ω i ) ( ρ 1 i 2 | s i | 1 2 s ˙ i ω ˙ i )
Substituting error dynamics (18) into the above equation, yields:
V ˙ i = 2 ρ 1 i ρ 3 i | s i | 1 2 + 2 ρ 3 i ω i sgn ( s i ) ρ 3 i ω i sgn ( s i ) + ω i ε ˙ i + ( ρ 1 i | s i | 1 2 sgn ( s i ) ω i ) ( ρ 1 i 2 | s i | 1 2 ( ρ 1 i | s i | 1 2 sgn ( s i ) + ω i ) ( ρ 3 i sgn ( s i ) + ε ˙ i ) ) V ˙ i = 1 | s i | 1 2 ( 1 2 ρ 1 i 3 | s i | + ρ 1 i 2 | s i | 1 2 sgn ( s i ) ρ 1 i 2 ω i 2 ρ 1 i ρ 3 i | s i | ) + ε ˙ i ( ρ 1 i | s i | 1 2 sgn ( s i ) + 2 ω i )
Simplify the above equation into matrix multiple forms:
V ˙ i = 1 | s i | 1 2 [ | s i | 1 2 sgn ( s i ) ω i ] [ 1 2 ρ 1 i 3 + ρ 1 i ρ 3 i ρ 1 i 2 2 ρ 1 i 2 2 ρ 1 i 2 ] [ | s i | 1 2 sgn ( s i ) ω i ] + ε ˙ i [ ρ 1 i 2 ] [ | s i | 1 2 sgn ( s i ) ω i ]
Supposing: A i = [ 1 2 ρ 1 i 3 + ρ 1 i ρ 3 i ρ 1 i 2 2 ρ 1 i 2 2 ρ 1 i 2 ] , B i = [ 0 1 ] , C i = [ 1 0 ] , then Equation (24) can be rewritten as:
V ˙ i = 1 | s i | 1 2 η i T A i η i + 2 ε ˙ i | s i | 1 2 | s i | 1 2 B i T P i η i
If ε ˙ δ , | ε ˙ i | δ i , then 2 ε ˙ i | s i | 1 2 B i T P i η i satisfies:
2 ε ˙ i | s i | 1 2 B i T P i η i ε ˙ i 2 | s i | + η i T P i B i B i T P i T η i δ ε i 2 η i T C i C i T η i + η i T P i B i B i T P i T η i
By substituting inequality (26) into rearranged V ˙ i (25), we obtain the following inequality (27):
V ˙ i 1 | s i | 1 2 η i T ( A i δ ε i 2 C i C i T P i B i B i T P i T ) η i = 1 | s i | 1 2 η i T Q i η i
where:
Q i = [ 1 2 ρ 1 i 3 + ρ 1 i ρ 3 i δ ε i 2 ρ 1 i 2 4 ρ 1 i 2 2 + ρ 1 i 2 ρ 1 i 2 2 + ρ 1 i 2 ρ 1 i 2 1 ]
If ρ 1 i and ρ 3 i satisfy the following conditions:
ρ 1 i > 2 ρ 3 i > ρ 1 i 3 + 4 δ ε i 2 ( ρ 1 i 2 ) 4 ( ρ 1 i 2 2 ρ 1 i )
then the error dynamics for each joint (18) meet the demands of the Lyapunov stability and the matrix Q i is symmetrical and positive. Obviously | s i | 1 2 η i , substituting Equation (23) into Equation (27), V ˙ i satisfies:
V ˙ i 1 η i λ min { Q i } η i 2 λ min { Q i } λ max 1 2 { P i } V i 1 2
where term λ min { Q i } denotes the minimum eigenvalues of the matrix Q , λ max { Q i } denotes the maximum eigenvalues. Thus, the converge time T c i for each joint of the low-cost humanoid manipulator satisfies the following inequality which can be obtained through lemmas 1 and 2:
T c i 2 λ max 1 2 { P i } λ min 1 { Q i } V i 1 2 ( 0 )
Therefore, the control law (14) can ensure the error dynamics of the low-cost humanoid manipulator to be stable.

5. Simulation and Discussion

To reveal the superior performances of the proposed DFONTSM-STA control, we perform simulation verification on the low-cost humanoid manipulator. The coulomb and viscous friction parameters are selected as f c 1 = f c 2 = f c 4 = 1.25 N , f c 3 = 0.125 N , f v 1 = f v 2 = f v 4 = 1 , f v 3 = 0.1 [44]. The model information of the low-cost humanoid manipulator is listed in Table 2, Table 3 and Table 4.

5.1. Comparison of Simulation Results

To better compare and analyze the performances of the FONTSM control (29) [44], FONTSM-STA control (30) [45], and DFONTSM-STA control (14), we select control parameters listed in Table 5 and Table 6. The simulation performances are described in Figure 2, Figure 3, Figure 4, Figure 5 and Figure 6.
τ r = M ( q ) ( q ¨ d + k D λ [ s i g ( e ) α ] + k 2 s i g ( s ) b + k 1 s ) + C ( q , q ˙ ) + G ( q )
τ r = M ( q ) ( q ¨ d + k D λ [ s i g ( e ) α ] + ρ 1 | s | 1 2 s g n ( s ) + ρ 3 0 t sgn ( s ) d t ) + C ( q , q ˙ ) + G ( q )

5.2. Simulation Analysis

The convergence time is calculated when the tracking error accuracy is within 0.5° (shoulder joints) or 1° (elbow joints), which is shown in Table 7. Table 8 shows the maximum amplitude of control torque variations in a small time interval of each joint. The variations of torque in a small interval reflect the degree of chattering suppression, we defined an indicator shown as equation (31) to facilitate analysis and to directly evaluate the controller’s chattering suppression performance.
| τ | max = | τ ( t ) τ ( t t p ) |
where tp is the time interval between the two calculated torques and tp = 20 ms is defined in this simulation.
As shown in Table 7, the tracking error convergence speed of the DFONTSM-STA control is faster than that of FONTSM and FONTSM-STA control. Compared with FONTSM control, the error convergence time by DFONTSM-STA control from joints one to four is reduced by 77.2%, 80.6%, 97.2%, and 78.6% respectively. Compared with the FONTSM-STA control, the convergence time is reduced by 75.3%, 80.6%, 93.0%, and 68.7% respectively. It can be concluded that under the control of DFONTSM-STA, each joint of the low-cost humanoid manipulator takes the least time to converge.
The DFONTSM-STA control and the FONTSM-STA control also have better chattering suppression effects compared with the FONTSM control. When tp = 20 ms, the maximum chattering variations of joints one to four under FONTSM-STA control are reduced by 70.8%, 41.8%, 33.9%, and 48.9% compared with the FONTSM control. While under DFONTSM-STA control, the maximum chattering variations for joints one to four are reduced by 66.4%, 52.1%, 24.7%, and 52.2% compared with the FONTSM control. From Figure 4, it can be seen that the control inputs under the FONTSM control have the most severe high-frequency chattering among the three control methods. If the unmodeled dynamics of the low-cost humanoid manipulator are excited by high-frequency chattering, the moving trajectory may diverge, which will destroy the machine structure and cause security compromises.
Compared with the FONTSM-STA and FONTSM methods, DFONTSM-STA adds dynamic characteristics to the sliding manifold, which can make the sliding manifold change dynamically according to the actual error. Therefore, among these three methods, the DFONTSM-STA controller has the strongest ability to maintain the error at zero, and the best joint error convergence performance.
From Table 9, the data of terminal position root mean square error indicates that compared with the FONTSM control, the terminal root mean square tracking error (Srmste) under DFONTSM-STA control are decreased by 90.9%, 57.4%, and 57.1% in the x-direction, y-direction, and z-direction of the low-cost humanoid manipulator. Furthermore, under DFONTSM-STA control, the Srmste in X, Y, and Z directions are further reduced by 78.2%, 43.7%, and 51.3% with the comparison of the FONTSM-STA control. The Srmste of the distance between the terminal and the target under DFONTSM-STA control is limited within 3 mm and decreased by 46.7% and 58.0% with the comparison of FONTSM-STA and FONTSM control respectively. Thus, adding dynamic characteristics can not only improve the joint error convergence but also greatly improve the terminal error convergence.
To sum up, the DFONTSM-STA control has the biggest possibility to realize the terminal trajectory tracking with smooth and accurate movements.

6. Experimental Verification

6.1. Experiment Setting

Figure 7 displays the experimental platform. The core components of the low-cost humanoid manipulator system are as follows: the PC; the hardware controller; EPOS4 drivers; Maxon DC motors. The PC calculates each joint’s control input. The hardware controller has data transmission functions. It uses EtherCAT as the communication channel to exchange position and torque data with the PC; EPOS4 drivers support the CANopen protocol. Its communication speed can reach to 1 Mbps. The hall sensor whose resolution converted to joints is 0.3° for obtaining angular position information was inserted in the Maxon DC motor. By debugging the above hardware, a real-time system has been constructed to control the low-cost humanoid manipulator. The parameters of the three controllers in experiments are listed in Table 10 and Table 11.
The experiments adapt the trajectories in the simulation as the target of the low-cost humanoid manipulator. The control performances of DFONTSM-STA control, FONTSM-STA control, and FONTSM control are compared. The simulation movements and physical schematic of the low-cost humanoid manipulator are shown in Figure 8.

6.2. Experiment Results

Figure 9, Figure 10, Figure 11, Figure 12, Figure 13, Figure 14, Figure 15, Figure 16, Figure 17 and Figure 18 present the experimental performances of the low-cost humanoid manipulator.

6.3. Experiment Analysis

The convergence time is calculated when the absolute value of the tracking error is within the 1° (elbow joints) or 0.5° (shoulder joints), which is shown in Table 12.
Figure 10 and Figure 12 are the angular tracking error of the three methods, which show the robustness of the FOSM control. Through experimental data, DFONTSM-STA control is superior in accurate and smooth position tracking performance. Compared with the FONTSM control and FONTSM-STA control, the error convergence time of joint one under DFONTSM-STA control is reduced by 0.548 s and 0.474 s respectively, and the error convergence time of joint two is reduced by 0.229 s and 0.075 s respectively. The error convergence speed of joint three under DFONTSM-STA control is speeded up by 43.5% and 33.6% respectively, and the error convergence speed of joint four is speeded up by 72.7% and 54.6% respectively. The DFONTSM-STA control can significantly improve the error convergence by dynamically changing the spatial position of the sliding mode manifold.
Figure 13 and Figure 14 show the control torques required to drive the low-cost humanoid manipulator. Table 13 shows the maximum variation of the control torque chattering, which can reveal the chattering suppression effects of the three controllers in real-time position control. From Table 13, it can be concluded that the chattering of joints one to four under the FONTSM-STA control is suppressed by 47.8%, 9.6%, 52.2%, and 34.5% respectively compared with the FONTSM control, and the chattering of joints one to four under the DFONTSM-STA control is suppressed by 54.1%, 51.1%, 46.2%, and 55.1% respectively, with the comparison of the FONTSM control. Thus, the chattering suppression performance of DFONTSM-STA control is ahead of the other two control methods.
Figure 15, Figure 16, Figure 17 and Figure 18 show the terminal motion performances of the low-cost humanoid manipulator. According to Figure 18, the DFONTSM-STA control can make the terminal faster and more accurate to tracking the target trajectory. The terminal tracking process of DFONTSM-STA control is smoother than FONTSM-STA control and FONTSM control, which can be illustrated by the terminal tracking trajectory that is decomposed to the X, Y, and Z direction of the base coordination. Compared with the FONTSM control, the motion accuracy of joints one to four of the DFONTSM-STA control embodied by the root mean square of joint tracking error is improved by 55.4% 51.1% 38.5%, and 32.8% respectively. Compared with the FONTSM-STA control, the motion accuracy of joints one to four is improved by 32.1%, 35.4%, 2.9%, and 42.6% respectively.
Table 14 shows the terminal root mean square error of the low-cost humanoid manipulator (Srmste). The Srmste of FOTNSM-STA control and FONTSM control between the terminal and the target trajectory surpasses 5 mm, which indicates the tracking performances of the anthropomorphic trajectory are not quite well. Compared with FONTSM-STA control, the Srmste on the X, Y, and Z coordinate axes of the base coordination under DFONTSM-TSM control is reduced by 35.5%, 45.4%, and 20.9%, respectively. Compared with FONTSM-STA control, the Srmste on the X, Y, and Z coordinate axes of the base coordination under DFONTSM-TSM control is reduced by 69.4%, 36.8%, and 61.2%, respectively. The Srmste of DFOTNSM-TSM control between the terminal and the target trajectory is limited to 3 mm and reduced by 23.7% and 53.3% compared with FONTSM-STA and FONTSM control.
To sum up, the experiments confirm that The DFONTSM-STA control, compared with FONTSM-STA control and FONTSM control, can further improve the accuracy and smoothness of the terminal tracking performances and basically realize anthropomorphic motion of the low-cost humanoid manipulator.

7. Conclusions

A DFONTSM-STA control was proposed for a low-cost humanoid manipulator by combining the dynamic fractional-order nonsingular terminal sliding mode manifold with the super-twisting reaching law. Experiments were conducted to control the low-cost humanoid manipulator and showed that the proposed control method can effectively improve error convergence speed, tracking accuracy, and chattering suppression ability. In error convergence speed, the errors of joints one and two were converged at the beginning while joint three was speeded up by 43.5% and 33.6%, and joint four was speeded up by 72.7% and 54.6% compared with FONTSM and FONTSM-STA controllers. In chattering suppressing, suppression performances of joints, one to four were enhanced by 54.1%, 51.1%, 46.2%, and 55.1%, respectively, compared with FONTSM control. In trajectory tracking performance, compared with FONTSM control and FONTSM-STA control, the tracking accuracy of DFONTSM-STA control was promoted by 53.3% and 23.7% respectively. Simulation and experimental results illustrate the superiority of the proposed DFONTSM-STA control for the low-cost humanoid manipulator.
The proposed DFONTSM-STA controller is applicable to humanoid manipulators that require fast error convergence and accurate trajectory tracking movements. The dynamic model of the low-cost humanoid manipulator is complex, and there exists the problem of big calculations in solving control inputs. Therefore, the adaptive fuzzy method will be studied to estimate model uncertainties and disturbances in future research work.

Author Contributions

Conceptualization, H.D.; Data curation, R.H., X.X. and Y.Z.; Funding acquisition, Y.Z. and H.D.; Methodology, R.H.; Project administration, X.X., Y.Z. and H.D.; Software, R.H. and X.X.; Supervision, H.D.; Validation, R.H., X.X. and Y.Z.; Writing—original draft, R.H.; Writing—review & editing, R.H. and H.D. All authors have read and agreed to the published version of the manuscript.

Funding

This research was funded in part by the National Key Research and Development Program of China under grant number 2018YFB1307203, in part by National Natural Science Foundation of China under Grant 52275297, and in part by the Project of State Key Laboratory of High Performance Complex Manufacturing, Central South University under Grant ZZYJKT2021-17.

Data Availability Statement

Not applicable.

Conflicts of Interest

The authors declare no conflict of interest.

Abbreviations

The following abbreviations are used in this manuscript:
AcronymsDefinition
D-HDenavit-Hartenberg
PCPersonal computer
3DThree dimensional
RLRiemann-Liouville
EtherCATEthernet control automation technology
CANopenController area network open
FOFractional-order
FOSMFractional-order sliding mode
FONTSMFractional-order nonsingular terminal sliding mode
DFONTSMDynamic fractional-order nonsingular terminal sliding mode
STASuper-twisting algorithm
STSMSuper-twisting sliding mode
FONTSM-STAFractional- order nonsingular terminal super-twisting sliding mode
DFONTSM-STADynamic fractional- order nonsingular terminal super-twisting sliding mode

References

  1. Kaneko, K.; Kaminaga, H.; Sakaguchi, T.; Kajita, S.; Morisawa, M.; Kumagai, I.; Kanehiro, F. Humanoid robot HRP-5P: An electrically actuated humanoid robot with high-power and wide-range joints. IEEE Robot. Autom. Lett. 2019, 4, 1431–1438. [Google Scholar] [CrossRef]
  2. Zhang, B.; Xiong, R.; Wu, J. Kinematics and trajectory planning of a novel humanoid manipulator for table tennis. In Proceedings of the 2011 International Conference on Electrical and Control Engineering, Yichang, China, 16–18 September 2011; pp. 3047–3051. [Google Scholar] [CrossRef]
  3. Khusainov, R.; Klimchik, A.; Magid, E. Humanoid robot kinematic calibration using industrial manipulator. In Proceedings of the 2017 International Conference on Mechanical, System and Control Engineering (ICMSC), St. Petersburg, Russia, 19–21 May 2017; pp. 184–189. [Google Scholar]
  4. Sarajchi, M.; Al-Hares, M.K.; Sirlantzis, K. Wearable Lower-Limb Exoskeleton for Children With Cerebral Palsy: A Systematic Review of Mechanical Design, Actuation Type, Control Strategy, and Clinical Evaluation. IEEE Trans. Neural Syst. Rehabil. Eng. 2021, 29, 2695–2720. [Google Scholar] [CrossRef] [PubMed]
  5. Rehman, I.U.; Javed, S.B.; Chaudhry, A.M.; Azam, M.R.; Uppal, A.A. Model-based dynamic sliding mode control and adaptive Kalman filter design for boiler-turbine energy conversion system. J. Process Control 2022, 116, 221–233. [Google Scholar] [CrossRef]
  6. Mechali, O.; Xu, L.M.; Xie, X.M.; Iqbal, J. Theory and practice for autonomous formation flight of quadrotors via distributed robust sliding mode control protocol with fixed-time stability guarantee. Control Eng. Pract. 2022, 123, 105150. [Google Scholar] [CrossRef]
  7. Bano, S.; Azam, M.R.; Uppal, A.A.; Javed, S.B.; Bhatti, A.I. Robust p53 recovery using chattering free sliding mode control and a gain-scheduled modified Utkin observer. J. Theor. Biol. 2021, 532, 110914. [Google Scholar] [CrossRef]
  8. Qin, L.; Liang, L.; Liu, F.; Jin, Z. The application of adaptive backstepping sliding mode for hybrid humanoid robot arm trajectory tracking control. In Proceedings of the 2013 International Conference on Advanced Mechatronic Systems, Luoyang, China, 25–27 September 2013; pp. 730–735. [Google Scholar]
  9. Kuan, J.Y.; Huang, H.P. Independent joint dynamic sliding mode control of a humanoid robot arm. In Proceedings of the 2008 IEEE International Conference on Robotics and Biomimetics, Dali, China, 6–8 December 2019; pp. 602–607. [Google Scholar]
  10. Sanchez-Magos, M.; Ballesteros-Escamilla, M.; Cruz-Ortiz, D.; Salgado, I.; Chairez, I. Terminal sliding mode control of a virtual humanoid robot. In Proceedings of the 2019 6th International Conference on Control, Decision and Information Technologies (CoDIT), Paris, France, 23–26 April 2019; pp. 726–731. [Google Scholar]
  11. Ganjefar, S.; Sarajchi, M.H.; Hoseini, S.M.; Shao, Z. Lambert W Function Controller Design for Teleoperation Systems. Int. J. Precis. Eng. Manuf. 2019, 20, 101–110. [Google Scholar] [CrossRef]
  12. Gao, W.; Hung, J.C. Variable structure control of nonlinear systems: A new approach. IEEE Trans. Ind. Electron. 1993, 40, 45–55. [Google Scholar]
  13. Ullah, M.I.; Ajwad, S.A.; Irfan, M.; Iqbal, J. Non-linear Control Law for Articulated Serial Manipulators: Simulation Augmented with Hardware Implementation. Elektron. Elektrotechnika 2016, 22, 3–7. [Google Scholar] [CrossRef] [Green Version]
  14. Utkin, V. Variable structure systems with sliding modes. IEEE Trans. Autom. Control 1977, 22, 212–220. [Google Scholar] [CrossRef]
  15. Fuh, C.C. Variable-thickness boundary layers for sliding mode control. J. Mar. Sci. Technol. 2008, 16, 7. [Google Scholar] [CrossRef]
  16. Young, K.D.; Utkin, V.; Ozguner, U.A. control engineer’s guide to sliding mode control. IEEE Trans. Control Syst. Technol. 1999, 7, 328–342. [Google Scholar] [CrossRef] [Green Version]
  17. Soheil, G.; Mohammad, H.S.; Mahmoud Hoseini, S. Teleoperation Systems Design Using Singular Perturbation Method and Sliding Mode Controllers. J. Dyn. Syst. Meas. Control 2014, 136, 051005. [Google Scholar]
  18. Chen, Y.-Q.; Wei, Y.-H.; Wang, Y. On 2 types of robust reaching laws. Int. J. Robust Nonlinear Control 2018, 28, 2651–2667. [Google Scholar] [CrossRef]
  19. Giap, V.-N.; Huang, S.-C. Effectiveness of fuzzy sliding mode control boundary layer based on uncertainty and disturbance compensator on suspension active magnetic bearing system. Meas. Control 2020, 53, 934–942. [Google Scholar] [CrossRef] [Green Version]
  20. Tayebi-Haghighi, S.; Piltan, F.; Kim, J.M. Robust Composite High-Order Super-Twisting Sliding Mode Control of Robot Manipulators. Robotics 2018, 6, 13. [Google Scholar] [CrossRef] [Green Version]
  21. Floquet, T.; Barbot, J.P.; Perruquetti, W. Higher order sliding mode stabilization for a class of non holomic perturbed system. Automatica 2003, 39, 1077–1083. [Google Scholar] [CrossRef]
  22. Davila, J.; Fridman, L.; Levant, A. Second-order sliding-mode observer for mechanical systems. IEEE Trans. Autom. Control 2005, 50, 1785–1789. [Google Scholar] [CrossRef]
  23. Davila, J.; Fridman, L.; Poznyak, A. Observation and identification of mechanical systems via second order sliding modes. In International Workshop on Variable Structure Systems; IEEE: New York, NY, USA, 2006; pp. 232–237. [Google Scholar]
  24. Guzmán, E.; Moreno, J.A. Super-twisting observer for second-order systems with time-varying coefficient. IET Control Theory Appl. 2015, 9, 553–562. [Google Scholar] [CrossRef]
  25. Mu, C.; Sun, C. A new finite time convergence condition for super-twisting observer based on Lyapunov analysis. Asian J. Control 2015, 17, 1050–1060. [Google Scholar] [CrossRef]
  26. Tenoch, G.; Jaime, A.M.; Fridman, L. Variable Gain Super-Twisting Sliding Mode Control. IEEE Trans. Autom. Control 2012, 57, 2100–2105. [Google Scholar]
  27. Utkin, V. On convergence time and disturbance rejection of super-twisting control. IEEE Trans. Autom. Control 2013, 58, 2013–2017. [Google Scholar] [CrossRef]
  28. Lochan, K.; Singh, J.P.; Roy, B.K. Adaptive time-varying super-twisting global SMC for projective synchronisation of flexible manipulator. Nonlinear Dyn. 2018, 93, 2071–2088. [Google Scholar] [CrossRef]
  29. Nasim, U.; Yasir, M.; Jawad, A.; Amjad, A.; Jamshed, I. UAVS-UGV Leader Follower Formation Using Adaptive Non-Singular Terminal Super Twisting Sliding Mode Control. IEEE Access 2021, 5, 3081483. [Google Scholar]
  30. Moreno, J.A.; Osorio, M. A Lyapunov approach to second-order sliding mode controllers and observers. In Proceedings of the 47th IEEE Conference on Decision and Control, Cancún, Mexico, 9–11 December 2008; pp. 2856–2861. [Google Scholar]
  31. Kali, Y.; Saad, M.; Benjelloun, K.; Khairallah, C. Super-twisting algorithm with time delay estimation for uncertain robot manipulators. Nonlinear Dyn. 2018, 93, 557–569. [Google Scholar] [CrossRef]
  32. Yin, C.; Chen, Y.; Zhong, S.-M. Fractional-order sliding mode based extremum seeking control of a class of nonlinear systems. Automatica 2014, 50, 3173–3181. [Google Scholar] [CrossRef]
  33. Chen, D.; Zhang, J.D.; Li, Z.K. A Novel Fixed-Time Trajectory Tracking Strategy of Unmanned Surface Vessel Based on the Fractional Sliding Mode Control Method. Electronics 2022, 11, 726. [Google Scholar] [CrossRef]
  34. Maaruf, M.; Khalid, M. Global sliding-mode control with fractional-order terms for the robust optimal operation of a hybrid renewable microgrid with battery energy storage. Electronics 2021, 11, 88. [Google Scholar] [CrossRef]
  35. Zhu, L.K.; Chen, X.R.; Qi, X.; Zhang, J. Research on Fractional-Order Global Fast Terminal Sliding Mode Control of MDF Continuous Hot-Pressing Position Servo System Based on Adaptive RBF Neural Network. Electronics 2022, 11, 1117. [Google Scholar] [CrossRef]
  36. Aghababa, M.P. A fractional-order controller for vibration suppression of uncertain structures. ISA Trans. 2013, 52, 881–887. [Google Scholar] [CrossRef]
  37. Cuong, H.M.; Dong, H.Q.; Trieu, P.V.; Tuan, L.A. Adaptive fractional-order terminal sliding mode control of rubber-tired gantry cranes with uncertainties and unknown disturbances. Mech. Syst. Signal Proc. 2021, 154, 107601. [Google Scholar] [CrossRef]
  38. Wang, Y.; Yan, F.; Zhu, K.; Chen, B.; Wu, H. A new practical robust control of cable-driven manipulators using time-delay estimation. Int. J. Robust Nonlinear Control. 2019, 29, 3405–3425. [Google Scholar] [CrossRef]
  39. Duc, T.M.; Hoa, N.V.; Dao, T.P. Adaptive Fuzzy Fractional-Order Nonsingular Terminal Sliding Mode Control for a Class of Second-Order Nonlinear Systems. J. Comput. Nonlinear Dyn. 2018, 13, 031004. [Google Scholar] [CrossRef]
  40. Tuan, L.A. Neural observer and adaptive fractional-order backstepping fast-terminal sliding-mode control of RTG cranes. IEEE Trans. Ind. Electron. 2021, 68, 434–442. [Google Scholar] [CrossRef]
  41. Nojavanzadeh, D.; Badamchizadeh, M. Adaptive Fractional-order Non-singular Fast Terminal Sliding Mode Control for Robot Manipulators. IET Control Theory Appl. 2016, 10, 1565–1572. [Google Scholar] [CrossRef]
  42. Su, L.; Guo, X.; Ji, Y.; Tian, Y. Tracking control of cable-driven manipulator with adaptive fractional-order nonsingular fast terminal sliding mode control. J. Vib. Control 2021, 27, 2482–2493. [Google Scholar] [CrossRef]
  43. Wang, Y.Y.; Peng, J.W.; Zhu, K.W.; Chen, B.; Wu, H.T. Adaptive PID-fractional-order nonsingular terminal sliding mode control for cable-driven manipulators using time-delay estimation. Int. J. Syst. Sci. 2020, 51, 3118–3133. [Google Scholar] [CrossRef]
  44. Wang, Y.Y.; Gu, L.Y.; Xu, Y.H.; Cao, X.X. Practical tracking control of robot manipulators with continuous fractional-order nonsingular terminal sliding mode. IEEE Trans. Ind. Electron. 2016, 63, 6194–6204. [Google Scholar] [CrossRef]
  45. Wang, Y.Y.; Chen, J.W.; Yan, F.; Zhu, K.W.; Chen, B.; Wang, Y. Adaptive super-twisting fractional-order nonsingular terminal sliding mode control of cable-driven manipulators. ISA Trans. 2018, 75, 163–180. [Google Scholar] [CrossRef]
  46. Zhang, Y.Y.; Yang, X.H.; Wei, P.; Liu, P.X. Fractional-order adaptive non-singular fast terminal sliding mode control with time delay estimation for robotic manipulators. IET Control Theory Appl. 2020, 14, 2556–2565. [Google Scholar] [CrossRef]
  47. Hu, R.; Deng, H.; Zhang, Y. Novel dynamic-sliding-mode-manifold-based continuous fractional-order nonsingular terminal sliding mode control for a class of second-order nonlinear systems. IEEE Access 2020, 8, 19820–19829. [Google Scholar] [CrossRef]
  48. Kilbas, A.; Srivastava, H.M.; Trujillo, J.J. Fractional integrals and fractional derivatives. In Theory Applications of Fractional Differential Equations; Elsevier: Amsterdam, The Netherlands, 2006; pp. 69–133. [Google Scholar]
Figure 1. Three dimensional (3D) model and Denavit-Hartenberg (D-H) coordinate of the low-cost humanoid manipulator.
Figure 1. Three dimensional (3D) model and Denavit-Hartenberg (D-H) coordinate of the low-cost humanoid manipulator.
Electronics 11 03693 g001
Figure 2. Position tracking trajectory of each joint. (a): joint one; (b): joint two; (c): joint three; (d): joint four.
Figure 2. Position tracking trajectory of each joint. (a): joint one; (b): joint two; (c): joint three; (d): joint four.
Electronics 11 03693 g002
Figure 3. The position tracking error of each joint. (a): joint one; (b): joint two; (c): joint three; (d): joint four.
Figure 3. The position tracking error of each joint. (a): joint one; (b): joint two; (c): joint three; (d): joint four.
Electronics 11 03693 g003
Figure 4. Control input torque of each joint (a): joint one; (b): joint two; (c): joint three; (d): joint four.
Figure 4. Control input torque of each joint (a): joint one; (b): joint two; (c): joint three; (d): joint four.
Electronics 11 03693 g004
Figure 5. Terminal motion trajectory and its tracking error (a): Terminal trajectory tracking curve under base coordinate; (b): Terminal trajectory tracking error; (c): axis X position; (d): axis X error.
Figure 5. Terminal motion trajectory and its tracking error (a): Terminal trajectory tracking curve under base coordinate; (b): Terminal trajectory tracking error; (c): axis X position; (d): axis X error.
Electronics 11 03693 g005
Figure 6. Terminal motion trajectory and its tracking error on Y axis and Z axis of the base coordination. (a): axis Y position; (b): axis Y error; (c): axis Z position; (d): axis Z error.
Figure 6. Terminal motion trajectory and its tracking error on Y axis and Z axis of the base coordination. (a): axis Y position; (b): axis Y error; (c): axis Z position; (d): axis Z error.
Electronics 11 03693 g006
Figure 7. The architecture of the humanoid manipulator system.
Figure 7. The architecture of the humanoid manipulator system.
Electronics 11 03693 g007
Figure 8. Simulation and physical schematic of humanoid manipulator movement. (a): Physical schematic (b): The simulation movement.
Figure 8. Simulation and physical schematic of humanoid manipulator movement. (a): Physical schematic (b): The simulation movement.
Electronics 11 03693 g008
Figure 9. Position tracking trajectories of the shoulder joints. (a): joint one; (b): joint two.
Figure 9. Position tracking trajectories of the shoulder joints. (a): joint one; (b): joint two.
Electronics 11 03693 g009
Figure 10. Position tracking errors of the shoulder joints. (a): joint one; (b): joint two.
Figure 10. Position tracking errors of the shoulder joints. (a): joint one; (b): joint two.
Electronics 11 03693 g010
Figure 11. Position tracking trajectories of the elbow joints. (a): joint three; (b): joint four.
Figure 11. Position tracking trajectories of the elbow joints. (a): joint three; (b): joint four.
Electronics 11 03693 g011
Figure 12. The position tracking error of the elbow joints. (a): joint three; (b): joint four.
Figure 12. The position tracking error of the elbow joints. (a): joint three; (b): joint four.
Electronics 11 03693 g012
Figure 13. Input torques of the shoulder joints. (a): joint one; (b): joint two.
Figure 13. Input torques of the shoulder joints. (a): joint one; (b): joint two.
Electronics 11 03693 g013
Figure 14. Input torques of elbow joints. (a): joint three; (b): joint four.
Figure 14. Input torques of elbow joints. (a): joint three; (b): joint four.
Electronics 11 03693 g014
Figure 15. Terminal trajectory and its tracking error. (a): terminal trajectory on the X axis; (b): terminal tracking error on the X axis.
Figure 15. Terminal trajectory and its tracking error. (a): terminal trajectory on the X axis; (b): terminal tracking error on the X axis.
Electronics 11 03693 g015
Figure 16. Terminal trajectory and its tracking error. (a): terminal trajectory on the Y axis; (b): terminal tracking error on the Y axis.
Figure 16. Terminal trajectory and its tracking error. (a): terminal trajectory on the Y axis; (b): terminal tracking error on the Y axis.
Electronics 11 03693 g016
Figure 17. Terminal trajectory and its tracking error. (a): terminal trajectory on the Z axis; (b): terminal tracking error on the Z axis.
Figure 17. Terminal trajectory and its tracking error. (a): terminal trajectory on the Z axis; (b): terminal tracking error on the Z axis.
Electronics 11 03693 g017
Figure 18. Terminal motion under base coordination system. (a): Terminal trajectory tracking curve; (b): initial part of the terminal trajectory tracking curve.
Figure 18. Terminal motion under base coordination system. (a): Terminal trajectory tracking curve; (b): initial part of the terminal trajectory tracking curve.
Electronics 11 03693 g018
Table 1. The parameter list of D-H.
Table 1. The parameter list of D-H.
Link i α i 1 a i 1 θ i d i
100θ1(0°)0
290°0θ2(−90°)0
390°0θ3(−90°)d3 = −313 mm
490°0θ4(−180°)0
Terminal0θ5(0°)d5 = −441 mm
Table 2. The center mass position of the connecting rod.
Table 2. The center mass position of the connecting rod.
Center Mass Position (m)Joint OneJoint TwoJoint ThreeJoint Four
X0−0.04 × 10−30−0.94 × 10−3
Y0125.16 × 10−3−7 × 10−3166.42 × 10−3
Z11.57 × 10−37.71 × 10−3−0.26 × 10−36.97 × 10−3
Table 3. Mass of connecting rod of the humanoid manipulator.
Table 3. Mass of connecting rod of the humanoid manipulator.
Mass (kg)Rod OneRod TwoRod ThreeRod Four
M728.22 × 10−37016.49 × 10−3382.18 × 10−33341.64 × 10−3
Table 4. Connecting rod inertia of humanoid manipulator.
Table 4. Connecting rod inertia of humanoid manipulator.
Moment of Inertia
( k g m 2 )
Rod OneRod TwoRod ThreeRod Four
Ixx1,709,909.71 × 10−926,245,6649.98 × 10−9625,787.92 × 10−9158,795,139.03 × 10−9
Iyy875,916.10 × 10−920,863,623.56 × 10−9544,829.79 × 10−92,996,242.06 × 10−9
Izz1,375,449.61 × 10−9249,837,989.90 × 10−9270,182.90 × 10−9157,591,605.74 × 10−9
Ixy24.45 × 10−9−46,664.65 × 10−913.85 × 10−9−1,391,395.68 × 10−9
Iyz−47.57 × 10−917,384,004.90 × 10−9279.02 × 10−9707,363.35 × 10−9
Ixz16.53 × 10−9185,311.42 × 10−9−2.14 × 10−9107,519.45 × 10−9
Table 5. Parameters list of dynamic fractional-order nonsingular terminal super-twisting sliding mode (DFONTSM-STA) control.
Table 5. Parameters list of dynamic fractional-order nonsingular terminal super-twisting sliding mode (DFONTSM-STA) control.
ρ 1 ρ 2 α κ δ 0 k 0 α λ ρ 0
Joint one40410.120.80.92
Joint two40410.120.80.92
Joint three70410.120.80.90.8
Joint four70410.120.80.90.8
Table 6. Parameters list of fractional-order nonsingular terminal super-twisting sliding mode (FONTSM-STA) control and fractional-order nonsingular terminal sliding mode (FONTSM) control.
Table 6. Parameters list of fractional-order nonsingular terminal super-twisting sliding mode (FONTSM-STA) control and fractional-order nonsingular terminal sliding mode (FONTSM) control.
k 1 ρ 1 k 2 ρ 2 k 0 α λ
Joint one60406410.80.9
Joint two60406410.80.9
Joint three80706440.80.9
Joint four80706440.80.9
Table 7. Convergence time for each joint.
Table 7. Convergence time for each joint.
|e| ≤ 0.5°
|e| ≤ 1°
DFONTSM-STA
(tconv)s
FONTSM-STA
(tconv)s
FONTSM
(tconv)s
Joint one0.1010.4090.443
Joint two0.0900.4640.464
Joint three0.0360.5151.309
Joint four0.0210.0670.098
Table 8. The maximum amplitude of the low-cost humanoid manipulator control torque variations.
Table 8. The maximum amplitude of the low-cost humanoid manipulator control torque variations.
|τ|max
tp = 20 ms
DONTSM-STAFONTSM-STAFONTSM
Joint one4.28753.735512.7760
Joint two3.57604.35417.4774
Joint three0.72940.63970.9683
Joint four2.00932.14794.2029
Table 9. Terminal position root mean square error.
Table 9. Terminal position root mean square error.
Srmste (mm)DFONTSM-STAFONTSM-STAFONTSM
Axis x0.11260.51651.2403
Axis y2.33294.14345.4771
Axis z1.58383.25143.6918
Distance between terminal and target2.82205.29216.7206
Table 10. Parameters of DFONTSM-STA control.
Table 10. Parameters of DFONTSM-STA control.
ρ 1 ρ 2 α κ δ 0 k 0 α λ ρ 0
Joint one6610.0510.80.91
Joint two6610.0510.80.91
Joint three3310.0510.80.92
Joint four3310.0510.80.92
Table 11. Parameters of FONTSM-STA and FONTSM control.
Table 11. Parameters of FONTSM-STA and FONTSM control.
k 1 ρ 1 k 2 ρ 2 k 0 α λ
Joint one9.5666150.80.9
Joint two9.5666150.80.9
Joint three6.5333150.80.9
Joint four6.5333150.80.9
Table 12. Convergence time for each joint.
Table 12. Convergence time for each joint.
|e| ≤ 0.5° or |e| ≤ 1°DFONTSM-STA
(tconv)s
FONTSM-STA
(tconv)s
FONTSM
(tconv)s
Joint one00.4740.548
Joint two00.0750.229
Joint three6.1886.3957.101
Joint four5.5625.9347.057
Table 13. The maximum variation of control torque in a small interval.
Table 13. The maximum variation of control torque in a small interval.
|τ|max (tp = 20 ms)DFONTSM-STAFONTSM-STAFONTSM
Joint one0.0095 0.01080.0207
Joint two0.01120.02070.0229
Joint three0.02040.01810.0379
Joint four0.01510.0220.0336
Table 14. Terminal root mean square error of the humanoid manipulator.
Table 14. Terminal root mean square error of the humanoid manipulator.
Srmste (mm)DFONTSM-STAFONTSM-STAFONTSM
Axis x0.9831.5243.212
Axis y2.5844.7304.090
Axis z1.9842.5095.111
Distance between the terminal and the target3.4035.5677.292
Publisher’s Note: MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Share and Cite

MDPI and ACS Style

Hu, R.; Xu, X.; Zhang, Y.; Deng, H. Dynamic Fractional-Order Nonsingular Terminal Super-Twisting Sliding Mode Control for a Low-Cost Humanoid Manipulator. Electronics 2022, 11, 3693. https://doi.org/10.3390/electronics11223693

AMA Style

Hu R, Xu X, Zhang Y, Deng H. Dynamic Fractional-Order Nonsingular Terminal Super-Twisting Sliding Mode Control for a Low-Cost Humanoid Manipulator. Electronics. 2022; 11(22):3693. https://doi.org/10.3390/electronics11223693

Chicago/Turabian Style

Hu, Rong, Xiaolei Xu, Yi Zhang, and Hua Deng. 2022. "Dynamic Fractional-Order Nonsingular Terminal Super-Twisting Sliding Mode Control for a Low-Cost Humanoid Manipulator" Electronics 11, no. 22: 3693. https://doi.org/10.3390/electronics11223693

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