You are on page 1of 11

GPS/IRS hybridization : definition of exclusion radius

using solution separation method


Anne-Christine Escher, Christophe Macabiau, Benoit Roturier, Nicolas Martin

To cite this version:


Anne-Christine Escher, Christophe Macabiau, Benoit Roturier, Nicolas Martin. GPS/IRS hy-
bridization : definition of exclusion radius using solution separation method. IFIS 2002, 12th
International Flight Inspection Symposium, 2002, Roma, Italy. 2002. <hal-01021708>

HAL Id: hal-01021708


https://hal-enac.archives-ouvertes.fr/hal-01021708
Submitted on 30 Oct 2014

HAL is a multi-disciplinary open access L’archive ouverte pluridisciplinaire HAL, est


archive for the deposit and dissemination of sci- destinée au dépôt et à la diffusion de documents
entific research documents, whether they are pub- scientifiques de niveau recherche, publiés ou non,
lished or not. The documents may come from émanant des établissements d’enseignement et de
teaching and research institutions in France or recherche français ou étrangers, des laboratoires
abroad, or from public or private research centers. publics ou privés.
Escher A.C., Ecole Nationale de l’Aviation Civile, France
Macabiau C., Ecole Nationale de l’Aviation Civile, France
Roturier B., Service Technique de la Navigation Aerienne, France
Martin N., Thales Avionics, France

GPS/IRS HYBRIDIZATION: DEFINITION OF EXCLUSION RADIUS USING SOLUTION


SEPARATION METHOD

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

Presented at IFIS 2002, Roma 1


Appendix R to RTCA/DO 229C [3] clarifies subset without a fault detection condition.
FDE requirements to GPS/IRS application Therefore fault exclusion performance
for en-route to non-precision approach. involves some similar parameters: a test
(Table 1) statistics, decision threshold and exclusion
level. The exclusion level is a radius in the
Missed detection probability 0.001 horizontal/vertical ( HEL / VEL) plane that
False detection rate (SA off) 1/3 10-6/hr guarantees that any errors on or beyond
Probability (pMI) of exceeding 10-7/hr this radius due to a satellite failure will be
HPL eliminated because of the exclusion
Rare normal performance rate <10-7/sample
function. It is given as the largest PL of the
Failed exclusion probability 0.001
subsets of N − 1 satellites computed in
Continuity 1/3 10-6/hr
function of failed exclusion probability PFE
Table 1. FDE requirements. and PFA .

The rare normal performance rate is the


probability that the horizontal error exceeds SOLUTION SEPARATION METHOD
the horizontal alert limit in a fault free case
ie in the case of noise only. In case of SA Fault Detection
off its value is 10-7/sample. Demonstration Fault Detection algorithm consists in
in [3] shows that the contribution of the rare maintaining a primary Kalman filter which
normal performance limit HPL0 which incorporates the N measurements of the
depends on this probability is essential in whole satellite constellation, and as many
integrated systems. In the system Kalman sub-filters as the number of
configuration presented here HPL0 is the satellites (i.e. N sub-filters). The primary
filter F00 provides IRS correction. Sub-
rare normal performance limit of the
primary Kalman filter. filters which each of these incorporate the
measurements from N-1 satellites are
FDE performance parameters dedicated to detection only. They are
Nominal fault detection performance noted F0 n , n = 1 N . Figure 1.
involves three parameters (test metric,
decision threshold and protection level PL ). F00
The test metric is an observed quantity that
is compared to a decision threshold. The
decision threshold is chosen on the basis
of statistical characteristics of the test
metric so that false alert doesn’t occur F 01 F 02 F 03 F0N
more than a false alert rate PFA . This rate is
defined for each phase of flight and Figure 1. Detection filters hierarchy.
depends on the continuity requirement
(continuity loss-of-function per hour or Solution separation between F00 and each
phase duration) imposed by ICAO and the F0 n is estimated: it is the difference in the
GNSS measurements time correlation. horizontal/vertical plane between the state
The protection level ( HPL / VPL ) is the vector estimated by F00 and the state
position error that the FDE algorithm
guarantees will not be exceeded without vector estimated by F0 n .
being detected by the fault detection Fault detection is performed by monitoring
function. It depends on the values of the separation between the main-solution
missed detection probability PMD and PFA . and each of sub-solutions and comparing it
As it will be described in the next to a computed detection threshold that
paragraph, exclusion of the faulty satellite depends on the separation statistics
is performed by examining each subset of and PFA . When a failure occurs at least one
N − 1 satellites (where N is the numerous solution separation will exceed this
of tracked satellites) and searches the threshold. This method also guarantees a
protection radius against any failure (even
Presented at IFIS 2002, Roma 2
slow ramp) in straight relationship with the Attitude Pseudorange
Inertial Unit Integration measurements
threshold and the value of the required PMD . processor: GPS
IRS Position IP
Receiver
Fault Exclusion Velocity and
Kalman Filter
Satellite
It assumes that there is only one satellite acceleration
(n-frame)
position in
ECEF
failure at a time. coordinates

