# US 6,731,237 B2 · Deeply-integrated adaptive GPS-based navigator with extended-range code tracking

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 6,731,237 B2
- Document ID: US6731237B2
- Status: Granted
- Kind: B2
- Application number: 10/010,093
- Filed: 2001-12-03
- Published: 2002-09-12
- Granted: 2004-05-04
- Earliest claimed: 1999-11-09
- Assignees: The Charles Stark Draper Laboratory, Inc.
- Inventors: Donald E. Gustafson; John R. Dowdle; John M. Elwell, Jr.
- Web page: https://patentgrep.com/patent/US6731237B2

## CPC

- G01S 19/26: involving a sensor measurement for aiding acquisition or tracking
- G01C 21/1652: {with ranging devices, e.g. LIDAR or RADAR}
- G01S 19/21: Interference related issues {; Issues related to cross-correlation, spoofing or other methods of denial of service}
- G01S 19/47: the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
- G01S: RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01C: MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY (measuring liquid level G01F; radio navigation, determining distance or velocity by use of propagation effects, e.g. Doppler effects, propagation time, of radio waves, analogous arrangements using other waves G01S)

## Abstract

A system and method for generating a multidimensional navigation solution utilizes Global Positioning System (GPS) data to obtain highly reliable and accurate navigational solutions in high interference and dynamic environments, at a performance level which has been heretofore unattainable. Additional sensors such as inertial (gyros and accelerometers), altimeters, radars, etc. may be employed in a deeply integrated configuration. The approach taken in the present invention differs from that of previous techniques through its exploitation of nonlinear filtering methods; as a result, the navigation system architecture and processes employed yield significant improvements in navigation system performance, both in code tracking and reacquisition, and in carrier tracking and reacquisition. The improvements are particularly significant at low signal/noise ratios, where conventional approaches are especially susceptible to loss of code lock or carrier lock.

## Claims

### Claim 1

A system for determining a multidimensional navigation state for a navigation platform based on radio navigation data transmitted by external terminals comprising:
a radio navigation data receiver for receiving and amplifying said radio navigation data embedded in noise;
a bank of correlators for extracting said radio navigation data from said noise over a range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of a degree of correlation for each correlator between said radio navigation data and a known internal replica signal, said correlator output functions being non-triangular M code correlator output functions;
an estimator for estimating the radio navigation data signal power and noise power from the correlator output functions; and
a measurement update unit including a nonlinear filter, said measurement update unit for updating the navigation state based on conditional moments of the navigation state calculated as a function of the estimated radio navigation data signal power and noise power, and the correlator outputs.

### Claim 2 (depends on 1)

The system of claim 1 further comprising an inertial sensor unit for generating inertial data indicative of the inertial behavior of the platform and wherein the conditional moments of the navigation state are further calculated as a function of the inertial data.

### Claim 3 (depends on 1)

The system of claim 1 wherein the radio navigation data comprises Global Positioning System (GPS) data, and wherein the radio navigation data receiver comprises a GPS receiver.

### Claim 4 (depends on 1)

The system of claim 1 further comprising a propagator for applying sensed inertial data to a dynamic model based on a recently updated navigation state to generate updated inertial data provided to said measurement update unit.

### Claim 5 (depends on 1)

The system of claim 1 wherein the multidimensional navigation state includes information selected from the group consisting of position, velocity, attitude, receiver clock errors, inertial sensor errors, propagation delays, and satellite errors.

### Claim 6 (depends on 1)

The system of claim 1 wherein the conditional moments are calculated using a set of correlator moments which are calculated with said nonlinear filter, and which represent statistical expectations of nonlinear functions of line-of-sight position error.

### Claim 7 (depends on 1)

The system of claim 1 wherein the conditional moments are calculated to include measurement non-linearities in the correlator output functions.

### Claim 8 (depends on 1)

The system of claim 1 wherein the bank of correlators comprises an extended-range bank of correlators for extracting said radio navigation data from said noise over an extended range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator in the extended-range bank between said radio navigation data and a known internal replica signal.

### Claim 9 (depends on 1)

The system of claim 1 wherein said estimator comprises:
a signal power estimator for determining radio navigation data signal power based on correlator moments; and
a noise power estimator for estimating noise power based on the correlator moments and said signal power estimate.

### Claim 10

