Professional Documents
Culture Documents
ABSTRACT INTRODUCTION
When hybridizing GPS with IRS, the Tight integration of GPS and inertial
integrity of GPS signals has to be checked information allows enhancing GNSS
so that slowly growing errors on GPS satellite FDE (fault detection and exclusion)
measurements don’t affect inertial and continuity performance (calibrated IRS
calibration. may be used for coasting when GNSS
Several solutions exist to perform fault information is unavailable).
detection and exclusion of GPS signal. Solution Separation method has first been
Some of these depend only on GNSS introduced by Brenner in 1995 [1].
information but the capacity of RAIM Assuming that only one failure may occur
(Receiver Autonomous Integrity Monitoring) at a time, fault detection is performed by
is limited. This algorithm greatly depends estimating the separation between the
on the constellation geometry (at least 5 solution given by a main filter and solution
SV are needed for detection) and doesn’t from different sub-filters that each exclude
have sufficient availability for stringent measurement from one satellite. This
phases of flight. AAIM (Aircraft separation is an estimate of the impact of
Autonomous Integrity Monitoring) the satellite failure on the IRS position error
algorithms are taking into account correction using GPS measurements.
additional onboard information such as The FDE method presented in this paper is
IRS. The Solution Separation method can an extension of Brenner’s solution
be implemented for RAIM or AAIM. separation as it has been defined in [2]. By
The aim of this paper is to describe the introducing one more rank of sub-sub-filters
technique inspired from Solution (each one is excluding measurement from
Separation used to compute isolation 2 satellites) the algorithm succeeds in
radius in addition to the classical detection isolating the faulty satellite and proposes a
protection level, and to present some computation of exclusion level.
simulation results we obtain by The aim of this paper is to present some
implementing this algorithm in a tightly simulation results obtained by
coupled Kalman. implementing the FDE algorithm with false
After reviewing civil aviation alarm rate and missed detection probability
requirements and defining the tightly corresponding to NPA phase of flight.
coupled Kalman filter that was used, the A point is first made on civil aviation
detection and isolation satellite failure assumptions concerning tightly integrated
method is described. This method is GPS/inertial systems. The FDE process is
inspired from the Solution Separation described and the method for computing
method which is generalised to N subsets protection level is defined. Finally simulated
of N-1 Kalman filters used to define the test results are presented.
isolation radius as presented in [2].
Finally simulated results of the algorithm for
NPA are shown. CIVIL AVIATION ASSUMPTIONS
FDE requirements
a mmn position,
velocity,
IMU IRS attitude
F12 F13 F1N F N 1 FN 2 FN N −1 m in n-frame
ω mn
Figure 2. Exclusion filters hierarchy.
Figure 4. Inertial Unit
When there is a detection, the separation
between each sub-sub-filter and its parent Inertial Measurement Unit: IMU
sub-filter is computed and compared to an This unit generates realistic gyro and
exclusion threshold that depends on the accelero measurements at 100 Hz rate from
expected separation statistics and PFA . If the data of an aircraft trajectory and
for sub-filter F0 n , there exists one solution attitude angles evolution. These
separation such that one separation measurements are respectively:
between it and sub-sub-filter Fnm exceeds
a mm/i non-gravitational acceleration of the
the threshold, it can’t be the faulty satellite.
But if there is only one sub-filter F0 n for mobile relative to the inertial
(absolute) frame in the mobile frame
which all separations between its solution
and its sub-sub-filters Fnm are under the
ω mm/I angular rate of the mobile relative to
threshold, satellite n is the faulty satellite.
the inertial frame in the mobile frame
∫ ∫ ( )dt dτ
User clock delay function
Position TRAJECTORY:
Acc USER POSITION
0 0 velocity
PR
∫q MEASUREMENT CODE PSEUDO
(mobile) Time RANGE
Gravity CONSTELLATION MEASUREMENTS
ω mmn computation SIMULATOR GENERATOR
Gyro Bnm
ω Im
m
− ω mnI SATELLITE
POSITION
Euler angles NOISES
Ramp failure
attitude
ω m
mn ∫q computation
ϕ, θ, ψ
Ephemeris data generator
δh altitude error
Filter error measurement model
δω Gyro drift m − frame
Each component of the measurement
δω x x-axis gyro drift (m ) vector z at filter’s input is the difference
δω y y-axis gyro drift (m ) between two PRs to each satellite. One is
z-axis gyro drift (m )
the measured PR input from the GPS
δω z
receiver; the other is the predicted PR
δf Accelero bias m − frame computed on the basis of the satellite
δf x x-axis accelero bias (m ) positions obtained from the GPS receiver
δf y y-axis accelero bias (m ) and the user location as calculated by the
IRS.
δf z z-axis accelero bias (m )
The coefficients of the measurement matrix
δb Receiver clock error vector H are direction cosine computed from the
b receiver clock bias GPS navigation equation linearization.
b receiver clock bias drift Let R be the measurement noise
Table 1. Kalman filter state vector. covariance matrix: all measurement noises
are independent.
Many different inertial error models are
available in literature. They are actually The size of the z − vector and the R
equivalent [5]. In our system the inertial and H − matrices depend on the number of
navigation error model applied is tracked satellite.
sub-filter: K 0n , n = 1, N
and
sub-sub-filter: K nm , n = 1, n; m = 1, N ; m ≠ n Φ 0 v
δx − (k ) = ⋅ δx +
(k − 1) + 0 (10)
Because GPS and IRS data are not 0 Φ
Π
available at the same rate, the error model
is updated at 100 Hz and Kalman filters
one can show that
measurements are updated at 1Hz .
So the Kalman corrections are available
every second.
dual
dP0n (k ) = Σ ⋅ dP0ndual (k ) ⋅ Σ T + Γ ⋅ R ⋅ Γ T (11)
+ −
(k − 1) ⋅ Π T +
Q 0
δP0ndual (k ) = Π ⋅ δP0n
Fault detection is performed by estimating − dual +
+
[( +
)(
dP0n (k ) = E dx 0n (k ) ⋅ dx 0n (k )
+
)]
T
(6)
on North and East axes are correlated,
L 0n is projected in an orthogonal plane so
that,
Since dx 0n and δx 00 are statically
L0n = P⊥ ⋅ ∆ ⋅ P⊥
T
dependent, let us form the 34x1 error (15)
vector
and X ⊥ = P⊥ ⋅ X H is a Gaussian vector
T
[
δx + (k ) = δx 00 (k ), ∆x 0n (k )
+ +
]
T
(7)
whose covariance matrix is the diagonal
matrix ∆ (eigenvalues matrix of L 0n ).
= δx 0n (k ) − δx nm (k ), m = 1
+ +
N,m ≠ n
The test for detecting one failure satellite is
(22)
H 0 no detection: d 0 n ≤ D0 n
whose statistics are described by the
H 1 detection: d 0 n > D0 n for at least one covariance matrix
n, n = 1, N
+
[(
dPnm (k ) = E dx nm (k ) ⋅ dx nm (k )
+
)( +
)]
T
(23)
Since for each sub-filter
Exclusion threshold Dnm vs test
δx 00 (k ) = dx 0n (k ) + δx 0n (k ), n = 1
+ + +
N (17)
statistics d nm
at detection (for the nth subset)
For each sub-sub-filter the decision
threshold is set so that (assuming that each
HPLn = D0 n + a0 n (18)
th filter Fnm has the same chance for a false
where a 0 n is an upper bound of the n sub-
alarm)
filter horizontal error ∆x 0n [7 : 8] whose
+
Pff
HPL0 = λ ⋅ Q
P00 −1
(20) with L nm = Pm ⊥ ⋅ ∆ ⋅ Pm ⊥
T
2
where Pff is the rare normal performance Satellite r is excluded as the failed satellite
rate and λ the maximum eigenvalue of
P00 if and only if
P00 [7 : 8,7 : 8].
+ d rm < Drm for all m ≠ r
and
The horizontal protection level is d nm ≥ Dnm for at least one m ≠ n for all n ≠ r
a nm = λ Pnm ⋅ Q −1 (1 − p FE ) (26)
RESULTS OF SIMULATIONS
REFERENCES