multi-sensor data fusion based on information theory

7
Multi-sensor data fusion based on Information Theory. Application to GNSS positionning and integrity monitoring Nourdine Aรฏt Tmazirte, Maan E. El Najjar, Cherif Smaili and Denis Pomorski LAGIS UMR 8219 CNRS/Universitรฉ-Lille1 Avenue Paul Langevin 59655 Villeneuve dโ€™Ascq, France [email protected] Abstract โ€” Integrity monitoring is considered now as an important part of a vehicle navigation system. Localisation sensors faults due to systematic malfunctioning require integrity reinforcement of multi-sensors fusion method through systematic analysis and reconfiguration method in order to exclude the erroneous information from the fusion procedure. In this paper, we propose a method to detect faults of the GPS signals by using a distributed information filter with a probability test. In order to detect faults, consistency is examined through a log likelihood ratio of the information innovation of each satellite using mutual information concept. Through GPS measurements and the application of the autonomous integrity monitoring system, the current study illustrates the performance of the proposed fault detection algorithm and the pertinence of the reconfiguration of the multi- sensors data fusion. Keywords:data fusion, Fault detection, information theory, localisation, GNSS, RAIM. I. INTRODUCTION Autonomous navigation system requires a safety positioning system. When leading safety, positioning services not only need to provide an estimate of the vehicle location, but also uncertainty estimation. In practice, an upper bound on the positioning error, representing an integrity risk, is required to determine if a positioning system can be used for a given task. At GNSS (Global Navigation Satellite System) receiver level, standard approaches introduce a Fault Detection & Exclusion (FDE) stage to monitor the integrity of the estimation of the position. This is known as Receiver Autonomous Integrity Monitoring (RAIM) [1] [2]. Numerous FD studies have been conducted with real time sensors measurements. When we do not dispose of a sensor model, which is always the case with localisation sensors, FDE methods are approached in a statistical manner. Classically, stochastic approaches are developed through KALMAN filters [3], Particle Filter [4] or interval analysis [5]. These procedures for FD introduce residual testing through statistical approach [6]. In this residual test scheme, generally, FD is conducted by examining the probabilistic property of the estimated state itself [5], yet a precise reference system unaffected by failures is required. The implementation of this kind of architecture requires a thresholding process in order to pick out measurements errors. This kind of process could easily detect sporadic measurements errors but hardly detect the gradually increasing error of measurements. In addition, thresholds are fixed classically with a heuristic manner. Recently, the information filter (IF), which is the informational form of the KALMAN filter (KF), has proved to be attractive for multi-sensors fusion, like in [7],[8] or [9]. The IF uses an information matrix and an information vector to represent the co-variance matrix and the state vector usually used in a KF. This difference in representation makes the IF superior to the KF concerning multiple sensor fusion, as computations are simpler and no prior information of the system state is required [10] [11]. In addition, consistency test using log likelihood ratio (LLR), based on information matrix, permits to have a good balance between the detection probability and the false alarm probability. With the help of information filtering, the main interest of this paper is to ensure the reliability of the GNSS positioning in a navigation system. In this paper, a new GNSS integrity monitoring method is presented by applying a distributed IF and a LLR test. Specifically, the presented (FDE) scheme takes advantage of the highly LLR change between the information of each satellite and the mutual information of a set of visible satellites by a GNSS (GPS) receiver. The performance of the distributed IF is notable after reconfiguration of the data fusion procedure. This paper is organized as follows: Section 2 briefly introduces the general principle of distributed IF. In section 3, a detailed GPS integrity monitoring algorithm that employs distributed IF and ratio test is illustrated. A result using real GPS measurement 743

Upload: others

Post on 16-Oct-2021

4 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Multi-sensor data fusion based on Information Theory

Multi-sensor data fusion based on Information Theory.

Application to GNSS positionning and integrity

monitoring

Nourdine Aรฏt Tmazirte, Maan E. El Najjar, Cherif Smaili and Denis Pomorski

LAGIS UMR 8219 CNRS/Universitรฉ-Lille1

Avenue Paul Langevin 59655 Villeneuve dโ€™Ascq, France

[email protected]

Abstract โ€” Integrity monitoring is considered now as an

important part of a vehicle navigation system. Localisation

sensors faults due to systematic malfunctioning require integrity