An estimator for estimating signal and noise power in a system for determining a multidimensional navigation state for a navigation platform based on radio navigation data embedded in noise, said radio navigation data signal being received by a radio navigation data receiver including a bank of correlators for extracting said radio navigation data from said noise over a range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output function indicative of degree of correlation for each correlator between said radio navigation data and a known replica signal, said estimator comprising:
a signal power estimator for determining radio navigation data signal power based on correlator moments;
a noise power estimator for estimating noise power based on the correlator moments and said signal power estimate; and
a nonlinear filter for calculating said correlator moments, which represent statistical expectations of nonlinear functions of line-of-sight position errors, said correlator moments being calculated according to the equation: M c , k ( s ) = ∫ - ∞ ∞ ⁢ ⁢ ⅆ τ ⁡ ( α ⁡ ( τ , k ) ) s ⁢ R c 2 ⁡ ( τ ) ⁢ ⁢ P α ⁡ ( τ , k , j ) ⁢ ⁢ where α ⁡ ( τ , k ) = k ⁢ ⁢ Δ + τ ⁢ ⁢ and P α ⁡ ( τ , k , j ) = ⅇ - ( α ⁡ ( τ , k ) ) 2 2 ⁢ ⁢ P los ⁡ ( j ) 2 ⁢ ⁢ π ⁢ ⁢ P los ⁡ ( j ) .

### Claim 11 (depends on 10)

The estimator of claim 10 further comprising a bias estimator for determining a bias estimate of each correlator in the bank, and wherein the signal power estimate and noise power estimate are further based on the bias estimate.

### Claim 12 (depends on 11)

The estimator of claim 11 wherein the bias estimator comprises:
a smoothing function for updating the bias estimate of each correlator according to a smoothing time constant; and
a minimum function for determining the bias estimate as the minimum value of the smoothed bias estimates.

### Claim 13 (depends on 10)

The estimator of claim 10 wherein said correlator moments comprise a first conditional moment comprising a conditional mean.

### Claim 14 (depends on 10)

The estimator of claim 10 wherein the noise power estimate comprises a vector, such that an independent noise power estimate is calculated for each correlator in the correlator bank.

### Claim 15 (depends on 10)

The estimator of claim 10 wherein the bank of correlators comprises an extended-range bank of correlators for extracting said radio navigation data from said noise over an extended range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator in the extended-range bank between said radio navigation data and a known internal replica signal.

### Claim 16 (depends on 10)

The estimator of claim 10 further comprising an inertial sensor unit for generating inertial data indicative of the inertial behavior of the platform and wherein the conditional moment of the navigation state is further calculated as a function of the inertial data.

### Claim 17 (depends on 10)

The estimator of claim 10 wherein the radio navigation data comprises Global Positioning System (GPS) data, and wherein the radio navigation data receiver comprises a GPS receiver.

### Claim 18

A measurement update unit for updating a navigation state and error covariances of the navigation state of a navigation platform based on radio navigation data transmitted by external terminals and embedded in noise, said radio navigation data signal being received by a radio navigation data receiver including a bank of correlators for extracting said radio navigation data from said noise over a range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator between said radio navigation data and a known replica signal, said correlator output functions being non-triangular M code correlator output functions, said measurement update unit comprising:
a state update unit including a nonlinear filter, said state update unit for updating the navigation state as a function of the correlator output functions weighted by state gain functions, the state gain functions being based on a set of correlator moments, which are calculated with said nonlinear filter and which represent statistical expectations of nonlinear functions of line-of-sight position error, a propagation of a previous navigation state, and an error covariance matrix; and
an error covariance matrix update unit for updating the error covariances of the navigation state based on the correlator moments.

### Claim 19 (depends on 18)

The measurement update unit of claim 18 wherein the propagation of the previous navigation state comprises an inertial data propagation.

### Claim 20 (depends on 18)

The measurement update unit of claim 18 wherein the statistical expectations of nonlinear functions of the line-of-sight position error are functions of the error covariances of the navigation state and the noise.

### Claim 21 (depends on 18)

The measurement update unit of claim 18 wherein the state gain functions and error covariances of the navigation state are further based on estimates of the radio navigation data signal power and noise power.

### Claim 22 (depends on 18)

