초록 ▼

This invention relates to the field of Inertial Navigation Systems (INS) and satellite navigation systems such as the Global Positioning System (GPS) and in particular relates to methods of integrating GPS and INS data in order to provide more accurate navigation solutions. The invention provides a

This invention relates to the field of Inertial Navigation Systems (INS) and satellite navigation systems such as the Global Positioning System (GPS) and in particular relates to methods of integrating GPS and INS data in order to provide more accurate navigation solutions. The invention provides a method of improving the accuracy of a tightly coupled integrated INS and satellite radio navigation system in cases where the satellite navigation receiver has adaptive tracking loop bandwidths.

대표청구항 ▼

1. A method of integrating inertial navigation system and satellite navigation system data in a tightly coupled architecture by means of a Kalman filter, the satellite navigation data being received on a receiver comprising tracking loops having adaptive bandwidths, comprisingmonitoring the tracking

1. A method of integrating inertial navigation system and satellite navigation system data in a tightly coupled architecture by means of a Kalman filter, the satellite navigation data being received on a receiver comprising tracking loops having adaptive bandwidths, comprisingmonitoring the tracking loop bandwidths or modelling them as a function of the receiver measured signal to noise density ratio (c/n0) outputs, and varying the rate of response of the Kalman filter to measurements from the satellite navigation system in response to changes in the tracking loop bandwidths such that correlated measurement noise in the Kalman filter is avoided. 2. A method as claimed in claim 1 wherein the Kalman filter is varied for each tracking loop.3. A method as claimed in claim 1, wherein the iteration rate of the Kalman filter is varied in inverse proportion to the tracking loop bandwidth.4. A method as claimed in claim 1, wherein measurement data averaged is averaged over the iteration period.5. A method as claimed in claim 1, the Kalman filter having a Kalman gain matrix and wherein said Kalman gain matrix is weighted by multiplying it by the time between successive measurements divided by the time between successive uncorrelated measurements.6. A method as claimed in claim 1, the Kalman filter having a Kalman gain matrix and wherein said Kalman gain matrix is represented as one nt column matrix for pseudo-range measurements and a second nt column matrix for pseudo-range rate measurements, where nt is the number of satellites tracked, and is then weighted by an adaption matrix A, the adaption matrix being an nt x nt diagonal matrix wherethe elements of the pseudo-range adaption matrix are Aρkii = 1forBL?COi ? BL?COTAρkii = BL?COi/BL?COTforBL?COi < BL?COTAρkij = 0 ??i ≠ jwhere BL?COi is the code tracking bandwidth of tracking channel i and BL?COT is the threshold code tracking bandwidth for adaption, and; the elements of the pseudo-range rate adaption matrix are Arkii = 1forBL?CAi ? BL?CATArkii = BL?CAi/BL?CATforBL?CAi < BL?CATArkij = 0 ??i ≠ jwhere BL?CAi is the carrier tracking bandwidth of tracking channel i and BL?CAT is the threshold carrier tracking bandwidth for adaption. 7. A method as claimed in claim 1, the Kalman filter comprising a Kalman gain matrix having a measurement noise covariance, R, and wherein said measurement noise covariance, R, is divided by an adaption matrix A as claimed in claim 5.8. A method as claimed in claim 1, wherein the measurement noise covariance, R, is weighted by multiplying by the time between successive uncorrelated measurements divided by the time between successive measurements.9. A method as claimed in claim 1, wherein the satellite navigation system is a Global Positioning System.10. A method of integrating inertial navigation system and satellite navigation system data in a tightly coupled architecture by means of a Kalman filter, the satellite navigation data being received on a receiver comprising tracking loops having adaptive bandwidths, comprisingmonitoring the tracking loop bandwidths or modelling them as a function of the receiver measured signal to noise density ratio (c/n0) outputs , and modelling time-correlated measurement noise within the Kalman filter explicitly such that the assumed correlation time within the Kalman filter is varied in inverse proportion to the tracking loop bandwidths. 11. A method as claimed in claim 10 wherein the correlation time is varied independently for measurements from each tracking loop.12. A method as claimed in claim 10, wherein the correlated measurement noise is estimated as Kalman filter states.13. A method as claimed in claim 10, wherein the correlated measurement noise is modelled using a Schmidt-Kalman filter algorithm.