Backstepping based Saturated Sliding Mode Joints ...

7
International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:20 No:06 97 202406-5959-IJMME-IJENS ยฉ December 2020 IJENS I J E N S Backstepping based Saturated Sliding Mode Joints Controller for Humanoid Walking Gait Abstractโ€” Development of a joint controller for humanoid robot is a challenging task since the dynamic system of the humanoid robot has nonlinearity characteristic and is extremely vulnerable to disturbance. This paper presents a robust back- stepping sliding mode controller to track the pre-computed joint trajectories in a commercial humanoid robot known as UXA-90. The proposed controller utilizes the back-stepping technique to decompose the dynamic equation of UXA-90 into reduced order systems which is asymptotically stable, then the control law for back-stepping SMC is chosen to guarantee that the systemโ€™s states are driven to the sliding manifold and stay there for all future time. Furthermore, the control law utilizes saturation function instead of sign function to reduce the chattering effect. Finally, some simulation results are carried out through MATLAB to evaluate the effectiveness of the proposed controller in comparison to the previous controller. Index Termโ€” Sliding mode controller, biped walking, back- stepping, humanoid robot. I. INTRODUCTION Human locomotion has been one of the most sophisticated topics to scientists in different fields: biologists, physiologists, mathematicians and engineers [1, 2, 3]. Therefore, it is a critical task for humanoid robots to imitate human locomotion because unlike human, they are not equipped with visual system to recognize object, soft tissues in the leg to reduce impact force, the brain to maintain balance. Despite many efforts in performing function like biped walking, the problem has yet been solved satisfactorily. Traditionally, there are two levels of controller when controlling a humanoid robot: the high-level walking pattern controller and the low-level joint controller [4]. The high-level controller ensures that the walking pattern is dynamically stable. Kajita et al. [5] proposed the preview control to modify COM trajectory while walking. Jun-Ho Oh et al. [6] utilized two high-level controllers: Landing Position Controller and Landing Timing Controller to adjust the walking trajectory. The low-level controller is then used to track the pre- computed joint trajectories, which are calculated by inverse kinematic. Various methods in designing the joint controller have been proposed in existing literatures. To track the pre- computed trajectories, Jun Ho Oh et al. [6] from Korea Advanced Institute of Science and Technology used PD controller to control position of each joint of KHR-3. CHARLI-2 from Virginia Tech utilized differential controller, based on the IMUโ€™s feedback data to control the jointsโ€™ positions [7]. Park and Kim successfully implemented the computed torque controller (CTC) to control a 7-link biped robot [8]. However, the dynamic of humanoid robot has many non-linear terms, uncertainty parameters, which degrade the performance of CTC and classic PID over time [9]. To avoid this problem, it is essential to adopt an advance control strategy to control the joints such as robust control [10, 11]. The SMC is one of the suitable controllers for controlling humanoid robotโ€™s dynamic system because it can guarantee robustness for system with strong uncertainty parameters, nonlinearity characteristics and even rejects disturbance [12, 13, 14]. Raibert et al. [15] has compared three controller schemes implemented on the 5-link planar biped robot: SMC, PID, CTC and the results showed that SMC has far smaller average tracking error and overshoot than the other two: PID and CTC. Moosavian et al. [16] modeled a 6 DoFs lower body and used a fuzzy regulated SMC on it to reduce the chattering effect, the results showed that the tracking error were considerably small even with major uncertainties. In-Gyu Park and Jin-Geol Kim used SMC to control each leg of a robot, the simulation results showed that the trajectories tracking was done very well [17]. In our previous study, the low-level joint controller for humanoid robot UXA-90 was proposed using sliding mode controller (SMC) to calculate the torque required for each joint. Although the SMC outperform the traditional controllers in tracking the pre-computed trajectories of the 12 joints, the control input of SMC is significantly suffered by the chattering phenomenon. Additionally, the pre-computed joint trajectories introduced peak and valley values at certain points, where the SMC was not able to drive the tracking error to zero. This problem can be realized by increasing the controller gain, however, it causes the chattering phenomenon worse. To overcome the aforementioned problems, an improved SMC should be implemented. The dynamic system of the humanoid robot is very complex. Therefore, the back- stepping technique provides an effective way to decompose the complex system into reduced order subsystems, then the SMC can guarantee their robustness despite the uncertainty parameters and external disturbances. As mentioned above, the SMC has proven its robustness against model uncertainty parameters, non-linear terms. However, the main drawback of the SMC is the use of the sign function, leading to the undesirable chattering phenomenon. This phenomenon reduces the performance of the system, damaging the mechanical parts in the long-time operation. In this paper, a back-stepping SMC is proposed to control the joints in humanoid robot UXA-90. First, the dynamic system of the lower body is derived using Euler-Lagrange method. Secondly, the back-stepping method is employed to decompose the aforementioned dynamic system into subsystems, then the control law based on SMC is proposed to drive the subsystems to the desired sliding manifold. To reduce the chattering effect, the saturation function is adopted in the control law instead of the sign function. Finally, the Xuan Tien Nguyen 2,3 , Tri Duc Tran 1 , Huy Hung Nguyen 1,3,* , Nhut Phuong Tong 1 ,Thanh Phuong Nguyen 2 and Tan Tien Nguyen 1,* 1 National Key Laboratory of Digital Control and System Engineering (DCSELAB), HCMUT, VNU-HCM 2 Hutech Institute of Engineering, Hochiminh City University of Technology (HUTECH) 3 Faculty of Electronics and Telecommunication, Saigon University, Vietnam * Corresponding author: [email protected], [email protected]

