Professional Documents
Culture Documents
both for the first flight test, Exploration Flight Test 1, and for the first planned Orion mission, Exploration Mission 1.
A detailed tradeoff of possible design decisions is discussed, and the choices made by Orion are presented. The actual
performance of the navigation system during Exploration Flight Test 1 is presented together with the navigation
flight-software data provided by Orion to the ground controllers in telemetry.
2 3
bgx The transformation matrix Tcctk
takes vector coordinates from the
6 7 case frame at time t to the case frame at time tk .
bg 4 bgy 5
bgz
III. Coarse Align Design
The gyro angular random walk is represented by νg ; the model of The coarse align computer software unit’s (CSU’s) main purpose is
the gyro’s angular velocity measurement ω~ c is given by to compute an initial estimate of the attitude of the Orion vehicle
while on the pad to initialize the EKF. The output attitude is based on
~ c I3 Γg Sg ωc bg νg
ω a simple filtering of high-rate IMU data with the assumption that the
vehicle has zero velocity in the Earth-fixed frame.
I3 Δg ωc bg νg (1) Orion IMU sensor internal sampling is done at a very high rate to
accommodate high-rate compensations such as coning, sculling, size
where I3 is a 3 × 3 identity matrix, the superscript c indicates that this effect, and accelerometer digitizer asymmetry compensation. The
is a measurement expressed in case-frame coordinates, and ωc is the high-rate data are used to form compensated 200 Hz delta angles and
“true” angular velocity in the case frame. Internally, the actual delta velocities in the body frame. The 200 Hz data are organized in
measurement from the gyros is an integrated angular rate that, if used buffers and passed to the Orion flight computer at 40 Hz. Low-pass
directly by the Kalman filter, would produce a suboptimal estimator second-order filters are applied to the IMU measurements to remove
[12]. A coning algorithm [13] is included in the sensor’s firmware and noise and oscillatory motion due to wind (twist and sway).
applied to the measurement, therefore the actual measurement The expected output of the coarse alignment, Tce , is the attitude
Downloaded by UNIVERSITY OF COLORADO on April 29, 2017 | http://arc.aiaa.org | DOI: 10.2514/1.G002666
outputted by the gyro is given by of the IMU case frame with respect to the Earth-fixed frame e
Zt (or International Terrestrial Reference Frame). An intermediate
k 1 calculation is T cned , which represents the transformation matrix of the
Δθ~ ck Δθ~ cckk−1 ~ c τ Δθ~ cτ
ω ~ c τ dτ Δθ~ cck−1
×ω 0
tk−1 2 ck−1 k−1 vehicle attitude with respect to the north–east–down frame:
(2)
Tce Tcned × Tned
e
B. Accelerometer Model
The transformation matrix Tned
e is determined from the surveyed
coordinates of the pad.
Similar to the gyros, the accelerometer scale factor represents the A potential algorithm singularity exists if Δvcfilt and Δθcfilt vectors
error in conversion from raw sensor outputs (accelerometer digitizer are colinear. This condition does not occur unless the alignment is
pulses) to engineering units and is modeled as a first-order Markov done near the north or south pole; however, the software contains a
process in terms of a diagonal matrix given as
check to ensure that jΔθcfilt × U^ c j is of reasonable size before
2 a 3 computing E^ c .
sx 0 0
Sa 4 0 say 0 5
0 0 saz IV. Fine Align Design
As previously mentioned, the goal of fine align is to improve the
As mentioned in the previous section, the gyro is taken as the attitude estimate before launch. The only measurement available is
aligned sensor, and the accelerometer misalignment relative to the the IMU measurement, which is used by an EKF in conjunction with
gyro is taken into account. The accelerometer misalignment and a pseudomeasurement relating the information that, before liftoff, the
nonorthogonality errors are combined and expressed in terms of six vehicle is not moving with respect to the pad.
different small angles as The EKF software is shared between fine align operations and
2 3 atmospheric flight operations (ascent, ascent aborts, and entry); all
0 ξaxy ξaxz measurements are incorporated in the navigation solution at 1 Hz,
6 ξayz 7
Ξa 4 ξayx 0 5 which is the GPS measurement rate used during atmospheric flight.
ξazx ξazy 0 The attitude control algorithm used during atmospheric flight (ascent
aborts and entry) necessitates estimates from the navigation solution
at a higher rate than 1 Hz; thus, delta velocity delta attitude
The bias errors are modeled as a first-order Gauss–Markov accumulator (DVDAAccum) computer software unit (CSU) is used
processes as as the high-rate IMU accumulator and attitude propagator
2 3 complement to EKF CSUs in the 1 Hz rate group. The vehicle
bax attitude is propagated forward in time through the use of accumulated
6 7 sensed Δθ data. The CSU also accumulates Δv measurements, which
ba 4 bay 5
are used by the position and velocity fast propagator (PVPropFast) to
baz
compute high-rate position and velocity for downstream users. The
attitude of DVDAAccum and the state of PVPropFast are resynched
The accelerometer measurements a~ c are modeled as to the 1 Hz rate group estimate each second.
DVDAAccum receives feedback data from the 1 Hz EKF CSUs
a~ c I3 Sa Ξa ac ba νa (3) and uses it to perform an update. During the update phase,
DVDAAccum replaces the estimates of the IMU errors with the most
where ac is the true nongravitational acceleration in the case frame. current values from the EKF, transforms the values of the inertial
The quantity νa is the velocity random walk. accumulated delta velocity into the updated inertial frame, and
The actual measurement is accumulated acceleration in the case updates the inertial to Orion body attitude with the information from
frame, Δv~c , which is mapped to the end of its corresponding time the filter.
interval by the sculling algorithm within the IMU firmware: As mentioned previously, the Orion fine alignment algorithm uses
Zt the same extended Kalman filter architecture and CSU as that used for
k
Δv~ck Δv~cckk−1 Tcct
k
a~ c t dt (4) atmospheric navigation (named ATMEKF). This paper presents the
tk−1 design of the fine align portion of the algorithm and trade studies that
were conducted between three different type of fine align
where Δv~ck covers the time interval from tk−1 to tk , and ct is the measurements: integrated velocity (IV), zero velocity (ZV), and
instantaneous case frame. pad position (Pos). All these measurements are pseudomeasurements
Article in Advance / ZANETTI ET AL. 3
(no sensor exists that produces them); instead, the measurements are where Φt; t0 is the state transition matrix. With this in mind, the
derived from the known fact that the vehicle is not moving with partial derivative of the IV measurement is as follows:
respect to the launch pad. Hence, the actual measurement used in the
filter is the theoretical value corresponding to absence of motion, and ∂hIV
^ Tei t − Tei t0 Φrr t; t0
x (11)
the measurement error is given by the variation from this theoretical ∂r
value due to twist and sway oscillations of the launch stack. This
motion is forced by wind and is a function of the bending modes of
the launch system. ∂hIV
^ −Tei t0 Φrv t; t0
x (12)
The navigation center of computations is given by the IMU ∂v
location. During EFT-1, the Orion EKF used an IV measurement
during the fine align phase. For EM-1 and beyond, three possible
solutions are considered. ∂hIV
^ −Tei t0 Φrϕ t; t0
x (13)
1) The IV measurement returns the change in Earth-centered ∂ϕ
Earth-fixed (ECEF) position over a specified amount of time,
typically the call rate of the EKF, which for EFT-1 is 1 s. The
processed measurement is always given by the nominal value of zero. ∂hIV
^ −Tei t0 Φrba t; t0
x (14)
The measurement noise is given by the change of position of the IMU ∂ba
over 1 s due to twist and sway of the stack.
Downloaded by UNIVERSITY OF COLORADO on April 29, 2017 | http://arc.aiaa.org | DOI: 10.2514/1.G002666
Notice that this measurement is nonlinear, potentially highly where bpad is the launch pad location survey error, and ηPos is the
nonlinear, because to calculate r^i0 it is necessary to backintegrate the measurement noise, which exactly cancels out the motion due to twist
nonlinear equations of motion that also contain the estimates of the and sway. The estimated measurement is given by
IMU error parameters. The measurement residual is
^ t Tei tr^i b^pad
y^ Pos hPos x; (21)
ϵIV yIV − y^ IV (7)
The measurement residual is
As a first-order approximation (used to obtain the IV measurement
partials or measurement mapping matrix HIV ), ϵPos yPos − y^ Pos HPos x
^ x^ ηPos (22)
∂hPos
^ Tei t
x (23)
∂h ∂h ∂r
IV x^ IV Φt; t0 x^ ηIV (9)
∂x ∂x0
∂hPos
x
^ I3×3 (24)
HIV xx
^ − x
^ ηIV (10) ∂bpad
4 Article in Advance / ZANETTI ET AL.
Notice that this is a linear measurement, and the measurement increase of the position estimation error covariance produced by the
noise is given by the displacement due to sway. filter during fine align. Figure 1 shows linear covariance analysis
results, including the increase in position uncertainty (Fig. 2 in the
C. Zero Velocity next section contains the telemetry covariance from the day of flight
The zero-velocity measurement is expressed as follows: and shows a very close match with the linear covariance analysis
results). Very long pad operations can cause the position estimation
yZV hZV x; t ηZV Tei tvi − ωiE × ri ηZV 0 (25) error to become excessively large, forcing the ground to send a
position reanchoring command before launch, as routinely done in
Space Shuttle missions. Two options are possible for the reanchoring:
where ωiE is the Earth angular velocity vector, and ηZV is the
overwriting the state only (hence having a good state estimate but a
measurement noise, which exactly cancels out the motion due to twist
large, overconservative estimation error covariance) or reinitializing
and sway. The estimated measurement is given by
the position error covariance as well (hence losing the correlations
between position and all other states).
^ t Tei tv^ i − ωiE × r^i
y^ ZV hZV x; (26)
During very long pad alignment times, the position covariance
eventually ceases to increase and asymptotically settles to a large
The measurement residual is value. The reason is that some position observability is extracted from
the gravity model and the measurement of gravity by the
ϵZV yZV − y^ ZV HZV x
^ x^ ηZV (27) accelerometer as well as from the direction of Earth’s rotation
Downloaded by UNIVERSITY OF COLORADO on April 29, 2017 | http://arc.aiaa.org | DOI: 10.2514/1.G002666
Fig. 1 Linear covariance analysis showing position, velocity, and attitude 3σ covariance while processing IV measurements.
Article in Advance / ZANETTI ET AL. 5
Downloaded by UNIVERSITY OF COLORADO on April 29, 2017 | http://arc.aiaa.org | DOI: 10.2514/1.G002666
Fig. 4 Linear covariance analysis showing position, velocity, and attitude 3σ covariance while processing pad position measurements.
gravity and IMU data. Two errors affect the measurement. The first is fixed coordinates and is modeled as
due to oscillations because of twist and sway; this error source is
aleatory in nature and is modeled as white noise. The second source ypad re bepad hpad
of error is repeatable and is given by the survey error of the pad
location together with the error in establishing the position of the where re is the ECEF position vector, bepad is the survey error of the
IMUs with respect to the pad. This error is accounted for as a state in pad position, and ηpad is the nonrepeatable error of the measurement.
the filter.
The filter is initialized with the pad surveyed position coordinated in
The normalized squared measurement residual values for each of
the inertial frame, that is, the initial position estimate is given by
the three components of the position observation are calculated
before processing any observations; normalization is with respect to
the filter’s predicted residual standard deviation. If any of the three ^ 0 Tie t0 ypad
rt
values exceeds the limit, all observation components are discarded
for this cycle. where Tie is the direction cosine matrix transforming inertial
The state vector components are divided in dynamic states X and coordinates into Earth-fixed coordinates; therefore, the initial
parameter states (IMU errors and GPS PR errors) . Parameter states position estimation error er t0 is given by
differ from the other states in that they are modeled as first-order
Markov processes; therefore, their time evolution is known ^ 0 Tie t0 re − Tie t0 re bepad hpad (31)
er t0 rt0 − rt
analytically and does not necessitate numerical integration. In
addition, their state transition matrix is also known analytically, and it
is very sparse, making their covariance matrix propagation extremely −Tie t0 bepad − Tie t0 ηpad −Tie t0 eebpad − Tie t0 ηpad (32)
numerically efficient:
T T
The last equality holds because the initial estimated pad survey
X XT (30) error is zero (otherwise, the estimate error would be subtracted from
Table 4 EFT-1 EKF navigation states where P 0 bpad ; bpad is the 3 × 3 covariance of the pad survey error
Number of
state, P0 r; r is the 3 × 3 initial covariance of the position state, and
State elements Description P 0 X; bpad is the cross covariance between any state X and the pad
Position 3 Position vector in inertial coordinates survey error state. Notice that the contribution of the covariance of
Velocity 3 Velocity vector in inertial coordinate ηpad is neglected during initialization because it is much smaller than
Attitude 3 Multiplicative attitude deviation state the survey error. The resulting 12 × 12 position, velocity, attitude,
Clock bias and drift 2 Only one GPS receiver used in EFT-1 and pad survey error covariance matrix is generally nondiagonal and
is converted to its UDU factorization for the filter to use. Notice that
this covariance is singular; however, no issues arise from this fact.
If desired, the covariance can be made nonsingular by slightly
Table 5 EFT-1 EKF navigation parameters increasing the position uncertainty by the covariance of ηpad .
Parameter Number of elements
Gyro bias 3 V. Prelaunch Exploration Flight Test 1 Design
Gyro scale factor 3 and Performance
Gyro nonorthogonality 3
Accelerometer high-g bias 3 To reduce the computation burden, EFT-1 EKF design did not
Accelerometer low-g bias 3 include GPS PR bias states; refer to [4] for more details on the
Accelerometer scale factor 3 postliftoff portion of EFT-1 navigation design and performance. The
Downloaded by UNIVERSITY OF COLORADO on April 29, 2017 | http://arc.aiaa.org | DOI: 10.2514/1.G002666
Accelerometer misalignment and nonorthogonality 6 state space of EFT-1 navigation filter design is shown in Tables 4
and 5.
The tuning of the fine align navigation phase for EFT-1 is nearly
the estimated position, resulting in a new estimated position with zero identical to that of the ascent phase described in [4]; in particular, an
estimated error). Equation (32) shows the correlation between the 8 × 8 gravity field is used, and the process noise is given by the IMU
initial position and the survey error state; from it, we deduce the angular random walk and velocity random walk values. As stated
previously, the IMU states are modeled as first-order Gauss–Markov;
values for the following elements of the initial covariance matrix:
a time constant of 4 h was used (the total flight duration was 4.5 h, and
these errors were expected to remain nearly constant). The IMU state
P0 bpad ; bpad Tei t0 P0 r; rTie t0 (33) process noise values are chosen to match the steady-state value of the
Markov processes to the vendor’s specification. The integrated
velocity error is unique to fine align; it was determined that an 8 in.
P 0 X; bpad P0 X; rTie t0 (34) displacement was the maximum oscillation of the IMU due to twist
and sway motion on the pad, making the peak-to-peak error 16 in. A
1σ IV error of 0.4 ft was chosen for EFT-1, which places the worst
P 0 bpad ; X Tei t0 P0 r; X (35) possible displacement case at a 4σ value.
Figure 5 shows the performance of the filter processing this measurements are accepted, and zero rejections occur. The residuals
measurement by means of the measurement residual (actual are extremely small with respect to their predicted standard
measurement minus estimated measurement) and their predicted 3σ deviation; this suggests that the filter is overly conservative. This
standard deviation (dashed lines). It can be seen that the residuals fact was expected, and a design choice was shown through
are well within their predicted standard deviations; all of the simulation to add robustness to large twist and sway motion of the
Article in Advance / ZANETTI ET AL. 9
Downloaded by UNIVERSITY OF COLORADO on April 29, 2017 | http://arc.aiaa.org | DOI: 10.2514/1.G002666
launch vehicle. During the day of flight, little to no twist and sway Figure 2 shows the filter’s position, velocity, and attitude
was observed. Figure 5 shows the results from the first flight covariance. Figures 7 and 8 show the accelerometer and gyro error
computer (FCM1, flight control module 1) and the first navigation states covariance, respectively. Figures 9 and 10 show the filter’s
channel (CH1, channel 1). A zoomed-in plot of the residuals from estimates of the accelerometer and gyro errors, respectively. The
channel 2 is shown in Fig. 6. Throughout the flight, the performance performance is as expected.
of the two channels is nearly identical; therefore, only results from Finally, Figures 11–13 show the position, velocity, and attitude
channel 1 are shown for the remainder of this section. estimates from the user parameters processor, which, for the entire
10 Article in Advance / ZANETTI ET AL.
Downloaded by UNIVERSITY OF COLORADO on April 29, 2017 | http://arc.aiaa.org | DOI: 10.2514/1.G002666
flight, provided the outputs from channel 1. Notice that some IMU [3] Battin, R. H., An Introduction to the Mathematics and Methods of
parameters are not observable, but they are kept in the filter for two Astrodynamics, AIAA Education Series, AIAA, New York, 1987,
reasons. First, they correctly condition the covariance. Second, they pp. 751–783.
become observable with GPS after the high dynamics of ascent builds [4] Zanetti, R., Holt, G. N., Gay, R. S., D’Souza, C., Sud, J., Mamich, H.,
Bagley, M., King, E., and Clark, F., “Orion Exploration Flight Test 1
correlations. Many plots of unobservable variances do not show all (EFT1) Absolute Navigation Performance,” Journal of Guidance,
lines because they are superimposed with each other. Control, and Dynamics (accepted for publication).
doi:10.2514/1.G002371
VI. Conclusions [5] Sud, J., Gay, R., Holt, G., and Zanetti, R., “Orion Exploration Flight Test
1 (EFT1) Absolute Navigation Design,” Proceedings of the AAS
This paper documents the design of the Orion ground navigation Guidance and Control Conference, Vol. 151, American Astronautical
system and presents its performance during Exploration Flight Test 1 Soc. Paper 14-092, Springfield, VA, Jan.–Feb. 2014, pp. 499–509.
(EFT-1). Characteristics of the EFT-1 design are introduced, and data [6] Holt, G., Zanetti, R., and D’Souza, C., “Tuning and Robustness
from the flight are shown to validate the design choices. These data Analysis for the Orion Absolute Navigation System,” AIAA Guidance,
illustrate a flight in which the absolute navigation system performed Navigation, and Control (GNC) Conference, AIAA Paper 2013-4876,
as expected and produced a good state to guidance and control. No Aug. 2013.
integrated velocity measurement rejections occurred in the filter, and doi:10.2514/6.2013-4876
[7] Bierman, G. J., Factorization Methods for Discrete Sequential
the measurement residuals were very low with respect to their Estimation, Vol. 128, Mathematics in Sciences and Engineering,
predicted standard deviations. This fact is due to a combination of Academic Press, Orlando, FL, 1978, Chap. 5.
conservative tuning of this measurement and perfect weather during [8] Carlson, N. A., “Fast Triangular Factorization of the Square Root Filter,”
Downloaded by UNIVERSITY OF COLORADO on April 29, 2017 | http://arc.aiaa.org | DOI: 10.2514/1.G002666
the day of launch. Design trades are also presented to justify the AIAA Journal, Vol. 11, No. 9, Sept. 1973, pp. 1259–1265.
transition from the EFT-1 IV measurement to the use of pad position doi:10.2514/3.6907
measurement during future Exploration Mission flights. The design [9] Agee, W., and Turner, R., “Triangular Decomposition of a Positive
of the EM-1 ground alignment phase is presented in detail. Definite Matrix Plus a Symmetric Dyad with Application to Kalman
Filtering,” White Sands Missile Range, TR 38, White Sands, NM, 1972.
[10] Schmidt, S. F., “Application of State-Space Methods to Navigation
Acknowledgments Problems,” Advances in Control Systems, Vol. 3, Dec. 1966,
The authors are very thankful to Mike Begley, Daniel Kubitschek, pp. 293–340.
Tim Straube, and Ellis King for their fundamental role in creating a doi:10.1016/B978-1-4831-6716-9.50011-4
[11] Zanetti, R., and D’Souza, C., “Recursive Implementations of the
successful Orion EFT-1 prelaunch navigation system. Consider Filter,” Journal of the Astronautical Sciences, Vol. 60,
Nos. 3–4, July–Dec. 2013, pp. 672–685.
References doi:10.1007/s40295-015-0068-7
[12] Crassidis, J. L., and Markley, F. L., “Three-Axis Attitude Estimation
[1] Kalman, R. E., “A New Approach to Linear Filtering and Prediction Using Rate-Integrating Gyroscopes,” Journal of Guidance, Control,
Problems,” Journal of Basic Engineering, Vol. 82, No. 1, March 1960, and Dynamics, Vol. 39, No. 7, 2016, pp. 1513–1526.
pp. 35–45. doi:10.2514/1.G000336
doi:10.1115/1.3662552 [13] Ignagni, M. B., “Efficient Class of Optimized Coning Compensation
[2] Kalman, R. E., and Bucy, R. S., “New Results in Linear Filtering and
Algorithms,” Journal of Guidance, Control, and Dynamics, Vol. 19,
Prediction,” Journal of Basic Engineering, Vol. 83, No. 1, March 1961, No. 2, March–April 1996, pp. 424–429.
pp. 95–108. doi:10.2514/3.21635
doi:10.1115/1.3658902