Solution of the Linearized Equations of Motion

advertisement
Solution of the Linearized Equations of Motion
ASEN 5070
4/22/02
G. H. Born
Introduction
The equations of motion for a satellite are given by:
X  F ( X , t ),
(1)
where
X  [ X Y Z X Y Z β] .
T
X is the state vector containing six position and velocity elements and β, an m vector,
represents all constant parameters such as gravity and drag coefficients that are to be
solved for. Hence, X is a vector of dimension n=m+6.
Equation (1) can be linearized by expanding about a reference state vector denoted by X*,
i.e.
*
 X (t ) 
X (t )  X (t )  
( X (t )  X * (t ))  h. o. t.

 X (t ) 
*
(2)
The * indicates that the quantity is evaluated on the reference state. By ignoring higher
order terms (h.o.t.) and defining
x  X (t )  X * (t ) ,
(3)
we can write Eq. (2) as
*
 X (t ) 
x (t )  
 x (t ) .
 X (t ) 
(4)
Define
*
 X (t ) 
A(t )  
 ,
 X (t ) 
then
x(t ) = A(t ) x(t ) .
1
(5)
Equation (5) is a linear system of first order differential equations with A being an n x n
time varying matrix evaluated on the known reference state X*. Note that
β
β  0, so that
0.
X (t )
Because Eq. (4) is linear1 and of the form x(t ) = A(t ) x(t ) , the solution can be written as
x (t ) 
x (t )
xo .
xo
x (t ) 
X (t )
xo .
X o
It is also true that
(6)
This follows from the fact that the reference state does not vary in this operation, i. e.,
x(t )  ( X(t )  X* (t )) X(t )


.
x0
 ( X 0  X 0* )
X0
It is easily shown that Eq. (6) satisfies Eq. (5). Differentiating Eq. (6) yields ( xo is a
constant vector)
*
 X (t ) 
x (t )  
 xo .
 X o 
(7)
Equating Eq. (7) and Eq. (4) and using Eq. (6) yields
*
*
 X (t ) 
 X (t )   X (t ) 
x (t )  
 xo  
 xo  A(t ) x (t ) .
 
 X (t )   X o 
 X o 
(8)
Substituting Eq. (6) and (7) into Eq. (5) yields
X (t )
X (t )
 A(t )
.
X o
X o
1
(9)
A differential equation of any order (order of highest-ordered derivative) is said to be linear when it is of
the first degree in the dependent variable and its derivatives and their products e. g.,
second order equation of first degree (hence linear), while x
2
d 2x x
  3t 2 is a
2
dt
t
dx
 3t  4 is second degree and nonlinear.
dt
Define the state transition matrix to be
 (t , to ) 
X (t )
.
X o
(10)
The differential equation for the state transition matrix is given by Eq. (9)
X (t )
 (t , to )  A(t )(t , to ) ,
X o
(11)
with initial conditions
(to , to )  I .
Consequently, Eq. (6) may be written as
x(t )  (t , t0 )x0 .
(12)
The State Transition Matrix
Insight into the nxn state transition matrix can be obtained as follows. Let
 r (t ) 


X o 

1 (t , to ) 
 r (t ) 
X (t ) 
 (t , to ) 
 2 (t , to )   
.
X o

X
o

3 (t , to )  
 β 


 X o 
(13)
Note that 3 (t , to ) is an m x n matrix of constants partitioned into an mx6 matrix of zeros
on the left and an mxm identity matrix on the right, where m is the dimension of β and X
is of dimension n. Because of this, it is only necessary to solve the upper 6xn portion of
Eq. (11).
Equation (11) also can be written in terms of a second order differential equation. This
can be shown by differentiating Eq. (13)
3
 r (t ) 
 X 
o

1 (t , to )  
X (t ) 
  r (t ) 
(t , to ) 
 2 (t , to )   
X o
X o 

3 (t , to )  

  0 




 r (t ) 
 X (t ) 


 r (t )   X (t ) 


 .
X (t )   X o  nxn


 0 



 nxn
(14)
In the above equations 0 represents an mxn null matrix. Notice from the first of Eqs. (14)
that
1 
r
 2 .
X o
(15)
Hence, we could solve this second order system of differential equations to obtain
(t , to ) , i.e.,
1 (t , t0 ) 
r (t ) r (t ) X (t )  r (t )


X o X (t ) X o
 r (t )
r (t )
r (t )
 r (t ) 


 X o 
r (t )   r (t ) 


β  3 xn  X o 
 β 


 X o  nxn
(16)
or,
1 (t , t0 ) 
r (t )
r (t )
r (t )
1 (t , to ) 
1 (t , to ) 
3 (t , to ) .
r (t )
r (t )
β
(17)
With initial conditions
1 (t0 , t0 )  [ [ I ]3 x3 [0]3 x ( n3) ]
1 (t0 , t0 )  2 (t0 , t0 )  [ [0]3 x3 [ I ]3 x3 [0]3 xm ].
We could solve Eq. (17), a 3 x n system of second order differential equations, instead of
the 6 x n first order system given by Eq. (11). Recall that the partial derivatives are
4
evaluated on the reference state and that the solution of the m x n system represented by
3 (t , to )  0 is trivial, i.e.,
3 (t , t0 )  [ [0]mx 6 [ I ]mxm ] .
In solving Eq. (17) we could write it as a system of n x n first order equations, i.e.,
1 (t , to )  2 (t , to )
2 (t , to ) 
r (t )
r (t )
r (t )
1 (t , to ) 
2 (t , to ) 
3 (t , to )
r (t )
r (t )
β
3 (t , to )  0.
It is easily shown that Eq. (18) is identical to Eq. (11), i. e.,
0 3 x 3
1 (t , to )  

   r (t ) 
2 (t , to )     r (t ) 
3x3
3 (t , to )   

 
0 mx 3
 I 3 x3
 r (t ) 
 r (t ) 

3x3
0 mx3
Or,
(t , to )  A(t )(t , to ).
5
0  3 xm


 r (t )  
 β  

 3 xm 
0 mxm 
*
1 (t , to ) 
 (t , t )  .
 2 o 
3 (t , to ) 
(18)
Download