reinforcement of multi-sensors fusion method through

systematic analysis and reconfiguration method in order to

exclude the erroneous information from the fusion procedure. In

this paper, we propose a method to detect faults of the GPS

signals by using a distributed information filter with a

probability test. In order to detect faults, consistency is

examined through a log likelihood ratio of the information

innovation of each satellite using mutual information concept.

Through GPS measurements and the application of the

autonomous integrity monitoring system, the current study

illustrates the performance of the proposed fault detection

algorithm and the pertinence of the reconfiguration of the multi-

sensors data fusion.

Keywords:data fusion, Fault detection, information theory,

localisation, GNSS, RAIM.

I. INTRODUCTION

Autonomous navigation system requires a safety positioning

system. When leading safety, positioning services not only need

to provide an estimate of the vehicle location, but also

uncertainty estimation. In practice, an upper bound on the

positioning error, representing an integrity risk, is required to

determine if a positioning system can be used for a given task.

At GNSS (Global Navigation Satellite System) receiver level,

standard approaches introduce a Fault Detection & Exclusion

(FDE) stage to monitor the integrity of the estimation of the

position. This is known as Receiver Autonomous Integrity

Monitoring (RAIM) [1] [2]. Numerous FD studies have been

conducted with real time sensors measurements. When we do

not dispose of a sensor model, which is always the case with

localisation sensors, FDE methods are approached in a statistical

manner. Classically, stochastic approaches are developed

through KALMAN filters [3], Particle Filter [4] or interval

analysis [5]. These procedures for FD introduce residual testing

through statistical approach [6]. In this residual test scheme,

generally, FD is conducted by examining the probabilistic

property of the estimated state itself [5], yet a precise reference

system unaffected by failures is required. The implementation of

this kind of architecture requires a thresholding process in order

to pick out measurements errors. This kind of process could

easily detect sporadic measurements errors but hardly detect the

gradually increasing error of measurements. In addition,

thresholds are fixed classically with a heuristic manner.

Recently, the information filter (IF), which is the informational

form of the KALMAN filter (KF), has proved to be attractive for

multi-sensors fusion, like in [7],[8] or [9]. The IF uses an

information matrix and an information vector to represent the

co-variance matrix and the state vector usually used in a KF.

This difference in representation makes the IF superior to the KF

concerning multiple sensor fusion, as computations are simpler

and no prior information of the system state is required [10]

[11]. In addition, consistency test using log likelihood ratio

(LLR), based on information matrix, permits to have a good

balance between the detection probability and the false alarm

probability.

With the help of information filtering, the main interest of this

paper is to ensure the reliability of the GNSS positioning in a

navigation system. In this paper, a new GNSS integrity

monitoring method is presented by applying a distributed IF and

a LLR test. Specifically, the presented (FDE) scheme takes

advantage of the highly LLR change between the information of

each satellite and the mutual information of a set of visible

satellites by a GNSS (GPS) receiver. The performance of the

distributed IF is notable after reconfiguration of the data fusion

procedure.

This paper is organized as follows: Section 2 briefly introduces

the general principle of distributed IF. In section 3, a detailed

GPS integrity monitoring algorithm that employs distributed IF

and ratio test is illustrated. A result using real GPS measurement

743

Page 2: Multi-sensor data fusion based on Information Theory

data is presented in section 4, followed by the conclusion in

section 5.

II. INFORMATION THEORY AND FILTERING

A. Information filter

An Extended KF can easily be expressed in another form, called

Nonlinear Information Filter (NIF) or inverse covariance filter

[10]. Instead of working with the estimation of states ๐‘ฅ(๐‘–|๐‘—) and

the variance ๐‘ƒ(๐‘–|๐‘—) , the IF deals with the information state

vector ๐‘ฆ (๐‘–|๐‘—) and information matrix ๐‘Œ(๐‘–|๐‘—), where:

y ๐‘– ๐‘— = Pโˆ’1 ๐‘– ๐‘— . x ๐‘– ๐‘— (1)

๐‘Œ(๐‘–|๐‘—) = ๐‘ƒโˆ’1(๐‘–|๐‘—) (2)

The information matrix is closely associated with the Fisher

information. The physical mean of the Fisher information is the

surface of a bounding region containing probability mass. It

