Disturbance Employment-Based Sliding Mode Control (DESMC) Method For 4-DOF Tower Crane Systems

Information

  • Patent Application
  • 20230399205
  • Publication Number
    20230399205
  • Date Filed
    June 12, 2022
    2 years ago
  • Date Published
    December 14, 2023
    a year ago
Abstract
The present disclosure provides a disturbance employment-based sliding mode control (DESMC) method for four-degrees-of-freedom (4-DOF) tower crane systems. The method includes the following steps: acquiring parameter data and operating state data of the 4-DOF tower crane systems; conducting, based on the acquired data, disturbance estimation by using a preset nonlinear disturbance observer, and conducting judgment on beneficial disturbance and detrimental disturbance according to a preset disturbance effect indicator (DEI); and adding the beneficial disturbance to a preset sliding mode controller, removing the detrimental disturbance, driving a jib and a trolley to a desired slew angle and a desired target displaced position, respectively, and setting a payload swing angle to 0 or within a preset range. According to the present disclosure, the disturbance effect is distinguished by introducing a DEI, such that good disturbance information is made full use of, and the transient control performance of the system is significantly improved.
Description
TECHNICAL FIELD

The present disclosure relates to the technical field of transient control for four-degrees-of-freedom (4-DOF) tower crane systems, and in particular to a disturbance employment-based sliding mode control (DESMC) method for 4-DOF tower crane systems.


BACKGROUND ART

The statement of this part is merely intended to provide background information related to the present disclosure, and does not necessarily constitute the prior art.


Crane system is a typical underactuation system, the number of independent control inputs of which is less than the degrees of freedom to be controlled. As the most widely used means of cargo transport in construction sites, tower crane has the advantages of simple structure, ease of installation, low cost, large payload capacity, low energy consumption and so on. However, due to the inevitable problems of external disturbance, parameter uncertainty, strong coupling, strong nonlinearity, and strong underactuation characteristics existing in the tower crane systems, controller design for the tower crane system is still a complicated and challenging task to achieve. For example, it is difficult to measure system parameters with complete accuracy, given the complexity and variability of the factors that may affect measurements. In addition, external disturbance such as a gust of wind, also imposes a great impact on the stability of the tower crane system. Therefore, in the presence of disturbance, the robustness of the crane system should be taken into full consideration.


In order to better solve the above problems, researchers have proposed a wide range of control methods, mainly including adaptive control, fuzzy logic control, neural network control and so on. By these methods, uncertain-but-bounded dynamics can be effectively dealt with. Besides, DESMC method has satisfactory robustness for unmodeled dynamics, parameter uncertainty, and external disturbance. Therefore, with respect to the tower crane systems, researchers have designed many sliding mode control methods, covering integral sliding mode control, nonlinear sliding mode control, adaptive sliding mode control and neural network sliding mode control. Recently, in order to better eliminate the impact of disturbance on the tower crane systems, researchers have proposed several disturbance observer-based control methods, through which system robustness can be further improved.


However, the inventors have found that most of existing control methods for tower crane system are designed by employing a linearized tower crane system model. When state variables of the system cannot come close enough to the equilibrium point, the linearized model becomes quite different from an original crane model, which may seriously affect the control performance of the system, and may even cause the instability problem. In addition, all of the above robust control methods fail to include the beneficial effects, but completely regard disturbance as a detrimental factor, and eliminate it directly without make full use of the beneficial disturbance, resulting in poor transient control performance.


SUMMARY

In order to overcome the defects of the prior art, the present disclosure provides a DESMC method for 4-DOF tower crane systems. According to the present disclosure, the disturbance effect is distinguished by introducing a disturbance effect indicator (DEI), such that good disturbance information is made full use of, and the transient control performance of the system is significantly improved.


To achieve the above objective, the present disclosure adopts the following technical solutions:


A first aspect of the present disclosure provides a DESMC method for 4-DOF tower crane systems.


The DESMC method for 4-DOF tower crane systems includes the following steps:


acquiring parameter data and operating state data of the 4-DOF tower crane systems;


conducting, based on the acquired data, disturbance estimation by using a preset nonlinear disturbance observer, and conducting judgment on beneficial disturbance and detrimental disturbance according to a preset DEI; and


adding the beneficial disturbance to a preset sliding mode controller, removing the detrimental disturbance, driving a jib and a trolley to a desired slew angle and a desired target displaced position, respectively, and setting a payload swing angle to be 0 or within a preset range.


A second aspect of the present disclosure provides a DESMC system for 4-DOF tower crane systems.


The DESMC system for 4-DOF tower crane systems includes:


a data acquisition module, which is configured to acquire parameter data and operating state data of the 4-DOF tower crane systems;


a disturbance judgment module, which is configured to conduct, based on the acquired data, disturbance estimation by using a preset nonlinear disturbance observer, and conduct judgment on beneficial disturbance and detrimental disturbance according to a preset DEI; and


a sliding mode control module, which is configured to add the beneficial disturbance to a preset sliding mode controller, remove the detrimental disturbance, drive a jib and a trolley to a desired slew angle and a desired target displaced position, respectively, and set a payload swing angle to be 0 or within a preset range.


A third aspect of the present disclosure provides a medium storing a program, where the program, when executed by a processor, implements steps of the DESMC method for 4-DOF tower crane systems as described in the first aspect of the present disclosure.


A fourth aspect of the present disclosure provides an electronic device, including a memory, a processor, and a program stored in the memory and executable on the processor, where the processor, when executing the program, implements steps of the DESMC method for 4-DOF tower crane systems as described in the first aspect of the present disclosure.


Compared with the prior art, the present disclosure has the following beneficial effects:

    • 1. The method, system, medium or electronic device as described in the present disclosure deliberately introduces a disturbance effect indicator to distinguish the good disturbance effect from the bad one, and then, takes full advantage of the good disturbance effect, consequently increasing the transient control performance dramatically.
    • 2. The method, system, medium or electronic device as described in the present disclosure does not require accurate knowledge about a model (for example, cable length, trolley mass, payload mass, jib inertia moment, friction-related parameters, and external disturbances), thus ensuring satisfactory robustness.
    • 3. The method, system, medium or electronic device as described in the present disclosure is designed and analyzed based on original dynamic model of tower crane systems without any approximation processing. As a consequence, for the designed control method, it has little influence on the control performance when the state variables are not close enough to the equilibrium point.





BRIEF DESCRIPTION OF THE DRAWINGS

