Professional Documents
Culture Documents
ISSN 1859-0551
Abstract
The paper proposes an effective control approach to a 3-DOF serial robotic arm actuated by electro-pneumatic servo systems (EPSS). The
robot control problem is divided into robot dynamics and pneumatic actuators sub-systems, and the control is subsequently elaborated for
each sub-system. The challenging task arises when dealing with pneumatic systems where system parametric information is very difficult to
acquired correctly. Hence, the Lyapunov-based control is formulated to derive the control signal in presence of external disturbances and model
uncertainties thank to the integrated disturbance observer. The closed-loop system stability is analytically proven through a series of Lyapunov
candidate functions. Simulations using MATLAB/Simscape Multibody Link plug-in on Solidworks are carried out to demonstrate the control
validity.
Keywords: Backstepping Sliding Mode Control (BSMC), 3-DOF robotic arm, electro-pneumatic servo system, nonlinear disturbance observer.
Symbols Units Description Bài báo trình bày phương án điều khiển robot 3 bậc tự do được truyền
m1 kg Upper arm mass with cylinder động bằng khí nén. Bài toán điều khiển được chia nhỏ thành hai bài
m2 kg Forearm mass toán con bao gồm động lực học robot và cơ cấu chấp hành khí nén,
mf kg Load mass with translation joint cylinder dựa vào đó, bộ điều khiển được thiết kế trên các hệ con. Những thách
I1 kg · m2 Moment of inertia for upper arm thức khi điều khiển đến từ việc khó khăn trong việc đo lường, xác
around the shoulder định tham số của hệ thống truyền động khí nén. Trong bài báo này,
I2 kg · m2 Moment of inertia for forearm bộ điều khiển được thiết kế dựa trên lý thuyết ổn định Lyapunov có
around the elbow tích hợp bộ quan sát nhiễu dùng để ước lượng tham số bất định cũng
P1 P2 m Upper arm length như nhiễu tác động lên đối tượng. Tính ổn định của hệ thống kín được
P1 Pm1 m Distance from centroid of upper arm chứng minh và các kết quả mô phỏng cho thấy hiệu quả của phương
to shoulder pháp đề xuất.
P2 Pm2 m Distance from centroid of forearm
to elbow 1. Introduction
θ1 rad Upper arm rotation range
θ2 rad Forearm rotation range In recent years, advances in technologies facilitate many indus-
trial automation processes. This creates an increasing demand
for actuators driven in high speed for the purpose of reducing
Abbreviations time consumption in industrial tasks like assembly process. In
comparison with servo motors, electro-pneumatic servo sys-
PRA Pneumatic Robotic Arm tems (EPSS) offer better characteristics such as low cost, high
EPSS Electro-Pneumatic Servo System power-to-weight ratio, the absence of magnetic field and simple
DOF Degree of Freedom cleaning and maintenance. These distinctive advantages allow
NDO Nonlinear Disturbance Observer pneumatic-driven units to be integrated in a wide range of in-
dustrial actuators. Therefore, the problems of exact control of
this kind of actuators are necessary. However, many hindrances
in model analyzing and controlling are found such as the com- turbance observer is presented to the 3-DOF pneumatic-driven
prehensibility of air and adverse effects of driving pneumatic manipulator. BSMC is used in control the dynamics of the
components in high speed that are oscillatory behaviours and EPAs and the kinematics of the entire manipulator itself. The
parasitic moving frictions [1]. manipulator model under the effect of external disturbances
The past decades also witnessed the profound automation in are also considered. The novel contributions of this paper are
many industries by the popularity of manipulators. Indeed, the summarized as follows:
use of industrial manipulators improves the overall productivity (i). The 3-DOF robotic arm driven by EPSS including shoul-
and reduces human error, as they have a superior load-lifting der, elbow, and translational joint is built, in which the 3-DOF
capability and can replace human labor in dangerous environ- manipulator is designed in CAD and a 3D model with precise
ments. They perform procedures repeatedly with high precision parameters of the model is built in Solidworks and Simscape
and are widely used from welding robots to car assembly lines. Multibody to validate the model in 3D simulation.
Generally, manipulator joints are driven in different modes, (ii). The nonlinear high-gain disturbance observer is embed-
i.e., full-actuated [2] and under-actuated [3]. It is more chal- ded with BSMC to have robust property against external dis-
lenging to do the under-actuated ones, since both kinematic turbances affecting on the manipulator. The stability of the
and dynamic constraints are tied in an under-actuated motion controller is proved mathematically by Lyapunov stability the-
system. Therefore, it is inappropriate to apply directly con- ory. The performance of the BSMC with nonlinear high-gain
ventional Euler–Lagrange method to this kind of joints. Thus, disturbance observer is compared to the conventional BSMC
complexity [4] and uncertainty of the model also degrade the using saturation function.
controller robustness. One typical model of a manipulator is The reminder of this article is organized as follows: the Section
from [5, 6]. It is a 2-DOF robotic manipulator is comprised of 1 is introduction, and the Section 2 concerns about mathemat-
an upper arm, a forearm, a disc load, and a fixed torso. The ical model of the manipulator. SMC with nonliear high-gain
shoulder and elbow joints are driven to rotate by two Electro- DOB is proposed in Section 3, followed by the simulation eval-
hydraulic actuators (EHAs). In this paper, we propose a model uation in Section 4. Finally, Section 5 discusses the simulation
using EPSS with additional electro-pneumatic servo actuator results and future development.
at the end of the forearm, which governs the extension of the
forearm and makes our model 3-DOF, providing a better range 2. Mathematical modeling of the 3-DOF PRA
of work and applications. The 3D model of this manipulator is
illustrated in Figure 1. 2.1. Dynamic and kinematic model of robotic arm
Due to the enormous applicability of pneumatic units in in-
dustries, researchers have come up with different strategies to
control accurately this type of actuator [7]. An active rejection-
disturbance controller (ARDC) was utilized in [8] and [9] and
brought promising results. Pulse-width modulation technique
and fuzzy logic controller were combined in [10] to control
an electro-pneumatic servo systems. In [11], Karpenko et al.
proposed a quantitative feedback theory of a PI controller for
positioning of a servo-pneumatic servo actuator. Paper [12]
presented a hybrid controller of fuzzy controller and PID con-
troller. These linear control schemes experienced difficulties
in obtaining both fast response and precise position control at
the same time, due to the nonlinear nature of the EPSS.
Therefore, different approaches are implemented to tackle this
problem. Popular employed methods can be listed as backstep-
ping technique and Sliding Mode Control (SMC). Tracking
position control of EPSS is concerned in [13] with a backstep-
ping controller. In [14], authors applied adaptive backstepping
controller using Nussbaum gain with unknown model. A differ-
ent approach of adaptive backstepping control is implemented
in [15]. For SMC, it showed a wider range of application in
Figure 1: The 3-DOF pneumatic robotic arm configuration.
a lot of control scenarios: SMC for servo-pneumatic servo
system [16] and [17], SMC with friction compensation [18], The 3-DOF pneumatic robotic arm is shown in Figure 1, in
SMC with Particle Swarm Optimization [19], and adaptive which the shoulder, elbow, and translational joints are driven
SMC [20]. These papers proved the robustness and efficiency by three independent single-rod cylinder electro-pneumatic
of SMC for a highly non-linear model like pneumatic system. servo actuators. The robot position vectors Pm1 , Pm2 , and P3 are
Some authors also combined these techniques together and ob- given by, respectively:
tained even remarkably better control quality like Ren et al. [21]
and Lu et al. [22]. SMC algorithms in these mentioned papers −P1 Pm1 sin (θ1 + εm1 )
rPm1/O = (1)
were found to be effective against external disturbances with P1 Pm1 cos (θ1 + εm1 )
addition of an observer like extended state observer (ESO).
In this paper, a new control approach using Backstepping- −P1 P2 sin (θ1 ) − P2 P2m sin (θ1 + θ2 )
Sliding Mode Control (BSMC) and nonlinear high-gain dis- rPm2/O = (2)
P1 P2 cos (θ1 ) + P2 P2m cos (θ1 + θ2 )
Measurement, control and automation 53
By using simple geometric calculations, three cylinder dynamic C12 = m1 P1 P2 .ẋ3 cos θ2 − 2m2 P1 P2 .P2 Pm20 θ̇1 sin θ2
lengths c1 , c2 , c3 are represented by: − m2 P1 P2 .P2 Pm20 θ̇2 sin θ2 − 2m f P1 P2 .x3 θ̇1 sin θ2
r π − m f P1 P2 .x3 θ̇2 sin θ2
c1 = a1 2 + b1 2 − 2a1 b1 cos − θ1 + ε11 C13 = 2m f x3 θ̇1 + 2m f x3 θ̇2 + 2m f P1 P2 .θ̇1 cos θ2
2
q
2
(10) C21 = 0
c2 = a2 2 + b2 − 2a2 b2 cos (π − θ2 − ε21 )
C22 = −m2 P1 P2 .P2 Pm20 θ̇1 sin θ2 − m f P1 P2 .x3 θ̇1 sin θ2
c3 = x3
C23 = 2m f x3 θ̇1 + 2m f x3 θ̇2 + m f P1 P2 θ̇1 cos θ2
Define the generalized force vectors T including torques T1 , T2 C31 = 0
and force F3 as:
C32 = m f P1 P2 θ̇1 cos θ2
T = [T1 T2 T3 ]T (11) C33 = 0
54 Measurement, control and automation
P1 A21 P2 A22
Ḟa = −αγ ẋ p − + γRT
A1 ψ1 A2 ψ2
− wkv u d̃ ≤ e−(1/ε)t d̃ (0) + ερ (t) (42)
V1 V2 V1 V2
(33) where ρ (t) denotes an envelope function that ρ (t) ≥ ḋ
Remark 1. Equation (42) shows that the estimated error d̃ of
Let the nonlinear high-gain disturbance observer can made arbitrar-
T ily small when the observer gain ε is chosen as infinitesimal.
x= xp ẋ p (34)
3.2. Robust control design process
Then, Equation (33) can be rewritten as:
In the paper, the complete system including the robot and the
Ḟa = fa (x,t) + ga (x,t) u (35) EPSS is rendered as a cascade system. Firstly, the system
level is taken into account to identify required torque/force to
where achieve positioning tasks. Subsequently, the control design
is carried out at pneumatic actuator level to construct the
P1 A21 P2 A22
fa (x,t) = −αγ ẋ p − final control signal. In this step, the nonlinear high-gain
V1 V2 disturbance observer is designed to effectively estimate
(36)
A1 ψ1 A2 ψ2 external disturbances acting on the system.
ga (x,t) = γRT − wkv
V1 V2
a. The 3-DOF robotic arm control
In this paper, we assume that all the EPSS are identical.
56 Measurement, control and automation
The conventional backstepping technique is integrated with the of the EPSS, sliding mode control is used for the electro-
sliding mode control to obtain a robust controller for uncer- pneumatic servo control system. Define sliding variable sa as
tain systems. The basic BSMC for the 3-DOF robotic arm is follows:
designed by firstly defining the tracking error as:
sa = Fa − Fd (53)
e1 = x1 − x1d (43)
where Fd denotes the desired force that determined from the
where x1d denotes the desired trajectory. Select Lyapunov can- control laws Td via the generalized force vectors (11) and
didate function V1 as: the two dynamic force arms (12). Select Lyapunov candidate
function V3 as:
1
V1 = eT1 e1 (44) 1
2 V3 = sTa sa (54)
2
The time derivative of Equation (44) is taken as follows:
The time derivative of equation (54) is taken as:
V̇1 = eT1 ė1 = eT1 (ẋ2 − ẋ1d ) (45) V̇3 = sa T ṡa = sa fa + ga u − Ḟd
(55)
Equation (45) suggests that the virtual control law is chosen Based on sliding mode control, the control law u of electro-
as: pneumatic servo system is designed as follows:
x2d = −c1 e1 + ẋ1d u = ga −1 −fa − ksa + Ḟd − κsgn (sa )
(46) (56)
where c1 = diag(c11 , c12 , c13 ) is a positive definite matrix, then, where k = diag(k1 , k2 , k3 ) and κ = diag(κ1 , κ2 , κ3 ) are positive
V̇1 ≤ 0. Define a sliding variable s = [s1 s2 s3 ]T : definite matrices.
Subsequently, Lyapunov candidate function V2 is defined as Theorem 1. Consider the 3-DOF robotic arm driven by
follows: electro-pneumatic servo systems described in general form as
1 equations (17) and (35) under unknown disturbance bounded
V2 = V1 + sT s (48) as Assumption 1, the control laws of the robotic arm (51),
2
the control laws of the EPSS (56), and the observer gains
The time derivative of equation (48) is taken as ε of the nonlinear disturbance observer (40) guarantee the
Input-to-State Stability [23] of the control system.
V̇2 = V̇1 + sT ṡ
(49)
= −c1 eT1 e1 + s (f2 (q) + g2 (q) T + d (q) − ẋ2d ) Proof of Theorem 1. Lyapunov function candidate is defined
as:
Equation (49) directly indicate that control law T of the 3-DOF 1 1 1 1
robotic arm is designed as: V = eT1 e1 + sT s + d̃T d̃ + sTa sa (57)
2 2 2 2
Td = g2 −1 (q) (−f2 (q) − c2 s + ẋ2d − υsgn (s)) (50) The time derivative of V is taken as:
where c2 = diag(c21 , c22 , c23 ) and υ = diag(υ1 , υ2 , υ3 ) are V̇ = e1 T ė1 + d̃T d̃˙ + sT ṡ + sa T ṡa (58)
positive definite matrices. Using the estimated disturbance
signal (40), Equation (50) is rewritten as follows: Substituting the control laws (51), (56) and the estimation error
dynamic (41) into Equation (58), it can be rewritten as:
Td = g2 −1 (q) −f2 (q) − c2 s + ẋ2d − υsgn (s) − d̂ (q)
(51)
V̇ = −eT1 c1 e1 + sT −c2 s − υsgn (s) + d − d̂
(59)
The control design for the robot level is completed, in the next 1
+d̃ ḋ − d̃ + sa T (−ksa − κsgn (sa ))
T
section, the control action for the EPSS is established. ε
b. The electro-pneumatic servo system control The inequality |a||b|⩾ ab is used for Equation (59), thus we
The dynamic model of one cylinder is described in detail in obtain:
subsection 2.3. To calculate the control for the three-cylinder of
si ζi ˜ 2
T T
the robot system, then the equation (35) is rewritten as follows: V̇ ≤−e1 c1 e1 − sa ksa − c2i − di
ζi 2c2i
2 !
ηi 2 2
1 1
Ḟa = fa + ga u (52) −τi |d˜i |− |d˙i | − 1 − 2 c2i si 2 − d̃i (60)
2τi ζi 4c2i
T
where Fa =
Fa,1 Fa,2 Fa,3 , fa = 1 ˙2
+ |di |
T
fa,1 (x,t) fa,2 (x,t) fa,3 (x,t) , u = u1 u2 u3
T
, 4τi
and ga = diag (ga,1 (x,t), ga,2 (x,t), ga,3 (x,t)), the subscript where
n = [1, 2, 3] represent the cylinders of the three joints (i.e, !
shoulder, elbow, and translation joint), respectively. 1 ζi 2 + ηi 2
τi = − ;ζ > 1; η ̸= 0; i = 1, 2, 3 (61)
In order to reduce the influence of parameter uncertainties ε 4c2i
Measurement, control and automation 57
There exists constants ι and γ satisfying the following condi- Table 1: Parameters of the 3-DOF robotic arm and the proposed
tions: controller
3 Symbol Value Unit
ι = ∑ 1 |d˙i |2 ,
4τi m1 1.335 kg
i=1 n o (62)
γ = min 1 − 12 c2i , ci , ki , ηi 2
m2 0.86 kg
ζi 4c2i
mf 1 kg
I1 0.05628 kg · m2
Equation (62) can be rewritten as:
I2 0.21154 kg · m2
V̇ ⩽ −2γV + ι (63) P1 P2 0.3 m
P1 Pm1 0.1523 m
Consequently, it can be concluded that P2 Pm2 0.165 m
L 0.2 m
ι
V (t) ⩽ V (0) e−2γt + 1 − e−2γt
(64) Patm 0.1 × 106 Pa
2γ Ps 0.6 × 106 Pa
Remark 2. Equation (64) implies that the tracking errors e1 , s, Pcr 0.528
sa , and estimation error d̃ of the 3-DOF robotic arm driven γ 1.4
by electro-pneumatic servo systems using the backstepping- R 287 N · m/kg · K
sliding mode control with nonlinear high-gain disturbance ob- T 300 K
server exponentially converge to an arbitrarily tiny ball. c1 = diag(c11 , c12 , c13 ) diag(2.5, 2, 4)
Remark 3. In order to reduce the chattering effect of sliding c2 = diag(c21 , c22 , c23 ) diag(5, 7, 13)
mode control, the saturation function is used to replace the sign υ = diag(υ1 , υ2 , υ3 ) diag(1, 2, 1)
function in the control laws (51), (56). ε 0.015
4. Simulation evaluation
Simulations based on Matlab/Simscape Multibody Link plug-
in on Solidworks are carried out to demonstrate the control
validity of the 3-DOF robotic arm driven by electro-pneumatic
servo systems. In which, the electro-pneumatic servo systems
are controlled by sliding mode control, and backstepping-
sliding mode control with nonlinear high-gain disturbance
observer is used for the 3-DOF robotic arm that are shown
as in Figure 4. In the simulations, assume that disturbances
acting on robot joints is sinusoidal wave form of 0.5 sin πt as
shown in Figure 11. Parameters of the 3-DOF robotic arm and
the proposed controller is expressed in Table 1. Figure 5: Shoulder joint rotation angle.
From figures 5, 6, and 7, we can observe that angular and
translational motions of the robot under the proposed con-
troller integrated with the disturbaces observer exhibit better is presented in Figure 11, in which the disturbance estima-
performances compared to traditional backstepping-sliding tion of the three joints (i.e, shoulder, elbow, and translational
mode control. Figures 8, 9, and 10 show that forces produced joint) follows the disturbances of 3-DOF robotic arm. By us-
by the EPSS closely (,i.e. the actual forces) track the desired ing the nonlinear high-gain disturbance observer combined
forces determined by the robot motion control problem. It is with backstepping-sliding mode control, the rotation angle re-
also noted that the control forces are well maintained in ap- sponses of the shoulder and elbow joints, and translational
plicable ranges. The effectiveness of the disturbance observer joint displacement are greatly improved that reducing the in-
58 Measurement, control and automation
Figure 6: Elbow joint rotation angle. Figure 10: Force response of the pneumatic cylinder F3 .
5. Conclusion
In the paper, the backstepping-sliding mode control with em-
bedded disturbance is developed for the 3-DOF robot driven by
electro-pneumatic actuators. The complicated dynamics of the
electro-pneumatic characteristic is considered in the control
design. By backstepping-like procedure the control scheme
is formulated exhibiting robust property against disturbances.
The constructed control allows the system output track the de-
sired signal in a short time period with negligible steady state
errors. Currently, the simulation is studied in the paper. In the
near future, the experimental results will be presented.
References
[1] Kawakami, Y., Moguchi, H., & Kawai, S. (1990) Some considerations
on the high-speed driving of pneumatic cylinders. J. Japan Hydraulics
& Pneumatics Society, 21(3 May), 318–327.
[2] Zhijun Li, Shuzhi Sam Ge, Adams, M., & Wijesoma, W. S. (2008)
Adaptive Robust Output-Feedback Motion/Force Control of Electrically
Driven Nonholonomic Mobile Manipulators. IEEE Transactions on
Control Systems Technology, 16(6), 1308-1315.
[3] Dong, W. (2002) On trajectory and force tracking control of constrained
mobile manipulators with parameter uncertainty. Automatica, 38(9),
Figure 9: Force response of the pneumatic cylinder F2 . 1475–1484.
[4] Yan, Y., Xu, J., & Wiercigroch, M. (2017) Basins of attraction of the
bistable region of time-delayed cutting dynamics. Physical Review E,
96(3).
[5] Guo, Q., Zhang, Y., Celler, B. G., & Su, S. W. (2019) Neural Adap-
tive Backstepping Control of a Robotic Manipulator with Prescribed
fluence of the disturbance of the three joints compared to the Performance Constraint. IEEE Transactions on Neural Networks and
conventional backstepping-sliding mode control. Learning Systems, 30(12), 3572–3583.
Measurement, control and automation 59