measures the compactness of a density function.

๐‘ฅ ๐‘˜ = ๐น ๐‘˜ . ๐‘ฅ ๐‘˜ โˆ’ 1 + ๐‘ค ๐‘˜ (3)

Where ๐‘ฅ(๐‘˜) is the state vector, ๐น(๐‘˜) the state transition matrix

and ๐‘ค(๐‘˜) the process noise.

The observation is also modeled:

๐‘ง ๐‘˜ = ๐ป ๐‘˜ . ๐‘ฅ ๐‘˜ + ๐‘ฃ(๐‘˜) (4)

Where ๐‘ง(๐‘˜) is the observation vector, ๐ป ๐‘˜ the observation

matrix and ๐‘ฃ(๐‘˜) is a white noise.

The update stage of the NIF is written :

๐‘ฆ ๐‘˜|๐‘˜ = ๐‘ฆ ๐‘˜|๐‘˜ โˆ’ 1 + ๐‘– ๐‘˜ (5)

๐‘Œ ๐‘˜|๐‘˜ = ๐‘Œ ๐‘˜|๐‘˜ โˆ’ 1 + ๐ผ ๐‘˜ (6)

Where

๐‘– ๐‘˜ = ๐ป๐‘‡ ๐‘˜ .๐‘…โˆ’1 ๐‘˜ . ๐‘ง(๐‘˜) (7)

๐‘–(๐‘˜) is a vector containing the contribution in term of

information from an observation ๐‘ง(๐‘˜).

๐ผ ๐‘˜ = ๐ป๐‘‡ ๐‘˜ .๐‘…โˆ’1 ๐‘˜ .๐ป๐‘‡ ๐‘˜ (8)

๐ผ(๐‘˜) is the associated information matrix. The couple

(๐‘– ๐‘˜ , ๐ผ(๐‘˜)) represents the Information Contribution (IC) of the

observation.

In multiple sensor problems:

zi k = Hi k . x k + vi k i = 1โ€ฆN (9)

the estimate does not represent a simple linear combination of

contributions from individual sensors :

๐‘ฅ ๐‘˜ ๐‘˜ โ‰  ๐‘ฅ ๐‘˜ ๐‘˜ โˆ’ 1 + ๐‘Š๐‘–๐‘๐‘–=1 ๐‘˜ . ๐‘ง๐‘– ๐‘˜ โˆ’

๐ป๐‘– ๐‘˜ . ๐‘ฅ ๐‘˜ ๐‘˜ โˆ’ 1

(10)

(with ๐‘Š๐‘–(๐‘˜) independent gain matrices). The innovation

generated from each sensor is correlated. Indeed, they share

common information through the prediction ๐‘ฅ (๐‘˜|๐‘˜ โˆ’ 1).

In information form, estimates can be constructed from linear

combinations of observation information.

๐‘ฆ ๐‘˜ ๐‘˜ = ๐‘ฆ ๐‘˜ ๐‘˜ โˆ’ 1 + ๐‘–๐‘– ๐‘˜ ๐‘๐‘–=1 (11)

It is because information terms ๐‘–๐‘–(๐‘˜) from each sensor are

assumed to be uncorrelated. Now it is straightforward to

evaluate the contribution of each sensor (unlike for a KF). Each

sensor node simply generates the information terms ๐‘–๐‘–(๐‘˜). These

are summed at the update step of the NIF to produce a global

information estimate.

B. Mutual Information

To evaluate the IC of each sensor, a well known concept of

Information theory can be used: the Mutual Information (MI).

The MI ๐ผ(๐‘ฅ, ๐‘ง) is an a priori measure of the information which

will be gained by x with a set of observations z.

๐ผ(๐‘ฅ, ๐‘ง) is defined in [12] as:

๐ผ ๐‘ฅ, ๐‘ง = โˆ’๐ธ ln๐‘ƒ ๐‘ฅ, ๐‘ง

๐‘ƒ ๐‘ฅ .๐‘ƒ ๐‘ง = โˆ’๐ธ ln

๐‘ƒ ๐‘ฅ ๐‘ง

๐‘ƒ ๐‘ฅ

= โˆ’๐ธ ln๐‘ƒ ๐‘ง ๐‘ฅ

๐‘ƒ ๐‘ง