The accompany drawings constituting a part of the present disclosure are intended to provide further understanding of the present disclosure. The exemplary embodiments of the present disclosure and illustrations thereof are used to explain the present disclosure and do not constitute an undue limitation to the present disclosure.



FIG. 1 is a schematic diagram illustrating a 4-DOF tower crane system according to Embodiment 1 of the present disclosure.



FIG. 2 is a flow block diagram illustrating an overall control method according to Embodiment 1 of the present disclosure.



FIG. 3 is a schematic diagram illustrating simulation results of a PD control method, an adaptive control method and a proposed control method according to Embodiment 1 of the present disclosure.



FIG. 4 is a schematic diagram illustrating simulation results of Case 1 according to Embodiment 1 of the present disclosure.



FIG. 5 is a schematic diagram illustrating simulation results of Case 2 according to Embodiment 1 of the present disclosure.





DETAILED DESCRIPTION OF THE EMBODIMENTS

The present disclosure is described in further detail below with reference to the accompanying drawings and examples.


It should be noted that the following detailed descriptions are all exemplary and aim to further describe the present disclosure. Unless specified otherwise, all terms (including technical terms and scientific terms) used in this embodiment have the same meanings usually understood by a person of ordinary skill in the pertinent technical field of the present disclosure.


It should be noted that the terms used herein are merely used for describing specific examples, but not intended to limit the exemplary examples according to the present disclosure. As used herein, the singular forms are intended to include the plural forms as well, unless the context clearly indicates otherwise, and also, it should be understood that when the terms “include” and/or “comprise” are used in this specification, they indicate that there are features, steps, operations, devices, elements, and/or combinations thereof.


The embodiments in the present disclosure and features in the embodiments may be combined with each other in a non-conflicting manner.


Embodiment 1

In Embodiment 1 of the present disclosure, uncertainties of disturbance are considered, and a nonlinear disturbance observer is adopted for accurately observing the disturbance; afterwards, based on estimated disturbance information, the DEI is configured to distinguish beneficial disturbance and detrimental disturbance; finally, the DEI and estimated disturbance information are introduced into controller design, and thus a DESMC method is proposed, which includes the following steps:


S1: Construction of error model of 4-DOF tower crane system


In this embodiment, the accurate positioning and fast swing elimination control are considered for 4-DOF tower crane systems. As shown in FIG. 1, the dynamic model constructed for the 4-DOF tower crane systems is as follows:





[mp(S12C22+S22)l2+2mpxlC2S1+J+(Mt+mp)x2]{umlaut over (φ)}−mplS2{umlaut over (x)}−mpl2C1C2S2{umlaut over (θ)}1+mpl(C2x+lS1){umlaut over (θ)}2+2(Mt+mp)x{dot over (x)}{dot over (φ)}2mplC1C2x{dot over (φ)}{dot over (θ)}1−mplS2(2{dot over (φ)}S1+{dot over (θ)}2)x{dot over (θ)}2+2mplS1C2{dot over (φ)}{dot over (x)}+mpl2S21C22{dot over (φ)}{dot over (θ)}1+mpl2S1S2C2{dot over (θ)}12+mpl2C12S22{dot over (φ)}{dot over (θ)}2+2mpl2C1S22{dot over (θ)}1{dot over (θ)}2=Fφ−F+dφ  (1)





1mplS2{umlaut over (φ)}+(Mt+mp){umlaut over (x)}+mplC1C2{umlaut over (θ)}1−mplS1S2{umlaut over (θ)}2−(Mt+mp)x{dot over (φ)}2−2mplC1S2{dot over (θ)}1{dot over (θ)}2−mplC2[S1({dot over (φ)}2+{dot over (θ)}12+{dot over (θ)}22)+2{dot over (φ)}{dot over (θ)}2]=Fx−Frx+dx   (2)





mpl2C1C2S2{umlaut over (φ)}+mplC1C2{umlaut over (x)}+mpl2C22{umlaut over (θ)}1−mplC1C2(x+lS2C2){dot over (φ)}2−2mpl2C2({dot over (φ)}C1C2+{dot over (θ)}1S2){dot over (θ)}2+mpglS1C2=0   (3)






m
p
l(C2x+lS1){umlaut over (φ)}−mplS1S2{umlaut over (x)}+mpl2{umlaut over (θ)}2+2mplC2{dot over (x)}{dot over (φ)}+mpl(xS1S2−lC12S2C2){dot over (φ)}2+2mpl2C1C22{dot over (φ)}{dot over (θ)}1+mpl2{dot over (θ)}12S2C2+mpglC1S2=0   (4)


where, the meanings of variables, parameters, and symbols of a system in Eqs. (1)-(4) are shown in Table 1.









TABLE 1







Variables, parameters, and symbols


of the 4-DOF tower crane system








Variables/Parameters/



Symbols
Meaning





φ
Jib slew angle


x
Trolley displacement


θ1, θ2
Payload swing angle


l
Cable length


Mt
Trolley mass


mp
Payload mass


J
Jib inertia moment


g
Gravitational acceleration


S1, S2, C1, C2
Abbreviations of sin θ1, sin θ2, cos θ1, cos θ2


dφ, dx
Disturbances including internal disturbances



and external disturbances


F
Jib friction torque


Frx
Trolley friction force


Fφ
Running torque


Fx
Translational force









After a series of experimental measurement, the friction torque and friction force can be expressed as follows:






F

=F
rφ1 tanh(ρφ{dot over (φ)})+Frφ2|{dot over (φ)}|{dot over (φ)}  (5)






F
rx
=F
rx1 tanh(ρx{dot over (x)})+Frx2|{dot over (x)}|{dot over (x)}  (6)


where Frφ1, Fdrφ2, Frx1, Frx2, ρφ and ρx denote friction-related coefficients.


For the sake of brevity, Eqs. (1)-(4) are re-written as the following matrix form:






M(q){umlaut over (q)}+C(q, {dot over (q)}){dot over (q)}+G(q)=u+F*   (7)


where, q∈custom-character4 denotes a state vector, M(q)∈custom-character4×4 denotes an inertial matrix, C(q, {dot over (q)})∈custom-character4×4 denotes a Coriolis-centripetal matrix, G(q)∈custom-character4 denotes a gravity vector, u∈custom-character4 denotes a control input vector, F*∈custom-character4 denotes a disturbance vector, and the specific expressions of these matrices and vectors are as follows:






q
=



[

φ


x



θ
1




θ
2


]

T

=


[


q
1




q
2


]

T









M

(
q
)

=


