Professional Documents
Culture Documents
net/publication/268554177
CITATIONS READS
2 229
2 authors:
Some of the authors of this publication are also working on these related projects:
Sensor Fusion and State Reconstruction for Moving-Base Flight Simulators View project
Design and Flight Testing of Incremental Backstepping based Control Laws with Angular Accelerometer Feedback View project
All content following this page was uploaded by Erwin Mooij on 31 January 2017.
E. Mooij
Dutch Space B.V., Leiden, The Netherlands
Q.P. Chu
Faculty of Aerospace Engineering, Delft University of
Technology, The Netherlands
Abstract
carrier-phase differences) and IMU (specific forces and
rotational rates) are applied to estimate the position,
This paper concerns a tightly coupled IMU/GPS integrated velocity and attitude of the re-entry vehicle, and can be
navigation system for re-entry vehicles. Unprocessed seen as a continuation of earlier work (Mooij and Chu,
measurement data from GPS (pseudorange, pseudorange 2001). There, the navigation system was based on tangent-
rate and carrier-phase difference) and IMU (specific force plane equations an local Euler angles, and used post-
and angular rate) are used to estimate the position, velocity processed GPS measurements as input to the Kalman
and attitude of the vehicle. Unlike the aircraft navigation filter. The work concentrated on the on-board calibration of
problems, sensor calibration for re-entry vehicles is special. inertial sensors for the most critical flight trajectory of the
During the blackout phase which covers large part of the re- vehicle. The results showed that not all modelled uncertain
entry flight, the GPS receiver will have no signal available parameters of the IMU could be estimated with this
for the navigation system. Therefore, IMU sensor calibra- integrated system, although for most critical uncertain
tion with GPS data will be performed during the exo- parameters it was possible to estimate them at a
atmospheric and de-orbiting phase. Some manoeuvres satisfactory level. Some of the results also showed large
during these phases are considered to increase the estimation errors. At the time it was concluded that the
observability of the navigation filter. Sensor bias, scale source of these errors could be a combination of nominal
factor and misalignment will be included in the models. A state propagation, filter convergence rate, and the large
performance analysis is presented by simulating the rate of change of the input signals during certain
integrated system for the complete re-entry trajectory manoeuvres. The latter problem may be solved by applying
including the blackout phase. Finally, both results from the local iterations to account for the severe non-linearities or
tightly coupled integrated system and the tightly/loosely by locally increasing the filter-gain matrix by applying
coupled integrated system are compared. From theoretical adaptive filters. Some of these aspects will be studied in the
analyses and numerical simulations it is concluded that the current paper.
tightly coupled navigation system has a good performance
and outperforms the loosely coupled navigation filter. It is noted that the loosely coupled integration results that
were presented earlier are not fully realistic, because only
1. Introduction white-noise errors were assumed in the processed GPS
measurements. In reality these data will be corrupted with
The IMU/GPS integrated navigation system has been coloured measurement noise, because pre-Kalman filters
applied to land and marine vehicles, as well as to aircraft- have already been used to process the GPS data. The
and spacecraft-navigation problems. For re-entry vehicle actual results from the loosely coupled system should
navigation, conventional techniques which are suitable for therefore be much worse than the results that were
IMU/GPS integration for general applications may not be presented in Mooij and Chu (2001). However, the tightly
used in this specific case. This paper concerns an coupled system will not have these problems since raw-
IMU/GPS integrated navigation system for re-entry measurement data are used, which means that the
vehicles. During the blackout phase which covers a large measurement noise is much more white than for the loosely
part of the re-entry flight, the GPS receiver will have no coupled system.
signal available for the navigation system. The IMU will
therefore be the only working navigation sensor, since air- This paper is organised as follows. Section 2 discusses the
data sensors can only be applied at low Mach numbers. re-entry vehicle and the equations of motion for the
Therefore, IMU sensor calibration with GPS data should be derivation of the navigation models. Navigation sensor
performed during the exo-atmospheric and de-orbiting (GPS and IMU) characteristics and sensor models are
phases. Some manoeuvres during these phases are given in Section 3, where also the IMU calibration
considered to increase the observability of the navigation parameters are specified. These error parameters should
filter. Sensor bias, scale factor and misalignment will be be estimated by using filtering techniques. The state and
included in the models. observation equations for filtering are discussed in Section
4. In Section 5, the improvements made to the integrated
This paper discusses an IMU/GPS integrated navigation system will be discussed step by step. Observability
system for re-entry vehicles with the so-called tightly analysis and manoeuvre design is an important issue for
coupled approach. Unprocessed measurement data from complete calibration of the IMU sensors. This, as well as
both GPS (such as, pseudo-ranges, Doppler shifts, and the results of the filter process, will conclude Section 5. The
performance analysis of the re-entry flight is presented in
Section 6. Finally, conclusions and recommendations are
Copyright 2002 by E. Mooij and Q.P. Chu. Published by the
given in Section 7.
American Institute of Aeronautics and Astronautics, Inc., with
permission.
AIAA-02-5005 1
2. Simulation model reference frame will be used.
Reference vehicle and mission The dynamic equations for translational motion are given by:
(2.2)
and a re-entry mass of 26,029 kg) that was originally
w = aR, ze + gz
nd
designed as a fully reusable 2 stage to the Ariane-5 (2.3)
launcher (Fig. 2.1).
In the above definition, aR, x e , aR, y e and aR,z e are the
estimated specific-force components (non-gravitational
acceleration, as measured by the IMU) expressed in the
ECEF frame (index R, for rotating geocentric frame), gx, gy
and gz are the Cartesian components of the gravitational
acceleration and ωcb is the rotational rate of the Earth.
150
height (km)
100
50
0
0 1000 2000 3000 4000 5000 6000 7000 8000
velocity (m/s)
Fig. 2.1 - The HORUS-2B reference vehicle (MBB, 1988). attitude angle (deg) 100
50
For the current study, HORUS will be equipped with 4 GPS
antennas, such that the GPS carrier-phase measurements 0
angle of attack
can be used to determine the vehicle’s attitude. The -50
bank angle
location of the antennas is the following:
-100
•
0 200 400 600 800 1000 1200 1400
The master antenna, index m, is located in the time (sec)
geometric plane of symmetry, at 16 m from the nose1
Fig. 2.2 – Altitude-velocity profile (top) and nominal control
and on top of the vehicle. From Fig. 2.1, it can be seen
history (bottom, angle of attack solid line and bank angle
that the body-frame location will be rm = (-3,0,-2.7)T m.
dashed).
• The first slave antenna, index s1, is located 7 m before
the master antenna, i.e., rs1 = (4,0,-2.7)T m.
The corresponding kinematic position equations are:
• The second and third slave antenna, indices s2 and s3,
are located on both sides of the master antenna, at y =
xR = u
(2.4)
± 1 m, i.e., rs2 = (-3,1,-2.5)T m and rs3 = (-3,-1,-2.5)T m.
yR = v
(2.5)
The nominal re-entry mission of HORUS starts at the zR = w
(2.6)
atmospheric entry interface at an altitude of h = 122 km and
a relative velocity of V = 7435.5 m/s. The vehicle is assumed
to be heading towards a runway in Kourou. Some 80 km The kinematic attitude equations used in this study will be
from the landing site guidance switches to the Terminal based on quaternions. Let the quaternion vector be defined
Area Energy Management logic. In Fig. 2.2, the altitude- as:
velocity profile for the atmospheric phase is plotted, as well
as the steering profile of angle of attack and bank angle. QI,B = (Q1 , Q2 , Q3 , Q4 )T
Equations of motion where the index I,B means that the quaternions define the
attitude of the body frame with respect to the inertial
During the course of this study it appeared that the
CN,B (1,2)
receiver clock time rsv,i = (xsv,i,ysv,i,zsv,i)T is the position of the
ψ = arctan (2.12c) ith GPS satellite, r = (xR,yR,zR)T is the user position in ECEF
CN,B (1,1)
co-ordinates, c denotes the speed of light (c = 299,792,458
m/s), br is the receiver clock bias and v ρi represents the
3. Navigation sensor characteristics and sensor white measurement noise. From pseudorange measure-
models ments to four satellites the user position xR, yR, zR and
receiver clock bias br can be determined.
In this paper, the so-called tightly coupled integration
technique is applied to the integrated GPS/IMU navigation It is well known that, if an observer has a non-zero velocity
system, which means that unprocessed or raw measure- component in the line-of-sight direction with respect to a radio
ments from GPS and inertial sensors are used. One of the source (which is, in this case, also moving) transmitting a
advantages of this type of integration is that sensor errors signal of a certain frequency, the observer will receive a signal
can be modelled more thoroughly and sensor calibration with a frequency not equal to the transmitted frequency. The
can be carried out with more transparent approaches. difference between received and transmitted frequencies is
called the Doppler shift of the signal. Many navigation
GPS observable models and characteristics systems are based on this effect. The relationship between
the Doppler shift (∆f) and the range rate ρ is:
GPS receivers reconstruct either the code, the carrier or
both signals of an incoming satellite signal. The code- ρf s
AIAA-02-5005 3
where fs is the transmitted GPS signal frequency (fs = 1575.42 expressed in the ECEF frame. Therefore, a transformation
MHz = L1), and fr is the received frequency. from this reference frame to the spacecraft body-fixed
reference frame is necessary. The line-of-sight vector from
The observation model of the Doppler shift can now be written the user position to a GPS satellite is given by:
as follows:
rLOS,i = rsv,i − r (3.6)
(rsv,i − r ) T (r sv,i − r )
ρi = + cdr + v ρi
(3.3)
To normalise this vector, it has to be divided by its norm,
(r sv,i − r ) T (rsv,i − r ) which is in this case equal to the pseudorange. So
GPS simulator
where sx, sy and sz are the scale factors, bx, by and bz are the The measurement equations, (3.1), (3.3) and (3.8) can also
biases, and m xy, m xz, m yx, m yz, m zx and m zy are be written in vector form.
misalignments. The mathematical model for the rate gyros
is defined in a similar way: z( t ) = h[ x( t ), u( t ), t ] + v (4.4b)
pm = spp + bp + mpqq + mpr r In state equation (4.4a), the state vector consists of the
qm = sqq + bq + mqpp + mqr r (3.11) following state variables:
rm = sr r + br + mrpp + mrqq • vehicle position components (xR, yR and zR);
• vehicle velocity components (u, v and w);
where the parameters have the same meaning as • vehicle attitude quaternions (Q1, Q2, Q3 and Q4);
explained for the model of the accelerometers. • unknown IMU calibration parameters (bx, by, bz, sx, sy,
sz, m xy, m xz, m yx, m yz, m zx and m zy, and bp, bq, br, sp, sq,
On-board calibration of those parameters is one of the sr, mpq, mpr, mqp, mqr, m rp and m rq);
tasks for this integrated navigation system. With GPS • receiver clock bias and clock drift (cbr and cdr).
pseudorange, pseudorange-rate and carrier-phase differ-
ence measurements, the integrated navigation system Furthermore, the input vector u consists of the following
should be able to accurately estimate not only position, measured variables:
velocity and attitude state variables, but also the above
0.4
The state estimator applied to the integrated navigation
0.2
system is the so-called Extended Kaman Filter (EKF),
which performs a first-order approximation of non-linear 0
filters (see also Mulder et al., 1999). When the non-linearity -0.2
of the integrated navigation system is high - as is the case 0 200 400 600 800 1000 1200 1400
time [sec]
with re-entry flights - the EKF may diverge. In that case,
east-velocity error [m/s]
0
improvements in performance of the EKF can be realised
by introducing local iterations. Since these algorithms are
recursive, they are suitable for on-board navigation. In the -0.5
current paper, we will also apply the Iterated Extended
Kalman Filter (IEKF), which is particularly suitable in case
-1
of non-linearities in the measurement equation. 0 200 400 600 800 1000 1200 1400
time [sec]
down-velocity error [m/s]
0.3
5. Improvement of the tightly/loosely coupled
0.2
system
0.1
Apart from using post-processed GPS measurements, the 0
EKF in Mooij and Chu (2001) appeared to have a problem
-0.1
with tracking large variations in attitude. To illustrate this, 0 200 400 600 800 1000 1200 1400
the estimated roll-angle error during the final descent has time [sec]
been plotted in Fig. 5.1. Large errors (up to 0.5°) for an
otherwise converged estimate showed whenever a bank Fig 5.2 - Relative velocity errors due to 25 Hz nominal-state
reversal was executed. To improve the results as well as to propagation.
use unprocessed GPS measurements, a number of
elements of the navigation system will be changed and/or When the frequency is set at 200 Hz, the resulting nominal
improved. state is very close to the truth model, and can be
considered to be identical for practical purposes. However,
1
the differences become larger when the frequency is
roll-angle error(deg)
0.5 decreased. To show the impact, in Figs. 5.2 and 5.3 the
0 difference between propagating at 200 Hz (truth model) and
25 Hz has been plotted for the complete re-entry trajectory.
-0.5
It is obvious, that by setting the IMU measurement
-1
1050 1100 1150 1200 1250 1300
frequency at 200 Hz, the error source due to the nominal
time (sec) state propagation will be removed. It is noted that the
accuracy improvement for the roll, pitch and yaw angle is in
Fig. 5.1 – Roll-angle error during final descent
the order of 0.01° for each of the three angles. This means
that the (low) IMU measurement frequency is hardly
Starting with the original model as described by Mooij and
contributing to the relatively large attitude-angle error.
Chu (2001), the following will be done:
Quaternion implementation
• Study the influence of increasing the IMU-measure-
ment frequency on the nominal position, velocity and
To improve the computational efficiency, the kinematic
attitude-angle propagation;
attitude equations are based on quaternions rather than
• Change the kinematic attitude equations from local local Euler angles. Since the GPS carrier-phase difference
Euler angles to quaternions, and check accuracy and measurement is a line-of-sight detector, it offers the
computational speed possibility to measure quaternions so no implementation
problems will be introduced. Moreover, for the current
AIAA-02-5005 6
tightly-coupled navigation system the use of quaternions When the amplitude is 30° (t = 20 s), the attitude is
will make the rotational kinematic equations Eq. (2.7) linear, stabilised for 10 s, after which φ = θ = ψ = -3 °/s is
1.5
latitude error [deg]
-1 error error
-4 -6
-2 bx 3⋅10 bp 5⋅10
-4 -6
-3
by -3.5⋅10 bq -5⋅10
bz -4 br -6
3⋅10 5⋅10
-4 -4
0 200 400 600 800 1000 1200 1400 sx 2⋅10 sp 2⋅10-4
20
time [sec] sy -1.7⋅10-4 sq -1.7⋅10-4
sz 2.3⋅10-4 sr 2.3⋅10-4
altitude error [m]
Two observations were made during the course of the As input to the filter, the mentioned manoeuvres are
study. In the first place, a gain in computational speed was simulated using the instrument errors listed in Table 5.1. In
obtained and in the second place, after converting the addition, the accelerometer measurements have white-
quaternions to local Euler angles, the corresponding values noise errors with a 1σ value of 10-5 m/s2, whereas the
appeared to be identical. The former observation will be gyroscope measurements have white-noise errors with 1σ
important at a later stage, once a real-time implementation = 10-6 rad/s. The GPS data are considered to have white-
of the navigation system is considered, whereas the second noise errors with 1σ values of σρ = 25 m, σ ρ = 0.1 m/s and
observation confirms a proper implementation of the σ∆Φ = 0.1 cycle (≈ 19 cm). The applied errors in initial con-
kinematic model. ditions are 30 m, -30 m and 35 m for the position, -0.1 m/s,
-0.1 m/s and 0.1 m/s for the velocity, and 0.05, -0.05, -0.05
ECEF model and unprocessed GPS measurements and 0.05 for the quaternions. Initial instrument-error
estimates were negated with respect to their respective
After implementing the measurement equation based on input values.
unprocessed GPS measurements, it appeared that the
30
output matrix H was badly scaled, due to the mixing of
spherical and Cartesian position and velocity components. sv #4
Therefore, it was decided to change the model to a fully sv #4
exo-atmospheric phase.
AIAA-02-5005 7
For the duration of the simulation (500 s), the 4 GPS estimation error is rather large, for xR even between 25 m
satellites that were used to generate the measurements and 35 m. However, the error covariance almost discretely
have been depicted in Fig. 5.43. It is clear from this figure, changes at t ≈ 30 s, as well as the estimation error. From
that during the course of the simulation, the combination of that moment, the error remains very small.
satellites changes. In Fig. 5.5, an example of the (ideal)
50
pseudorange measurements has been plotted, whereas in
X ECEF (m)
Fig. 5.6 an example of the carrier-phase differences can be
found. It is noted that the integer ambiguity is assumed to 0
be solved, which explains that the plotted values are not
scaled between 0 and 1 (cycles). In both figures, the
change in satellite constellation is represented by discrete -50
0 50 100 150 200 250 300 350 400 450 500
jumps in the measurements. 50
time (sec)
7 7
x 10 sv #1 x 10 sv #2
Y ECEF (m)
2.55 2.3
2.5 2.25 0
pseudorange (m)
pseudorange (m)
2.45 2.2
2.4 2.15
-50
0 50 100 150 200 250 300 350 400 450 500
2.35 2.1
time (sec)
50
2.3 2.05
0 100 200 300 400 500 0 100 200 300 400 500
Z ECEF (m)
time (sec) time (sec)
7 7
x 10 sv #3 x 10 sv #4
2.5 2.4 0
2.4
pseudorange (m)
pseudorange (m)
2.3
2.3 -50
0 50 100 150 200 250 300 350 400 450 500
2.2 time (sec)
2.2
2.1
2 2.1
Fig. 5.7 - Estimated ECEF position errors, including error
0 100 200 300
time (sec)
400 500 0 100 200 300
time (sec)
400 500 standard-deviation bounds, for the exo-atmospheric phase.
0.2
Fig. 5.5 - Ideal pseudoranges during exo-atmospheric
V x ECEF (m/s)
0.1
phase.
sv #1 0
20
-0.1
DPHI m-s (cycles)
0 -0.2
0 50 100 150 200 250 300 350 400 450 500
1
time (sec)
0.2
-20
Vy ECEF (m/s)
0.1
-40 0
0 50 100 150 200 250 300 350 400 450 500
time (sec) -0.1
5
DPHI m-s (cycles)
-0.2
0 50 100 150 200 250 300 350 400 450 500
time (sec)
0.2
0
2
Vz ECEF (m/s)
0.1
0
-5
0 50 100 150 200 250 300 350 400 450 500 -0.1
time (sec)
10 -0.2
0 50 100 150 200 250 300 350 400 450 500
DPHI m-s (cycles)
5 time (sec)
0
3
0.05
0 50 100 150 200 250 300 350 400 450 500
time (sec) 0
Fig. 5.9 - Estimated clock-bias and drift errors, including
-0.05
error standard-deviation bounds,for the exo-atmospheric EKF
phase. -0.1
0 50 100 150 200 250 300 350 400 450 500
time (sec)
0.01
10
0.005 EKF
z-bias (m/s2)
5
Y ECEF (m)
0
0
-0.005
-5
-0.01 IEKF
0 50 100 150 200 250 300 350 400 450 500
-10
time (sec) 0 50 100 150 200 250 300 350 400 450 500
0.01 time (sec)
0.005
Fig. 5.11 - Estimated Y velocity and position error, including
error standard-deviation bounds,for the exo-atmospheric
x-scale (-)
AIAA-02-5005 9
required for this type of re-entry (heat-flux minimisation).
In the first flight phase the gravitational acceleration is Final errors for the other parameters are τerr = -2⋅10-5°, δerr =
-10 °, vN,err = -0.01 m/s, vE,err = -0.025 m/s, vD,err = 0.02 m/s,
-5
largely dominating. The aerodynamic forces and moments
start increasing only close to the beginning of the blackout φerr = -1.5⋅10-3° and ψerr = -10-3°.
phase, which means that this phase will not give much
10
extra information as compared with the exo-atmospheric
25 0
sv #4
sv #3
-0.1
20
satellite number (-)
-0.2
sv #2 0 20 40 60 80 100 120 140 160 180 200
sv #4 time (sec)
15
Fig. 6.2 – Error in estimated altitude (top), relative velocity
sv #3
(middle) and (local) pitch angle (bottom) as a function of
10 time since re-entry.
sv #1
The black-out phase is characterised by the lack of aiding
5
GPS measurements, which means that the navigation
system should rely on the estimated instrument errors from
0 the calibration phase and the previous first part of the entry.
0 200 400 600 800 1000 1200 1400
time (sec)
In the following, a dead-reckoning simulation will be done
for the blackout phase with the best estimate of the instru-
Fig. 6.1 – Best combination of 4 visible satellites during re-
ment errors obtained from the previous phases as well as
entry (including blackout phase and final descent). ground calibration. This means that the scale factors and
misalignments will all have a 30% uncertainty as compared
Since it concerns a new estimation process, the initial with their input values (Table 5.1), whereas the errors in bx,
errors have been taken quite large, thereby discarding the bp, and br are put at 25%. The remaining bias and drift
information for the related states from the exo-atmospheric values are assumed to be known. Initial conditions are set
phase4. The filter converges rapidly resulting in accurate equal to the final values of the (first) re-entry phase.
navigation information. Converged errors are in the order of
a few meters for the position components, 0.02 m/s or less
In Fig. 6.3, the altitude, relative-velocity and roll-angle error
for the velocity and less than 10-4 for the quaternions. The have been plotted. Despite the relatively large IMU sample
clock-drift and -bias errors are 0.04 m/s and 2 m, frequency, the error in, for instance, the relative velocity is
respectively. rather large. It remains to be studied what the impact on the
performance of the guidance system will be. At the moment
The estimated Cartesian position and velocity, as well as
that a bank reversal is initiated (t ≈ 730 s), the error in
the quaternions, are transformed to spherical position h, τ,
attitude angles changes almost discretely, indicating that
δ, local tangent-plane velocity vN, vE and vD, and local Euler the IMU sample frequency is still too low for these fast
angles φ, θ and ψ, and compared with the actual values, dynamics, although the error is small. In turn, the attitude
resulting from the non-linear simulation. In Fig. 6.2, a error results in a transformation and hence a small
subset of the results is plotted, i.e., the altitude error, the acceleration error, such that there is also an almost discrete
error in relative velocity (which is the modulus of the ECEF change in the pattern of velocity error. Obviously, the
velocity components) as well as the pitch-angle error. It can decreasing rate in altitude error is a direct consequence of
be concluded that the filter has an excellent performance, this. The remaining (maximum) errors are τerr = -7.5⋅10-3°
which is, in fact, better than the filter performance in Mooij and δerr = 4⋅10-3°, which are gradually increasing with time,
and Chu (2001). An accurate pitch-angle estimate provides
as is vE,err (final error of -4.4 m/s), vN,err = 1.6 m/s, but with a
a good basis for accurate angle-of-attack control that is
rather constant error after the reversal, and vD,err = 1.25 m/s
at the moment of the reversal, but which decreases again
4 It remains to be studied, how all successive phases can be to zero afterwards. Finally, θerr = 0.05° and ψerr = 0.025°.
linked (including leaving the blackout phase), such that one
smooth estimation process is obtained.
AIAA-02-5005 10
7. Conclusions
200
altitude error (m)
0 This paper discusses a tightly coupled IMU/GPS integrated
navigation system for re-entry vehicles. Despite the limited
-200 manoeuvre possibilities, the on-board calibration of inertial
sensors has been addressed. Not all modelled uncertain
-400 parameters of the IMU can be estimated, although the
100 200 300 400 500 600 700 800 900 1000 1100
time (sec) accelerometer bias and gyroscope drift can be estimated at
velocity-norm error (m/s)
6
a satisfactory level. Position, velocity and attitude can be
4 accurately estimated, with a filter performance that is much
better than the loosely coupled approach presented in a
2 previous paper. An implementation based on ECEF
position and velocity, as well as quaternions rather than
0
100 200 300 400 500 600 700 800 900 1000 1100 Euler angles, gives a numerically stable filter which is
0
time (sec) relatively fast. Application of local iterations does not give
too much of an improvement in accuracy.
roll-angle error (deg)
-0.02
Simulating the hypersonic entry and descent yields
-0.04 accurate position, velocity and attitude estimates in all
phases of the re-entry, including the blackout phase. Also
-0.06
100 200 300 400 500 600 700 800 900 1000 1100 during the (excessive) bank reversals, the attitude-angle
time (sec) error remains small and does not induce significant
acceleration errors.
Fig. 6.3 – Error during blackout phase in estimated altitude
(top), relative velocity (middle) and (local) roll angle
The tightly coupled GPS/IMU integrated system offers
(bottom) as a function of time since re-entry.
flexibility to improve the performance of the navigation
200 system by remodelling errors of the GPS receiver, while in
the loosely coupled system the position, velocity and
altitude (m)
-0.15
1050 1100 1150 1200 1250 1300
References
time (sec)
Fig. 6.4 – Error during final descent in estimated altitude 1. Chu, Q.P. and P.Th.L.M. van Woerkom, “GPS for low cost
(top), relative velocity (middle) and (local) roll angle attitude determination: a review of concepts, in-flight
(bottom) as a function of time since re-entry. experiences and current development.” Journal of Acta
Astronautica, Volum 41 Number 4-10 pp 421-433, 1997.
2. Farrell, J.A. and Barth, M., The Global Positioning System
Initializing the Kalman filter with the above state-variable
& Inertial Navigation, McGraw-Hill, New York, 1999.
errors (xR,err = 940 m, yR,err = 115 m, zR,err = -423 m, uerr = 3. MBB Space Communication and Propulsion Systems
3.6 m/s, verr = 2.65 m/s and werr = -1.65 m/s; the quaternion Division, "Study on re-entry guidance and control - Final
errors are all very small) and taking large initial values for report", ESA reference: ESA CR (P) 2652, Munich, 1988.
the error covariance matrix, the estimation process for the 4. Mooij, E., "Aerospace-plane flight dynamics: analysis of
final descent is started. As for the first phase, the filter guidance and control concepts", PhD thesis, Delft Univer-
converges rapidly, again showing a good performance. Fig. sity of Technology, Faculty of Aero-space Engineering,
6.4 shows a subset of errors. As can be seen, the altitude 1998.
and velocity error rapidly converge to small values, which 5. Mooij E., and Chu, Q.P., "IMU/GPS Integrated Navigation
also holds for the errors that are not shown here. After System for a Winged Re-entry Vehicle", AIAA paper 2001-
comparing the roll-angle error with the one shown in Fig. 1469. From: AIAA Guidance, Navigation, and Control
5.1, it is clear that there are no large errors during the bank Conference, August 6-9, 2001, Montreal, Canada.
reversals anymore. The filter behaviour is very stable, 6. Mulder, J.A., Chu, Q.P., Sridha, J.K., Breeman, J.H. and
which is promising for an actual on-board implementation of Laban, M., “Non-linear aircraft flight path reconstruction
the presented navigation system. review and new advances”, Progress in Aerospace
Sciences, Elsevier, 35, pp. 673-726, 1999.
AIAA-02-5005 11