# Modified Linear Active Disturbance Rejection Control for Uncertain Robot Manipulator Trajectory Tracking

Authors: Hongjun Hu; Shungen Xiao; Haikuo Shen
Journal: Mathematical Problems in Engineering
 (2021)

---

## Abstract

To solve the problems of model uncertainties, dynamic coupling, and external disturbances, a modified linear active disturbance rejection controller (MLADRC) is proposed for the trajectory tracking control of robot manipulators. In the computer simulation, MLADRC is compared to the proportional-derivative (PD) controller and the regular linear active disturbance rejection controller (LADRC) for performance tests. Multiple uncertain factors such as friction, parameter perturbation, and external disturbance are sequentially added to the system to simulate an actual robot manipulator system. Besides, a two-degree-of-freedom (2-DOF) manipulator is constructed to verify the control performance of the MLADRC. Compared with the regular LADRC, MLADRC is significantly characterized by the addition of feedforward control of reference angular acceleration, which helps robot manipulators keep up with target trajectories more accurately. The simulation and experimental results demonstrate the superiority of the MLADRC over the regular LADRC for the trajectory tracking control.


---

## Body

## 1. Introduction

Robot manipulators are well-known mechanical systems with controllable trajectories, which are widely used in modern industry and other fields. Trajectory tracking control of robot manipulators requires that the end-effector can move precisely along the given trajectories. However, the nonlinearity, strong coupling, and uncertainty of the system make the trajectory tracking very complicated and difficult, so it has always been a hot spot for researchers.Trajectory tracking control methods of robot manipulators can be divided into “motion control” and “dynamic control.” The motion control only carries out negative feedback control through the deviation between target trajectories and actual trajectories. Therefore, such methods cannot guarantee control performance. The dynamic control is designed according to the dynamic characteristics of robot manipulators, so it can make the control quality of the system better [1, 2]. At present, the commonly used dynamic control methods mainly include intelligent PID control [3–5], iterative learning control [6–9], adaptive neural network control [10–13], sliding mode control [14–16], and active disturbance rejection control [17, 18]. Aiming at n-degree-of-freedom rigid robots, Hernández-Guzmán and Orrante-Sakanassi [4] proposed a control scheme for direct-drive brushless direct-current (BLDC) motors, which solved the position control problem of n direct-drive BLDC with complex, nonlinear, and highly coupled mechanical loads. Bouakrif and Zasadzinski [7] designed a high-order iterative learning controller for the trajectory tracking of robot manipulators subject to external disturbances and performing repetitive tasks. A dual-link manipulator was taken as the research object to prove that the closed-loop system was asymptotically stable in the finite time interval when the number of iterations tended to infinity. Liu et al. [11] proposed the adaptive neural network control with the optimal number of hidden layer nodes. The method could approach the uncertainty of the robot manipulator to ensure high-precision trajectory tracking. Baek and Kwon [14] proposed a strong and stable adaptive sliding-mode control method by designing two adaptive laws related to switching gain. It enhanced the robustness of the robot manipulator system and achieved accurate tracking performance. Chen et al. [17] proposed a robust active disturbance rejection controller (ADRC) based on sliding mode control technology. The uncertainties in control gains and disturbance estimation errors were considered in the design process of the controller, which improved tracking accuracy and minimized link vibrations.The most important feature of ADRC is the ability to estimate and compensate for system uncertainties. Hence, it is very suitable for the application in multiple-input and multiple-output (MIMO) systems such as robot manipulators [19]. However, ADRC has many control parameters, and the physical meaning of some parameters is not very clear. So, the parameter tuning is difficult. To simplify the tuning process, Gao [20] proposed a linear ADRC, i.e., LADRC, and replaced nonlinear ESO with a linear ESO (LESO). In this paper, we make some improvements to LADRC to make it have higher control precision and better dynamic performance compared with the regular LADRC.


## 2. Modeling of a 2-DOF Manipulator System

### 2.1. A Dynamic Model of the 2-DOF Manipulator

A simplified model of the 2-DOF manipulator is depicted in Figure1, which has two rotary joints. Ignoring gravity, friction, and external disturbances, the robot manipulator can be modeled as(1)Dqq¨+Cq,q˙q˙=τ,where q=q1q2T is the joint angle vector, τ=τ1τ2T is the joint control torque vector, Dq is the inertia matrix, and Cq,q˙ is the Coriolis matrix. The expressions of Dq and Cq,q˙ are as follows:(2)Dq=p1+p2+2p3cosq2p2+p3cosq2p2+p3cosq2p2,Cq,q˙=−p3q˙2sinq2−p3q˙1+q˙2sinq2p3q˙1sinq20,where(3)p1=m1+m2l12,p2=m2l22,p3=m2l1l2,where l1 and l2 represent the lengths of the two rods and m1 and m2 represent the masses of the two rods. The values of l1,l2,m1, and m2 are(4)l1=0.2m,l2=0.17m,m1=0.48kg,m2=0.16kg.Figure 1
A simplified model of the 2-DOF manipulator.


### 2.2. A Mathematical Model of the BLDC Reduction Motor

The robot manipulator is driven by the BLDC reduction motor on each joint. According to the working principle of BLDC reduction motors, the mathematical model of the motor can be described as(5)i˙=−keLαq˙m−RLi+1Lu,τm=αkti,where u, i, R, and L represent the voltage, current, resistance, and inductance of the motor, respectively. qm and τm are the rotation angle and output torque of the motor. kt and ke are the torque coefficient and the back electromotive force (EMF) coefficient. α represents the reduction ratio. The parameter values of the BLDC reduction motor are listed in Table 1.Table 1
Technical parameters of the BLDC reduction motor.
RΩLmHkev⋅s/radktNm/Aαmkg0.70.40.0320.032900.15


## 2.1. A Dynamic Model of the 2-DOF Manipulator

A simplified model of the 2-DOF manipulator is depicted in Figure1, which has two rotary joints. Ignoring gravity, friction, and external disturbances, the robot manipulator can be modeled as(1)Dqq¨+Cq,q˙q˙=τ,where q=q1q2T is the joint angle vector, τ=τ1τ2T is the joint control torque vector, Dq is the inertia matrix, and Cq,q˙ is the Coriolis matrix. The expressions of Dq and Cq,q˙ are as follows:(2)Dq=p1+p2+2p3cosq2p2+p3cosq2p2+p3cosq2p2,Cq,q˙=−p3q˙2sinq2−p3q˙1+q˙2sinq2p3q˙1sinq20,where(3)p1=m1+m2l12,p2=m2l22,p3=m2l1l2,where l1 and l2 represent the lengths of the two rods and m1 and m2 represent the masses of the two rods. The values of l1,l2,m1, and m2 are(4)l1=0.2m,l2=0.17m,m1=0.48kg,m2=0.16kg.Figure 1
A simplified model of the 2-DOF manipulator.


