Escolar Documentos
Profissional Documentos
Cultura Documentos
Sara Fateh
Department of Electrical and Robotic Engineering, Shahrood University of Technology, Shahrood 3619995161, Iran
Abstract: Fuzzy control of robot manipulators with a decentralized structure is facing a serious challenge. The state-space model
of a robotic system including the robot manipulator and motors is in non-companion form, multivariable, highly nonlinear, and
heavily coupled with a variable input gain matrix. Considering the problem, causes and solutions, we use voltage control strategy and
convergence analysis to design a novel precise robust fuzzy control (PRFC) approach for electrically driven robot manipulators. The
proposed fuzzy controller is Mamdani type and has a decentralized structure with guaranteed stability. In order to obtain a precise
response, we regulate a fuzzy rule which governs the origin of the tracking space. The proposed design is verified by stability analysis.
Simulations illustrate the superiority of the PRFC over a proprotional derivative like (PD-like) fuzzy controller applied on a selective
compliant assembly robot arm (SCARA) driven by permanent magnet DC motors.
Keywords:
Precise performance, fuzzy control, robot manipulator, voltage control strategy, convergence analysis, stability analysis.
Introduction
M. M. Fateh and S. Fateh / A Precise Robust Fuzzy Control of Robots Using Voltage Control Strategy
Modeling
The dynamics of manipulator[20] is expressed as
D ( ) + C ( , ) + g ( )= r f ( )
(1)
+ r r = m
z =
z 1 = x1
z 2 = x2
Jr 1 + rD
x1 ))1f 2
z 3 = (Jr
rD(x
z 1 = z 2
z 2 = z 3
z 3 = h (zz 1 , z 2 , z 3 )+
Jr 1 + rD
x1 ))1K m L 1 (
+ u)
(Jr
rD(x
1
d 1
h1 ) +
Jr + D (zz 1 )
(h
h (zz 1 , z 2 , z 3 ) =
dt
1
d 1
h1 ) +
Jr + D (zz 1 )
(h
dt
1
1
Jr + rD
rD(zz 1 )
rrC (zz 1 , z 2 )zz 2 h 2
1
1 1 1
Jr + rD
rD(zz 1 )
L R Jr + rD
rD(zz 1 ) z 3 + h 1
1
1
Jr + rD
rD(zz 1 )
K m L 1K b r 1z 2
1
rC
h 1 = Br +rC
rC(zz 1 , z 2 ) z 2 + rg
rg(zz 1 ) + r f (zz 2 )
1
h 2 = Br + rC
rC(zz 1 , z 2 ) z 3 rg (zz 1 ) r f (zz 2 ). (10)
(4)
(6)
x2
1
x) = Jr 1 + rD
f (x
x1 )
f2 ,
rD(x
L1 K b r 1x 2 + Rx 3
L
x = , b = 0
1
L
Ia
1
rC
x1 , x 2 ) x 2 rg
x1 ) r f (x
x2 ) + K m x 3 .
f 2 = Br +rC
rC(x
rg(x
(7)
The state-space equation (6) shows a highly coupled nonlinear multivariable system in the non-companion form. The
robot modeling and control is facing a serious challenge
due to the complexity of the model. Many works have
(9)
where
KmIa = m
(8)
which results in
(3)
(2)
65
1
+ u ) . (11)
= h ( , , ) + Jr 1 + rD
rD( )
K m L 1 (
Since D ( ), J , r , K m and L are positive definite matrices,
Jr 1 + rD
(Jr
rD(zz 1 ))1 K m L1 6= 0. Thus, the companion form
(9) proves that the robotic system is controllable. However,
the companion form is highly nonlinear, heavily coupled and
computationally extensive.
66
0,
e60
2e2 ,
0 6 e 6 0.5
P (e) =
1 2(e 1)2 ,
0.5 6 e 6 1
1,
e>1
1,
e 6 1
2e2 ,
0.5 6 e 6 0
0,
e>0
e2
Z (e) = exp 2 , = 0.3.
2
e in Fig. 1.
Fig. 1
To define the membership functions of output, we consider the maximum voltage of motor, umax , that is 42 V
in this study. Then, we arrange the membership functions
to cover the range of output in [42, 42]. The membership
functions of output u are named as positive high (PH), positive medium (PM), positive small (PS), zero (Z), negative
small (NS), negative medium (NM) and negative high (NH).
They are expressed as
(u 42)2
PH (u) = exp
32
(u 28)2
PM (u) = exp
32
(u 14)2
PS (u) = exp
32
(u y5 )2
Z (u) = exp
32
(u + 14)2
NS (u) = exp
32
(u + 28)2
NM (u) = exp
32
(u + 42)2
NH (u) = exp
.
(13)
32
Fuzzy rules: Assigning three membership functions to
each fuzzy input, the whole control space is covered by nine
fuzzy rules. The linguistic fuzzy rules are proposed in the
form of Mamdani type as
Rule l : If e is Al and e is Bl , then u is Cl
(12)
(14)
67
M. M. Fateh and S. Fateh / A Precise Robust Fuzzy Control of Robots Using Voltage Control Strategy
3.1
Convergence analysis
(15)
as
umax ,
R
y5 = kp e + ki edt,
umax ,
if
if
if
R
kp e + ki Re dt >
umax
kp e + ki e dt < umax
R
kp e + ki e dt < umax
(17)
(16)
u=
9
X
yl l (e, e)
= yT (e, e)
(18)
l=1
The following laws are suggested to direct the error trajectory toward the origin according to the convergence analysis:
1) The control effort u has the same sign as e.
2) A small control effort is sufficient in the convergequarters Q2 and Q4 .
3) A medium control effort is sufficient when passing from
Q2 to Q1 , and from Q4 to Q3 .
4) A high control effort is required in the diverge-quarters
Q1 and Q3 .
5) The control effort must change the sign of e to negative
in Q1 for going into Q4 .
6) The control effort should change the sign of e to positive in Q3 for moving in Q2 .
Using (12), (13) and (14), based on the convergence analysis, we define fuzzy rules in Table 1.
Table 1
Fuzzy rules
Rule l
Al
Bl
Cl
PH
PM
PS
PM
NM
NS
NM
NH
In order to obtain a precise tracking, Rule 5 which governs the vicinity of origin should be fine-tuned. Center of
zero fuzzy set of output u is regulated to reduce the tracking error. An ordinary proportional-integral (PI) controller
equipped by a saturation unit is proposed to fulfill this role
i
28
14
28
42
(19)
h
where y5 is expressed in (17), =
is a positive value expressed as
l (e, e)
=
1 ,
Al (e)Bl (e)
9
P
Al (e)Bl (e)
iT
, l
(20)
l=1
3.2
Stability analysis
(21)
(22)
(23)
68
(24)
(u ()) Ia d =
0
RIa2 d +
0
a d.
kb r1 I
(25)
a d.
kb r1 I
a d 6
kb r1 I
(u ()) Ia d.
(27)
Rt
a d
Thus, the upper bound of mechanical energy 0 kb r1 I
is given by
Z t
Z t
a d =
(u ()) Ia d.
(28)
kb r1 I
0
R
t
0
a d
kb r1 I
dt
R
t
0
(u ()) Ia d
dt
kb r
a = (u (t)) Ia .
I
Therefore, is limited as
1
6 kb r (|u| + |(t)|) .
(30)
for l = 1, , 9.
LIa = w RIa .
(37)
(38)
V = e d .
One can easily show from (22) that
9
!
X
1
yl l (e, e)
RIa LIa (t) .
= K r
b
(39)
l=1
l=1
(40)
To establish the convergence, we should satisfy V < 0.
To satisfy V < 0 in (40), it is required that
9
X
yl l (e, e).
(32)
(33)
(41)
l=1
(31)
We ensure (32) by considering that the membership functions 0 6 Al (e) 6 1 and 0 6 Bl (e)
6 1 for l = 1, , 9.
Thus, l (e, e)
in (20) is bounded. The membership func can be defined such that
tions of inputs, Al (e) and Bl (e),
= 1 for P
l = l1 , then l (e, e)
= 0 for l 6= l1 .
if l1 (e, e)
9
= 1.
y
(e,
e)
=
y
Consequently u =
l
l
l
1 if l1 (e, e)
l=1
Therefore, in order to satisfy |u| 6 umax , it is required to
select yl such that
|
yl | 6 umax
(29)
(36)
Hence,
1
w = u kb r1 (t).
Thus,
d
(35)
(26)
RIa + LIa = w
where
LIa Ia d+
P9
Since l (e, e)
and yl are bounded, u =
yl
l=1 l (e, e)
will be bounded.
Substituting (23) and (32) into (31) yields
1
(34)
6 kb r (umax + max ) = max
1
(42)
RIa + LIa + kb r d + (t) 6 (t) < umax
where (t) is a positive scalar. Using Cauchy-Schwartz inequality and (42), it follows that
(43)
69
M. M. Fateh and S. Fateh / A Precise Robust Fuzzy Control of Robots Using Voltage Control Strategy
9
X
yl l (e, e).
(44)
l=1
9
X
is stable if gains kp and ki are positive. However, the tracking error depends on (t),
4
yl l (e, e)sgn(e)
(45)
l=1
e
. As mentioned above, if l1 (e, e)
= 1
where sgn(e) = |e|
for l =
l
=
0
for
l
6= l1 .
1 then for l 6= l1 , then l (e, e)
P
Thus 9l=1 yl l (e, e)
= yl1 . As a result, if l1 (e, e)
= 1, the
convergence is guaranteed using
(46)
Thus,
The proposed controller (18) has been developed by improving the PD-like fuzzy controller. Therefore, we prefer
to compare it with the PD-like fuzzy controller to show its
superiority. A decentralized PD-like fuzzy controller in the
form of Mamdani type using VCS is designed. The PD-like
fuzzy controller has two inputs of e and e and the output
u. Three membership functions of P, Z and N are given to
each input as shown in Fig. 1 membership functions. The
Gaussian MFs in the form of (13) with the centers of y in
(53) are given to the controller output u.
h
yl1 = (t)sgn(e).
(47)
y =
14
28
28
14
28
42
and
sgn(
yl1 ) = sgn(e).
Z
edt = sgn(e)(t).
(49)
u = yT (k1 e, k2 e),
(48)
R
and kp e + ki edt < umax , from (17) and (47), we can
write
kp e + ki
28
(53)
i
42
(50)
k1 = 100,
k2 = 20
(54)
where k1 and k2 are the input scaling factors which are the
control design parameters.
Simulations
ki e2
V (e) =
.
kp
(51)
< |e| .
ki
(52)
as small as (t)
. In addition, the origin of the tracking space
ki
Fig. 2
70
x i (m)
y i (m)
z i (m)
m i (km)
I xxi (kgm2 )
I yyi (kgm2 )
I zzi (kgm2 )
I xyi (kgm2 )
I xzi (kgm2 )
I yzi (kgm2 )
0.172
2.6
0.0034
0.0043
0.0045
0.0012
0.133
0.111
5.9
0.0240
0.0670
0.0540
0.0066
0.333
1.1
0.0041
0.0041
3.2104
-0.04
0.06
2.2105
2.2105
2.3105
Table 2
The DH parameters
(rad)
d (m)
a (m)
(rad)
a1 = 0.325
a2 = 0.225
d3
d4 = 0.0548
MISE =
Ixxi
Ii = Ixyi
Ixzi
Ixzi
Iyzi .
Izzi
Ixyi
Iyyi
Iyzi
1
T
(55)
(V)
() (Vs/rad)
42
1.6
0.26
Jm
Bm
(H)
0.001
0.0002
0.001
0.1
t
,
2
if
06t<2
if
2 6 t < 4.
(56)
Fig. 3
Controller gains
Controller 1
Controller 2
Controller 3
kp
5 000
5 000
5 000
4 000
ki
2 0000
2 0000
2 0000
2 0000
Controller 4
(57)
Fig. 4
M. M. Fateh and S. Fateh / A Precise Robust Fuzzy Control of Robots Using Voltage Control Strategy
71
with guaranteed stability and high accuracy tracking performance in a decentralized structure. The error and its
derivative are the only feedbacks required for the proposed
control law. Simulation results show the effectiveness of the
proposed PRFC. It is superior to the PD-like fuzzy controller as presented through comparisons.
Fig. 5
Simulation 2. The decentralized PD-like fuzzy controller (54) is simulated. The same external disturbance
as used in Simulation 1, is inserted to the control system.
The performance of the PD-like fuzzy controller is shown
in Fig. 6. Tracking error for joint 3 at the end is about
3.1 103 m. This value is about 837 times greater than
the one in the PRFC. The MISE of the PD-like fuzzy controller is about 1.337 105 . This value is about 163 times
greater than its value in the PRFC. The control efforts behave well under disturbance as shown in Fig. 7. Performance of the decentralized PD-like fuzzy controller is quite
good. However, the performance of the decentralized PRFC
is much better.
Conclusions
The decentralized PRFC of electrically driven robot manipulators has been proposed using voltage control strategy
and convergence analysis. This design is important from
a control point of view that the state-space model of the
robotic system including robot manipulator and motors is
in non-companion form, multivariable, highly nonlinear and
heavily coupled with a variable input gain matrix. The
proposed decentralized PRFC is simple, model-free, robust
References
[1] Y. L. Shen, W. J. Cai, S. Y. Li. Multivariable process control: Decentralized, decoupling, or sparse. Industrial & Engineering Chemistry Research, vol. 49, no. 2, pp. 761771,
2010.
[2] S. H. Hsua, L. C. Fua. A fully adaptive decentralized
control of robot manipulators. Automatica, vol. 42, no. 10,
pp. 17611767, 2006.
[3] Q. Zhu, A. G. Song, T. P. Zhang, Y. Q. Yang. Fuzzy adaptive control of delayed high order nonlinear systems. International Journal of Automation and Computing, vol. 9,
no. 2, pp. 191199, 2012.
[4] B. K. Yoo, W. C. Ham. Adaptive control of robot manipulator using fuzzy compensator. IEEE Transactions on Fuzzy
Systems, vol 8, no. 2, pp. 186199, 2000.
[5] K. C. Chiou, S. J. Huang. An adaptive fuzzy controller for
robot manipulators. Mechatronics, vol. 15, no. 2, pp. 151
177, 2005.
[6] E. Kim. Output feedback tracking control of robot manipulators with model uncertainty via adaptive fuzzy
logic. IEEE Transactions on Fuzzy Systems, vol. 12, no. 3,
pp. 368376, 2004.
[7] J. P. Hwang, E. Kim. Robust tracking control of an electrically driven robot: Adaptive fuzzy logic approach. IEEE
Transactions on Fuzzy Systems, vol. 14, no. 2, pp. 232247,
2006.
[8] R. J. Wai, P. C. Chen. Intelligent tracking control for
robot manipulator including actuator dynamics via TSKtype fuzzy neural network. IEEE Transactions on Fuzzy
Systems, vol. 12, no. 4, pp. 552560, 2004.
[9] Y. W. Cho, K. S. Seo, H. J. Lee. A direct adaptive fuzzy
control of nonlinear systems with application to robot manipulator tracking control. International Journal of Control,
Automation, and Systems, vol. 5, no. 6, pp. 630642, 2007.
[10] L. Cheng, Z. G. Hou, M. Tan. Adaptive neural network
tracking control for manipulators with uncertain kinematics, dynamics and actuator model. Automatica, vol. 45,
no. 10, pp. 23122318, 2009.
72
[11] Z. G. Hou, A. M. Zou, L. Cheng, M. Tan. Adaptive control of an electrically driven nonholonomic mobile robot
via backstepping and fuzzy approach. IEEE Transactions
on Control Systems Technology, vol. 17, no. 4, pp. 803815,
2009.
[12] F. Nagata, K. Watanabe. Adaptive learning with large variability of teaching signals for neural networks and its application to motion control of an industrial robot. International Journal of Automation and Computing, vol. 8, no. 1,
pp. 5461, 2011.
[13] M. M. Fateh. On the voltage-based control of robot manipulators. International Journal of Control, Automation, and
Systems, vol. 6, no. 5, pp. 702712, 2008.
[14] M. M. Fateh. Robust fuzzy control of electrical manipulators. Journal of Intelligent and Robotic System, vol. 60,
no. 34, pp. 415434, 2010.
[15] M. M. Fateh. Robust voltage control of electrical manipulators in task-space. International Journal of Innovative Computing, Information and Control, vol. 6, no. 6, pp. 2691
2700, 2010.
[16] M. M. Fateh. Robust control of flexible-joint robots using
voltage control strategy. Nonlinear Dynamics, vol. 67, no. 2,
pp. 15251537, 2012.
[17] M. M. Fateh. Nonlinear control of electrical flexible-joint
robots. Nonlinear Dynamics, vol. 67, no. 4, pp. 25492559,
2012.
[18] M. M. Fateh, H. A. Tehrani, S. M. Karbassi. Repetitive control of electrically driven robot manipulators. International
Journal of Systems Science, 2011. (Online first).
[19] M. M. Fateh, S. Khorashadizadeh. Robust control of electrically driven robots by adaptive fuzzy estimation of uncertainty. Nonlinear Dynamics, vol. 69, no. 3, pp. 14651477,
2012.
[20] M. W. Spong, S. Hutchinson, M. Vidyasagar. Robot Modeling and Control, Hoboken, NJ, USA: John Wiley & Sons,
2006.