(12)

In term of entropies, the MI is written:

๐ผ ๐‘ฅ, ๐‘ง = ๐ป ๐‘ฅ + ๐ป ๐‘ง โˆ’ ๐ป ๐‘ฅ, ๐‘ง = ๐ป ๐‘ฅ โˆ’ ๐ป ๐‘ฅ ๐‘ง (13)

With ๐ป(๐‘ฅ), ๐ป(๐‘ง) the respective entropies of ๐‘ฅ and ๐‘ง. ๐ป ๐‘ฅ ๐‘ง and ๐ป ๐‘ง ๐‘ฅ the conditional entropies.

744

Page 3: Multi-sensor data fusion based on Information Theory

III. FAULTY DETECTION AND EXCLUSION : APPLICATION TO

GPS INTEGRITY MONITORING

GNSS integrity monitoring or Receiver Autonomous Integrity

Monitoring (RAIM) is a technology developed to control the

integrity of global navigation satellite system signals in a

receiver system. During a long time, integrity was exclusively

used in aviation or marine navigation. The integrity represents

the ability to associate to a position a reliable indication of trust.

With the development of different safety-critical urban

applications, the notion of integrity became an important field of

research, in particular in urban canyon, where satellites signals

are subject to hostile environment.

Usually, RAIM algorithms use a comparison of the result of a

main equation system and subsystems results [4], we propose to

use the information theory to quantify the information

contribution of each satellite (Figure 1). In other words, we

propose to detect and to exclude faulty satellite upstream,

meaning before the equation system resolution.

Figure 1. Satelllite Information contribution for GNSS Monitoring

A. State space representaion for GNSS Positionning

GNSS positioning with pseudo-range is a Time of Arrival

method [5]. Pseudo-ranges are the distances between visible

satellites and the receiver plus the unknown difference between

the receiver clock and the GNSS time. Thus, GNSS positioning

is a four dimensional problem: the 3D coordinates (๐‘ฅ๐‘– , ๐‘ฆ๐‘– , ๐‘ง๐‘– ) of

the user and the clock offset ๐‘‘๐‘ก๐‘– are unknown.

As well detailed in [13], the process model depends on the

dynamical characteristics of the vehicle. The system is assumed

to evolve according to the equation:

๐‘ฅ ๐‘˜ + 1 = ๐ด. ๐‘ฅ ๐‘˜ + ๐‘ค ๐‘˜ + 1

(14)

Where the state vector is composed of the eight following

variables:

๐‘ฅ ๐‘˜ =

๐‘‹ ๐‘˜ ,๐‘‹ ๐‘˜ ,๐‘Œ ๐‘˜ ,๐‘Œ ๐‘˜ ,๐‘ ๐‘˜ ,๐‘ ๐‘˜ , ๐‘๐œ•๐‘ก ๐‘˜ , ๐‘๐œ•๐‘ก ๐‘˜ (15)

[๐‘‹,๐‘Œ,๐‘] representing the receiver position,[๐‘‹ ,๐‘Œ ,๐‘ ]the velocity

in Earth Centered Earth Fixed (ECEF) frame, ๐œ•๐‘ก the clock range

and ๐œ•๐‘ก the clock drift.

The state transition matrix is given by:

๐ด =

1 ๐‘‡ 0 0 0 0 0 00 1 0 0 0 0 0 00 0 1 ๐‘‡ 0 0 0 00 0 0 1 0 0 0 00 0 0 0 1 ๐‘‡ 0 00 0 0 0 0 1 0 00 0 0 0 0 0 1 ๐‘‡0 0 0 0 0 0 0 1

(16)

Where ๐‘‡ is the sample period (in our case 1 second). The

measurement noise ๐‘ค . is assumed to be time invariant:

๐‘ค . =

๐‘‡2๐œ๐‘ฅ

2

2,๐‘‡๐œ๐‘ฅ

2,๐‘‡2๐œ๐‘ฆ

2

2,๐‘‡๐œ๐‘ฆ

2,๐‘‡2๐œ๐‘ง

2

2,๐‘‡๐œ๐‘ง

2, ๐‘๐œ๐‘“2๐‘‡ +

๐‘๐œ๐‘”2๐‘‡2

2, ๐‘๐œ๐‘”

2๐‘‡

