Azimuth misalignment determination in an inertial navigator

• US 5,789,671 A
• Filed: 08/15/1996
• Issued: 08/04/1998
• Est. Priority Date: 08/15/1996
• Status: Expired due to Fees

• Current Assignee: Manuel Fernandez
• Original Assignee: Manuel Fernandez
• Inventors: Fernandez, Manuel
• Primary Examiner(s): Oen, William L.
• Application Number:
  US08/698,395
• Time in Patent Office: 719 Days
• Field of Search: 73/180, 33/320, 33/321, 33/322, 33/323, 33/324, 33/325, 33/326, 33/317 D, 244/177, 364/450, 364/453, 364/454
• US Class Current: 73/180
• CPC Class Codes: G01C 21/188 for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems

Abstract

A process and algorithms to determine and correct for the error in azimuth alignment and the errors in "North" and "East" Gyro Drift Rates in an inertial navigator which has been aligned via gyrocompassing, or via the "Stored Heading" technique, with the system "at rest". The process and algorithms may be implemented as an automatic sequence within the system computer to determine and correct the system errors thus determined. These actions make the inertial navigator more accurately represented by the model of an ideal navigation system with a pure and singular initial azimuth misalignment error. Thus the inertial navigator'"'"'s inital azimuth misalignment error can be more accurately determined and corrected by the model.

Claims

1. A method for correcting an initial azimuth alignment error in an inertial navigator which has been pre-aligned in azimuth with an azimuthal alignment proportional to east gyro drift, said inertial navigator comprising at least an east gyro and a north gyro, said method comprising the steps of:

placing the inertial navigator in an unaided navigation mode;

measuring a cumulative north velocity error in a detected north velocity while the inertial navigator is at rest;

measuring a cumulative east velocity error in a detected east velocity while the inertial navigator is at rest;

determining a drift rate about an east axis using the cumulative north velocity error;

determining a drift rate about a north axis using the cumulative east velocity error;

correcting the inertial navigator for the drift rate about a east axis and the drift rate about the north axis;

correcting the inertial navigator for the cumulative north velocity error and the cumulative east velocity error;

determining a cross-axis error in navigational data output by the inertial navigator after the inertial navigator has traveled from an original location to a new location, said cross-axis error caused at least in part by an initial azimuth misalignment;

correcting the inertial navigator for the cross-axis error; and

correcting the inertial navigator for an initial azimuth misalignment and an east gyro drift rate that caused the initial azimuth misalignment.

2. The invention of claim 1, wherein said step of measuring the cumulative north velocity error comprises the step of detecting a north velocity over a predetermined time interval T, and wherein said step of measuring the cumulative east velocity error comprises the step of detecting an east velocity error over said predetermined time interval T.

3. The invention of claim 2 wherein said step of determining a drift rate about the east axis using the cumulative north velocity error is accomplished according to the formula ##EQU15## wherein Δ

DR_GE represents the drift rate about the east axis, Δ

V_NS represents the cumulative north velocity error, G represents a gravitational constant, and T represents said predetermined time interval; and

wherein said step of determining a drift rate about the north axis using the cumulative east velocity error is accomplished according to the formula ##EQU16## wherein Δ

DR_GN represents the drift rate about the north axis, Δ

V_ES represents the cumulative east velocity error, G represents said gravitational constant, and T represents said predetermined time interval.

4. The invention of claim 2 further comprising the steps of correcting the inertial navigator for angular errors caused by the drift rate about the east axis and the drift rate about the north axis, and correcting the inertial navigator for position errors caused by the drift rate about the east axis and the drift rate about the north axis.

5. The invention of claim 1 wherein said step of correcting the inertial navigator for the drift rate about the east axis and the drift rate about the north axis is carried out using an automatic sequence within a system computer.

6. The method of claim 1 wherein the step of determining a cross-axis error in navigational data output by the inertial navigator after the inertial navigator has traveled from an original location to a new location comprises the step of comparing the navigational data output by the inertial navigator with a reference position provided by at least one external navigational aid.

7. The method of claim 6 wherein said at least one external navigational aid comprises a global positioning system (GPS).

8. The method of claim 6 wherein said step of determining a cross-axis error in navigational data output by the inertial navigator after the inertial navigator has traveled from an original location to a new location comprises the step of determining at least one of a cross-axis positional error and a cross-axis velocity error, and wherein the step of correcting the inertial navigator for the cross-axis error comprises the step of determining the initial azimuth misalignment according to the formula ##EQU17## for the cross-axis velocity error, or ##EQU18## for the cross-axis position error, wherein ψ

_o represents the initial azimuth misalignment error, V_ERROR represents the cross-axis velocity error, X_ERROR represents the cross-axis position error, S represents a point-to-point distance between the original location and the new location determined with assistance of the external navigation aid, and V represents actual velocity as determined with assistance of the external navigation aid.

9. The method of claim 8 wherein said step of determining at least one of a cross-axis positional error and a cross-axis velocity error is carried out using an automatic sequence within a system computer.

