sigma point kalman filters for gps navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · sigma...

17
This may be the author’s version of a work that was submitted/accepted for publication in the following source: Greer, Duncan, Bruggemann, Troy,& Walker, Rodney (2007) Sigma Point Kalman Filters for GPS Navigation with Integrity in Aviation. In Dempster, A (Ed.) International Global Navigation Satellite Systems Society - IGNSS Symposium 2007. Menay Pty Ltd, CD Rom, pp. 1-16. This file was downloaded from: https://eprints.qut.edu.au/11143/ c Copyright 2007 Duncan Greer This work is covered by copyright. Unless the document is being made available under a Creative Commons Licence, you must assume that re-use is limited to personal use and that permission from the copyright owner must be obtained for all other uses. If the docu- ment is available under a Creative Commons License (or other specified license) then refer to the Licence for details of permitted re-use. It is a condition of access that users recog- nise and abide by the legal requirements associated with these rights. If you believe that this work infringes copyright please provide details by email to [email protected] Notice: Please note that this document may not be the Version of Record (i.e. published version) of the work. Author manuscript versions (as Sub- mitted for peer review or as Accepted for publication after peer review) can be identified by an absence of publisher branding and/or typeset appear- ance. If there is any doubt, please refer to the published source.

Upload: others

Post on 23-Mar-2020

36 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

This may be the author’s version of a work that was submitted/acceptedfor publication in the following source:

Greer, Duncan, Bruggemann, Troy, & Walker, Rodney(2007)Sigma Point Kalman Filters for GPS Navigation with Integrity in Aviation.In Dempster, A (Ed.) International Global Navigation Satellite SystemsSociety - IGNSS Symposium 2007.Menay Pty Ltd, CD Rom, pp. 1-16.

This file was downloaded from: https://eprints.qut.edu.au/11143/

c© Copyright 2007 Duncan Greer

This work is covered by copyright. Unless the document is being made available under aCreative Commons Licence, you must assume that re-use is limited to personal use andthat permission from the copyright owner must be obtained for all other uses. If the docu-ment is available under a Creative Commons License (or other specified license) then referto the Licence for details of permitted re-use. It is a condition of access that users recog-nise and abide by the legal requirements associated with these rights. If you believe thatthis work infringes copyright please provide details by email to [email protected]

Notice: Please note that this document may not be the Version of Record(i.e. published version) of the work. Author manuscript versions (as Sub-mitted for peer review or as Accepted for publication after peer review) canbe identified by an absence of publisher branding and/or typeset appear-ance. If there is any doubt, please refer to the published source.

Page 2: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

International Global Navigation Satellite Systems Society IGNSS Symposium 2007

The University of New South Wales, Sydney, Australia 4 – 6 December, 2007

Sigma Point Kalman Filters for GPS Navigation with Integrity in Aviation

Mr D. Greer Australian Research Centre for Aerospace Automation

Queensland University of Technology Brisbane Australia

Tel: +61 7 3138 1362 Email: [email protected]

Mr T. Bruggemann Australian Research Centre for Aerospace Automation

Queensland University of Technology Brisbane Australia

Tel: +61 7 3138 1362 Email: [email protected]

A/Prof R. Walker Australian Research Centre for Aerospace Automation

Queensland University of Technology Brisbane Australia

Tel: +61 7 3138 1772 Email: [email protected]

ABSTRACT

This paper presents an investigation into the benefits of Sigma Point Kalman Filters (SPKF) applied to GPS­Only estimation problem for high­integrity navigation in aviation applications. Navigation systems used for aircraft approach and landing must meet strict requirements for accuracy, integrity, availability and continuity. Modern GPS is capable of meeting the accuracy and availability requirements, however the integrity and continuity required for approach navigation mandate the use of additional sensors to meet the standards. Modern signal processing techniques can allow greater capability of existing systems, lowering the costs for all users of the system, particularly in the General Aviation sector. This work begins by comparing the raw estimation performance of the sigma­point filter against established approaches of the Extended Kalman Filter (EKF) and snapshot Least­squares (LSQ). The fault detection algorithms are then developed for the SPKF

Page 3: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

filters based on an approach used for high­grade navigation systems. It is hypothesised that since the SPKF can provide a more accurate estimate of the state covariance, then the fault detection scheme, including the integrity protection level, will be more reliable. Comparisons of the fault­detection performance against current techniques are presented. Finally, conclusions are drawn as to the overall benefits of the SPKF approach to navigation integrity. It is demonstrated that whilst the accuracy of the SPKF is not significantly different than the EKF or Least Squares approaches, the covariance estimation and resultant integrity protection level is reliable.

