Measuring In-Flight Angular Motion With A Low-Cost Magnetometer
Measuring In-Flight Angular Motion With A Low-Cost Magnetometer
Low-Cost Magnetometer
Disclaimers
The findings in this report are not to be construed as an official Department of the Army position
unless so designated by other authorized documents.
Thomas E. Harkins
Weapons and Materials Research Directorate, ARL
Michael J. Wilson
ATK
14. ABSTRACT
A technique for obtaining pitch, yaw, and roll rates of a projectile from a single, low-cost, commercial off-the-shelf
magnetometer has been developed at the Advanced Munitions Concepts Branch of the U.S. Army Research Laboratory’s
Weapons and Materials Research Directorate. In this report, the magnetometer-based methodology is presented, the flight
experiment and subsequent analyses are described, criteria for use of this methodology are given, and the potential uses of
this technique in inertial measurements unit/INS applications are discussed.
ii
Contents
List of Figures iv
1. Introduction 1
3. Vector Magnetometer 4
8. Summary 10
9. References 11
Distribution List 12
iii
List of Figures
iv
1. Introduction
The Advanced Munitions Concepts Branch of the U.S. Army Research Laboratory’s (ARL’s)
Weapons and Materials Research Directorate has for many years designed, built, and employed
body-fixed sensor and telemetry systems to measure flight body kinematics, primarily in support of
military ordnance testing. Because requirements imposed by military applications such as high-g
environment, extreme projectile dynamics, small size, low cost, low power consumption, etc.,
exclude many traditional inertial sensor systems, ARL is continually exploring emerging tech-
nologies and developing alternate techniques for their utility in obtaining desired measurements.
With the result from vector differentiation relating the time derivatives of a vector represented in
two coordinate systems in relative motion, a technique for obtaining pitch, yaw, and roll rates from
a single, low-cost, commercial off-the-shelf magnetometer was developed. In a recent ARL flight
experiment intended to characterize the angular motion of National Aeronautics and Space Admin-
istration (NASA) re-entry capsules, no data were available from the strap-down angular rate
sensors during critical portions of several flights because the launch environment and projectile
dynamics exceeded sensor capabilities. These rates were successfully derived from magnetometer
data, and complete Euler angular histories of the test trajectories were obtained with an ARL-
developed vector-matching algorithm.
In this report, the magnetometer-based methodology is presented, the flight experiment and sub-
sequent analyses are described, criteria for use of this methodology are given, and potential uses of
this technique in inertial measurement unit (IMU)/inertial navigation system (INS) applications are
discussed.
The equations of motion describing free-flight dynamics of rigid projectiles have six degrees of
freedom, three translational velocity components and three rotational velocity components. A
traditional strap-down IMU consists of an orthogonal triad of linear accelerometers and an or-
thogonal triad of angular rate sensors oriented along a projectile’s principal axes. Given initial
launch position, orientation, and velocity of a projectile, the rate sensors’ output is integrated to
update the projectile orientation, and the accelerometers are integrated once to update the projectile
velocity and twice to update the projectile position. The solution of the inertial navigation problem
is conceptually simple, but it is often difficult to realize an IMU capable of measuring the required
six body states under constraints imposed by a particular application. Although this problem is
1
equally of concern to accelerometers and rate sensors, only the orientation estimation (i.e., rate
sensor) problem is addressed herein.
Formulation of the inertial navigation problem for gun- and tube-launched projectiles requires the
use of multiple coordinate systems (Harkins, 2003, 2007). Trajectory time histories are best
described in an earth-fixed coordinate system with its origin at the launcher. Of necessity, strap-
down sensor measurements are made in a flight-body-fixed coordinate system, and target locations
are most naturally described in another earth-fixed system.
The first coordinate system is right-handed Cartesian (I,J,K) with its origin at the launch site. This
will be referred to as the “earth-fixed” system and the axes are defined by
• The I and J axes, which define a plane tangent to the earth’s surface at the origin;
• The K axis, which is perpendicular to the earth’s surface with positive downward, i.e., in
the direction of gravity;
• The I axis, which is chosen so that the centerline of the launcher is in the I-K plane.
Down-range travel is then measured along the I axis, deflection along the J axis (positive to the
right when one is looking down range), and altitude along the K axis (positive downwards) (see
figure 1).
The second system is convenient for aeroballistic computations of rigid projectiles’ flights and for
describing the locations and orientations of such projectiles’ components. This system is right-
handed Cartesian (i,j,k) with its origin at the center of gravity (c.g.) of the flight body. For rotating
flight bodies, the projectile-fixed coordinate system usually has its i axis lying along the projectile
axis of symmetry, i.e., the spin axis (with positive in the direction of travel at launch). The j and k
axes are then oriented so as to complete the right-handed orthogonal system (figure 1). Spin (p),
2
pitch (q), and yaw (r) rates are measured about these axes. This will be referred to as the “body-
fixed” system.
The third coordinate system (X,Y,Z) is commonly employed to specify locations on or near the
earth’s surface, i.e., north, east, and down. This will be referred to as the “navigation” system
where north = X , east = Y , and down = Z.
The earth-fixed and body-fixed coordinate systems are related through an Euler rotation sequence,
beginning with a rotation of the earth-fixed frame about the K-axis through the yaw angle ψ . The
system is then rotated about the new J’-axis through the pitch angle θ . Finally, the system is
rotated about the new i-axis through the roll angle φ . The two systems are related by the direction
cosine transformation matrix (DCM), TEb , with the subscript denoting earth fixed to body fixed.
This transformation matrix is
⎛ cψ cθ sψ cθ − sθ ⎞
⎜ ⎟
TEb = ⎜ cψ sθ sφ − sψ cφ sψ sθ sφ + cψ cφ cθ sφ ⎟ , (1)
⎜⎜ ⎟
⎝ cψ sθ cφ + sψ sφ sψ sθ cφ − cψ sφ cθ cφ ⎟⎠
where c• is cos(•) , and s• is sin(•) . Figure 2 shows both coordinate systems and the Euler angle
relations between them.
The body-fixed components of projectile angular motion and the Euler angle derivatives are
related by
φ& = p + [ q sin(φ ) + r cos(φ ) ] tan(θ )
θ& = q cos(φ ) − r sin(φ ) (2)
ψ& = (q sin(φ ) + r cos(φ ) ) cos(θ )
3
3. Vector Magnetometer
Among the many varieties of magnetic sensors, “vector” magnetometers are devices whose output
is proportional to the magnetic field strength along the sensor’s axis(es). If a tri-axial vector mag-
netometer is installed so that the sensor axes are parallel to the axes of the body-fixed system, the
projections of the earth’s magnetic field onto each of the sensor axes can be obtained by equation 1.
r
If M E = (M I , M J , M K ) is the magnetic field vector in the earth-fixed system, then the
components along the sensor axes are given by
r r
M b = TEb M E (3)
M i = cψ cθ M I + sψ cθ M J − sθ M K
or ( ) ( )
M j = cψ sθ sφ − sψ cφ M I + sψ sθ sφ + cψ cφ M J + cθ sφ M K (4)
( ) ( )
M k = cψ sθ cφ + sψ sφ M I + sψ sθ cφ − cψ sφ M J + cθ cφ M K
In any real magnetic sensor, determination of axes’ orientations and calibration coefficients can be
a complex process, but for the present purpose, it is assumed that this has been successfully accom-
r
plished and M b is being accurately measured at a known sampling rate.
Consider two coordinate systems with the same origin and in relative motion, e.g., the earth-fixed
and body-fixed systems just described at the time of projectile launch. From vector differentiation,
r r
the time derivative of any vector in the earth-fixed system (v& E = δ v E / δ t ) and its time derivative
r r
in the body-fixed system (v& = δ v / δ t ) are related by
b b
r r r r
v& E = v&b + ω b × vb (5)
r
where ω b = ( p, q, r ) . Applied to the geomagnetic field vector, equation 5 becomes
r& r& r r
M E = M b + ωb × M b (6)
Realizing that equation 6 is unaffected by a translation of the earth-fixed system’s origin to the
r
projectile c.g. at each sampling time and that M E is unchanging in the earth-fixed system and
expanding in component form, we have the relations
M& i = −qM k + rM j , M& j = pM k − rM i , and M& k = − pM j + qM i . (7)
4
Because these equations are not linearly independent, they can not be solved directly for the
angular rates. However, for most rolling projectiles where p >> q and r , a good estimate of p
is readily obtainable from the magnetometer data, as described in the next section. With a spin
estimate, this system can be solved to yield estimates of the body-fixed pitch and yaw rates.
Therefore,
( ) (
qˆ = M& k + pM j M i and rˆ = − M& j + pM k M i . ) (8)
Consider an earth-fixed, right-handed Cartesian coordinate system where the z-axis is along the
geomagnetic field. In this new system, denoted by the subscript m, the geomagnetic field vector is
r r
M m = (0,0, M E )T . As seen in section 2, there is a new set of Euler angles that defines a trans-
formation matrix from this magnetic coordinate system into the body-fixed system so that
⎛ Mi ⎞
⎜ r ⎟
⎜ ME ⎟
⎜ ⎟ ⎛ cψ m cθ m sψ m cθ m − sθ m ⎞⎛ 0 ⎞ ⎛ − sθ ⎞
⎜ Mj ⎟ ⎜ ⎟⎜ ⎟ ⎜ m ⎟
⎜ r ⎟ = ⎜ cψ m sθ m sφ m − sψ m cφ m sψ m sθ m sφ m + cψ m cφ m cθ m sφ m ⎟⎜ 0 ⎟ = ⎜ cθ m sφ m ⎟ (9)
⎜ ME ⎟ ⎜⎜ cψ sθ cφ + sψ sφ sψ m sθ m cφ m − cψ m sφ m
⎟⎟⎜ ⎟ ⎜⎜ ⎟⎟
⎜ Mk ⎟ ⎝ m m m m m
cθ m cφ m ⎠⎝ 1 ⎠ ⎝ cθ m cφ m ⎠
⎜ r ⎟
⎜ ME ⎟
⎝ ⎠
This gives a definition of the magnetometer measurements in terms of the magnetic Euler angles.
The magnetic pitch angle,
r
θ m = sin −1 − M i M E ,( ) (10)
r r
is the complement of the angle between the projectile’s spin axis ( i ), and the magnetic field, M E .
The magnetic roll angle, φ m , is computed by
φ m = tan −1 (M j M k ) (11)
Analogous to equation 2, the body-fixed rates and the derivatives of the magnetic Euler angles are
related by
φ&m = p + [ q sin(φ m ) + r cos(φ m ) ] tan(θ m )
θ&m = q cos(φ m ) − r sin(φ m ) (12)
ψ& m = (q sin(φ m ) + r cos(φ m ) ) cos(θ m )
5
Estimates of φm can be obtained in several ways. The simplest method is to make roll period
estimates from successive zero crossings or signal extrema on the Mj or Mk signals. This process
yields average roll rates over the respective periods. More continuous, higher order estimates are
obtained by the computation of equation 11 at each sampling time and the differentiation of the
results. Alternatively, φm is computed directly from
δ tan −1 ( M j M k ) δ ( M j M k ) ⎛⎜ 1 ⎞ ⎛ M M − M M
⎟=⎜ j k k j
⎞
⎟
= (13)
δT δT ⎜ 1 + (M M ) 2 ⎟ ⎜ M 2 + M 2 ⎟
⎝ j k ⎠ ⎝ j k ⎠
with the advantage of avoiding potential singularities in equation 11 when M k = 0 . The spin rate
(p) can then be estimated by low-pass filtering of the φ estimates (Wilson, 2004).
m
NASA needs to characterize the aerodynamics of the CEV that will be a part of future Mars
missions. Some previous measurements had been made in spark ranges with scale models of the
CEV, but this methodology cannot be employed to characterize all conditions of interest because of
velocity and stability limitations imposed by safety considerations in an indoor range. Further,
only limited amounts of data are collected for each shot in a spark range, so testing costs quickly
mount with the number of shots required. With the dual hope of expanding the set of potentially
measurable flight dynamics and reducing testing costs, it was decided that gun launching of Mars
CEV models equipped with a sensor and telemetry system (figure 3c) at an outdoor range would be
explored as a practicable way to acquire the desired data at reentry velocities (Brown et al., 2006).
Before proceeding to the Orion CEV tests, we evaluated the proposed methodology using an
Apollo capsule model with known aerodynamics (figure 3a and b). The sensor system consisted of
six angular rate sensors and a three-axis magnetometer. Along each of the principal axes there
were an angular rate sensor with a dynamic range of ± 1000 deg/s, an angular rate sensor with a
dynamic range of ± 2000 deg/s, and a vector magnetometer.
Figure 4 gives the body-fixed pitch axis rate sensor data for the first 0.5 second of one of the Apollo
model flight tests. Two “problems” with these data are readily apparent. First, the pitch (and yaw)
angular rates exceeded the dynamic range of the rate sensors and clipping resulted. Second, after
gun launch, the rate sensors required time to “settle”. This is obvious in the 1000-deg/s sensor data
but was later discovered to be equally true of the 2000-deg/s sensor data. Because of these issues,
the magnetometer-based method was used to estimate the angular rates and the Apollo model’s
attitude history.
6
a) Apollo model schematic b) Apollo model in sabot c) Orion CEV schematic
Figure 3. NASA re-entry vehicle models with sensor and telemetry system.
Initial spin rate was estimated to be approximately 2 Hz from a period measurement of radial
magnetometer output. With this value for p, equation 8 was evaluated to obtain estimates of the
body-fixed pitch (q̂ ) and yaw (r̂ ) rates. We estimated M and M by differencing the successive
k j
magnetometer measurements. The resulting pitch rate estimate is seen in figure 5a superimposed
on the rate sensor data. The good agreement of the magnetometer-derived pitch rate with the rate-
sensor-measured pitch rates whenever those measurements exist supports the accuracy of the
magnetometer-derived rate estimates at all other times. The magnetometer-derived rates indicate
initial pitching rates of approximately 4000 deg/s. These early data are particularly important
because the high-drag shape of the model causes the mach 3.5 launch velocity to decay to subsonic
speed in less than 1 second, and the high mach numbers are representative of re-entry velocities.
Later in the flight, as the model begins to tumble, pitch rates approaching 20000 deg/s are esti-
mated by the magnetometer (figure 5b). Although these data are not of interest for characterizing
7
CEV aerodynamics, they demonstrate that the magnetometer method does not suffer from dynamic
range limitations.
With θ m , φ m , q̂ , and r̂ in hand, equation 12 is used to compute ψ& m at each sampling interval.
The magnetic azimuth is then given by
t
ψ m (t ) = ψ m (0) +
∫0ψ m (t ) δ t . (14)
⎛θ ⎞ ⎛θm ⎞
⎜ ⎟ ⎜ ⎟
⎜ψ ⎟ = TmE ⎜ψ m ⎟ (15)
⎜φ ⎟ ⎜φ ⎟
⎝ ⎠ ⎝ m⎠
where TmE is the DCM relating the magnetic and earth-fixed coordinate systems. This metho-
dology has been successfully implemented in an on-board digital signal processor for real-time
guidance of experimental projectiles, as reported in reference 1. When this methodology was
executed during post-processing of the flight telemetry data, the Apollo model heading history seen
in figure 6 was computed for the first second of flight. With these data, aerodynamic coefficients
of interest were estimated for the test vehicle, and the flight experiment evaluation was successfully
completed.
8
Figure 6. Elevation (θ) and azimuth (ψ) angle history.
The effectiveness of this methodology is clearly dependent on the accuracy of the measurements
of M i , M j , M k , M& j , and M& k . Thus, a calibrated vector magnetometer is required. Calibration
constants can be determined on the ground and pre-loaded or often can be dynamically determined
in flight. We estimated M& j and M& k by differencing successive magnetometer measurements.
This simplistic method requires that data rates be sufficiently high to accurately estimate the
derivatives. Sampling rates of at least one sample per degree of projectile rotation have been
found to be adequate for a number of simulated projectiles. Alternatively, polynomial fitting to
the magnetometer data followed by analytic differentiation has been shown to produce equally
accurate results at lower sampling rates. Preferred methods should be determined for individual
applications.
9
8. Summary
Free flight angular dynamics of projectiles have been successfully measured with vector
magnetometers in flight experiments during intervals when angular rate sensors have failed to
provide measurements. This result argues for investigation of the inclusion of magnetometers as
supplements and/or replacements to rate sensors in low-cost IMU/INS systems.
10
9. References
Brown, T. G.; Brandon, F.; Bukowski, E.; Davis, B.; Hall, R.; Hathaway, W.; Muller, P.; Topper,
B.; Rodgers, A.; Vong, T. Calculating Aerodynamic Coefficients for a NASA Body Using
Telemetry Data From Free Flight Range Testing. 57th Aeroballistic Range Association
Meeting, Venice, Italy, September 2006.
Harkins, T. Understanding Body-Fixed Sensor Output From Projectile Flight Experiments;
ARL-TR-3029; U.S. Army Research Laboratory: Aberdeen Proving Ground, MD,
September 2004.
Harkins, T. Solving for Flight Body Angular Histories With the Use of Solar and Magnetic
Sensor Data; ARL-TR-4072; U.S. Army Research Laboratory: Aberdeen Proving Ground,
MD, April 2007.
Wilson, M. Attitude Determination With Magnetometers for Gun-Launched Munitions; ARL-
TR-3209; U.S. Army Research Laboratory: Aberdeen Proving Ground, MD, August 2004.
11
NO. OF NO. OF
COPIES ORGANIZATION COPIES ORGANIZATION
1 US ARMY RSRCH DEV & ENGRG CMD 1 DIR US ARMY CECOM RDEC
SYSTEMS OF SYSTEMS ATTN AMSEL RD C2 CS J VIG
INTEGRATION FORT MONMOUTH NJ 07703-5601
AMSRD SS T
6000 6TH ST STE 100 1 CDR US ARMY TACOM ARDEC
FORT BELVOIR VA 22060-5608 ATTN AMSRD AAR QEM E M BOMUS
BLDG 65S
1 DIRECTOR PICATINNY ARSENAL NJ 07806-5000
US ARMY RESEARCH LAB
IMNE ALC IMS 4 CDR US ARMY TACOM ARDEC
2800 POWDER MILL RD ATTN AMSRD AAR AEM A S CHUNG
ADELPHI MD 20783-1197 W KOENIG W TOLEDO
T RECCHIA
1 DIRECTOR BLDG 95
US ARMY RESEARCH LAB PICATINNY ARSENAL NJ 07806-5000
AMSRD ARL CI OK TL
2800 POWDER MILL RD 1 CDR US ARMY TACOM ARDEC
ADELPHI MD 20783-1197 ATTN AMSRD AAR AEM A F BROWN
BLDG 151
2 DIRECTOR PICATINNY ARSENAL NJ 07806-5000
US ARMY RESEARCH LAB
AMSRD ARL CI OK T 1 CDR US ARMY TACOM ARDEC
2800 POWDER MILL RD ATTN AMSRD AAR AEM C A MOCK
ADELPHI MD 20783-1197 BLDG 171A
PICATINNY ARSENAL NJ 07806-5000
3 DIR US ARMY RSCH LABORATORY
ATTN AMSRD ARL SE RL M DUBEY 1 CDR US ARMY TACOM ARDEC
B PIEKARSKI ATTN AMSRD AAR AEM C J POTUCEK
AMSRD ARL SE EE Z SZTANKAY BLDG 61S
2800 POWDER MILL RD PICATINNY ARSENAL NJ 07806-5000
ADELPHI MD 20783-1197
1 CDR US ARMY TACOM ARDEC
2 DIR US ARMY RSCH LABORATORY ATTN AMSRD AAR AEP S PEARCY
ATTN AMSRD ARL SE S J EICKE BLDG 94
AMSRD ARL SE SA J PRICE PICATINNY ARSENAL NJ 07806-5000
2800 POWDER MILL RD
ADELPHI MD 20783-1197 1 CDR US ARMY TACOM ARDEC
ATTN AMSRD AAR AEP M CILLI
3 DIR US ARMY RSCH LABORATORY BLDG 382
ATTN AMSRD ARL SE SS LADAS PICATINNY ARSENAL NJ 07806-5000
A EDELSTEIN D FLIPPEN
2800 POWDER MILL RD 5 CDR US ARMY TACOM ARDEC
ADELPHI MD 20783-1197 ATTN AMSRD AAR AEP E J VEGA
P GRANGER D CARLUCCI
1 DIR US ARMY RSCH LABORATORY M HOLLIS J KALINOWSKI
ATTN AMSRD ARL WM MB A FRYDMAN BLDG 94
2800 POWDER MILL RD PICATINNY ARSENAL NJ 07806-5000
ADELPHI MD 20783-1197
12
NO. OF NO. OF
COPIES ORGANIZATION COPIES ORGANIZATION
13
NO. OF NO. OF
COPIES ORGANIZATION COPIES ORGANIZATION
14
NO. OF NO. OF
COPIES ORGANIZATION COPIES ORGANIZATION
3 DIR USARL
ATTN AMSRD ARL WM BC
P PLOSTINS
B GUIDOS P WEINACHT
BLDG 390
3 DIR USARL
ATTN AMSRD ARL WM BD M NUSCA
J COLBURN T COFFEE
BLDG 390
2 DIR USARL
ATTN AMSRD ARL WM BF
W OBERLE A THOMPSON
BLDG 390
2 DIR USARL
ATTN AMSRD ARL WM MB
J BENDER W DRYSDALE
BLDG 390
15