Transcript of Backstepping based Saturated Sliding Mode Joints ...

Page 1: Backstepping based Saturated Sliding Mode Joints ...

International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:20 No:06 97

202406-5959-IJMME-IJENS ยฉ December 2020 IJENS I J E N S

Backstepping based Saturated Sliding Mode Joints

Controller for Humanoid Walking Gait

Abstractโ€” Development of a joint controller for humanoid

robot is a challenging task since the dynamic system of the

humanoid robot has nonlinearity characteristic and is extremely

vulnerable to disturbance. This paper presents a robust back-

stepping sliding mode controller to track the pre-computed joint

trajectories in a commercial humanoid robot known as UXA-90.

The proposed controller utilizes the back-stepping technique to

decompose the dynamic equation of UXA-90 into reduced order

systems which is asymptotically stable, then the control law for

back-stepping SMC is chosen to guarantee that the systemโ€™s

states are driven to the sliding manifold and stay there for all

future time. Furthermore, the control law utilizes saturation

function instead of sign function to reduce the chattering effect.

Finally, some simulation results are carried out through

MATLAB to evaluate the effectiveness of the proposed

controller in comparison to the previous controller.

Index Termโ€” Sliding mode controller, biped walking, back-

stepping, humanoid robot.

I. INTRODUCTION Human locomotion has been one of the most sophisticated

topics to scientists in different fields: biologists, physiologists, mathematicians and engineers [1, 2, 3]. Therefore, it is a critical task for humanoid robots to imitate human locomotion because unlike human, they are not equipped with visual system to recognize object, soft tissues in the leg to reduce impact force, the brain to maintain balance. Despite many efforts in performing function like biped walking, the problem has yet been solved satisfactorily.

Traditionally, there are two levels of controller when controlling a humanoid robot: the high-level walking pattern controller and the low-level joint controller [4]. The high-level controller ensures that the walking pattern is dynamically stable. Kajita et al. [5] proposed the preview control to modify COM trajectory while walking. Jun-Ho Oh et al. [6] utilized two high-level controllers: Landing Position Controller and Landing Timing Controller to adjust the walking trajectory. The low-level controller is then used to track the pre-computed joint trajectories, which are calculated by inverse kinematic. Various methods in designing the joint controller have been proposed in existing literatures. To track the pre-computed trajectories, Jun Ho Oh et al. [6] from Korea Advanced Institute of Science and Technology used PD controller to control position of each joint of KHR-3. CHARLI-2 from Virginia Tech utilized differential controller, based on the IMUโ€™s feedback data to control the jointsโ€™ positions [7]. Park and Kim successfully implemented the computed torque controller (CTC) to control a 7-link biped robot [8]. However, the dynamic of humanoid robot has many non-linear terms, uncertainty parameters, which degrade the performance of CTC and classic PID over time [9]. To avoid

this problem, it is essential to adopt an advance control strategy to control the joints such as robust control [10, 11]. The SMC is one of the suitable controllers for controlling humanoid robotโ€™s dynamic system because it can guarantee robustness for system with strong uncertainty parameters, nonlinearity characteristics and even rejects disturbance [12, 13, 14]. Raibert et al. [15] has compared three controller schemes implemented on the 5-link planar biped robot: SMC, PID, CTC and the results showed that SMC has far smaller average tracking error and overshoot than the other two: PID and CTC. Moosavian et al. [16] modeled a 6 DoFs lower body and used a fuzzy regulated SMC on it to reduce the chattering effect, the results showed that the tracking error were considerably small even with major uncertainties. In-Gyu Park and Jin-Geol Kim used SMC to control each leg of a robot, the simulation results showed that the trajectories tracking was done very well [17].

In our previous study, the low-level joint controller for humanoid robot UXA-90 was proposed using sliding mode controller (SMC) to calculate the torque required for each joint. Although the SMC outperform the traditional controllers in tracking the pre-computed trajectories of the 12 joints, the control input of SMC is significantly suffered by the chattering phenomenon. Additionally, the pre-computed joint trajectories introduced peak and valley values at certain points, where the SMC was not able to drive the tracking error to zero. This problem can be realized by increasing the controller gain, however, it causes the chattering phenomenon worse. To overcome the aforementioned problems, an improved SMC should be implemented. The dynamic system of the humanoid robot is very complex. Therefore, the back-stepping technique provides an effective way to decompose the complex system into reduced order subsystems, then the SMC can guarantee their robustness despite the uncertainty parameters and external disturbances. As mentioned above, the SMC has proven its robustness against model uncertainty parameters, non-linear terms. However, the main drawback of the SMC is the use of the sign function, leading to the undesirable chattering phenomenon. This phenomenon reduces the performance of the system, damaging the mechanical parts in the long-time operation.