In order to perform exclusion for each sub- Inertial corrected position

filter N-1 sub-sub-filters are also


maintained. Each of these is excluding the Figure 3. GPS/IRS architecture
measurement excluded by its “parent” sub-
filter, and the measurement from a different All measurements and simulations have
satellite. These sub-sub-filters are noted been made with Matlab.
Fnm , n = 1 N , m = 1 N , n ≠ m. Figure 2.
Inertial unit
It provides to the integration process
F00 Matlab-generated inertial position, velocity
and attitude angles and gyrometric and
accelerometric measurements.
F01 F0 N

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

Sensor noises and biases are also


GPS/IRS KALMAN HYBRIDIZING
modelled in order to simulate different
FILTERS
inertial sensors quality.
All of the Kalman filters are running in the
Inertial Reference System: IRS
same way.
IMU measurements are processed by
For any of them, the implemented system
Strapdown inertial navigation to provide
is composed of three units: an inertial unit
inertial solution at 100 Hz . The navigation
(Inertial measurement Unit + Inertial
Reference System), a GNSS receiver function gives the mobile positions and
(GPS measurements) and an integration velocities relative to the earth frame in the
process (Kalman filters) that also navigation frame. Strapdown inertial
performed FDE function. Figure 3. navigation scheme is described in figure 5

Presented at IFIS 2002, Roma 3


UMI an
am Bnm t t

∫ ∫ ( )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

Figure 6. GPS measurements generator


Figure 5. IRS platform computations
GPS/IRS Kalman filtering system
B mn is the coordinate transformation matrix
that rotates the mobile body frame (m ) As shown in figure 3, the output position of
acceleration measurements to the local the whole system is the corrected inertial
north, east and down navigation frame (n ) . position. The role of Kalman filters is to
estimate inertial errors using GPS
Its components are computed from the
measurements in order to correct inertial
integration of gyro measurements.
outputs as done in figure 7. This may be
The attitude determination function
m
done in an open loop manner or in a closed
determines B n and the attitude of the loop manner.
mobile body frame to the navigation frame The dynamical evolution of the system is
that is to say Euler angles, where ϕ ,θ ,ψ given by inertial error model equations.
stand for roll, pitch, yaw respectively. They The measurement vector consists of the
are the rotation angles that allow passing difference between two PRs to each
from the m − frame to the n − frame. satellite (GPS PR and predicted PR
computed with inertial data).
Attitude determination method
The attitude algorithm used is the IRSoutput = True value + IRS errors best estimate of IRS output
IRS
quaternion method ( ∫ q ) which offers better +
-
Inertial error
numerical and stable characteristics than estimate
Euler or Direct Cosine methods.[4] (inertial error )
External + − (GPS error )
The single rotation that allows aiding - Kalman Filter
transformation from the m − frame to the source
GPS GPS meas . output =

n − frame is represented by the True value + GPS meas . errors

quaternion q . It evolves in accordance with Figure 7. Open loop GPS/IRS hybridization