(17)

Where ๐œ๐‘ฅ2 ,๐œ๐‘ฆ

2 ,๐œ๐‘ง2 represent the process noise variances related

to the states ๐‘ฅ, ๐‘ฆ and ๐‘ง , ๐œ๐‘“ and ๐œ๐‘” are the variances related to

clock offset and velocity, and ๐‘ the speed of light .

Making the assumption that ๐‘ค~๐‘ 0,๐‘„ means that ๐‘ค is assumed to be a white Gaussian noise with covariance ๐‘„ :

๐‘„ =

๐›ผ๐œ๐‘ฅ2

๐›ฝ๐œ๐‘ฅ2

000000

๐›ฝ๐œ๐‘ฅ2

๐›พ๐œ๐‘ฅ2

000000

00

๐›ผ๐œ๐‘ฅ2

๐›ฝ๐œ๐‘ฅ2

0000

00

๐›ฝ๐œ๐‘ฅ2

๐›พ๐œ๐‘ฅ2

0000

0000

๐›ผ๐œ๐‘ฅ2

๐›ฝ๐œ๐‘ฅ2

00

0000

๐›ฝ๐œ๐‘ฅ2

๐›พ๐œ๐‘ฅ2

00

000000

๐›พ๐œ๐‘“2 + ๐›ผ๐œ๐‘”

2

๐›ฝ๐œ๐‘”2

000000

๐›ฝ๐œ๐‘”2

๐›พ๐œ๐‘”2

(18)

745

Page 4: Multi-sensor data fusion based on Information Theory

With

๐›ผ =

๐‘2๐‘‡3

3

(19)

๐›ฝ =

๐‘2๐‘‡2

2

(20)

๐›พ = ๐‘‡

(21)

The observation [๐‘ฅ๐‘– , ๐‘ฆ๐‘– , ๐‘ง๐‘–] of each satellite ๐‘– , is calculated

thanks to broadcasted ephemeris. The atmospheric errors are

also modeled ๐›ฟ๐œŒ๐‘– ๐ผ๐‘œ๐‘›๐‘œ๐‘† , ๐›ฟ๐œŒ๐‘– ๐‘‡๐‘Ÿ๐‘œ๐‘๐‘œ

๐‘† . The pseudo-range can be

modeled as follow:

๐‘…๐‘–๐‘  = ๐‘ฅ๐‘– โˆ’ ๐‘ฅ๐‘† 2 + ๐‘ฆ๐‘– โˆ’ ๐‘ฆ๐‘† 2 + ๐‘ง๐‘– โˆ’ ๐‘ง๐‘† 2 +

๐‘. ๐‘‘๐‘ก๐‘– โˆ’ ๐‘‘๐‘ก๐‘  + ๐›ฟ๐œŒ๐‘– ๐ผ๐‘œ๐‘›๐‘œ๐‘† + ๐›ฟ๐œŒ๐‘– ๐‘‡๐‘Ÿ๐‘œ๐‘๐‘œ

๐‘†

(22)

Being non-linear, the observation model is linearised around a

predicted state [๐‘‹๐‘๐‘Ÿ ] to obtain an observation matrix:

๐ป =

โˆ‡๐‘•๐‘ฅ1

โ‹ฎ

โˆ‡๐‘•๐‘ฅ๐‘—

โ‹ฎโˆ‡๐‘•๐‘ฅ

๐‘›

0โ‹ฎ0โ‹ฎ0

โˆ‡๐‘•๐‘ฆ1

โ‹ฎ

โˆ‡๐‘•๐‘ฆ๐‘—

โ‹ฎโˆ‡๐‘•๐‘ฆ

๐‘›

0โ‹ฎ0โ‹ฎ0

โˆ‡๐‘•๐‘ง1

โ‹ฎ

โˆ‡๐‘•๐‘ง๐‘—

โ‹ฎโˆ‡๐‘•๐‘ง

๐‘›

0โ‹ฎ0โ‹ฎ0

1โ‹ฎ1โ‹ฎ1

0โ‹ฎ0โ‹ฎ0

(23)

With

โˆ‡๐‘•๐‘ฅ๐‘—

=๐œ•๐‘…๐‘—

๐‘ 