The measurement update unit of claim 18 wherein said radio navigation data signal power estimate and noise power estimate are calculated by an estimator comprising:
a signal power estimator for determining radio navigation data signal power based on the correlator moments; and
a noise power estimator for estimating noise power based on the correlator moments and said signal power estimate.

### Claim 23 (depends on 18)

The measurement update unit of claim 18 wherein the bank of correlators comprises an extended-range bank of correlators for extracting said radio navigation data from said noise over an extended range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator in the extended-range bank between said radio navigation data and a known internal replica signal.

### Claim 24 (depends on 18)

The measurement update unit of claim 18 wherein the radio navigation data comprises Global Positioning System (GPS) data, and wherein the radio navigation data receiver comprises a GPS receiver.

### Claim 25 (depends on 18)

The measurement update unit of claim 18 wherein the line-of-sight error comprises the difference between a measured and an estimated line-of-sight range between the receiver and the external terminals.

### Claim 26

A measurement update unit for updating a navigation state and error covariances of the navigation state of a navigation platform based on radio navigation data carried on a radio navigation data carrier signal embedded in noise, said radio navigation data signal being received by a radio navigation data receiver including a bank of correlators for extracting said radio navigation data from said noise over a range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator between said radio navigation data and a known replica signal, said correlator output functions being non-triangular M code correlator output functions, said bank of correlators including a prompt correlator for processing radio navigation data signals near the radio navigation data carrier frequency, said measurement update unit comprising:
a state update unit including a nonlinear filter, said state update unit for updating the navigation state as a function of the prompt correlator output function weighted by state gain functions, the state gain functions being based on a set of correlator moments which are calculated with said nonlinear filter and which represent statistical expectations of nonlinear functions of line-of-sight position error, and an error covariance matrix;
an error covariance matrix update unit for updating the error covariances of the navigation state based on the correlator moments; and
an integrity management unit for maintaining the integrity of the navigation state and the error covariances.

### Claim 27 (depends on 26)

The measurement update unit of claim 26 wherein the state gain functions are further based on estimates of the radio navigation data carrier signal power and noise power, a data bit estimate, an inertial data propagation of a previous navigation state and an error covariance matrix.

### Claim 28 (depends on 26)

The measurement update unit of claim 26 wherein the noise power is calculated based on the average noise power in at least two non-prompt correlator output functions.

### Claim 29 (depends on 26)

The measurement update unit of claim 26 wherein the state update unit and error covariance matrix update unit operate linearly for a relatively large radio navigation data carrier signal power to noise power ratio and operate nonlinearly for a relatively small radio navigation data carrier signal power to noise power ratio.

### Claim 30 (depends on 26)

The measurement update unit of claim 26 wherein the bank of correlators comprises an extended-range bank of correlators for extracting said radio navigation data from said noise over an extended range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator in the extended-range bank between said radio navigation data and a known internal replica signal.

### Claim 31

A measurement update unit for updating a navigation state and error covariances of the navigation state of a navigation platform based on radio navigation data embedded in noise, said radio navigation data signal being received by a radio navigation data receiver including a bank of correlators for extracting said radio navigation data from said noise over a range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator between said radio navigation data and a known replica signal, said correlator output functions being non-triangular M code correlator output functions, said measurement update unit comprising:
a state update unit for updating the navigation state as a function of the correlator output functions weighted by state gain functions, the state gain functions being based on a set of correlator moments which are statistical expectations of nonlinear functions of line-of-sight position error variance, a propagation of a previous navigation state and an error covariance matrix;
an error covariance matrix update unit for updating the error covariances of the navigation state based on the correlator moments; and
an integrity management unit for maintaining the integrity of the navigation state and the error covariances.

### Claim 32 (depends on 31)

The measurement update unit of claim 31 wherein the propagation of the previous navigation state comprises an inertial data propagation.

### Claim 33 (depends on 31)

The measurement update unit of claim 31 wherein the state gain functions and error covariances of the navigation state are further based on estimates of the radio navigation data signal power and noise power.

### Claim 34 (depends on 31)

The measurement update unit of claim 31 wherein the line-of-sight position error is a function of the error covariances of the navigation state and the noise, and wherein the integrity management unit monitors and limits the signal and noise power estimate values.

### Claim 35 (depends on 31)

The measurement update unit of claim 31 wherein the integrity management unit limits growth rate of the error covariances.

### Claim 36 (depends on 35)