KEYWORDS: GPS, Extended KF, Sigma­Point, Unscented KF, Integrity

1. INTRODUCTION

The future of General Aviation (GA) will require high integrity and high continuity navigation in order to fully realise the benefits of concepts such as Automatic Dependant Surveillance Broadcast (ADS­B), Highway­in­the­Sky (HITS) and Synthetic Vision Systems (SVS). Integrity of a navigation system refers to the system's ability to alert the user, in a timely manner, when its’ information should not be used. Continuity is the probability that the system will be available without interruption for the desired duration. There is little doubt that Global Navigation Satellite Systems (GNSS), such as the Global Positioning System (GPS), will play a major role in fulfilling this requirement for many users throughout the world, however due to various factors, GNSS augmentation systems will be required to ensure their integrity for safety critical applications.

The Ground­based Regional Augmentation System (GRAS) has been proposed as a cost effective means of overcoming the limitations of GPS for use in aviation (Murphy, 2000). GRAS uses a network of reference stations over a wide area to continually monitor the GPS in a similar manner to Space Based Augmentation Systems (SBAS) such as the Wide Area Augmentation System (WAAS). A second network of VHF broadcast stations is used to transmit this integrity information to users in the service volume. The infrastructure for such a network already exists in Australia in the form of the aviation VHF voice network.

However even with integrity information from a GRAS, high continuity of integrity information cannot be guaranteed to the user due to the continued possibility of outages or faults due to local effects such as terrain masking, intentional or unintentional interference, multipath or receiver faults. Therefore, an autonomous integrity scheme is required to protect the final information presented by the navigation system. A multi­sensor approach is favoured, since modern GA aircraft will likely include a range of sensors which can be used to improve the navigation on board the aircraft. In order to fuse this information, recursive Bayesian filtering is commonly used, particularly Extended Kalman Filters (EKF). One of the limitations of the EKF is that the pseudo­covariance information used by the filter to calculate the Kalman gain could be unreliable (Bar­Shalom et al., 2001), thus its use in a safety­critical integrity scheme is not desirable. The SPKF is claimed to produce more accurate covariance estimates, since it uses the true non­linear system dynamic model, rather than a linearised model, to complete the time update (Julier, 2004). Previous work has validated the SPKF accuracy for integrated navigation applications (van der Merwe, 2004; Wendel et al., 2006), however this work has not addressed the benefits to navigation system integrity . The purpose of this paper has been to investigate these claims in the context of GPS navigation, and compare the integrity performance with established approaches.

Page 4: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

This paper’s methodology was chosen to compare the outputs of three estimators using two GPS datasets – a 24 hour static set and a short airborne dynamic set. The SPKF is compared with the Extended Kalman Filter (EKF) and snapshot Least­Squares Residual (LSQ). An analysis of the state and covariance estimation accuracy is carried out. For the integrity analysis, a baseline snapshot integrity scheme for the LSQ is compared with a separation based integrity scheme for the EKF and SPKF. This paper begins with a technical description of the SPKF, in particular the Unscented Kalman Filter (UKF) implementation which has been used in this paper. The fault­detection algorithm is then presented. Finally, results are shown which demonstrate the performance of the SPKF approach against the EKF and LSQ for both accuracy and integrity.

2. Sigma Point Kalman Filters

The Sigma­Point approach (sometimes referred to as SPA) emerged from particle filtering for non­linear systems in the late 1990’s. In the particle filtering approach, a large number (many hundreds or thousands) of ‘particles’ are sampled from an arbitrary prior distribution and propagated through the system dynamics thus preserving the true posterior probability distribution. Particle filtering is extremely computationally intensive and has the added complication of requiring a re­sampling scheme. In the sigma­point approach, rather than randomly sampling an arbitrary prior, a deterministic number of ‘sigma­points’ are chosen from a Gaussian prior distribution. These points are propagated through the system dynamics and a new Gaussian posterior is reconstructed. Various weighting factors are used to control the spread and weighing of each sigma point. For this paper, the Unscented Transform was used, yielding an Unscented Kalman Filter (UKF). This section provides a brief technical overview of the SPKF formulation used in this paper. More detailed tutorials can be found in papers by Julier and Uhlmann (1997; 2004)

