Method and apparatus for high accuracy relative motion determination using inertial sensors

• US 7,844,397 B2
• Filed: 01/27/2006
• Issued: 11/30/2010
• Est. Priority Date: 03/29/2005
• Status: Expired due to Fees

• Current Assignee: Honeywell International Inc.
• Original Assignee: Honeywell International Inc.
• Inventors: Ignagni, Mario, Vallot, Lawrence C., Lund, Christopher A., Soehren, Wayne A.
• Primary Examiner(s): Camby; Richard M.
• Application Number:
  US11/341,812
• Publication Number:
  US 20060224321A1
• Time in Patent Office: 1,768 Days
• Field of Search: 701205-215, 701/222, 701/225, 701/220, 342/149, 342/152, 342/387
• US Class Current: 701/220
• CPC Class Codes: G01C 19/58 Turn-sensitive devices without moving masses
• CPC Class Codes: G01C 21/165 combined with non-inertial navigation instruments
• CPC Class Codes: G01C 21/185 for gravity
• CPC Class Codes: G01C 21/188 for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
• CPC Class Codes: G01C 23/005 Flight directors indicating arrangements specially adapted for rotary gyroscopes G01C19/32

Abstract

A relative navigation system including a first unit responsive to the motion of a first position, a second unit responsive to the motion of a second position and a processing unit that generates a relative navigation solution as a function of first unit information and second unit information. The generated relative navigation solution is indicative of at least one of: a relative position vector of the second position relative to the first position, a relative velocity of the second position relative to the first position, and a relative attitude of the first unit at the first position relative to the second unit at the second position.

Claims

1. A system comprising:

a first unit located at a first position, the first unit operable to generate first unit information that is responsive to a motion of the first position;

a second unit located at a second position nominally offset from the first position by a nominal lever-arm, the second unit operable to generate second unit information that is responsive to a motion of the second position; and

a processing unit operable to receive the first unit information from the first unit and the second unit information from the second unit, the processing unit additionally operable to generate compensated sensor information from the first unit information and the second unit information;

wherein the processing unit generates resets to relative states of a relative navigation solution as a function of the compensated sensor information and reference information,

wherein the compensated sensor information is generated from the first unit information and the second unit information and

wherein the reference information is indicative of at least one of the nominal lever-arm of the second position relative to the first position and a nominal relative velocity of the second position relative to the first position.

2. The system of claim 1, wherein the first unit is a first inertial measurement unit and the second unit is a second inertial measurement unit and wherein compensated sensor information is derived from inertial sensor data received from the first inertial measurement unit and inertial sensor data received from the second inertial measurement unit.

3. The system of claim 2, wherein the system is a relative navigation system, wherein at least one of the first unit and the second unit is collocated with a global positioning system (GPS) antenna and wherein the relative navigation system comprises a portion of a tightly-coupled GPS-aided navigational system.

4. The system of claim 2, wherein the system is a relative navigation system, wherein at least one of the first unit and the second unit is collocated with an electronic surveillance measurement (ESM) antenna and wherein the relative navigation system comprises a portion of a radiation source locating system.

5. The system of claim 1, wherein the processing unit comprises:

a data fusion algorithm;

a sensor compensation algorithm operable to generate the compensated sensor information from the first unit information and the second unit information; and

a relative navigation algorithm operable to;

receive the compensated sensor information from the sensor compensation algorithm;

receive the resets from the data fusion algorithm; and

generate the relative states as a function of at least the compensated sensor information,

wherein the data fusion algorithm is operable to;

receive the relative navigation solution and the reference information;

generate the resets based on the relative navigation solution and the reference information; and

output the resets to the relative navigation algorithm,

wherein the resets are corrective feedback used to control errors in the relative navigation solution.

6. The system of claim 5, wherein the processing unit further comprises:

a prefilter that receives the relative states and filters error information that is a function of at least the relative navigation solution.

7. The system of claim 6, wherein the prefilter comprises at least one of a first-order roll-off filter and a notch filter.

8. The system of claim 5, wherein the resets comprise algorithm resets and device resets, and where in the algorithm resets are corrective feedback used to control errors in the relative navigation solution and the device resets are corrective feedback used to control errors in one of the first unit and the second unit.

9. The system of claim 5, wherein the nominal lever-arm is a first lever-arm, the data fusion algorithm is a first data fusion algorithm, the relative navigation algorithm is a first relative navigation algorithm, the reference information is first reference information, the compensated sensor information is first compensated sensor information, the reference information is a first reference information, the resets are first resets and the relative states are first relative states and the relative navigation solution is a first relative navigation solution, the system further comprising:

a third unit located at a third position nominally offset from the first position by a second lever-arm and operable to generate third unit information that is indicative of at least one of a position of the third position and a motion of the third position; and

a second data fusion algorithm;

a second sensor compensation algorithm operable to generate a second compensated sensor information from the first unit information and the third position information; and

a second relative navigation algorithm operable to;

receive the second compensated sensor information from the second sensor compensation algorithm;

receive second resets from the second data fusion algorithm; and

generate second relative states as a function of at least the second compensated sensor information,

wherein the second data fusion algorithm is operable to;

receive a second relative navigation solution and a second reference information;

generate second resets based on the second relative navigation solution and the second reference information; and

output the second resets to the second relative navigation algorithm, wherein the resets are corrective feedback used to control errors in the second relative navigation solution.

10. The system of claim 9, where in the first unit is a first inertial measurement unit, the second unit is a second inertial measurement unit, and the third unit is a third inertial measurement unit and wherein the first compensated sensor information is derived from inertial sensor data received from the first inertial measurement unit and the second inertial measurement unit, and wherein second compensated sensor information is derived from the inertial sensor data received from the first inertial measurement unit and the third inertial measurement unit.

11. The system of claim 9, wherein the first relative states and second relative states are output from the processing unit for use in an external system.

12. The system of claim 11, wherein the external system is selected from a group comprising one of a navigation system, a structure monitoring system, a system to monitor a plurality of structures, an ultra tight coupling global positioning system inertial navigation system, an emitter location system, and combinations thereof.

13. The system of claim 1, wherein the reference information comprises a model of a nominal lever-arm including the first position and the second position.

14. The system of claim 1, wherein the motion of the first position comprises at least one of a velocity of the first position, an acceleration of the first position, and a rotation of the first position.

15. The system of claim 1, further comprising:

a plurality of units in addition to the first unit and the second unit, the plurality of units each located at a related position and each operable to generate unit information that is responsive to a motion of the unit, wherein each of the plurality of units exclusive of the first unit is located at a position nominally offset from the first position by a respective nominal lever-arm, and wherein each of the plurality of units, exclusive of the first unit, forms a pair of units with the first unit;

a plurality of relative navigation algorithms in the processing unit each associated with a respective pair of units and each relative navigation algorithm operable to generate relative states of a relative navigation solution for each pair of units; and

a plurality of data fusion algorithms in the processing unit each associated with one of the plurality of relative navigation algorithms and a respective pair of units, wherein each data fusion algorithm generates resets to the relative states of the relative navigation solution for each pair of units.

16. The system of claim 15, wherein the plurality of units are positioned on at least two dimensions of a semi-flexible structure, and wherein the plurality of the relative states are output from the processing unit for use in an external system to determine relative movements of the plurality of units on the semi-flexible structure.