## 2.2. A Mathematical Model of the BLDC Reduction Motor

The robot manipulator is driven by the BLDC reduction motor on each joint. According to the working principle of BLDC reduction motors, the mathematical model of the motor can be described as(5)i˙=−keLαq˙m−RLi+1Lu,τm=αkti,where u, i, R, and L represent the voltage, current, resistance, and inductance of the motor, respectively. qm and τm are the rotation angle and output torque of the motor. kt and ke are the torque coefficient and the back electromotive force (EMF) coefficient. α represents the reduction ratio. The parameter values of the BLDC reduction motor are listed in Table 1.Table 1
Technical parameters of the BLDC reduction motor.
RΩLmHkev⋅s/radktNm/Aαmkg0.70.40.0320.032900.15


## 3. Design of the Trajectory Tracking Control System

### 3.1. Modified LADRC Design

Since the inertial matrixDq is symmetric and positive definite, equation (1) can be converted into(6)q¨=−Dq−1Cq,q˙q˙+Dq−1τ.Considering the influence of friction, parameter perturbation, and external disturbances, we add these uncertainties to equation (6) and take them together with the coupling term as total disturbances applied to the joint. The total disturbances can be expressed as(7)−Dq−1Cq,q˙q˙+Fq˙+τd=f1q1,q2,q˙1,q˙2,τd1t,tf2q1,q2,q˙1,q˙2,τd2t,t,where τd=τd1τd2T is the disturbance torque vector, Fq˙=F1q˙1F2q˙2T is the friction torque vector, f1⋅ is treated as the total disturbances of joint 1, and f2⋅ is the total disturbances of joint 2. Furthermore, assuming(8)Dq−1=b=b11b12b21b22.Equation (6) can be rewritten as(9)q¨1=f1q1,q2,q˙1,q˙2,τd1t,t+b11τ1++b12τ2,q¨2=f2q1,q2,q˙1,q˙2,τd2t,t+b21τ1++b22τ2.According to the application of LADRC in MIMO systems [21–23], a “virtual control torque” vector T is introduced to the control system. Let(10)T=T1T2=bτ1τ2,and equation (9) can be represented by(11)q¨1=f1q1,q2,q˙1,q˙2,τd1t,t+T1,q¨2=f2q1,q2,q˙1,q˙2,τd2t,t+T2.We can observe from equation (11) that the two joints of the 2-DOF manipulator are decoupled; each joint becomes an independent second-order system with the total disturbances. So MLADRC can be designed to control them separately.For the sake of simplicity, only the MLADRC algorithm for controlling joint 1 is presented. MLADRC is mainly composed of a third-order LESO, disturbance compensation, a PD controller, and reference angular acceleration feedforward. The controller design of joint 2 is the same as that of joint 1.(1)
LESO: the third-order LESO is used to dynamically estimate the total disturbancesf1⋅, which is characterized as(12)z˙1r=z2r−β1rz1r−q1,z˙2r=z3r−β2rz1r−q1+T1,z˙3r=−β3rz1r−q1,wherez1r and z2r are the estimates of q1 and q˙1, respectively, and z3r is the estimate of f1⋅, i.e., the extended state. β1r, β2r, and β3r are the control gains.(2)
Disturbance compensation:z3r is dynamically compensated by(13)T1=T01−z3r,whereT01 is an intermediate control quantity. Ignoring the estimation error of z3r to f1⋅, joint 1 is reduced to a unit-gain double integrator:(14)q¨1=f1q1,q2,q˙1,q˙2,τd1t,t−z3r+T01=T01.(3)
State error feedback control: the PD controller is designed to control the double integrator, and its control algorithm is as follows:(15)T01=kprqd1−z1r−kdrz2r,whereqd1 is the reference input trajectory of joint 1 and kpr and kdr are the PD controller parameters.(4)
Reference angular acceleration feedforward: in the case that the reference trajectoryqd1 is known, the reference angular acceleration, i.e., the second derivative of qd1, can be solved first. The calculation result is then assigned to T01; that is,(16)q¨1=T01=q¨d1⇒q1=qd1.It can be seen from equation (16) that the joint trajectory can track the reference input trajectory very well. Therefore, we call the LADRC that incorporates the reference angular acceleration feedforward control as “modified linear active disturbance rejection control,” i.e., MLADRC.


### 3.2. BLDC Motor Control

Since the output torque of the BLDC reduction motor is proportional to the current andi is relatively easy to be collected in experiments, a first-order LADRC is designed to control the current [24]. Considering the design process of LADRC, equation (5) is simplified as(17)i˙=fmi,q˙m+bmu,τm=αkti,where(18)fmi,q˙m=−keLαq˙m−RLi,bm=1/L,where fmi,q˙m is regarded as the total disturbances of the motor and bm is the control input gain.The first-order LADRC is designed as(19)z˙1m=z2m−β1mz1m−i+b0u,z˙2m=−β2mz1m−i,u0=kpmid−z1m,u=u0−z2mb0,where z1m is the estimate of i and z2m is the estimate of fmi,q˙m, i.e., the extended state; β1m and β2m are the second-order LESO control gains; kpm is the P controller parameter; b0 is the compensation coefficient, and its value is selected as(20)b0=bm=1L.Based on the above design and analysis of the controller, we adopt a double closed-loop control structure for the trajectory tracking system of the 2-DOF manipulator, as shown in Figure2. The position loop controls the joint angle and the current loop controls motor torque. In the current loop, the proportional (P1) controller acts as the state error feedback control law of the first-order LADRC. The controller structure of joint 2 is consistent with that of joint 1.Figure 2
Trajectory tracking control structure based on the MLADRC of joint 1.


### 3.3. Stability Analysis of the Control System

LESO is a key component of MLADRC. Whether the total disturbances and other system states can be accurately observed by LESO will directly affect the dynamic performance and quality of the entire control system. Therefore, we should first analyze the estimation ability of LESO in the control system, and then the stability of the manipulator trajectory tracking system is analyzed and verified.


#### 3.3.1. LESO Observation Performance Analysis