2.1. Sigma Point Generation

Sigma Point Generation is the first step in evaluating the SPKF. The system state vector is denoted as x, process noise as w and measurement noise as n. An augmented state vector, x a , and covariance P a , is generated by concatenating the system state with process noise states, w, and measurement noise states, n, as shown in Equation 1 and Equation 2. The total dimension of the augmented state vector, Na, defines the dimension of each sigma point. The number of sigma points required is typically 2Na+1, however other formations are possible which only need Na+1 points. A matrix of dimension Na × (2Na+1) is required to track the total system state using sigma points.

[ ] n w x x = a (1)

=

R 0 0 0 Q 0 0 0 P

P a (2)

A superscript ‘a’ denotes the augmented state vector, a superscript ‘x’ denotes the state sigma points, superscript ‘w’ the process noise sigma points and superscript ‘n’ the measurement noise sigma points. The sigma points, χi, are calculated from the posterior mean and covariance of the previous time step as shown in Equations 3­4. The matrix square root given in Equation 4 is implemented using Cholesky factorisation.

Page 5: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

a k k

a 1 | 1 0 ˆ − − = x χ (3)

( ) i

a k k

a k k

a i 1 | 1 1 | 1 ˆ − − − − ± = P x ζ χ (4)

The parameters of the SPKF are given by the Unscented Transform weighting scheme equations 5­10.

U a N λ ζ + = (5)

( ) a U a U U N N − + = κ α λ 2 (6)

U a

U m

N w

λ λ +

= 0 (7)

( ) U a

m i N w

λ + = 2

1 (8)

( ) U U m c w w β α + − + = 2 0 0 1 (9)

m i

c i w w = (10)

For this paper, αU = 0.1, βU = 2 and κU = 0. The state prediction is calculated by propagating the sigma points through the system dynamics and integrating, then finding the mean and covariance of the transformed points.

( ) w k i

x k i

x k k i f 1 , 1 , 1 | , , − − − = χ χ χ (11)

∑ =

− − = a N

i

x k k i

m i k k w

2

0 1 | , 1 | ˆ χ x (12)

( )( ) ∑ ∑ = =

− − − − − − − = a a N

i

N

j

T k k

x k k j k k

x k k i

c ij k k x w

2

0

2

0 1 | 1 | , 1 | 1 | , 1 | , ˆ ˆ x x P χ χ (13)

The measurement sigma points are generated as a non­linear function of the state sigma points and measurement noise as shown in Equation 14. The predicted measurement mean and covariance are calculated from the measurement sigma points as shown in Equations 15­16.

( ) n k i,

x 1 ­ k | k i, 1 | ,χ χ h γ k k = − (14)

Page 6: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

∑ =

− − = a N

i k k i

m i k k w

2

0 1 | , 1 | ˆ γ y (15)

( )( ) ∑ ∑ = =

− − − − − − − = a a N

i

N

j

T k k k k j k k k k i

c ij k k y w

2

0

2

0 1 | 1 | , 1 | 1 | , 1 | , ˆ ˆ y y P γ γ (16)

Finally, the state­measurement cross covariance is calculated as shown in Equation 17.

( )( ) ∑ ∑ = =

− − − − − − − = a a N

i

N

j

T k k k k j k k

x k k i

c ij k k xy w

2

0

2

0 1 | 1 | , 1 | 1 | , 1 | , ˆ ˆ y x P γ χ (17)

2.2. Kalman Gain and State Update

The Kalman gain and state update are calculated in the usual way of a Kalman filter as shown in Equations 18­20.

1 − = y xy k P P K (18)

( ) 1 | 1 | | ˆ ~ ˆ ˆ − − − + = k k k k k k k k y y K x x (19)

T k y k k k x k x K P K P P − = −1 | , , (20)

where k y ~ denotes the actual measurements.

3. Application of the SPKF to GPS

The application of the SPKF to GPS navigation is straightforward. A standard process and measurement model for the estimator is chosen (Brown and Hwang, 1997) and discussed below. One of the advantages of the SPKF approach is that the process and measurement models do not need to be linearised, thus there is no need to calculate Jacobians. The same process and measurement models are used for the UKF and EKF, although the EKF must be linearised about the current state estimate.

3.1. Process Model

