Documente Academic
Documente Profesional
Documente Cultură
I.
INTRODUCTION
In recent years, numerous methodologies of
stabilization and tracking control design for nonlinear
underactuated systems have been studied. These include
linear design techniques based on Jacobian linearization,
gain scheduling, sliding mode control and partial feedback
linearization, as well as linear/nonlinear adaptive control
[1][2]. One of the systematic and effective ways for nonlinear state-feedback control design for underactuated systems is the method based on the solution of a state-dependent Riccati equation (SDRE), which relies on the original
nonlinear state-space description of the system and creates
a separate linear quadratic optimal control problem (LQR)
at each time step. As a result, tradeoff between acceptable
control accuracy (state error) and control input effort is
ensured, which is a property not generally found in other
nonlinear control design methods [3].
As a significant class of nonlinear unstable underactuated mechanical systems, inverted pendulum systems
(IPSs) are well-suited for verification and practice of
ideas and techniques emerging in control theory and
robotics [4]. Stabilization of a set of interconnected
pendulum links in the unstable upright position is
considered a benchmark control problem which has been
solved by attaching the pendulum links to a base that
moves in a controlled linear manner (classical or linear
IPSs) or in a rotary manner in a horizontal plane (rotary
IPSs) [5]. Principles of modeling and control of IPSs can
further be considered as the basic starting point for the
II.
( t ) = ( 0 ( t ) 1 ( t ) n ( t ) )
209
(1)
S. Jadlovsk and J. Sarnovsk Application of the State-Dependent Riccati Equation Method in Nonlinear Control Design for Inverted Pendulum Systems
u (t ) = F (t )
u (t ) = M (t )
(5)
( t )
=
( t ) M( ( t) )
x ( t ) = Ax ( t ) + bu ( t )
y ( t ) = Cx ( t ) + du ( t )
) = ( x (t )
1
(9)
(3)
I
0
0 0
x (t ) =
x ( t ) + -1 + -1 u ( t ) . (8)
-1
0 -M N
-M R -M V
y (t ) = h ( x (t ) , u (t ))
( t )
(7)
V ( t ) u( t ) N ( t ) ,( t ) ( t ) R( ( t) )
)(
1
(2)
x (t ) = f ( x (t ) , u (t ))
d L ( t ) L ( t ) D ( t )
+
= Q* ( t )
dt ( t ) ( t ) ( t )
M ( ( t ) ) ( t ) + N ( t ) , ( t ) ( t ) + R ( ( t ) ) = V ( t ) u ( t ) (6)
x ( i + 1) = Fx ( i ) + gu ( i )
y ( i ) = Cx ( i ) + du ( i )
x2 ( t ) ... x2 n + 2 ( t ) ) (4)
T
(10)
210
SISY 2013 IEEE 11th International Symposium on Intelligent Systems and Informatics September 26-28, 2013, Subotica, Serbia
III.
k LQR ( i ) = ( r + g T P ( i ) g ) g T P ( i ) F .
1
(14)
F T PF F T Pg ( r + gT Pg ) gT PF + Q = 0
1
(15)
k LQR =
1 T
g P
r
(16)
u ( i ) = k LQR x ( i ) .
(17)
u ( i ) = k LQR x ( i ) + k ffLQR w ( i )
(18)
c1 I ( F gk LQR )
(19)
(11)
u ( i ) = k LQR ( i ) x ( i )
N 1
J LQR ( i ) = xT ( i ) Qx ( i ) + uT ( i ) ru ( i )
(12)
k =0
P ( i 1) = FT P ( i ) F FT P ( i ) g ( r + gT P ( i ) g) gT P ( i) F + Q (13)
1
x (t ) = f ( x (t )) + g ( x (t )) u (t )
(20)
211
S. Jadlovsk and J. Sarnovsk Application of the State-Dependent Riccati Equation Method in Nonlinear Control Design for Inverted Pendulum Systems
x (t ) = A ( x (t )) x (t ) + b ( x (t )) u (t )
(21)
R ( ( t ) ) = Rm ( ( t ) ) ( t ) .
The extended control law which ensures that the base will
maintain the predefined reference position is defined in
an analogical form to (18):
(22)
k ffSDRE ( x ( i ) ) =
sin1 ( t )
0 r1
0
1 ( t )
sin2 ( t )
0
r2
Rm ( ( t ) ) = 0
2 ( t )
0
0
0
. (24)
0
sinn ( t )
rn
n ( t )
0
gi
1 2 2
1
2
J 0 + m1l0 + 4 m1l1 sin 1 ( t ) 2 m1l0l1 cos1 ( t ) 0 ( t )
+
1
1 ( t )
m1l0l1 cos 1 ( t )
J1
1 2
1
11 0( )
1( )
8
= M (t )
+ 1
m1 gl1 sin 1 ( t ) 0
2
where Fi = F ( x ( i ) ) and gi = g ( x ( i ) ) are the discretetime pseudo-linear state-space matrices [9][10]. Since Fi
and gi are treated as being constant (although different)
at every i-th time step, the feedback control law,
optimized for the momentary measured/estimated state of
a nonlinear IPS is specified to be:
1
u ( i ) = k SDRE ( x ( i ) ) x ( i ) = gi Pi x ( i )
r
))
(30)
IV.
I
0
x (t ) +
-1 u ( t ) (25)
-M -1 N
-M V
x ( i + 1) = Fi x ( i ) + gi u ( i )
( (
c1 I Fi gi k SDRE ( x ( i ) )
(27)
212
SISY 2013 IEEE 11th International Symposium on Intelligent Systems and Informatics September 26-28, 2013, Subotica, Serbia
60
180
40
160
140
SDRE - Q
50
30
20
10
LQR - Q
120
SDRE - Q
100
80
60
40
20
0
-10
0
0.5
1.5
2.5
3.5
-20
0
10
12
14
16
18
20
20
10
40
SDRE - Q
30
30
0
-10
-20
LQR - Q
SDRE - Q
20
10
0
-10
-20
-30
-30
-40
0
-40
0.5
1.5
2.5
3.5
-50
0
10
12
14
16
18
20
213
S. Jadlovsk and J. Sarnovsk Application of the State-Dependent Riccati Equation Method in Nonlinear Control Design for Inverted Pendulum Systems
[3]
[4]
[5]
V.
CONCLUSION
The purpose of this paper was to provide a practicallyoriented overview of the nonlinear control design
approach based on the state-dependent Riccati equation
(SDRE). As a systematic and flexible way of designing
nonlinear feedback controllers, the SDRE technique
approximates the solution of the infinite horizon optimal
control and serves as a nonlinear counterpart to the LQRbased control design. The individual steps of the SDRE
control design were illustrated on an important
representative of nonlinear mechanical underactuated
systems: the generalized (n-link) system of classical and
rotary inverted pendula.
The performance of the controller designed via the
SDRE control technique was verified using the
simulation model of a rotary single inverted pendulum
system, and the results were compared to those yielded
by the standard LQR control design, which relies on a
linearized model around the equilibrium. Although the
accuracy of a linear approximation is generally sufficient
for control algorithm design for underactuated systems, it
was nevertheless shown that the SDRE-based controller,
which preserves the original nonlinear system dynamics,
gradually outperforms the conventional discrete-time
LQR algorithm whenever the distance from the
equilibrium point increases.
[6]
[7]
[8]
[9]
[10]
[11]
[12]
[13]
[14]
ACKNOWLEDGMENT
This contribution is the result of the Vega project
implementation Dynamic Hybrid Architectures of the
Multi-agent Network Control Systems (No. 1/0286/11),
supported by the Scientific Grant Agency of Slovak
Republic 70%, and of the KEGA project
[15]
[16]
214