The measurement update unit of claim 35 wherein the inertial data is sensed by inertial data sensors and wherein the growth of the error covariances are limited to an upper bound based on estimated accuracy of the inertial sensors.

### Claim 37 (depends on 31)

The measurement update unit of claim 31 wherein the integrity management unit monitors and maintains the positive-definiteness of the error covariance matrix.

### Claim 38 (depends on 31)

The measurement update unit of claim 31 wherein the integrity management unit limits estimated change of the navigation state.

### Claim 39

A method for determining a multidimensional navigation state for a navigation platform based on radio navigation data transmitted by external terminals comprising:
receiving and amplifying said radio navigation data embedded in noise at a radio navigation data receiver;
extracting said radio navigation data from said noise over a range of delay error at a bank of correlators, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator between said radio navigation data and a known internal replica signal, said correlator output functions being non-triangular M code correlator output functions;
estimating the radio navigation data signal power and noise power from the correlator output functions;
updating the navigation state based on the conditional moments of the navigation state calculated using a set of correlator moments as a function of the estimated radio navigation data signal power and noise power, and the correlator outputs;
calculating said correlator moments, which and represent statistical expectations of nonlinear functions of line-of-sight position errors, with a nonlinear filter.

### Claim 40 (depends on 39)

The method of claim 39 further comprising generating inertial data indicative of the inertial behavior of the platform and wherein the conditional moments of the navigation state are further calculated as a function of the inertial data.

### Claim 41 (depends on 39)

The method of claim 39 wherein the radio navigation data comprises Global Positioning System (GPS) data, and wherein the radio navigation data receiver comprises a GPS receiver.

### Claim 42 (depends on 39)

The method of claim 39 further comprising applying a dynamical model to the navigation state to generate a propagated navigation state to be updated.

### Claim 43 (depends on 42)

The method of claim 42 further comprising applying sensed inertial data indicative of the inertial behavior of the platform to the dynamical model.

### Claim 44 (depends on 39)

The method of claim 39 further comprising updating the navigation state based on auxiliary sensor data.

### Claim 45 (depends on 44)

The method of claim 44 wherein the auxiliary data is selected from the group of data types consisting of inertial data, altimeter data, radar data, and electro-optical device data.

### Claim 46 (depends on 39)

The method of claim 39 wherein the multidimensional navigation state includes information selected from the group consisting of position, velocity, attitude, receiver clock errors, inertial sensor errors, propagation delays, and satellite errors.

### Claim 47 (depends on 39)

The method of claim 39 wherein said conditional moments are calculated to include measurement non-linearities in the correlator output functions.

### Claim 48 (depends on 47)

The method of claim 47 wherein the bank of correlators comprises an extended-range bank of correlators for extracting said radio navigation data from said noise over an extended range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator in the extended-range bank between said radio navigation data and a known internal replica signal.

### Claim 49 (depends on 39)

The method of claim 39 wherein estimating comprises:
estimating radio navigation data signal power based on the correlator moments; and
estimating noise power estimator for estimating noise power based on the correlator moments and said signal power estimate.

### Claim 50

A method for estimating signal and noise power in a system for determining a multidimensional navigation state for a navigation platform based on radio navigation data embedded in noise, said radio navigation data signal being received by a radio navigation data receiver including a bank of correlators for extracting said radio navigation data from said noise over a range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator between said radio navigation data and a known replica signal, comprising:
calculating correlator moments, which and represent statistical expectations of nonlinear functions of line-of-sight position errors, with a nonlinear filter;
determining radio navigation data signal power based on the correlator moments; and
estimating noise power based on the correlator moments and said signal power estimate;
wherein said correlator moments are calculated according to the equation: M c , k ( s ) = ∫ - ∞ ∞ ⁢ ⁢ ⅆ τ ⁡ ( α ⁡ ( τ , k ) ) s ⁢ R c 2 ⁡ ( τ ) ⁢ ⁢ P α ⁡ ( τ , k , j ) ⁢ ⁢ where α ⁡ ( τ , k ) = k ⁢ ⁢ Δ + τ ⁢ ⁢ and P α ⁡ ( τ , k , j ) = ⅇ - ( α ⁡ ( τ , k ) ) 2 2 ⁢ ⁢ P los ⁡ ( j ) 2 ⁢ ⁢ π ⁢ ⁢ P los ⁡ ( j ) .

