Professional Documents
Culture Documents
Nonlinear Control
Lecture 10: Back Stepping
Farzaneh Abdollahi
Fall 2011
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
1/26
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
2/26
I
I
I
= f () + g ()
(1)
= u
(2)
I
I
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
3/26
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
4/26
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
4/26
= [f () + g ()()]
z
+ g ()z
= u
=
Farzaneh Abdollahi
[f () + g ()]
Nonlinear Control
Lecture 10
4/26
I
I
= v
origin is a.s.
g () kz, k > 0
Choose v =
So V c W () kz 2
origin is a.s. ( = 0, z = 0)
(0) = 0
=0
V
u=
[f () + g ()]
g () k( ())
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
(3)
5/26
Example: Consider
x 1 = x12 x13 + x2
x 2 = u
Therefore = x1 , = x2
V (x1 ) = x12 /2
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
6/26
Hence
x 1 = x1 x13 + z2
z 2 = u + (1 + 2x1 )(x1 x13 + z2 )
I
I
u = x1 (1 + 2x1 )(x1
Farzaneh Abdollahi
x13
Nonlinear Control
+ z2 ) z2
Lecture 10
7/26
Example: Consider
x 1 = x12 x13 + x2
x 2 = x3
x 3 = u
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
8/26
2
(x1 x13 + x2 )
( + z3 )
z 3 = u
x1
x2
Define Vc = V + z32 /2 V c =
V
x12 x14 (x2 +x1 +x12 )2 +z3 [ x
x
(x12 +xx3 +x2 ) x
(z3 +)+u]
2
1
2
V
u = x
+
2
Farzaneh Abdollahi
2
x1 (x1
+ xx3 + x2 ) +
Nonlinear Control
x2 (z3
+ ) z3
Lecture 10
9/26
Consider
= f () + g ()
(4)
= fa (, ) + ga (, )u
I
I
1
[ua fa (, )]
ga (, )
and Vc (, ) = V () + 21 [ ()]2
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
10/26
= f0 (x) + g0 (x)z1
= fk (x, z1 , . . . , zk ) + gk (x, z1 , . . . , zk )u
x Rn
z1 to zk are scalar
f0 (0) to fk (0) are zero
gi (x, z1 , ..., zi ) 6= 0 for 1 i k over the domain of interest
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
11/26
= f0 (x) + g0 (x)z1
Farzaneh Abdollahi
V0
x g0 k1 (z1 )
V0 (x) + 12 [z1 1 (x)]2
Nonlinear Control
Lecture 10
f1 ], k1 > 0
12/26
Now consider:
x
= f0 (x) + g0 (x)z1
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
13/26
(5)
= fa (, ) + ga (, )u + (, )
I
I
I
I
I
I
in domain D R n+1
contains ( = 0, = 0); R n , R
all fcns are smooth
If ga (, ) 6= 0 over the domain of interest
f , g , fa , ga are known; , are uncertain terms
f (0) = 0 and fa (0, 0) = 0
k (, )k2
| (, )|
I
Farzaneh Abdollahi
a1 kk2
(6)
a2 kk2 + a3 ||
Lecture 10
14/26
Suppose
(7)
|()| a4 kk2 , k k2 a5
I
I
ga u +
Farzaneh Abdollahi
(f
+ g + )]
Nonlinear Control
Lecture 10
15/26
Suppose
|()| a4 kk2 , k k2 a5
(7)
I
I
(f
+
g
)]
1
V
I Choose u =
ga [fa + (f + g ) g k( )], k > 0
I Vc bkk2 + 2a6 kk2 | | (k a3 )( )2 =
2 T
kk2
kk2
b
a6
; a6 = a3 a4 +a22 +a5 a1
| |
| |
a6 (k a3 )
ga u +
|
Farzaneh Abdollahi
{z
P
Nonlinear Control
}
Lecture 10
15/26
Suppose
(7)
|()| a4 kk2 , k k2 a5
I
I
(f
+
g
)]
1
V
I Choose u =
ga [fa + (f + g ) g k( )], k > 0
I Vc bkk2 + 2a6 kk2 | | (k a3 )( )2 =
2 T
b
a6
kk2
kk2
; a6 = a3 a4 +a22 +a5 a1
| |
a6 (k a3 )
| |
ga u +
|
I
Choose k > a3 +
Farzaneh Abdollahi
{z
P
a62
b
V c min (P)[kk22 + | |2 ]
Nonlinear Control
Lecture 10
15/26
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
16/26
The dynamics:
mx rx m3 lsin() m3 lcos()2 = 1
my ry + m3 lcos() m3 lsin()2 = 2
I m3 lsin()rx + m3 lcos()r )y = 0
+ rx sin() + ry cos() = 0
where [rx , ry ]: displacement of third joint;
orientation of third link respect to x axis; 1 2 :
input of actuated joints; mi : mass, Ii : inertia;
= (I3 + m3 l 2 )/(m3 l)
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
17/26
Transform
the dynamics by:
1
rx + (cos() 1)
1
2 =
tan()
;
=
2
3
ry + sin()
m3 lcos()2 + (mx I2 sin2 ())vx + ( I2 sin()cos())vy
m3 lsin()2 + (fracI 2 sin()cos())vx + (my I2 cos 2 ())vy
vx
where
=
vy
#
"
u1
2
cos() sin()
cos() +
; , I = I3 + m3l 2
2
2
sin() cos()
(u2 cos () 2theta tan()
Therefore
Farzaneh Abdollahi
1 = u1
2 = u2
3 = 2 u1
Nonlinear Control
Lecture 10
18/26
(8)
x 21 = x22 x 22 = u2 u2d
x 31 = x32 x 32 = x21 u1d + 21 (u1 u1d )
I
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
19/26
x 12 = u1 u1d
Farzaneh Abdollahi
Nonlinear Control
u1 = u1d
Lecture 10
20/26
Stabilzing
I
I
x 11 = x12
x 12 = u1 u1d
This system can be stabilized by defining
k1 > 0, k2 > 0
(9)
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
21/26
Stabilizing 1
Assuming
that u1 u1d 0, 1 can be written as
x 31 = x32
1
x 32 = x21 u1d
Objective looking to design a stabilizing feedback x21
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
22/26
Stabilizing
2
I
x 21 = x22
x 22 = u2 u2d
With u1 = u1d , 1 is e.sabilized by x21 = 2
I
I
It can be easily find that the following u2 can stabilize the system
dt
u2 u2d = c4 x22 +
d
dt [2 ]
d
[3 ]
dt
(10)
d
d2
[2 ] + 2 [2 ]
dt
dt
It has been shown that (9) and (10) can e.stabilized (8). [1]
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
23/26
Simulation Results
Define: r1 = r2 = a = 1, k1 = 4, k2 = 2 2, c1 = 2, c2 = 2, c3 = 4, c4 = 4
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
24/26
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
25/26
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
26/26
Farzaneh Abdollahi
Nonlinear Control
Lecture 10
26/26