Professional Documents
Culture Documents
Integrator Back-stepping;
Linear Quadratic (LQ) Observer
Dr. Radhakant Padhi
Asst. Professor
Dept. of Aerospace Engineering
Indian Institute of Science - Bangalore
X = f ( X ,U )
Goal: Design
U = ( X ) such that
X = f ( X , ( X ) ) is asymptotically stable
Design Idea:
Choose a pdf V1 ( X )
Make V1 ( X ) V2 ( X ) , where V2 ( X ) > 0 (pdf)
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
Solution:
Let
V1 ( X ) =
1
2
x2
V1 = x x = x ax 2 x 3 + u
= ax 3 x 4 + xu
Let us choose
V2 ( X ) = x 2
V1 ( X ) V2 ( X )
ax 3 x 4 + xu x 2
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
u = x + x 3 ax 2
x = ax 2 x 3 x + x 3 ax 2
x = x
leads to:
ax 3 x 4 + xu x 2 x 4
ax 3 + xu x 2
ax 2 + u = x
or
u = x ax 2
x = x3 x
Integrator Back-stepping
Problem : Design a state feedback asymptotically stabilizing controller
= u
where
X Rn , R , u R
Note:
X
n +1
R
: State of the system, u : Control input (single input)
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
10
Integrator Back-stepping
Assumptions:
f , g : D R n are smooth
f (0) = 0
Considering state as a "control input" of subsystem (1)
we assume that a state feedback control law
of the from = ( X ) , ( 0 ) = 0. Moreover,
a Lyapunov function V1 : D R + such that
V1
f ( X ) + g ( X ) ( X ) Va ( X ) , X D
X
where, Va ( X ) : D R + is a pdf function.
V1 ( X ) =
11
Integrator Back-stepping
An important observation:
When X = 0, = ( 0 ) = 0 & X = f ( 0 ) = 0
(i.e. everything is nice)
However, when 0, X = f ( X ) and hence X 0
in general. That is the core problem!
We need some algebraic manipulation as follows.
12
Integrator Back-stepping
Step - 1:
X = f ( X ) + g ( X ) + g ( X ) ( X ) g ( X ) ( X )
= f ( X ) + g ( X ) ( X ) + g ( X ) ( X )
= f ( X ) + g ( X ) ( X ) + g ( X ) z
13
Integrator Back-stepping
z =
This is backstepping, since ( X ) is
= u
v
So, we have
X = f ( X ) + g ( X ) ( X ) + g ( X ) z
z=v
14
Back-stepping:
Conceptual Block Diagram
Back-stepping
15
Integrator Back-stepping
Step-2:
Let V ( X , z ) = V1 ( X ) +
1 2
z
2
V1
V =
f ( X ) + g ( X ) ( X ) + g ( X ) z + z v
X
T
Then
Va ( X )
V1 T
Va ( X ) +
g ( X ) + v z
X
V1
g ( X ) k z, k > 0
X
Then V Va ( X ) k z 2 < 0
(ndf)
T
Let v =
ndf
nddf
16
Integrator Back-stepping
Control Solution:
V1
v = u =
g(X )k z
X
T
V1
u =
g ( X ) k ( X )
X
T
where, =
f ( X ) + g ( X ) , k > 0
X
T
17
Integrator Back-stepping:
An Example
Problem:
x1 = ax12 x13 + x2
x2 = u
Solution :
X = x1 , f ( x1 ) = ax12 x13 , = x2 , g ( x1 ) = 1
To find ( x1 ) :
1 2
V1 ( x1 ) = x1
2
V1 = x1 x1 = x1 ( ax12 x13 + x2 ) Va ( x1 )
x12 + x14
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
18
Integrator Back-stepping:
An Example
ax13 x14 + x1 x2 x12 x14
x1 ( ax12 + x2 ) x12
Let
ax12 + x2 = x1
x2 = ( ax12 x1 ) ( x1 )
z
z=v
x2 ( x1 )
u
1 2
z
2
V1
V1
2
3
+ v z
V = V1 + z v =
ax1 x1 + ( x1 ) +
x
x
1
1
Let V ( x1 , z ) = V1 ( x1 ) +
19
Integrator Back-stepping:
An Example
V1
v =
Let
k z , k > 0
x1
u = x1 k x2 ( x1 )
u=
ax12 x13 + x2 ) x1 k x2 ( ax12 x1 )
(
x1
20
Integrator Back-stepping:
An Example
Note: The composite Lyapunov function is:
1 2
V = V1 + z
2
2
1 2 1
= x1 + x2 ( x1 )
2
2
1 2 1
2 2
= x1 + ( x2 + x1 + ax1 )
2
2
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
21
Integrator Back-stepping:
More General Case
System Dynamics:
X = f ( X ) + g ( X ) 1
1 = 2
2 = u
Idea : Successive iteration.
22
Integrator Back-stepping:
More General Case
Step-1: Consider the subsystem
X = f ( X ) + g ( X ) 1
1 = 2
Assumption:
23
Integrator Back-stepping:
More General Case
By the result obtained before, we have
( X )
V1
2 =
f ( X ) + g ( X ) 1
g ( X ) k 1 ( X )
X
X
X
T
1 ( X , 1 )
(k > 0)
2
1
We also have V2 = V1 + 1 ( X )
2
24
Integrator Back-stepping:
More General Case
Step - 2:
X1
X f ( X ) + g ( X ) 1
=
+
0
1
f1 ( X1 )
2 = u
where, X 1
0
1 2
g1 ( X1 )
X
1
1
V2
u =
f1 ( X 1 ) + g1 ( X 1 ) 2
g1 ( X 1 ) k1 2 1 ( X 1 ) , k1 > 0
X 1
X 1
2
2
2
1
1
1
and V = V2 + 2 1 ( X 1 ) = V1 + 1 ( X ) + 2 1 ( X 1 )
2
2
2
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
25
X = f ( X ) + g ( X ) 1
1 = f1 ( X , 1 ) + g1 ( X , 1 ) 2
2 = f 2 ( X , 1, 2 ) + g 2 ( X , 1 , 2 ) 3
k = f k ( X , 1 , , k ) + g k ( X , 1 , , k ) u
Strong Assumption:
g1 ( X , 1 ) , g 2 ( X , 1 , 2 ) , , g k ( X , 1 , , k ) 0
over the domain of interest t
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
26
X = f ( X ) + g ( X )
= fa ( X , ) + ga ( X , ) u
Solution:
Define = v and carryout the design for v as before.
Finally f a ( X , ) + g a ( X , ) u = v
i.e.
u=
1
v f a ( X , )
ga ( X , )
Note: By assumption, g a ( X , ) 0 t
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
27
Why Observers?
z
Non-availability of sensors
Expensive sensors
Quality of some sensors may not acceptable due to noise (its
an issue in output feedback control design as well)
29
Observer
z
Full-order Observer
Reduced-order Observer
30
Plant
Observer dynamics be
+ BU
+KY
X = AX
e
Error : X
( X X )
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
State observer
31
X = X X
+ BU
+KY
= ( AX + BU ) AX
e
+ A A K C X + B B U
= AX
e
Goals: 1. Make the error dynamics independent of X
( X may be large, even though X may be small)
2. Eliminate the effect of U from eror dynamics
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
32
A A K eC = 0
and B B = 0
This results in
A = A K C
e
B = B
Observer dynamics: X = AX + BU + K e Y CX
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
33
34
CL Dynamics
Observer Design
z
X = ( A BK ) X
z
Objective
CL Error Dynamics
= ( A K C) X
X = AX
e
z
X ( t ) 0, as t
Objective
X ( t ) 0, as t
Notice that
T
( A K e C ) = ( A K e C )
= AT C T K eT
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
35
System
Z = AT Z + C T V
n = BT Z
X = AX + BU
Y = CX
M = B AB
A B
N = C T AT C T
n 1
T n1
CT
M = C T AT C T
N = B A B
CT
A n 1 B
T n1
LQR Design
U = K X
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
36
Error Dynamics
X = ( A K eC ) X
X = ( A BK ) X
X 0 as t
( A K eC )
= AT C T K eT
Analogous
1
K = R B P,
T
P>0
where,
= R CP
where,
1
PA + A P PBR B P + Q = 0
T
T
e
Acts like a
controller
gain
X = AX + BU + K e (Y CX )
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
37
Problem Statement
System Dynamics: X = AX + BU + GW W (t ) : Process noise vector
V (t ) : Sensor noise vector
Measured Output: Y = CX + V
Assumptions:
(i )
X (0) X 0 , P0 , W (t ) ( 0, Q ) and V (t ) ( 0, R )
are "mutually orthogonal"
[ X (0) :
39
Problem Statement
Objective:
To obtain an estimate of the state vector X ( t ) using the
state dynamics as well as a "sequence of measurements"
as accurate as possible.
i.e., to make sure that the error X (t )
X (t ) X (t ) becomes
40
Observer/Estimator/Filter Dynamics
X = AX + BU + K e Y Y
( E (V ) = 0 )
= CX
(iii ) K e : Estimator/Filter/Kalman Gain
Problem : How to design K e ?
ADVANCED CONTROL SYSTEM DESIGN
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
41
Solution: Summary
(i) Initialize X (0)
(ii) Solve for Riccati matrix P from the Filter ARE:
AP + PAT PC T R 1CP + G Q GT = 0
(iii) Compute Kalman Gain:
K e = PC T R 1
(iv) Propagate the Filter dynamics:
X = AX + BU + K e Y CX
42
43