### Claim 51 (depends on 50)

The method of claim 50 further comprising determining a bias estimate of each correlator in the bank, and wherein the signal power estimate and noise power estimate are further based on the bias estimate.

### Claim 52 (depends on 51)

The method of claim 51 further comprising determining the bias estimate according to the steps of:
updating the bias estimate of each correlator according to a smoothing time constant; and determining the bias estimate as the minimum value of the smoothed bias estimates.

### Claim 53 (depends on 50)

The method of claim 50 wherein said correlator moments each comprise a first conditional moment comprising a conditional mean.

### Claim 54 (depends on 50)

The method of claim 50 wherein the noise power estimate comprises a vector, such that an independent noise power estimate is calculated for each correlator in the correlator bank.

### Claim 55 (depends on 50)

The method of claim 50 wherein the bank of correlators comprises an extended-range bank of correlators for extracting said radio navigation data from said noise over an extended range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator in the extended-range bank between said radio navigation data and a known internal replica signal.

### Claim 56 (depends on 50)

The method of claim 50 further comprising generating inertial data indicative of the inertial behavior of the platform and wherein the correlator moments are further calculated as a function of the inertial data.

### Claim 57 (depends on 50)

The method of claim 50 wherein the radio navigation data comprises Global Positioning System (GPS) data, and wherein the radio navigation data receiver comprises a GPS receiver.

### Claim 58

A method for updating a navigation state and error covariances of the navigation state of a navigation platform based on radio navigation data transmitted by external terminals and embedded in noise, said radio navigation data signal being received by a radio navigation data receiver including a bank of correlators for extracting said radio navigation data from said noise over a range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator between said radio navigation data and a known replica signal, said correlator output functions being non-triangular M code correlator output functions, the method comprising:
calculating correlator moments, which represent statistical expectations of nonlinear functions of line-of sight position errors, a propagation of a previous navigation state and an error covariances matrix, with a nonlinear filter;
updating the navigation state as a function of the correlator output functions weighted by state gain functions, the state gain functions being based on a set of said correlator moments; and
updating the error covariances of the navigation state based on the correlator moments.

### Claim 59 (depends on 58)

The method of claim 58 wherein the propagation of a previous navigation state comprises an inertial data propagation.

### Claim 60 (depends on 58)

The method of claim 58 wherein the line-of-sight position error is a function of the error covariances of the navigation state and the noise.

### Claim 61 (depends on 58)

The method of claim 58 wherein the state gain functions and error covariances of the navigation state are further based on estimates of the radio navigation data signal power and noise power.

### Claim 62 (depends on 58)

The method of claim 58 wherein said radio navigation data signal power estimate and noise power estimate are calculated by:
estimating radio navigation data signal power based on the correlator moments; and
estimating noise power based on the correlator moments and said signal power estimate.

### Claim 63 (depends on 58)

The method of claim 58 wherein the bank of correlators comprises an extended-range bank of correlators for extracting said radio navigation data from said noise over an extended range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator in the extended-range bank between said radio navigation data and a known internal replica signal.

### Claim 64 (depends on 58)

The method of claim 58 wherein the radio navigation data comprises Global Positioning System (GPS) data, and wherein the radio navigation data receiver comprises a GPS receiver.

### Claim 65 (depends on 58)

The method of claim 58 wherein the line-of-sight error comprises the difference between a measured and an estimated line-of-sight range between the receiver and the external terminals.

### Claim 66

A method for updating a navigation state and error covariances of the of a navigation platform based on radio navigation data carried on a radio navigation data carrier signal embedded in noise, said radio navigation data signal being received by a radio navigation data receiver including a bank of correlators for extracting said radio navigation data from said noise over a range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator between said radio navigation data and a known replica signal, said correlator output functions being non-triangular M code correlator output functions, said bank of correlators including a prompt correlator for processing radio navigation data signals near the radio navigation data cater frequency, the method comprising:
updating the navigation state as a function of the prompt correlator output function weighted by state gain functions, the state gain functions being based on a set of correlator moments which are calculated with a nonlinear filter and which represent statistical expectations of nonlinear functions of line-of-sight position error, and an error covariance matrix; and
updating the error covariances of the navigation state based on said state gain functions.

### Claim 67 (depends on 66)

