LQG Design
LQG Design
LQG Design
Lecture 7
LQG Design
Linear Quadratic Gaussian regulator
Control-estimation duality
SRL for optimal estimator
Example of LQG design for MIMO plant
L7:2
LQG regulator
If the process and measurement noises are
assumed Gaussian, then the estimate is
statistically most likely, as well as producing the
minimum squared error
This assumption is not necessary, but has led to
the name Linear Quadratic Gaussian (LQG) for a
regulator designed with an optimal control law
(u = Kx) and a Kalman estimator
Matlab provides the function lqgreg to form the
feedback regulator:
w
v
Hlqg = lqgreg(Kest, K) r = 0 u
+
G +
Form the closed-loop system
with feedback
Hlqg
Kx
L7:3
K ( k 1) = [T P(k ) + R ] T P (k )
1
P(k 1) = T M (k ) + Q
This is a backward recursion starting from
P(N) = Q, K(N) = 0
The time-varying optimal estimation equations are:
P(k ) = M (k ) M (k )C
[CM(k )C
+ R]
CM (k )
L7:4
Control:
K ( k 1) = [ P (k ) + R ] T P(k )
1
P(k 1) = T M (k ) + Q
P(k ) = M (k ) M (k )C [CM (k )C + R ] CM (k )
T
Estimation:
Estimation T
M P
Q
P M wQwT
CT
R
R
L7:5
L7:6
L7:7
+
x (k )
v(k)
Plant
Estimator
y(k)
L7:8
To: disp d
0.5
0
-1
To: disp y
-2
Amplitude
2
0
-2
-0.5
To: force u
si
x
A
g
a
m
I
-1
10
0
-1.5
-1.5
-1
-0.5
0
Real Axis
0.5
1.5
-10
2
8
Time (sec.)
10
12
14
16
L7:9
0
-1
To: disp y
5
0
-5
150
-0.5
To: force u
si
x
A
g
a
m
I
Amplitude
0.5
-1
100
50
0
-50
0
-1.5
-1.5
-1
-0.5
0
Real Axis
0.5
1.5
8
Time (sec.)
10
12
14
16
L7:10
low L = [2.18 3.97 6.49 4.08]T high L = [3.71 9.61 20.1 18.2]T
Response of states and predictive estimates
to x (0) = 1
1
4
x 1=d
x 1hat
x 2=ddot
x 2hat
x 1=d
x 1hat
x 2=ddot
x 2hat
5
0
0
-5
-2
-4
10
-10
0
5
Time (s)
10
10
-5
5
Time (s)
10
10
x 3=y
x 3hat
-2
x 4=ydot
x 4hat
-5
-5
-20
10
-10
0
5
Time (s)
10
-15
0
5
Time (s)
10
50
x 3=y
x 3hat
20
5
Time (s)
10
40
-10
0
5
Time (s)
x 4=ydot
x 4hat
-50
-40
0
5
Time (s)
10
-100
0
5
Time (s)
10
+
x (k )
Plant
Estimator
Controller design:
weight displacements, not velocities
Qc = diag(Q11, 0, Q22, 0)
scalar input Rc = 1
K = dlqr(Phi, Gam, Qc, Rc)
Kalman estimator design:
assume 1% rms sensor noise on d and y
Re = diag(0.012, 0.012)
trial-and-error values for process noise Qe
L7:11
y(k) = [d y]T
+
x (k )
Plant
Estimator
y(k) = [d y]T
L7:12
L7:13
Sensor noise
v
Process noise
2
Gp(1:2,1)
Sum
Continuous
plant model
Sum1
1
yp
Hreg
Discrete regulator
3
u
ys
L7:14
L7:15
L7:16
Robustness
For an LQ regulator with a diagonal R, the closedloop system will have a
gain margin of
gain-reduction margin of 0.5
phase margin 60
in each plant input control channel
Given the duality between optimal control and
estimation, the Kalman filter has similar robust
properties
However, the LQG combination can have
arbitrarily poor stability margins!
Increasing the speed of the estimator dynamics
may reduce stability margins
L7:17
L7:18
LTR procedure
w
r=0 +
L7:19
H
We have seen that this gives desirable
robustness properties (phase and gain margins)
For the LQG regulator, u = Kx , so that the loop
1
1
gain is HG = K [sI A + BK + LC] L C(sI A ) B
It can be shown that this approaches the ideal LQR
loop gain if L = B, as . (Glad & Ljung, ch. 9)
One way of achieving this is to design the Kalman filter
assuming w = (process noise is additive with control
input), and setting Q = R.
As increases (large process noise), the optimal
estimation solution approaches L = B . The advantage
of this approach is that the estimator is guaranteed
stable for any .
Case studies
Hot steel rolling mill
Matlab Control Systems Toolbox Users Guide
(On-line pdf documentation)
milldemo.m
Magnetic tape drive
Franklin, Powell & Workman (3rd edn), sec. 9.5.4
L7:20