10. The method of claim 1 wherein the east gyro drift rate is determined according to the formula

11. The method of claim 10 wherein the east gyro drift rate is determined using an automatic sequence within a computer system.

12. The method of claim 1 wherein the inertial navigator is pre-aligned in azimuth using a gyrocompassing technique or a stored heading technique.

13. In a system using an inertial navigator which has been self-aligned in azimuth and then placed in an unaided navigation mode, a method for correcting an initial azimuth alignment error comprising the steps of:

measuring a cumulative north velocity error with the inertial navigator at rest;

calculating a drift rate about an east axis from the cumulative north velocity error;

measuring a cumulative east velocity error with the inertial navigator at rest;

calculating a drift rate about a north axis from the cumulative east velocity error;

correcting the inertial navigator for the drift rate about the east axis;

correcting the inertial navigator for the drift rate about the north axis;

correcting the inertial navigator for the cumulative north velocity error and the cumulative east velocity error; and

correcting the inertial navigator for position errors caused by the drift rate about the north axis and the drift rate about the east axis.

14. The system of claim 13, further comprising the steps of:

traveling with the inertial navigator from a first position to a second position;

determining a reference position and a reference velocity using an external navigation aid;

comparing the reference position with a current position as indicated by the inertial navigator;

comparing the reference velocity with a current velocity as indicated by the inertial navigator;

deriving a cross-axis position error and a cross-axis velocity error based on the difference between the reference position and the current position as indicated by the inertial navigator and the difference between the reference velocity and the current velocity as indicated by the inertial navigator;

calculating an initial azimuth misalignment based upon at least one of said cross-axis position error and said cross-axis velocity error;

calculating an east gyro drift rate from said initial azimuth misalignment;

correcting the inertial navigator for said cross-axis position error, said cross-axis velocity error, said initial azimuth misalignment, and said east gyro drift rate.

15. The system of claim 14 wherein the east gyro drift rate is determined according to the formula

16. The system of claim 13, wherein said step of calculating the drift rate about the east axis from the cumulative north velocity error comprises the step of dividing twice the cumulative north velocity error by a product of a gravitational constant and a square of an amount of time over which the cumulative north velocity error was measured, and wherein said step of calculating the drift rate about the north axis from the cumulative east velocity error comprises the step of dividing twice the cumulative east velocity error by a product of the gravitational constant and a square of an amount of time over which the cumulative east velocity error was measured.

17. The system of claim 14 wherein one or more of said steps of correcting the inertial navigator are carried out using an automatic sequence within a system computer.

18. The system of claim 13 wherein said inertial navigator is pre-aligned using a gyrocompassing or a stored heading technique.

19. An inertial navigator, comprising:

a plurality of gyros;

first velocity measuring means for measuring a north velocity, wherein a north direction is determined according to said plurality of gyros during self-alignment with the system at rest;

second velocity measuring means for measuring an east velocity, wherein an east direction is determined according to said plurality of gyros during self-alignment with the system at rest;

a north velocity error measurement accumulator connected to said first velocity measuring means, said north velocity error measurement accumulator outputting a cumulative north velocity error measurement;

an east velocity error measurement accumulator connected to said second velocity measuring means, said east velocity error measurement accumulator outputting a cumulative east velocity error measurement;

an east axis drift rate calculator coupled to said north velocity error measurement accumulator, said east axis drift rate calculator outputting an east axis drift rate value from said cumulative north velocity error measurement;

a north axis drift rate calculator coupled to said east velocity error measurement accumulator, said north axis drift rate calculator outputting a north axis drift rate value from said cumulative east velocity error measurement; and

a compensator connected to said east axis drift rate calculator and to said north axis drift rate calculator, said compensator correcting the inertial navigator according to said east axis drift rate value and said north axis drift rate value, for said cumulative north velocity error measurement and said cumulative east velocity error measurement, and for angular and position errors indicated by the north axis drift rate value and the east axis drift rate value.

20. The inertial navigator of claim 19, further comprising:

means for receiving navigational data from an external navigation aid;

a cross-axis position error calculator, said cross-axis position error calculator outputting a cross-axis position error based upon a comparison of said navigation data, from the external navigational aid and a navigational position as indicated by said inertial navigator;

a cross-axis velocity error calculator, said cross-axis position error calculator outputting a cross-axis velocity error based upon a comparison of said navigational data from the external navigation aid and a velocity as indicated by said inertial navigator;

a initial azimuth misalignment calculator, said initial azimuth misalignment calculator outputting an initial azimuth misalignment error value based upon at least one of said cross-axis position error and said cross-axis velocity error; and

an east gyro drift rate calculator, said east gyro drift rate calculator outputting an east gyro drift rate value based upon said initial azimuth misalignment error value;

wherein said compensator corrects the inertial navigator for said initial azimuth misalignment error, said cross-axis velocity error, said cross-axis position error, and said east gyro drift rate.