For the GPS­Only estimator, four dynamic state triplets (position, velocity, acceleration and jerk), plus two clock states (bias and drift rate) are tracked resulting in a fourteen element state vector. The clock model is a simple random­walk model for frequency error which is integrated again for bias error. The jerk state is also modelled as random walk, which is integrated to produce acceleration, velocity and position. Process noise for the UKF and EKF is calculated as shown in (Brown and Hwang, 1997).

3.2. Measurement Model

The measurement model on the other hand is non­linear in nature, as the geometric range to

Page 7: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

the each i­th satellite is a non­linear function of user, U, and satellite, Si, position and velocity. The measurement vector is a concatenation of the pseudorange, ρ, and pseudorange rate (doppler), measurements as given by Equations 21­23.

( )

= = i

i h ρ ρ &

x y (21)

ρ ρ , i b i i n R + + − = U S (22)

( ) ρ ρ & & & & , i f i

i

i i n R + + −

− −

= U S U S U S

(23)

In these equations, Rb is the user clock bias error, Rf is the user clock frequency error and ni is the pseudorange and doppler noise.

The measurement noise chosen for the estimator was based on the broadcast User Range Accuracy (URA) from the satellite plus local errors. Satellites with a broadcast URA greater than zero (2.4m) were rejected. Standard ionosphere and troposphere error corrections were applied to the measurements. A summary of the error contribution for the range measurement is provided in Table 1 (Parkinson et al., 1996). Since the error contributions of the pseudorange doppler were not discussed in Parkinson, an error of 20cm was chosen based on inspection of the measurements.

Error Source Contribution URA 2.4m Ionosphere 4.0m Troposphere 0.7m Multipath 1.4m Measurement Noise 0.5m Total 4.95m Table 1: Measurement Error Summary

3.3. Calculation of DOP

The Dilution of Precision (DOP) value is useful in gaining an instantaneous impression of the geometry of the GPS constellation. It represents the ratio of satellite ranging errors to position errors and may be calculated from the SPKF parameters as shown.

( ) ( ) T xy x equiv P P H 1 − = (24)

( ) 1 − = equiv

T equiv equiv H H A (25)

The DOPs are then calculated from the trace of the Aequiv matrix. The Horizontal and Vertical DOP during the static test is presented in the results section.

Page 8: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

4. Fault Detection

This paper makes use of two fault detection approaches. The baseline least­squares scheme uses a standard parity RAIM scheme proposed by Brown (1994). The recursive filters use a position domain based fault detection approach based on the work of Brenner (1995) and Young (2003). This approach was chosen because the recursive nature of the Kalman filter does not have high sensitivity to ramp faults. If it assumed that only one satellite fault can occur during the operation, multiple filters can be used with each filter omitting at least one of the measurements. Therefore, there should always be at least one filter which does not incorporate the fault.

4.1. Test Statistic and Threshold

The test statistic is a scalar value which is calculated from the filter outputs and compared to a threshold. If the test statistic exceeds the threshold, a fault is declared. The test statistic is formed by differencing the outputs of each sub­filter to a filter which incorporates all measurements. The separation vector for each j th sub­filter is:

j k k k k j , | | ˆ ˆ x x β − = (26)

The test statistic, Гj, is the sum­square of the separation vector:

j T j j β β = Γ (27)

The test statistic covariance is then calculated as:

k k x j k k x j | , , | , P P B − = (28)

Accurate covariance estimation is very important here, since it is used directly to calculate the separation covariance. This separation covariance is subsequently used to calculate the detection threshold and protection level. If the state covariance estimate were underestimated, this would lead to threshold and protection levels which were too low, leading to a high number of false alarms or misleading information events.

The detection threshold for each sub­filter, TDj, is a scalar calculated by:

j FA j K TD B λ = (29)

Since the test statistic is chi­square distributed with two degrees of freedom, KFA is calculated from the inverse chi­square distribution as a function of the probability of False­Alarm. This value is scaled by λ Bj which is the largest eigenvalue of Bj.

4.2. Protection Level

The protection level is a fundamental measure of system integrity. This paper is concerned primarily with the Horizontal Protection Level (HPL) which describes a radius in metres around the aircraft containing the true position. The protection level comprises of a combination of the fault­free protection level (HPLH0) and the fault­in­progress protection

Page 9: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

