Upload
mtanzania-mtanzania
View
246
Download
0
Embed Size (px)
Citation preview
MODERN CONTROL SYSTEMS ENGINEERING
COURSE #: CS421
INSTRUCTOR: DR. RICHARD H. MGAYA
Date: October 25th, 2013
Optimal Control System Design
Consider a state differential equation:
The system can be represented in a general form:
(i)
where
x(t) states of the system
u(t) control effort
Optimal control:
Seeks to maximize the return from a system at minimum cost
Finding the control u which causes the system (i) to follow an optimal trajectory x(t) that minimizes the performance criterion or cost function
(ii)
Dr. Richard H. Mgaya
)()( tButAxx
ttutxgx ),(),(
1
0
),(),(
t
t
ttutxhJ
Optimal Control System Design
Types of Optimal Control Problems
Terminal control problems: Deals with bringing the system as close as possible to a given terminal state within a given period of time
Example an automatic aircraft landing system
Optimal policy-Minimizing errors in state vector at the point of landing
Minimum-time control problem: Reaching the terminal state in shortest time possible
Example Bang-bang control policy
Control is set to umax initially, switching to umin at some specified time
Minimum energy control problem: Transferring of the system from initial state to final state with minimum expenditure of control effort
Example Satellite control
Dr. Richard H. Mgaya
Optimal Control System Design
Types of Optimal Control Problems
Regulator control problems: System initially displaced from the equilibrium, will return to equilibrium state in such a manner so as
to minimize a given performance index
Example an autopilot for aircraft, shipping vessel or yacht
Optimal policy-Minimizing errors between actual course and desired course
Tracking control problem: Cause the state of the system to track as close as possible some desired state time history in such a manner so
as to minimize a given performance index
Example missile tracking a target
Dr. Richard H. Mgaya
Optimal Control System Design
Selection of Performance Index
Decision on the type of performance index depends on the nature of the control problem
Example: Autopilot system - yacht
Goal Maintain course
Minimize the error e , between desired course d , and the actual course a , with minimum transient period
Source of disturbance wind, waves and currents
Requirements
Minimize distance off-track, ye(t) wandering off track increases the distance
Minimize course or heading error e
Minimize radar activity a minimize control energy Minimize forward speed loss ue(t) yaw movement increases angle of
attack resulting to increased drag and forward speed loss
Dr. Richard H. Mgaya
Optimal Control System Design
Selection of Performance Index
General performance index:
Control variable:
x1 = ye(t) , x2 = e , x3 = ue(t) , and u = a
Performance index equation
If the state and control variables are square then the performance index becomes quadratic performance index
Dr. Richard H. Mgaya
1
0
)(),(),(),(
t
t
aeee dtttuttyhJ
1
0
1333222111
t
t
dturxqxqxqJ
1
0
t
t
dtRuQxJ
Optimal Control System Design
Quadratic Performance Index
A linear system with quadratic performance index has a solution that yield a linear control law
Therefore,
General form
Q and R are control and weight matrix respectively, J is a scalar quantity
Dr. Richard H. Mgaya
1
0
321
2
1
2
33
2
22
2
11
t
t
dturxqxqxqJ
)()( tKxtu
1
0
1
33
2
1
33
22
11
321
00
00
00t
t
dturu
x
x
x
q
q
q
xxxJ
1
0
t
t
TT dtRuuQxxJ
Optimal Control System Design
Quadratic Performance Index
When is J finite?
Can converge to a limit or diverge to infinity
Note:
If (A, B) is stabilizable, then the uncontrollable eigen values are of A have negative real part
If (A, C) is detectable, then the unobservable eigen values are of A have negative real part
Suppose (A, B) is stabilizable and (A, M) is detectable where Q = MTM and u(t) = -Kx(t), then the cost function J is finite for every x(0) Rn if and only
if Re[(A + BK)] < 0
Note:
Dr. Richard H. Mgaya
0)]([ ARe
Optimal Control System Design
Linear Quadratic Regulator, LQR
Provides optimal control law for a linear system with quadratic performance index
Continuous Form
Functional equation:
from eqn. i and ii a Hamilton-Jacobi can be expressed as follows
Dr. Richard H. Mgaya
1
0
),(min),(
t
t
u dtuxhtxf
0),(
))0((),(
1
0
txf
xftxf
),(),(min uxg
x
fuxh
t
fT
u
Optimal Control System Design
Linear Quadratic Regulator, LQR
Continuous Form
Substitution
Introduce the relationship of the form:
where P is square and symmetric, Riccati matrix
Dr. Richard H. Mgaya
1
0
)(:),(
:),(
t
t
TT dtRuuQxxJuxh
BuAxxuxg
Pxxtxf T),(
)(min BuAx
x
fRuuQxx
t
fT
TT
u
Optimal Control System Design
Linear Quadratic Regulator, LQR
Continuous Form
Substitution:
(iii)
In order to minimize u then
Dr. Richard H. Mgaya
Pxx
f
Pxx
f
Pxt
xt
f
T
T
T
2
2
)(2min BuAxPxRuuQxxxt
Px TTTu
T
022
PBxRuu
tf
TT
Optimal Control System Design
Linear Quadratic Regulator, LQR
Optimal control law:
(iv)
where K = -R-1BTP
Substitution: eqn. (iv) to eqn. (iii)
But
then
(v)
Equation (v) belong to a class known as matrix Riccati equations
Dr. Richard H. Mgaya
PxBRu Topt1
xPBPBRPAQxxPx TTT )2( 1
xPAPAxPAxx TTT )(2
Kxuopt
PBPBRQPAPAP TT 1
Optimal Control System Design
Linear Quadratic Regulator, LQR
Discrete Form
Discrete solution to state equation:
or
Discrete quadratic performance index:
Solution of matrix Riccati is solved recursively for P and K
Dr. Richard H. Mgaya
)()()()()1( kTuTBkTxTATkx
1
0
))()()()((N
k
TT TkRukukQxkxJ
)()()()()1( kuTBkxTAkx
)()()()()()()1( 1 TAkNPTBTBkNPTBTRkNK TT
Optimal Control System Design
Linear Quadratic Regulator, LQR
Recursive equation for P:
Boundary condition:
Optimal regulator:
Dr. Richard H. Mgaya
BuAxx x
r
-
+ uC y
K
)1(()()()()1(()()(
))1(())1(()1(
kNKTBTAkNPkNKTBTA
kNTRKkNKTQkNP
T
T
0)( NP
Optimal Control System Design
Linear Quadratic Regulator, LQR
Example: The plant and performance index are given as follows:
Determine Riccati matrix P, state feedback matrix K and the
closed-loop eigenvalues
Soln:
Dr. Richard H. Mgaya
xy
ux
x
x
x
01
1
0
21
10
2
1
2
1
dtuxxJ T
0
2
21
10
PBPBRQPAPAP TT 1
Optimal Control System Design
Linear Quadratic Regulator, LQR
Dr. Richard H. Mgaya
222122
121112
2221
1211
2
2
21
10
ppp
ppp
pp
ppPA
2
222122
22122112
2221
22
12
2221
1211
2221
12111
1011
0
ppp
pppp
ppp
p
pp
pp
pp
ppPBPBR T
22122111
2221
2221
1211
2221
10
pppp
pp
pp
ppPAT
Optimal Control System Design
Linear Quadratic Regulator, LQR
Four Simultaneous Equations:
P is symmetric, i.e., p21 = p12
Dr. Richard H. Mgaya
010
02
222
2
2
222122
22122112
22122111
2221
222122
121112
ppp
pppp
pppp
pp
ppp
ppp
0122
02
02
02
2
2222122212
2212121122
2212221211
2
121212
ppppp
ppppp
ppppp
ppp
Optimal Control System Design
Linear Quadratic Regulator, LQR
Solving simultaneous equations:
P is symmetric, i.e., p21 = p12
p12 = p21 = 0.732
From the last simultaneous eqn.:
p22 = 0.542
From second simultaneous eqn:
Dr. Richard H. Mgaya
022 122
12 pp
732.2 732.0 2112 andpp
0464.24 222
22 pp
0 142 2222212 ppp
542.4 542.022 andp
403.2
0)542.0732.0(542.0)732.02(
11
11
p
p
Optimal Control System Design
Linear Quadratic Regulator, LQR
Ricatti matrix P:
Feedback Matrix K
Closed-loop eigen values:
Dr. Richard H. Mgaya
542.0732.0
732.0403.2
2221
1211
pp
ppPA
542.0732.0
732.0403.21011 PBRK T
542.0732.0K
0542.0732.01
0
21
10
0
0
s
s
341.0271.1,0732.1542.2,0542.2732.1
1
0542.0732.0
00
21
1
2,1
2 jssss
s
s
s
0 BKAsI
Optimal Control System Design
Linear Quadratic Regulator, LQR
Generally, for 2nd order systems if Q is diagonal and R is scalar then the elements for Riccati matrix are given as:
Dr. Richard H. Mgaya
r
qpaa
b
rp
r
bqaa
b
rpp
apapppr
bp
22122
22222
2
22
2
2112
21212
2
2112
221221222212
2
211
2
Optimal Control System Design
Linear Quadratic Regulator, LQR
Tracking Problem:
Control effort to drive the plant state vector x(t) to follow a desired trajectory r(t) in optimal manner
Continuous Form
Performance index to be minimized:
State tracking equation:
(vi)
Boundary conditions for tracking vector s:
Dr. Richard H. Mgaya
1
0
)()(
t
t
TT dtRuuxrQxrJ
QrsPBBRAs TT )( 1
0)( 1 ts
Optimal Control System Design
Linear Quadratic Regulator, LQR
Tracking Problem:
Optimal control law:
Let
(vii)
and
Then
If r(t) is known then the system can be designed to follow the command v(t) from eqn. (vi) and (vii)
Dr. Richard H. Mgaya
sBRv T1
sBRPxBRu TTopt11
PBRK T1
Kxvuopt
Optimal Control System Design
Linear Quadratic Regulator, LQR
Optimal Controller for Tracking System
Discrete Form
Discrete quadratic performance index
Dr. Richard H. Mgaya
BuAxx xr
-
+ optuC
y
K
QrsPBBRAs TT )( 1TBR 1
s v
Tracking vector Command vector
1
0
)()()()()()(N
k
TT TkRukukxkrQkxkrJ
Optimal Control System Design
Linear Quadratic Regulator, LQR
Discrete Form
Discrete state tracking equation:
where F(T) and G(T) are control and transition matrices
Boundary condition:
Command vector v:
Optimal control at time (kT):
Thus,
Dr. Richard H. Mgaya
)()()()()1( kNrTGkNsTFkNs
0)( Ns
)(1 kNsBRkNv T
)()()()( kTxkTKkTvkTuopt
)()()()()1( kTuTBkTxTATkx opt
Robust Control System Design
Deals with finding the control law which maintains system response and error signals within prescribed tolerances despite
the effect of uncertainties on the system
Form of uncertainties:
Disturbance effect on the plant
Measurement noise
Modeling error due to nonlinearity
Model uncertainties due to time varying parameter
Generally, physical system are nonlinear
Linearized for small perturbation about an operating point
Controller design for that operating point
Dr. Richard H. Mgaya
Robust Control System Design
If we consider a family of operating points the uncertainty in the nominal model is taken into account by considering all
possible variations in the family of models
Controller is said to have robust stability if it can stabilize all plants within the family
Controller is said to have robust performance if all the plants within the family meet a given performance specification
Trade-off between conflicting requirements is also taken into account
Dr. Richard H. Mgaya
Robust Control System Design
Consider a feedback control system bellow
N(s) and D(s) are disturbance and measurement noise
(viii)
Substituting U(s) and B(s) in Y(s)
(ix)
Dr. Richard H. Mgaya
)]()()[()(
)()()(
)()()()(
sBsRsCsU
sNsYsB
sDsUsGsY
)()(1
)()()(
)()(1
)(
)()(1
)()()()(
sCsG
sNsCsG
sCsG
sD
sCsG
sRsCsGsY
Robust Control System Design
Introduce sensitivity function S(s) relates Y(s) and D(s) when R(s) = N(s) = 0
Complementary sensitivity function:
If N = 0 eqn. (viii) becomes:
If T(s) = 1 and S(s) = 0, then perfect set point for tracking and disturbance rejection
If N(s) 0 then
Therefore,
Dr. Richard H. Mgaya
)()(1
1)(
)(
)(
sCsGsS
sD
sY
)()()()()( sDsSsRsTsY
)()(1
)()()(1)(
sCsG
sCsGsSsT
)()()()()()()( sNsTsDsSsRsTsY
rejectionNoisejTTrackingjT ,0)( , ,1)(
Robust Control System Design
Model Uncertainties
Unstructured model uncertainties relates to the unmodelled effects such as plant disturbance and are related to the nominal
plant as either additive or multiplicative
Additive uncertainties, (a):
(x)
Multiplicative uncertainties, (b):
(xi)
Dr. Richard H. Mgaya
)()()( slsGsG an
)( )(1)( sGslsG nm
)(sla
)(sGn+
+
)(slm
)(sGn+
+
)(b)(a
Robust Control System Design
Model Uncertainties
Structured model uncertainties relates to parametric variation in the plant dynamic
Uncertain variation in coefficients of the differential equation
Normalized System Input:
All inputs to the control loop are normalized
Inputs , i.e., changes in set-point or disturbance, are represented by V(s)
where V1(s) and W(s) are bounded input and input transfer function, .i.e.,
the input weight, respectively
Dr. Richard H. Mgaya
)()()()( 1 sWsWsVsV
ssWsV
sWsV
1)(1)( :Step
1)(1)(:Impulse
1
1
Robust Control System Design
Normalized System Input:
Set of bounded input : 2-norm of the input signals
Transformation to frequency domain Parsevals Theorem
Dr. Richard H. Mgaya
1)(
)(
2
1)(
22
2
1
d
jW
jVtv
0
212
2
1 1)()( dttvtv
Robust Control System Design
Linear Quadratic H2 Optimal Control
Consider the performance index of the linear quadratic tracking problem
In scalar for with u not constrained = Integral Square Error
H2 - Optimal control problem:
Find a controller c(t) such that the 2-norm of ISE is minimized for a specific input
Transformation using Parsevals Theorem:
Dr. Richard H. Mgaya
1
0
)(2t
t
dtteISE
1
0
)()(
t
t
TT dtRuuxrQxrJ
djEte cc22
2)(
2
1min)(min
Robust Control System Design
Linear Quadratic H2 Optimal Control
H2 - Optimal control problem:
From set of eqn. (viii)
If B(s) and Y(s) are substituted and U(s) be written as C(s)E(s), then
Since, V(s) = W(s) for specific input
Thus,
Therefore, H2 optimal controller minimizes the average magnitude of sensitivity function S(j) weighted by W(j)
Dr. Richard H. Mgaya
)()()()(
)()()()()(1
1)(
sNsDsRsS
sNsDsRsCsG
sE
djWjSte cc22
2)()(
2
1min)(min
Robust Control System Design
Linear Quadratic H Optimal Control
Assumption: The input V(j) belong to a set of bounded function with weight W(j)
Each input V(j) in a set will result in a corresponding error, E(j)
H - Optimal control problem:
Minimize the worst error that can arise from any input in the set, i.e., the final result will have the least upper bound
Therefore, H optimal controller minimizes the maximum magnitude of weighted sensitivity function S(j) over a
frequency range . Dr. Richard H. Mgaya
)()(supmin)(min jWjSte cc
1)(
)(
2
1)(
22
2
1
d
jW
jVtv
Robust Control System Design
Robust Stability
Let Gm(j) be a nominal model belong to a family of plants
If G(j) is modelled exactly, i.e., disturbance D(s) and noise N(s) are zero, G(j) = Gm(j)
If la() is the bound of additive uncertainties, then G(j) belonging in the
family is given as
Multiplicative uncertainties bound: from eqn. (x) and (xi)
Note: G(j)C(j) is the open-loop forward transfer function
Dr. Richard H. Mgaya
)()(
)()(
jCjG
ll
m
am
)()()(: am ljGjGG
)()()()( mma ljCjGl
Robust Control System Design
Robust Stability
Closed-loop uncertainty bound:
or
Robust stability:
If all plants G(s) in the family have same number of RHP poles then
controller C(s) stabilizes the nominal plant iff the complementary
sensitivity function satisfy the following condition
lm() is referred as the weighted function for T(j)
Note: Robust stability provides minimum requirements, .i.e., stability
Dr. Richard H. Mgaya
1)()()(1
)()(
m
m
ml
jCjG
jCjG
1)()( mljT
1)()(sup)()(
mm ljTljT
Robust Control System Design
Robust Performance
Control system is said to have robust performance if the controller can minimize the worst plant error in the family
Recall:
If a bound is placed on the sensitivity function S(j) such that:
Then,
Dr. Richard H. Mgaya
)()(sup)()( jWjSjWjS
1)()(
jWjS
)( allfor 1)()(sup jGjWjS
Robust Control System Design
Example: Given the following control system
(a) Plot the bode magnitude for sensitivity function S(j) and
complementary sensitivity function T(j), for k = 10 and
comment on their values
(b) For step input, let W(s) = 1/s and produce a bode magnitude
plot for for k = 10, 50, and 100 and identify the
optimal value for using both H2 and H criteria
Dr. Richard H. Mgaya
)()( jWjS
Robust Control System Design
Soln:
(a) Sensitivity function:
Complementary sensitivity function:
Dr. Richard H. Mgaya
)1(32
132
)21)(1(1
1
)()(1
1)(
2
2
Kss
ss
ss
KsCsGsS
)1(32
)1(32
1321)(1)(
2
2
2
Kss
K
Kss
sssSsT
Robust Control System Design
Soln:
(a) Bode plot:
The system has approximately set-point tracking error of -0.8dB and disturbance rejection of -20dB for up to 1 rad/s
Dr. Richard H. Mgaya
Robust Control System Design
Soln:
(b) Weighted sensitivity function for step input:
The H2-norm reduces as k increases, thus k = 100 is the be value
H-norm: Maximum magnitude of the weighted sensitivity function occurs at the lowest frequency. Thus, the least upper bound is is 0dB at 0.01rad/s
where k = 100
Dr. Richard H. Mgaya
)}1(32{
132)()(
2
2
Ksss
sssWsS
Robust Control System Design
Example: The nominal forward path transfer function for a
closed-loop system is given as follows
Let the bound for multiplicative model uncertainty be
What is the maximum value of K for a robust stability?
Soln:
Dr. Richard H. Mgaya
)42()()(
2
sss
KsCsGm
)25.01(
)1(5.0)(
s
sslm
1)()(sup)()(
mm ljTljT
)()(1
)()()(
sCsG
sCsGsT
m
m
Ksss
KsT
42)(
23
Robust Control System Design
Soln:
Marginal stability occurs at k = 3.5, thus maximum value for robust stability
Dr. Richard H. Mgaya
)42)(25.01(
)1(5.0)(
23 Kssss
sKlsT m
Robust Control System Design
If N(s) 0 then
Therefore,
Dr. Richard H. Mgaya
)()()()()( sDsSsRsTsY
)()()()()()()( sNsTsDsSsRsTsY
rejectionNoisejTTrackingjT ,0)( , ,1)(