Considering the joint 1 system of(21)q¨1=f1q1,q2,q˙1,q˙2,τd1t,t+T1,assuming f˙1⋅=h⋅, the state equation of plant (21) can be expressed as(22)x˙1=x2,x˙2=x3+T1,x˙3=hX,τd1,q1=x1,where x1,x2, and x3 are system state variables and X=x1x2x3T. Let A=010001000, B1=010, and B2=001; we have(23)X˙=AX+B1T1+B2hX,τd1.Meanwhile, equation (12) can also be expressed in matrix form as(24)Z˙r=AZr+B1T1+βrX−Zr,where Zr=z1rz2rz3r, βr=β1r00β2r00β3r00, and then subtracting equation (24) from equation (23), we obtain(25)X˙−Z˙r=A−βrX−Zr+B2hX,τd1.Lete˜=X−Zr and A2=A−βr, and it follows that(26)e˜˙=A2e˜+B2hX,τd1.Assuming(27)β1r=a1γ,β2r=a2γ2,β3r=a3γ3,where γ∈R+, a1,a2, and a3 are LESO coefficients, and a1,a2,a3∈R+, the stability condition of LESO can be expressed as(28)a1>0,a3>0,a1a2−a3>0.Thus, as long as we can select the appropriate gains, the LESO estimation error will be bounded; that is, there exists constantM>0, such that e˜≤M.


#### 3.3.2. Closed-Loop System Stability Analysis

Assuming that the reference input trajectory is bounded and according to the state estimates of LESO, the system error feedback control law of joint 1 can be described as(29)T1=kprqd1−z1r+kdrq˙d1−z2r+q¨d1−z3r.Equation (21) is then rewritten as(30)q¨1=f1q1,q2,q˙1,q˙2,τd1t,t+kprqd1−z1r+kdrq˙d1−z2r+q¨d1−z3r.Letr1=qd1, r2=q˙d1, r3=q¨d1, and εi=ri−xi,i=1,2; we have(31)ε˙1=r˙1−x˙1=r2−x2=ε2,ε˙2=r˙2−x˙2=r3−q¨1=−kprε1−kdrε2−kpre˜1−kdre˜2−e˜3,where e˜i is the estimation error of LESO and e˜i=xi−zir,i=1,2,3. Let ε=ε1ε2, A3=01−kpr−kdr, and A4=000−kpr−kdr−1; the matrix form of equation (31) can then be expressed as(32)ε˙=A3ε+A4e˜.Since the estimation error of LESO has been proved to be bounded, there existskpr>0,kdr>0 to make the tracking error of system (32) bounded [25, 26]. Thus, for bounded input, the plant (21) output is bounded; that is, the system is bounded-input bounded-output (BIBO) stable.Figure 3
Trajectory tracking control structure based on PD of joint 1.


## 3.1. Modified LADRC Design

Since the inertial matrixDq is symmetric and positive definite, equation (1) can be converted into(6)q¨=−Dq−1Cq,q˙q˙+Dq−1τ.Considering the influence of friction, parameter perturbation, and external disturbances, we add these uncertainties to equation (6) and take them together with the coupling term as total disturbances applied to the joint. The total disturbances can be expressed as(7)−Dq−1Cq,q˙q˙+Fq˙+τd=f1q1,q2,q˙1,q˙2,τd1t,tf2q1,q2,q˙1,q˙2,τd2t,t,where τd=τd1τd2T is the disturbance torque vector, Fq˙=F1q˙1F2q˙2T is the friction torque vector, f1⋅ is treated as the total disturbances of joint 1, and f2⋅ is the total disturbances of joint 2. Furthermore, assuming(8)Dq−1=b=b11b12b21b22.Equation (6) can be rewritten as(9)q¨1=f1q1,q2,q˙1,q˙2,τd1t,t+b11τ1++b12τ2,q¨2=f2q1,q2,q˙1,q˙2,τd2t,t+b21τ1++b22τ2.According to the application of LADRC in MIMO systems [21–23], a “virtual control torque” vector T is introduced to the control system. Let(10)T=T1T2=bτ1τ2,and equation (9) can be represented by(11)q¨1=f1q1,q2,q˙1,q˙2,τd1t,t+T1,q¨2=f2q1,q2,q˙1,q˙2,τd2t,t+T2.We can observe from equation (11) that the two joints of the 2-DOF manipulator are decoupled; each joint becomes an independent second-order system with the total disturbances. So MLADRC can be designed to control them separately.For the sake of simplicity, only the MLADRC algorithm for controlling joint 1 is presented. MLADRC is mainly composed of a third-order LESO, disturbance compensation, a PD controller, and reference angular acceleration feedforward. The controller design of joint 2 is the same as that of joint 1.(1)
LESO: the third-order LESO is used to dynamically estimate the total disturbancesf1⋅, which is characterized as(12)z˙1r=z2r−β1rz1r−q1,z˙2r=z3r−β2rz1r−q1+T1,z˙3r=−β3rz1r−q1,wherez1r and z2r are the estimates of q1 and q˙1, respectively, and z3r is the estimate of f1⋅, i.e., the extended state. β1r, β2r, and β3r are the control gains.(2)
Disturbance compensation:z3r is dynamically compensated by(13)T1=T01−z3r,whereT01 is an intermediate control quantity. Ignoring the estimation error of z3r to f1⋅, joint 1 is reduced to a unit-gain double integrator:(14)q¨1=f1q1,q2,q˙1,q˙2,τd1t,t−z3r+T01=T01.(3)
State error feedback control: the PD controller is designed to control the double integrator, and its control algorithm is as follows:(15)T01=kprqd1−z1r−kdrz2r,whereqd1 is the reference input trajectory of joint 1 and kpr and kdr are the PD controller parameters.(4)
Reference angular acceleration feedforward: in the case that the reference trajectoryqd1 is known, the reference angular acceleration, i.e., the second derivative of qd1, can be solved first. The calculation result is then assigned to T01; that is,(16)q¨1=T01=q¨d1⇒q1=qd1.It can be seen from equation (16) that the joint trajectory can track the reference input trajectory very well. Therefore, we call the LADRC that incorporates the reference angular acceleration feedforward control as “modified linear active disturbance rejection control,” i.e., MLADRC.


## 3.2. BLDC Motor Control

Since the output torque of the BLDC reduction motor is proportional to the current andi is relatively easy to be collected in experiments, a first-order LADRC is designed to control the current [24]. Considering the design process of LADRC, equation (5) is simplified as(17)i˙=fmi,q˙m+bmu,τm=αkti,where(18)fmi,q˙m=−keLαq˙m−RLi,bm=1/L,where fmi,q˙m is regarded as the total disturbances of the motor and bm is the control input gain.The first-order LADRC is designed as(19)z˙1m=z2m−β1mz1m−i+b0u,z˙2m=−β2mz1m−i,u0=kpmid−z1m,u=u0−z2mb0,where z1m is the estimate of i and z2m is the estimate of fmi,q˙m, i.e., the extended state; β1m and β2m are the second-order LESO control gains; kpm is the P controller parameter; b0 is the compensation coefficient, and its value is selected as(20)b0=bm=1L.Based on the above design and analysis of the controller, we adopt a double closed-loop control structure for the trajectory tracking system of the 2-DOF manipulator, as shown in Figure2. The position loop controls the joint angle and the current loop controls motor torque. In the current loop, the proportional (P1) controller acts as the state error feedback control law of the first-order LADRC. The controller structure of joint 2 is consistent with that of joint 1.Figure 2
Trajectory tracking control structure based on the MLADRC of joint 1.


