Professional Documents
Culture Documents
Aghil Jafari and Jee-Hwan Ryu Mehdi Rezaei and Reza Monfaredi
School of Mechanical Engineering Department of Mechanical Engineering
Korea University of Technology and Education Amirkabir University of technology
Cheonan, Rep. of Korea, 303-708 Tehran, Iran
Email: Jafari_ aghil@kut.ac.ir.j hryu@kut.ac.kr Email: smrezaei@aut.ac.ir.reza_monfaredi@aut.ac.ir
Abstract-In the present paper, the objective of hybrid strategies have been suggested for different implementations,
impedance control is specified and a robust hybrid impedance most of which are based on linear model of the system
control approach is proposed. Based on the concept of hybrid dynamics. Some robust hybrid control methods are presented
control, the task space is decomposed into position and force in [1,7,10], but the implementations of these controllers are
controlled subspaces. Impedance control is used in the position
difficult in practical applications because there are acceleration
controlled subspace. Desired inertia and damping are applied in
terms or derivative of force signals in their control laws. Also
the force controlled subspace to meliorate the dynamic behavior
of robot manipulator. Robust controller using the variable struc
robust implementations of hybrid impedance control by using
ture model reaching control (VSMRC) is introduced that can adaptive control are considered in [10-13]. As pointed out in
realize the objective impedance in the sliding mode in finite time. [14], an assumption is made that the system parameters' rate
In order to overcome the chattering ef1"ect due to sliding mode of change is much lower than the rate of adjustment of the
approach, fuzzy logic methodology is employed in the control controller gain. This limits the rate at which the manipulator
system. In addition, the reaching transient response is undertaken can maneuver. In [10,15,16], some adaptive control schemes
with prescribed quality. Simulating the control system for a 6DOF for a rigid robot manipulator were extended to achieve robust
PUMA560 robot confirms the validity and effectiveness of the impedance control against both uncertainties of parameters and
proposed control system.
external disturbance. Nevertheless, the transient analysis of
Keywords-Hybrid Control, Sliding Mode Control, Impedance adaptive system is still in its infancy, and few significant results
Control, Robust Control. are available.
{
comparing to the latest research in the field and the controller is
r = Jrx + Vt = Jqq + Vt (5)
simple in the structure yet. In order to overcome the chattering
effects, fuzzy logic engine for reaching phase and fuzzy sliding where
mode control strategy is proposed. The robust behavior of r(x,t)
the system is the other advantage of this method. The next
Jr - o ox Jr = [/;1 J7.;, ]
priority of the proposed approach is that the performance Jrf E Rmxn Jrp E R (n -m)xn
r(x( q),t) (6)
of the controller is improved in the sense of removing the Jq - o oq Jq = JrJ
_ or(x,t)
chattering in comparison with the traditional sliding mode
Jq, Jr E Rn xn Vt - ----at
controller technique using boundary layer. Furthermore, the
reaching transient response is also guaranteed with prescribed Using the transformation (4) and (5) in (1), multiplying both
quality. Simulation results of a 6DOF PUMA560 robot are sides by J;;T, dynamic equation (1) can be presented in terms
presented to illustrate the performance of the proposed method. of the task space variable r as
Simultion sudy ad experimental results illustrate validty of the
suggsted contr scheme.
Mr(r, t)r+Cr(r, r, t)r+Gr(r, t)+F t+F(r, t) = Tr-Fr (7)
where
This paper is organized as the followings. Section (II)
addresses the robot manipulator model and its main properties. Mr(r, t) = J;;T M(q)J;;l
The specification of the objective impedance, the proposed Cr(r, r, t) =! TC(q, q)J;;l - J;;TM(q)J;;ljqJ;;l
i
controller are given in section (III). Simulation results are pre Gr(r, t) = Jq G(q)
sented in Section (IV), and explanatory results as conclusion
F(r, t) = J;;TF(t)
are given in Section (V).
F t =-Mr(r, t)Vt - Cr(r, r, t)Vt
Fr = J;TF
II. DYNAMIC EQUATIONS OF THE SYS TEM Tr = J;;TT
(8)
The dynamic equation of a general nonredundant rigid-link Let in represent the normal contact force control parameter.
manipulator having n degrees of freedom can be written as Suppose that the relationship between Fr and in is described
[20] as
(9)
M(q)ij + C(q, q)q + G(q) + JT(q)F + F(t) = T (1)
where L depends on the environment and is the function of un
where q = q(t) is the (nx1) vector of the robot generalized known friction coefficient. It is assumed that the nominal value
coordinates, T is the (nxl) vector of the input control, M (q)
of M(q), C(q, q), G(q) and L are M (q), C(q, q), G(q), Land
is the (nxn) inertia matrix of the manipulator, C(q, q)q is
the modeling errors are bounded as follows:
the (nx1) Coriolis a�d centrifugal vector, G(q) is the (nx1)
gravitational vector, F is the external disturbance and F is the I6.M(q) 1 :s; OM(q) 6.M(q) = M(q) - i;f(q)
(nx1) interaction forces/moments exerted by the manipulator I6.C(q, q)1 :s; oc(q, q) 6.C(q, q) = C(q, q) - C(q, q)
on the environment, and J(q) is the manipulator Jacobian
I6.G(q)1 :s; Oc(q) 6.G(q) = G(q) - G (q)
matrix relating joint space velocity to task space velocity,
which is assumed to be non-singular in finite work space n
I6.L I :s; OL 6.L = L - L
I 1
F(t) :s; Op(t)
(lO)
8x(q)
J(q) = (2) where the elements of OM(q), oc(q, q), oc(q), OL and Op(t) are
8q the known boundary values of elements of 6.M(q), 6.C(q, q),
x is the (nxl) position and orientation vector of the end 6.G(q) and 6.L. The modeling errors are accounted for para
effector in the world space. Equation (1) has the following metric uncertainties of the robot manipulator and terms that are
properties Suppose that the environment in undeformation is neglected due to computation efficiency. from (8), the nominal
described by a set of m time-varying hypersurfaces values of Mr(r, t), Cr(r, r, t) and Gr(r, t) are obtained as:
{
A. OBJECTIVE OF THE PROPOSED CONTROL METHOD Based on objective of hybrid impedance control (l7) the
following general objective impedance form, is defined:
{
definite diagonal matrices, the i-th element of the velocity
vector r(t) is obtained solving the equation (15). Kfz must be chosen as:
Kvz = F2-I(MiICd + F2AF2-1 )
Kpz = F2-I(MilKd + F2AF2-1 Fd
(16)
(23 )
Treq = M r(r, t)req+Cr(r, r, t)req+Gr(r, t)+Lfn +Ft- Dss Tfs FSMHIC(ss, 8s) [TfS(1)' Tfs(2)"'"Tfs(n)(
= =
(27)
For the stability analysis, a Lyapunov function is defined as:
= [FSMHIC(sS(l), 8s(1»),"" FSMHIC(ss (n), 8s(n»)]T
1
V = 2"ssT Mr(r, t)ss (28)
Tdf [Tdf(1),Tdf(2),...,Tdf(n)(
=
V. = Ss
T .
Mrss
1
+ 2"ssT Mrss
.
(29)
variables Ss(i) and8s(i) are chosen as triangular functions,
and the membership functions of the output linguistic variable
where
1, i= ... , n
�
�
=
� 0.6
oT OMr (r, t) li'eq I + oCr (r, r, t) Ireq l + OGr (r, t)+
=
E
op(r, t) + OFt + oL lfn l ."
sgn(ss ) = [sgn(sSl),' ", sgn(ssn)V E >0
{I, forss i >0
sgn(SSi) = 0, forss i = 0
- 1, forss i < 0
(31)
Using the above mentioned controller and closed loop system
dynamics, the derivative of the Lyapunov function becomes as
following
(32)
Fig. 1. Membership function of input variables Tf
Using Barbalat's lemma [24], the states of the system ap
8
proache to the hyper plane and the error vector asymptotically The process is decomposed into seven fuzzy partitlOnS
converges to zero while the system states are on Ss = O. expressed as "positive big" (PB),"positive medium" (PM),
"positive small" (PS), "zero" (ZE), "negative small" (NS),
"negative medium" (NM) and "negative big" (NB). The fuzzy
rule table is designed as in Table 1.
C. CHATTERING-FREE FUZZY SLIDING MODE HYBRID D. ROBUST STABILITY AND CONVERGENCE ANALYSIS
IMPEDANCE CONTROLLER
Based on the Iyaponov function (28), the following can be
obtained
In this section, in order to overcome the chattering prob
lems, a fuzzy inference engine for reaching phase and fuzzy
�k� IISs 1 2 :s; V :s; �k: IISs 1 2 (34)
0.8
(3
0.7
Where property 2.4 has been used to eliminate the term
0. 6
1/2ss TM rss owing to the time dependency of inertia matrix.
NO.5
Substituting control torque theorem 3.1 into (35) and noticing
0.4
(34) , yields in:
0.3
{ _ 2.\min(D)
C3 - k"x
(37)
C4= E � Fig. 2. 3D view of PUMA560
a:
setting the right hand side of (39) equal to zero, then it leads '0 -0.04
,.
to
O IE
- .
(40)
-D.[E
.01
IV. SIMULATION RESULTS
In this section the main features of the proposed controller
XofPlane(m)
is illustrated through simulation results on the well-known
6DOF robotic arm PVMA-560, which is a classical 6R serial
manipulator with spherical wrist. The results shown have been Fig. 3. Tracking contour of the manipulator
obtained with the Robotics Toolbox (Release 7.1) for MAT
LAB developed by Corke [25], which includes the kinematic
model of the PUMA-560 robot. 12 ,-----,-----,
Iv\t\J1 :1 U,. , I
and force contro for robotic manipulator with kinematics and dynamics
uncertainties, Int. J. ELSEVIER, Automatica, Volume 39, Issue 5, Pages
847-855, May 2003.
: :
o 2 4 6 8 10 12 14 16 18 lJ 0 2 4 6 8 10 12 14 16 18 !I
Mechanism and Machine Theory, Volume 35, Issue 9, Pages 1183-1196,
H==m=1
: : � " tIErTI1
Time(s) TllIr e(s)
1 September 2000.
lime(s) Time(s) [6] Z. Lt, W. CHENA, J. Luo, Adaptive compliant force-motion control
I:·t · ·. · · · · .· · • • • ··.· · .· · 1·
of coordinated non-holonomic mobile manipulators interacting with
unknown non-rigid environments, Int. J. ELSEVIER, Neurocomputing,
�
, .. . . Volume 71, Issues 7-9, Pages 1330-1344, March 2008.
[2 -
[7] G.J. LIU, A . A . GOLDENBERG, Robust Hybrid Impedance Control of
�O "'- ,
. . . . . .• . .. .. •. ........•. .......
, . . .
of the controller when the robot approaches and contacts a stiff [19] B. YAO, S. P. CHAN, AND D. WANG, A unified approach to vari
able structure control of robot manipulators, American Control Conf.
environment.
(Chicago), pp. 1482-1486, 1992.
[20] S.P.CHAO, B. YAO,W.B. GAO, Robust impedance control of robot ma
ACKNOWLEDGMENT nipulator, International Journal of Robotics and Automation, Vol, 6, No.
4, 1991.
This work was supported partly by the R&D program of
[21] V. I. UTKIN, Discontinuous control systems state of art in theory and
the Korea Ministry of Knowledge and Economy (MKE) and
application, 10th IFAC World Congress (Munich), pp. 2744,1987.
the Korea Institute for Advancement of Technology (KIAT).
[22] S. P. CHAN, W. B. GAO, Variable structure model reaching control
(Project: 3D perception and Robot Navigation Technology for strategy for robot manipulators, IEEE Inf. Conf. Robotics and Automation
Unstructured Environment, M002300090) , 1989.