This paper presented the modeling of a parallel robot driven by DC motors. The equations of motion for parallel manipulator were derived by using the redundant generalized
coordinates and the Lagrangian multipliers. Moreover, the dynamics of DC motors were
also integrated in the whole models of the system. The obtained model in this study included electric and mechanical parts, so it described better a mechanical system that is
driven by electric motors such as parallel manipulators. The equations of motion in DAEs
form were then transformed to ODE form of task space variables for the control design. The
sliding mode controllers in the task space has been proposed for the manipulator. Simulation results have shown that the controller is effective for trajectory control of the parallel
manipulator.
13 trang |
Chia sẻ: huongthu9 | Lượt xem: 536 | Lượt tải: 0
Bạn đang xem nội dung tài liệu Sliding mode control for a planar parallel robot driven by electric motors in a task space, để tải tài liệu về máy bạn click vào nút DOWNLOAD ở trên
Journal of Computer Science and Cybernetics, V.33, N.4 (2017), 325–337
DOI 10.15625/1813-9663/33/4/10339
SLIDING MODE CONTROL FOR A PLANAR PARALLEL ROBOT
DRIVEN BY ELECTRIC MOTORS IN A TASK SPACE
NGUYEN QUANG HOANG1, VU DUC VUONG1,2
1School of Mechanical Engineering, Hanoi University of Science and Technology
2Faculty of Electronics Engineering, Thai Nguyen University of Technology
1hoang.nguyenquang@hust.edu.vn
Abstract. This paper addresses the modeling of a planar parallel robot including electric motors.
The dynamic model of the system is derived by applying the substructure method and Lagrangian
equations with multipliers in the form of redundant generalized coordinates. These equations are then
transformed to the form of minimal coordinates of operational variables. Based on this form, a sliding
mode controller (SMC) is designed for trajectory tracking in a task space. Numerical simulations in
MATLAB are carried out based on the 3RRR parallel robot in order to show the effectiveness of the
proposal approach. The obtained results show a good behavior of the proposed task space tracking
controller.
Keywords. parallel robot, electromechanical system, dynamic modeling, sliding mode control.
1. INTRODUCTION
Nowadays, parallel robotic manipulators are used widely in industrial applications due
to their advantages such as high stiffness, accuracy, and light links. This kind of robots has
attracted numerous researchers. Many of them deal with the modeling of parallel manipu-
lators [4, 8]. In many work such as [1, 2] the parallel manipulators are modeled by a closed
loop rigid multibody system driven directly by torques/forces. To establish the dynamic
equations of a parallel robot, there are some approaches proposed in literature including
Lagrangian formulation with multipliers, Newton-Euler equations, the principle of virtual
work, the Jourdain principle, and Kane equation such as in [2, 3, 6-8, 13, 14]. In general,
manipulators are driven by electric motors with gear transmission, therefore the dynamic
of actuators should be considered. The modeling of electromechanical systems of a parallel
robotic manipulator has been examined by only some researchers [19-21].
Besides modeling, the control design of parallel manipulators is also an important prob-
lem. Similarly to serial manipulators, many control laws such as PD plus gravity compensa-
tion, exact feedback linearization, sliding mode, adaptive, fuzzy and neural network are also
exploited to design controllers for parallel manipulators. Several authors have designed con-
trollers for the robot in active joint coordinates [9-11, 17, 18]. This design method required
solving the inverse kinematic problem.
In this study, the substructure method is applied in the modeling of a parallel manip-
ulator driven by electric motors. The whole system is divided into three parts: actuators,
c© 2017 Viet Nam Academy of Science & Technology
326 NGUYEN QUANG HOANG, VU DUC VUONG
massless gear transmissions, and manipulator as a closed loop multiboby system. The dy-
namic equations of electric actuators are derived, mainly based on the angular momentum
law combined with Kirchoff’s laws. The equation describing a massless gear transmission is
obtained by the power balance at the input and output of the gearbox. For the closed loop
multiboby system, the redundant generalized coordinates and the Lagrangian formulation
with multipliers are used to establish the equations of motion [1, 2, 4]. Being combined with
the constraint equations, the dynamic model of a parallel robot is presented in a form of
differential-algebraic equations (DAEs). The obtained equations are then simplified with the
assumption that an electric time constant is much smaller than a mechanical time constant.
Moreover, to design the controller for the robot the simplified equations in a DAEs form are
then converted into the form of minimal coordinates of operational variables.
The rest of this paper is organized as follows: Section 2 presents a dynamical modeling
of parallel manipulator actuated by electric motors and the transformation of the differential
equations into the minimal form in space of operational coordinates. The controller design
in task space is described in Section 3. Some numerical simulations are shown in Section 4.
Finally, the conclusion is given in Section 5.
2. DYNAMICAL MODEL
2.1. Equations of motion of a parallel robot driven by electric motors
Let us consider the parallel robot having n degrees of freedom driven by n electric motors
as shown in Fig. 1. For governing the equations of motion, the symbols and notations in
Table 1 will be used.
Figure 1. Model of an electric motor with gearbox and a 3RRR parallel robot
The system dynamic model is derived by applying Lagrangian equation with multipli-
ers and the substructure method. The three mentioned substructures are described by the
following equations: Dynamics of actuators is described by the mechanical and electric equa-
tions as [15, 16].
SLIDING MODE CONTROL FOR A PLANAR PARALLEL ROBOT... 327
Table 1. The generalized coordinates and parameters of the system
Order Notations Name
1 θ = [θ1, θ2, ..., θn]
T =: qa Active joint variables
2 β = [β1, β2, ..., βl]
T Auxiliary variables (unactuated joint)
3 x = [x1, x2, ..., xn]
T Position of moving platform
4 p = [βT ,xT ]T Combination of auxiliary and moving plat-
form variables
5 q = [θT ,βT ,xT ]T Redundant coordinates
6 λ = [λ1, λ2, ..., λr]
T Lagrangian multipliers
7 r = ri = θm,i/θi Gear reduction ratio
8 θm = [θm1, θm2, ..., θmn]
T Angle of the motor shaft
9 τ 2 = [τ2,1, τ2,2, ..., τ2,n]
T Torque/force at the output of transmission
10 τ 1 = [τ1,1, τ1,2, ..., τ1,n]
T Torque/force at the input of transmission
11 τ 0 = [τ0,1, τ0,2, ..., τ0,n]
T Torque/force of the motor
12 Jm = diag(Jm,1, Jm,2, ..., Jm,n) Moment of inertia of rotors
13 La = diag(La,1, La,2, ..., La,n) Motor coil inductances
14 Ra = diag(Ra,1, Ra,2, ..., Ra,n) Motor coil resistances
15 Ke = diag(Ke,1,Ke,2, ...,Ke,n) Back-emf constants
16 Km = diag(Km,1,Km,2, ...,Km,n) Torque constants
17 u = [U1, U2, ..., Un]
T Motor input voltages
18 i = [i1, i2, ..., in]
T Current in motors
19 Dm = diag(b1, b2, ..., bn) Viscous friction coefficients of motor shafts
Jmθ¨m +Dmθ˙m = τ 0 − τ 1. (1)
La
di
dt
+Rai = u− ue. (2)
The mechanical and electric interaction in DC motors is shown by the relationship be-
tween current and motor torque; between motor speed and EMF’s voltages as follows
τ 0 = Kmi, ue = Keθ˙m. (3)
For the gear transmission, by neglecting the mass and power loss, the constraint equations
are written as follows
rq˙a = rθ˙ = θ˙m, (4)
τ 2 = rτ 1. (5)
For a closed loop multibody system the redundant generalized coordinate will be used
and the dynamic equation is described in form of DAEs as follows
M(q)q¨ +C(q, q˙)q˙ + g(q) +Dq˙ + ΦT (q)λ = Bτ 2, (6)
328 NGUYEN QUANG HOANG, VU DUC VUONG
φ(q) = 0, (7)
where M(q) is the mass matrix; g(q) the potential generalized force vector; Dq˙ is the vector
of generalized forces of non-conservative forces (linear damping force); φ(q) = 0 is the vector
of constraint equations; Φ(q) = ∂φ/∂q is the Jacobian matrix; B = [En×n,0Tm−n,n]T is the
matrix related to the control input arrangement; the coriolis and centrifugal matrix C(q, q˙)
can be determined from the mass matrix by using the Christoffel formula [2].
Normally, the electric time constant is much smaller than mechanical time constant, so
the approximation Ladi/dt ≈ 0 when t ≥ ε > 0 can be used to simplify the system of
differential equations describing the system. After some calculations one gets(
M(q) +BJmr
2Z
)
q¨ +C(q, q˙)q˙ + g(q)
+
(
D +B(Dm +KmR
−1
a Ke)r
2Z
)
q˙ = BK
m
R−1a ru+ Φ
T
q (q)λ
(8)
in which the matrix Z = [En×n,0n,m−n] has been used. By defining the following matrices
Bs(q) =
(
M(q) +BJmr
2Z
)
, Cs(q, q˙) = C(q, q˙)
Ds =
(
D +B(Dm +KmR
−1
a Ke)r
2Z
)
gs(q) = g(q), Bs = BKmR
−1
a r
the equation (8) is rewritten in a compact form as
M s(q)q¨ +Cs(q, q˙)q˙ +Dsq˙ + gs(q) = Bs(q)u+ Φ
T
q λ. (9)
Noting that BJmr
2Z is a constant matrix, so the Coriolis matrices Cs(q, q˙) or C(q, q˙)
calculating from mass matrices M s(q) or M(q) are the same, and the skew-symmetric
property of matrix N = M˙ s(q)− 2Cs(q, q˙) is remained.
Thus, the dynamic model of a planar parallel robot driven by electric motors is described
by a set of differential algebraic equations (9) and (7). These equations show the dynamic
relationship between input (voltage u) and output (motion q(t) including the motion of
moving platform x(t)). These will be used for the inverse and forward dynamic problems of
parallel robots.
2.2. Equations of motion in a minimal coordinate form in a task space
The equations of motion in a redundant generalized coordinates form are convenient for
deriving it as well as simulation. To design a controller in a task space, the equations need
to be transformed to minimal coordinates form of operational variable x with a number of
equations equal to the degrees of freedom. By differentiating (7) with respect to time (w.r.t.)
one gets
Φq(q)q˙ = Jyy˙ + Jxx˙ = 0, with y = [θ
T ,βT ]T . (10)
Assuming that Jacobian matrix Jy(q) = ∂φ/∂y is regular. From (10), after some calcu-
lations one gets
q˙ = Rxx˙. (11)
Here matrix Rx(q) ∈ Rm×n is defined by
Rx =
[ −J−1y Jx
E
]
. (12)
SLIDING MODE CONTROL FOR A PLANAR PARALLEL ROBOT... 329
By differentiating (12) w.r.t. time one gets
q¨ = Rxx¨+ R˙xx˙. (13)
Noting that matrix Rx(q) defined by (12) satisfies the following formula
ΦqRx = 0 or R
T
xΦ
T
q = 0. (14)
To eliminate multipliers λ in equation (9) one premultiplies it from link with RTx
RTx [M s(q)q¨ +Cs(q, q˙)q˙ +Dsq˙ + gs(q)] +R
T
xΦ
T
q (q)λ = R
T
xBsu. (15)
In order to get the equation of motion in minimal coordinates, substituting q˙, q¨ defined
from (11) and (13) into (15), one obtains
Mx(x)x¨+Cx(x, x˙)x˙+Dxx˙+ gx(x) = R
T
xBsu =: τ x (16)
where
Mx(x) = R
T
xM s(q)Rx, Cx(x, x˙) = R
T
x (Cs(q, q˙)Rx +M s(q)R˙x),
Dx(x) = R
T
xDsRx, gx(x) = R
T
x gs(q).
In equation (16) the following properties are still guaranteed: Mx(x) is a symmetric and
positive definite matrix and Nx = [M˙x(x)− 2Cx(x, x˙)] skew-symmetric matrix [5]. These
properties are important for control design in the next section.
3. DESIGN OF A SLIDING MODE CONTROLLER IN A TASK SPACE
The objective of the control problem is to find the law of the motor voltage so that the
motion of the mobile platform tracks the given trajectory defined by xd(t). The basis for
the design of controller in a task space is the equation (16). To design a controller based on
sliding mode, the sliding surface is chosen as follows
s = e˙x(t) + Λex(t), Λ = diag([λ1, λ2, ...λn]) > 0, (17)
with the tracking error ex(t) = x(t)− xd(t). Defining
x˙r = x˙d(t)−Λex(t), s = x˙− x˙r, s˙ = x¨− x¨r. (18)
To find a control law, a Lyapunov candidate function is chosen as
V =
1
2
sTMx(x)s. (19)
Differentiating this function w.r.t. time, one gets
V˙ = sTMx(x)s˙+
1
2
sTM˙x(x)s. (20)
From (16), (18) and the skew-symmetric property of M˙x − 2Cx ones obtains
V˙ = sT [τ x −Cx(x, x˙)x˙r −Dx(x)x˙− gx(x)−Mx(x)x¨r]. (21)
330 NGUYEN QUANG HOANG, VU DUC VUONG
The formula (21) suggests to choose a control law as
τ x = Mˆx(x)x¨r + Cˆx(x, x˙)x˙r + Dˆx(x)x˙r + gˆx(x)−Kpds−Ks sgn(s) (22)
where Mˆx(x), Cˆx(x, x˙), Dˆx(x), gˆx(x) are the estimators ofMx(x), Cx(x, x˙), Dx(x), gx(x),
sgn(s) = [sgn(s1), sgn(s2), ..., sgn(sn) ]
T , Kpd and Ks are the symmetric positive definite
matrices, Kpd = K
T
pd > 0, Ks = K
T
s > 0. For simplicity, these two matrices are selected to
be in diagonal form as
Kpd = diag{k11pd, k22pd, ... , knnpd }, Ks = diag{k11s , k22s , ... , knns }.
Substituting control law (22) into (16) one gets
Mx(x)(x¨− x¨r) +Cx(x, x˙)(x˙− x˙r) +Dx(x˙− x˙r) =
−Kpds−Ks sgn(s) + M˜x(x)x¨r + C˜x(x, x˙)x˙r + D˜xx˙r + g˜x(q)
(23)
or
Mx(x)s˙+Cx(x, x˙)s+Dxs = −Kpds−Ks sgn(s) + dx(x, x˙, x˙r, x¨r), (24)
where system uncertainties are
M˜x(x) = Mˆx(x)−Mx(x), C˜x(x, x˙) = [Cˆx(x, x˙)−Cx(x, x˙)],
D˜x = Dˆx −Dx, g˜x(q) = gˆx(q)− gx(q),
d = M˜x(x)x¨r + C˜x(x, x˙)x˙r + D˜xx˙r + g˜x(q).
From (24) it leads to
Mx(x)s˙ = −Cx(x, x˙)s−Dxs−Kpds−Ks sgn(s) + dx(x, x˙, x˙r, x¨r). (25)
Substituting (25) into (20) one obtains
V˙ = sTMx(x)s˙+
1
2s
TM˙x(x)s
= −sT [Dx +Kpd]s− sT (Ks sgn(s)− dx) + 12sT [M˙x(x)− 2Cx(x, x˙)]s
= −sT [Dx +Kpd]s− sT (Ks sgn(s)− dx).
(26)
Assuming that the system uncertainties are bounded, it means |d| ≤ d0, or |di| ≤ di,0,
with the above selection, one gets
V˙ = −sT [Dx +Kpd]s− sTKssgn(s) + sTd
= −sT [Dx +Kpd]s−
∑n
i=1K
(ii)
s |si|+
∑n
i=1 sidi
≤ −sT [Dx +Kpd]s−
∑n
i=1(K
(ii)
s − |di|)si.
To be sure V˙ ≤ 0, the elements of the matrixKs will be chosen such that Kiis −|di| > 0 or
Kiis > |di| > 0. In control law (22) the discontinuous terms sign(s) can cause the chattering
phenomenon in the system. In order to reduce this effect, the sign(s) function will be replaced
by an approximation (2/pi)atan(ks), k >> 1.
In summary, the control law is determined with the following quantities
s = e˙x(t) + Λex(t), ex(t) = x(t)− xd(t),
x˙r = x˙d(t)−Λex(t),
x¨r = x¨d(t)−Λe˙x(t), s = x˙(t)− x˙r(t),
SLIDING MODE CONTROL FOR A PLANAR PARALLEL ROBOT... 331
τ x = Mˆx(q)x¨r + Cˆx(q, q˙)x˙r + Dˆxx˙+ gˆx(q)−Kpds− 2piKsatan(ks), (27)
u = (RTxBs)
−1τ x. (28)
The control diagram in the task space is given in Fig. 2.
Figure 2. Control diagram
4. NUMERICAL SIMULATIONS
4.1. Stabilization technique in simulation
The numerical simulation of a parallel manipulator requires to solve the DAEs (16) and
(17). In order to solve the DAEs, normally, the constraint equations are derived twice w.r.t.
time to transform the DAEs to ODEs. Because the second order derivative instead of the
constrained equation is used in the simulation, the constraint stabilization is needed. Here
the Baumgarte’s technique is applied in the simulation [12]. The main idea of this approach
is that the constraint in acceleration level, φ¨(q) = 0, is replaced by the following equation
φ¨(q) + 2δω0φ˙(q) + ω
2
0φ(q) = 0, (29)
with two parameters of the method 0 0. Differentiating twice (7) w.r.t.
time, yields
Φq(q)q¨ + Φ˙q(q)q˙ = 0. (30)
So the constraint equation using in simulation derived from (29) will be
Φqq¨ + Φ˙qq˙ + 2δω0Φqq˙ + ω
2
0φ = 0. (31)
Combination with the equation (15), the dynamic model used for simulation of parallel
manipulator becomes
RTx (M s(q)q¨ +Cs(q, q˙)q˙ +Dsq˙ + gs(q)) = R
T
xBsu,
Φq(q)q¨ + Φ˙q(q)q˙ + 2δω0Φq(q)q˙ + ω
2
0φ(q) = 0,
or in the matrix form as follows[
RTxM s(q)
Φq(q)
]
q¨ +
[
RTx [Cs(q, q˙) +Ds]
Φ˙q + 2δω0Φq(q)
]
q˙ +
[
RTx gs(q)
ω20φ(q)
]
=
[
RTxBsu
0
]
. (32)
332 NGUYEN QUANG HOANG, VU DUC VUONG
4.2. Numerical simulations
Some simulations with a 3-DOF planar parallel manipulator which moves in the horizon-
tal plane driven by 3 actuators are implemented. The numerical simulations are carried out
in Matlab. The model of the robot is shown in Fig. 1. The mechanical parameters of the
robot are given as follows [22].
Base: L = 1.2m.
Two links of the legs:
li,1 = 0.581m, mi,1 = 2.072kg, JC1 = 0.13kg.m
2,
li,2 = 0.620m, mi,2 = 0.750kg, JC2 = 0.03kg.m
2,
Platform: a = 0.2m, m7 = 0.978kg, JC7 = 0.007kg.m
2, αi = [
7
6
pi,−1
6
pi,
1
2
pi].
Gear trans: r = 10 (transmission ratio).
DC motor : Jm = 0.01kg.m
2,Km = 3.00Nm/A, Ke = 0.10Vs/rad, Ra = 3.00Ohm.
In order to compare the controller proposed in this paper to an augmented PD controller,
two simulations are carried out. The first one is implemented with the SMC and the second
one is conducted with the augmented PD controller, that is given as
τ x = Mx(x)x¨d +Cx(x, x˙)x˙d +Dx(x)x˙d + gx(x)−Kde˙−Kpe, Kd,Kp > 0. (33)
This control law is driven from a Lyapunov candidate function as
V =
1
2
e˙TMx(x)e˙+
1
2
eTKpe, Kp = K
T
p > 0, e = x− xd. (34)
In two simulations, the center of the platform will be moved along a circular trajec-
tory, while its orientation is constant, ϕ = pi/3[rad]. The trajectory has a center at
(xC , yC) = (0.6, 0.4)[m] and radius R = 0.12[m]. This trajectory is chosen to be in the
work space of the mobile platform. The parameters of two controllers are chosen as
SMC: Λ = 30diag(1, 1, 1), Kpd = 200diag(1, 1, 1), Ks = 0.01diag(1, 1, 1),
PD: Kp = 850diag(1, 1, 1), Kd = 150diag(1, 1, 1).
Additionally, the robot parameters such as masses and moments of inertia used in the
control laws are chosen about 15 − 25% different compared to those that are used in the
dynamic model.
The results are shown in Fig. 3. to Fig. 12. The results show that with the SMC the
motion of the mobile platform tracks the desired trajectory after about 0.22 second (Fig. 7
and 9), while this time is about 1 second with the PD controller (Fig. 8 and 10). The moving
platform errors in position are kept about 10−5 mm and error in angle is kept about 10−5
radian. Fig. 11 and 12 show that the center of mobile platform tracks the desired trajectory
better than the one with the augmented PD controller. These results show the robustness
of the SMC controller.
SLIDING MODE CONTROL FOR A PLANAR PARALLEL ROBOT... 333
Figure 3. Trajactory tracking in a task space
(SMC)
Figure 4. Trajactory tracking in a task space
(PD)
Figure 5. Trajactory tracking of active joint
(SMC)
Figure 6. Trajactory tracking of active joint
(PD)
Figure 7. Tracking errors of x, y coordinates
(SMC)
Figure 8. Tracking errors of x, y coordinates
(PD)
334 NGUYEN QUANG HOANG, VU DUC VUONG
Figure 9. Tracking errors of φ angle (SMC) Figure 10. Tracking errors of φ angle (PD)
Figure 11. The desired path vs. the actual
path of the platform center (SMC)
Figure 12. The desired path vs. the actual
path of the platform center (PD)
5. CONCLUSION
This paper presented the modeling of a parallel robot driven by DC motors. The equa-
tions of motion for parallel manipulator were derived by using the redundant generalized
coordinates and the Lagrangian multipliers. Moreover, the dynamics of DC motors were
also integrated in the whole models of the system. The obtained model in this study in-
cluded electric and mechanical parts, so it described better a mechanical system that is
driven by electric motors such as parallel manipulators. The equations of motion in DAEs
form were then transformed to ODE form of task space variables for the control design. The
sliding mode controllers in the task space has been proposed for the manipulator. Simula-
tion results have shown that the controller is effective for trajectory control of the parallel
manipulator.
SLIDING MODE CONTROL FOR A PLANAR PARALLEL ROBOT... 335
APPENDIX: THE DYNAMIC MODEL OF A 3RRR PARALLEL ROBOT
For this model, the following vectors have been used in Section 2
θ = [θ1, θ2, θ3]
T , β = [β1, β2, β3]
T , x = [xC , yC , ϕ]
T .
Here q = [θ1, β1, θ2, β2, θ3, β3, xC , yC , ϕ]
T .
The equation of motion is derived with the kinetic and potential energy
T (q, q˙) =
1
2
7∑
k=1
(mkv
2
Ck + JCkω
2
k), Π(q) = 0.
The constraint equations of the manipulator are given as follows
φ(q) ≡ φ(θ,β,x) = 0,
xO1 + l1 cos θ1 + l2 cos(θ1 + β1) = xC + b cos(ϕ+ α1),
yO1 + l1 sin θ1 + l2 sin(θ1 + β1) = yC + b sin(ϕ+ α1),
xO2 + l1 cos θ2 + l2 cos(θ2 + β2) = xC + b cos(ϕ+ α2),
yO2 + l1 sin θ2 + l2 sin(θ2 + β2) = yC + b sin(ϕ+ α2),
xO3 + l1 cos θ3 + l2 cos(θ3 + β3) = xC + b cos(ϕ+ α3),
yO3 + l1 sin θ3 + l2 sin(θ3 + β3) = yC + b sin(ϕ+ α3).
The mass matrix M s(q) is obtained as
M s =
m11 m12 0 0 0 0 0 0 0
m21 m22 0 0 0 0 0 0 0
0 0 m33 m34 0 0 0 0 0
0 0 m43 m44 0 0 0 0 0
0 0 0 0 m55 m56 0 0 0
0 0 0 0 m65 m66 0 0 0
0 0 0 0 0 0 m77 0 0
0 0 0 0 0 0 0 m88 0
0 0 0 0 0 0 0 0 m99
,
m11 = Jc1 + Jc2 +
1
4
m1l
2
1 +m2l
2
1 + r
2Jr, m12 =
1
2
m2l1l2 cos(θ1 − β1),
m21 = m12, m22 =
1
4
m2l
2
2, m33 = Jc1 +
1
4
m1l
2
1 +m2l
2
1 + r
2Jr,
m34 =
1
2
m2l1l2 cos(θ2 − β2), m43 = m34,
336 NGUYEN QUANG HOANG, VU DUC VUONG
m44 = Jc2 +
1
4
m2l
2
2, m55 = Jc1 +
1
4
m1l
2
1 +m2l
2
1 + r
2Jr,
m56 =
1
2
m2l1l2 cos(θ3 − β3), m65 = m56, m66 = Jc1 +
1
4
m2l
2
2,
m77 = m3, m88 = m3, m99 = Jc3 .
The coriolis and centrifugal matrix Cs(q, q˙) are given below and other elements are zero
c21 = −1
2
m2l1l2 sin(θ1 − β1)θ˙1, c12 = 1
2
m2l1l2 sin(θ1 − β1)β˙1,
c43 = −1
2
m2l1l2 sin(θ2 − β2)θ˙2, c34 = 1
2
m2l1l2 sin(θ2 − β2)β˙2,
c65 = −1
2
m2l1l2 sin(θ3 − β3)θ˙3, c56 = 1
2
m2l1l2 sin(θ3 − β3)β˙3.
The damping matrix Ds is given with
Ds = R
−1
a r
2KmKediag([1, 0, 1, 0, 1, 0, 0, 0, 0]).
The control input matrix Bs is given with zero elements except for
Bs(1, 1) = Bs(3, 2) = Bs(5, 3) = R
−1
a rKm.
REFERENCES
[1] J.G. Jalon, E. Bayo, Kinematic and Dynamic Simulation of Multibody Systems The
Real-Time Challenge, Springer Verlag, New York, 1994.
[2] Nguyen Van Khang, Dynamics of Multibody Systems (in Vietnamese), Science and Tech-
nics Publishing House, Ha Noi, 2007.
[3] L.-W. Tsai, Robot Analysis - The Mechanics of Serial and Parallel Manipulators, John
Wiley & Sons, New York, 1999.
[4] J.-P. Merlet, Parallel Robots (2nd Ed.), Springer, Berlin, 2006.
[5] R.M. Murray, Z. Li, and S.S. Sastry, A Mathematical Introduction to Robotic Manipu-
lation, CRC Press, Boca Raton, Fla., 1994.
[6] J. Angeles, Fundamentals of robotics Mechanical Systems (2nd Ed.), Springer Verlag,
New York, 2003.
[7] Y. Nakamura, Advanced Robotics/ Redundancy and Optimization, Addison-Wesley Pub-
lishing Company, Reading 1991.
[8] M. Ceccarelli, Fundaments of Mechanics of Robotic Manipulation, Springer, Dordrecht,
2004.
SLIDING MODE CONTROL FOR A PLANAR PARALLEL ROBOT... 337
[9] A. Muller, T. Hufnagel, “Model-based control of redundantly actuated parallel ma-
nipulators in redundant coordinates”, Robotics and Autonomous Systems, vol. 60, pp.
563–571, 2012.
[10] L. Sciavicco and B. Siciliano, Modelling and Control of Robot Manipulators, 2nd Ed.,
Springer-Verlag, London, UK, 2000.
[11] Pham Thuong Cat, Some Modern Control Methods for Industrial Robots (in Viet-
namese), Thai Nguyen University Publishing, 2009.
[12] J. Baumgarte, “Stabilization of constraints and integrals of motion in dynamical sys-
tems, Computer Methods in Applied Mechanics and Engineering, vol 1, pp 1–16, 1972.
[13] T.R. Kane and D.A. Levinson, Dynamics: Theory and applications, McGraw-Hill, New
York, 1985.
[14] A.A. Shabana, Dynamics of multibody systems, 2nd Ed., Cambridge Uni. Press, 1998.
[15] Benjamin C. Kuo and Farid Golnaraghi, Automatic Control Systems (8th Ed.), John
Wiley Sons, Inc., New York, NY, USA, 2002.
[16] Katsuhiko Ogata, Modern Control Engineering (4th Ed.), Prentice Hall PTR, Upper
Saddle River, NJ, USA, 2001.
[17] A. Fumagalli and P. Masarati, “Real-time inverse dynamics control of parallel manipu-
lators using general-purpose multibody software”, Multibody System Dynamics, vol. 22,
pp. 47-68, 2009.
[18] C. Yang, J. Zhao, L. Li, and S. K. Agrawal, “Design and implementation of a novel modal
space active force control concept for spatial multi-DOF parallel robotic manipulators
actuated by electrical actuators”, ISA Transactions, 2017.
[19] C. Rolda´n-Paraponiaris, F. J. Campa, and O. Altuzarra, “Mechatronic modeling of a
parallel kinematics multi-axial simulation table based on decoupling the actuators and
manipulator dynamics”, Mechatronics, vol. 47, no. Supplement C, pp. 208–222, 2017.
[20] L. Beji, A. Abichou, P. Joli, and M. Pascal, Nonlinear Control of a Parallel Robot
Including Motor Dynamics, Springer Vienna, 1997 (pp. 45–52).
[21] M. Jouini, M. Sassi, N. Amara, and A. Sellami, “Modeling and control for a 6-DOF
platform manipulator”, 2013 Inter. Conf. on Electrical Engineering and Software Ap-
plications, 2013 (pp. 1–5).
[22] Trung Do Thanh, Jens Kotlarski, Bodo Heimann, and Tobias Ortmaier, “Dynam-
ics identification of kinematically redundant parallel robots using the direct search
method”, Mechanism and Machine Theory, vol. 55, pp. 104–121, 2012.
Received on June 27, 2017
Revised on March 17, 2018
Các file đính kèm theo tài liệu này:
- sliding_mode_control_for_a_planar_parallel_robot_driven_by_e.pdf