Professional Documents
Culture Documents
Robot Model Auto2013 PDF
Robot Model Auto2013 PDF
Robot Model Auto2013 PDF
1
Marriott waterfront, Baltimore, MD, USA
June 30-July 02, 2010
II.
systems. It yields a stable observer for larger Lipschitz constants
introduction of geometric techniques has led to great success where x E is the state vector, uE is the input vector,
y=Cx
in the development of controllers for nonlinear systems and yE is the output measurement vector. AE ,
n
R RP
(lsidori, 1998, Khalil, 2001), it has not been possible to obtain and CE are appropriate matrices. The
n n
R x
and Xiao-Hua and Gao (1985) attempted to fmd a coordinate constant r i.e.
transfonnation so that the state estimation error dynamics (2)
were linear in the new coordinates. Necessary and sufficient
1I <D(x,u)-<ll(x,u)1 r l x -x l , "ix,x
conditions for the existence of such a coordinate To begin with, note that any nonlinear system of the fonn
�
constant. When the Lipschitz constant is large or when the The Lyapunov function candidate for observer design is
defined as
•
(6)
where P and PE
V=iT pi
Its derivative is
l Gridsada Phanomchoeng and 2Rajesh Rajamani are with the University of n n.
> 0 R x
Minnesota, Minneapolis, MN 55455, Email: phano002@umn.edu or
rajamani@me.umn.edu, TEL 612-626-7961
V=[ XT {<I>(x)-<I>(x)t]x
Thus the nonlinear function <I>(x,u) satisfies an inequality of
[(A-LC)T P+P(A-LC) P][<I>(x)-<I>( (8) the type
x)] x-x. ]:::;;0 (17 )
x
P 0 [(x-xl (<ll(X,U)-<ll(X,U){ ] M [<ll(x,u)-<ll (x,u)
III. where MER2nx2nis a symmetric matrix and is given by
(18)
BACKGROUND RESULTS
3.1
The S-Procedure Lemma is as follows [16].
The S-Procedure Lemma M=[_�2I �1
Let Va(x) and V; (x) be two arbitrary quadratic forms over Applying the S-Procedure Lemma to equations (8) and (1 7),
Lemma 1:
Rn. Then Va(x)<O for all X ERn-{O} satisfying V; (x)S; 0 if we fmd V<0 if and only if there exist s 0 such that
and only if there exist s 0 such that [(A-LCf P; P(A-LC) �]-SM<0. (19)
�
]<0 (20)
Lemma 2:
[(A-LCf P+P(A-LC)+sy21 P
is equivalent to one of the followingI conditions. It is possible to write equation (14) in the matrix form
(11)
Less Conservative Lipschitz Condition
or
R<0, Q-SK ST <0
defined as
(12) 1I <I>(x,u)-<I>(x,u)1 S;I G(x-x)l , \ix,x (21)
Note that the matrix G in this case could be a sparsely
IV. populated matrix. Hence I G(x-x)11 can be much smaller than
NONLINEAR OBSERVER
the constant Ilx-xi used earlier in equation (2) for the same
For the class of systems and observer forms nonlinear function.
r
4.1 Observerfor Lipschitz Nonlinear Systems
matrix L can be chosen such that Illustrative Example for Less Conservative Lipschitz
[(A-LC)T P+P(A-LC)+sy21 P ]
<0 (13) Let <I>(x,u) given by
Condition
for some positive defmite symmetric matrix P , then this <I>(x,u)=[2 S�(XI) l (22)
P -sl
6061
This result brings us to the corollary to theorem 1. Then equation (29) can be rewritten as
For the class of systems and ATP+PA+8GTG+!Pp-CT 8 J!P-PLC<0 (34)
observer forms described in equations (1), (4) and (21), if an which is the same as equation (28), thus proving the result.
Corollary to Theorem 1:
for some positive defmite symmetric matrix P , then this The previous section has shown the necessary and sufficient
5.1
choice of L leads to asymptotically stable estimates by the conditions for observer design. The observer design by using
observer (4) for the system (1). theorems 1-2 needs to search for P andL to satisfy inequality
(13) or (28). Solving the inequality by a numerical method
would be an obvious approach. However, the inequalities (13)
and (28) seem to be noncovex because each involves the
4.2 Reformulation of Observer Design Using Riccati
such that the error dynamics are quadratically stabilized if and Searching for P and L satisfying (13) is equivalent to
only if there exist 8>0 and 13 R such that the following searching for P and Y satisfying (36). Once a feasible set of
Riccati inequality has a symmetric positive defmite solution P and Y is found, L can be computed as L =p-IY . Note that
P:
E
ATP+PA+8GTG+-PP-f32 1 CTC<0 (29) P>0 (or equivalently P is invertible) and that there is always
8 a one to one mapping from Y to L for a given P .
The observer gain can then be chosen as In the same way, we can apply the change of variables to
inequality (28). Then the inequality (28) becomes
L = 1322 p-1CT . (30) [ATP+PA_CTYTP -YC+8GTG -81P ]<0, P>O (37)
Applying the Schur Inequality (Lemma 2) to equation
(28), the necessary and sufficient condition for observer Hence, for a given 8 and or G , the inequality (36), or
Proof:
design is (37), is affme with respect to its two variables P and Y . The
r
(A-LCf P+P(A-LC)+8GTG+!Pp 8 <0 . (31) corresponding feasibility problem can be solved using many
standard convex optimization techniques or the TLAB
This can be re-written as LMI control toolbox.
MA
8 ATp+PA+8GTG+-PP-f32 8
x(t) . where J1>0, J1 is a small scalar.
Equation (29) is therefore a necessary condition. The fact that 1
equation (29) is a sufficient condition can be proved as ATP+PA+-PP+8GTG-f32
8 CTC+J11 =0 (39)
follows: For given 8 , G , 13, and J1 , the Riccati equality (39) can be
Let there exist a positive defmite solution P to equation (29). easily solved. This equation may be solved with the TLAB
Let the observer gain be chosen as command "ARE':
MA
6062
continuous-time Riccati equation: However, this control law requires measurement of all the
(41) states. Physically, one can measure the motor position and
with b being symmetric and nonnegative defmite and c being velocity, but the measurement of the other states is non-trivial.
a'X +Xa-XbX +c=O
symmetric.
Rearrange the equation (39) to appropriate equation (41) as In this section we present an observer for the above robotic
follows:
6.2 Observer design for ajlexible link robot
The Matlab function "ARE' can now be used to fmd the with =1 , an observer gain is found to be
=
'-v--'
a
s�
a
' �
solution.
b
The corresponding state-space model is Thus, the eigenvalues are well damped in this case. The
response will show no transient oscillations. However, there is
one small eigenvalue. So the estimated state will converge
slowly to the actual state.
Om =O)m
The robotic system with the above observer gain matrix was
(43) simulated under an open-loop excitation with being a
. k B K,
0)m =-Jm (B. - B)
m - J 0) m +-u
Jm
sinusoid at 1 Hz. Fig. 1 shows a comparison of actual and
-
m u
link; Bm the angular rotation of the motor; B. the angular converge to the correct values.
position of the link; O)m the angular velocity of the motor; and
the angular velocity of the link.
Actual and obser\er estimated link angular position
= +Bu +<1>( x )
x Ax
(44)
with x =[Bm O)m B. O).t .
y=Cx
A=[
-4:.6 -1�25 4�.6 �l B=[2�'6l
0 0 0 ' 1 0'
19.5 0 -19.5 0 (45)
o - 1:-
0 -='--- 0.5--= ----O-
- 7:
1.,---
5 -: - - ::
2 '"=
.5 -
time (sec)
:----:'3. 5-=- ----0-4
- 7:
4 .,-
5 ---:
( )=[ �
l' =[� c
Fig. I Actual and observer estimated link angular position (Corollary
-3.33sin( x J
<I> X
to Theorem I)
-2
-3
-3
-4
-4
S S
- ':--
O
---:O
: -.
':----'''--
S -: 1 S.
-':----:-: - -::' -::-
2.S----: S.
-: - -::'3.:S---:- ----:'c
4:--- -!
' -,
- O--- � 1--=S. �-�2S--=. �-�3'
S. '''---
� ----
-
O � ,...-
S. ----�-4 S. --J
time (sec)
time (sec)
andf3=180 , an observer gain matrix is found to be This section will compare observer design techniques in
6.3 Comparison with previous observer design techniques
=� ���: :��� observer design techniques can deal with a larger Lipshitz
L =[ :
1� l. (48) constant. The problem in section 6.1 is reconsidered and we
10.0309 91.3947 will keep the same plant equations. However, the nonlinearity
14.2679 51.5085 will be scaled to continuously increase the value of the
Lipschitz constant for this system until the observer can no
The eigenvalues of (A-LC) are longer solve the problem when the Lipschitz constant is too
61 large.
·
-65.4;�; : 3 :'5212il. (49) First, we fmd an observer gain by Theorem 1 which needs
eig(A-LC) = [
the solution of LMI Inequalities. Then, we use Theorem 2 to
-65.4807 -34.5212 fmd an observer gain matrix by solving the corresponding
-1.0914 Algebraic Riccati equation. Finally, the traditional standard
Thus, the eigenvalues have lower damping in this case. LMI observer [16] as described below is used to fmd an
However, the overall eigenvalues are large. So the estimated observer gain matrix for comparison.
states rapidly converge to the actual state and transient
oscillations are not present. The transient performance is For the class of systems and observer forms described in
better than the previous LMI solution.
Standard LMI Observer
Ymax
VII.
Optimization, vol. 27, pp.199 - 216, 1989.
6065