level (HPLH1). HPLH1 is not calculated in this analysis, since it is not expected to be dominant (RTCA, 2001). The HPLH0 for each sub­filter is calculated from the sum of the threshold, TDj, and the fault­free error, Aj. This is depicted graphically in Figure 1 for a 1­ dimensional case and is justified by the fact that at detection, the j­th filter (which does not contain the fault) will have an error described by Aj. Note that TDj and Aj do not always act in the same direction (horizontally), so the HPL is conservative.

j x MD j K A , P λ = (30)

Aj is the contribution to HPL due to normal pseudorange error, and hence is normally distributed. KMD is therefore calculated from the inverse normal distribution as a function of the probability of missed­detection. KMD is scaled by λ Pj which is the largest eigenvalue of Px,j.

j j j A TD HPL + = (31)

The maximum HPL of each sub filter is taken as the fault­free hypothesis protection level.

j H HPL HPL max 0 = (32)

Figure 1: Calculation of Protection Level

5. Experimental Setup

5.1. Static Test

The first test carried out was a 24 hour static trial conducted at QUT in Brisbane. Data was sampled at 1 second epochs using a Novatel OEMV­1 L1 receiver and processed in Matlab. The real­time broadcast ephemeris was used to process the data and standard real­time ionosphere and troposphere error corrections were applied.

Page 10: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

A snapshot least­squares residual (LSQ) solution and an Extended Kalman Filter (EKF) solution were computed for comparison with the UKF. For the integrity, a Parity RAIM scheme (Brown, 1994) was chosen as a baseline fault detection scheme for the LSQ solution and the same integrity scheme as presented earlier was used for the EKF.

Figure 2 shows the variation of DOP during the static test. HDOP is the Horizontal Dilution of Precision and VDOP is the Vertical Dilution of Precision. Note the poor geometry conditions which occur at the end of the 9 th hour and continue through to approximately the 12 th hour. During this time, poorer estimation accuracy should be expected.

Figure 2: Dilution of Precision during Static Test

5.2. Dynamic Test

For the dynamic test, a Spirent GSS6550 GNSS Signal Simulator was used to generate a trajectory typical of a general aviation aircraft flying a holding pattern and approach to landing. This was a standard IFR holding pattern with 1 minute legs and rate 1 turns. The duration of this test was approximately 23 minutes. The horizontal and vertical profile is depicted in Figure 3. The same receiver as used during the static test was used to take the GPS raw measurements. The measurements were then processed in Matlab.

Baseline LSQ and EKF solutions were also computed for the dynamic case for comparison.

Poor Geometry

Page 11: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

Figure 3: Dynamic Track Used in Simulation

6. Results

This section presents the results in four parts. The static results are presented in sections 6.1 and 6.2. The dynamic test results are shown in sections 6.3 and 6.4.

6.1. Static Test Estimation Accuracy

In order to assess the relative accuracy of the UKF estimator, the RMS errors were calculated in 1 hour blocks over the 24 hour period. The results are presented in Figure 4, Figure 5 and Figure 6 for the North, East and Down channels respectively.

Figure 4: North RMS Variation over 24 Hours (Static)

Page 12: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

Figure 5: East RMS Variation over 24 Hours (Static)

Figure 6: Vertical RMS Variation over 24 Hours (Static)

From these figures it can be seen that the recursive filters are sensitive to spurious un­ modelled noise in the GPS measurements. This can be overcome to a degree by pre­filtering the data, or inflating the measurement noise to account for un­modelled effects. These points also coincide with the poor DOP conditions seen in Figure 2. Overall, there is no significant difference to be noted between the three filtering strategies. The RMS errors tabulated in Table 2 show the recursive solutions exhibiting slightly worse errors than the least squares (note that these results do not include the initialisation of the filter, which is included during the first hour of the figures above).

North East Down 3DRMS % Change LSQ 3.51m 2.85m 17.11m 17.70m EKF 3.54m 3.00m 17.42m 18.03m +1.87% UKF 3.53m 2.95m 17.24m 17.84m +0.82%

Table 2: RMS Error Comparison – Static

Examining the covariance estimates, shown in Table 3, it is clear that the recursive solutions

Page 13: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

both exhibit much lower covariance than the least squares. This is expected since they incorporate much more information about the state in the process model and by using past measurements. Importantly, the overall average 3D covariance for the UKF was 2m larger than the EKF. The 2­σ covariance estimate for the UKF (21.02m) bounds the 3DRMS error by 3.18m, however the EKF 2­σ covariance estimate (17.3m) underestimates the actual 3DRMS error by 0.73m. This result highlights the better reliability of the UKF covariance estimate as an indicator of the actual 3DRMS error, although it is at the sacrifice of being slightly conservative.

