Method and apparatus for improving performance of an inertial navigation system having global positioning system corrections

• US 6,631,323 B2
• Filed: 05/23/2001
• Issued: 10/07/2003
• Est. Priority Date: 05/30/2000
• Status: Expired due to Term

• Current Assignee: Northrop Grumman Systems Corporation (Northrop Grumman Corporation)
• Original Assignee: Northrop Grumman Corporation
• Inventors: Tucker, Terry A., Coleman, Albert L.
• Primary Examiner(s): NGUYEN, THU V
• Application Number:
  US09/863,994
• Publication Number:
  US 20020026283A1
• Time in Patent Office: 867 Days
• Field of Search: 701/1, 701/21, 701/23, 701/26, 701/34, 701/200, 701/207, 701/213-217, 701/220-221, 342/357-1-3, 342/357.06, 342/357.08, 342/357.12, 342/357.14, 342/358
• US Class Current: 701/221
• CPC Class Codes: G01C 21/165 combined with non-inertial navigation instruments

Abstract

Performance of an inertial navigation system (INS) corrected with GPS position data is enhanced with the addition of a filter that smooths the GPS-INS position difference data and couples the smoothed data to the INS position data. Difference data provided to the filter is edited to eliminate GPS-INS position data that excceeds a predetermined level. Performance is further improved by applying position resets from the INS Kalman filter in a ramp like manner.

Claims

1. In an inertial navigation system (INS), at an INS location, of the type having inertial sensors coupled to a navigator, the navigator having an output at which position data is provided, said navigator output coupled to a differencing element to which an output, providing position data, of a global positioning system (GPS) receiver, at a GPS location, is also coupled, the differencing element providing GPS-INS position difference data that is coupled to a Kalman filter, the Kalman filter having an output from which correction position data is provided to the navigator, the improvement comprising:

a filter coupled to receive said GPS-INS position difference data and provide filtered position difference data; and

means for adding said GPS-INS filtered position difference data to position data provided by said navigator to provide navigator corrected position data.

2. The inertial navigation system of claim 1 further including an editor coupled between said differencing element and said filter for eliminating position difference data exceeding a predetermined value.

3. The inertial navigation system of claim 2 further including:

a reset smoothing coupled to said Kalman filter output for providing correction data from said Kalman filter output in incremental steps; and

means coupled between said navigator and said adding means and to receive said incremental steps for applying each incremental step to said navigator position data until said correction data is completed.

4. The inertial navigation system of claim 3 further including a lever arm corrector coupled between said GPS receiver and said INS to correct GPS position data to said INS location.

5. The inertial navigation system of claim 4 further including another lever arm corrector coupled between said INS and an other INS, at an other location, for correcting said INS position data to said other INS location.

6. The inertial navigation system of claim 4 wherein said filter processes said GPS-INS position difference data in accordance with

7. The inertial navigation system of claim 4 wherein said filter comprises:

a subtraction element coupled to receive said GPS-INS position difference data at a n^th predetermined time interval and said filtered position difference data at a (n−

1) predetermined time interval to provide difference data;

a multiplier coupled to receive said difference data to provide multiplied difference data;

a summing element coupled to receive said multiplied difference data and said filtered position difference data at said (n−

1) predetermined time interval to provide a sum of said multiplied difference data and said filtered position difference data, said sum being said filtered difference position data for said n^th predetermined time interval.

8. The inertial navigation system of claim 1 wherein said filter processes said GPS-INS position difference data in accordance with

9. The inertial navigation system of claim 1 wherein said filter comprises:

a subtraction element coupled to receive said GPS-INS position difference data at a n^th predetermined time interval and said filtered position difference data at a (n−

1) predetermined time interval to provide difference data;

a multiplier coupled to receive said difference data to provide multiplied difference data;

a summing element coupled to receive said multiplied difference data and said filtered position difference data at said (n−

1) predetermined time interval to provide a sum of said multiplied difference data and said filtered position difference data at said (n−

1) predetermined time interval, said sum being said filtered difference position data at said n^th predetermined time interval.

10. The inertial navigation system of claim 1 further including a lever arm corrector coupled between said GPS receiver and said INS to correct GPS position data to said INS location.

11. A method for correcting position data of an inertial navigation system (INS), at an INS location, of the type having inertial sensors coupled to a navigator, the navigator having an output coupled to provide position data and coupled to a differencing element to which position data of a global positioning system (GPS) receiver, at a GPS location, is also coupled, the differencing element providing GPS-INS position difference data that is coupled to a Kalman filter, the Kalman filter having an output from which correction position data is provided to the navigator comprising the steps of:

filtering said GPS-INS position difference data to provide filtered position difference data; and

adding said filtered position difference data to said navigator position data.

12. The method of claim 11 further including the step of eliminating position difference data that exceed a predetermined level.

13. The method of claim 12 further including the steps of:

receiving correction data from said Kalman filter;

dividing said correction data into incremental steps; and

applying each incremental step to said navigation position data until said correction data is completed.

14. The method of claim 13 further including the step of correcting GPS position data to said INS location.

15. The method of claim 14 further including the step of correcting INS position data to an other INS at an other location.

16. The method of claim 13 wherein said filtering is in accordance with

17. The method of claim 11 wherein said filtering step includes the steps of:

subtracting said filtered position difference data at a (n−

1) predetermined time interval from said GPS-INS difference data at a n^th predetermined time interval to provide difference data;

multiplying said filter difference data by a predetermined constant to obtain multiplied difference data;

adding said multiplied difference data to said filtered position difference data at said (n−

1) predetermined time interval to obtain filtered position difference data at said n^th predetermined time interval.

18. The method of claim 11 wherein said filtering step is in accordance with

19. The method of claim 11 wherein said filtering step includes the steps of:

subtracting said filtered position difference data at a (n−

1) predetermined time interval from said GPS-INS difference data at a n^th predetermined time interval to provide difference data;

multiplying said filter difference data by a predetermined constant to obtain multiplied difference data;

adding said multiplied difference data to said filtered position difference data at said (n−

1) predetermined time interval to obtain filtered position difference data at said n^th predetermined time interval.

20. The method of claim 11 further including the step of correcting GPS position data to said INS location.