๐œ•๐‘ฅ= โˆ’(๐‘ฅ๐‘† โˆ’ ๐‘ฅ๐‘๐‘Ÿ ) ๐‘…๐‘๐‘Ÿ

๐‘ 

(24)

โˆ‡๐‘•๐‘ฆ๐‘—

=๐œ•๐‘…๐‘—

๐‘ 

๐œ•๐‘ฆ= โˆ’(๐‘ฆ๐‘† โˆ’ ๐‘ฆ๐‘๐‘Ÿ ) ๐‘…๐‘๐‘Ÿ

๐‘ 

(25)

โˆ‡๐‘•๐‘ง๐‘—

=๐œ•๐‘…๐‘—

๐‘ 

๐œ•๐‘ง= โˆ’(๐‘ง๐‘† โˆ’ ๐‘ง๐‘๐‘Ÿ ) ๐‘…๐‘๐‘Ÿ

๐‘ 

(26)

And

๐‘…๐‘๐‘Ÿ๐‘  = ๐‘ฅ๐‘† โˆ’ ๐‘ฅ๐‘๐‘Ÿ

2+ ๐‘ฆ๐‘† โˆ’ ๐‘ฆ๐‘๐‘Ÿ

2+ ๐‘ง๐‘† โˆ’ ๐‘ง๐‘๐‘Ÿ

2

(27)

Each satellite noise is assumed to be uncorrelated with all others.

So, the noise described as follow ๐‘ฃ~๐‘ 0,๐‘… is simply

represented by its diagonal time-invariant matrix R:

๐‘…(. ) =

๐œ1

โ‹ฎ

0

โ‹ฑ

โ€ฆ

๐œ๐‘—

โ€ฆ

โ‹ฑ

0

โ‹ฎ

๐œ๐‘›

(28)

B. Mutual Information for FDE

As proved in [14] the entropy, for a multivariate Gaussian

distribution (which is assumed to be the case in Eq. 14 for our

study), goes as the log-determinant of the covariance. Precisely,

the differential entropy of a d-dimensional random vector ๐‘‹

drawn from the Gaussian ๐‘(๐œ‡, ํœ€) is:

๐ป ๐‘‹ = ๐‘ ๐‘‹ . ln ๐‘ ๐‘‹ .๐‘‘๐‘‹

=๐‘‘

2+ ๐‘‘.

ln(2๐œ‹)

2+ ln

ํœ€

2

(29)

From Eq.13 & Eq. 29, the MI in our case is defined:

๐ผ ๐‘‹,๐‘ =๐‘‘

2+ ๐‘‘.

ln 2๐œ‹

2+ ln

๐‘ƒ(๐‘‹)

2โˆ’ (

๐‘‘

2+ ๐‘‘.

ln 2๐œ‹

2

+ ln ๐‘ƒ(๐‘‹|๐‘)

2)

It becomes a basic Log Likelihood Ratio :

(30)

๐ผ ๐‘‹,๐‘ =1

2ln

๐‘ƒ(๐‘‹)

๐‘ƒ(๐‘‹|๐‘)

(31)

A Global Information Mutual Information (GOMI) can be

defined. ๐‘ƒ(๐‘‹) is the prediction covariance and ๐‘ƒ(๐‘‹|๐‘) is the

updated covariance. The GOMI becomes, in information form:

๐ผ ๐‘‹,๐‘ =1

2ln

๐‘Œ(๐‘˜|๐‘˜)

๐‘Œ(๐‘˜|๐‘˜ โˆ’ 1) (32)

๐ผ ๐‘‹,๐‘ =1

2ln

๐‘Œ ๐‘˜ ๐‘˜ โˆ’ 1 + ๐ผ๐‘–(๐‘˜)๐‘๐‘–=1

๐‘Œ(๐‘˜|๐‘˜ โˆ’ 1) (33)

We also define the Partial Observation Mutual Information

(POMI) which will take in account only one information term of

sensor ๐‘–.

๐ผ๐‘– ๐‘‹,๐‘ =1

2ln

๐‘Œ ๐‘˜ ๐‘˜ โˆ’ 1 + ๐ผ๐‘–(๐‘˜)

๐‘Œ(๐‘˜|๐‘˜ โˆ’ 1)

(34)

The GOMI will prove to be an adapted residual for fault

detection, whereas the POMI will isolate the faulty observation.