## 3.3. Stability Analysis of the Control System

LESO is a key component of MLADRC. Whether the total disturbances and other system states can be accurately observed by LESO will directly affect the dynamic performance and quality of the entire control system. Therefore, we should first analyze the estimation ability of LESO in the control system, and then the stability of the manipulator trajectory tracking system is analyzed and verified.


### 3.3.1. LESO Observation Performance Analysis

Considering the joint 1 system of(21)q¨1=f1q1,q2,q˙1,q˙2,τd1t,t+T1,assuming f˙1⋅=h⋅, the state equation of plant (21) can be expressed as(22)x˙1=x2,x˙2=x3+T1,x˙3=hX,τd1,q1=x1,where x1,x2, and x3 are system state variables and X=x1x2x3T. Let A=010001000, B1=010, and B2=001; we have(23)X˙=AX+B1T1+B2hX,τd1.Meanwhile, equation (12) can also be expressed in matrix form as(24)Z˙r=AZr+B1T1+βrX−Zr,where Zr=z1rz2rz3r, βr=β1r00β2r00β3r00, and then subtracting equation (24) from equation (23), we obtain(25)X˙−Z˙r=A−βrX−Zr+B2hX,τd1.Lete˜=X−Zr and A2=A−βr, and it follows that(26)e˜˙=A2e˜+B2hX,τd1.Assuming(27)β1r=a1γ,β2r=a2γ2,β3r=a3γ3,where γ∈R+, a1,a2, and a3 are LESO coefficients, and a1,a2,a3∈R+, the stability condition of LESO can be expressed as(28)a1>0,a3>0,a1a2−a3>0.Thus, as long as we can select the appropriate gains, the LESO estimation error will be bounded; that is, there exists constantM>0, such that e˜≤M.


### 3.3.2. Closed-Loop System Stability Analysis

Assuming that the reference input trajectory is bounded and according to the state estimates of LESO, the system error feedback control law of joint 1 can be described as(29)T1=kprqd1−z1r+kdrq˙d1−z2r+q¨d1−z3r.Equation (21) is then rewritten as(30)q¨1=f1q1,q2,q˙1,q˙2,τd1t,t+kprqd1−z1r+kdrq˙d1−z2r+q¨d1−z3r.Letr1=qd1, r2=q˙d1, r3=q¨d1, and εi=ri−xi,i=1,2; we have(31)ε˙1=r˙1−x˙1=r2−x2=ε2,ε˙2=r˙2−x˙2=r3−q¨1=−kprε1−kdrε2−kpre˜1−kdre˜2−e˜3,where e˜i is the estimation error of LESO and e˜i=xi−zir,i=1,2,3. Let ε=ε1ε2, A3=01−kpr−kdr, and A4=000−kpr−kdr−1; the matrix form of equation (31) can then be expressed as(32)ε˙=A3ε+A4e˜.Since the estimation error of LESO has been proved to be bounded, there existskpr>0,kdr>0 to make the tracking error of system (32) bounded [25, 26]. Thus, for bounded input, the plant (21) output is bounded; that is, the system is bounded-input bounded-output (BIBO) stable.Figure 3
Trajectory tracking control structure based on PD of joint 1.


## 3.3.1. LESO Observation Performance Analysis

Considering the joint 1 system of(21)q¨1=f1q1,q2,q˙1,q˙2,τd1t,t+T1,assuming f˙1⋅=h⋅, the state equation of plant (21) can be expressed as(22)x˙1=x2,x˙2=x3+T1,x˙3=hX,τd1,q1=x1,where x1,x2, and x3 are system state variables and X=x1x2x3T. Let A=010001000, B1=010, and B2=001; we have(23)X˙=AX+B1T1+B2hX,τd1.Meanwhile, equation (12) can also be expressed in matrix form as(24)Z˙r=AZr+B1T1+βrX−Zr,where Zr=z1rz2rz3r, βr=β1r00β2r00β3r00, and then subtracting equation (24) from equation (23), we obtain(25)X˙−Z˙r=A−βrX−Zr+B2hX,τd1.Lete˜=X−Zr and A2=A−βr, and it follows that(26)e˜˙=A2e˜+B2hX,τd1.Assuming(27)β1r=a1γ,β2r=a2γ2,β3r=a3γ3,where γ∈R+, a1,a2, and a3 are LESO coefficients, and a1,a2,a3∈R+, the stability condition of LESO can be expressed as(28)a1>0,a3>0,a1a2−a3>0.Thus, as long as we can select the appropriate gains, the LESO estimation error will be bounded; that is, there exists constantM>0, such that e˜≤M.


## 3.3.2. Closed-Loop System Stability Analysis

Assuming that the reference input trajectory is bounded and according to the state estimates of LESO, the system error feedback control law of joint 1 can be described as(29)T1=kprqd1−z1r+kdrq˙d1−z2r+q¨d1−z3r.Equation (21) is then rewritten as(30)q¨1=f1q1,q2,q˙1,q˙2,τd1t,t+kprqd1−z1r+kdrq˙d1−z2r+q¨d1−z3r.Letr1=qd1, r2=q˙d1, r3=q¨d1, and εi=ri−xi,i=1,2; we have(31)ε˙1=r˙1−x˙1=r2−x2=ε2,ε˙2=r˙2−x˙2=r3−q¨1=−kprε1−kdrε2−kpre˜1−kdre˜2−e˜3,where e˜i is the estimation error of LESO and e˜i=xi−zir,i=1,2,3. Let ε=ε1ε2, A3=01−kpr−kdr, and A4=000−kpr−kdr−1; the matrix form of equation (31) can then be expressed as(32)ε˙=A3ε+A4e˜.Since the estimation error of LESO has been proved to be bounded, there existskpr>0,kdr>0 to make the tracking error of system (32) bounded [25, 26]. Thus, for bounded input, the plant (21) output is bounded; that is, the system is bounded-input bounded-output (BIBO) stable.Figure 3
Trajectory tracking control structure based on PD of joint 1.


## 4. Simulation Research