(




m

1

1





m

1

2





m

1

3





m

1

4







m

1

2





m

2

2





m

2

3





m

2

4







m

1

3





m

2

3





m

3

3





m

3

4







m

1

4





m

2

4





m

3

4





m

4

4





)

=

(




M

1

1





M

1

2







M

1

2





M

2

2





)









C

(

q
,

q
˙


)

=


(




c

1

1





c

1

2





c

1

3





c

1

4







c

2

1





c

2

2





c

2

3





c

2

4







c

3

1





c

3

2





c

3

3





c

3

4







c

4

1





c

4

2





c

4

3





c

4

4





)

=

(




C

1

1





C

1

2







C

2

1





C

2

2





)









G

(
q
)

=



[

0


0



m
p


g

l


S
1



C
2




m
p


g

l


C
1



S
2


]

T

=


[


G
1




G
2


]

T









u
*

=



[


F
φ




F
x



0


0

]

T

=


[


u
1




u
2


]

T









F
*

=



[


-

F

r

φ



+

d
φ


-

F
rx

+


d
x



0


0


]

T

=



[


F
1
*




F
2
*


]

T



where









q
1

=


[

φ


x

]

T








q
2

=


[


θ
1




θ
2


]

T








m

1

1


=




m
p

(



S
1
2



C
2
2


+

S
2
2


)



l
2


+

2


m
p


x

l


C
2



S
1


+
J
+


(


M
t

+

m
p


)



x
2










m

1

2


=


-

m
p



l


S
2









m

1

3


=


-

m
p




l
2



C
1



C
2



S
2









m

1

4


=


m
p



l

(



C
2


x

+

l


S
1



)









m

2

2


=


M
t

+

m
p









m

2

3


=


m
p


l


C
1



C
2









m

2

4


=


-

m
p



l


S
1



S
2









m

3

3


=


m
p



l
2



C
2
2









m

3

4


=
0







m

4

4


=


m
p



l
2









M

1

1


=

(




m
11




m

1

2







m

1

2





m

2

2





)








M

1

2


=

(




m

1

3





m

1

4







m

2

3





m

2

4





)








M

2

2


=

(




m

3

3





m

3

4







m

3

4





m

4

4





)








c

1

1


=

2


(


M
c

+

m
p


)


x


x
˙









c

1

2


=

2


m
p


l


S
1



C
2



φ
˙









c

1

3


=


2


m
p


l


C
1



C
2


x


φ
˙


+


m
p



l
2



S

2

1




C
2
2



φ
˙


+


m
p



l
2



S
1



S
2



C
2




θ
˙

1










c

1

4


=



-

m
p



l



S
2

(


2


φ
˙



S
1


+


θ
˙

2


)


x

+


m
p



l
2



C
1
2



S

2

2




φ
˙


+

2


m
p



l
2



C
1



S
2
2




θ
˙

1










c

2

1


=



-

(


M
t

+

m
p


)



x


φ
˙


-


m
p


l


S
1



C
2



φ
˙










c

2

2


=
0







c

2

3


=



-

m
p



l


S
1



C
2




θ
˙

1


-

2


m
p


l


C
1



S
2




θ
˙

2










c

2

4


=



-

m
p



l


S
1



C
2




θ
˙

2


-

2


m
p


l


C
2



φ
˙










c

3

1


=


-

m
p



l


C
1




C
2

(

x
+

l


S
1



C
2



)



φ
˙









c

3

2


=
0







c

3

3


=


-
2



m
p



l
2



S
2



C
2




θ
˙

2









c

3

4


=


-
2



m
p



l
2



C
1



C
2
2



φ
˙









c

4

1


=


m
p



l

(


x


S
1



S
2


-

l


C
1
2



S
2



C
2



)



φ
˙









c

4

2


=

2


m
p


l


C
2



φ
˙









c

4

3


=


2


m
p



l
2



C
1



C
2
2



φ
˙


+


m
p



l
2



S
2



C
2




θ
˙

1










c

4

4


=
0







C

1

1


=

(




c
11




c

1

2







c

2

1





c

2

2





)








C

1

2


=

(




c

1

3





c

1

4







c

2

3





c

2

4





)








C

2

1


=

(




c
31




c

3

2







c

4

1





c

4

2





)








C

2

2


=

(




c

3

3





c

3

4







c

4

3





c

4

4





)








G
1

=


[

0


0

]

T








G
2

=


[


m
p


g

l


S
1



C
2




m
p


g

l


C
1



S
2


]

T








u
1

=


[


F
φ




F
x


]

T








u
2

=


[

0


0

]

T








F
1
*

=


[


-

F

r

φ



+

d
φ


-

F
rx

+

d
x


]

T








F
2
*

=


[

0


0

]

T





Eqs. (3)-(4) reflect the coupling relationship between the actuated jib/trolley motion and the unactuated payload swing motion, and the only solution to achieve rapid payload swing suppression and elimination is to take full advantage of this relationship. In order to facilitate the subsequent controller design, Equation (7) is decomposed into the following two equations:






M
11
{umlaut over (q)}
1
+M
12
{umlaut over (q)}
2
+C
11
{dot over (q)}
1
+C
12
{dot over (q)}
2
=u
1
+F*
1   (8)






M
12
{umlaut over (q)}
1
+M
22
{umlaut over (q)}
2
+C
21
{dot over (q)}
1
+C
22
{dot over (q)}
2
+G
2
=F*
2   (9)


It can be readily concluded that |M22|>0. Therefore, Equation (9) can be rewritten into the following form:






{umlaut over (q)}
2
=−M
22
−1
M
12
{umlaut over (q)}
1
−M
22
−1
C
21
{dot over (q)}
1
−M
22
−1
C
22
{dot over (q)}
2
−M
22
−1
G
2
+M
22
−1
F*
2   (10)


By substituting Equation (10) into Equation (8), the following can be obtained:







M{umlaut over (q)}

1
+C
1
{dot over (q)}
1
+C
2
{dot over (q)}
2
=u
1
+M
12
M
22
−1
G
2
+F*
1
−M
12
M
22
−1
F*
2   (11)


where







M=M

11
−M
12
M
22
−1
M
12







C

1
=C
11
−M
12
M
22
−1
C
21







C

2
=C
12
−M
12
−M
22
−1
C
22


Then, a positioning error vector e is introduced as:






e=[φ−φ
d
x−x
d]T=[eφex]T   (12)


where eφ and ex denote positioning errors of a jib and a trolley, respectively.


Besides, a sliding mode surface vector s is constructed as:






s=e+λė=[s
1
s
2]T   (13)


