In this project, you will investigate the attitude motion of the

advertisement
In this project, you will investigate the attitude motion of the Wilkinson Microwave Anisotropy
Probe (WMAP) spacecraft. The spacecraft was launched on June 30, 2001. The main objectives of the
WMAP mission include: (1) to create a full-sky map of the cosmic microwave background and
measure anisotropy with 0.3 angular resolution, and (2) to answer fundamental cosmological questions
such as, inflationary versus non-inflationary “big bang” models, accurate determination of the Hubble
constant, and the existence and nature of dark matter.
The ideal orbit for the WMAP spacecraft is about the Earth-Sun L2 Lagrange point, which is a
Lissajous orbit with approximately a 180-day period. Because of its distance, 1.5 million km from
Earth, this orbit affords great protection from the Earth's microwave emission, magnetic fields, and
other disturbances, with the dominant disturbance torque being solar radiation pressure. It also
provides for a very stable thermal environment and near 100% observing efficiency, since the Sun,
Earth, and Moon are always behind the instrument's field of view. In this orbit MAP sees a Sun/Earth
angle between 2 and 10 degrees. The instrument scans an annulus in the hemisphere away from the
Sun, so the universe is scanned twice as the Earth revolves once around the sun.
The spacecraft orbit and attitude specifications are shown in Figure 1. To provide the scan pattern,
the spacecraft spins about the z-axis at 0.464 rpm, and the z-axis cones about the Sun-line at 1 rev/hour.
A 22.50.25 angle between the z-axis and the Sun direction must be maintained to provide a constant
power input, and to provide constant temperatures for alignment stability and science quality. The
instrument pointing knowledge is 1.8 arcmin (1), which is not required for onboard or real-time
implementation.
Fig. 1 WMAP Spacecraft Specifications
The spacecraft’s attitude is defined by a 3-1-3 Euler angle rotation (  ,  , ) relative to a rotating,
Sun-referenced frame. The desired (note any variable with a ~ above it denotes a desired quantity, i.e.
this is what you want your spacecraft to do) Euler parameters for the observing mode are
 1
rev
rad
 0.001745
hr
sec
  22.5  0.3927 rad
  0.464 rpm  0.04859
rad
sec
(1a)
(1b)
(1c)
The desired Euler angles for  and  over time are determined by a simple integration of their
respective desired constant Euler rates,  and  from Eqs. (1a) and (1c), with   0   0 and
  0   0 . Also, note that   0 for all time. The inertia matrix for the WMAP spacecraft is given by
 399 2.81 1.31
J   2.81 377
2.54  kg  m2
 1.31 2.54 377 
(2)
You are to perform the following computer-based tasks (show all of your codes):
1. Pick a time interval of 1 second and a final time of 2 hours (7,200 seconds) and determine the
desired Euler angles (  ,  , ) for the entire time span. Determine the desired scan pattern over
the entire time span using the following equations (plot y versus x ):
e1  cos  cos cos   cos 2  sin sin   sin 2  sin 
e2  cos  cos sin   cos 2  sin cos   sin 2  cos 
e3  cos  sin   sin  1
x
e1
1  e3
y
e2
1  e3
(3)
2. Pick a time interval of 0.1 seconds and a final time of 10 minutes (600 seconds) and again
determine the Euler angles and Euler rates, now for this new time interval and time span. Using
a 3-1-3 attitude sequence, determine the desired body angular velocity trajectories, denoted by
  t   1  t  2  t  3  t  , and plot your results (store these angular velocity trajectories
T
because you’ll need then later).
3. Compute the Euler angle attitude matrix using a 3-1-3 attitude sequence at the initial time only,
i.e. with   22.5 and   0     0   0 (note  does not change with time). Extract the
initial-time desired quaternion, denote by q  0  , from this initial-time attitude matrix and show
your result.
4. Using the initial quaternion determined in part 3. and the body angular velocities determined in
part 2., determine the desired quaternion trajectory, denoted q  t  , by propagating the
kinematics equation using the following closed-form solution (store the quaternion trajectory):
q  t  t      t   q  t 
(4)
 1


1

 t 
sin    t  t    t 
cos  2   t  t  I    t  



2

 ,  t  
   t    



t
1



 T  t 
cos    t  t  

2


(5)
where
Note again that t  0.1 seconds and the final time is 600 seconds. Plot q  t  versus time.
5. Write a computer program to numerically integrate the combined quaternion kinematics and
Euler’s rotational equations:
q
  J
1
1
 q  
2
   J   J
(6)
1
L
6. You will now design a controller to drive the quaternion q  t  to the desired quaternion
trajectory q  t  , computed earlier, and drive the angular velocity   t  to the desired angular
velocity trajectory   t  , also computed earlier. Use the following control law:
L  kq T  q  q  k     
(7)
Use the gains kq  k  10 and set the initial quaternion to q  0   0 0 0 1
T
and the
initial angular velocity to   0   0 0 0 . Perform the simulation with t  0.1 seconds
and a final time of 600 seconds. Compute the following error quaternion at each time step:
T
1/ 2   
1
  q q

q
4 

q  
(8)
Convert  from radians to degrees, which are components of the small roll, pitch and yaw
error-angles. Show plots of   t  ,   t     t  and L  t  over the 600 second span.
EXTRA CREDIT:
Change the control gains kq and k , and see how the errors for   t  ,
  t     t  and L  t  change. Discuss how the magnitude of the control input, L  t  , changes for
various gains.
Download