a simple differential equation that is solved
using Edwards’ method. See [4] Filter error state model
Each component δx of the Kalman filter
GPS Receiver state vector stands for the difference
between the true value x and the
Pseudo range measurements (PRs) are measured ~ x (or computed x̂ ) value.
generated at 1Hz . Random noise is added The state vector consists of a 17 error state
on each satellite measurement and is variables
composed of a correlated noise due to
inospheric delay ( biono ) and white-Gaussian ∆X = [ρ, δv, δp, δω, δf , δb]T
noise due to noise process ( bPR ).
where

ρ Attitude error vector


δϕ (ε N ) roll error
δθ (ε E ) pitch error
δψ (ε D ) yaw error

Presented at IFIS 2002, Roma 4


δv Inertial velocity error vector and the noise state vector w is a zero-mean
δv N north velocity error Gaussian white noise vector, whose
components are all independent.
δv E east velocity error
Let Φ be the discret form of F .
δv D vertical velocity error
δr Inertial position error Let be Q the state noise covariance matrix:
δL
δG
latitude error
longitude error
[
Q = E v ⋅ vT ] (4)

δ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.

ρ = δω + ω nIn × ρ Kalman filters implementation


( )
Let ij be the subscript for the Kalman
δv = δf + ω nIe + ω nIn × δv + ρ × a nmI (1)
filter Fij . The maximum number of tracked
δr = δv + ω nen × δr satellites is N = 10 .
There is one primary filter, N sub-filters,
Using inertial data as nominal trajectory and N*(N-1) sub-sub-filters that are running
these non-linear equation are linearized in parallel.
and lead to the matrix presentation of the The estimated state vector for each are
dynamical evolution equation of the primary filter: ∆ˆx 00
linearized Kalman filter [6]:
sub-filter: ∆xˆ 0n , n = 1, N
X = F⋅X+ v (2) sub-sub-filter: ∆xˆ nm , n = 1, n; m = 1, N ; m ≠ n
The estimation error covariance matrix for
where F is the state transition matrix each is
primary filter: P00
Fρρ Fρv Fρr Fρω 0 0 0 sub-filter: P0n , n = 1, N
F 0
 vρ Fvv Fvr 0 Fvf 0 sub-sub-filter: Pnm , n = 1, n; m = 1, N ; m ≠ n
 Frρ Frv Frr 0 0 0 0 where
 
F= 0 (3)
[ ]
0 0 Fωω 0 0 0
Pij = E δx ij ⋅ δx ij , δx ij = ∆ˆxij − ∆x
T
 0 0 0 0 Fff 0 0
 
 0 0 0 0 0 0 1
 0 ∆x is the true error between estimated IRS
 0 0 0 0 0 0
and true position: ∆x = Xˆ IRS − X

Presented at IFIS 2002, Roma 5


dx 0n (k ) = ∆xˆ 00 (k ) − ∆xˆ 0n (k )
The Kalman Gain matrix for each is + + +

primary filter: K 00 (9)


= δxˆ 00 (k ) − ∆xˆ 0n (k ) + ∆x
+ +

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)
+ −

Next section details implementation of FDE with