In this equation, λ∈custom-character2×2=diag(λ1 λ2) denotes a positive definite diagonal control matrix.


Next, an error dynamic model of the system solved from Eqs. (11)-(13) is as follows:







Mλ

−1
{dot over (s)}=u
1
+X
1
+X
2   (14)


where X1 denotes a bounded measurable vector, X2 denotes a lumped disturbance vector, and the specific expressions of these vectors are as follows:






X
1
=−C
1
{dot over (q)}
1
C
2
{dot over (q)}
2
+Mλ
−1
ė+M
12
M
22
−1
G
2





X2=F*1−M12M22−1F*2∥X1∥≤N   (15)


where N denotes a bounded constant.


It can be readily concluded that ∥M∥≠0. Therefore, Equation (14) can be further simplified as:






{dot over (s)}=u*
1
+X*
1
+C*
2   (16)


where






u*
1
M
−1
u
1
X*
1
M
−1
X
1
X*
2
M
−1
X
2   (18)


In this Equation, u*1, X*1, and X*2 denote a control input vector, a bounded measurable vector and a lumped disturbance vector which are newly constructed, respectively.


Assumption 1: in light of the fact that a payload is always beneath a jib/trolley during actual operation, the following reasonable assumption is made:













"\[LeftBracketingBar]"


θ
1



"\[RightBracketingBar]"


<

π
2


,




"\[LeftBracketingBar]"


θ
2



"\[RightBracketingBar]"


<

π
2






(
18
)







Assumption 2: regarding tower crane systems, a lumped disturbance vector X*2 and its first derivative with respect to time {dot over (X)}*2 are both bounded, and in addition, X*2, dφ, dx converge to 0 as time approaches infinity, which is mathematically expressed as:













X
2
*



<
β

,





X
˙

2
*



<
α

,



lim

t





X
2
*


=
0

,



lim

t





d
φ


=
0

,



lim

t





d
x


=
0





(
19
)







where β and α denote upper bounds of X*2 and {dot over (X)}*2 respectively.


Note 1: Since unknown disturbances dφ,dx are composed of internal disturbances and external disturbances, the system parameters and the friction-related coefficients adopted in the present embodiment refer to their nominal values.


S2: Control objective


The ultimate goal of controller design is to transport the payload to a target position quickly and steadily in the presence of uncertain/unknown dynamics and external disturbances. However, as mentioned above, it is impossible to directly control the swing of the payload due to the inherent underactuation of the crane system.


Therefore, the control objective is divided into two parts:

    • 1) Positioning: drive a jib or trolley to its target angle/position, which is mathematically expressed as:












lim

t




φ

=

φ
d


,



lim

t




x

=

x
d






(
20
)









    • 2) Swing elimination: in the meanwhile, payload swing is inhibited and eliminated, which is expressed as:















lim

t





θ
1


=
0

,



lim

t





θ
2


=
0





(
21
)







S3: Main results


In this embodiment, the overall framework designed for the DESMC method is given, and a nonlinear disturbance observer is constructed to accurately estimate lumped disturbance. Based on the estimated disturbance information, a new DEI is introduced to judge the pros and cons of disturbance acting on the tower crane system. Afterwards, by making full use of the constructed DEI and the estimated disturbance information, the whole process from design to stability analysis for a DESMC method is achieved.


S3.1: Design of nonlinear disturbance observer


First, an observed error vector {tilde over (X)}*2 is defined as:






{tilde over (X)}*
2
=X*
2
−{circumflex over (X)}*
2   (22)


where {circumflex over (X)}*2 denotes an estimated vector of X*2.


Next, according to the structure of the error dynamic model (16) of a tower crane system, the auxiliary function Γ1 in the following form is constructed:





{dot over (Γ)}1=−LΓ1+L(−u*1−X*1−Γ2)   (23)


where L∈custom-character2×2=diag(L1 L2) denotes a positive definite diagonal observation gain matrix, and the auxiliary function Γ2 is specifically expressed as:





Γ2=Ls   (24)


Therefore, an estimated vector of X 2 can be constructed as follows:






{circumflex over (X)}*
212   (25)


Theorem 1: by using the nonlinear disturbance observer designed according to Eqs. (23)-(25), the estimated disturbance vector and observed error vector are constrained within the following range:





{circumflex over (X)}*2∥≤P1, ∥{tilde over (X)}*2∥≤P2   (26)


where P1 and P2 denote upper bounds of {circumflex over (X)}*2 and {tilde over (X)}*2, respectively, and besides, {tilde over (X)}*2 converges to 0 as time approaches infinity, which is mathematically expressed as:











lim

t






X
˜

2
*


=
0




(
27
)







Proof: it follows from Eqs. (16) and (23)-(25) that:















X
^

.

2

*


=




Γ
˙

1

+


Γ
˙

2








=




-
L



Γ
1


+

L

(


X
2
*

-

s
.

-

Γ
2


)

+

L


s
.









=




-
L



Γ
1


+

L

(


-

u
1
*


-

X
2
*

-

Γ
2


)

+

L


s
.









=




-
L



Γ
1


+

L

(


X
2
*

-

s
.

-

Γ
2


)

+

L


s
.









=




-
L




X
^

2
*


+

L


X
2
*










(
28
)







Solving Equation (28) may lead to the following conclusion:











X
^

2
*

=







X
^

2
*

(
0
)



e

-
Lt



+


e

-
Lt






0
t



LX
2
*



e
La


da










X
^

2
*

(
0
)



e

-
Lt



+


e

-
Lt



L

β




0
t



e
La


da










X
^

2
*

(
0
)



e

-
Lt



+
β








X
^

2
*










X
^

2
*

(
0
)



+
β







(
29
)







Equation (28) is also followed by:











X
~

2
*

=







X
~

2
*

(
0
)



e

-
Lt



+


e

-
Lt






0

t






X
.

2
*



e
La


da










X
~

2
*

(
0
)



e

-
Lt



+


e

-
Lt



α




0
t



e
La


da










X
~

2
*

(
0
)



e

-
Lt



+


L

-
1



α









X
~

2
*










X
~

2
*

(
0
)



+




L

-
1





α








(
30
)







According to Equation (30), as time approaches infinity, the observed error vector can be calculated as:











lim

t








X
˜

2
*









L

-
1





α





(
31
)







Based on the setting ∥L∥»α of the present embodiment, the following conclusion can be drawn:











lim

t








X
˜

2
*




=


0



lim

t








X
ˆ

2
*





=
0





(
32
)







S3.2: Definition of DEI


