• 대한전기학회
Mobile QR Code QR CODE : The Transactions of the Korean Institute of Electrical Engineers
  • COPE
  • kcse
  • 한국과학기술단체총연합회
  • 한국학술지인용색인
  • Scopus
  • crossref
  • orcid

  1. (ERI, Dept. of Control & Instrum. Eng. Gyeongsang Nat’l University, Korea)



Robot control, Regulation control, Variable structure system, Sliding mode control, Disturbance observer

1. Introduction

In servo control, three fundamental problems are the point-to-point(regulation) control problem, tracking problem (trajectory following), and mixed problem. The regulation problem is concerned with moving control objects from a point to another. While the controllers for the regulation problem are required to provide a small positioning error and superior regulation. In the tracking control, control objects must be moved along the desired trajectory with the same initial position as that of plants. Particularly, the mixed problem is the tracking problem with the severely different initial position of plants from that of planned trajectory in which the features of both regulation and tracking problems exist. The regulation, tracking, and mixed problems are very important in many mechanical systems such as robot manipulators, machining systems, tracking antennas etc. These three control problems may be combined in practical fields. Among them, the regulation control problem of robot manipulators is the theme of this paper.

A great deal of the researches on the control of highly nonlinear rigid robot manipulators has been reported in order to improve the performance of controllers and to extend the application fields of robot manipulators (1). There are several approaches to attempt to obtain the desired performances such as decentralized PID (2,3), optimal control, state feedback control(linear techniques until now), computed torque method (4,7,8), adaptive control (9,10), sliding mode control (11-21,27), and others (22-26) (nonlinear techniques). Each method has its merits and shortcomings. In the model based methods (5,6,20) among them, specially, all of highly nonlinear dynamics models are taken into account to calculate the control input which is a hard task in view of the computation time of the process for controllers, which needs the robustness property for controllers against all the modeling errors. In order to obtain the robustness against parameter variations and uncertainties, the variable structure system(VSS) with the sliding mode control(SMC) for robot manipulators has been studied by many researchers (11-21,27). The strong robustness with the simple control structure can be obtained in spite of the existence for an acceptable modeling error and unknown payload by using the sliding mode. The other advantages of a SMC are that the almost output performance can be predetermined by choosing the sliding surface. The first application of SMC to robot manipulator seems to be in the work of Young (11) dealing with a set point regulation problem. A modification of the Young’s controller was presented by Morgan (13). Other SMCs of robot manipulators may be found. However, the existing SMCs for robot manipulators unfortunately have the problem of the reaching phase in the regulation controls during the transient period. Hence the whole output is not completely robust and it is difficult to obtain accurate pre-information on the control performance. Because of this reaching phase, the works about the reacheability and convergence to the sliding surface with finite time are reported. To increase the steady state performance of controllers, an integral action with a zero initial value is simply introduced to the variable structure system, but which causes the inevitable overshoot problems in the transient state as a side effect (23). To alleviate computation burden due to the nonlinear dynamics of manipulators, the multi sampling technique is employed to the inner and outer two loop control scheme(Lee and Kwon (24)) which results in the complexity of the analysis and design. The neural network is considered for the control of robot manipulators, it is good for static nonlinear dynamics but not effective for the unknown payload and external disturbances (25). Using the fuzzy control, the set-point regulation of robot manipulators with flexible joints is studied in [26](26). Currently, the sliding mode control is applied to the tracking and regulation control of medical surgery robots(27).

In [29](29), a continuous integral variable structure system with the prescribed control performance is reported for the regulation control of uncertain general linear plants.

In this paper, an integral variable structure regulation controller with the prescribed accuracy to the predetermined output is designed for highly nonlinear rigid robot manipulators without the problems mentioned above. With the proposed technique, the reaching phase is completely removed by means of the integral sliding surface augmented by the integral state with special initial value. The ideal sliding dynamics of the integral sliding surface is analytically obtained from a given initial point without the reaching phase. The solution of the ideal sliding dynamics predetermines the ideal sliding trajectory from a given initial point to the desired reference. The relationship between the value of the sliding surface and the error to the ideal sliding trajectory is analyzed in Theorem 1. The continuous sliding mode input based on the disturbance observer for efficient compensation of the nonlinear dynamics of robot manipulators can derive robot manipulators to follow the predetermined ideal sliding trajectory within the prescribed accuracy. The calculation burden in control input is also avoided by using the disturbance observer effectively calculating the nonlinear dynamics of robot manipulators. The stability of the closed loop system is investigated in detail in Theorem 2. The results of Theorem 2 provide the stable condition for control gains. Combing the results of Theorem 1 and Theorem 2 gives rise to possibility of designing the improved integral variable structure regulation controller to guarantee the tracking error from the predetermined sliding trajectory within the prescribed accuracy. The usefulness of the algorithm has been demonstrated through the simulations of the regulation control of a two-link robot under parameter uncertainties and payload variations.

2. An Integral Variable Structure Controller

2.1 State equation of robot manipulators

The motion equations of an n degree-of-freedom manipulator can be derived using the Lagrange-Euler formulation as

