Sliding mode control for a planar parallel robot driven by electric motors in a task space

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.

pdf13 trang | Chia sẻ: huongthu9 | Lượt xem: 533 | Lượt tải: 0download
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:

  • pdfsliding_mode_control_for_a_planar_parallel_robot_driven_by_e.pdf