In this paper, a back-stepping SMC is proposed to control the joints in humanoid robot UXA-90. First, the dynamic system of the lower body is derived using Euler-Lagrange method. Secondly, the back-stepping method is employed to decompose the aforementioned dynamic system into subsystems, then the control law based on SMC is proposed to drive the subsystems to the desired sliding manifold. To reduce the chattering effect, the saturation function is adopted in the control law instead of the sign function. Finally, the

Xuan Tien Nguyen2,3, Tri Duc Tran1 , Huy Hung Nguyen1,3,* , Nhut Phuong Tong1 ,Thanh Phuong Nguyen2 and

Tan Tien Nguyen1,* 1National Key Laboratory of Digital Control and System Engineering (DCSELAB), HCMUT, VNU-HCM

2 Hutech Institute of Engineering, Hochiminh City University of Technology (HUTECH) 3Faculty of Electronics and Telecommunication, Saigon University, Vietnam

*Corresponding author: [email protected], [email protected]

Page 2: Backstepping based Saturated Sliding Mode Joints ...

International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:20 No:06 98

202406-5959-IJMME-IJENS ยฉ December 2020 IJENS I J E N S

simulation is carried out through MATLAB to evaluate its effectiveness.

II. DYNAMIC MODEL

Table I

UXA-90 jointsโ€™ constraints

๐›‰ Constraint ๐›‰ Constraint

๐œฝ๐Ÿ โˆ’20ยฐ~20ยฐ ๐œฝ๐Ÿ• โˆ’40ยฐ~50ยฐ

๐œฝ๐Ÿ โˆ’20ยฐ~50ยฐ ๐œฝ๐Ÿ– โˆ’120ยฐ~30ยฐ

๐œฝ๐Ÿ‘ โˆ’150ยฐ~0ยฐ ๐œฝ๐Ÿ— โˆ’40ยฐ~0ยฐ

๐œฝ๐Ÿ’ โˆ’30ยฐ~120ยฐ ๐œฝ๐Ÿ๐ŸŽ 0ยฐ~150ยฐ

๐œฝ๐Ÿ“ 0ยฐ~40ยฐ ๐œฝ๐Ÿ๐Ÿ โˆ’50ยฐ~20ยฐ

๐œฝ๐Ÿ” โˆ’40ยฐ~50ยฐ ๐œฝ๐Ÿ๐Ÿ โˆ’20ยฐ~20ยฐ

UXA-90 has 6 DOFs leg, a total of 12 DOFs for its lower body. Each joint is actuated by DC servo motor from Robobuilder. Normally, the humanoid robot has three phases when running: single support phase, biped-in-the-air phase, double support phase (impact phase). Since UXA-90 currently has only a straight walking function, it has a total of two phases: single support phase, double support phase. To imitate a humanโ€™s joints precisely, twelve joints in the lower body of UXA-90 are constrained according to the motion range in humanโ€™s body [18] as shown in Table I.

By assigning coordinate frame as shown in Fig. 1, a 12 DOFs dynamic model can be derived by using Euler-Lagrange method. The Denavit-Hatenberg parameters and transformation matrixes are taken from [19].

0z1

0y1z2

1y

2z

2y

0x

1x

2x

3x

3z

3y

4z

4x

4y5y

5z

5x

3

456z

6x

6y7z7x

7y8x

8z

8y

9z

9y

9x

10

10z

10y

10x11

11z12

11y11x

8

7

6

9

12z12x

12y

fx fy

fz

, rollx , pitchy

, yawz

Fig. 1. Coordinates system of lower body

A. Swing phase model

This phase occurs when only one foot is in contact with

the ground as shown in Fig. 2, so the whole lower body can

be considered as a 12 DOFs robot manipulator.

By applying Euler-Lagrange method, the dynamic

model for a manipulator is given by [20]:

๐‘ซ(๐œฝ)๏ฟฝฬˆ๏ฟฝ + ๐‘ช(๐œฝ, ๏ฟฝฬ‡๏ฟฝ)๏ฟฝฬ‡๏ฟฝ + ๐’ˆ(๐œฝ) = ๐‰ where

๐œฝ = [๐œƒ1, ๐œƒ2, โ€ฆ , ๐œƒ12] โˆˆ โ„›12ร—1 is the vector of joints.

๐‘ซ(๐œฝ) โˆˆ โ„›12ร—12 is the inertia matrix.

๐‘ช(๐œฝ, ๏ฟฝฬ‡๏ฟฝ ) โˆˆ โ„›12ร—12 is the Coriolis and centrifugal force matrix.

๐’ˆ(๐œฝ) โˆˆ โ„›12ร—1 is the vector of gravitational forces.

๐‰ = [๐œ1, ๐œ2, โ€ฆ , ๐œ12] โˆˆ โ„›12ร—1 is the vector of joint torques.

2m

3m

4m

5m

fm

hm

O x

z

Swing leg

Stance leg

Fig. 2. Swing phase

B. Impact phase model

This phase is activated when the swing leg comes to

contact with the ground as shown in Fig. 3, the duration of

this process is assumed to be infinitesimal time interval.

During this process, external forces acting on the robot appear

due to the contact made by the swing leg and the ground. The dynamic equation in this case is:

๐‘ซ(๐œฝ)๏ฟฝฬˆ๏ฟฝ + ๐‘ช(๐œฝ, ๏ฟฝฬ‡๏ฟฝ)๏ฟฝฬ‡๏ฟฝ + ๐’ˆ(๐œฝ)

