Azimuth misalignment determination in an inertial navigator

Claim 3

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.

Claim 4

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.

Claim 5

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.

Claim 6

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.

Claim 7

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.

Claim 8

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

Claim 9

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.

Claim 10

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.

Claim 11

The method of claim 1 wherein the east gyro drift rate is determined according to the formula DR.sub.GE=ψ.sub.o ·Ω· cos Lt.sub.o, wherein DR GE represents the east gyro drift rate, ψ o represents the initial azimuth misalignment, Ω represents an angular velocity of the earth in inertial space, and Lt o represents the latitude at the self-alignment location.

Claim 12

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

Claim 13

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

Claim 14

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.

Claim 15

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.

Claim 16

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.

Claim 17

The system of claim 14 wherein the east gyro drift rate is determined according to the formula DR.sub.GE =ψ.sub.o ·Ω·cos Lt.sub.o, wherein DR GE represents the east gyro drift rate, ψ o represents the initial azimuth misalignment, Ω represents an angular velocity of the earth in inertial space, and Lt o represents the latitude at the self-alignment location.

Claim 18

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.

Claim 19

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.

Claim 20

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

Claim 21

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.

Claim 22

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.

Claim 23

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.