In Matlab/Simulink, PD, LADRC, and MLADRC are applied for controlling plant (11). By comparing the simulation results of the three, the rationality of MLADRC design is verified. The dynamic control performance of MLADRC is analyzed according to the simulation results under different disturbances.Table 2
Parameter values of the control system based on PD.
ParameterValue (joint 1)Value (joint 2)kp15060kd155kp′300300ki5050Table 3
Parameter values of the control system based on MLADRC.
ParameterValue (joint 1)Value (joint 2)ω0r240300ωcr10080ω0m200200kpm800800b02.52.5


### 4.1. Controller Parameters’ Tuning

(1)
PD controller: because PD is simple and easy to be realized in practical engineering, it is often used in robot manipulator control. The trajectory tracking system based on PD of joint 1 is plotted in Figure3. The current loop adopts a proportional-integral (PI) controller.The controller parameters of the PD and PI are tuned based on the Ziegler–Nichols method, and the final tuning results are listed in Table2. kp and kd are the proportional coefficient and differential coefficient of PD, and kp′ and ki are the proportional coefficient and integral coefficient of PI.(2)
MLADRC: MLADRC, i.e., “modified LADRC.” The structure of the trajectory tracking control system composed of MLADRC is plotted in Figure2. According to the method of parameter bandwidthization proposed in [20], the MLADRC parameters are configured as(33)β1r,β2r,β3r=3ω0r,3ω0r2,ω0r3,kpr,kdr=ωcr2,2ωcr,β1m,β2m=2ω0m,ω0m2,whereω0r is denoted as the third-order LESO bandwidth, ωcr represents the bandwidth of the PD controller in MLADRC, and ω0m is the second-order LESO bandwidth. As a result, the parameters that need to be tuned are greatly reduced and the physical meaning of each parameter is very clear.In MLADRC,b0, ω0r, ωcr, and ω0m determine the various performances of the system, such as stability, transient performance, anti-interference, and noise suppression. Each performance needs to be weighed when adjusting the controller parameters. For the controlled plant (11) and plant (17), b0 is known, and ω0r, ωcr, and ω0m need to be tuned. The specific configuration process is as follows [27]:Step 1: first, determine the initial value ofωcr according to the adjustment time of the system, and then let ω0r=2∼10ωcr.Step 2: keepω0r constant, and adjust ωcr in a small range until the system is stable. If adjustment of ωcr fails to stabilize the system, decrease or increase both ωcr and ω0r in the same proportion, and then adjust ωcr individually to make the system stable.Step 3: keepωcr constant, and gradually decrease ω0r. On the premise of ensuring the stability of the system, weigh the transient performance and noise suppression ability, and select the appropriate value for ω0r.Step 4: weigh the stability, transient performance, anti-interference, and noise suppression of the system, and determine the optimal values ofω0r and ωcr.After multiple tests and adjustments, the ideal parameter values are obtained as shown in Table3.(3)
LADRC: LADRC, i.e., “regular LADRC.” The LADRC-based trajectory tracking control system is obtained by removing the reference angular acceleration feedforward from Figure2. All parameter values of LADRC are in line with those of MLADRC. Since the derivative of cosine is continuous, it is often used as the reference input trajectory in simulation research. So the target trajectories of the two joints of the robot manipulator are set as(34)qd1=π61−cos0.5πtrad,qd2=π41−cos0.5πtrad.


### 4.2. Simulation Results

#### 4.2.1. Research on Joint Friction

In working processes, the robot manipulator will be hindered by the friction at the joint, so the influence of friction cannot be ignored when designing the controller. Assuming the frictional force at each joint is(35)F1q˙1=0.1sgnq˙1,F2q˙2=0.02sgnq˙2,the tracking curves and tracking errors among PD, LADRC, and MLADRC are compared in Figure 4.Figure 4
Comparison of the tracking performance among PD, LADRC, and MLADRC with the friction. (a) Trajectory tracking of joint 1. (b) Tracking errors of joint 1. (c) Trajectory tracking of joint 2. (d) Tracking errors of joint 2.
(a)(b)(c)(d)As is seen from Figure4, the trajectory tracking accuracy of MLADRC is the highest. The maximum tracking error of joint 1 is limited to ±5×10−4rad and that of joint 2 is limited to ±2×10−4rad. Joint friction in actual systems is very complex; especially at the moment when the velocity direction changes, there will be a spiking error, as shown in Figures 4(b) and 4(d). The friction needs to be observed by LESO before it is compensated, which leads to a lag in compensation.


#### 4.2.2. Research on System Robustness

In addition to the friction, the preidentified parameter values of the system model will change with the variety of working states. For example, in actual work, the end of robot manipulators will clamp different loads. Assuming the model perturbation caused by varying loads isΔp1=30%p1,Δp2=20%p2,Δp3=20%p3, the tracking errors with the friction and parameter perturbation are depicted in Figure 5.Figure 5
Comparison of the tracking errors among PD, LADRC, and MLADRC with the parameter perturbation and friction. (a) Tracking errors of joint 1. (b) Tracking errors of joint 2.
(a)(b)From Figure5, we can observe that the tracking error of MLADRC is still the smallest. Comparing Figures 4 and 5, the error curves are very close. So it illustrates that MLADRC is strongly robust against the system parameter perturbation.


#### 4.2.3. Research on Disturbance Rejection

High-performance controllers must be able to reject external disturbances. To test the disturbance rejection property of MLADRC, a disturbance ofτd2=0.2 is applied to joint 2 between 4.5 and 5.5 seconds. The tracking errors of the two joints are shown in Figure 6, and the total disturbances (the friction, parameter perturbation, external disturbances, and dynamic coupling) and their estimates are described in Figure 7.Figure 6
Comparison of the tracking errors among PD, LADRC, and MLADRC with the total disturbances. (a) Tracking errors of joint 1. (b) Tracking errors of joint 2.
(a)(b)Figure 7
Observations of the total disturbances of the MLADRC. (a) The total disturbances of joint 1. (b) The total disturbances of joint 2.
(a)(b)It can be observed from Figure6 that MLADRC can respond quickly and make timely adjustments when joint 2 is subjected to the external disturbance. The convergence time of the tracking error caused by the external disturbance is very short, which is mainly thanks to LESO’s excellent disturbance observation ability (see Figure 7). Figure 8 shows the input torques of the two joints, where the increased torque in joint 2 between 4.5 and 5.5 seconds is used to compensate for the external disturbance. The torque curves are relatively smooth and there is no violent chattering.Figure 8
Control torques of the two joints based on the MLADRC. (a) Control torque of joint 1. (b) Control torque of joint 2.
(a)(b)According to Figures4–8, we can conclude that the trajectory tracking system based on MLADRC can keep up with the target trajectory rapidly and has a strong robustness to the total disturbances. Under the same conditions, the tracking accuracy of MLADRC is enhanced compared with the regular LADRC.


## 4.1. Controller Parameters’ Tuning