Time-varying disturbance may impose significant effects on the transient control performance of a tower crane system. If the direction of disturbance is consistent with the desired direction of movement, the disturbance may be able to improve the control performance. Therefore, it is essential to conduct an in-depth study on the relationship between the disturbance effect and the stability/control performance of a controlled system. A definition of the DEI is given herein.


Definition 1: for the error model (16) of the tower crane system, the DEI is defined as:






X=sgn(s∘{circumflex over (X)}*2)=[X1 X2]Tcustom-character2   (33)


In this Equation, ∘ denotes a product of elements, and on this basis, the disturbance effect for the model introduced into the error system (16) is as follows:









{





χ
i

<

0
:

disturbance


effect


is


negative








χ
i

<

0
:

disturbance


effect


is


postive









χ
i

=

0
:

disturbance


effect


is


nill


,

i
=
1

,
2








(
34
)







As described in Definition 1, apart from negative effects that the disturbance may impose on the tower crane system, it also has positive effects. If xi=0, it indicates that disturbance imposes no effect on the system; and if xi>0 or xi<0, it indicates that disturbance is detrimental or beneficial, respectively. Considering that Definition 1 is given depending on whether the symbol of the disturbances is consistent with the desired movement, it is necessary to improve the control performance of the system by employing beneficial disturbances.


S3.3: Design and stability analysis for DESMC method


Firstly, non-negative Lyapunov candidate function V(t) is defined as follows:






V(t)=½sTs   (35)


Differentiating Equation (35) with respect to time, and substituting Equation (16) into the resulting equation, it is derived that:






{dot over (V)}(t)=sT{dot over (s)}=sT(u*1+X*1+X*2)   (36)


Construct a DESMC method according to the structure of Equation (36), which is expressed as:






u*
1
=−k
p
s−k
s sgn(s)−∥kuq2∥s−{circumflex over (X)}*2∘Θ(χ)   37)


where kp=diag(kp1, kp2) and ks=diag(ks1, ks2) denote positive definite control gain matrices, sgn(s)=[sgn(s1) sgn(s2)]T, Θ(χ)=diag[Θ(χ1), Θ(χ2)], where Θ(χi), i=1, 2 is expressed as follows:










Θ

(

χ
i

)

=

{





1
,





if



χ
i



0






0
,





if



χ
i


<
0




,

i
=
1

,
2






(
38
)







From Eqs. (17) and (37), it is easy to derive the actual input vector as:






u
1−1M[−kps−ks sgn(s)−∥kuq2∥s−{circumflex over (X)}*2∘Θ(χ)]  (39)


Theorem 2: the proposed DESMC method (39) can drive a jib and a trolley to a desired slew angle and a desired target displaced position, respectively, while eliminating payload swing angles, which is expressed as:











lim

t






[

φ


x



θ
1




θ
2


]

T


=


[


φ
d




x
d



0


0

]

T





(
40
)











lim

t






[


φ
.




x
.





θ
.

1





θ
¨

2


]

T


=


[

0


0


0


0

]

T





Proof: by substituting Equation (37) into Equation (36), the following is obtained:














V
.

(
t
)

=



s
T

(



-

k
p



s

-


k
s




sgn

(
s
)


-





k
u



q
2





s

+

X
1
*

+

(


X
2
*

-



X
^

2
*



Θ

(
χ
)



)


)







=




-

s
T




k
p


s

-


s
T






k
u



q
2





s

-


k
s




s



+


s
T



X
1
*


+


s
T

(


X
2
*

-



X
^

2
*



Θ

(
χ
)



)








=




-

s
T




k
p


s

-


s
T






k
u



q
2





s

-


k
s




s



+


s
T



X
1
*


+










(


X
2
*

-


X
^

2
*


)

+

(



X
^

2
*

-



X
^

2
*



Θ

(
χ
)



)








=





-

s
T




k
p


s

-


s
T






k
u



q
2





s

-


k
s




s



+


s
T



X
1
*


+


s
T




X
~

2
*


+
Ω














-

s
T




k
p


s

-


s
T






k
u



q
2





s

-


k
s




s



+


s


+



s




P
2


+
Ω













-

s
T




k
p


s

-


s
T






k
u



q
2





s

-


(


k
s

-
N
-

P
2


)




s



+
Ω








(
41
)







where Ω=sT({circumflex over (X)}*2−{circumflex over (X)}*2∘Θ(χ)) is an auxiliary function, then Ω proves to be non-positive, and by expanding Ω, Ω=Σi=12si({circumflex over (X)}*2i−{circumflex over (X)}*2iΘ(χi)) can be obtained, which is analyzed based on the following two cases.

    • 1) Case 1: χi≥0, i=1, 2, where in this case, disturbance is harmful/invalid. Therefore, it is required to eliminate such disturbance. At this moment, Θ(χi)=1, which is followed by si({circumflex over (X)}*2i−{circumflex over (X)}*2iΘ(χi))=0→Ω=0.
    • 2) Case 2: χi<0, i=1, 2, where in this case, disturbance is beneficial. At this moment, the relationship si{circumflex over (X)}*2i<0 always holds, and therefore it is required to retain disturbance, from which it can be concluded that Θ(χi)=0, and the following can be deduced:






s
i({circumflex over (X)}*2i−{circumflex over (X)}*2iΘ(χi))=si{circumflex over (X)}*2i<0→Ω<0


In general, the following conclusion can be drawn:





Ω=sT({circumflex over (X)}*2−{circumflex over (X)}*2∘Θ(χ))<0   (42)


Eqs. (41) and (42) are followed by:






{dot over (V)}(t)≤−sTkps−sT∥kuq2∥s−(ks−N−P2)∥s∥≤0   (43)


This shows that the controlled system is Lyapunov stable, and the Lyapunov candidate function V(t) is bounded, in the sense that:






V(t)∈L⇒s∈L  (44)


Besides, a sliding mode surface converges to 0, in the sense that:












lim

t




s

=


0



lim

t





s
i



=
0


,

i
=

1

,
TagBox[",", "NumberComma", Rule[SyntaxForm, "0"]]

2






(
45
)







In case of s=0, the following can be obtained according to the definition of the sliding mode surface (13):






e
jiėj=0, j=φ, x   (46)


It can be deduced from the calculation equation (46) that:











e
j

=


c
i



e


-

1

λ
i




t




,


e
.

=


-

1

λ
i





c
i



e


-

1

λ
i




t




,

j
=
φ

,
x




(
47
)







It follows from Equation (47) that:












lim

t





