473068.burul Kolonic Matusko Iz CD-A
473068.burul Kolonic Matusko Iz CD-A
473068.burul Kolonic Matusko Iz CD-A
Control Theory
Ivan Burul, Fetah Koloni, Jadranko Matuko
Department of Electric Machines, Drives and Automation
Faculty of Electrical Engineering and Computing
Unska 3, Zagreb, Croatia
Tel.: +38516129824 Fax: +38516129705
[email protected], [email protected], [email protected]
ABSTRACT This paper describes a robust controller
design procedure based on H
theory
based crane controller is designed in order to minimize
friction effect. H
based
controller design is given in section V.
II B
BASEB C0NTR0L
H
(1)
In that sense H
(10)
These equations show how the specification of an upper
bound on the sensitivity function S leads to a condition on
the H
optimal controller is obtained by solving the problem:
( )
min N K
K
, (12)
where K is a stabilizing controller.
G
u
K
w z
y
y
A
u
A
Fig. 3 Standard plant (G) with controller (K) and uncertainty ()
Fig. 3 shows the general framework that will be used in
this article. Any control problem within a linear setting
may be written in this form.
The standard plant G incorporates the plant and provides
an interconnection structure, defining the way in which the
uncertainty block and the controller K act on the system.
The inputs to the standard plant are: the output of the
uncertainty block u
control design problem can be defined as finding the
largest such that there exists a controller K(s) for which :
( )
( ) ( )
, 1, : 1 T s s s
wz
s A A s
. (13)
An important consequence of (13) for the rest of this paper
is that the infinity norm of the uncertainty must be
bounded. Otherwise, no solution can be found [9].
If no uncertainty block is present, a direct computational
solution is available, based on the solution of two algebraic
Ricatti equations. This solution has been implemented in
the software package MATLAB using a small adaptation
of the algorithm given by Glover and Doyle [8].
III BESCRIPTI0N 0F TBE uANTRY CRANE
PR0CESS
Simplified single gantry crane model is depicted in Fig.
4, where x
c
is the cart position, x
p
and y
p
determine
position of the center of the mass of pendulum, M
c
is the
mass of the cart, M
p
is the mass of pendulum, is the sway
angle of pendulum and F
c
is external force acting on the
cart. Zero sway angle, corresponds to a suspended
pendulum vertical rest down position.
p
x
p
y
c
x
k
M
0
c
F >
o
p
M
C
M
0 o >
Fig. 4. Single pendulum gantry crane system
Mathematical equations of the motion can be defined via
Lagrange equations. Nonlinear equations of motion are by
following set of equations [10]:
( )
( )
2
2 2
2 2 2
2
( )
( )
( )
( ) ( )
( )
p p p eq c
c
c p p c p p
p p p p p p c p p
c p p c p p
d
I M l B x t
d dt
x t
dt M M I M M l
d
M l B t I M l F M l g t
dt
M M I M M l
o o
| |
+
|
\ .
=
+ +
| |
+ + +
|
\ .
+
+ +
(14)
( ) ( )
2
2 2
2
( ) ( )
( )
( )
( )
( )
c p p p c p p
c p p c p p
p p eq c c p p
c p p c p p
d
M M M gl t M M B t
d dt
t
dt M M I M M l
d
M l B x t F M l
dt
M M I M M l
o o
o
| |
+ +
|
\ .
=
+ +
| |
|
\ .
+
+ +
(15)
Upon linearization of the nonlinear single gantry crane
model following state space linear model P is obtained:
0 0 1 0 0
0 0 0 1 0
0
1 2 3 7
0
4 5 6 8
x x
c c
U
m
H H H H x x
c c
H H H H
o o
o o
( ( ( (
( ( ( (
( ( ( (
= +
( ( ( (
( ( ( (
, (16)
1 0 0 0
0 1 0 0
x
c
x
c
x
c
o
o
o
(
(
( (
(
=
( (
(
(
, (17)
where:
1.5216 11.6513 0.0049
1 2 3
26.1093 26.8458 0.0841
4 5 6
H H H
H H H
= = =
= = =
and:
1.5304 3.5261
7 8
H H = = .
A. Friction Model
As the uncertainty model is not suitable to incorporate
the friction effect in a standard plant setting [9], an
alternative solution needs to be used. The usual approach
to the reduction of friction influence is the construction a
disturbance observer. In that case an extra state is added to
the controller to be able to estimate the friction force. The
result then resembles the servo compensator approach of
Davison [11] for a constant disturbance input signal, which
uses extra dynamics to describe this signal.
To be able to incorporate the friction phenomenon in the
standard plant setting, but without the necessity of adding
dynamics, the dry friction force is modeled as an external
disturbance force. Hence, disturbance input F
tr
to the
standard plant P is added, as it is shown at Fig. 5.
Iv C0NTR0LLER BESIuN
The H
optimal
solution guarantees the system stability) and thus it is
ensured that the steady state error for speeds (linear and
angular), and swinging angle of pendulum are zero.
0, 6
2
0
3
0,1
4
W
W
W
=
=
=
(22)
Weighting function W
u
which determines
complementary sensitivity function T is chosen as:
1.05s 30
s 10000
W
u
+
=
+
. (23)
The series of experiments showed that for this selection
of weighting functions system is the best described when
the weighting functions W
tr
which determines the force of
friction is chosen as:
39 W
tr
= . (24)
Weighting function for the measurement noise W
n
is
chosen as:
3
10 W
n
= . (25)
In this paper reference signals are not weighted, so their
weighting functions are set to value 1.
v EXPERINENTAL RES0LTS
The designed H
controller
Fig. 10 Control signal of PP controller
187
The next comparison of the two controllers is shown in
Fig. 9 and Fig. 10 which shows a control signal. While
pole placement controller leads to larger control signal
amplitudes to start the pendulum movement, H
controller
produces more dynamic control signal when approaching
the steady state (from t=2s to t=3s). Such the dynamic
control signal prevents the trolley to stop due to static
friction force. In the case of pole placement controller,
control signal in that time period is not large enough to
overcome the static friction force.
vI C0NCL0SI0N
Considering the obtained results, the H
optimization
based controller meets all the requirements. The main goal
of this work, fast trolley positioning with minimization of
pendulum swinging is successfully executed and proved to
be successful in relation with pole placement method.
Comparison of two mentioned methods was done
experimentally and clearly confirmed the superiority of the
H
controller.
H
Control Theory, Fuji Electric Co., Ltd, Tokyo, Japan.
[6] B. Armstrong, P. Dupont, C. Canudas, A survey of models
analysis tools, and compensation methods for the control of
the machines with friction, Automatica 30 (70) (1994)
10831138.
[7] J.De Cuyper, J. Swevers, M. Verhaegen, P.Sas, H
Feedback Control for signal tracking on a 4 poster test rig
in the Automotive Industry.
[8] Kemin Zhou, Keith Glover, John Doyle, Robust and
Optimal Control, Prentice Hall, 1995.
[9] Gert-Wim van der Linden, Paul F. Lambrechts, Control of
an Experimental Inverted Pendulum with Dry Friction,
IEEE, 0272-1708/93, 1993.
[10] Quanser Inc, Linear Experiment #4: Pole Placement,
Linear Motion Servo Plants: IP02, Quanser, Student
Handout.
[11] E.J. Davison and A. Goldenberg, Robust control of a
general servomechanism problem: The servo
compensator, Automatica vol. 11. pp. 461-471, 1975.
188