746

Page 5: Multi-sensor data fusion based on Information Theory

C. Principle of the FDE method

The structure of the proposed GNSS integrity monitoring

method is illustrated in figure 2 which correspond to a classical

prediction/correction filtering using IF but including a FDE

stage.

Figure 2. Classical GNSS Integrity Monitoring schema

In the proposed FDE approach, described in the following

flowchart, in figure 3, only five measurements are needed for the

integrity monitoring.

Figure 3. Information Theory based proposed method

With n measurements, n Information Contribution (IC1 โ€ฆ ICn)

(Eq. 7 & Eq.8) are computed. A GOMI (Eq. 33) is then

computed using the n IC. The GOMI permits to have an auto-

thresholding stage in order to detect the inconsistency of one or

several satellites.

In case of fault detection, a POMI (Eq. 34) is computed for each

satellite. These different POMIs are used to isolate the faulty

satellites measurements in order to be excluded from the

correction step of the NIF algorithm.

IV. EXPERIMENTAL RESULTS

In order to test the performance of the RAIM developed

approach, real data acquisition has been carried out with CyCab

vehicle produced by Robosoft (www.robosoft.fr/) with several

embedded sensors. In this work, measurements of GPS RTK

Thales Sagitta 02 system and open GPS Septentrio Polarx2e@

(Figure 4) are used.

Figure 4. Experimental vehicle.

The data acquisition has been carried out around LORIA Lab.

During these experiments we remarked, as shown in figure 5,

that when the positionning system uses all visible satellite

without a FDE stage, one satellite introduces a bias in the

positionning process. It seems that this satellite was in a bad

geometric configuration in respect to the building in front (Bat C

in the figure 4, 5 and 6). To compare, the test trajectory

reference with centimetric accuracy (GPS RTK) is plotted in

green in figure 6. This trajectory is about eighty meters length.

747

Page 6: Multi-sensor data fusion based on Information Theory

Figure 5. Trajectory after fusion without FDE

Figure 6. Reference trajectory given by RTK GPS

In figure 7 and 8, the results of the detection and exclusion

process are presented for the set of visible satellites during the

test trajectory. GOMI concept, introduced in section 2 helps to

auto-threshold information contribution of all satellites. After

few steps of initialization, the contribution of each satellite goes

to โ€•stabilizeโ€– around a value. Indeed, a satellite, if still visible,

should not bring a contribution different to the information gives

by the steps before.

Figure 7, one can easily see the different surges of information

contribution. That because a pseudo-range is generally

overestimated when the corresponding satellite waves is subject

to multi-path. Thus, the IC of the faulty satellite is also

overvalued. This IC becomes inconsistent, and need to be

excluded.

In this test, we detected only one satellite real errors, but the

proposed approach can be generalized for multiple faulty

satellites.

Figure 7. Global Observation Mutual Information for Detection

The fault exclusion step is realised using the POMI computed

for each satellite. In fact, the POMI permits to identify the

inconsistency of the faulty satellite like discribed in figure 8.

One can see the surges of POMI of satellite 6 represented in

blue.

Figure 8. Partials Observation Mutual Information for Exclusion

In figure 9, is shown the performance of the fusion with FDE

after exclusion of satellite 6 from the fusion procedure. We note

that the trajectory in figure 9 is close to the GPS RTK trajectory

showed in figure 6.

748

Page 7: Multi-sensor data fusion based on Information Theory

Figure 9. Trajectory after fusion with FDE

Finally, the figure 10 shows performance of the proposed

approach with faulty satellite exclusion in blue. This figure

shows the position computation in the ECEF frame for each axis

(X,Y,Z). In red, are the position computation on ECEF frame

without faulty satellite exclusion.

Figure 10. Exclusion of a faulty satellite in GNSS positioning

V. CONCLUSION AND FUTURES WORKS

This paper proposes a reliable multi sensor data fusion approach

with integrity monitoring. This approach integrates Fault

Detection stage by using distributed NIF and LLR test using

mutual information. The proposed method makes it possible to

detect fault without heuristic thresholing step. It permits an

automatic reconfiguration of the fusion procedure in order to

exclude the faulty measure. The proposed approach is applied

for a GPS integrity monitoring. Measurements were pseudo-

