Attitude Determination and Control
Attitude Determination and Control
(ADCS)
16.684 Space Systems Product Development
Spring 2001
Olivier L. de Weck
Department of Aeronautics and Astronautics
Massachusetts Institute of Technology
ADCS Motivation
Motivation
Spacecraft Control
Spacecraft Stabilization
Spin Stabilization
Gravity Gradient
Three-Axis Control
Formation Flight
Actuators
Reaction Wheel Assemblies
(RWAs)
Control Moment Gyros
(CMGs)
Magnetic Torque Rods
Thrusters
Euler Angles
Quaternions
Key Question:
What are the pointing
requirements for satellite ?
Outline
Opening Remarks
Terminology
ATTITUDE :
or Post-Facto knowledge,
within a given tolerance, of the spacecraft attitude
Maintenance of a desired, specified attitude
within a given tolerance
ATTITUDE CONTROL:
ATTITUDE ERROR:
ATTITUDE JITTER:
a
true
k
s
target
true
estimate
a
s
k
c
^ ^ ^
Y=ZxX
dihedral
th
g
n
e
l
Arc
D
VERNAL
EQUINOX
^
X
Inertial Coordinate
System
^
Y
X and Y are
in the plane of the ecliptic
Z A
Pz
A*
Py
Px
Px
A*
P = Py
P
z
YA
X A
1 0 0
Unit vectors of { A} = X A YA Z A = 0 1 0
0 0 1
Rotation Matrix
Z A
Jefferson
Memorial Y
Z B
YA
X A
Z A
X A X B
0
1
A
B R = 0 cos
0 sin
Jefferson
MemorialY
Z
A A
A
A
R
=
X
ZB
B
B YB
X B
RT R = I , RT = R 1
YA
- sin
cos
0
(2) Orthonormal:
R =1
Z B
Rotate about YB by
Z B
Z C
YB
X A
YA
X B
cos - sin
A
cos
B R = sin
0
0
X B
Z D
YB
Z C
YC
X C
0
0
Rotate about X C by
cos
B
CR= 0
- sin
YC
X C
0
1
0
A
A B C
D R= B R C R D R
sin
0
cos
YD
X D
0
0
1
C
D R = 0 cos - sin
0 sin cos
Zi (parallel to r)
about Yi
Concept used in rotational
about X
kinematics to describe body
Yaw
orientation w.r.t. inertial frame about Zb
Roll
Sequence of three angles and
Body
Xi
prescription for rotating one
CM
(parallel
reference frame into another
to v)
Pitch
Can be defined as a transformation
(r x v direction)
matrix body/inertial as shown: TB/I
Yi
Euler angles are non-unique and
r
nadir
exact sequence is critical
Note:
TB/1I = TI / B = TBT/ I
cos
Transformation
-sin
from Body to T
=
B/I
Inertial frame:
Euler Angles
sin
cos
0 1
0
0 cos 0 -sin
0 0 cos sin 0
1
0
0
0
1 0 -sin cos sin 0 cos
YAW
ROLL
PITCH
Quaternions
*
q = A vector describes the
K
Z A
EULERS THEOREM
Jefferson Memorial
Z B
X A
A: Inertial
B: Body
k x
A
K = k y
k
z
YB
YA
X B
q1 = k x sin
2
q2 = k y sin
2
q3 = k z sin
2
q4 = cos
2
Euler
Angles
Direction
Cosines
Angular
Velocity Z
Quaternions
Pluses
If given ,,
then a unique
orientation is
defined
Orientation
defines a
unique dir-cos
matrix R
Vector
properties,
commutes w.r.t
addition
Minuses
Given orient
then Euler
non-unique
Singularity
6 constraints
must be met,
non-intuitive
Best for
analytical and
ACS design work
Must store
initial condition
Computationally
robust
Ideal for digital
control implement
Best for
digital control
implementation
Time Derivatives:
(non-inertial)
Body
CM
r
^
k
^
K
Z = Angular velocity
of Body Frame
^i
Inertial
Frame
^j
Rotating
Body Frame
Y
J^
^
I
X
Applied to
position vector r:
r = R+
BASIC RULE:
Position
r = R + BODY +
INERTIAL = BODY +
Expressed in
the Inertial Frame
Rate
+
+
2
+
r=R
BODY
BODY
Inertial
relative accel
accel of CM
w.r.t. CM
coriolis
angular
accel
centripetal
Acceleration
H total =
r i mi ri
i =1
mn
Z
System in
motion relative
to Inertial Frame
.
ri
mi
rn
ri
r1
m1
.
r1
Y
If we assume that
X
(a)
(b)
Then :
H total =
mi R R
i =1
n
ANGULAR MOMENTUM
OF TOTAL MASS W.R.T
INERTIAL ORIGIN
mi i i
i =1
H BODY
BODY ANGULAR
MOMENTUM ABOUT
CENTER OFMASS
Collection of point
masses mi at ri
Note that Ui is
measured in the
inertial frame
i =
i ,BODY
+ i = i
RELATIVE
MOTION IN BODY
H = I
I11
I = I 21
I 31
I12
I 22
I 32
I13
I 23
I 33
I12 = I 21 = mi i 2 i1
I13 = I 31 = mi i1 i 3
I 23 = I 32 = mi i 2 i 3
I 22 = mi i21 + i23
i =1
n
I 33 = mi i21 + i22
i =1
i =1
n
i =1
n
i =1
Etotal
2 1 n
1 n
= mi R + mi i2
2 i =1
2 i =1
E-TRANS
E-ROT
1
1
EROT = H = T I
2
2
H = T I
H 1 = I11 = T1 + ( I 22 I 33 ) 23
H 2 = I 2 2 = T2 + ( I 33 I11 ) 31
H = I = T + ( I I )
3
3 3
11
22
1 2
Euler Equations
x , y << z =
By these assumptions:
x (t ) = xo cos n t
y (t ) = yo cos n t
x =
n2 = K x K y 2
Z
I xx I yy
H
Z
I zz I yy
I xx
Kx
I zz I xx
y
y =
I yy
e
Con
Iz < Ix = I y
y
Bod
ne
Co
dy
Bo
Sp
ac
eC
on
e
Ky
Q : nutation
angle
Space
Cone
Iz > Ix = I y
z = 0
H and Z never align
unless spun about
a principal axis !
Zb
Perfect Cylinder
I xx = I yy
Antenna
despun at
1 RPO
I zz
mL
2
= + R
4 3
mR 2
=
2
Yb
Xb
DUAL SPIN
:
BODY
Disturbance Torques
Assessment of expected disturbance torques is an essential part
of rigorous spacecraft attitude control design
Typical Disturbances
Gravity Gradient
n = / a 3 = ORBITAL RATE
1) Local vertical
2) 0 for symmetric spacecraft
Gravity Gradient:
3) proportional to
r = sin
Zb
^r
T = 3n 2 r I r
Gravity Gradient
Torques
In Body Frame
1/r3
Small
angle
approximation
T
Xb
- sin T
1]
Earth
( I zz I yy )
T 3n 2 ( I zz I xx )
lib = n
3 ( I xx I zz )
I yy
Aerodynamic Torque
T = r Fa
1
Fa = V 2 SCD
2
Aerodynamic
Drag Coefficient
1 CD 2
Typical Values:
Cd = 2.0
S = 5 m2
r = 0.1 m
r = 4 x 10-12 kg/m3
T = 1.2 x 10-4 Nm
Notes
(1) r varies with Attitude
(2) U varies by factor of 5-10 at
a given altitude
(3) CD is uncertain by 50 %
U = Atmospheric Density
2 x 10-9 kg/m3 (150 km)
3 x 10-10 kg/m3 (200 km)
7 x 10-11 kg/m3 (250 km)
4 x 10-12 kg/m3 (400 km)
Magnetic Torque
T = M B
M = Spacecraft residual dipole
in AMPERE-TURN-m2 (SI)
or POLE-CM (CGS)
M = is due to current loops and
residual magnetization, and will
be on the order of 100 POLE-CM
or more for small spacecraft.
Typical Values:
B= 3 x 10-5 TESLA
M = 0.1 Atm2
T = 3 x 10-6 Nm
B ~ 0.3 Gauss
at 200 km orbit
Ps = I s / c
(2)
(3)
Internal Torque:
Notes:
(1)
(2)
r
mg
Pivot Point
Air Bearing
Body
CM
Air
Bearing
ground
Important
to balance
precisely ! Initial Assumption:
H = T = rF
dH H
H=
dt
t
H rF t
'H
H = 2 H sin
H = I
2
Large Z
=
gyroscopic
stability
rF t rF
=
t
H
I
'T
H
T = rF
F into page
BODY rotates at
one RPO (rev per orbit)
O.N.
do
nadir
wn
Wheel spins
at rate :
For three-axes of torque, three wheels are necessary. Usually use four
wheels for redundancy (use wheel speed biasing equation)
If external torques exist, wheels will angularly accelerate to counteract
these torques. They will eventually reach an RPM limit (~3000-6000
RPM) at which time they must be desaturated.
Static & dynamic imbalances can induce vibrations (mount on isolators)
Usually operate around some nominal spin rate to avoid stiction effects.
Ithaco RWAs
(www.ithaco.com
/products.html)
Waterfall plot:
Can be used
Thrusters / Jets
Currently 27 Satellites
12hr Orbits
Accurate Ephemeris
Accurate Timing
Stand-Alone
100m
DGPS
5m
Carrier-smoothed DGPS 1-2m
Magnetometers
Bnorth
3 C
B = 6378 0
east r
Bdown km 2S
S C
S S 29900
S
C 1900
2C C 2C S 5530
Me
flux
lines
+Y
+X
Mechanical gyros
(accurate, heavy)
Ring Laser (RLG)
MEMS-gyros
Typical
Accuracy
Remarks
Sun
1 min
Earth
0.1 deg
Magnetic Field
1 deg
Stars
0.001 deg
Inertial Space
0.01 deg/hour
Orbit dependent;
usually requires scan;
relatively expensive
Economical; orbit
dependent; low altitude
only; low accuracy
Heavy, complex,
expensive, most
accurate
Rate only; good short
term reference; can be
heavy, power, cost
Potential Solution:
Electronic Compass,
Magnetometer and
Tilt Sensor Module
Specifications:
Heading accuracy: +/- 1.0 deg RMS @ +/- 20 deg tilt
Resolution 0.1 deg, repeatability: +/- 0.3 deg
Tilt accuracy: +/- 0.4 deg, Resolution 0.3 deg
Sampling rate: 1-30 Hz
Three-Axis Stabilization
De-Spun Stages
Typical Accuracy
Remarks
Spin Stabilized
0.1 deg
Gravity Gradient
1-3 deg
Jets
0.1 deg
Magnetic
1 deg
Reaction Wheels
0.01 deg
3-axis stabilized, active control most common choice for precision spacecraft
+
-
'T
error
signal
Spacecraft
Control
Actuators
Tc
gain
Ta
Actual
Pointing
Direction
Attitude Measurement
T = K
c
Correction
torque = gain x error
Tsat
K
sat
hence
K
+ sat 0
I
K
I
[rad/sec]
I = moment
of inertia
f =
2
[Hz]
1 2
= =
f
, sat ,
EXAMPLE:
sat = 102
[rad]
Tsat = 10 [Nm]
I = 1000
[kgm 2 ]
K = 1000
=1
[Nm/rad]
[rad/sec]
f = 0.16
[Hz]
= 6.3 [sec]
I = Tw + Text = I = H
Wheel
Dynamics
+ ) = T = h
J (
w
Feedback
Law, Choose
Tw = K p K
r
, ,
+ (K r / I ) + (K p / I ) = 0
s 2 + (K r / I ) s + K p / I = 0
s + 2 s + = 0
2
Im
Stabilize
RIGID
BODY
Rate
feedback
Position
feedback
Then:
Y
D
BO
Re
Laplace Transform
Characteristic Equation
Nat. frequency
= Kp / I
damping
=K r / 2 K p I
Tc
SWITCH
LINE
l
.
I = T c
Problem
Fl
c
T = 0
Fl
T c = Fl sgn +
Where
T c = Fl
T = Fl
c
PHASE PLANE
On/Off
Control
only
sgn ( x ) =
x
x
)
prediction
term
W = time constant
Solution:
Eliminate Chatter by Dead Zone ; with Hysteresis:
T c = Fl
TC
+
-
E1 E2
T c = Fl
= +
Is 2
1+ s
PHASE PLANE
At Switch Line:
+ = 0
max
DEAD ZONE
max
estimate
dynamic
disturbances
Controller
Estimator
true
Spacecraft
Sensors
accuracy + stability
knowledge error
sensor noise,
misalignment
Attitude Determination
1
raw
gyro rate
2
inertial
update
Switch
Kalman
Logical
NOT
Fixed
Gain
Example:
Attitude
Estimator
for NEXUS
Wc comp rates
2
filtered/corrected
rate
estimated
1
quaternion
Switch1
true
solution
a priori
estimate
^
Y
Locus of
possible attitudes
from earth cone
with error band
Define:
i = u / u
j = (u v ) / u v
k = i j
Want Attitude Matrix T:
jB kB = T iR jR kR
i
B
u,v
So:
T = MN 1
H = I
CONSTANT
Conservation of
Angular Momentum
EROT
1 T
= I
2
DECREASING
EXPLORER 1
initial
spin
axis
energy dissipation
Controls/Structure Interaction
Spacecraft
Sensor
Flexibility
Stable
no encirclements
of critical point
NM axis 1 to NM axis 1
200
Gain
[dB]
-200
-2000
-1500
-1000
-500
Phase [deg]
500
1000
Ground Processing
Testing
Maneuvers
Attitude/Translation Coupling
Simulation
CM
l
T
(1)
F1 (2)
F
T
'F
Lower Cost
x 2yn
3n 2 x = a x
= ay
y + 2xn
+ n 2z
z
Circula r P a ra boloid
0.5
Ellips e
-0.5
-1
-1.5
0.5
1.5
1.5
0.5
-0.5
-1
-1.5
TPF
= az
NGST
ACS
Design
Command 3
Rate
Command
Position
KF Flag
FEM
3
72
72 DOF
ACS Rate
Matrix
gyro
Qt true attitude
Qt prop
6x1
Forces &
Torques
4
Wt true rate
Wheels
Deployable
secondary
Mirror (SM)
cold side
arm side
*
Guide Star
Source: G. Mosier
NASA GSFC
*
Target
Guider
Camera
Rule of thumb:
Pointing Jitter
RMS LOS < FWHM/10
References