e
ϕ


=
0

,



lim

t






e
.

ϕ


=
0

,



lim

t





e
x


=
0

,



lim

t






e
.

x


=


0



lim

t




φ


=

φ
d



,



lim

t





φ
.


=
0

,



lim

t




x

=

x
d


,



lim

t





x
.


=
0

,



lim

t





φ
¨


=
0

,



lim

t





x
¨


=
0

,



lim

t





F

r

φ



=
0

,



lim

t





F
rx


=
0





(
48
)







Eqs. (26), (39) and (44) are followed by:






u
1
∈L

⇒F
φ
, F
x
∈L
  (49)


From Eqs. (45), (39) and (32) as well as conclusion in Assumption 2, it can be readily concluded that:












lim

t





u
1


=


0



lim

t





F
φ



=
0


,



lim

t





F
x


=
0





(
50
)







By substituting Equation (48) into Eqs. (3) and (4), respectively, the following conclusion may be drawn:






lC
2{umlaut over (θ)}1=2l{dot over (θ)}1S2{dot over (θ)}2−gS1   (51)






l{umlaut over (θ)}
2
=−l{dot over (θ)}
1
2
S
2
C
2
−gC
1
S
2   (52)


From Eqs. (48), (50), (19) and (2), it can be concluded that:






C
1
C
2{umlaut over (θ)}1−C1S2{dot over (θ)}1{dot over (θ)}2−S1C2{dot over (θ)}12−S1S2{umlaut over (θ)}2−C1S2{dot over (θ)}1{dot over (θ)}2−C2S1{dot over (θ)}22=0   (53)


By multiplying both ends of Equation (53) by l, it can be concluded that:






lC
1
C
2{umlaut over (θ)}1−lC1S2{dot over (θ)}1{dot over (θ)}2−lS1C2{dot over (θ)}12−lS1S2{umlaut over (θ)}2−lC1S2{dot over (θ)}1{dot over (θ)}2−lC2S1{dot over (θ)}22=0   (54)


By substituting the conclusions of Eqs. (51) and (52) into Equation (54), and after some tedious operations, the following can be deduced:






gC
1
S
1
C
2
2
+lS
1
C
2
3{dot over (θ)}12+lC2S1{dot over (θ)}22=0   (55)


where, the characteristic of C22+S22=1 is used in the process of derivation. According to Assumption 1, the relationship C2>0 always holds. Therefore, by dividing both ends of Equation (54) by C2, the following can be deduced:






S
1(gC1C2+lC22{dot over (θ)}12+l{dot over (θ)}22)=0   (56)


Next, following the conclusions C1>0 and C2>0 (see Assumption 1), it can be concluded that gC1C2+lC22{dot over (θ)}12+l{dot over (θ)}22>0 in Equation (56) always holds. Therefore, to ensure Equation (56) always holds, the following result is derived:






S
1=0⇒θ1=0{dot over (θ)}1=0,{umlaut over (θ)}1=0   (57)


By substituting conclusions in Eqs. (19), (48), (50) and (57) into Equation (1), it can be concluded that:






m
p
lx
d
C
2{umlaut over (θ)}2−mplxdS2{dot over (θ)}22=0   (58)


By integrating both ends of Equation (58) with respect to time, it can be concluded that:






m
p
lx
d
C
2{dot over (θ)}2=a1   (59)


where a1 denotes a to-be-determined constant.


A time inteual of Equation (59) can be calculated as:










S
2

=




a
1



m
p


l


x
d




t

+

a
2






(
60
)







where a2 is a constant. If a1≠0, then when t→∞:






S
2→∞  (61)


which contradicts S2∈L. Therefore, it can be concluded that a1=0, and the following can be further deduced from Equation (60):






S
2
=a
2→θ2=arcsin(a2)→{dot over (θ)}2=0, {umlaut over (θ)}2=0   (62)


By substituting the conclusions of Eqs. (57) and (62) into Equation (52), the following can be deduced:






gC
1
S
2=0→S2=0→θ2=0   (63)


The conclusion of Assumption 1 is used in the process of derivation.


According to the conclusions in Eqs. (48), (58) and (63), Theorem 2 can be proved.


Next, in order to better understand the design flow of the proposed control method, a schematic diagram of the method is given, as shown in FIG. 2.


S3. Simulation results and analysis In order to test the superior control performance and satisfactory robustness of the proposed DESMC method, two groups of numerical simulations are carried out by using MATLAB/SIMULINK. To be more precise, in Simulation 1, the proposed control method is compared with PD control method and adaptive control method to better verify the excellent control performance of the proposed control method; in Simulation 2, the uncertainty of system parameters and different external disturbance are considered to verify that the proposed control method has good robustness.









TABLE 2







Control gains










Controller
Control gains







PD Controller
k = 15, k = 20, kpx = 7, kdx = 10



Adaptive controller
k = 13.5, k = 25, kpx = 7, kdx = 12,




k = 100, ksx = 10



Proposed controller
k = 16, k = 25, kpx = 10, kdx = 13.2,




k = 40,




ksx = 10, L = diag(100 100),




λ = diag(10 15)










Simulation 1: in this group, the PD control method and adaptive control method are selected as control methods to better highlight the excellent control performance of the proposed control method. With cut-and-trial, control gains of the three control methods are shown in Table 2.


In this study, parameters of the tower crane system are set as follows:


Mt =3.5 kg, mp=1 kg, l=0.6 m, Frφ1=4.4, Frφ2=−0.5, ρφ=100, Frx1=4.4, Frx2=−0.5, ρx=100


For the sake of retaining generality, the initial slew angle of the jib, the initial trolley displacement, and the initial payload swing angle are set as 0, in the sense that:


φ(0)=0°, x(0)=0 m, θ1(0)=0°, θ2(0)=0°


In addition, the desired jib slew angle and desired position of trolley are set as follows:


φd=45°, xd=1 m


Simulation results of PD control method, adaptive control method and proposed control method are shown in FIG. 3, and corresponding quantization results are given in Table 3, including the following four performance indicators:

    • 1) Positioning errors of jib/trolley: Δφ and Δx;
    • 2) Maximum payload swing angles: θ1max and θ2max;
    • 3) Residual payload swing angles: θ1res and θ2res, defined as maximum payload swing angles after t=6 s;
    • 4) Energy consumption: ∫015Fφ2(t)dt and ∫015Fx2(t)dt.