(1)
J ( q ( t ) , ϕ ) · q ¨ ( t ) + D ( q ( t ) , q ˙ ( t ) , ϕ ) = τ ( t )

where J(q(t),Ø)∈Rn×n is a symmetric positive definite inertia matrix, D(q(t). q ˙ (t).Ø)∈Rn is called a smooth generalized disturbance vector as follows:

(2)
D ( q ( t ) , q ˙ ( t ) , ϕ ) = H ( q ( t ) , q ˙ ( t ) , ϕ ) + F ( q ( t ) , q ˙ ( t ) . ϕ ) + G ( q ( t ) , ϕ )

including the centrifugal and Coriolis terms H(q(t), q ˙ (t),Ø), Coulomb and viscous or any other frictions F(q(t), q ˙ (t),Ø), gravity terms G(q(t),Ø), unknown pay loadand etc. where τ is an input vector, and q(t), q ˙ (t), and q ¨ (t)∈Rn are the generalized position, velocity, and acceleration vectors, respectively. The Ø is the vector composed of the parameters of robot manipulators (i.e. the masses, lengths, offset angles, and inertia of links). An exact modeling of physical robot dynamics is difficult because of the existence of parameter uncertainties, unknown frictions, and payload variations. In this study for the regulation problem, a desired reference qd∈Rn is given from a current state and q ˙ (t)= q ¨ Z(t)=0 is satisfied. Let us define the state vector X(t)∈Rn in the error coordinate system for the improved integral variable structure regulation controller as

(3)
X ( t ) = [ X 1 T ( t )     X 2 T ( t ) ] T

where X1(t) and X2(t) are the trajectory errors and its derivative as

(4)
X 1 ( t ) e ( t ) = q d - q ( t ) X 2 ( t ) e ˙ ( t ) = - q ˙ ( t )

Then the state equation of robot systems for the regulation control becomes