= ๐‰ + ๐œน๐‘ญ๐’†๐’™๐’•

where

๐œฝ = [๐œƒ1, ๐œƒ2, โ€ฆ , ๐œƒ12] โˆˆ โ„›12ร—1 is the vector of joints.

๐‘ซ(๐œฝ) โˆˆ โ„›12ร—12 is the inertia matrix.

๐‘ช(๐œฝ, ๏ฟฝฬ‡๏ฟฝ ) โˆˆ โ„›12ร—12 is the Coriolis and centrifugal force matrix.

๐’ˆ(๐œฝ) โˆˆ โ„›12ร—1 is the vector of gravitational forces.

๐‰ = [๐œ1, ๐œ2, โ€ฆ , ๐œ12] โˆˆ โ„›12ร—1 is the vector of joint torques.

๐œน๐‘ญ๐’†๐’™๐’• โˆˆ โ„›12ร—1 is the impulsive external forces vector acting on the robot.

extF

2m

3m 4m

5m

fm

O x

z

Fig. 3. Impact phase

By taking the integration of Eq. (2) over [๐‘ก, ๐‘ก + โˆ†๐‘ก] ,

gives:

limโˆ†๐‘กโ†’0

โˆซ ๐‘ซ(๐œฝ)

๐‘ก+โˆ†๐‘ก

๐‘ก

๏ฟฝฬˆ๏ฟฝ๐‘‘๐‘ก + limโˆ†๐‘กโ†’0

โˆซ [๐‘ช(๐œฝ, ๏ฟฝฬ‡๏ฟฝ)๏ฟฝฬ‡๏ฟฝ + ๐’ˆ(๐œฝ) โˆ’ ๐‰]๐‘‘๐‘ก

๐‘ก+โˆ†๐‘ก

๐‘ก

Page 3: Backstepping based Saturated Sliding Mode Joints ...

International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:20 No:06 99

202406-5959-IJMME-IJENS ยฉ December 2020 IJENS I J E N S

The integration of ๐’ˆ(๐œฝ) and ๐‰ over [๐‘ก, ๐‘ก + โˆ†๐‘ก] are zero,

we have:

limโˆ†๐‘กโ†’0

๐‘ซ(๐œฝ)(๏ฟฝฬ‡๏ฟฝ๐’•+โˆ†๐’• โˆ’ ๏ฟฝฬ‡๏ฟฝ๐’•) + limโˆ†๐‘กโ†’0

๐‘ช(๐œฝ, ๏ฟฝฬ‡๏ฟฝ)(๐œฝ๐’•+โˆ†๐’• โˆ’ ๐œฝ๐’•)

= lim

โˆ†๐‘กโ†’0โˆซ ๐œน๐‘ญ๐’†๐’™๐’•

๐‘ก+โˆ†๐‘ก

๐‘ก

๐‘‘๐‘ก

Since the contact duration is infinitesimal, the joint

positions remain unchanged, therefore:

limโˆ†๐‘กโ†’0

๐‘ช(๐œฝ, ๏ฟฝฬ‡๏ฟฝ)(๐œฝ๐’•+โˆ†๐’• โˆ’ ๐œฝ๐’•) = 0

Then the final result when integrating Eq. (2) is:

๐‘ซ(๐œฝ)โˆ†๏ฟฝฬ‡๏ฟฝ = ๐‘ญ๐’†๐’™๐’• The differential of the joint angles โˆ†๏ฟฝฬ‡๏ฟฝ can be calculated

using the following equation [9]:

โˆ†๏ฟฝฬ‡๏ฟฝ = ๐‘ซโˆ’๐Ÿ๐‘ฑ๐‘ป(๐‘ฑ๐‘ซโˆ’๐Ÿ๐‘ฑ๐‘ป)โˆ’๐Ÿโˆ†๏ฟฝฬ‡๏ฟฝ where

โˆ†๏ฟฝฬ‡๏ฟฝ is the velocity of the foot just before the

contact with the ground.

๐‘ฑ is the Jacobian matrix.

III. SLIDING MODE CONTROLLER DESIGN

To realize the biped walking process, pre-computed walking trajectories with constraints for the robot should be given first. Then by using inverse kinematic, a set of joint trajectories is deduced. Finally, a suitable controller is used to make the joints follow the pre-computed trajectories. The basic work flow to realize biped walking is shown in Fig. 4.

Inverse

Kinematic

Constraints

SMC SystemForward

Kinematic

referror u

+

-

realCOM

refCOM

Fig. 4. Simulation workflow

To implement the sliding mode controller, the dynamic model (2) should be expressed in the compact form:

๏ฟฝฬ‡๏ฟฝ = ๐’‡(๐’™, ๐‘ก) + ๐’ˆ(๐’™, ๐‘ก)๐’– + ๐’…(๐‘ก) where

๐’™ is the system state.

๐’‡(๐’™, ๐‘ก), ๐’ˆ(๐’™, ๐‘ก) are known non-linear functions.

๐’– โˆˆ โ„›12ร—1 is control inputs vector.

๐’…(๐‘ก) โˆˆ โ„›12ร—1 is external disturbances vector which is assumed to be bounded.