As can be seen from FIG. 3 and Table 3, under the condition of similar positioning errors (respectively falling within the range of 0.02° and 0.001 m) and similar transport times (falling within the range of 6 s), the payload swing angles (θ1max: 5.3028°, θ2max: 2.8654°; θ1res: 0.0008°; θ2res: 0.0006°) in the proposed DESMC method are much smaller than the swing angles (θ1max: 8.9912°, θ2max: 5.7958°; θ1res: 1.1583°; θ2res: 4.0565°) in the PD control method and the swing angles (θ1max: 7.8383°, θ2max: 3.4531°; θ1res: 0.9039°; θ2res: 2.6509°) in the adaptive control method. Moreover, in the PD control method and the adaptive control method, the payload still swings back and forth even after the jib and trolley stop running, while the payload is almost static in the control method proposed in this embodiment. In addition, energy consumption in the proposed DESMC method is much lower than that in the above two control methods. All these simulation results show that the proposed control method has excellent control performance.









TABLE 3







Quantitative results for simulation group 1
















Δφ
Δx
θ1max
θ2max
θ1res
θ2res
015Fφ2(t)dt
015Fx2(t)dt


Controller
(°)
(m)
(°)
(°)
(°)
(°)
(N2 · m2 · s)
(N2 · s)





PD
0.1518
0.0008
8.9912
5.7958
1.1583
4.0565
178.1228
256.0058


controller










Adaptive
0.0901
0.0005
7.8383
3.4531
0.9039
2.6509
171.7246
304.8559


controller










Proposed
0.0003
0.0001
5.3028
2.8654
0.0008
0.0006
109.5841
174.8429


controller









Simulation group 2: In this group, the robustness of the proposed control method will be further verified. For this purpose, the following two cases are considered:


Case 1: uncertainty system parameters: payload mass mp, cable length l, and friction-related coefficients Frφ1 and Frx1 are changed to 2 kg, 0.7 m, 6 and 7.6, respectively, while the control gain in the proposed control method are kept the same as those in simulation group 1.


Case 2: external disturbances: in order to simulate external disturbances, such as a sudden gust of wind, the initial payload swing angle θ1(0) is set to be 2°, and when 7 s<t<8 s, sinusoidal disturbance with an amplitude of 3° and a cycle of 1 s is applied onto a payload swing angle θ2.


Simulation results for Case 1 are shown in FIG. 4. By comparison to FIG. 3, even in case of huge difference between an actual value and a nominal value of system parameters, the proposed control method can still ensure desired control performance. For example, parameter variation of the system has almost no impact on system positioning and payload swing elimination. In addition, as can be seen from FIG. 5, the proposed control method can quickly eliminate different external disturbance through the forward and backward movement of the jib and the trolley. Through the above analysis, it can be concluded that the proposed DESMC method has stronger robustness.


Embodiment 2

Embodiment 2 of the present disclosure provides a DESMC control system for 4-DOF tower crane systems, including:


a data acquisition module, which is configured to acquire parameter data and operating state data of the 4-DOF tower crane systems;


a disturbance judgment module, which is configured to conduct, based on the acquired data, disturbance estimation by using a preset nonlinear disturbance observer, and conduct judgment on beneficial disturbance and detrimental disturbance according to a preset DEI; and


a sliding mode control module, which is configured to add the beneficial disturbance to a preset sliding mode controller, remove the detrimental disturbance, drive a jib and a trolley to a desired slew angle and a desired target displaced position, respectively, and set a payload swing angle to be 0 or within a preset range.


Given that the operating method of the system is the same as the DESMC method for 4-DOF tower crane systems provided by Embodiment 1, the details are not repeated herein.


Embodiment 3

Embodiment 3 of the present disclosure provides a medium storing a program, where the program, when executed by a processor, implements steps of the DESMC method for 4-DOF tower crane systems as described in Embodiment 1 of the present disclosure.


Embodiment 4

Embodiment 4 of the present disclosure provides an electronic device, including a memory, a processor, and a program stored in the memory and executable on the processor, where the processor, when executing the program, implements steps of the DESMC method for 4-DOF tower crane systems as described in Embodiment 1 of the present disclosure.


Those skilled in the art should understand that the embodiments of the present disclosure may be provided as a method, a system or a computer program product. Therefore, the present disclosure may use a form of hardware examples, software examples, or examples with a combination of software and hardware. Moreover, the present disclosure may use a form of a computer program product that is implemented on one or more computer-usable storage media, including but not limited to a magnetic disk memory and a compact disc read-only memory (CD-ROM), which include computer-usable program code.


The present disclosure is described with reference to the flowcharts and/or block diagrams of the method, the device (system) and the computer program product according to the embodiments of the present disclosure. It should be understood that computer program instructions may be used to implement each process and/or each block in the flowcharts and/or the block diagrams and a combination of a process and/or a block in the flowcharts and/or the block diagrams. These computer program instructions may be provided for a general-purpose computer, a dedicated computer, an embedded processor, or a processor of any other programmable data processing device to generate a machine, so that the instructions executed by a computer or a processor of any other programmable data processing device generate an apparatus for implementing a specific function in one or more processes in the flowcharts and/or in one or more blocks in the block diagrams.


These computer program instructions may also be stored in a computer-readable memory that can instruct the computer or any other programmable data processing device to work in a specific manner, so that the instructions stored in the computer-readable memory generate an artifact that includes an instruction apparatus. The instruction apparatus implements a specific function in one or more processes in the flowcharts and/or in one or more blocks in the block diagrams.


These computer program instructions may also be loaded onto a computer or another programmable data processing device, so that a series of operations and steps are performed on the computer or the another programmable device, thereby generating computer-implemented processing. Therefore, the instructions executed on the computer or the another programmable device provide steps for implementing a specific function in one or more processes in the flowcharts and/or in one or more blocks in the block diagrams.


A person of ordinary skill in the art may understand that all or some of the procedures in the methods of the foregoing embodiments may be implemented by a computer program instructing related hardware. The program may be stored in a computer readable storage medium. When the program is executed, the procedures in the embodiments of the foregoing methods may be performed. The storage medium may be a magnetic disk, an optical disk, a read-only memory (ROM) or a random access memory (RAM), etc.


The foregoing is merely illustrative of the preferred embodiments of the present disclosure and is not intended to limit the present disclosure, and various changes and modifications can be made to the present disclosure by those skilled in the art. Any modifications, equivalent replacements, improvements, etc. made within the spirit and principle of the present disclosure shall be included within the protection scope of the present disclosure.