The method of claim 66 wherein the state gain functions are further based on estimates of the radio navigation data carrier signal power and noise power, a data bit estimate and an error covariance matrix.

### Claim 68 (depends on 66)

The method of claim 66 wherein the noise power is calculated based on the average noise power in at least two non-prompt correlator output functions.

### Claim 69 (depends on 66)

The method of claim 66 wherein the state update unit and error covariance matrix update unit operate linearly for a relatively large radio navigation data carrier signal power to noise power ratio and operate non-linearly for a relatively small radio navigation data carrier signal power to noise power ratio.

### Claim 70 (depends on 66)

The method of claim 66 wherein the bank of correlators comprises an extended-range bank of correlators for extracting said radio navigation data from said noise over an extended range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator in the extended-range bank between said radio navigation data and a known internal replica signal.

### Claim 71

A method for updating a navigation state and error covariances of the navigation state of a navigation platform based on radio navigation data embedded in noise, said radio navigation data signal being received by a radio navigation data receiver including a bank of correlators for extracting said radio navigation data from said noise over a range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator between said radio navigation data and a known replica signal, said correlator output functions being non-triangular M code correlator output functions, the method comprising:
updating the navigation state as a function of the correlator output functions weighted by state gain functions, the state gain functions being based on a set of correlator moments which are statistical expectations of nonlinear functions of line-of-sight position error, a propagation of a previous navigation state, and an error covariance matrix;
updating the error covariances of the navigation state based on the correlator moments; and
maintaining the integrity of the navigation state and the error covariances.

### Claim 72 (depends on 71)

The method of claim 71 wherein the propagation of the previous navigation state comprises an inertial data propagation.

### Claim 73 (depends on 72)

The method of claim 72 further comprising sensing the inertial data by inertial data sensors and limiting the growth of the error covariances to an upper bound based on estimated accuracy of the inertial sensors.

### Claim 74 (depends on 71)

The method of claim 71 wherein the state gain functions and error covariances of the navigation state are further based on estimates of the radio navigation data signal power and noise power.

### Claim 75 (depends on 71)

The method of claim 71 wherein the line-of-sight position error is a function of the error covariances of the navigation state and the noise, and wherein maintaining comprises monitoring and limiting the signal and noise power estimate values.

### Claim 76 (depends on 71)

The method of claim 71 wherein maintaining the integrity further comprises limiting growth rate of the error covariances.

### Claim 77 (depends on 71)

The method of claim 71 wherein maintaining integrity further comprises monitoring and maintaining the positive-definiteness of the error covariance matrix.

### Claim 78 (depends on 71)

The method of claim 71 wherein maintaining integrity further comprises limiting estimated change of the navigation state.

### Claim 79

A system for determining a multidimensional navigation state for a navigation platform based on radio navigation data transmitted by external terminals comprising:
a radio navigation data receiver for receiving and amplifying said radio navigation data embedded in noise;
an extended-range bank of correlators for extracting said radio navigation data from said noise over an extended range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of a degree of correlation for each correlator in the extended-range bank between said radio navigation data and a known internal replica signal;
an estimator for estimating the radio navigation data signal power and noise power from the correlator output functions; and
a measurement update unit including a nonlinear filter, said measurement update unit for updating the navigation state based on a calculation of the conditional moments of the navigation state using a set of correlator moments, the calculation being based on the estimated radio navigation data signal power and noise power and the correlator output functions;
wherein said correlator moments are calculated with said nonlinear filter and represent statistical expectations of nonlinear functions of the line-of-sight position errors, said correlator moments being calculated according to the equation. M c , k ( s ) = ∫ - ∞ ∞ ⁢ ⁢ ⅆ τ ⁡ ( α ⁡ ( τ , k ) ) s ⁢ R c 2 ⁡ ( τ ) ⁢ ⁢ P α ⁡ ( τ , k , j ) ⁢ ⁢ where α ⁡ ( τ , k ) = k ⁢ ⁢ Δ + τ ⁢ ⁢ and P α ⁡ ( τ , k , j ) = ⅇ - ( α ⁡ ( τ , k ) ) 2 2 ⁢ ⁢ P los ⁡ ( j ) 2 ⁢ ⁢ π ⁢ ⁢ P los ⁡ ( j ) .

### Claim 80