โ€–๐’…(๐‘ก)โ€–โˆž โ‰ค ๐ท๐‘

where ๐ท๐‘ is positive scalar constant

By defining ๐‘ฟ๐Ÿ(๐œฝ) = [๐œƒ1, โ€ฆ , ๐œƒ12]๐‘‡ , ๐‘ฟ๐Ÿ(๏ฟฝฬ‡๏ฟฝ) =

[๏ฟฝฬ‡๏ฟฝ1, โ€ฆ , ๏ฟฝฬ‡๏ฟฝ12]๐‘‡

, ๐’– = [๐œ1, โ€ฆ , ๐œ12]๐‘‡.

Eq. (2) can be rewritten by:

{

๏ฟฝฬ‡๏ฟฝ๐Ÿ = ๐‘ฟ๐Ÿ

๏ฟฝฬ‡๏ฟฝ๐Ÿ = ๐‘ซโˆ’๐Ÿ(โˆ’๐‘ช๐‘ฟ๐Ÿ โˆ’ ๐‘ฎ + ๐’– + ๐œน๐‘ญ๐’†๐’™๐’•)

By defining ๐’‡(๐‘ฟ) = โˆ’๐‘ซโˆ’๐Ÿ๐‘ช๐‘ฟ๐Ÿ โˆ’ ๐‘ซโˆ’๐Ÿ๐‘ฎ, ๐’ˆ(๐‘ฟ) = ๐‘ซโˆ’๐Ÿ ,

๐’…(๐‘ก) = ๐‘ซโˆ’๐Ÿ๐œน๐‘ญ๐’†๐’™๐’•, Eq. (10) can be summarized as follows:

{

๏ฟฝฬ‡๏ฟฝ๐Ÿ = ๐‘ฟ๐Ÿ

๏ฟฝฬ‡๏ฟฝ๐Ÿ = ๐’‡(๐‘ฟ) + ๐’ˆ(๐‘ฟ)๐’– + ๐’…(๐‘ก)

Defines a joint trajectories vector as ๐œฝ๐’… =[๐œƒ๐‘‘1, โ€ฆ , ๐œƒ๐‘‘12]๐‘‡ , the difference between the current joint angles and the desired angle is defined as the error:

๐’†๐Ÿ = ๐‘ฟ๐Ÿ โˆ’ ๐œฝ๐’…

Step 1: The first time derivative of ๐’†๐Ÿ can be obtained as follow:

๏ฟฝฬ‡๏ฟฝ๐Ÿ = ๏ฟฝฬ‡๏ฟฝ๐Ÿ โˆ’ ๏ฟฝฬ‡๏ฟฝ๐’…

The candidate Lyapunov function (CLF) for considering the system of Eq. (13) is chosen as:

๐‘‰1 =1

2๐’†๐Ÿ

๐‘ป๐’†๐Ÿ

Considering Eq. (14) and taking the first time derivative

of ๐‘‰1, it yields :

๏ฟฝฬ‡๏ฟฝ1 = ๐’†๐Ÿ๐‘ป๏ฟฝฬ‡๏ฟฝ๐Ÿ = ๐’†๐Ÿ

๐‘ป(๐‘ฟ๐Ÿ โˆ’ ๏ฟฝฬ‡๏ฟฝ๐’…)

Defines a vector ๐‘บ = [๐‘ 1, โ€ฆ , ๐‘ 12]๐‘‡ as the sliding surfaces which is given in the following form

๐‘บ = ๐‘ฟ๐Ÿ + ๐’„๐Ÿ๐’†๐Ÿ โˆ’ ๏ฟฝฬ‡๏ฟฝ๐’…

where ๐’„๐Ÿ โˆˆ โ„›12ร—12 is a constant symmetric

positive-definite matrix

Substituting Eq. (16) into Eq. (15), it can be

expressed as:

๏ฟฝฬ‡๏ฟฝ1 = ๐’†๐Ÿ๐‘ป๐‘บ โˆ’ ๐’†๐Ÿ

๐‘ป๐’„๐Ÿ๐’†๐Ÿ

It can be observed that ๐’†๐Ÿ and ๐‘‰1 are bounded

when the following condition holds true : ๐‘บ โ†’ ๐ŸŽ.

Step 2 : The augmented CLF for considering the

dynamic of sliding surface ๐‘บ is chosen as:

๐‘‰2 = ๐‘‰1 +1

2๐‘บ๐‘ป๐‘บ

Considering Eq. (18) and taking the first derivative of Eq. (16) gives:

๏ฟฝฬ‡๏ฟฝ = ๏ฟฝฬ‡๏ฟฝ๐Ÿ + ๐’„๐Ÿ๏ฟฝฬ‡๏ฟฝ๐Ÿ โˆ’ ๏ฟฝฬˆ๏ฟฝ๐’…

Substituting the 2nd system of Eq. (11) into Eq. (19), it yields:

๏ฟฝฬ‡๏ฟฝ = ๐’‡(๐‘ฟ) + ๐’ˆ(๐‘ฟ)๐’– + ๐’…(๐‘ก) + ๐’„๐Ÿ๏ฟฝฬ‡๏ฟฝ๐Ÿ โˆ’ ๏ฟฝฬˆ๏ฟฝ๐’…

Taking the first derivative of Eq. (18), it yields:

๏ฟฝฬ‡๏ฟฝ2 = ๏ฟฝฬ‡๏ฟฝ1 + ๐‘บ๐‘ป๏ฟฝฬ‡๏ฟฝ

= ๐’†๐Ÿ๐‘ป๐‘บ โˆ’ ๐’†๐Ÿ

๐‘ป๐’„๐Ÿ๐’†๐Ÿ + ๐‘บ๐‘ป[๐’‡(๐‘ฟ) + ๐’ˆ(๐‘ฟ)๐’–

+ ๐’…(๐‘ก) + ๐’„๐Ÿ๏ฟฝฬ‡๏ฟฝ๐Ÿ โˆ’ ๏ฟฝฬˆ๏ฟฝ๐’…]

Page 4: Backstepping based Saturated Sliding Mode Joints ...

International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:20 No:06 100

202406-5959-IJMME-IJENS ยฉ December 2020 IJENS I J E N S

In order to restrain the chattering phenomenon, the saturation function ๐‘ ๐‘Ž๐‘ก is adopted instead of the ๐‘ ๐‘”๐‘› . Therefore, the control input designed for system of Eq. (11) is as followed:

๐’– = ๐’ˆ(๐‘ฟ)โˆ’๐Ÿ[โˆ’๐’‡(๐‘ฟ) โˆ’ ๐’„๐Ÿ๐‘บ โˆ’ ๐’†๐Ÿ โˆ’ ๐’„๐Ÿ๏ฟฝฬ‡๏ฟฝ๐Ÿ + ๏ฟฝฬˆ๏ฟฝ๐’…

โˆ’ ๐œผ๐‘ ๐‘Ž๐‘ก(๐‘บ)]

where ๐’„๐Ÿ โˆˆ โ„›12ร—12 is a constant symmetric positive-definite matrix.

๐œผ โˆˆ โ„›12ร—12 is a constant diagonal matrix.

Each element in the main diagonal of ๐œผ should satisfy the following:

๐œ‚๐‘– > ๐ท๐‘

where ๐‘– = 1 รท 12.

๐‘ ๐‘Ž๐‘ก(โˆ™) is the saturation function defined as:

๐‘ ๐‘Ž๐‘ก(โˆ™) = {

1, ๐‘–๐‘“ โˆ™ > โˆ†

๐‘˜ ร— โˆ™ , ๐‘–๐‘“ | โˆ™ | โ‰ค โˆ†, ๐‘˜ = 1/โˆ†โˆ’1, ๐‘–๐‘“ โˆ™ < โˆ’โˆ†

where 0 < โˆ†< 1 is the boundary layer constant.

Substituting Eq. (22) into Eq. (21), gives:

๏ฟฝฬ‡๏ฟฝ2 = โˆ’๐’†๐Ÿ๐‘ป๐’„๐Ÿ๐’†๐Ÿ โˆ’ ๐‘บ๐‘ป๐’„๐Ÿ๐‘บ + ๐‘บ๐‘ป๐’…(๐‘ก)

โˆ’ ๐‘บ๐‘ป๐œผ๐‘ ๐‘Ž๐‘ก(๐‘บ)

Since ๐’„๐Ÿ, ๐’„๐Ÿ are constant symmetric positive-definite matrix, let us define:

๐ถ1 โ‰œ โ€–๐’„๐Ÿโ€–โˆž โ‰ฅ 0, ๐ถ2 โ‰œ โ€–๐’„๐Ÿโ€–โˆž โ‰ฅ 0, ๐ท๐‘ โ‰œ ๐‘‘๐‘š๐‘Ž๐‘ฅ

Taking the infinity norm of ๏ฟฝฬ‡๏ฟฝ2, it yields:

๏ฟฝฬ‡๏ฟฝ2 = โˆ’๐ถ1โ€–๐’†๐Ÿโ€–โˆž2 โˆ’ ๐ถ2โ€–๐‘บโ€–โˆž

2 + โ€–๐‘บโ€–โˆž๐‘‘๐‘š๐‘Ž๐‘ฅ

โˆ’ โ€–๐‘บโ€–โˆžโ€–๐œผโ€–โˆž๐‘ ๐‘Ž๐‘ก(โ€–๐‘บโ€–โˆž)

Recall Eq. (9), Eq. (23) and Eq. (24) we obtain:

๏ฟฝฬ‡๏ฟฝ2 โ‰ค 0

With Eq. (28), we can conclude that ๐‘’1 โ†’ 0 and ๐‘’2 โ†’ 0 as ๐‘ก โ†’ โˆž.

IV. SIMULATION RESULTS

To evaluate the effectiveness of the proposed controller,

a simulation was carried out. The proposed joint controller is

commanded to track the desired trajectories of the hips, knees

and ankles. The sampling period is 0.01 second and the pre-

computed trajectories take 10 seconds to complete. The

physical parameters are given by Table II.

Table II

Parameters of UXA-90

Link Mass (kg) Length (m)

๐‘™2 0.077 0.21

๐‘™3 0.211 0.21

๐‘™4 0.211 0.21

๐‘™5 0.077 0.21

๐‘™โ„Ž 0.5 0.09

๐‘™๐‘“ 0.469 0.065

First, the trajectory of the center of mass for UXA-90 on

the planar ๐‘‹๐‘Œ is obtained such that it satisfies the given

constraint: the ๐‘ง value of the center of mass should stay at

0.4๐‘š(400๐‘š๐‘š) since the assumed distance of the center of

mass of UXA-90 to the ground is approximately 0.4๐‘š. Then,

the joint trajectories (๐œƒ1, โ€ฆ , ๐œƒ12) were calculated using

inverse kinematic. The ๐‘ซ(๐œฝ) , ๐‘ช(๐œฝ, ๏ฟฝฬ‡๏ฟฝ) and ๐’ˆ(๐œฝ) are

calculated using the physical parameters obtained from

UXA-90. The inertia matrixes for the links of UXA-90 are

shown as:

๐ผ3 = [0.000267879958 โˆ’0.000039044428 0

โˆ’0.000039044428 0.000987981853 00 0 0.000852226607

]

๐ผ6 = [0.001058274664 0 0

0 0.000906206447 โˆ’0.000045279150 โˆ’0.00004527915 0.0001523499

]

๐ผ9 = [0.000267879958 โˆ’0.000039044428 0

โˆ’0.000039044428 0.000987981853 00 0 0.000852226607

]

๐ผ10 = [0.000013103094 0 0

0 0.00004938225 00 0 0.000045965477

]

๐ผ12 = [0.001058274664 0 0

0 0.000906206447 โˆ’0.000045279150 โˆ’0.00004527915 0.0001523499

]

The angle trajectories tracking are shown on the left, the

tracking errors are shown on the right in Fig. 5 below.

a. ๐œƒ1 trajectory and tracking error

b. ๐œƒ2 trajectory and tracking error

c. ๐œƒ3 trajectory and tracking error

d. ๐œƒ4 trajectory and tracking error

Page 5: Backstepping based Saturated Sliding Mode Joints ...

International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:20 No:06 101

202406-5959-IJMME-IJENS ยฉ December 2020 IJENS I J E N S

e. ๐œƒ5 trajectory and tracking error

f. ๐œƒ6 trajectory and tracking error

g. ๐œƒ7 trajectory and tracking error

h. ๐œƒ8 trajectory and tracking error

i. ๐œƒ9 trajectory and tracking error

j. ๐œƒ10 trajectory and tracking error

k. ๐œƒ11 trajectory and tracking error

l. ๐œƒ12 trajectory and tracking error

Fig. 5. Joint angle trajectories and errors

The simulation of joint trajectories as shown in Fig. 5

showed that the back-stepping SMC tracked the joint

trajectories closely. The errors range from โˆ’1.5ยฐ to 1.25ยฐ.

The COM trajectories were calculated: ๐‘ฅ trajectory is shown

in Fig. 6, ๐‘ฆ trajectory is shown in Fig. 7, ๐‘ง trajectory is shown

in Fig. 8.

Fig. 6. ๐‘ฅ trajectory of COM

Fig. 7. ๐‘ฆ trajectory of COM

Page 6: Backstepping based Saturated Sliding Mode Joints ...

International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:20 No:06 102

202406-5959-IJMME-IJENS ยฉ December 2020 IJENS I J E N S

Fig. 8. ๐‘ง trajectory of COM

The COM trajectories showed that the real COM has

successfully tracked the pre-computed trajectories. The ๐‘ง

motion oscillate around 0.4๐‘š , the error ranges from

โˆ’0.002๐‘š (โˆ’2๐‘š๐‘š) to 0.0016๐‘š (1.6mm). As a result, this

satisfied the constraint proposed before: the ๐‘ง value of the

center of mass maintains at 0.4๐‘š.

a. Comparison between SMC and back-stepping SMC for ๐œ1 and ๐œ2

b. Comparison between SMC and back-stepping SMC for ๐œ3 and ๐œ4

c. Comparison between SMC and back-stepping SMC for ๐œ5 and ๐œ6

d. Comparison between SMC and back-stepping SMC for ๐œ7 and ๐œ8

e. Comparison between SMC and back-stepping SMC for ๐œ9 and ๐œ10

f. Comparison between SMC and back-stepping SMC for ๐œ11 and ๐œ12

Fig. 9. Control input comparison between SMC and back-stepping SMC

As shown in Fig. 9, the control inputs for 12 joints of the

proposed controller expressed in red solid line do not feature

the chattering phenomenon in comparison to that of

traditional SMC employed the sign function. At the time of

2 seconds, 4 seconds, 6 seconds and 8 seconds, the control inputs have peaks and valleys due to the abrupt change of the

sign of acceleration in a very short time interval (0.01s).

Overall, the proposed controller has successfully reduced the

chattering effect, thus showing its advantage over the

traditional SMC.

V. CONCLUSION This paper proposed a novel back-stepping sliding mode

controller to control the dynamic equation of humanoid robot

UXA-90. The back-stepping method decompose the dynamic

system into reduced order subsystems which can be easily

controlled. The SMC guarantees the robustness while the use

of saturation function reduces the chattering effect. Also, the

COM tracked closely the desired trajectories, satisfying the

constraint: the ๐‘ง value of the center of mass should maintain

around 0.4๐‘š throughout the walking phase. The simulation results revealed that the back-stepping SMC outperforms the

traditional SMC controller when used to control the

humanoid robot UXA-90.

ACKNOWLEDGMENT This research is funded by Vietnam National University

HoChiMinh City (VNU-HCM) under grant number B2019-

20-09 and TX2020-20B-01.

REFERENCES

[1] D. J. Villarreal, D. Quintero and R. D. Gregg, "A Perturbation

Mechanism for Investigations of Phase-Dependent Behavior in

Human Locomotion," IEEE Access, vol. vol. 4, pp. 893-904, 2016.

[2] C. Yang, K. Yuan, S. Heng, T. Komura and Z. Li, "Learning Natural

Locomotion Behaviors for Humanoid Robots Using Human Bias,"

IEEE Robotics and Automation Letters, vol. 5, no. 2, pp. 2610-2617,

2020.

[3] A. A. Saputra, J. Botzheim, I. A. Sulistijono and N. Kubota,

"Biologically Inspired Control System for 3-D Locomotion of a

Humanoid Biped Robot," IEEE Transactions on Systems, Man, and

Cybernetics: Systems, vol. 46, no. 7, pp. 898-911, 2016.

Page 7: Backstepping based Saturated Sliding Mode Joints ...

International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:20 No:06 103

202406-5959-IJMME-IJENS ยฉ December 2020 IJENS I J E N S

[4] E. R.Westervelt, J. W.Grizzle, C. Chevallereau, J. H. Choi and B.

Morris, Feedback Control of Dynamic Bipedal Robot Locomotion,

CRC Press, 2007.

[5] S. Kajita and e. al, Introduction to Humanoid Robotics, Springer,

2013.

[6] I.-W. Park, J.-Y. Kim and J.-H. Oh, "Online Walking Pattern

Generation and Its Application to a Biped Humanoid Robot - KHR-3

(HUBO)," Advanced Robotics, 2008.

[7] J. Han, Bipedal Walking for a Full-sized Humanoid Robot Utilizing

Sinusoidal Feet Trajectories and Its Energy Consumption, 2012.

[8] J. H.Park and K. D.Kim, "Biped Robot Walking Using Gravity-

Compensated Inverted Pendulum Mode and Computed Torque

Control," in International Conference on Robotics & Automation,

Leuven, 1998.

[9] T. Spyros, R. Mark and T. Costas, "Robust Sliding-mode Control

Applied to a 5-Link Biped Robot," Journal of Intelligent and Robotic

Systems, pp. 67-133, 1996.

[10] A. Noshadi, J. Shi, W. S. Lee, P. Shi and A. Kalam, "System

Identification and Robust Control of Multi-Input Multi-Output Active

Magnetic Bearing Systems," IEEE Transactions on Control Systems

Technology, vol. 24, no. 4, pp. 1227-1239, 2016.

[11] W. Sun, H. Gao and B. Yao, "Adaptive Robust Vibration Control of

Full-Car Active Suspensions With Electrohydraulic Actuators," IEEE

Transactions on Control Systems Technology, vol. 21, no. 6, pp. 2417-

2422, 2013.

[12] Y. Yu, Z. Yang, C. Han and H. Liu, "Fuzzy Adaptive Back-Stepping

Sliding Mode Controller for High-Precision Deflection Control of the

Magnetically Suspended Momentum Wheel," IEEE Transactions on

Industrial Electronics, vol. 65, no. 4, pp. 3530-3538, 2018.

[13] M. Mat-Noh, M. R. Arshad, R. Mohd-Mokhtar and Q. Khan, "Back-

stepping Sliding Mode Control Strategy for Autonomous Underwater

Glider," in International Conference on Emerging Technologies

(ICET), Islamabad, 2017.

[14] Z. Zhu and S. Cao, "Back-stepping sliding mode control method for

quadrotor UAV with actuator failure," The Journal of Engineering,

vol. 22, pp. 8374-8377, 2019.

[15] M. Raibert, S. Tzafestas and C. Tzafestas, "Comparative Simulation

Study of Three Control Techniques Applied to a Biped Robot," in

Systems Man And Cybernetic - SMC, Le Touquet, 1993.

[16] S. A.Moosavian, M. Alghooneh and A. Takhmar, "Stable trajectory

planning, dynamics modeling and fuzzy regulated sliding mode

control of a biped robot," in 7th IEEE-RAS International Conference

on Humanoid Robots, Pittsburgh, 2007.

[17] I.-G. Park and J.-G. Kim, "Robust control for dynamic walking of a

biped robot with ground contacting condition," in 2001 IEEE

International Symposium on Industrial Electronics Proceedings,

Pusan, 2001.

[18] N. Hamilton, W. Weimar and K. Luttgens, Kinesiology: Scientific

Basis of Human Motion, 2012.

[19] X. T. Nguyen, T. D. Tran, H. H. Nguyen, N. P. Tong, T. P. Nguyen

and T. T. Nguyen, "Controlling Center of Mass in Humanoid Robot

using Sliding Mode Control," in International Conference on

Advanced Mechatronic Systems, Hochiminh, 2020.

[20] M. W.Spong, S. Hutchinson and M.Vidyasagar, Robot Modeling and

Control, 1989.