Ultrasonic Welding
Ultrasonic Welding
Ultrasonic Welding
http://dx.doi.org/10.1007/s12555-017-0544-x http://www.springer.com/12555
Abstract: Robotic manipulators are usually subject to different types of disturbances. If the effects of such dis-
turbances are not taken into account, it can lead to unsatisfactory tracking performance of the robot and may even
destabilize the robot control system. In this paper a novel nonlinear disturbance observer-based controller is de-
signed for robotic manipulators. Previous disturbance observer-based controllers which are designed for robotic
systems undergo the restricting assumption that the external disturbance is constant. In this paper a novel two-stage
procedure is proposed to design a disturbance observer that improves disturbance attenuation ability of current dis-
turbance observer-based controllers. The proposed method can cope with non-constant disturbance. Furthermore,
it is shown that even for the fast time varying disturbance, the controller achieves satisfactory tracking performance.
The proposed controller guarantees semi-global asymptotic position and velocity tracking and moreover, removes
restrictions of previous studies on the number of degrees of freedom (DOFs), joint types, and manipulator configu-
ration. The effectiveness of the proposed method is verified against different types of external disturbance applied
on the robot manipulator and the results are compared with the results of previous methods. Furthermore, the results
support the theoretical conclusions.
Keywords: Disturbance observer, robotic manipulators, stability analysis, time varying disturbance, trajectory fol-
lowing.
Manuscript received September 5, 2017; revised June 2, 2018; accepted August 8, 2018. Recommended by Associate Editor Nam H. Jo
under the direction of Editor Hyun-Seok Yang.
Mohamadreza Homayounzade is with the Department of Mechanical Engineering, Fasa University, Fasa, Iran (e-mail: homayounzade.
[email protected]). Amir Khademhosseini is with the Department of Computer Engineering, Fasa University, Fasa, Iran (e-mail: khadem_h
@fasau.ac.ir).
* Corresponding author.
⃝ICROS,
c KIEE and Springer 2019
204 Mohamadreza Homayounzade and Amir Khademhosseini
trol, in the majority of these cases, the analysis or design is ulator subject to different types of disturbance and the re-
based on linearized models and linear control techniques sults are compared with previous results.
[20, 21]. Since the robot manipulator dynamic is highly The rest of the paper is organized as follows: In Sec-
nonlinear and coupled, the validity of utilizing linear tech- tion 2 the dynamic modelling of the robot dynamic is pre-
niques for robotic systems may be in doubt. sented. In Section 3 the controller along with disturbance
In order to resolve the limitations and shortcomings estimator is dersigned. The error dynamics of the system
of utilizing linear disturbance observers for nonlinear dy- is presented in Section 4. The stability of the system is an-
namic of robot manipulators, Chen et al. [22] proposed alyzed by the Lyapunov theroem in Section 5. Simulation
a nonlinear disturbance observer for a specific class of results are presented in Section 6 and Section 7 concludes
robotic manipulators without the need for the acceleration the paper.
measurements. Their method depends on finding a proper
observer gain matrix that stabilizes the control system. 2. DYNAMIC MODELLING OF ROBOTIC
However, Chen et al. could find such a proper gain matrix SYSTEMS
for a 2-link planar manipulator with revolute joints. After-
wards, Nikoobin et al. [23], generalized Chen’s method to Dynamic equation of an n-degrees-of-freedom serial
be applicable to n-link planar manipulators with revolute rigid manipulator is given by
joints by exploiting the explicit relation for this particular M(q)q̈ +C(q, q̇)q̇ + G(q) + τd = τ , (1)
class of robots.
The method proposed in [22] has been applied to other where q, q̇, q̈ represent respectively the n × 1 vectors of
classes of robotic systems such as observer-based control joint positions, velocities and accelerations; M is the n × n
of 6-DOF parallel manipulators [24] and dynamic surface inertia matrix; C(q, q̇) is the n × n centrifugal and Coriolis
control of mobile wheeled inverted pendulums [25]. Al- matrix; τ is the n×1 vector of applied joint torques; and τd
though the method designed in [23] show promising re- is the n × 1 disturbance vector which lumps the effects of
sults in disturbance estimation, their method is restricted torque due to disturbance, end-effector payloads, external
to the planar, serial manipulators with revolute joints. force, friction force, and unmodeled dynamics.
However, industrial robots are generally non-planar and Property 1: The inertia matrix is positive definite
may have prismatic joints in addition to revolute joints. (P.D.) and there exists positive real numbers Mm and MM
Furthermore, in [22, 23] the external disturbance is sup- such that
posed to be constant.
Mm ∥x∥2 ≤ xT M(q)x ≤ MM ∥x∥2 ∀x ∈ ℜn , (2)
The above limitations serve as the stimulation to look
for a more general design method. In [9], the authors de- where throughout this paper ∥·∥ represents the 2 induced
signed a disturbance observer-based controller for robotic matrix norm for matrices and Euclidean norm for vectors.
manipulators which removes previous restrictions on the Property 2: The centripetal-Coriolis matrix can be de-
number of DOFs, joint types, or manipulator configura- signed such that it possesses the following skew symmet-
tion. However, their method similar to previous researches ric property
suffers from the restricting assumption that the external [ ]
1
disturbance is required to be constant. In [26] an integral xT Ṁ −C(q, q̇) x = 0 ∀ x ∈ ℜn . (3)
2
sliding disturbance observer is designed to compensate for
unknown disturbances for a class of nonlinear systems ex- Definition 1: For any arbitrary P.D. or N.D. (negative
posed to disturbance with bounded first time derevative. definite) symmetric matrix such as P, throughout this pa-
The above limitations serve as the motivation for this per by Pm and PM , we mean the minimum and maximum
paper to design a general method that guarantees stability eigenvalues of the matrix P. Hence, for any arbitrary vec-
of the controlled system exposed to non-constant distur- tor such as ξ we can state
bance. Pm ∥ξ ∥2 ≤ ξ T Pξ ≤ PM ∥ξ ∥2 . (4)
In this paper we design a nonlinear disturbance
observer-based controller for robotic systems. The pro- Let us define position tracking error, i.e., z1 , by
posed controller guarantees asymptotic trajectory tracking
z1 = q − qd , (5)
and removes the restrictions of the previous methods that
require the external disturbance to be constant or its first where the vector qd represents the desired angular position
time derevative to be bounded. The proposed method can of joints. Moreover, let the filtered velocity tracking error
be utilized for non-constant external disturbance and it of the links (i.e., z2 ) be defined by
requires the measurement of joint positions and velocities
z2 = q̇ − q̇d + Λ(q − qd ), (6)
but not accelerations.
In order to illustrate the effectiveness of the proposed where Λ is an n × n P.D. matrix and the vector q̇d repre-
method, simulations are done using a 2-link robot manip- sents the desired joint angular velocity.
Disturbance Observer-based Trajectory Following Control of Robot Manipulators 205
3. CONTROL OBJECTIVE
In the next section it will be shown that the controlled sys- V̇ =ε z1 T [z2 − Λz1 ]
[ ]
tem is asymptotically stable. + z2 T −γ M −1Cz2 − γ M −1 K1 z2
Disturbance Observer-based Trajectory Following Control of Robot Manipulators 207
[ ] ∫ ]
+ τ̃d T −α 2 LM −2 τ̃d
t
+ λ3 ∥τ̃d ∥ dt .
2
(38)
1 d 0
+ α τ̃d T (M −1 )τ̃d . (31)
2 dt Equation (38) implies that E(t) ∈ L2 ∩ L∞ , and moreover
Remark 3: The observer-based controller is designed from Barballat conditions it can be concluded that
to cope with the ramp external disturbance, i.e., τ̈d = 0.
Moreover, it is shown numerically that even if for fast time lim (q−qd ) = 0, lim (q̇−q̇d ) = 0, lim (τd −τ̂d ) = 0.
t→∞ t→∞ t→∞
varying disturbance the controller works well. (39)
Remark 4: For any arbitrary vector such as a and b we
can state that 6. NUMERICAL SIMULATIONS
aT b ≤ ∥a∥ × ∥b∥ , In this section the effectiveness of the proposed con-
1( 2 )
trol method is evaluated numerically by performing sim-
aT b ≤ ∥a∥ + ∥b∥2 . (32)
2 ulation on a two link robot manipulator and a 4 DOF
Considering Remark 4, one can simplify (31) to obtain SCARA (selective compliance assembly robot arm) and
the results are compared with the results of methods pro-
1 ( )
posed in [10, 31].
V̇ ≤ ε ∥z1 ∥2 + ∥z2 ∥2 − ε Λm ∥z1 ∥2
2
1 6.1. Comparison with [31]
+ γ
M −1
∥C∥ ∥z2 ∥2 − γ K1m ∥z2 ∥2
MM In [31], a disturbance observer-based controller is de-
1 1
d −1
signed for robotic systems exposed to eternal disturbance
− α Lm
2
∥τ̃ d ∥2
+ α
(M )
∥τ̃d ∥ .
2
MM 2 2 dt which is supposed to be generated by a linear exogenous
(33) system
In any bounded region the inertia matrix and the ξ̇ = Aξ , d = Cξ , (40)
matrix can be bounded by ∥C∥ ≤
Corriollis-centripedal
CM and
dtd (M −1 )
≤ δ [27–30]. Hence, where d ∈ R represents an external disturbance and ξ ∈
( ) Rm . Afterward, a disturbance estimator is designed to es-
V̇ ≤ ∥z1 ∥2 12 ε − ε Λm timate ξ while the matrices A, C are assumed to be certain
( )
γ CM γ K1m and these matrices have been utilized to construct the dis-
+ ∥z2 ∥2 21 ε + − turbance observer. In [31] the effectiveness of the distur-
Mm MM
( ) bance observer-based controller is evaluated by control-
α Lm 1
2
+ ∥τ̃d ∥2 − + αδ . (34) ling a two-link robotic manipulator, each link of which is
MM 2 2 directly driven by a DC motor. Moreover, it is assumed
By designing the matrices Λ, K1 , L and the constants γ , α , that there is a periodic disturbance torque acting on the
ε such that the conditions (27a) to (27c) are held, it can be end of the second link, given by d(t) = 0.5 sin(2t + 1)
stated that N.m. However, the amplitude and frequency of the ex-
ternal disturbance is required to be known. It is worth
V̇ ≤ −λ1 ∥z1 ∥2 − λ2 ∥z2 ∥2 − λ3 ∥τ̃d ∥2 , (35) mentioning that our method does not require the knowl-
edge of the amplitude and frequency of disturbance, and
where λ1 to λ3 are all positive constants and clearly de-
these parameters are not utilized in the controller design.
fined from (34). From (35), it can be deduced that V̇ ≤ 0,
The simulation results of the method presented in [31]
and consequently
and those of the traditional computed torque controller
1 1 (CTC) without utilizing any disturbance compensation are
Bm ∥E(t)∥2 ≤ V ≤ V (0) ≤ BM ∥E(0)∥2 . (36)
2 2 shown in Fig. 3. It is worth mentioning that Fig. 3 is ex-
Hence, actly the same as presented in [31].
We simulate the proposed method in the same situation
BM as performed in [31] and the results are shown in Fig. 4.
∥E(t)∥2 ≤ ∥E(0)∥2 , ∀t > 0. (37)
Bm Comparing Fig. 4 with Fig. 3, it can be justified that the
Thus, any trajectory initiated within any bounded region same control performance is obtained utilizing our method
{ }
while compared to [31], here the amplitude and frequency
such as Ω2 = E | ∥E∥2 ≤ BBMm ℓ will remain in Ω1 .
of the disturbance is not required to be known.
Integrating (35) with respect to time and considering
(36), we obtain 6.2. Comparison with [10]
[ ∫t ∫ t
2 In this section we perform simulation on a 4 DOF
∥E(t)∥2 ≤ℓ − λ1 ∥z1 ∥2 dt + λ2 ∥z2 ∥2 dt SCARA manipulator and the results are compared with
Bm 0 0
208 Mohamadreza Homayounzade and Amir Khademhosseini
4
+ ∑ Ii ,
i=1
p2 = 2a1 [x2 m2 + a2 (m3 + m4 )] ,
4
p3 = m2 x2 2 + a2 2 (m3 + m4 ) + ∑ Ii ,
i=2
p4 = m3 + m4 , p5 = I4 , (42)
7. CONCLUSIONS
the proposed control algorithm can cope with even time [13] S. Katsura, Y. Matsumoto, and K. Ohnishi, “Analysis and
varying external disturbance. The effectiveness of the pro- experimental validation of force bandwidth for force con-
posed method is compared with previous methods in dif- trol,” IEEE Trans. on Industrial Electronics, vol. 53, no. 3,
ferent scenarios. pp. 922-928, June 2006.
[14] Y. Ohba, M. Sazawa, K. Ohishi, T. Asai, K. Majima, Y.
REFERENCES Yoshizawa, and K. Kageyama, “Sensorless force control
for injection molding machine using reaction torque ob-
[1] S. Li, J. Yang, W. H. Chen, and X. Chen, Distur- server considering torsion phenomenon,” IEEE Trans. on
bance Observer-Based Control: Methods and Applica- Industrial Electronics, vol. 56, no. 8, pp. 2955-2960, Au-
tions, CRC, Boca Raton, FL, April 2014. gust 2009.
[2] C. H. Choi and N. Kwak, “Robust control of robot [15] E. Sariyildiz and K. Ohnishi, “An adaptive reaction force
manipulator by model-based disturbance attenuation,” observer design,” IEEE/ASME Trans. on Mechatronics,
IEEE/ASME Trans. on Mechatronics, vol. 8, no. 4, pp. 511- vol. 20, no. 2, pp. 750-760, April 2015.
513, December 2003. [16] A. Mohammadi, H. J. Marquez, and M. Tavakoli, “Non-
[3] C. Zhongyi, S. Fuchun, and C. Jing, “Disturbance linear disturbance observers: design and applications to
observer-based robust control of free-floating space manip- Euler-Lagrange systems,” IEEE Control Systems, vol. 37,
ulators,” IEEE Systems Journal, vol. 2, no. 1, pp.114-119, no. 4, pp. 50-72, August 2017.
March 2008.
[17] M. Chen and W. H. Chen, “Disturbance-observer-based ro-
[4] J. H. She, M. Fang, Y. Ohyama, H. Hashimoto, and M. bust control for time delay uncertain systems,” Interna-
Wu, “Improving disturbance-rejection performance based tional Journal of Control, Automation, and Systems, vol.
on an equivalent-input-disturbance approach,” IEEE Trans. 8, no. 2, pp. 445, April 2010.
on Industrial Electronics, vol. 55, no. 1, pp. 380-389, Jan-
[18] K. Kong and M. Tomizuka, “Nominal model manipula-
uary 2008.
tion for enhancement of stability robustness for disturbance
[5] B. Bona and M. Indri, “Friction compensation in robotics: observer-based control systems,” International Journal of
an overview,” Proc. of 44th IEEE Conf. on Decision and Control, Automation and Systems, vol. 11, no. 1, pp. 12-20,
Control, pp. 4360-4367, 2005. February 2013.
[6] U. Sawut, N. Umeda, K. B. Park, T. Hanamoto, and T. [19] E. Kim, “A fuzzy disturbance observer and its application
Tsuji, “Frictionless control of robot arm with sliding mode to control,” IEEE Transactions on Fuzzy Systems, vol. 10,
observer,” Proc. of the IEEE International Vehicle Elec- no. 1, pp.77-84, February 2002.
tronics Conf., pp. 61-66, 2001.
[20] B. K. Kim and W. K. Chung, “Advanced disturbance ob-
[7] Z. J. Yang, Y. Fukushima, and P. Qin, “Decentralized adap- server design for mechanical positioning systems,” IEEE
tive robust control of robot manipulators using disturbance Trans. on Industrial Electronics, vol. 50, no. 6, pp. 1207-
observers,” IEEE Trans. on Control Systems Technology, 1216, December 2003.
vol. 20, no. 5, pp.1357-1365, September 2012.
[21] S. Komada, N. Machii, and T. Hori, “Control of redundant
[8] Y. X. Su, B. Y. Duan, C. H. Zheng, Y. F. Zhang, G. D. Chen,
manipulators considering order of disturbance observer,”
and J. W. Mi, “Disturbance-rejection high-precision mo-
IEEE Trans. on Industrial Electronics, vol. 47, no. 2, pp.
tion control of a Stewart platform,” IEEE Trans. on Con-
413-420, April 2000.
trol Systems Technology, vol. 12, no. 3, pp. 364-374, May
2004. [22] W. H. Chen, D. J. Ballance, P. J. Gawthrop, and J. O’Reilly,
[9] A. Mohammadi, H. J. Marquez, and M. Tavakoli, “Distur- “A nonlinear disturbance observer for robotic manipula-
bance observer-based trajectory following control of non- tors,” IEEE Trans. on Industrial Electronics, vol. 47, no.
linear robotic manipulators,” Proc. of the 23rd CANCAM, 4, pp. 932-938, August 2000.
pp. 5-9, 2011. [23] A. Nikoobin and R. Haghighi, “Lyapunov-based nonlinear
[10] A. Mohammadi, M. Tavakoli, H. J. Marquez, and F. disturbance observer for serial n-link robot manipulators,”
Hashemzadeh, “Nonlinear disturbance observer design for Journal of Intelligent & Robotic Systems, vol. 55, no. 2, pp.
robotic manipulators,” Control Engineering Practice, vol. 135-153, July 2009.
21, no. 3, pp. 253-267, March 2013. [24] R. Hao, J. Wang, J. Zhao, and S. Wang, “Observer-based
[11] S. Katsura, Y. Matsumoto, and K. Ohnishi, “Modeling of robust control of 6-DOF parallel electrical manipulator
force sensing and validation of disturbance observer for with fast friction estimation,” IEEE Trans. on Automation.
force control,” IEEE Trans. on Industrial Electronics, vol. Science Engineering, vol. 13, no. 3, pp. 1399-1408, July
54, no. 1, pp. 530-538, February 2007. 2016.
[12] M. Rakotondrabe, C. Clévy, K. Rabenorosoa, and K. Ncir, [25] J. Huang, S. Ri, L. Liu, Y. Wang, J. Kim, and G. Pak, “Non-
“Force estimation and control of an instrumented platform linear disturbance observer-based dynamic surface control
dedicated to automated micromanipulation tasks,” Proc. of of mobile wheeled inverted pendulum,” IEEE Trans. Con-
IEEE Conf. on Automation Science and Engineering, pp. trol System Technology, vol. 23, no. 6, pp. 2400-2407,
722-727, 2010. November 2015.
Disturbance Observer-based Trajectory Following Control of Robot Manipulators 211