(1)
PD controller: because PD is simple and easy to be realized in practical engineering, it is often used in robot manipulator control. The trajectory tracking system based on PD of joint 1 is plotted in Figure3. The current loop adopts a proportional-integral (PI) controller.The controller parameters of the PD and PI are tuned based on the Ziegler–Nichols method, and the final tuning results are listed in Table2. kp and kd are the proportional coefficient and differential coefficient of PD, and kp′ and ki are the proportional coefficient and integral coefficient of PI.(2)
MLADRC: MLADRC, i.e., “modified LADRC.” The structure of the trajectory tracking control system composed of MLADRC is plotted in Figure2. According to the method of parameter bandwidthization proposed in [20], the MLADRC parameters are configured as(33)β1r,β2r,β3r=3ω0r,3ω0r2,ω0r3,kpr,kdr=ωcr2,2ωcr,β1m,β2m=2ω0m,ω0m2,whereω0r is denoted as the third-order LESO bandwidth, ωcr represents the bandwidth of the PD controller in MLADRC, and ω0m is the second-order LESO bandwidth. As a result, the parameters that need to be tuned are greatly reduced and the physical meaning of each parameter is very clear.In MLADRC,b0, ω0r, ωcr, and ω0m determine the various performances of the system, such as stability, transient performance, anti-interference, and noise suppression. Each performance needs to be weighed when adjusting the controller parameters. For the controlled plant (11) and plant (17), b0 is known, and ω0r, ωcr, and ω0m need to be tuned. The specific configuration process is as follows [27]:Step 1: first, determine the initial value ofωcr according to the adjustment time of the system, and then let ω0r=2∼10ωcr.Step 2: keepω0r constant, and adjust ωcr in a small range until the system is stable. If adjustment of ωcr fails to stabilize the system, decrease or increase both ωcr and ω0r in the same proportion, and then adjust ωcr individually to make the system stable.Step 3: keepωcr constant, and gradually decrease ω0r. On the premise of ensuring the stability of the system, weigh the transient performance and noise suppression ability, and select the appropriate value for ω0r.Step 4: weigh the stability, transient performance, anti-interference, and noise suppression of the system, and determine the optimal values ofω0r and ωcr.After multiple tests and adjustments, the ideal parameter values are obtained as shown in Table3.(3)
LADRC: LADRC, i.e., “regular LADRC.” The LADRC-based trajectory tracking control system is obtained by removing the reference angular acceleration feedforward from Figure2. All parameter values of LADRC are in line with those of MLADRC. Since the derivative of cosine is continuous, it is often used as the reference input trajectory in simulation research. So the target trajectories of the two joints of the robot manipulator are set as(34)qd1=π61−cos0.5πtrad,qd2=π41−cos0.5πtrad.


## 4.2. Simulation Results

### 4.2.1. Research on Joint Friction

In working processes, the robot manipulator will be hindered by the friction at the joint, so the influence of friction cannot be ignored when designing the controller. Assuming the frictional force at each joint is(35)F1q˙1=0.1sgnq˙1,F2q˙2=0.02sgnq˙2,the tracking curves and tracking errors among PD, LADRC, and MLADRC are compared in Figure 4.Figure 4
Comparison of the tracking performance among PD, LADRC, and MLADRC with the friction. (a) Trajectory tracking of joint 1. (b) Tracking errors of joint 1. (c) Trajectory tracking of joint 2. (d) Tracking errors of joint 2.
(a)(b)(c)(d)As is seen from Figure4, the trajectory tracking accuracy of MLADRC is the highest. The maximum tracking error of joint 1 is limited to ±5×10−4rad and that of joint 2 is limited to ±2×10−4rad. Joint friction in actual systems is very complex; especially at the moment when the velocity direction changes, there will be a spiking error, as shown in Figures 4(b) and 4(d). The friction needs to be observed by LESO before it is compensated, which leads to a lag in compensation.


### 4.2.2. Research on System Robustness

In addition to the friction, the preidentified parameter values of the system model will change with the variety of working states. For example, in actual work, the end of robot manipulators will clamp different loads. Assuming the model perturbation caused by varying loads isΔp1=30%p1,Δp2=20%p2,Δp3=20%p3, the tracking errors with the friction and parameter perturbation are depicted in Figure 5.Figure 5
Comparison of the tracking errors among PD, LADRC, and MLADRC with the parameter perturbation and friction. (a) Tracking errors of joint 1. (b) Tracking errors of joint 2.
(a)(b)From Figure5, we can observe that the tracking error of MLADRC is still the smallest. Comparing Figures 4 and 5, the error curves are very close. So it illustrates that MLADRC is strongly robust against the system parameter perturbation.


### 4.2.3. Research on Disturbance Rejection

High-performance controllers must be able to reject external disturbances. To test the disturbance rejection property of MLADRC, a disturbance ofτd2=0.2 is applied to joint 2 between 4.5 and 5.5 seconds. The tracking errors of the two joints are shown in Figure 6, and the total disturbances (the friction, parameter perturbation, external disturbances, and dynamic coupling) and their estimates are described in Figure 7.Figure 6
Comparison of the tracking errors among PD, LADRC, and MLADRC with the total disturbances. (a) Tracking errors of joint 1. (b) Tracking errors of joint 2.
(a)(b)Figure 7
Observations of the total disturbances of the MLADRC. (a) The total disturbances of joint 1. (b) The total disturbances of joint 2.
(a)(b)It can be observed from Figure6 that MLADRC can respond quickly and make timely adjustments when joint 2 is subjected to the external disturbance. The convergence time of the tracking error caused by the external disturbance is very short, which is mainly thanks to LESO’s excellent disturbance observation ability (see Figure 7). Figure 8 shows the input torques of the two joints, where the increased torque in joint 2 between 4.5 and 5.5 seconds is used to compensate for the external disturbance. The torque curves are relatively smooth and there is no violent chattering.Figure 8
Control torques of the two joints based on the MLADRC. (a) Control torque of joint 1. (b) Control torque of joint 2.
(a)(b)According to Figures4–8, we can conclude that the trajectory tracking system based on MLADRC can keep up with the target trajectory rapidly and has a strong robustness to the total disturbances. Under the same conditions, the tracking accuracy of MLADRC is enhanced compared with the regular LADRC.


## 4.2.1. Research on Joint Friction

