Professional Documents
Culture Documents
(ECES-817)
Presented by : Shubham Bhat
...2
...3
...4
v,
...5
s ( x) s ( x)
q ( x)
1
where
and
are also smooth functions.
s ( x)
s ( x)
0
1
M AM
..
a0
1
0
0
0
1.
0
, M 1b
..
.
.
a1 a2 .. an1
0
,
:
1
and the ai ' s are the coefficients of the characteristic polynomial
n
n 1
| sI A | s a j s j
i 0
0
1..
..
..
1
0
0
..
,b
0
0
z M 1T ( x ), v v az q ( x) a ' M 1T ( x ) s ( x)u
where
a ' [ a0 a1 ...an 1 ].
Problem Statement
Given the system as in 1, does there exists ??
(i ) a smooth function q S ( X )
(ii ) a smooth function s S ( X ) such that s ( x) 0 for all x
in the neighborhood of 0.
(iii ) a local diffeomorphism T : R n R n such that T (0) 0,
satisfying the following conditions :
if new var iables v and z are defined ,
then z1 z2 , z 2 z3 ,....z n1 zn , z n v
Example Contd.
The dynamics can be written as
A(h)h u a 2 gh
If u (t ) is chosen as
u (t ) a 2 gh A(h)v
with v being an " equivalent input" to be specified , the resulting dynamics is linear
h v
~
Choo sin g v as v h
~
with h h(t ) hd being the level error , and being a positive cons tan t ,
the resulting closed loop dynamics is
h h~ 0
~
This implies that h (t ) 0 as t .
Example Contd.
The actual input flow is det er min ed by the nonlinear control law
~
u (t ) a 2 gh A(h)h
The first part on the RHS is used to provide the output flow a 2 gh
while the sec ond part is used to raise the fluid level.
If the desired level is a known time var ying function hd (t ),
the equivalent input v can be chosen as
~
v hd (t ) h
~
so as to still yield h (t ) 0 as t .
Example Contd.
A system is said to be in companion form if its dynamics are
x ( n ) f ( x) b( x)u
where u is the scalar control input , x is the scalar output and
f ( x) and b( x) are nonlinear function of the states.
x1
x2
...
...
d
xn
dt xn1
xn f ( x) b( x)u
U sin g the control input (assu min g b to be nonzero)
1
u [v f ]
b
multiple int egrator form
xn v
Example Contd.
Thus, the control law
v ko x k1x .... kn1x(n 1)
with the ki chosen so that the polynomial p n kn1 p n1 .... k0
has all its roots strictly in the left half complex plane, leading to
x ( n ) kn1x ( n1) ...k0 x 0
which implies that x(t ) 0
v K z
u u ( x, v )
x f ( x, u )
Linearization Loop
pole-placement loop
z z (x)
x 2 x15 x3
x 3 x12 u
y x1
Internal Dynamics
If we need to differentiate the output r times to generate an
explicit relationship between output y and input u, the system is
said to have a relative degree r.
The system order is n. If r<= n, there is an part of the system
dynamics which has been rendered unobservable. This part is
called the internal dynamics, because it cannot be seen from the
external input-output relationship.
If the internal dynamics is stable, our tracking control design has
been solved. Otherwise the tracking controller is meaningless.
Therefore, the effectiveness of this control design, based on
reduced-order model, hinges upon the stability of the internal
dynamics.
Internal Dynamics
Consider the nonlinear system
x1 x23 u
x
2 u
y x1
u x2 e(t ) y d (t )
which yields exp onential convergence of e to zero
e e 0
The same control input is also applied to the sec ond
dynamic equation, leading to the int ernal dynamics
x2 u
y x1
where y (t ) is required to track a desired output yd (t ).
With one differenti ation of the output , we get
y x2 u
which exp licitly contains u. Thus, the control law
u x2 y d e yields the tracking equation e e 0
where (e y yd ) and the int ernal dynamics x 2 x2 y d e(t )
We see that while y (t ) tends to yd (t ) ( y (t ) tends to y d (t ),
x2 remains bounded , so does u.
x2 u
y x1
The same control law as above yields the same
tracking error dynamics, but the int ernal dynamics is
x 2 x2 e(t ) y d
This implies that x2 , and accordingl y u , both go to
inf inity as t .
Therefore this is not a suitable controller for the system.
Mathematical Tools
Lie derivative and Lie bracket
Diffeomorphism
Frobenius Theorem
Input-State Linearization
Examples
The zero dynamics with examples
Input-Output Linearization with examples
Opto-Mechanical System Example
Lie Derivatives
Given a scalar function h( x) and a vector field , L f h,
called the Lie derivative of h with respect to f .
Definition : Let h : R n R be a smooth scalar function, and
f : R n R be a smooth vector field on R n , then the Lie derivative
of h with respect to f is a scalar function defined by L f h h f
Example:
x f ( x)
y h( x )
The derivatives of the output are
[ L f h]
h
y
x L f h ; y
x L f 2 h
x
x
Lie Brackets
Let f and g be two vector fields on R n .The Lie Bracket of
f and g is a third vector defined by
f , g g f f g
The Lie Bracket [ f , g ] is commonly written as ad f g ( where ad
s tan ds for adjo int)
Re peated Lie Brackets can be defined recursivel y by
o
ad f g g
i
ad f g [ f , ad f
i 1
g]
for i 1,2,....
g ( x)
cos(
2
x
)
1
x
cos
x
2
1
0
0 2 x1 ax2 sin( x1 ) 2 cos x1
a
[ f , g]
2
sin(
x
)
0
x
cos
x
x
sin
x
cos
x
1
2
1
1
1
2
a cos(2 x1 )
cos
x
cos(
2
x
)
2
sin(
2
x
)(
2
x
ax
sin
x
)
1
1
1
1
2
1
cos(
2
x
)
1
Example
Consider the dynamic system described by
x f ( x) g ( x)u
y h( x )
and let the new states be defined by
z ( x)
Differenti ation of z yields
z
x
( f ( x ) g ( x)u )
x
x
[ f i , f j ]( x) ijk ( x) f k ( x)
k 1
i, j
Frobenius theorem
Theorem :
Let f1, f 2 ,... f m be a set of linearly independent
vector fields.
The set is completely int egrable if , and only if ,
it is involutive.
Consider the set of partial differenti al equations
h
h
4 x3
0
x1 x2
h
h
h
2
x1
( x3 3 x2 )
2 x3
0
x1
x2
x3
f 2 [ x1 ( x32 3x2 ) 2 x3 ]T
Input-State Linearization
Definition :
A sin gle input nonlinear system in the form x f ( x) g ( x)u
with f ( x) and g ( x) being smooth vector fields on R n , is said to
be input state linearizable if there exists a region in R n ,
a diffeomorhpism : R n , a nonlinear feedback control law
u ( x ) ( x )v
such that the new state var iables z ( x) and the new input v
satisfy a linear time in var iant relation
z Az bv
where
0 1 0.. 0
0
0
0
1
..
.
.
A
b
.. .
.
.
.
0
0
0
0
1
The new state z is called the linearizing state and the control law
is called the linearizing law.
i 0,...n 2
z1ad f n1g 0
(iv) Compute the state transformation z ( x) [ z1 L f z1 .... L f n1z1 ]T and the input
transformation, with
( x)
( x)
L f n z1
Lg L f n1z1
1
Lg L f n1z1
Example system
Consider a mechanism given by the dynamics which represents a single link flexible
joint robot.
Its equations of motion is derived as
x [q1 q1 q2 q 2 ]
and corresponding vector fields f and g can be written as
MgL
k
k
f [ x2
sin x1 ( x1 x3 ) x4 ( x1 x3 )T
l
l
j
1 T
g [0 0 0 ]
J
k
IJ
[ g ad f g ad 2 f g ad 3 f g ]
1
J
k
J2
k
IJ
0
J2
0
It has rank 4 for k>0 and IJ> infinity. Furthermore, since the
above vector fields are constant, they form an involutive set.
Therefore the system is input-state linearizable.
z1
0
x2
z1
0
x3
z1
0
x4
z1
0
x1
u (v z4 f ) /(z4 g )
which can be written exp licitly as
IJ
u
(v a( x))
k
where
MgL
MgL
k
k
k k MgL
a ( x)
sin x1 ( x2 2
cos x1 ) ( x1 x3 )(
cos x1 )
I
I
I
I
I J
I
x1 z1
x2 z2
I
MgL
x3 z1 ( z3
sin z1 )
k
I
I
MgL
x4 z2 ( z4
z2 cos z1 )
k
I
which is well defined and differenti able everywhere.
0 i r 1
Normal Forms
Let
[ 1 2 .... r ]T [ y y ... y ( r 1) ]T
In a neighborhood of a po int x0 , the normal form of the system can be
written as
..
a ( , ) b( , )u
w( , )
with the output defined as
y 1
The i and i are referred to as normal coordinate s or normal states
in (or at x0 )
Zero Dynamics
The int ernal dynamics associated with the input output
linearization simply corresponds to the last (n r ) equations
w( , ) of the normal form.
Generally, this dynamics depends on the output states .
However , we can define an int rinsic property of the
nonlinear system by considering the system' s int ernal
dynamics when the control input is such that the output
y is ma int ained at zero. Studying zero dynamics will
allow us to make some conclusions about the stability of
the int ernal dynamics.
Zero Dynamics
The constra int that the output y is identically zero implies that all of its time
derivatives are zero. Thus, the zero dynamics of a system is its dynamics when
its motion is restricted to the (n r ) dim ensional smooth surface in R n
Further , input must be such that y stays at zero.
In order for the system to operate in zero dynamics,
The original input u must be given by the state feedback
u* (t )
L f r h( x )
Lg L f r 1h( x)
Therefore , correspond ing to the zero dynamics, the system states x evolves
according to
x f ( x) g ( x)u* ( x)
1
Lg L f r 1 y
[ L f r y kr 1 y ( r 1) ... k1 y k0 y ]
Example System
x1 x12 x2
x 2 3x2 u
x2 T is
x 2 3x2 u
and thus has an uncontroll able mod e corresponding to a pure int egrator.
Let us define the output function y 2 x1 x2
Correspond ing to this output , the relative deg ree of the system is 1, because
dy
2 x1 x 2 2 x12 x2 3x2 u
dt
The associated zero dynamics (obtained by setting y 0 ) is simply
x1 2 x13
and thus is asymptotically stable. Therefore , the control law
u 2 x12 x2 4 x2 2 x1
locally stablizes the nonlinear system.
d [ yd y d ... yd ( r 1) ]T
and define the tracking error vector by
~ (t ) (t ) d (t )
Tracking Control
Theorem :
Assume the system has relative deg ree r (defined and cons tan t
over the region of int erest ), that d is smooth and bounded ,
and that the solution d of the equation
d ( d , d )
d (0) 0
exists, is bounded , and is uniformly asymptotically stable.
Then by u sin g the control law
1
r
(r )
~]
u
[
....
f
1
d
r 1 r
0 1
r 1
Lg L f 1
the whole state remains bounded and the tracking error ~
converges to zero exp onentially.
Inverse Dynamics
For systems described by previous sec tion,
let us find out what the initial conditions x(0) and control input u
should be in order for the plant output to track a reference output
yr (t ) perfectly.
Let us assume that the system output y (t ) is identical to the reference
output yr (t ) i.e y (t ) yr (t ), t 0.
y k (t ) yr k (t )
k 0,1,....,.r 1
t 0
(t ) r (t ) [ yr (t ) y r (t ) .... yr ( r 1) (t )]T
Thus, the control input u (t ) must satisfy
yr r (t ) a( r , ) b( r , )u (t )
t 0
kb
x
ka
x
sin (tan 1 ( ) ) ) cos2 ( sin(tan 1 ( )))
2
z
2
z
= wavelength = 630 nm
k = wave number associated with the wavelength
a = center-to-center separation = 32 um
b = width of the slit = 18 um
z = distance of propagation =1000 um
Plant Model
1
( s 1)
X2
Motor Dynamics
Plant
Model
Y= X1
Plant Model
X2
1
U X1 s 1
Y X1 A sin c( X 2 )
X 2
X 2 X1 U
t
Y sin c( X 2 )
A 1 (assume)
X 2
sin c( X 2 ) X 2 U
t
Y sin c( X 2 )
A 1 (assume)
Input-State Linearization
X 2
sin c( X 2 ) X 2 U
t
U sin g a transformation z1 x2
We get z1 sin c( z1 ) z1 u
Therefore u z1 sin c( z1 ) z1
u v sin c( z1 ) z1
v z1
Select v k1z1
u k1z1 f ( z ) where f ( z ) sin c( z1 ) z1
By proper choice of feedback gains , we can get a stable closed
loop dynamics.
v K1z1
U(x,v)
Pole-Placement loop
1
( s 1)
X2
Motor Dynamics
z1 x2
Plant
Model
Plant Model
Input-Output Linearization
sin( x2 )
y sin c( x2 )
x2
[cos( x2 ) x 2 ]x2 sin( x2 ) x 2
y
x2 2
x2 (cos( x2 )) x 2 sin( x2 ) x 2
x2 2
y
Input-Output Linearization
x2 cos( x2 ) sin c( x2 ) x2 2 cos( x2 ) x2 cos( x2 )u
sin( x2 ) sin c( x2 ) sin( x2 ) x2 u sin( x2 )
y
[
x2 2
x2 cos( x2 )u sin( x2 )u
x2
x2 cos( x 2 ) sin( x2 )
x2
Input-Output Linearization
y u[
cos( x2 ) sin( x2 )
] f ( x)
2
x2
x2
where
v f ( x)
u
cos( x2 ) sin( x2 )
[
]
2
x2
x2
y v
Comparing with x Ax Bu, we get A 1, B 0
Select v y d k1e
[e y y d ]
Control law is defined everywhere except at sin gularity
cos( x2 ) sin( x2 )
po int s where [
]0
2
x2
x2
Zero Dynamics
Zero Dynamics is given by :
x 2 x2 u
This zero dynamics is asymptotically stable,
hence the feedback controller locally stabilizes the nonlinear
system.
There are no int ernal dynamics associated with this system
because relative deg ree r n ( system order ).
Conclusion
Control design based on input-output linearization can be made
in 3 steps:
Differentiate the output y until the input u appears
Choose u to cancel the nonlinearities and guarantee tracking
convergence
Study the stability of the internal dynamics
If the relative degree associated with the input-output linearization is
the same as the order of the system, the nonlinear system is fully
linearized.
If the relative degree is smaller than the system order, then the
nonlinear system is partially linearized and stability of internal
dynamics has to be checked.
Homework Problems