Data processing: vehicles – navigation – and relative location – Navigation – Employing position determining equipment
Reexamination Certificate
2001-06-20
2002-08-27
Nguyen, Tan (Department: 3661)
Data processing: vehicles, navigation, and relative location
Navigation
Employing position determining equipment
C701S216000, C342S357490
Reexamination Certificate
active
06442481
ABSTRACT:
BACKGROUND OF THE INVENTION
1. Field of the Invention (Technical Field)
This invention relates to navigation systems, and, in particular, airborne navigation and guidance systems utilizing the computation of position and velocity for automatic guidance.
2. Background Art
Modern navigation systems utilize extremely accurate signals from a constellation of satellites that comprise the Global Positioning System (GPS) to compute position. However, while such signals provide excellent long-term position accuracy, they are noisy in the short-term. This is particularly true of the velocity data provided. Velocity data as well as position data is required to provide smooth, stable guidance. A further disadvantage of GPS is that the data rate of the position solution is lower than desirable for smooth, stable aircraft guidance.
Current practice is to augment the GPS signals with signals from Inertial Navigation Systems (INS). Present day commercial systems compute the difference between unfiltered INS position, and unfiltered GPS position, and then filter the correction signal in a second order lag (not complementary) filter before applying it to the INS. The computational complexity of such approaches is equivalent to the instant invention, but provides none of the advantages. The INS signals exhibit excellent short-term accuracy and smoothness, but they suffer from long-term drift that produces position errors that are unbounded with time. By blending the GPS and INS signals, a blend can be produced that exhibits the best characteristics of each. Not only is accurate position data produced, but also, velocity data that is smooth. Further, the velocity data can be used to “fill” the position data between GPS position updates. The accurate position data can be used to correct the INS data from long term-drift as well.
A common, albeit complicated, method to accomplish the blending of GPS and INS data that also corrects the INS long term drift is the Kalman Filter. Such a filter can correct both drift and drift rate of an INS, but requires a very powerful digital computer to provide acceptable data rates for smooth, stable guidance.
The current invention provides both smooth long-term and short-term signals whose quality and data rate are high enough to be used for guidance, and provides signals to correct INS drift and drift rate. However, it is simple and straightforward to implement, and does not require a powerful computer in order to provide the necessary functionality and update rate for guidance. In fact, it could be implemented in an analog computer.
The two means of solving the problem are Kalman Filters, and “lag” filters. The former are used commonly in Military systems, (for instance the C-141C GPS Enhanced Navigation System or GPSENS) while the latter are used in Commercial systems such as Honeywell's Flight Management System for the Boeing 757, 767, and 777 aircraft.
The Kalman filter is the standard solution to the problem of providing blended GPS and INS data for use in guidance systems while also providing correction signals for the INS drift and drift rate. However, it requires a powerful computer to produce acceptable data rates, or its output must be augmented in other ways to be acceptable for use in guidance systems. This prior art solution is very costly and complex. Kalman filters may solve the problem of correcting the INS data for drift and drift rate, but that is not necessarily their primary purpose. Kalman filters combine signals from a multiplicity of sources, in an effort to produce an output that is statistically more accurate than any of the inputs.
Commercial systems use lag filters to eliminate noise from the GPS position information so that it can be used to correct the INS information that is used for guidance. However, such filters cannot provide correction for INS drift rate, and may limit the effectiveness of the guidance system in which they are used.
Prior art is concerned with using a simple second order filter (Not complementary) to determine the magnitude, velocity, or acceleration of the error between two sensor signals (
1
), or optimizing the blending of signals at the “raw” measurement level, using a plurality of measurements to determine the integrity of any single measurement in a conventional (
2
-
5
) or Kalman filter Kalman (
6
). None of the prior art used position from GPS and both position and velocity from INS to correct errors in both the position and velocity output of an INS as used in the present invention.
Other devices are similar in that they utilize both velocity and position data in combination to provide smooth output signal. However, such filters to not use the velocity error that may be available in such devices to correct for drift rate of the INS. For an example, see the Radio/INS filter that is used in the C-141C Navigation subsystem as shown in FIG.
1
.
The current invention improves on the prior art in that it inherently compensates for errors in the velocity input as it uses the velocity data in the blended output. It therefore corrects both position and velocity errors using signal from a single filter.
SUMMARY OF THE INVENTION (DISCLOSURE OF THE INVENTION)
In accordance with the present invention, disclosed is a second order complementary filter for correcting position errors and velocity errors in an inertial navigation system (INS). The preferred second order complementary filter for correcting position errors and velocity errors in an inertial navigation system comprises a blending filter for blending a position signal from a first navigation source with a velocity signal from a second navigation source, structure for generating an output from the blending filter comprising a rate of change of position error of the first navigation source from the second navigation source, an integrator for inputting the rate of change of position error when the first navigation source becomes invalid and outputting a dynamic position error signal and an apparatus for summing the dynamic position error signal and an inertial navigation system position signal to output a dynamically corrected inertial navigation system position. The first navigation source preferably comprises a global positioning system and the second navigation source comprises the INS. The preferred integrator comprises an INS correction loop for continuous compensation for an INS drift rate when the first navigation source becomes invalid. The preferred invention further comprises a switch for rendering the correction loop operational when the first navigation source becomes invalid. The preferred switch further comprises a hold position for making the output of the integrator constant.
The preferred method of correcting position and velocity errors with a second order complementary filter in an inertial navigation system comprises the steps of blending a position signal from a first navigation source with a velocity signal from a second navigation source with blending filter, generating an output from the blending filter comprising a rate of change of position error of the first navigation source from the second navigation source, creating a position correction signal from the generated output and applying the corrected signal to the inertial navigation system. The preferred method further comprises the step of continuously repeating the aforementioned steps. The preferred method further comprises the step of capturing a last value of position error when the first navigation source becomes invalid. The preferred method further comprises the step of switching the second order complimentary filter on when the first navigation source becomes invalid. The preferred step of switching further comprises placing the second order complimentary filter on hold so that the generated output is constant.
An alternative apparatus comprises a second order complementary filter for correcting position errors and velocity errors in an inertial navigation system (INS) comprising a blending filter for blending a position signal from a first navigation source with an
Honeywell International , Inc.
Nguyen Tan
LandOfFree
Second order complementary global positioning... does not yet have a rating. At this time, there are no reviews or comments for this patent.
If you have personal experience with Second order complementary global positioning..., we encourage you to share that experience with our LandOfFree.com community. Your opinion is very important and Second order complementary global positioning... will most certainly appreciate the feedback.
Profile ID: LFUS-PAI-O-2897267