(5)
X ˙ ( t ) = 0 I 0 0 · X ( t ) + 0 Γ 1 ( q ( t ) , ϕ ) · τ ( t ) + 0 Γ 1 ( q ( t ) , ϕ ) · D ( q ( t ) , q ˙ ( t ) , ϕ ,       X ( 0 )

where X ( 0 ) = [ q d T - q T ( 0 ) - q ˙ T ( 0 ) ] T is a given initial condition. For (5), a new improved integral variable structure regulation controller will be designed through the two steps, design of the integral sliding surface and choice of continuous control input. And some analysis about the relationship between the error to the sliding trajectory and the non-zero value of the sliding surface and the closed loop stability will be given in each step.

2.2 An integral sliding surface, its sliding trajectory, and error analysis

First of all, let's define an integral-augmented sliding surface vector s(t) be

(6)
s ( t ) X 2 ( t ) + K v · X 1 ( t ) + K ρ X 0 ( t )     ( = 0 )

where

(7)
X 0 ( t ) = 0 t X 1 ( τ ) d τ + X 0 ( 0 ) X 0 ( 0 ) = - K ρ - 1 ( X 2 ( 0 ) + K v X 1 ( 0 ) )

where Kv and Kρ are diagonal coefficient matrices and X0(t) is the integral of the error with the special initial condition for removing the reaching phase by means of making the integral sliding surface be zero at t=0, i.e., s(0)=0. Thus this integral augmented sliding surface determines the ideal sliding mode dynamics to have an ideal second order dynamics exactly from a given initial condition to the origin in the error coordinate system without any reaching phase, not a straight line of the conventional sliding surface through the origin. If X0(0)=0 in (7) such as previous works(23) on the integral variable structure systems, there exist still the reaching phase problems because s(t)≠0 at t=0 and an inevitable over shoot problems as the side effect because the integral state accumulated form the zero must re-converge to the zero. The sliding dynamics from a given initial condition to the origin defined by equation (6) is obtained from s ˙ (t)=0 as follows:

(8)
s ˙ ( t ) = X 2 ˙ * ( t ) + K v · X 2 * ( t ) + K ρ · X 1 * ( t ) = 0

Then rewrite equation (8) into the state equation form

(9)
X ˙ * ( t ) = Λ · X * ( t )         X * ( 0 ) = X ( 0 )

where

(10)
X * ( t ) = [ q d T ( t ) - q s * T ( t ) - q s ˙ * T ( t ) ] T       a n d       Λ R 2 n × 2 n       Λ = 0 1 - K ρ - K v

The solution of the state equation of the sliding dynamics (9) q s * and q s ˙ * ∈Rn theoretically predetermines the ideal sliding trajectory from a given initial state q(0) to the desired reference qd defined by (6). Since det[λI-Λ]=[λ2I+λKv+Kρ], Kv and Kρ∈Rn×n can be chosen so that all the eigenvalues of Λ have the negative real parts, which guarantees the exponential stability of the system (9), then there exists the positive scalar constants K and κ such that

(11)
| | e Λ t | | < = K · e - κ t

where ||·|| is the induced Euclidean norm.

Now, define X 1 ¯ ( t ) and X 2 ¯ ( t ) are the error from the ideal sliding trajectory and its derivative, respectively as

(12)
X ¯ ( t ) = [ X 1 ¯ T ( t ) X 2 ¯ T ( t ) ] T = [ ( q s * ( t ) - q ( t ) ) T ( q s ˙ * ( t ) - q ˙ ( t ) ) T ] T

If the sliding surface is zero for all time, naturally this defined error and its derivative are also zeros. The sliding surface may be not exactly zero if the input of the improved integral variable structure regulation controller is continuous. Hence the effect of the non-zero value of the sliding surface to the error to the sliding trajectory is analyzed in the following Theorem 1 as a prerequisite to the main theorem.

Theorem 1: If the sliding surface defined by equation (6) satisfies ||s(t)|| γ for any t 0 and || X ^ (0)|| γ/κ is satisfied at the initial time, then

(13)
| | X 1 ¯ ( t ) | | ϵ 1 | | X 2 ¯ ( t ) | | ϵ 2

is satisfied for all t 0 where ε1 and ε2 are the positive constants defined as follows:

(14)
ϵ 1 = K κ · γ ,       ϵ 2 = γ · [ 1 + Z · K κ ] ,       Z = | | [ K ρ       K v ] | |

Proof: Let us define a new error vector as

(15)
X ^ = [ 0 t q s * T ( τ ) - q T ( τ ) d τ     q s * T ( t ) - q T ( t ) ] T

The sliding surface can be re-written as

(16)
s ( t ) = X 2 + K v · X 1 + K ρ · X 0 - { X 2 * + K v · X 1 * + K ρ · X 0 * }

and can be re-expressed in a differential matrix from as

(17)
X ^ ˙ = Λ · X ^ + 0 1 · s ( t )

In (17), the sliding surface may be considered as the bounded disturbance input, ||s(t)|| γ. The solution of (17) is expressed as

(18)
X ^ ( t ) = e Λ t · X ^ ( 0 ) + 0 t { e Λ t · 0 1 · s ( t - τ ) } d τ

From the boundness of the sliding surface and (11), the Euclidean norm of the vector X ^ becomes

(19)
| | X ^ ( t ) | | = | | e Λ t | | · | | X ^ ( 0 ) | | + 0 t | | e Λ t · 0 1 · s ( t - τ ) | | d τ K · e - κ t · | | X ^ ( 0 ) | | + 0 t | | e Λ t | | · | | 0 1 | | · | | s ( t - τ ) | | d τ K κ · γ + ( | | X ^ ( 0 ) - γ κ ) · K · e - κ t K κ · γ

for all time, t 0. Since | | X 1 ^ | | | | X | | ^ , the following equation is obtained

(20)
| | X 1 ¯ | | K κ · γ

From the sliding surface, one can be simply obtained as

(21)
X 2 ¯ = s ( t ) - [ K ρ K v ] · X ^

If the norm operation is taken on both sides, (21) becomes

(22)
| | X 2 ¯ | | < = γ · ( 1 + Z · K κ )

which completes the proof of Theorem 1.

The above Theorem 1 implies that the error from the ideal sliding trajectory and its derivative are uniformly bounded provided the sliding surface is bounded for all time t 0. Using this result of Theorem 1, we can give the specifications on the error from the ideal sliding trajectory being dependent upon the value of the integral sliding surface, (6). In the next section, we will design a variable structure regulation controller with the efficient compensation which can guarantee the boundedness of s(t), i.e., ||s(t)|| γ for a given γ, then the error to the ideal sliding trajectory is bounded by ε1 in virtue of Theorem 1.

2.3 Continuous input and its stability analysis

Robot manipulators activated by several servo motors are subject to a variety of disturbances and uncertainties. The robust control of highly nonlinear robot manipulators is essential for developing robotics. It is often noted that the generalized nonlinear disturbances, D(q(t), q ˙ (t), Ø), must be compensated for improving the control performance. As an ideal control input in the sliding mode control, the equivalent control of the augmented sliding surface (6) for the robot system (5) is obtained from equation (8)

(23)
τ e q ( t ) = D ( q ( t ) , q ˙ ( t ) , ϕ ) + J ( q ( t ) , ϕ ) · ( K v X 2 + K ρ X 1 )

The smooth generalized disturbance D(q(t), q ˙ q(t), ø) is included in an equivalent control, τeq(t). Since generally this smooth generalized disturbance is very complex, a direct calculation of the smooth generalized disturbance from the model of robot manipulators results in the long sampling time, limitations of the control performance, and difficulties of the controller design for highly nonlinear robot manipulators.

In this paper, using the efficient compensation method, so called disturbance observer(22), we consider the following continuous control input, τ(t)

(24)
τ ( t ) = τ c ( t ) + τ s ( t )

where τc(t) is the compensation term for the smooth generalized disturbance as well as the error of the nominal inertia matrix, is not the direct calculation from D ^ (q(t), q ˙ q(t), ø) in the model but the efficient estimation of the generalized disturbance, D(q(t), q ˙ q(t), ø), only using the nominal inertia matrix, JN of the model (1) and an available acceleration information which can be calculated from the speed information by means of the Euler method

(25)
τ c ( t ) = τ ( t - h ) - J N · q ¨ ~ ( t ) = D ( q ( t ) , q ˙ ( t ) , ϕ ) + Δ J ( q ( t ) , ϕ ) · q ¨ ~ ( t ) - J ( q ( t ) , ϕ ) · Δ q ¨ ( t ) - Δ τ ( t )

where q ¨ ~ ( t ) , ΔJ(q(t),Ø), Δ q ¨ ( t ) , Δτ(t) and are defined by

(26)
q ¨ ~ ( t ) = q ˙ ( t ) - q ˙ ( t - h ) h

(27)
Δ J ( q ( t ) , ϕ ) = J ( q ( t ) , ϕ ) - J N

(28)
Δ q ¨ ( t ) = q ¨ ~ ( t ) - q ¨ ( t )

(29)
Δ τ = τ ( t - h ) - τ ( t )

respectively, where ΔJ(q(t),Ø) is the deviation between the real inertia matrix and its nominal value, Δ q ¨ ( t ) is the acceleration information error to the real acceleration value, Δτ(t) is the control input delay error resulted from the digital control, and h is the sampling time for digital implementation. If the sampling time is sufficiently small and control input is continuously implemented, then the acceleration information error Δ q ¨ ( t ) and the control input delay error Δτ(t) can be small. This disturbance observer fails at the initial time because τ(t-h) is unknown, hence only τc(0) is once calculated by using the model of robots with off-line in advance. The detail features of disturbance observer is explained in the work of Komoda in [22](22). The second term in the right hand side of the equation (24) is defined as

(30)
τ s ( t ) = τ e q ~ ( t ) + τ χ ( t )

where τ e q ~ ( t ) is the modified equivalent control for the compensated dynamics of equation (1), and is designed so that the error dynamics of the controlled system has the sliding surface dynamics defined by equation (9), which is defined as

(31)
τ e q ~ ( t ) = J N · ( K v · X 2 + K ρ · X 1 )

As can be seen in (31), τ e q ~ ( t ) is determined directly according to the design of the integral sliding surface. The τχ(t) is the continuous feedback term of the integral sliding surface for correcting the small compensation error as follows:

(32)
τ χ ( t ) = J N · { k χ 1 · s ( t ) + k χ 2 · σ ( t ) } σ ( t ) = s ( t ) | | s ( t ) | | + δ

where kχ1, kχ2, and δ are the suitable positive constants as the design parameters for the continuous control input. After effectively compensating a almost part of nonlinear dynamics of robot manipulators based on the disturbance observer for avoiding a heavy computation burden, the sliding control input is totally continuously implemented. As the function of the disturbance observer, the effective compensation for highly nonlinear generalized disturbances and modeling errors of the inertia matrix will be studied. If we apply the continuous input control torque given by equation (24)-(32) to the robotic system (5), the following equation is obtained

(33)
X 2 ˙ ( t ) = - J - 1 ( q ( t ) , ϕ ) · ( Δ J ( q ( t ) , ϕ ) · q ¨ ( t ) - Δ τ ( t ) ) + Δ q ¨ ( t ) - J - 1 ( q ( t ) , ϕ ) · J N · [ K v · X 2 + K ρ · X 1 + k χ 1 · s ( t ) + k χ 2 · σ ( t ) ]

and the dynamics of s(t) is expressed in the following simple form

(34)
s ˙ ( t ) = n 1 ( t ) - [ k χ 1 · s ( t ) + k χ 2 · σ ( t ) ]

where n1(t)∈Rn is the resulting disturbance vector given by

(35)
n 1 ( t ) = n 1 ( Δ q ¨ ( t ) , Δ τ ( t ) , ϕ ^ ) = J N - 1 · J ( q ( t ) , ϕ ) · Δ q ¨ ( t ) + J N - 1 · Δ τ ( t )

From the equation (34), the 2n-th order original regulation control problem is converted to the 2n-th stabilization problems with three degree of freedoms kχ1, kχ2, and δ against the resultant disturbance n1(t) by means of the proposed algorithm which implies the robustness problems in the design of controllers. For some positive constants ε1 and ε2 defined in (14), let the constant N be defined as follows:

(36)
N = m a x { | | n 1 ( Δ q ¨ ( t ) , Δ τ ( t ) , ϕ ^ ) | | ;     q ( t ) B ( ϵ 1 ; q s * ( t ) )     a n d     q ˙ ( t ) B ( ϵ 2 ; q ˙ s * ( t ) ) }

where the matrix norm is defined as the induced Euclidean norm, and for a positive number ε > 0 and a vector λ∈Rn the boundary set defined by as

(37)
B ( ϵ ; λ ) = { x R n ; | | x - λ | | ϵ }

In equation (35), the resultant disturbances are mainly dependent on the acceleration information error and the control input computation delay error and not system uncertainties or modeling error of robot manipulators. The disturbance observer can compensate for modeling errors of the inertia matrix besides the smooth generalized disturbance (2). Thus the SMC design is independent of the maximum bound of modeling errors in the parameter space, but dependent on only the resultant disturbance composed of the acceleration information error and the control time delay due to the digital implementation.

The stability property of the system (5) with the control laws (24)-(32) will be stated in the next theorem:

Theorem 2: Consider the robot system with the control algorithm given by the equations (24)-(32). Assume that for some positive γ > 0, ||s(0)|| γ and || X ^ (0)|| γ/κ are satisfied at the initial time t=0, and if the gains kχ1 and kχ2 satisfy

(38)
k χ 2 N - k χ 1 · δ

for a given δ > 0 and N in (36), then the closed loop control system is uniformly bounded(i.e. the solution X ^ is uniformly bounded at the origin in the error coordinate state space) for all time t 0 until ||s(t)|| η where η is defined by

(39)
η = α 1 2 + β 1 - α 1 α 1 = δ / 2 + ( k χ 2 - N ) / ( 2 k χ 1 ) β 1 = δ · N k χ 1

Proof: The proof is straightforward, first take Lyapunov candidate function as

(40)
V ( t ) = 1 2 s T ( t ) · s ( t )

and differentiate with respect to time, it leads to

(41)
V ˙ ( t ) = s T ( t ) · s ˙ ( t ) = s T ( t ) n 1 ( t ) - s T ( t ) [ k χ 1 · s ( t ) + k χ 2 · σ ( t ) ]

By the matrix inequality, (41) becomes

(42)
V ˙ ( t ) < = | | s ( t ) | | · | | n 1 ( t ) | | - | | s ( t ) | | [ k χ 1 · | | s ( t ) | | + k χ 2 · | | σ ( t ) | | ] | | s ( t ) | | · { N - [ k χ 1 · | | s ( t ) | | + k χ 2 · | | σ ( t ) | | ] } - k χ 1 · | | s ( t ) | | | | s ( t ) | | + δ { | | s ( t ) | | 2 + 2 α 1 · | | s ( t ) | | - β 1 }

If the gains kχ1 and kχ2 satisfy the inequality (38)

(43)
V ˙ ( t ) < 0

at all t 0 as long as ||s(t)|| η , which completes the proof of Theorem 2.

Theorem 2 guarantees the uniform bounded stability of the proposed continuous improved integral variable structure regulation controller for robot manipulators. The smaller δ in control algorithm (32), the lower value of η. The η can be decreased by an increase of kχ1 for a given δ and N so that η is sufficiently smaller than γ the bound of the sliding surface in Theorem 1(η < γ). If the initial value of the sliding surface is small(||s(0)|| γ) which is reasonable in case of the known initial state of robot manipulators, the feedback control (24)-(32) designed by Theorem 1 and Theorem 2 maintains the bounded stability of the system with the prescribed performance:

(44)
q ( t ) B ( ϵ 1 ; q s * ( t ) )       a n d       q ˙ ( t ) B ( ϵ 2 ; q ˙ s * ( t )

which implies guaranteeing the prescribed tracking error ε1 to the ideal sliding trajectory q s * ( t ) predetermined by the integral sliding surface from a given initial condition q(0) to qd, in other words, guaranteeing the predetermined output response with the prescribed accuracy. Fig. 1 shows the structure of the proposed algorithm composed of the compensation term, modified equivalent term, and continuous feedback term of the integral sliding surface which is relatively simple because of avoidance of large computation burden and nature of the VSS. Thus the sampling time can be as small as possible so that the acceleration information calculated by Euler method and the delayed control input are almostly exact to each real value, therefore, the maximum value N can be small. Therefore, a new SMC can be realized effectively. And robot manipulators are controlled to follow the predetermined sliding trajectory from q(0) to qd. The sliding trajectory is obtained by the solution of the sliding dynamics of (9) in advance. Hence the output is predictable with ε1 accuracy. The design procedure of the proposed sliding mode controller to guarantee the predetermined output with prescribed accuracy is as follows: First, choose the desired sliding surface defining the desired sliding dynamics (9) which means the determination of the coefficients, Kv and Kρ and calculate the ideal sliding trajectory off-line (performance design phase). Second, find the constants and satisfying the equation (11). Third, determine the bound of the sliding surface, γ using (14) in Theorem 1 for a given the accuracy of the tracking error to the sliding trajectory, ε1. And finally design the gains, kχ1 and kχ2, in equation (32) based on Theorem 2 so that the η is smaller than γ(robustness design phase). In the whole procedure, the design does not need the information of maximum bound of system parameter variations or uncertainties because of the efficient on-line compensation.

그림. 1. 제안된 적분 가변 구조 레귤레이션 제어기

Fig. 1. Proposed integral variable structure regulation controller

../../Resources/kiee/KIEE.2018.67.1.103/fig1.png

3. Design Examples and Simulation Studies

Numerical simulations are performed to show the accurate and robust control property of the proposed algorithm. The dynamic model of a SCARA-type two degree-of-freedom manipulator shown in Fig. 2 used in this simulation is as follows:

그림. 2. 스카라 형 2 자유도 머니플레이터

Fig. 2. SCARA–type two degree-of freedom manipulator

../../Resources/kiee/KIEE.2018.67.1.103/fig2.png

(45)
τ 1 τ 2 = l 2 · 1 3 m 1 + 4 3 m 2 + m 2 C 2 1 3 m 2 + m 2 C 2 1 3 m 2 + 1 2 m 2 C 2 1 3 m 2 · q 1 q 2 + l 2 · - 1 2 m 2 S 2 q ˙ 1 2 - m 2 S 2 q 1 ˙ q 2 ˙ 1 2 m 2 S 2 q ˙ 1 2 + l 2 · 1 2 m 1 g C 1 + 1 2 m 2 g C 12 + m 1 g C 1 1 2 m 2 g C 12

where Ci, Si, and Cij imply cos(qi), sin(qi) and cos(qi+qj), respectively. The manipulator parameters are m1=m2=0.782[kg], l=0.23[m], and g=9.8[m/sec2].

The reference command qd=[90°~-60°]T is given for the two links as an example. The sampling time is selected as 2 [msec]. Following the design procedure, the coefficients of an integral sliding surface 1 is designed as Kv=12 and Kρ=36 in (8) for locating double poles at -6 into the ideal sliding dynamics (9). The solution of (9) q s * predetermines the intermediate ideal sliding trajectory from q(0) to qd The corresponding constants in (11) K and κ become 4 and 2.715, respectively. By the results of Theorem 1, the error to the ideal sliding trajectory and its derivative, X 1 ¯ and X 2 ¯ , are bounded as ε1=1.473γ and ε2=57γ for a given γ of the bound of the sliding surface. For a ε1=0.2° maximum error, γ is selected as 0.13. Now, the controller gains, kχ1 and kχ2, are selected to be 20 and 10 for δ=0.05 and N=5 by Theorem 2 which satisfy the condition (38) so that η=0.037 is sufficiently small with respect to the chosen γ=0.13 by theorem 1 in order to guarantee the prescribed error ε1=0.2° to the sliding trajectory previously determined by the integral sliding surface 1.

For comparison, the simulations of the previous IVSS algorithm in [23](23) are carried out under the three different conditions, i.e., case 1:no modeling error, case 2: 10 [%] modeling error, and case 3: 10 [%] modeling error and 1[kg] unknown payload. Fig. 3 shows the position error responses of the two links for the three cases by the previous IVSS algorithm in [23](23). The corresponding phase trajectories are shown in Fig. 4. As can be seen in Fig. 3 and Fig. 4, there are the overshoot problems as expected. Each control input of the link 1 and link 2 are shown in Fig. 5 and Fig. 6, respectively. For illustrating the performances of the proposed algorithm, the simulations are carried out under same three cases. The position errors of two links and corresponding phase trajectories for the three case conditions are shown in Fig. 7 and Fig. 8, respectively. As can be seen, the three error outputs and phase trajectories are exactly identical and accurate to the predetermined sliding trajectories which means the high robustness of the suggested algorithm for all parameter uncertainties and payload variations as therorectically expected. And there is no reaching phase in Fig. 8 showing the curve line sliding surface from the initial state to the origin. The continuous control inputs of link 1 and link 2 for the three cases are depicted in Fig. 9 and Fig. 10, respectively. Fig. 11 shows the position errors of two links for three sliding surfaces, i.e., sliding surface 1:previously designed surface, sliding surface 2: the coefficients Kv=16 and Kρ=64 for double poles at -8 in the sliding dynamics, and sliding surface 3:the coefficients Kv=24 and Kρ=144 for double poles at -12. As can be seen in Fig. 11, the convergence speed of the position error trajectory can be changed according to the design of the integral sliding surface, (6), which means that the real output can be designed as desired. The corresponding phase trajectories are shown in Fig. 12 for the three integral sliding surfaces. From the results of the simulation studies until now, the advantages of the proposed algorithm can be pointed out in view of no reaching phase, no overshoot, the strong robustness, the predetermined output with designed accuracy, design phase separation, and easy changeability of output performance which has been illustrated.

그림. 4. 참고문헌 [23](23) 기존 IVSS에 의한 3가지 경우에 대한 2 링크의 상 궤적

Fig. 4. Phase trajectories of two links for three cases by previous IVSS algorithm in [23](23)

../../Resources/kiee/KIEE.2018.67.1.103/fig4.png

그림. 5. 참고문헌 [23](23) 기존 IVSS에 의한 3가지 경우에 대한 링크 1의 제어입력

Fig. 5. Control inputs of link 1 for three cases by previous IVSS algorithm in [23](23)

../../Resources/kiee/KIEE.2018.67.1.103/fig5.png

그림. 6. 참고문헌 [23](23) 기존 IVSS에 의한 3가지 경우에 대한 링크 2의 제어입력

Fig. 6. Control inputs of link 2 for three cases by previous IVSS algorithm in [23](23)

../../Resources/kiee/KIEE.2018.67.1.103/fig6.png

그림. 7. 제안된 알고리듬에 의한 3가지 경우에 대한 2 링크의 위치 오차 응답

Fig. 7. Position error responses of two links for three cases by proposed algorithm case 1: no modeling error, case 2: 10[%] modeling error, case 3: 10[%] modeling error and 1[kg] unknown payload

../../Resources/kiee/KIEE.2018.67.1.103/fig7.png

그림. 8. 제안된 알고리듬에 의한 3가지 경우에 대한 2 링크의 상 궤적

Fig. 8. Phase trajectories of two links for three cases by proposed algorithm

../../Resources/kiee/KIEE.2018.67.1.103/fig8.png

그림. 9. 제안된 알고리듬에 의한 3가지 경우에 대한 링크 1의 제어입력

Fig. 9. Control inputs of link 1 for three cases by proposed algorithm

../../Resources/kiee/KIEE.2018.67.1.103/fig9.png

그림. 10. 제안된 알고리듬에 의한 3가지 경우에 대한 링크 2의 제어입력

Fig. 10. Control inputs of link 2 for three cases by proposed algorithm

../../Resources/kiee/KIEE.2018.67.1.103/fig10.png

그림. 11. 다른 3 슬라이딩 면에 대한 2 링크의 위치 오차 응답

Fig. 11. Position error responses of two links for different three sliding surfaces sliding surface 1: Kv=12 and Kρ=36, sliding surface 2: Kv=16 and Kρ=64, sliding surface 3: Kv=24 and Kρ=144

../../Resources/kiee/KIEE.2018.67.1.103/fig11.png

그림. 12. 다른 3 슬라이딩 면에 대한 2 링크의 상 궤적

Fig. 12. Phase trajectories of two links for different three sliding surfaces

../../Resources/kiee/KIEE.2018.67.1.103/fig12.png

4. 결 론

In this paper, an improved integral variable structure regulation controller with the prescribed tracking accuracy to the predetermined sliding output is suggested for highly nonlinear rigid robot manipulators based on the special integral sliding surface and the efficient disturbance observer. In the proposed improved integral variable structure regulation controller, the special integral sliding surface is adopted for removing the reaching phase. The ideal sliding dynamics of the integral sliding surface is analytically obtained as the differential equation in matrix form. Hence by using the solution of the sliding dynamics, the sliding trajectory is predetermined from a given initial state to the desired reference without the reaching phase according to the choice of the integral sliding surface (performance design). The relationship between the maximum bound of the tracking error to the predetermined ideal sliding trajectory and the non-zero value of the sliding surface is derived analytically in Theorem 1 and its proof. The uniform bounded stability of the suggested algorithm is investigated in theorem 2. Through the two theorems, it is proved that the predetermination of the output response with prescribed tracking accuracy is possible. Robot manipulators can be controlled to follow the predetermined ideal sliding trajectory within the prescribed accuracy for all the modeling errors and payload variations in the proposed regulation control. The usefulness of the proposed algorithm has been demonstrated by the simulations about the regulation position controls of a two-link robot under parameter uncertainties and payload variations with the example designs. The advantages of the proposed algorithm can be pointed out in view of no reaching phase, no overshoot, strong robustness with prescribed accuracy, the predetermined output with designed accuracy, design phase separation and easy changeability of output performance, etc.

References

1 
Abdallah C., Dawson D., Dorato P., Jamshidi M., 1991, Survey of Robust Control for Rigid Robots, IEEE Control System Magazine, Vol. 11, No. 2, pp. 24-30DOI
2 
Rocco P., 1996, Stability of PID Control of Industrial Robot Arms, IEEE Trans. Robotics Autom., Vol. 12, No. 4, pp. 606-614DOI
3 
Mendoza M., Zavala-Rio A., Santibanez V., Reyes F., 2015, Output-Feedback Proportion-Integral-Derivative-Type Control with Simple Tuning for the Global Regulation of Robot Manipulators with Input Constraints, IET Control Theory & Applications, Vol. 9, No. 14, pp. 2097-2106DOI
4 
Fu K. S., Gonzales R., Lee C. S. G., 1987, Robotics:Control, Sensing Vision, Intelligence. (McGraw-Hill, New York)Google Search
5 
Brady M. et al., 1982, Robot Motion: Planning and control, The MIT Press, MasachusettsGoogle Search
6 
Sahba M., Mayne D. Q., 1984, Computer-Aided Design of Nonlinear Controller for Torque Controlled Robot Arms, IEE Proc. Part D, Vol. 131, pp. 8-14DOI
7 
Tourasis V. D., Neuman C. P., 1985, Robust Nonlinear Feedback Controller Robotic Manipulators, IEE Proc. Part D, Vol. 132, pp. 134-143DOI
8 
Egeland O., 1986, On the Robustness of Computed Torque Method in Manipulator Control, Proc. IEEE Int. Conf. on Robotics and Automation, pp. 1203-1208Google Search
9 
Kovio A. J., Huo T. H., 1983, Adaptive Linear Controller for Robotic Manipulators, IEEE Trans. on Automat. Cont., Vol. AC-28, No. 2, pp. 162-171DOI
10 
Craig J. J., 1986, Adaptive Control of Mechanical Manipulators, Ph.D. thesis, Stanford University, Department of Electrical EngineeringGoogle Search
11 
Young K. K. D., 1978, Controller Design for a Manipulator Using Theory of Variable Structure Systems, IEEE Trans. on Systems, Man, and Cybernetics, Vol. SMC-8, No. 2, pp. 101-109DOI
12 
Slotine J. J., Sastry S. S., 1983, Tracking Control of Nonlinear Systems Using Sliding Surface, with Application to Robot Manipulators, Int. J. Control, Vol. 38, No. 2, pp. 465-492DOI
13 
Morgan R. G., Ozguner U., 1985, A Decentralized Variable Structure Control Algorithm for Robotic Manipulators, IEEE J. of Robotics and Automation, Vol. RA-1, No. 1, pp. 57-65Google Search
14 
Hashimoto H., Maruyame K., Harashima F., 1987, A Microprocessor-Based Robot Manipulator Control with Sliding Mode, IEEE Trans. on Indust. Electr., Vol. IE-34, No. 1, pp. 11-18DOI
15 
Young K. K. D., 1988, A Variable Structure Model Following Control Design for Robotics Applications, IEEE J. of Robotics and Automation, Vol. RA-4, No. 5, pp. 556-561DOI
16 
Xu J. X., Hashimoto H., Slotine J. J., Arai Y., Harashima F., 1989, Implementation of VSS Control to Robotic Manipulators-Smoothing Modifications, IEEE Trans. on Indust. Electr., Vol. IE-36, No. 3, pp. 321-329DOI
17 
Bellini A., Figall G., Pinello P., Vanniulivi G., 1989, Realization of a Control Device for a Robotic Manipulator Based on Nonlinear Decoupling and Sliding Mode Control, IEEE Trans. on Industry Application, Vol. IA-25, No. 5, pp. 790-799DOI
18 
Young K. S., Chen Y. P., 1990, Sliding mode Controller Design of a Single-link Flexible Manipulator Under Gravity, Int. J. Contr., Vol. 52, No. 1, pp. 101-117DOI
19 
Singh S., 1990, Decentralized Variable Structure Control for Tracking in Non-linear Systems, Int. J. Contr., Vol. 52, No. 4, pp. 811-831DOI
20 
Wijesoma S. W., Richards R. J., 1990, Robust Trajectory Following of Robots Using Computed Torque Structure with VSS, Int.J. Contr., Vol. 52, No. 4, pp. 935-962DOI
21 
Chen Y. F., Mita T., Wakui S., 1990, A New and Simple Algorithm for Sliding Mode Trajectory Control of the Robot Arm, IEEE Trans. on Automat. Contr., Vol. AC-33, No. 7, pp. 828-829DOI
22 
Komada S., Ohnishi K., 1990, Force Feedback Control of Robot Manipulator by the Acceleration Tracking Orientation Method,, IEEE Trans. on Indust. Electr., Vol. IE-37, No. 1, pp. 6-12DOI
23 
Chern T. L., Wu Y. C., 1992, Integral Variable Structure Control Approach for Robot Manipulators, lEE Proceedings-D, Vol. 139, No. 2, pp. 162-165DOI
24 
Lee J. S., Kwon W. H., A Hybrid Control Algorithm for Robotic Manipulator, Robotica(In print)Google Search
25 
Zhou S. L., Han P., Wang D. F., Yao W. Y., Zhang L. J., 2003, Fuzzy-Neural Net Based Control Strategy for Robot Manipulator Trjectory Tracking, Proceedings of the Second Int. Conference on Machine Learning and Cybernetics, Xi’an, Vol. 2, No. 5, pp. 596-601DOI
26 
Lara-Molina F. A., Takano K. A., Koroishi E. H., 2015, Set-Point Regulation of a Robot Manipulator with Flexible Joints Using Fuzzy Control, 2015 12th Latin American Robotics Symposition and 2015 3rd Brazilian Symposium on Robotics, pp. 103-108DOI
27 
Rascon R., Reyna M. A., Torres J., 2016, Tracking and Regulation Control of a Scara Robot with Application to Minimally Invasive Surgeries, 2016 Global Medical Engineering Physics Exchanges/Pan American Health Care Exchanges(GMEPE/PAHCE), pp. 1-6DOI
28 
Lee J. H., 2010, A Proof of Utkin’s Theorem for a MI Uncertain Linear Case, KIEE, Vol. 59, No. 9, pp. 1680-11685DOI
29 
Lee J. H., 2017, An Improved Continuous Integral Variable Structure Systems with Prescribed Control Performance for Regulation Controls of Uncertain General Linear Systems, KIEE, Vol. 66, No. 12, pp. 1759-1771DOI

저자소개

이정훈 (Jung-Hoon Lee)
../../Resources/kiee/KIEE.2018.67.1.103/au1.png

1966년 2월 1일생

1988년 경북대학교 전자공학과 졸업(공학사)

1990년 한국과학기술원 전기 및 전자공학과 졸업(석사)

1995년 한국과학기술원 전기 및 전자공학과 졸업(공박)

1995년~현재 경상대학교 공과대학 제어계측공학과 교수

경상대학교 공대 공학연구원 연구원

1997~1999 경상대학교 제어계측공학과 학과장

마르퀘스사의 Who's Who in the world 2000년 판에 등재

American Biograhpical Institute(ABI)의 500 Leaders of Influence에 선정

Tel:+82-55-772-1742

Fax:+82-55-772-1749

E-mail : jhleew@gnu.ac.kr