High frequency disturbance detection and compensation

• US 9,316,664 B2
• Filed: 08/14/2012
• Issued: 04/19/2016
• Est. Priority Date: 08/14/2012
• Status: Active Grant

• Current Assignee: Honeywell International Inc.
• Original Assignee: Honeywell International Inc.
• Inventors: Buck, Timothy Merrill, Vallot, Lawrence Charles
• Primary Examiner(s): EL CHANTI, HUSSEIN A
• Application Number:
  US13/585,453
• Publication Number:
  US 20160077125A1
• Time in Patent Office: 1,344 Days
• Field of Search: 327/552, 375/346
• US Class Current: 1/1
• CPC Class Codes: G01C 21/183 Compensation of inertial measurements, e.g. for temperature effects
• CPC Class Codes: G01P 15/00 Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
• CPC Class Codes: H03B 2200/0088 Reduction of noise

Abstract

A disturbance correction device comprises a disturbance detector configured to detect and output a high frequency component of a measurement signal from an inertial sensor and a level converter coupled to the output of the disturbance detector. The level converter is configured to convert the high frequency component to a direct current (DC) signal. The disturbance correction device also comprises a compensator coupled to an output of the level converter and configured to compare the DC signal with a plurality of thresholds. When the DC signal passes one of the plurality of thresholds, the compensator is further configured to output a respective process noise increment to a Kalman filter. The respective process noise increment corresponds to the passed threshold.

Claims

1. A disturbance correction device comprising:

a disturbance detector configured to detect and output a high frequency component of a measurement signal from an inertial sensor;

a level converter coupled to the output of the disturbance detector, the level converter configured to convert the high frequency component to a direct current (DC) signal;

a compensator coupled to an output of the level converter and configured to compare the DC signal with a plurality of thresholds;

wherein, when the DC signal passes one of the plurality of thresholds, the compensator is further configured to output a respective process noise increment to a Kalman filter, the respective process noise increment corresponding to the passed threshold.

2. The system of claim 1, wherein the disturbance detector comprises a low pass filter and a summer configured to remove low frequency signal from the measurement signal based on a selected bandwidth of the low pass filter.

3. The system of claim 1, wherein the compensator is configure to output a respective process noise increment for each of a plurality of axes when a DC signal associated with one of the plurality of axes passes one of the plurality of thresholds.

4. The system of claim 1, wherein the level converter comprises a low pass filter with a dynamically configurable bandwidth.

5. The system of claim 1, wherein the comparator is configured to compare the DC signal with a first plurality of thresholds associated with increasing levels of the DC signal and with a second plurality of thresholds associated with decreasing levels of the DC signal.

6. The system of claim 1, wherein a bandwidth of the disturbance detector is dynamically configurable.

7. A method of compensating for a disturbance, the method comprising:

isolating a high frequency component of an inertial measurement signal;

converting the high frequency component to a DC-output value;

comparing the DC-output value with a plurality of thresholds; and

incrementing process noise associated with state variables in a Kalman filter that are related to the disturbance based on results of the comparison of the DC-output with the plurality of thresholds.

8. The method of claim 7, wherein comparing the DC-output value with a plurality of thresholds comprises:

comparing the DC-output value with a first plurality of thresholds indicating an increasing disturbance level to determine when to increase a current threshold level and increment the process noise; and

comparing the DC-output value with a second plurality of thresholds indicating a decreasing disturbance level to determine when to decrease the current threshold level and increment the process noise.

9. The method of claim 7, wherein incrementing the process noise comprises incrementing the process noise based on whether the DC-output value is increasing or decreasing.

10. The method of claim 7 further comprising dynamically adjusting a cutoff frequency of a signal frequency filter used to isolate the high frequency component of the inertial measurement signal.

11. The method of claim 7, wherein each of the plurality of thresholds is associated with a respective compensation value;

and

wherein incrementing the process noise comprises incrementing the process noise by the respective compensation value when the associated threshold is passed.

12. The method of claim 7 wherein incrementing the process noise comprises incrementing the process noise in the Kalman filter for all axes of an inertial measurement when a DC-output value corresponding to one axis passes one of the thresholds.

13. The method of claim 7, wherein incrementing the process noise comprises incrementing the process noise in the Kalman filter for each axis of an inertial measurement independently of other axes of the inertial measurement.

14. The method of claim 7 further comprising determining an initial threshold level, wherein determining the initial threshold level comprises:

averaging DC-output values over a pre-determined period of time; and

comparing the average DC-output value with the plurality of thresholds.