Second order complementary global positioning system/inertial navigation system blending filter
First Claim
1. 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 a velocity signal from a second navigation source;
a means 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
a means for summing said dynamic position error signal and an inertial navigation system position signal to output a dynamically corrected inertial navigation system position.
1 Assignment
0 Petitions
Accused Products
Abstract
A second-order filter that blends accurate position information from a one source, and velocity information from another source, both suitably scaled, in a second-order complementary filter. The filter is arranged such that an internal integrator maintains a value that represents the difference in the rate of change of the accurate position information, and the velocity input of the other source. This velocity difference is applied to another integrator outside the filter, whose initial condition is the position error between the two sources to the second order filter. The output of this latter integrator is a correction signal that grows at a rate equal and opposite to the rate of error build-up of position data from the source whose velocity is used in the second order filter. This correction signal is summed with the original position signal. In addition, the output of the second order filter may be used as a highly accurate position signal.
16 Citations
13 Claims
-
1. 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 a velocity signal from a second navigation source;
a means 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
a means for summing said dynamic position error signal and an inertial navigation system position signal to output a dynamically corrected inertial navigation system position. - View Dependent Claims (2, 3, 4, 5)
-
-
6. A method of correcting position and velocity errors with a second order complementary filter in an inertial navigation system, the method comprising the steps of:
-
a) blending a position signal from a first navigation source with a velocity signal from a second navigation source with blending filter;
b) 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;
c) creating a position correction signal from the generated output; and
d) applying the corrected signal to the inertial navigation system. - View Dependent Claims (7, 8, 9, 10)
-
-
11. 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 inertial navigation velocity signal from a second navigation source;
a means for generating a dynamic error signal from said blending filter comprising a rate of change of position error of the first navigation source from the second navigation source;
a means for disconnecting a position input and a position feedback from said blending filter when said input position signal becomes invalid;
a means for summing said dynamic error signal and said inertial navigation system velocity signal to produce a dynamically corrected inertial navigation system velocity signal; and
a means for integrating said inertial navigation velocity signal to produce a corrected inertial navigation system position signal. - View Dependent Claims (12, 13)
-
Specification