A system for determining a multidimensional navigation state for a navigation platform based on radio navigation data transmitted by external terminals comprising:
a radio navigation data receiver for receiving and amplifying said radio navigation data embedded in noise;
an extended-range bank of correlators for extracting said radio navigation data from said noise over an extended range of delay error, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of a degree of correlation for each correlator in the extended-range bank between said radio navigation data and a known internal replica signal;
an estimator for estimating the radio navigation data signal power and noise power from the correlator output functions; and
a measurement update unit for updating the navigation state based on a calculation of the conditional moments of the navigation state using a set of correlator moments, the calculation being based on the estimated radio navigation data signal power and noise power and the functions;
wherein said correlator moments represent statistical expectations of nonlinear functions of the line-of-sight position errors and are calculated according to the equation: M c , k ( s ) = ∫ - ∞ ∞ ⁢ ⁢ ⅆ τ ⁡ ( α ⁡ ( τ , k ) ) s ⁢ R c 2 ⁡ ( τ ) ⁢ ⁢ P α ⁡ ( τ , k , j ) ⁢ ⁢ where α ⁡ ( τ , k ) = k ⁢ ⁢ Δ + τ ⁢ ⁢ and P α ⁡ ( τ , k , j ) = ⅇ - ( α ⁡ ( τ , k ) ) 2 2 ⁢ ⁢ P los ⁡ ( j ) 2 ⁢ ⁢ π ⁢ ⁢ P los ⁡ ( j ) .

### Claim 81

A method for determining a multidimensional navigation state for a navigation platform based on radio navigation data transmitted by external terminals comprising:
receiving and amplifying said radio navigation data embedded in noise at a radio navigation data receiver;
extracting said radio navigation data from said noise over an extended range of delay error at an extended-range bank of correlators, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator in the extended-range bank between said radio navigation data and a known internal replica signal;
estimating the radio navigation data signal power and noise power from the correlator output functions; and
updating the navigation state using a set of correlator moments, the calculation being based on the estimated radio navigation data signal power and noise power, and the correlator output functions; and
calculating said correlator moments, which represent statistical expectations of nonlinear functions of line-of-sight position errors, with a nonlinear filter, said correlator moments being calculated according to the equation: M c , k ( s ) = ∫ - ∞ ∞ ⁢ ⁢ ⅆ τ ⁡ ( α ⁡ ( τ , k ) ) s ⁢ R c 2 ⁡ ( τ ) ⁢ ⁢ P α ⁡ ( τ , k , j ) ⁢ ⁢ where α ⁡ ( τ , k ) = k ⁢ ⁢ Δ + τ ⁢ ⁢ and P α ⁡ ( τ , k , j ) = ⅇ - ( α ⁡ ( τ , k ) ) 2 2 ⁢ ⁢ P los ⁡ ( j ) 2 ⁢ ⁢ π ⁢ ⁢ P los ⁡ ( j ) .

### Claim 82

A method for determining a multidimensional navigation state for a navigation platform based on radio navigation data transmitted by external terminals comprising:
receiving and amplifying said radio navigation data embedded in noise at a radio navigation data receiver;
extracting said radio navigation data from said noise over an extended range of delay error at an extended-range bank of correlators, said correlators processing said radio navigation data and said noise to generate correlator output functions indicative of degree of correlation for each correlator in the extended-range bank between said radio navigation data and a known internal replica signal;
estimating the radio navigation data signal power and noise power from the correlator output functions; and
updating the navigation state using a set of correlator moments, the calculation being based on the estimated radio navigation data signal power and noise power, and the correlator output functions; and
calculating said correlator moments, which represent statistical expectations of nonlinear functions of line-of-sight position errors, said correlator moments being calculated according to the equation: M c , k ( s ) = ∫ - ∞ ∞ ⁢ ⁢ ⅆ τ ⁡ ( α ⁡ ( τ , k ) ) s ⁢ R c 2 ⁡ ( τ ) ⁢ ⁢ P α ⁡ ( τ , k , j ) ⁢ ⁢ where α ⁡ ( τ , k ) = k ⁢ ⁢ Δ + τ ⁢ ⁢ and P α ⁡ ( τ , k , j ) = ⅇ - ( α ⁡ ( τ , k ) ) 2 2 ⁢ ⁢ P los ⁡ ( j ) 2 ⁢ ⁢ π ⁢ ⁢ P los ⁡ ( j ) .