In working processes, the robot manipulator will be hindered by the friction at the joint, so the influence of friction cannot be ignored when designing the controller. Assuming the frictional force at each joint is(35)F1q˙1=0.1sgnq˙1,F2q˙2=0.02sgnq˙2,the tracking curves and tracking errors among PD, LADRC, and MLADRC are compared in Figure 4.Figure 4
Comparison of the tracking performance among PD, LADRC, and MLADRC with the friction. (a) Trajectory tracking of joint 1. (b) Tracking errors of joint 1. (c) Trajectory tracking of joint 2. (d) Tracking errors of joint 2.
(a)(b)(c)(d)As is seen from Figure4, the trajectory tracking accuracy of MLADRC is the highest. The maximum tracking error of joint 1 is limited to ±5×10−4rad and that of joint 2 is limited to ±2×10−4rad. Joint friction in actual systems is very complex; especially at the moment when the velocity direction changes, there will be a spiking error, as shown in Figures 4(b) and 4(d). The friction needs to be observed by LESO before it is compensated, which leads to a lag in compensation.


## 4.2.2. Research on System Robustness

In addition to the friction, the preidentified parameter values of the system model will change with the variety of working states. For example, in actual work, the end of robot manipulators will clamp different loads. Assuming the model perturbation caused by varying loads isΔp1=30%p1,Δp2=20%p2,Δp3=20%p3, the tracking errors with the friction and parameter perturbation are depicted in Figure 5.Figure 5
Comparison of the tracking errors among PD, LADRC, and MLADRC with the parameter perturbation and friction. (a) Tracking errors of joint 1. (b) Tracking errors of joint 2.
(a)(b)From Figure5, we can observe that the tracking error of MLADRC is still the smallest. Comparing Figures 4 and 5, the error curves are very close. So it illustrates that MLADRC is strongly robust against the system parameter perturbation.


## 4.2.3. Research on Disturbance Rejection

High-performance controllers must be able to reject external disturbances. To test the disturbance rejection property of MLADRC, a disturbance ofτd2=0.2 is applied to joint 2 between 4.5 and 5.5 seconds. The tracking errors of the two joints are shown in Figure 6, and the total disturbances (the friction, parameter perturbation, external disturbances, and dynamic coupling) and their estimates are described in Figure 7.Figure 6
Comparison of the tracking errors among PD, LADRC, and MLADRC with the total disturbances. (a) Tracking errors of joint 1. (b) Tracking errors of joint 2.
(a)(b)Figure 7
Observations of the total disturbances of the MLADRC. (a) The total disturbances of joint 1. (b) The total disturbances of joint 2.
(a)(b)It can be observed from Figure6 that MLADRC can respond quickly and make timely adjustments when joint 2 is subjected to the external disturbance. The convergence time of the tracking error caused by the external disturbance is very short, which is mainly thanks to LESO’s excellent disturbance observation ability (see Figure 7). Figure 8 shows the input torques of the two joints, where the increased torque in joint 2 between 4.5 and 5.5 seconds is used to compensate for the external disturbance. The torque curves are relatively smooth and there is no violent chattering.Figure 8
Control torques of the two joints based on the MLADRC. (a) Control torque of joint 1. (b) Control torque of joint 2.
(a)(b)According to Figures4–8, we can conclude that the trajectory tracking system based on MLADRC can keep up with the target trajectory rapidly and has a strong robustness to the total disturbances. Under the same conditions, the tracking accuracy of MLADRC is enhanced compared with the regular LADRC.


## 5. Experiment

### 5.1. Experimental Platform

A self-developed horizontal 2-DOF manipulator is used as the controlled object to conduct experimental researches on PD, LADRC, and MLADRC. The experimental platform includes a horizontal 2-DOF manipulator, an STM32 microcontroller, a host computer, two Hall current sensors, two DC motor drivers, and a switching power supply, which is shown in Figure9. An angle sensor with dual-channel pulse output is mounted at the tail of the BLDC reduction motor to measure the rotation angle and angular velocity of the joint. The linearity of the current sensor is 0.1% and the resolution of the angle sensor is 1024p/r. A smart power chip of BTS7960 is adopted to drive the BLDC motor.Figure 9
2-DOF manipulator control experiment platform.STM32 receives the position and control instructions from the host computer and collects the feedback signals such as joint angles and motor currents. The PD, LADRC, and MLADRC control algorithms run in STM32 to complete the calculation and output of the control quantity. The current sensor sends the current signal to the A/D conversion module in the STM32, and then the conversion result is sent to the current loop. The host control system is developed through Microsoft Foundation Classes (MFC) in Visual Studio 2015 and is responsible for such tasks as kinematics calculation, trajectory planning, data processing, and human-computer interaction.


### 5.2. Trajectory Planning and Motion Control

The experiment requires the end tip of the 2-DOF manipulator to track a circular trajectory with a diameter of 0.17 m. The circular trajectory is preset in the host control system, and its mathematical equation is expressed as(36)xd=0.285+0.085sin0.25πt+2m,yd=0.085cos0.25πt+2m,where xd and yd are the rectangular coordinates of the end tip. According to the structure and coordinate definition of the 2-DOF manipulator, the kinematic relationship between the end tip and the joints is described as(37)xd=l1cosqd1+l2cosqd1+qd2,yd=l1sinqd1+l2sinqd1+qd2.From equation (37), the desired motion equations of the two joints can be obtained as(38)qd1=arctanydxd−arccosxd2+yd2+l12−l222l1xd2+yd2,qd2=π−arccosl12+l22−xd2−yd22l1l2.(1)
Joint trajectory planning: when the robot manipulator is running, the target trajectories of the two joints are calculated and generated in real time by equations (36) and (38). To explain how the trajectories are produced, a detailed trajectory planning procedure is given as follows:Step 1: give timet an increment: t=t+ΔtStep 2: solve equation (36) to get the position coordinate xd,ydStep 3: substitutexd and yd into equation (38) to solve for qd1 and qd2Step 4: sendqd1 and qd2 to STM32 for tracking controlStep 5: go back to the beginning of the loop(2)
Motion control: control algorithms are loaded into STM32 before the system is powered on. The sampling period is set to 2 ms. When receiving the running command sent by the host computer, the end tip of the robot manipulator will be driven to move along target trajectories. The lower computer control system is designed by the modularization method, which includes function modules such as system initialization, data acquisition, algorithm design, and serial communication. The control program flow is shown in Figure10.Figure 10
Control program flowchart of the real-time motion control system.


### 5.3. Experimental Results and Discussion