Claims
  • 1. A disturbance employment-based sliding mode control (DESMC) method for four-degrees-of-freedom (4-DOF) tower crane systems, comprising the following steps: acquiring parameter data and operating state data of the 4-DOF tower crane systems;conducting, based on the acquired data, disturbance estimation by using a preset nonlinear disturbance observer, and conducting judgment on beneficial disturbance and detrimental disturbance according to a preset disturbance effect indicator (DEI); andadding the beneficial disturbance to a preset sliding mode controller, removing the detrimental disturbance, driving a jib and a trolley to a desired slew angle and a desired target displaced position, respectively, and setting a payload swing angle to be 0 or within a preset range.
  • 2. The DESMC method for 4-DOF tower crane systems according to claim 1, wherein: an absolute value of a payload swing angle is less than 90°.
  • 3. The DESMC method for 4-DOF tower crane systems according to claim 1, wherein: a lumped disturbance vector and disturbances comprising internal disturbances and external disturbances both converge to 0 as time approaches infinity.
  • 4. The DESMC method for 4-DOF tower crane systems according to claim 1, wherein: an observed error vector is a difference between a lumped disturbance vector and a lumped disturbance estimation vector, the lumped disturbance estimation vector being a sum of a first auxiliary function and a second auxiliary function;the first auxiliary function is as follows: {dot over (Γ)}1=−LΓ1+L(−u*1−X*1−Γ2)the second auxiliary function is as follows: Γ2=Ls wherein L denotes a positive definite diagonal observation gain matrix, X*1 denotes a bounded measurable vector, u*1 denotes a control input vector, and s denotes a sliding mode surface vector.
  • 5. The DESMC method for 4-DOF tower crane systems according to claim 1, wherein: the DEI is as follows: χ=sgn(s∘{circumflex over (X)}*2)=[χ1 χ2]T∈2 wherein s denotes a sliding mode surface vector, {circumflex over (X)}*2 denotes a lumped disturbance vector, and ∘ denotes a product of elements.
  • 6. The DESMC method for 4-DOF tower crane systems according to claim 1, wherein: an actual input of sliding mode control is as follows: u1=λ−1M[−kps−ks sgn (s)−∥kuq2∥s−{circumflex over (X)}*2∘Θ(χ)]wherein, λ denotes a positive definite diagonal control matrix, M=M11−M12M22−1M12, kp=diag(kp1, kp2) , and ks=diag(ks1, Ks2) denote positive definite control gain matrices, and s denotes a sliding mode surface vector;sgn(s)=[sgn (s1) sgn(s2)]T, Θ(χ)=diag[Θ(χ1), Θ(χ2)],
  • 7. The DESMC method for 4-DOF tower crane systems according to claim 4, wherein: the sliding mode surface vector is as follows: s=e+λė=[s1 s2]T wherein λ denotes the positive definite diagonal control matrix, and e denotes a positioning error vector.
  • 8. The DESMC method for 4-DOF tower crane systems according to claim 5, wherein: the sliding mode surface vector is as follows: s=e+λė=[s1 s2]T wherein λ denotes the positive definite diagonal control matrix, and e denotes a positioning error vector.
  • 9. The DESMC method for 4-DOF tower crane systems according to claim 6, wherein: the sliding mode surface vector is as follows: s=e+λė=[s1 s2]T wherein λ denotes the positive definite diagonal control matrix, and e denotes a positioning error vector.
  • 10. A DESMC system for 4-DOF tower crane systems, comprising: a data acquisition module, which is configured to acquire parameter data and operating state data of the 4-DOF tower crane systems;a disturbance judgment module, which is configured to conduct, based on the acquired data, disturbance estimation by using a preset nonlinear disturbance observer, and conduct judgment on beneficial disturbance and detrimental disturbance according to a preset DEI; anda sliding mode control module, which is configured to add the beneficial disturbance to a preset sliding mode controller, remove the detrimental disturbance, drive a jib and a trolley to a desired slew angle and a desired target displaced position, respectively, and set a payload swing angle to be zero or within a preset range.
  • 11. A medium storing a program, wherein the program, when executed by a processor, implements steps of the DESMC method for 4-DOF tower crane systems according to claim 1.
  • 12. The medium storing a program according to claim 11, wherein: an absolute value of a payload swing angle is less than 90°.
  • 13. The medium storing a program according to claim 11, wherein: a lumped disturbance vector and disturbances comprising internal disturbances and external disturbances both converge to 0 as time approaches infinity.
  • 14. The medium storing a program according to claim 11, wherein: an observed error vector is a difference between a lumped disturbance vector and a lumped disturbance estimation vector, the lumped disturbance estimation vector being a sum of a first auxiliary function and a second auxiliary function;the first auxiliary function is as follows: {dot over (Γ)}1=−LΓ1+L(−u*1−X*1−Γ2)the second auxiliary function is as follows: Γ2=Ls wherein L denotes a positive definite diagonal observation gain matrix, X*1 denotes a bounded measurable vector, u*1 denotes a control input vector, and s denotes a sliding mode surface vector.
  • 15. The medium storing a program according to claim 11, wherein: the DEI is as follows: χ=sgn(s∘{circumflex over (X)}*2)=[χ1 χ2]T∈2 wherein s denotes a sliding mode surface vector, {circumflex over (X)}*2 denotes a lumped disturbance vector, and ∘ denotes a product of elements.
  • 16. The medium storing a program according to claim 11, wherein: an actual input of sliding mode control is as follows: u1=λ−1M[−kps−ks sgn(s)−∥kuq2∥s−{circumflex over (X)}*2∘Θ(χ)]wherein, λ denotes a positive definite diagonal control matrix, M=M11−M12M22−1M12, kp=diag(kp1, kp2), and ks=diag(ks1, Ks2) denote positive definite control gain matrices, and s denotes a sliding mode surface vector; sgn(s)=[sgn(s1) sgn(s2)]T, Θ(χ)=diag [Θ(χ1), Θ(χ2)],
  • 17. The medium storing a program according to claim 14, wherein: the sliding mode surface vector is as follows: s=e+λė=[s1 s2]T wherein λ denotes the positive definite diagonal control matrix, and e denotes a positioning error vector.
  • 18. The DES12. The medium storing a program according to claim 15, wherein: the sliding mode surface vector is as follows: s=e+λė=[s1 s2]T wherein λ denotes the positive definite diagonal control matrix, and e denotes a positioning error vector.
  • 19. The medium storing a program according to claim 16, wherein: the sliding mode surface vector is as follows: s=e+λė=[s1 s2]T wherein λ denotes the positive definite diagonal control matrix, and e denotes a positioning error vector.