North East Down 3D % Change LSQ 5.82m 4.75m 11.89m 14.31m EKF 3.15m 5.85m 5.55m 8.65m ­39.55% UKF 3.47m 7.18m 6.84m 10.51m ­26.55%

Table 3: Standard Deviation Estimate (1­σ) Comparison ­ Static

To summarise, the initial comparison of the UKF and EKF show that the estimation accuracy benefit is negligible, however the improved covariance estimate is significant.

6.2. Static Test Protection Level

This section presents the results of the protection level calculated over a 24 hour period. Figure 7 and Figure 8 are Error­Protection level plots, commonly referred to as Stanford plots. The diagram is essentially a two­dimensional histogram where the colour intensity represents the percentage of samples which fall in each region. If any samples fall on the right hand side of the diagonal (i.e. the error has exceeded the protection level) without a fault being declared, this is termed Misleading Information (MI). The Horizontal Alert Limit (HAL) is represented by the horizontal black line, and the HPL is required to be less than this if the operation is to continue. If the error exceeds the HAL, but the HPL is less than the HAL, it is termed Hazardously Misleading Information (HMI).

Figure 7: Horizontal Protection Level for UKF Solution

Figure 7 clearly shows good margin between the error and protection level throughout the day for the UKF. However for the EKF, shown in Figure 8, there is much less margin, and the

Page 14: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

error slightly exceeds the protection level for brief periods. This result clearly demonstrates the superior reliability of the UKF based approach.

Figure 8: Horizontal Protection Level for EKF Solution

6.3. Dynamic Test Estimation Accuracy

The results for the dynamic test accuracy are presented in Table 4. Once again, there is no significant difference in accuracy between the Least­squares, and the two recursive approaches. Note that it is not possible to directly compare the accuracy results of the static and dynamic test, since the dynamic test was conducted on a signal simulator, with many of the error sources set to zero. Another important consideration is that this data set is only 23 minutes, which does not provide a large variation in satellite geometry to gain a realistic picture of long term errors.

North East Down 3DRMS % Change LSQ 0.18m 0.21m 0.59m 0.65m EKF 0.18m 0.21m 0.61m 0.67m +2.79% UKF 0.18m 0.21m 0.59m 0.65m +0.00%

Table 4: RMS Error Comparison ­ Dynamic

The covariance results are similarly inconclusive due to the short data set. In this case, the EKF covariance is slightly larger than the UKF. In order to properly validate this result, a much longer dynamic trial would be needed to confirm that the results approach the results obtained during the static scenario.

North East Down 3D % Change LSQ 4.92m 2.11m 9.39m 10.84m EKF 0.63m 3.39m 2.99m 4.56m ­57.9% UKF 0.62m 2.84m 2.75m 4.00m ­63.1%

Table 5: Standard Deviation Estimate (1­σ) Comparison ­ Dynamic

6.4. Dynamic Test Protection Level

Page 15: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

This section presents the results of the protection level calculation from the dynamic test. Once again it is shown that the UKF based HPL is slightly larger than the EKF based result, and both improve on the snapshot algorithm. This demonstrates that the results obtained in the static trials are valid for the dynamic case, although a longer dynamic test with all of the GPS errors included is required to make a conclusive assessment.

Figure 9: Horizontal Protection Level for Dynamic Test

It is noted that at approximately 15 minutes into the simulation an increase in protection level of 5m occurs on the UKF and EKF solutions. The LSQ solution experiences the same increase, but with a much greater magnitude at 8m. The cause for this increase is a change in the set of satellites being tracked, which results in a poorer geometry for the purposes of fault detection.

7. CONCLUSIONS

This paper has presented a comparison of the SPKF with the established approaches to GPS navigation of the EKF and Least­squares. Implementation of the SPKF using the Unscented Kalman Filter is straightforward, and in many respects is conceptually simpler than the EKF implementation. Despite having to track a large number of sigma points, speed was not noticeably faster or slower than the EKF, although formal measurements were not carried out for the Matlab implementation. Speed is not considered an impediment to real­time operation.