ranges from the GPS satellites. The basic concept is to use the

Information Filter in a distributed architecture. The likelihood

function is established and examined by integrating state

estimate from distributed Information Filters. Thus, the LLR test

is used in fault detection, which compares the information

introduced by each satellite observation compared to the

expected information.

The evaluation of FDE is conducted through simulation using

real GPS measurements data. In the presented test trajectory, the

measured data from GPS contain the well known waveโ€™s multi-

path error illustrated with an abnormal bias. Based on real data,

results demonstrate performance of the proposed approach in

detecting GPS measurements faults and fusion method

reconfiguration. In future work, our objective is to integrate dead

reckoning sensors in order to develop a tightly coupled data

fusion method. These sensors are known to introduce gradually

increasing errors (drift). The LLR is well adapted to detect this

kind of errors.

REFERENCES

Erreur ! Source du renvoi introuvable. [1] R. Grover Brown, Gerald Y. Chin, โ€•GPS RAIM: Calculation of Threshold

and Protection Radius Using Chi-Square Methods-A Geometric Approachโ€–, in. Global Positioning System: Inst. Navigat., vol. V, pp. 155โ€“179, 1997

[2] T. Walter, P. Enge. โ€•Weighted RAIM for Precision Approach.โ€–

Proceedings of the ION-GPS 1995, Palm Springs, CA, 1995.

[3] B. W. Parkinson, and P. Axelrad, โ€•Autonomous GPS integrity monitoring using the pseudorange residualโ€–, Navig., J. Inst. Navig., vol. 35, no. 2, pp. 255โ€“274, 1988.

[4] J. Ahn & al., โ€•GPS Integrity Monitoring Method Using Auxiliary Nonlinear Filters with Log Likelihood Ratio Test Approachโ€–, Journal of Electrical Engineering & Technology Vol. 6, No. 4, pp. 563~572, 2011.

[5] V. Drevelle and Ph. Bonnifait ,โ€•Global Positioning in Urban Areas with 3-D Mapsโ€– Proceedings of the 2011 IEEE Intelligent Vehicles Symposium, Baden-Baden, Allemagne, pp. 764-769, 2011

[6] Y. C. Lee, โ€•Analysis or range and position comparison methods as a means to provide GPS integrity in the user receiver,โ€– in Proceedings of the Annual Meeting of the Institute of Navigation, Seattle, WA, Jun. 1986, pp. 1โ€“4, 1986.

[7] B. Grocholsky, H. Durrant-Whyte, and P. Gibbens, โ€•An informationtheoretic approach to decentralized control of multiple autonomous flight vehicles,โ€– Proc. SPIE: Sensor Fusion and Decentralized Control in Robotic Systems III, vol. 4196, pp. 348โ€“359, Oct. 2000.

[8] L. Wang, Q. Zhang , H. Zhu , and L. Shen, โ€•Adaptive consensus fusion estimation for msn with communication delays and switching network topologiesโ€–. Decision and Control (CDC), 2010 49th IEEE Conference on, pages 2087 โ€“2092,2010.

[9] G. Liu, F. Wรถrgรถtter, and I. Markeliยดc, โ€•Nonlinear estimation using central difference information filterโ€–. In IEEE Workshop on Statistical Signal Processing, pages 593โ€“596, 2011.

[10] S. Grime and H. F. Durrant-Whyte. โ€•Data Fusion in Decentralized Sensor Networksโ€–. Control Engineering Practice, 2:849-863, 1994.

[11] D.-J. Lee, โ€•Nonlinear estimation and multiple sensor fusion using unscented information filteringโ€–. Signal Processing Letters, IEEE, 15:861 โ€“864, 2008.

[12] T.M. Cover and J.A. Thomas, Elements of information theory. John Wiley &

Sons, New York, NY, Inc., Chapter 9 Theroem 9.4.3, 1991.

[13] S. Cooper and H. F. Durrant-Whyte. โ€•A Kalman filter model for GPS navigation of land vehiclesโ€–. In: IEEE/RSJ/GI International Conference on Intelligent Robots and Systems, p. 157โ€”163, 1994.

[14] T.M. Cover and J.A. Thomas, Elements of information theory. John Wiley &

Sons, New York, NY, Inc., Chapter 2 Definition 2.3, 1991.

749