According to the above experimental design process, a comparative experiment is carried out on LADRC and MLADRC. Two kinds of experimental results are given: undisturbed experiment and disturbed experiment. During the operation of the robot manipulator, joint angles are read in real time by STM32 and then transmitted to the host computer. Without external disturbances, the tracking performances of the two joints are shown in Figure11. Figure 12(a) describes the tracking curves of the end tip without disturbance. A step disturbance is applied to joint 1 at 4 seconds, and then the tracking curves are depicted in Figure 12(b).Figure 11
The tracking responses of the two joints. (a) Trajectory tracking of joint 1. (b) Tracking error of joint 1. (c) Trajectory tracking of joint 2. (d) Tracking error of joint 2.
(a)(b)(c)(d)Figure 12
The trajectory tracking curves of the end tip. (a) Trajectory tracking without external disturbances. (b) Trajectory tracking with the external disturbance.
(a)(b)From Figure11, we observed that joints 1 and 2 can track target trajectories very well, but the tracking error of MLADRC is less than that of LADRC. When the robot manipulator is just started, the system will be disturbed by sudden coupling and friction. The initial tracking error of each joint is large because of the lag of dynamic coupling and friction compensation.As can be seen from Figure12, the motion trajectory of the end tip is very close to the preset circular trajectory. When the robot manipulator is just started or is subject to the step disturbance, both MLADRC and LADRC can quickly adjust the motion state of the system. The tracking accuracy of MLADRC is higher than that of LADRC, and the MLADRC system responds faster.In the experiment, the measurement accuracy of the sensor will affect the observation performance of LESO, so the tracking accuracy is not as high as that in the simulation. In future research, high-precision current sensors and angle sensors can be selected to further enhance the trajectory tracking accuracy.


## 5.1. Experimental Platform

A self-developed horizontal 2-DOF manipulator is used as the controlled object to conduct experimental researches on PD, LADRC, and MLADRC. The experimental platform includes a horizontal 2-DOF manipulator, an STM32 microcontroller, a host computer, two Hall current sensors, two DC motor drivers, and a switching power supply, which is shown in Figure9. An angle sensor with dual-channel pulse output is mounted at the tail of the BLDC reduction motor to measure the rotation angle and angular velocity of the joint. The linearity of the current sensor is 0.1% and the resolution of the angle sensor is 1024p/r. A smart power chip of BTS7960 is adopted to drive the BLDC motor.Figure 9
2-DOF manipulator control experiment platform.STM32 receives the position and control instructions from the host computer and collects the feedback signals such as joint angles and motor currents. The PD, LADRC, and MLADRC control algorithms run in STM32 to complete the calculation and output of the control quantity. The current sensor sends the current signal to the A/D conversion module in the STM32, and then the conversion result is sent to the current loop. The host control system is developed through Microsoft Foundation Classes (MFC) in Visual Studio 2015 and is responsible for such tasks as kinematics calculation, trajectory planning, data processing, and human-computer interaction.


## 5.2. Trajectory Planning and Motion Control

The experiment requires the end tip of the 2-DOF manipulator to track a circular trajectory with a diameter of 0.17 m. The circular trajectory is preset in the host control system, and its mathematical equation is expressed as(36)xd=0.285+0.085sin0.25πt+2m,yd=0.085cos0.25πt+2m,where xd and yd are the rectangular coordinates of the end tip. According to the structure and coordinate definition of the 2-DOF manipulator, the kinematic relationship between the end tip and the joints is described as(37)xd=l1cosqd1+l2cosqd1+qd2,yd=l1sinqd1+l2sinqd1+qd2.From equation (37), the desired motion equations of the two joints can be obtained as(38)qd1=arctanydxd−arccosxd2+yd2+l12−l222l1xd2+yd2,qd2=π−arccosl12+l22−xd2−yd22l1l2.(1)
Joint trajectory planning: when the robot manipulator is running, the target trajectories of the two joints are calculated and generated in real time by equations (36) and (38). To explain how the trajectories are produced, a detailed trajectory planning procedure is given as follows:Step 1: give timet an increment: t=t+ΔtStep 2: solve equation (36) to get the position coordinate xd,ydStep 3: substitutexd and yd into equation (38) to solve for qd1 and qd2Step 4: sendqd1 and qd2 to STM32 for tracking controlStep 5: go back to the beginning of the loop(2)
Motion control: control algorithms are loaded into STM32 before the system is powered on. The sampling period is set to 2 ms. When receiving the running command sent by the host computer, the end tip of the robot manipulator will be driven to move along target trajectories. The lower computer control system is designed by the modularization method, which includes function modules such as system initialization, data acquisition, algorithm design, and serial communication. The control program flow is shown in Figure10.Figure 10
Control program flowchart of the real-time motion control system.


## 5.3. Experimental Results and Discussion

According to the above experimental design process, a comparative experiment is carried out on LADRC and MLADRC. Two kinds of experimental results are given: undisturbed experiment and disturbed experiment. During the operation of the robot manipulator, joint angles are read in real time by STM32 and then transmitted to the host computer. Without external disturbances, the tracking performances of the two joints are shown in Figure11. Figure 12(a) describes the tracking curves of the end tip without disturbance. A step disturbance is applied to joint 1 at 4 seconds, and then the tracking curves are depicted in Figure 12(b).Figure 11
The tracking responses of the two joints. (a) Trajectory tracking of joint 1. (b) Tracking error of joint 1. (c) Trajectory tracking of joint 2. (d) Tracking error of joint 2.
(a)(b)(c)(d)Figure 12
The trajectory tracking curves of the end tip. (a) Trajectory tracking without external disturbances. (b) Trajectory tracking with the external disturbance.
(a)(b)From Figure11, we observed that joints 1 and 2 can track target trajectories very well, but the tracking error of MLADRC is less than that of LADRC. When the robot manipulator is just started, the system will be disturbed by sudden coupling and friction. The initial tracking error of each joint is large because of the lag of dynamic coupling and friction compensation.As can be seen from Figure12, the motion trajectory of the end tip is very close to the preset circular trajectory. When the robot manipulator is just started or is subject to the step disturbance, both MLADRC and LADRC can quickly adjust the motion state of the system. The tracking accuracy of MLADRC is higher than that of LADRC, and the MLADRC system responds faster.In the experiment, the measurement accuracy of the sensor will affect the observation performance of LESO, so the tracking accuracy is not as high as that in the simulation. In future research, high-precision current sensors and angle sensors can be selected to further enhance the trajectory tracking accuracy.


## 6. Conclusions

Aiming at the trajectory tracking control problem of robot manipulators, a more in-depth study is carried out based on the regular LADRC. The control quality of the system is improved by adding the reference angular acceleration feedforward control, and the stability of the proposed MLADRC closed-loop system is analyzed. In the control system design, LESO is used to estimate and compensate for the total disturbances composed of internal uncertainties, external disturbances, and dynamic coupling. The feedforward control is used to improve the trajectory tracking accuracy. The double closed-loop control structure enhances the robustness of the system. In addition, according to the proposed control method, the error convergence, robustness, and external disturbance suppression of the system are studied, respectively. The comparative simulations and experiments verify the excellent control performance of MLADRC.



---

*Source: 8892032-2021-06-07.xml*