In terms of accuracy, the SPKF is not significantly different to the EKF or Least­squares, and this result is consistent with results presented elsewhere (Wendel et al., 2006). Claims that the SPKF is significantly more accurate than the EKF were not realised in these experiments, with the EKF accuracy being only 1­3% worse than the SPKF for the tests undertaken. However, significant differences were noted with the covariance estimation. The mean covariance of the SPKF was nearly 2m greater than the EKF over the 24 hour static trial. This result was not noted in the short dynamic trial, however a much longer trail would be required to confirm this. Whilst it is difficult to empirically validate the SPKF as being a more accurate measure of covariance, given the many assumptions made regarding GPS errors, analytically it is a more robust approach since important information regarding the interaction

Page 16: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

of errors in each state is not lost in a linearisation process. Since the fault detection threshold and protection level calculations rely on this critical information, the SPKF yields a more robust and reliable fault detection scheme. This hypothesis was demonstrated in the experimental results.

Based on the results presented in this paper, the SPKF is recommended over the EKF for implementing fault detection schemes where recursive filtering is required or desired as it has been shown to provide a more accurate covariance estimate for the tests under consideration. The result is a more reliable integrity protection level estimate which ensures safety of flight using the GPS. Future work will consist of validating these results for multi­sensor systems during comprehensive dynamic trials including flight testing.

ACKNOWLEDGEMENTS

The authors would like to acknowledge and thank the excellent support by Airservices Australia, GPSat Systems Australia. This research was supported under the Australian Research Council's Linkage Projects funding scheme (project number LP0455566).

REFERENCES

Bar­Shalom, Y., Li, X.R. and Kirubarajan, T., 2001. Estimation with Applications to Tracking and Navigation. John Wiley & Sons, Inc.

Brenner, M., 1995. Integrated GPS/Inertial Fault Detection Availability, Proceedings of the Institute of Navigation's ION GPS­95, Palm Springs, CA.

Brown, R.G., 1994. GPS RAIM: Calculation of Thresholds & Protection Radius Using Chi­ Square Methods ­ A Geometric Approach. RTCA Paper No. 49194/SC159­584, Radio Technical Commission for Aeronautics (RTCA) Inc., Washington DC.

Brown, R.G. and Hwang, P., 1997. Introduction to Random Signals and Applied Kalman Filtering. John Wiley \& Sons, New York.

Julier, S.J. and Uhlmann, J.K., 1997. A new extension of the Kalman filter to nonlinear systems, The 11th Internaiontal Symposium on Aerospace/Defence Sensing, Simulation and Controls, Orlando, Florida.

Julier, S.J. and Uhlmann, J.K., 2004. Unscented Filtering and Nonliner Estimation. Proceedings of the IEEE, Vol. 92(No. 3): 401­422.

Julier, S.J.U., Jeffrey K., 2004. Unscented Filtering and Nonliner Estimation. Proceedings of the IEEE, Vol. 92(No. 3): 401­422.

Murphy, T., 2000. Ground Based Regional Augmentation Systems Architectures and Performance, Airservices Australia, Canberra.

Parkinson, B.W., Spilker Jr., J.J., Axelrad, P. and Enge, P. (Editors), 1996. The Global Positioning System: Theory and Applications; Volume I & II. Progress in Astronautics and Astronautics, 163. American Institute of Aeronautics and Astronautics, Inc., Washington.

RTCA, 2001. DO­229C Minimum Operational Performance Standards for Global Positioning System / Wide Area Augmentation System Airborne Equipment, Radio Technical Commission for Aeronautics, Washington.

van der Merwe, R.W., Eric A, 2004. Sigma­Point Kalman Filters for Integrated Navigation, 60th Annual Meeting of the Institute of Navigation, Dayton, Ohio.

Wendel, J., Metzger, J., Moenikes, R., Maier, A. and Trommer, G., 2006. A Performance Compairson of Tightly Coupled GPS/INS Navigation Systems based on Extended and Sigma Point Kalman Filters. Navigation: Journal of The Institute of Navigation,

Page 17: Sigma Point Kalman Filters for GPS Navigation with ...eprints.qut.edu.au/11143/1/p124.pdf · Sigma Point Kalman Filters for GPS Navigation with ... calculate the Kalman gain could

53(1): 21­31. Young, R.S. and McGraw, G.A., 2003. Fault Detection and Exclusion Using Normalized

Solution Separation and Residual Monitoring Methods. NAVIGATION: Journal of the Institute of Navigation, Vol. 50(No. 3): 151­169.