algorithm.  I − K 00 ⋅ H 00 0 
Σ= (12)
(K ' 0n −K 00 ) ⋅ H 00 I − K ' 0n ⋅H 00 
FAULT DETECTION AND HORIZONTAL  K 00 
PROTECTION LEVEL Γ=  (13)
K 00 − K ' 0n 

(k − 1) ⋅ Π T + 
Q 0
δP0ndual (k ) = Π ⋅ δP0n
Fault detection is performed by estimating − dual +

the separation between the primary filter 


 0 0
estimate and each of the N sub-filters (14)
estimates in the horizontal plane. K'0n is constructed from K 0n so that it
operates on the full set of measurements
At each estimation time the discriminator
for the nth sub-filter is based on Solution by extending the 17x(N-1) matrix K 0n sub-
Separation vector between the primary solution matrix with a nth zeroed column.
filter and the nth sub-filter:
0n (k ) = ∆x00 (k ) − ∆x 0n (k )
+
dx ˆ + ˆ + Detection threshold D0 n vs. test
(5)
= δx 00 (k ) − δx 0n (k ), n = 1 N
+ + statistics d 0 n
The statistic of the horizontal separation
vector X H = dx 0n [7 : 8] , is described by
+
whose statistics are described by the
L 0n = dP0n [7 : 8,7 : 8] . Because separations
covariance matrix +

+
[( +
)(
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 ).

whose statistics are described by One of the two eigenvalues is dominating.


dual
dP0n [( )(
(k ) = E δx + (k ) ⋅ δx + (k )
+
)
T
] Let λdP be the approximate variance
( ∆(1,1) or ∆(2,2) ) of the error in the
 P + (k ) cross corr. (8) horizontal plane.
=  00 
cross corr. dP0n (k ) 
+ For each sub-filter the decision threshold
is set so that d 0 n will exceed D0 n with the
Given the fact that probability PFA . Since all sub-filters have the
same chance of false alarm
Presented at IFIS 2002, Roma 6
P  sub-filter estimate solution and its parent’s
D0 n = λdP ⋅ Q −1  FA  with Q −1 (u ) = erfc(u ) sub-filter estimate solution in the horizontal
 2N 
plane. For the nth sub-filter they are
and d 0 n = X ⊥ (1) or X ⊥ (2) (16)
depending on λdP = ∆(1,1) or λdP = ∆(2,2) dx nm (k ) = ∆xˆ 0n (k ) − ∆xˆ nm (k )
+ + +

= δ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

Horizontal protection level HPL


By definition the HPL is the error bound [(
= E δx0n (k ) − δxnm
+ +
(k ))(δx 0n
+
(k ) − δxnm + (k ))
T
]
that contains the primary filter error with a
probability of 1 − p MD when d 0 n = D0 n .
= P0n (k ) − Pnm
+ cross
(k ) − Pnm
+ cross
(
(k ) + Pnm (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
+

distribution is described by  PFA 


Dnm = λdPnm ⋅ Q −1   (24)
L = P0n [7 : 8,7 : 8] .  2( N − 1) 
+

Let λ P0 n be the maximum eigenvalue of L where λdPnm the maximum eigenvalue of


a 0 n = λ P0 n ⋅ Q −1 (1 − p MD ) L nm = Pnm [7 : 8,7 : 8]
+
(19)
The test statistic associated to Dnm is
Besides we have to consider the rare
normal performance that is to say the d nm = X m ⊥ (1) or X m ⊥ (2) (25)
contribution of the primary filter HPL0
where X m ⊥ = Pm ⊥ ⋅ dx nm [7 : 8]
T +

 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

HPL = max{HPL 0 , max(HPLn )}, n = 1, N Horizontal exclusion level HEL


(21) By definition HEL is the error bound that
contains the primary filter error with a
FAULT EXCLUSION AND HORIZONTAL probability of 1 − p FE when the failure is
EXCLUSION LEVEL excluded.
Fault exclusion is accomplished in the “For a failed exclusion to occur, the solution
same manner than detection but one layer of one of the sub-filters ∆xˆ 0n which does
down in the filters hierarchy. contain the failed satellite must be
The discriminator of each of the sub-sub- separated from one of its sub-sub-filter’s
filter is the separation between each sub-
Presented at IFIS 2002, Roma 7
solution ∆xˆ nm by less than the threshold Trajectory: duration 600s
Dnm plus the sub-sub-filter position error” - The simulated trajectory is an
approach to Toulouse-Blagnac
[2]
Airport from AGN VOR. It includes a
Let a nm be the sub-sub-filter horizontal turn at time 180s and a descent at
estimation error bound and λ Pnm be the time 280 s.
maximum eigenvalue of Pnm [7 : 8,7 : 8]
+

a nm = λ Pnm ⋅ Q −1 (1 − p FE ) (26)

For the nth sub-filter HELn is given by


HELn = max{Dnm + a nm }, m = 1, N (27)
And the horizontal exclusion level is
HEL = max{HELn }, n = 1, N (28)

RESULTS OF SIMULATIONS

The whole system has been implemented


in Matlab language. This section presents
the firsts results obtained in testing the
FDE algorithm for detection and isolation of
failures causing slowly increasing ramp
error.
Figure 8.Simulated trajectory
Conditions for the simulation
GPS constellation - During the turn, heading angle is
- Mask angle 5° (10 SVs, no varying from 098° to 145°. Roll angle
constellation change) is varying with a rate of 1 (180°/60s).
GPS receiver Pitch angle is also varying since the
- Total receiver noise 12.5m (1σ) aircraft is supposed to keep its
- Correlated noise: 1srt order Markov altitude.
process (τ = 15 min, σ = 4.8m ) - During the descent only pitch angle
Inertial error sources is varying according trajectory slope.
Error source (one sigma) Good Low cost
Results
Gyro constant bias: °/hr 0.01 1
3.10
-5
0.001 Figure 9 shows Horizontal Protection Level
Gyro white noise: °/s/ Hz for RAIM and AAIM (HPL), and Horizontal
Accelero constant bias: µg 50 500
Exclusion Level for AAIM (HEL) using
Accel. white noise: 6.4 64
Solution Separation algorithm.
µg/ Hz AAIM HPL and HEL convergence occurs
Table 2. Good / low cost IRS error sources after 250s of simulation. HPL and HEL are
much smaller (under 30m) than RAIM HPL
GPS/IRS hybridization is performed in an (70m). AAIM HEL is greater than HPL by
open-loop manner for good IRS, and approximately 5m. AAIM HPL and HEL
closed and open loop manner for low cost obtained using closed loop are the same
IRS. than those obtained using open loop.
FDE algorithm Figure 10 shows how detection is achieved
- No. of independent tests/hr=4 on channel 4 in presence of a failure when
- PFA = 1 / 3.10 −6 / hr = 1 / 12.10 −6 / test GPS measurement noise is only due to
- Pff = 1 / 3.10 −8 / test white-Gaussian noise. Before the failure
occurs at 400s the discriminator is zero-
- ramp error size (m/s) (time 400s)
mean and is lower than the decision
0.1, 0.2, 0.5,1, 2, 5
threshold. The failure detection occurs
on the worst case satellite (SV 4).
Presented at IFIS 2002, Roma 8
when the discriminator exceeds the Failure RAIM AAIM
decision threshold. The IRS quality seems introduced at open loop closed
400s good Low cost IRS
to have an influence: HPL and HPE
Ramp: 0.1(m/s)
obtained hybridizing GPS with a good IRS detection > 600s 566 s 594s > 600s
are in the order of 10m under those SV4 no
obtained hybridizing GPS with a low cost isolation simu. 586 s > 600s > 600s
IRS. But no extensive Monte-Carlo Ramp: 0.5 (m/s)
simulation has been performed. Detection 565 s 451 s 439s 443s
SV4 no
isolation simu. 458 s 445s 446s
Ramp: 1 (m/s)
Detection 500 s 435 s 433s 428s
SV4 no
isolation simu. 439 s 435s 432s
Ramp: 5 (m/s)
Detection 415 411 s 412s 411s
SV4 no
isolation simu. 413 s 413s 412s
Table 3. RAIM and AAIM times of detection
and isolation.
Ramp size AAIM
Figure 9. Horizontal protection levels. RAIM Open loop closed
good Low cost IRS

0.1(m/s) >7.1 m 5.2m 9.5m > 6m


0.5 (m/s) 34.1m 5.3m 7m 5.3m
1 (m/s) 32.5m 5.7m 12m 10.5 m
5 (m/s) 8.5m 5.8m 10.6m 9m
Table 4. Error size at detection time in the
horizontal plane (good IRS)
Ramp size AAIM
Open loop closed
good IRS Low cost IRS
0.1(m/s) 6.1m > 9.5m > 6m
0.5 (m/s) 6.5m 9.5m 5.8m
Figure 10. Discriminator deviation due 1 (m/s) 7m 13m 11.2 m
satellite failure causing ramp 5 (m/s) 7.2m 12.5m 10.5 m
Table 5. Error size at AAIM isolation time in
The following tables show examples of the horizontal plane (good IRS)
detection and exclusion performance with
only white measurement noise. One main advantage of this algorithm is
In these examples, AAIM algorithm is that it is able to detect any type of failures.
detecting satellite failure earlier than RAIM But it may become a drawback if the
algorithm and the delay between detection process is bad modelled in the Kalman
and isolation doesn’t exceed 20 s (table 3). filter. Simulations were made assuming the
Besides, for all the simulations the faulty measurement noise was not only white
satellite was detected and isolated before noise. Many false detections (only due to
the horizontal error grows over around 13m measurement noise) and false isolations
(table 4, 5). were observed. Indeed in that case
In the case of open-loop, the low cost IRS correlated noise was interpreted by the
drifts tend to make the whole system FDE algorithm as a failure.
derivate. In the case of closed loop bad Figure 11 and 12 show AAIM HPL with only
estimates of inertial errors due to ramp white measurement noise generated and
failure tend to miss-calibrate the inertial mixed measurement noise. In the
platform. Thus position error drift is not simulation context of figure 12, results
only due to satellite failure but also inertial show a false detection alert at time 404 s
drift. In these cases detection occurs whereas the ramp error on measurement is
earlier, these results might yield us to think not large enough to be detected in the case
that the false alarm rate could increase. illustrated in figure 10. In fact, in figure 12,

Presented at IFIS 2002, Roma 9


correlated noises make the GPS state stands for GPS range bias error for ith
measurement look like being affected by satellite.
ramp failure which is certainly the reason of CONCLUSION
this alert. Figure 13 shows the miss-
modelling impact on the discriminator Solution Separation method is a very
computed for sub-filter F04 that is no more appealing Fault detection and Exclusion
a zero-mean variable due to correlated algorithm because of its rigorousness. This
noise addition on range measurement. On paper presents an open-loop GPS/IMU
figure 10 the discriminator deviation is only system being investigated by the ENAC in
due to satellite failure causing a ramp. order to start appreciating the Solution
Separation algorithm ability of fault
isolation. Simulations were performed
assuming NPA requirements and satellite
failure causing a ramp from 0.1m/s to 5m/s.
AAIM HPL and HEL are the order of 20-30
m and are lower than RAIM HPL (closed to
70m). Isolation of the faulty satellite occurs
less than 20 seconds after fault detection
arise. Low cost IRS is affected by inertial
drift that pollutes the hybridized solution
causing false alarm in open-loop
Figure 11. White noise measurement noise hybridization. Finally the whole FDE
observation algorithm performance seems to greatly
depend on Kalman filter miss-modelization.
Thus implementation improvements have
to be taken account such as the correlation
measurement noise in the Kalman filter
model and will be the issue of further
works.

REFERENCES

Figure 12. White + correlated noise 1. - M. BRENNER, Integrated GPS/inertial


measurement observation detection availability, Journal of The
Institute of Navigation, Sept. 1995.
2 - K. VANDERWERF, FDE Using Multiple
Integrated GPS/Inertial Kalman Filters
in the Presence of Temporally and
Spatially Correlated Ionospheric Errors,
ION GPS 2001, 11-14 Sept. 2001, Salt
Lake City
3. - Requirements and Test Procedures for
Tightly Integrated GPS/Inertial Systems
Appendix R to DO-229C,.
4.- J. C. RADIX, Systèmes Inertiels à
Figure 13. Discriminator deviation due to Composants Liés “Strapdown”,
correlated noise Cépadues Educs, 1991.
5.- R. DA, Investigation of a Low-Cost and
Solution to take into account the High-Accuracy GPS/IMU System,
correlated noise on GPS measurement is Proceedings of ION GPS, Sept. 1996.
to estimate the evolution of this process. 6.- FARRELL J. A., BARTH M., The Global
The Kalman filters state vector is extended Positionning System & Inertial
by adding as many states as the number of navigation, McGraw-Hill, 1998.
tracked satellites. The ith supplemental

Presented at IFIS 2002, Roma 10

You might also like