Smoothed navigation solution using filtered resets

Patent metadata

Field	Value
Publication number	US-9625262-B2
Application number	US-201213660396-A
Country	US
Kind code	B2
Filing date	Oct 25, 2012
Priority date	Oct 25, 2012
Publication date	Apr 18, 2017
Grant date	Apr 18, 2017

Abstract

A navigation system includes at least one inertial sensor configured to detect motion of the system and generate inertial data; at least one aiding device configured to generate aiding device measurement data; at least one processing unit configured to generate an un-smoothed navigation solution inclusive of navigation state variable error resets based on the inertial data and the aiding device measurement data; wherein the at least one processing unit is further configured to sum the state variable error resets into a cumulative sum of the state variable error resets; wherein the at least one processing unit is further configured to high pass filter the cumulative sum of the state variable error resets; and wherein the at least one processing unit is further configured to subtract the high pass filtered cumulative sum of the state variable error resets from the un-smoothed navigation solution to generate a smoothed navigation solution.

First claim

What is claimed is:

1. A navigation system comprising:
at least one inertial sensor configured to detect motion of the system and generate inertial data;
at least one aiding device configured to generate aiding device measurement data;
at least one processing unit configured to generate an un-smoothed navigation solution based on the inertial data and the aiding device measurement data, the un-smoothed navigation solution inclusive of state variable error resets for a state variable;
wherein the at least one processing unit is further configured to sum the state variable error resets for the state variable into a cumulative sum of the state variable error resets for the state variable;
wherein the at least one processing unit is further configured to high pass filter the cumulative sum of the state variable error resets for the state variable;
wherein the at least one processing unit is further configured to subtract the high pass filtered cumulative sum of the state variable error resets for the state variable from the un-smoothed navigation solution to generate a smoothed navigation solution; and
wherein the at least one processing unit is configured to provide the smoothed navigation solution to at least one of:
an autopilot system configured to use the smoothed navigation solution to smooth out a response of the autopilot system to changes in the navigation solution;
a global navigation satellite system (GNSS) receiver configured to use the smoothed navigation solution to help steer the GNSS receiver to better track GNSS signals; and
a seeker configured to use the smoothed navigation solution to control where the seeker is pointed.

2. The system of claim 1 , wherein the un-smoothed navigation solution is fed back to the at least one processing unit as a previously calculated un-smoothed navigation solution.

3. The system of claim 2 , wherein the at least one processing unit is further configured to subtract the previously calculated un-smoothed navigation solution from the aiding device measurement data to determine error measurements between the aiding device measurement data supplied by the aiding device and the previously calculated un-smoothed navigation solution;
wherein the at least one processing unit is further configured to generate state variable error resets for the state variable based on the error measurements between the aiding device measurement data and the previously calculated un-smoothed navigation solution; and
wherein the at least one processing unit is further configured to generate the un-smoothed navigation solution inclusive of state variable error resets for the state variable based on the inertial data and the aiding device measurement data by calculating the un-smoothed navigation solution based on the inertial data and the state variable error resets for the state variable.

4. The system of claim 1 , wherein the aiding device includes at least one of a global navigation satellite system (GNSS) receiver, a magnetometer, a pressure sensor, a master inertial navigation system, a Doppler radar receiver, and LOng RAnge Navigation (LORAN) based positioning receiver; and
wherein the aiding device measurement data comprises at least one of position data, location data, velocity data, heading data, and orientation data.

5. The system of claim 1 , wherein the aiding device is further configured to receive the smoothed navigation solution and to use the smoothed navigation solution to aid in generating the aiding device measurement data.

6. The system of claim 1 , wherein the aiding device is further configured to receive the un-smoothed navigation solution and to use the un-smoothed navigation solution to aid in generating the aiding device measurement data.

7. The system of claim 1 , wherein each of the un-smoothed navigation solution and the smoothed navigation solution includes at least one of a velocity solution, an altitude solution, a latitude and longitude solution, and an attitude solution;
wherein the state variable error resets includes at least one of a velocity error reset, an altitude error reset, a latitude and longitude error reset, and an attitude error reset;
wherein the at least one processing unit is configured to sum at least one of velocity error resets into a cumulative sum of velocity error resets, altitude error resets into a cumulative sum of altitude error resets, latitude and longitude error resets into a cumulative sum of latitude and longitude error resets, and attitude error resets into a cumulative sum of attitude error resets; and
wherein the at least one processing unit is configured to subtract at least one of the high pass filtered cumulative sum of velocity error resets, the high pass filtered cumulative sum of altitude error resets, the high pass filtered cumulative sum of latitude and longitude error resets, and the high pass filtered cumulative sum of attitude error resets from at least one of a corresponding velocity solution, altitude solution, latitude and longitude solution, and attitude solution.

8. A method of generating a smoothed navigation solution for a vehicle comprising:
generating state variable error resets for a state variable based on aiding device measurement data provided by an aiding device and inertial data provided by an inertial device onboard a vehicle using at least one processing unit onboard the vehicle;
determining an un-smoothed navigation solution inclusive of the state variable error resets for the state variable using the at least one processing unit onboard the vehicle;
summing the state variable error resets for the state variable into a cumulative sum of the state variable error resets for the state variable using the at least one processing unit onboard the vehicle;
high pass filtering the cumulative sum of the state variable error resets for the state variable using the at least one processing unit onboard the vehicle; and
subtracting the high pass filtered cumulative sum of the state variable error resets for the state variable from the un-smoothed navigation solution to generate a smoothed navigation solution using the at least one processing unit onboard the vehicle; and
providing the smoothed navigation solution to at least one of:
an autopilot system configured to use the smoothed navigation solution to smooth out a response of the autopilot system to changes in the navigation solution;
a global navigation satellite (GNSS) receiver configured to use the smoothed navigation solution to help steer the GNSS receiver to better track GNSS signals; and
a seeker configured to use the smoothed navigation solution to control where the seeker is pointed.

9. The method of claim 8 , wherein the un-smoothed navigation solution is fed back as a previously calculated un-smoothed navigation solution to be used in generating the state variable error resets for the state variable, wherein the un-smoothed navigation solution is indirectly based on the aiding device measurement data provided by the aiding device through the state variable error resets for the state variable and directly based on the inertial data provided by the inertial device.

10. The method of claim 9 , wherein generating the state variable error resets for the state variable includes:
subtracting the previously calculated un-smoothed navigation solution from the aiding device measurement data to determine error measurements between the aiding device measurement data and the previously calculated un-smoothed navigation solution; and
generating the state variable error resets for the state variable based on the error measurements between the aiding device measurement data and the previously calculated un-smoothed navigation solution; and
w

Assignees

• Honeywell Int Inc

Inventors

• Buck Timothy Merrill
• Vallot Lawrence Charles
• Snyder Scott I

Classifications

• G01C21/188

  for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems · CPC title

• G01C21/1654

  with electromagnetic compass · CPC title

• G01C21/165 Primary

  combined with non-inertial navigation instruments · CPC title

• G01C21/1652

  with ranging devices, e.g. LIDAR or RADAR · CPC title

• G01C21/16 Primary

  by integrating acceleration or speed, i.e. inertial navigation · CPC title