US7421343B2 - Systems and methods for reducing vibration-induced errors in inertial sensors - Google Patents

Systems and methods for reducing vibration-induced errors in inertial sensors Download PDF

Info

Publication number
US7421343B2
US7421343B2 US11/163,695 US16369505A US7421343B2 US 7421343 B2 US7421343 B2 US 7421343B2 US 16369505 A US16369505 A US 16369505A US 7421343 B2 US7421343 B2 US 7421343B2
Authority
US
United States
Prior art keywords
output
input
vibration
kalman filter
inertial
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
US11/163,695
Other versions
US20070100550A1 (en
Inventor
Wesley J. Hawkinson
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Honeywell International Inc
Original Assignee
Honeywell International Inc
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Honeywell International Inc filed Critical Honeywell International Inc
Priority to US11/163,695 priority Critical patent/US7421343B2/en
Assigned to HONEYWELL INTERNATIONAL INC. reassignment HONEYWELL INTERNATIONAL INC. ASSIGNMENT OF ASSIGNORS INTEREST (SEE DOCUMENT FOR DETAILS). Assignors: HAWKINSON, WESLEY J.
Priority to EP06800329.2A priority patent/EP1941236B1/en
Priority to PCT/US2006/028907 priority patent/WO2007050163A1/en
Publication of US20070100550A1 publication Critical patent/US20070100550A1/en
Application granted granted Critical
Publication of US7421343B2 publication Critical patent/US7421343B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/183Compensation of inertial measurements, e.g. for temperature effects

Definitions

  • the present invention relates generally to the field of inertial sensors. More specifically, the present invention pertains to systems and methods for reducing vibration-induced bias errors in inertial sensors.
  • Inertial sensors such as gyroscopes and accelerometers are used in a variety of applications for detecting and measuring inertial motion in one or more directions.
  • INS inertial navigation systems
  • such devices are used in sensing slight variations in linear and rotational motion of an object traveling through space.
  • a resonating structure such as a number of cantilevered beams or interdigitated comb fingers.
  • a number of oscillating proof masses can be used to sense displacement and acceleration in response to movement of the device about an input or “rate” axis.
  • one or more of the gyroscopes and/or accelerometers can be provided as a part of an inertial measurement unit (IMU) that can be used to measure inertial motion and acceleration in multiple directions.
  • IMU inertial measurement unit
  • Inertial sensors are often used in environments that inherently subject the sensors to significant vibrations. When provided on aircraft and weapons, for example, significant vibration-induced bias errors can occur as a result of the constantly changing vibratory environment, affecting the sensor's ability to detect and measure subtle changes in motion. Such environments are especially problematic in those systems employing microelectromechanical (MEMS) sensors, which typically utilize vibratory mechanisms for rate and acceleration sensing.
  • MEMS microelectromechanical
  • MEMS resonant beam accelerometer having a nominally one mili-g accuracy, for example, the presence of a constantly changing vibratory environment may produce bias shifts on the order of several mili-g's.
  • the most common effect is a slowly varying low frequency error component that changes as a function of the applied vibration spectrum. Other errors may be present, however, depending on the application.
  • inertial sensors employ a sensor model and calibration process that is independent of the actual operating environment.
  • an inertial navigation system INS
  • an in-flight transfer alignment and calibration procedure is typically performed prior to release of the weapon.
  • velocity differences (or related quantities) between the aircraft INS and the weapon INS may be processed by a Kalman filter to initialize the attitude and heading of the weapon INS, and to estimate errors in the IMU including any gyroscope and/or accelerometer bias errors.
  • the vibration spectrum present at the weapon IMU is strongly driven by its captive-carry environment, such as a wing-store station or weapon bay.
  • the weapon's inertial sensor bias errors will be affected by the vibration environment.
  • a significantly different vibration environment will typically exist, leading to gyroscope and accelerometer bias shifts that can cause vibration-induced errors in the sensor output.
  • other vibratory and non-vibratory related factors can also lead to such bias shifts in the sensor.
  • such change can negate any benefit of the pre-launch weapon IMU calibration.
  • An illustrative system for reducing bias errors in an inertial sensor may include a vibration detector for sensing vibration changes within the environment proximate to the inertial sensor, and a Kalman filter for computing an estimate of the navigational error produced by the inertial sensor due to a vibration-induced bias shift detected by the vibration detector.
  • the vibration detector can be configured to measure an accelerometer output of the inertial sensor over a Kalman filter cycle, and then use the standard deviation of such accelerometer output to obtain a statistical measure of the vibration within the environment.
  • the inertial sensor may comprise an inertial measurement unit (IMU) capable of detecting and sensing inertial motion of the object about several orthogonal rate axes.
  • IMU inertial measurement unit
  • An error compensation unit and a strapdown navigator operatively connected to the IMU can be configured to receive a navigation correction signal from the Kalman filter that can be used to compensate for any vibration-induced bias shifts in the IMU.
  • An illustrative method of reducing vibration-induced bias errors in an inertial sensor may include the steps of sensing inertial data of an object moving within an environment, detecting any vibration induced bias shifts in the inertial sensor using a vibration detector adapted to sense vibration changes within the environment proximate to the inertial sensor, outputting a bias shift signal to a Kalman filter adapted to compute an estimate of any navigational error, and then reducing any vibration-induced bias error in the inertial data based at least in part on the estimated navigational error outputted by the Kalman filter.
  • Other methods and techniques are further described herein.
  • FIG. 1 is a block diagram showing an illustrative system for reducing vibration-induced bias errors in an inertial sensor
  • FIG. 2 is another block diagram of the illustrative system of FIG. 1 , showing the structure of the Kalman filter in greater detail;
  • FIG. 3 is a flow chart showing an illustrative method of reducing vibration-induced bias errors in an inertial sensor.
  • FIG. 1 is a block diagram showing an illustrative system for reducing vibration-induced bias errors in an inertial sensor.
  • the system may include an inertial sensor 12 , a vibration detector 14 adapted to sense vibration changes within the environment proximate to the inertial sensor 12 , and a Kalman filter 16 including a recursive algorithm adapted to compute an estimate of the navigational error produced by the inertial sensor 12 based at least in part on inertial data 18 sensed by the inertial sensor 12 as well as a bias shift signal 20 outputted by the vibration detector 14 .
  • the inertial sensor 12 may be housed within a sensor package 22 , and can be configured to sense rotational motion of a host object 24 in one or more dimensions.
  • the inertial sensor 12 may comprise an inertial measurement unit (IMU) having a number of gyroscopes 26 for detecting and sensing inertial motion of the object about several orthogonal rate axes.
  • IMU inertial measurement unit
  • the gyroscopes 26 may comprise, for example, three Coriolis-force gyroscopes adapted to sense angular rotation of the sensor package or housing 22 about three orthogonal rate axes, the output of which can be used to determine an X-axis rate component, a Y-axis rate component, and a Z-axis rate component of the host object 24 motion.
  • a number of accelerometers 28 can be provided to measure acceleration of the host object 24 in one or more dimensions, if desired.
  • the accelerometers 28 may include, for example, a number of cantilevered beams that can be used to sense acceleration along each of three orthogonal rate axes.
  • the inertial sensor 12 will typically include multiple gyroscopes 26 and accelerometers 28 for sensing motion and acceleration in multiple dimensions, it should be understood that the inertial sensor 12 could include a single gyroscope and accelerometer for sensing angular rate and acceleration data in only a single direction, if desired.
  • the vibration detector 14 can be configured to sense vibration changes within the environment proximate to the inertial sensor 12 , and then output a bias shift signal 20 containing information about any vibration-induced bias shift in the inertial sensor 12 .
  • the vibration detector 14 can be configured to measure the accelerometer output over a Kalman filter cycle, and then use the standard deviation of such accelerometer output to statistically measure any changes in vibration occurring within the environment.
  • the vibration detector 14 can statistically determine the deviation or variation of such change against other measured values by taking the standard deviation of the accelerometer 28 output.
  • Such statistical analysis may be conducted, for example, using a processor or other suitable computational means equipped with a storage unit (e.g. a RAM, flash memory, etc.) for storing accelerometer 28 output data over time.
  • a storage unit e.g. a RAM, flash memory, etc.
  • the vibration detector 14 may also be capable of detecting other parameters or characteristics that can be used to compensate for vibration-induced bias errors in the inertial sensor 12 .
  • the vibration detector 14 can include a temperature sensor that can be used to measure the temperature of the inertial sensor 12 in those cases where the sensor 12 exhibits temperature-dependent vibrational sensitivity. The output from the temperature sensor can then be used by the system 10 to compensate for any temperature-dependent bias errors in the inertial data 18 outputted by inertial sensor 12 .
  • the vibration detector 14 may also employ other types of sensors for sensing other parameters and/or characteristics within the surrounding environment that may affect the performance of the inertial sensor 12 .
  • An error compensation unit 30 operatively connected to the inertial sensor 12 can be used to provide error compensation for the inertial data 18 outputted by the inertial sensor 12 , including any vibration-induced bias shifts detected.
  • the error compensation unit 30 can be configured to receive a navigation correction signal outputted by the Kalman filter 16 , which as described in greater detail below with respect to FIG. 2 , contains various navigation corrections based at least in part on the bias shift signal 20 outputted from the vibration detector 14 .
  • the error compensation unit 30 can be configured to run an algorithm or routine that compensates for any errors in the inertial data 18 using a correction matrix containing various coefficients for reducing bias errors in the inertial sensor 12 , including any vibration-induced bias errors in the gyroscopes 26 and accelerometers 28 due to vibration of the host object 24 .
  • the error compensation unit 30 may also contain correction coefficients for compensating various other errors in the inertial sensor 12 , including, for example, any temperature dependent errors affecting the vibrational sensitivity of the inertial sensor 12 .
  • the error-compensated inertial data 34 outputted by the error compensation unit 30 can be fed to a strapdown navigator 36 , which can be configured to integrate the angular rate output from the gyroscopes 26 and from the accelerometers 28 to output a position signal 38 containing a measurement of the heading and level attitude (e.g. pitch and roll).
  • the position signal 38 may include, for example, the path heading, distance traveled, velocity output, and the attitude describing the orientation of the host object 24 in space.
  • the strapdown navigator 36 can also provide various state and dynamics information to the Kalman filter 16 , including confidence intervals or the like describing the accuracy of the inertial sensor 12 . It should be understood, however, that different outputs may be determined and provided by the error compensation unit 30 and strapdown navigator 36 , if desired.
  • a navigation reference 40 such as a global positioning system (GPS) reference may be further implemented to provide accurate measurements of position and/or velocity (or equivalently, pseudorange and/or deltarange for a plurality of GPS satellites).
  • the position data 42 provided by the navigational reference 40 can be used to detect and quantify any position and/or velocity errors of the navigational solution resulting from the effects of host object 24 vibration on the gyroscopes 26 and accelerometers 28 .
  • GPS position data 42 is provided in the illustrative embodiment of FIG. 1 , it should be understood that other types of position data 42 may also be used, including but not limited to, data from a differential GPS, ultrasonic or RF positioning systems, or other suitable positioning system.
  • a comparator 44 can be utilized to difference the position data 42 from the navigational reference 40 with the position signal 38 computed and outputted by the strapdown navigator 36 to obtain a measurement signal 46 indicative of the position and/or attitude errors of the inertial sensor 12 .
  • the Kalman filter 16 may employ a recursive algorithm or routine that accepts changes in vibration detected by the vibration detector 14 , and then outputs a navigation correction signal 32 that can be used, if necessary, to compensate for any vibration-induced bias shifts in the inertial data 18 outputted by the inertial sensor 12 .
  • the navigation correction signal 32 may be in the form of state corrections that can be used by the error compensation unit 30 and/or the strapdown navigator 36 to construct a navigation solution that incorporates actual vibration changes in the environment rather than relying on modeled solutions and/or on calibration procedures in different environments.
  • the ability of the system 10 to compensate for vibration-induced bias shifts in the inertial sensor 12 using actual vibration changes sensed within the environment reduces modeling errors that can result from operation of the sensor in an environment different from the modeled environment.
  • FIG. 2 is another block diagram of the illustrative system 10 of FIG. 1 , showing the structure of the Kalman filter 16 in greater detail.
  • the bias shift signal 20 containing vibration change data within the environment indicative of a sensor bias shift can be fed to an error model uncertainty component 48 of the Kalman filter 16 , which computes a process noise covariance “Q” and a measurement noise covariance “R” that can be used by a Kalman gain component “K” 58 for compensation.
  • a navigation error model 50 of the Kalman filter 16 can be configured to predict a navigation error estimate 52 that can be compared 64 with the measurement data 46 to form a measurement residual 62 .
  • the measurement residual 62 thus reflects the discrepancy between the navigational error estimates 52 produced by the navigation error model 50 and the actual measurement data 46 taken from the inertial sensor 12 .
  • a measurement residual 62 of zero for example, means that the predicted and actual measurements are the same. Conversely, a measurement residual 62 different than zero indicates that there is a discrepancy between the predicted and actual measurements.
  • the measurement residual 62 can be applied to the gain component 58 to form the model resets 60 of the Kalman filter 16 .
  • the model resets 60 can be applied to the navigation error model 50 and error model uncertainty 48 to modify the Kalman filter's estimate of the navigational error and error model uncertainty.
  • the navigation error estimates 52 produced by the navigation error model 50 can then be fed to various control logic 54 , which outputs navigation corrections 32 to the error compensation unit 30 and strapdown navigator 36 , as described above.
  • the weighting matrix employed by the gain component 58 may include coefficients that weigh the measurement residual 62 by different amounts depending on whether the measurement error covariance approaches zero or not. If, for example, the error model uncertainty 48 approaches zero, the gain component 58 may weigh the measurement residual 62 less heavily, thus indicating a greater level of confidence that the navigation error model 50 is correct. On the other hand, if the process error model uncertainty 48 is large, the gain component 58 may weigh the measurement residual 62 more heavily, thus indicating a decreased level of confidence that the navigation error model 50 is correct.
  • the navigational error estimate 52 outputted by the navigation error model 50 will typically vary based on the confidence afforded to either the predicted or updated measurements vis-à-vis the gain component 58 , allowing the Kalman filter 16 to provide navigation corrections 32 to the error compensation unit 30 and strapdown navigator 36 that more accurately reflect the actual operating conditions of the inertial sensor 12 .
  • Q is a process noise density matrix
  • G is a process noise dynamic coupling matrix
  • the tilde (“ ⁇ tilde over ( ) ⁇ ”) and circumflex (“ ⁇ ”) marks distinguish the values of the covariance matrix after and before the time update, respectively.
  • the last term on the right-hand side of the equation (1) takes into account the effect of process noise on the growth of the covariance matrix over time.
  • the process noise dynamic coupling matrix “G”, in turn, can be used to account for correlations among the components of the noise driving the various elements of the error state.
  • K is the Kalman gain matrix
  • “H” is a measurement sensitivity matrix
  • R is the measurement error covariance matrix
  • ⁇ circumflex over (x) ⁇ ⁇ tilde over (x) ⁇ +K ( ⁇ y ⁇ H ⁇ tilde over (x) ⁇ ) (4)
  • the covariance matrix behavior associated with sensor bias states in a standard Kalman filter implementation is typically characterized by an initial large value, and, with appropriately processed measurements from the measurement data 46 , a monotonic reduction over time to a relatively small value.
  • Such behavior assumes that the sensor biases do not exhibit a significant change once they are initially estimated, which may not be the case in some systems that use sensors whose biases are sensitive to changing vibration environments.
  • the Kalman filter does not have accurate information as to the sources of the navigational errors, the performance of the navigational system may be degraded.
  • the Kalman filter 16 should therefore be informed that the likely cause of navigation error is due to sensor biases in order to more quickly reduce the error.
  • the Kalman filter 16 can be informed that an individual sensor bias has experienced a vibration-induced change by adjusting the “P” elements associated with that sensor bias error state vector element. If the bias shift data 20 is used to increase the value of the appropriate elements of “Q”, the covariance matrix “P” elements will be adjusted accordingly, as described in equation (1) above. The adjusted “P” elements will thus alter the Kalman gain “K” 58 computation in equation (3), and when used with the measurement residual 62 to update the error state vector of equation (4), will result in a proportionally larger change of the sensor bias error states and effectively re-estimate the sensor biases, thus resulting in increased navigation performance.
  • the illustrative method 66 may begin with the step 68 of sensing inertial data of a host object using an inertial sensor.
  • the inertial sensor may comprise, for example, an inertial measurement unit (IMU) such as that described above with respect to FIG. 1 , including a number of gyroscopes and accelerometers for detecting and sensing velocity and acceleration of the host object about several orthogonal rate axes.
  • IMU inertial measurement unit
  • Other types of inertial sensors may be used, however, depending on the application.
  • a vibration detector or other suitable means for detecting vibration within the environment proximate to the inertial sensor can then be used to detect any vibration-induced bias shifts in the inertial sensor, as indicated generally by reference number 70 .
  • the bias shift detection may occur, for example, by measuring an accelerometer output of the inertial sensor over a Kalman filter cycle, and then using the standard deviation of such accelerometer output as a statistical measure of the vibration within the environment. Other techniques could be employed, however, to stochastically measure the vibration within the environment, if desired.
  • the vibration detector may convert such data into a bias shift signal that can be fed to the Kalman filter to determine an estimate of any navigational error produced by the inertial sensor, as indicated generally by reference number 72 .
  • the Kalman filter can then be configured to compute an estimate of any navigation error in the sensor output based on actual measurements received from the inertial sensor as well as the bias shift signal outputted by the vibration detector.
  • the steps of sensing 68 inertial data, detecting 70 any vibration-induced bias shifts in the inertial sensor, and computing 72 an estimate of any navigation error using the Kalman filter can then be repeated one or more times in order to estimate and, if necessary, compensate for any future vibration changes within the environment, as indicated generally by reference number 74 .
  • an error compensation unit or other suitable means for error compensation can be employed to reduce any vibration-induced bias error in the inertial sensor, as indicated generally by reference number 76 .

Abstract

Systems and methods for reducing vibration-induced bias errors in inertial sensors are disclosed. A system for reducing bias errors in an inertial sensor operating within an environment may include a vibration detector for sensing vibration changes within the environment proximate to the inertial sensor, and a Kalman filter for computing an estimate of the navigational error produced by the inertial sensor due to a vibration-induced bias shift detected by the vibration detector. The vibration detector can be configured to measure an accelerometer output of the inertial sensor over a Kalman filter cycle, and then use the standard deviation of such output to obtain a statistical measure of the vibration within the environment. In some embodiments, the inertial sensor may include an inertial measurement unit (IMU) connected to an error compensation unit and strapdown navigator, each of which can be fed navigation corrections determined by the Kalman filter.

Description

GOVERNMENT SUPPORT
This invention was made with government support under DARPA contract number MDA972-01-9-0018. The government may have certain rights in the invention.
FIELD
The present invention relates generally to the field of inertial sensors. More specifically, the present invention pertains to systems and methods for reducing vibration-induced bias errors in inertial sensors.
BACKGROUND
Inertial sensors such as gyroscopes and accelerometers are used in a variety of applications for detecting and measuring inertial motion in one or more directions. In the design of some inertial navigation systems (INS), for example, such devices are used in sensing slight variations in linear and rotational motion of an object traveling through space. Typically, such motion is sensed by detecting and measuring displacement of a resonating structure such as a number of cantilevered beams or interdigitated comb fingers. In an inertial sensor employing a MEMS-type gyroscope and accelerometer, for example, a number of oscillating proof masses can be used to sense displacement and acceleration in response to movement of the device about an input or “rate” axis. In some designs, one or more of the gyroscopes and/or accelerometers can be provided as a part of an inertial measurement unit (IMU) that can be used to measure inertial motion and acceleration in multiple directions.
Inertial sensors are often used in environments that inherently subject the sensors to significant vibrations. When provided on aircraft and weapons, for example, significant vibration-induced bias errors can occur as a result of the constantly changing vibratory environment, affecting the sensor's ability to detect and measure subtle changes in motion. Such environments are especially problematic in those systems employing microelectromechanical (MEMS) sensors, which typically utilize vibratory mechanisms for rate and acceleration sensing. In a commonly used MEMS resonant beam accelerometer having a nominally one mili-g accuracy, for example, the presence of a constantly changing vibratory environment may produce bias shifts on the order of several mili-g's. For those inertial sensors exhibiting vibration sensitivity, the most common effect is a slowly varying low frequency error component that changes as a function of the applied vibration spectrum. Other errors may be present, however, depending on the application.
To overcome bias shifts resulting from vibration changes in the environment, many inertial sensors employ a sensor model and calibration process that is independent of the actual operating environment. In the case of an inertially guided weapon launched from an aircraft equipped with an inertial navigation system (INS), for example, an in-flight transfer alignment and calibration procedure is typically performed prior to release of the weapon. During this period, velocity differences (or related quantities) between the aircraft INS and the weapon INS may be processed by a Kalman filter to initialize the attitude and heading of the weapon INS, and to estimate errors in the IMU including any gyroscope and/or accelerometer bias errors. The vibration spectrum present at the weapon IMU is strongly driven by its captive-carry environment, such as a wing-store station or weapon bay. During the captive carry, the weapon's inertial sensor bias errors will be affected by the vibration environment. However, after release of the weapon, a significantly different vibration environment will typically exist, leading to gyroscope and accelerometer bias shifts that can cause vibration-induced errors in the sensor output. In some situations, other vibratory and non-vibratory related factors can also lead to such bias shifts in the sensor. Depending on the magnitude of these bias shifts, such change can negate any benefit of the pre-launch weapon IMU calibration.
SUMMARY
The present invention relates generally to systems and methods for reducing vibration-induced bias errors in inertial sensors. An illustrative system for reducing bias errors in an inertial sensor may include a vibration detector for sensing vibration changes within the environment proximate to the inertial sensor, and a Kalman filter for computing an estimate of the navigational error produced by the inertial sensor due to a vibration-induced bias shift detected by the vibration detector. The vibration detector can be configured to measure an accelerometer output of the inertial sensor over a Kalman filter cycle, and then use the standard deviation of such accelerometer output to obtain a statistical measure of the vibration within the environment. In certain embodiments, the inertial sensor may comprise an inertial measurement unit (IMU) capable of detecting and sensing inertial motion of the object about several orthogonal rate axes. An error compensation unit and a strapdown navigator operatively connected to the IMU can be configured to receive a navigation correction signal from the Kalman filter that can be used to compensate for any vibration-induced bias shifts in the IMU.
An illustrative method of reducing vibration-induced bias errors in an inertial sensor may include the steps of sensing inertial data of an object moving within an environment, detecting any vibration induced bias shifts in the inertial sensor using a vibration detector adapted to sense vibration changes within the environment proximate to the inertial sensor, outputting a bias shift signal to a Kalman filter adapted to compute an estimate of any navigational error, and then reducing any vibration-induced bias error in the inertial data based at least in part on the estimated navigational error outputted by the Kalman filter. Other methods and techniques are further described herein.
BRIEF DESCRIPTION OF THE DRAWINGS
FIG. 1 is a block diagram showing an illustrative system for reducing vibration-induced bias errors in an inertial sensor;
FIG. 2 is another block diagram of the illustrative system of FIG. 1, showing the structure of the Kalman filter in greater detail; and
FIG. 3 is a flow chart showing an illustrative method of reducing vibration-induced bias errors in an inertial sensor.
DETAILED DESCRIPTION
The following description should be read with reference to the drawings, in which like elements in different drawings are numbered in like fashion. The drawings, which are not necessarily to scale, depict selected embodiments and are not intended to limit the scope of the invention. Although examples of operational steps and parameters are illustrated in the various views, those skilled in the art will recognize that many of the examples provided have suitable alternatives that can be utilized. Moreover, while the use of an inertial measurement unit (IMU) is specifically shown, it should be understood that the systems and methods described herein could be used for error compensation in other types of inertial sensors as well as other devices exhibiting a sensitivity to vibration.
FIG. 1 is a block diagram showing an illustrative system for reducing vibration-induced bias errors in an inertial sensor. The system, indicated generally by reference number 10 in FIG. 1, may include an inertial sensor 12, a vibration detector 14 adapted to sense vibration changes within the environment proximate to the inertial sensor 12, and a Kalman filter 16 including a recursive algorithm adapted to compute an estimate of the navigational error produced by the inertial sensor 12 based at least in part on inertial data 18 sensed by the inertial sensor 12 as well as a bias shift signal 20 outputted by the vibration detector 14.
The inertial sensor 12 may be housed within a sensor package 22, and can be configured to sense rotational motion of a host object 24 in one or more dimensions. In certain embodiments, for example, the inertial sensor 12 may comprise an inertial measurement unit (IMU) having a number of gyroscopes 26 for detecting and sensing inertial motion of the object about several orthogonal rate axes. The gyroscopes 26 may comprise, for example, three Coriolis-force gyroscopes adapted to sense angular rotation of the sensor package or housing 22 about three orthogonal rate axes, the output of which can be used to determine an X-axis rate component, a Y-axis rate component, and a Z-axis rate component of the host object 24 motion. A number of accelerometers 28, in turn, can be provided to measure acceleration of the host object 24 in one or more dimensions, if desired. The accelerometers 28 may include, for example, a number of cantilevered beams that can be used to sense acceleration along each of three orthogonal rate axes. While the inertial sensor 12 will typically include multiple gyroscopes 26 and accelerometers 28 for sensing motion and acceleration in multiple dimensions, it should be understood that the inertial sensor 12 could include a single gyroscope and accelerometer for sensing angular rate and acceleration data in only a single direction, if desired.
The vibration detector 14 can be configured to sense vibration changes within the environment proximate to the inertial sensor 12, and then output a bias shift signal 20 containing information about any vibration-induced bias shift in the inertial sensor 12. In those embodiments in which the inertial data 18 includes an acceleration output from one or more accelerometers 28, the vibration detector 14 can be configured to measure the accelerometer output over a Kalman filter cycle, and then use the standard deviation of such accelerometer output to statistically measure any changes in vibration occurring within the environment. If, for example, the accelerometer 28 output spectrum changes during the course of a Kalman filter cycle, thus indicating a change in vibration within the surrounding environment, the vibration detector 14 can statistically determine the deviation or variation of such change against other measured values by taking the standard deviation of the accelerometer 28 output. Such statistical analysis may be conducted, for example, using a processor or other suitable computational means equipped with a storage unit (e.g. a RAM, flash memory, etc.) for storing accelerometer 28 output data over time.
In addition to sensing vibration changes within the environment, the vibration detector 14 may also be capable of detecting other parameters or characteristics that can be used to compensate for vibration-induced bias errors in the inertial sensor 12. In certain embodiments, for example, the vibration detector 14 can include a temperature sensor that can be used to measure the temperature of the inertial sensor 12 in those cases where the sensor 12 exhibits temperature-dependent vibrational sensitivity. The output from the temperature sensor can then be used by the system 10 to compensate for any temperature-dependent bias errors in the inertial data 18 outputted by inertial sensor 12. If desired, the vibration detector 14 may also employ other types of sensors for sensing other parameters and/or characteristics within the surrounding environment that may affect the performance of the inertial sensor 12.
An error compensation unit 30 operatively connected to the inertial sensor 12 can be used to provide error compensation for the inertial data 18 outputted by the inertial sensor 12, including any vibration-induced bias shifts detected. As indicated generally by arrow 32, the error compensation unit 30 can be configured to receive a navigation correction signal outputted by the Kalman filter 16, which as described in greater detail below with respect to FIG. 2, contains various navigation corrections based at least in part on the bias shift signal 20 outputted from the vibration detector 14. In some embodiments, the error compensation unit 30 can be configured to run an algorithm or routine that compensates for any errors in the inertial data 18 using a correction matrix containing various coefficients for reducing bias errors in the inertial sensor 12, including any vibration-induced bias errors in the gyroscopes 26 and accelerometers 28 due to vibration of the host object 24. The error compensation unit 30 may also contain correction coefficients for compensating various other errors in the inertial sensor 12, including, for example, any temperature dependent errors affecting the vibrational sensitivity of the inertial sensor 12.
The error-compensated inertial data 34 outputted by the error compensation unit 30 can be fed to a strapdown navigator 36, which can be configured to integrate the angular rate output from the gyroscopes 26 and from the accelerometers 28 to output a position signal 38 containing a measurement of the heading and level attitude (e.g. pitch and roll). The position signal 38 may include, for example, the path heading, distance traveled, velocity output, and the attitude describing the orientation of the host object 24 in space. The strapdown navigator 36 can also provide various state and dynamics information to the Kalman filter 16, including confidence intervals or the like describing the accuracy of the inertial sensor 12. It should be understood, however, that different outputs may be determined and provided by the error compensation unit 30 and strapdown navigator 36, if desired.
In certain embodiments, a navigation reference 40 such as a global positioning system (GPS) reference may be further implemented to provide accurate measurements of position and/or velocity (or equivalently, pseudorange and/or deltarange for a plurality of GPS satellites). The position data 42 provided by the navigational reference 40 can be used to detect and quantify any position and/or velocity errors of the navigational solution resulting from the effects of host object 24 vibration on the gyroscopes 26 and accelerometers 28. While GPS position data 42 is provided in the illustrative embodiment of FIG. 1, it should be understood that other types of position data 42 may also be used, including but not limited to, data from a differential GPS, ultrasonic or RF positioning systems, or other suitable positioning system.
A comparator 44 can be utilized to difference the position data 42 from the navigational reference 40 with the position signal 38 computed and outputted by the strapdown navigator 36 to obtain a measurement signal 46 indicative of the position and/or attitude errors of the inertial sensor 12.
The Kalman filter 16 may employ a recursive algorithm or routine that accepts changes in vibration detected by the vibration detector 14, and then outputs a navigation correction signal 32 that can be used, if necessary, to compensate for any vibration-induced bias shifts in the inertial data 18 outputted by the inertial sensor 12. The navigation correction signal 32 may be in the form of state corrections that can be used by the error compensation unit 30 and/or the strapdown navigator 36 to construct a navigation solution that incorporates actual vibration changes in the environment rather than relying on modeled solutions and/or on calibration procedures in different environments. In use, the ability of the system 10 to compensate for vibration-induced bias shifts in the inertial sensor 12 using actual vibration changes sensed within the environment reduces modeling errors that can result from operation of the sensor in an environment different from the modeled environment.
FIG. 2 is another block diagram of the illustrative system 10 of FIG. 1, showing the structure of the Kalman filter 16 in greater detail. As shown in FIG. 2, the bias shift signal 20 containing vibration change data within the environment indicative of a sensor bias shift can be fed to an error model uncertainty component 48 of the Kalman filter 16, which computes a process noise covariance “Q” and a measurement noise covariance “R” that can be used by a Kalman gain component “K” 58 for compensation. A navigation error model 50 of the Kalman filter 16 can be configured to predict a navigation error estimate 52 that can be compared 64 with the measurement data 46 to form a measurement residual 62. The measurement residual 62 thus reflects the discrepancy between the navigational error estimates 52 produced by the navigation error model 50 and the actual measurement data 46 taken from the inertial sensor 12. A measurement residual 62 of zero, for example, means that the predicted and actual measurements are the same. Conversely, a measurement residual 62 different than zero indicates that there is a discrepancy between the predicted and actual measurements.
The measurement residual 62 can be applied to the gain component 58 to form the model resets 60 of the Kalman filter 16. In some embodiments, and as shown in FIG. 2, the model resets 60 can be applied to the navigation error model 50 and error model uncertainty 48 to modify the Kalman filter's estimate of the navigational error and error model uncertainty. The navigation error estimates 52 produced by the navigation error model 50 can then be fed to various control logic 54, which outputs navigation corrections 32 to the error compensation unit 30 and strapdown navigator 36, as described above.
The weighting matrix employed by the gain component 58 may include coefficients that weigh the measurement residual 62 by different amounts depending on whether the measurement error covariance approaches zero or not. If, for example, the error model uncertainty 48 approaches zero, the gain component 58 may weigh the measurement residual 62 less heavily, thus indicating a greater level of confidence that the navigation error model 50 is correct. On the other hand, if the process error model uncertainty 48 is large, the gain component 58 may weigh the measurement residual 62 more heavily, thus indicating a decreased level of confidence that the navigation error model 50 is correct. The navigational error estimate 52 outputted by the navigation error model 50 will typically vary based on the confidence afforded to either the predicted or updated measurements vis-à-vis the gain component 58, allowing the Kalman filter 16 to provide navigation corrections 32 to the error compensation unit 30 and strapdown navigator 36 that more accurately reflect the actual operating conditions of the inertial sensor 12.
In some embodiments, the error model uncertainty component 48 may be implemented by a covariance matrix, whose time propagation step in a standard Kalman filter algorithm may be expressed generally as:
{tilde over (P)}=Φ{circumflex over (P)}Φ T +GQG T  (1)
where:
“P” is the covariance matrix;
“Φ” is a state transition matrix;
“Q” is a process noise density matrix; and
“G” is a process noise dynamic coupling matrix.
In equation (1) above, the tilde (“{tilde over ( )}”) and circumflex (“^”) marks distinguish the values of the covariance matrix after and before the time update, respectively. The last term on the right-hand side of the equation (1) takes into account the effect of process noise on the growth of the covariance matrix over time. The process noise dynamic coupling matrix “G”, in turn, can be used to account for correlations among the components of the noise driving the various elements of the error state.
Based on the above equation (1), the measurement update step of the standard Kalman filter algorithm may be expressed generally as:
{circumflex over (P)}={tilde over (P)}−KH{tilde over (P)}  (2)
and
K={tilde over (P)}H T(H{tilde over (P)}H T +R)−1  (3)
where:
“K” is the Kalman gain matrix;
“H” is a measurement sensitivity matrix; and
“R” is the measurement error covariance matrix.
Again, the tilde and circumflex marks distinguish the values before and after the measurement update, respectively. The gain “K” is also used to update the estimate of the error state according to the following equation:
{circumflex over (x)}={tilde over (x)}+Ky−H{tilde over (x)})  (4)
where:
“Δy” denotes the measurement residual.
Relatively small values of “P” indicate that the uncertainty of the corresponding error states is small, and thus only small adjustments of the error state vector are necessary to reduce the total navigation error. Conversely, increasing values of “P” indicate an increasing uncertainty of corresponding error states, thus implying that a relatively larger portion of the navigational error is due to incorrectly estimated values of those error states.
The covariance matrix behavior associated with sensor bias states in a standard Kalman filter implementation is typically characterized by an initial large value, and, with appropriately processed measurements from the measurement data 46, a monotonic reduction over time to a relatively small value. Such behavior assumes that the sensor biases do not exhibit a significant change once they are initially estimated, which may not be the case in some systems that use sensors whose biases are sensitive to changing vibration environments. Thus, if the Kalman filter does not have accurate information as to the sources of the navigational errors, the performance of the navigational system may be degraded. In the case of a navigational system with changing biases, the Kalman filter 16 should therefore be informed that the likely cause of navigation error is due to sensor biases in order to more quickly reduce the error.
In one illustrative method, the Kalman filter 16 can be informed that an individual sensor bias has experienced a vibration-induced change by adjusting the “P” elements associated with that sensor bias error state vector element. If the bias shift data 20 is used to increase the value of the appropriate elements of “Q”, the covariance matrix “P” elements will be adjusted accordingly, as described in equation (1) above. The adjusted “P” elements will thus alter the Kalman gain “K” 58 computation in equation (3), and when used with the measurement residual 62 to update the error state vector of equation (4), will result in a proportionally larger change of the sensor bias error states and effectively re-estimate the sensor biases, thus resulting in increased navigation performance.
Referring now to FIG. 3, a flow chart showing an illustrative method 66 of reducing vibration-induced errors in an inertial sensor will now be described. As shown in FIG. 3, the illustrative method 66 may begin with the step 68 of sensing inertial data of a host object using an inertial sensor. The inertial sensor may comprise, for example, an inertial measurement unit (IMU) such as that described above with respect to FIG. 1, including a number of gyroscopes and accelerometers for detecting and sensing velocity and acceleration of the host object about several orthogonal rate axes. Other types of inertial sensors may be used, however, depending on the application.
Once inertial data has been sensed by the inertial sensor, a vibration detector or other suitable means for detecting vibration within the environment proximate to the inertial sensor can then be used to detect any vibration-induced bias shifts in the inertial sensor, as indicated generally by reference number 70. The bias shift detection may occur, for example, by measuring an accelerometer output of the inertial sensor over a Kalman filter cycle, and then using the standard deviation of such accelerometer output as a statistical measure of the vibration within the environment. Other techniques could be employed, however, to stochastically measure the vibration within the environment, if desired.
Once the vibration detector detects a vibration-induced bias shift in the inertial sensor output, it may convert such data into a bias shift signal that can be fed to the Kalman filter to determine an estimate of any navigational error produced by the inertial sensor, as indicated generally by reference number 72. The Kalman filter can then be configured to compute an estimate of any navigation error in the sensor output based on actual measurements received from the inertial sensor as well as the bias shift signal outputted by the vibration detector. The steps of sensing 68 inertial data, detecting 70 any vibration-induced bias shifts in the inertial sensor, and computing 72 an estimate of any navigation error using the Kalman filter can then be repeated one or more times in order to estimate and, if necessary, compensate for any future vibration changes within the environment, as indicated generally by reference number 74. Using an estimate of the navigational error outputted by the Kalman filter during each filter cycle, an error compensation unit or other suitable means for error compensation can be employed to reduce any vibration-induced bias error in the inertial sensor, as indicated generally by reference number 76.
Having thus described the several embodiments of the present invention, those of skill in the art will readily appreciate that other embodiments may be made and used which fall within the scope of the claims attached hereto. Numerous advantages of the invention covered by this document have been set forth in the foregoing description. It will be understood that this disclosure is, in many respects, only illustrative. Changes can be made with respect to various elements described herein without exceeding the scope of the invention.

Claims (20)

1. A system for reducing bias errors in an inertial sensor operating within an environment, the system comprising:
an inertial sensor having an output;
a vibration detector for sensing vibration changes within the environment proximate to the inertial sensor and operatively connected to the output of the inertial sensor, the vibration detector adapted for outputting a bias shift signal containing information of any vibration-induced bias shift in the inertial sensor;
a Kalman filter for computing an estimate of the navigational error produced by the inertial sensor due to the vibration-induced bias shift, the Kalman filter having a first input, a second input, and an output, the first input of the Kalman filter directly connected to the output of the vibration detector, the output of the Kalman filter adapted for outputting a navigation correction based at least in part on actual measurement data from a comparator unit and from the bias shift signal outputted by the vibration detector;
an error compensation unit having a first input, a second input, and an output, the first input of the error compensation unit directly connected to the output of the inertial sensor, the second input of the error compensation unit operatively connected to the output of the Kalman filter; and
a strapdown navigator having a first input, a second input, and an output, the first input of the strapdown navigator operatively connected to the output of the error compensation unit, the second input of the strapdown navigator operatively connected to the output of the Kalman filter;
wherein the comparator unit has a first input, a second input, and an output, the first input of the comparator unit operatively connected to the output of the strapdown navigator, the second input of the comparator unit operative to receive position data, and the output of the comparator unit operatively connected to the second input of the Kalman filter.
2. The system of claim 1, wherein said inertial sensor is an inertial measurement unit.
3. The system of claim 2, wherein the vibration detector is adapted to measure an accelerometer output of the inertial measurement unit over a Kalman filter cycle, and then use a standard deviation of said accelerometer output as a statistical measure of vibration within the environment.
4. The system of claim 2, wherein the error compensation unit is adapted to compensate for any vibration-induced bias errors in the inertial measurement unit based at least in part on the navigation correction outputted by the Kalman filter.
5. The system of claim 2, wherein the strapdown navigator is adapted to integrate an angular rate output from one or more gyroscopes and one or more accelerometers of the inertial measurement unit and output a position change signal containing a measure of heading and/or attitude.
6. The system of claim 5, further comprising a navigational reference for referencing the position change signal outputted by the strapdown navigator.
7. The system of claim 6, wherein said navigational reference includes data from a global positioning system.
8. The system of claim 1, further comprising temperature sensing means for measuring the temperature of the inertial sensor.
9. A system for reducing bias errors in an inertial sensor operating within an environment, the system comprising:
an inertial measurement unit having an output;
a vibration detector for sensing vibration changes within the environment proximate to the inertial measurement unit and operatively connected to the output of the inertial measurement unit, the vibration detector configured to measure an output signal from the inertial measurement unit and use a standard deviation of the output signal to statistically measure the vibration changes within the environment, the vibration detector adapted for outputting a bias shift signal containing information of any vibration-induced bias shift in the inertial measurement unit;
a Kalman filter for computing an estimate of the navigational error produced by the inertial measurement unit due to the vibration-induced bias shift, the Kalman filter having a first input, a second input, and an output, the first input of the Kalman filter directly connected to the output of the vibration detector, the output of the Kalman filter adapted for outputting a navigation correction based at least in part on actual measurement data from a comparator unit and from the bias shift signal outputted by the vibration detector;
an error compensation unit having a first input, a second input, and an output, the first input of the error compensation unit directly connected to the output of the inertial measurement unit, the second input of the error compensation unit operatively connected to the output of the Kalman filter; and
a strapdown navigator having a first input, a second input, and an output, the first input of the strapdown navigator operatively connected to the output of the error compensation unit, the second input of the strapdown navigator operatively connected to the output of the Kalman filter;
wherein the comparator unit has a first input, a second input, and an output, the first input of the comparator unit operatively connected to the output of the strapdown navigator, the second input of the comparator unit operative to receive position data, and the output of the comparator unit operatively connected to the second input of the Kalman filter.
10. The system of claim 9, wherein the vibration detector is adapted to measure an accelerometer output of the inertial measurement unit over a Kalman filter cycle, and then use the standard deviation of said accelerometer output as a statistical measure of the vibration within the environment.
11. The system of claim 9, wherein the error compensation unit is adapted to compensate for any vibration-induced bias errors in the inertial measurement unit based at least in part on the navigation correction outputted by the Kalman filter.
12. The system of claim 9, wherein the strapdown navigator is adapted to integrate an angular rate output from one or more gyroscopes and one or more accelerometers of the inertial measurement unit and output a position change signal containing a measure of heading and/or attitude.
13. The system of claim 12, further comprising a navigational reference for referencing the position change signal outputted by the strapdown navigator.
14. The system of claim 13, wherein said navigational reference includes data from a global positioning system.
15. The system of claim 9, further comprising temperature sensing means for measuring the temperature of the inertial measurement unit.
16. A system for reducing bias errors in an inertial sensor operating within an environment, the system comprising:
an inertial measurement unit having an output;
a vibration detector for sensing vibration changes within the environment proximate to the inertial measurement unit and operatively connected to the output of the inertial measurement unit, the vibration detector configured to measure an output signal from the inertial measurement unit and use a standard deviation of the output signal to statistically measure the vibration changes within the environment, the vibration detector adapted for outputting a bias shift signal containing information of any vibration-induced bias shift in the inertial measurement unit;
a Kalman filter for computing an estimate of the navigational error produced by the inertial measurement unit due to the vibration-induced bias shift, the Kalman filter having a first input, a second input, and an output, the first input of the Kalman filter directly connected to the output of the vibration detector, the output of the Kalman filter adapted for outputting a navigation correction based at least in part on actual measurement data from a comparator unit and from the bias shift signal outputted by the vibration detector;
an error compensation unit having a first input, a second input, and an output, the first input of the error compensation unit directly connected to the output of the inertial measurement unit, the second input of the error compensation unit operatively connected to the output of the Kalman filter, the error compensation unit adapted to compensate for the vibration-induced bias shift based at least in part on said navigation correction;
a strapdown navigator having a first input, a second input, and an output, the first input of the strapdown navigator operatively connected to the output of the error compensation unit, the second input of the strapdown navigator operatively connected to the output of the Kalman filter; and
a navigation reference for referencing a position change signal outputted by the strapdown navigator;
wherein the comparator unit has a first input, a second input, and an output, the first input of the comparator unit operatively connected to the output of the strapdown navigator, the second input of the comparator unit operative to receive position data from the navigation reference, and the output of the comparator unit operatively connected to the second input of the Kalman filter.
17. A method of reducing vibration-induced bias errors in an inertial sensor, the method comprising the steps of:
sensing inertial data of an object moving within an environment;
outputting an inertial data signal to a vibration detector and a first input of an error compensation unit both directly connected to the inertial sensor;
detecting any vibration-induced bias shifts in the inertial sensor using the vibration detector, the vibration detector adapted to sense vibration changes within the environment proximate to the inertial sensor by measuring the inertial data signal and using a standard deviation of the inertial data signal to statistically measure the vibration changes within the environment;
outputting a bias shift signal to a first input of a Kalman filter directly from the vibration detector, the Kalman filter adapted to compute an estimate of any navigational error produced by the inertial sensor based at least in part on actual measurement data from a comparator unit and from any vibration-induced bias shift detected by the vibration detector;
outputting an error-compensated inertial data signal from the error compensation unit to a first input of a strapdown navigator;
outputting a position signal from the strapdown navigator to a first input of the comparator unit;
sending a navigation reference signal to a second input of the comparator unit; and
reducing any vibration-induced bias error in the inertial data based at least in part on the estimated navigational error outputted by the Kalman filter to a second input of the error compensation unit and a second input of the strapdown navigator.
18. The method of claim 17, wherein said inertial sensor is an inertial measurement unit.
19. The method of claim 17, wherein said step of detecting any vibration-induced bias shifts in the inertial sensor includes the steps of:
measuring an accelerometer output of the inertial sensor over a Kalman filter cycle; and
using the standard deviation of said accelerometer output as a statistical measure of the vibration within the environment.
20. An inertial sensor system comprising:
an inertial measurement unit having an output;
a vibration detector having an input and an output, the input of the vibration detector directly connected to the output of the inertial measurement unit, the vibration detector configured to measure an output signal from the inertial measurement unit to statistically measure vibration changes within an environment proximate to the inertial measurement unit;
a Kalman filter having a first input, a second input, and an output, the first input of the Kalman filter directly connected to the output of the vibration detector, the output of the Kalman filter configured for outputting a navigation correction;
an error compensation unit having a first input, a second input, and an output, the first input of the error compensation unit directly connected to the output of the inertial measurement unit, the second input of the error compensation unit operatively connected to the output of the Kalman filter;
a strapdown navigator having a first input, a second input, and an output, the first input of the strapdown navigator operatively connected to the output of the error compensation unit, the second input of the strapdown navigator operatively connected to the output of the Kalman filter;
a navigation reference for referencing a position change signal outputted by the strapdown navigator; and
a comparator unit having a first input, a second input, and an output, the first input of the comparator unit operatively connected to the output of the strapdown navigator, the second input of the comparator unit operatively connected to an output of the navigation reference, and the output of the comparator unit operatively connected to the second input of the Kalman filter.
US11/163,695 2005-10-27 2005-10-27 Systems and methods for reducing vibration-induced errors in inertial sensors Active US7421343B2 (en)

Priority Applications (3)

Application Number Priority Date Filing Date Title
US11/163,695 US7421343B2 (en) 2005-10-27 2005-10-27 Systems and methods for reducing vibration-induced errors in inertial sensors
EP06800329.2A EP1941236B1 (en) 2005-10-27 2006-07-26 Systems and methods for reducing vibration-induced errors in inertial sensors
PCT/US2006/028907 WO2007050163A1 (en) 2005-10-27 2006-07-26 Systems and methods for reducing vibration-induced errors in inertial sensors

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
US11/163,695 US7421343B2 (en) 2005-10-27 2005-10-27 Systems and methods for reducing vibration-induced errors in inertial sensors

Publications (2)

Publication Number Publication Date
US20070100550A1 US20070100550A1 (en) 2007-05-03
US7421343B2 true US7421343B2 (en) 2008-09-02

Family

ID=37401207

Family Applications (1)

Application Number Title Priority Date Filing Date
US11/163,695 Active US7421343B2 (en) 2005-10-27 2005-10-27 Systems and methods for reducing vibration-induced errors in inertial sensors

Country Status (3)

Country Link
US (1) US7421343B2 (en)
EP (1) EP1941236B1 (en)
WO (1) WO2007050163A1 (en)

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20100060573A1 (en) * 2008-09-09 2010-03-11 Apple Inc. Methods and apparatus for incremental prediction of input device motion
US20100133374A1 (en) * 2008-12-01 2010-06-03 Geswender Chris E Projectile navigation enhancement method
US20110172950A1 (en) * 2009-01-14 2011-07-14 Tye Brady Integrated rate isolation sensor
US8242423B2 (en) * 2009-06-02 2012-08-14 Raytheon Company Missile navigation method
RU2486468C1 (en) * 2012-01-31 2013-06-27 Открытое акционерное общество "Концерн "Центральный научно-исследовательский институт "Электроприбор" Angular speed meter
US8566055B1 (en) * 2010-02-12 2013-10-22 Lockheed Martin Corporation Gyro indexing compensation method and system
US8626359B2 (en) 2010-11-05 2014-01-07 Sikorsky Aircraft Corporation Implementation of Kalman filter linear state estimator for actuator equalization
US8629836B2 (en) 2004-04-30 2014-01-14 Hillcrest Laboratories, Inc. 3D pointing devices with orientation compensation and improved usability
US20140139374A1 (en) * 2012-11-21 2014-05-22 Raytheon Company Kalman filtering with indirect noise measurements
US9008757B2 (en) 2012-09-26 2015-04-14 Stryker Corporation Navigation system including optical and non-optical sensors
US20150276429A1 (en) * 2014-03-27 2015-10-01 Honeywell International Inc. Mems sensor filtering with error feedback
US20160033284A1 (en) * 2014-07-31 2016-02-04 Seiko Epson Corporation Position calculation method and position calculation device
US9261978B2 (en) 2004-04-30 2016-02-16 Hillcrest Laboratories, Inc. 3D pointing devices and methods
US9316664B2 (en) 2012-08-14 2016-04-19 Honeywell International Inc. High frequency disturbance detection and compensation
US9880193B2 (en) 2012-08-15 2018-01-30 Qualcomm Incorporated Device driven inertial interference compensation
US9909872B2 (en) 2014-07-08 2018-03-06 Honeywell International Inc. Systems and methods for inertial reference system alignment
US10159897B2 (en) 2004-11-23 2018-12-25 Idhl Holdings, Inc. Semantic gaming and application transformation

Families Citing this family (26)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7328104B2 (en) * 2006-05-17 2008-02-05 Honeywell International Inc. Systems and methods for improved inertial navigation
FR2902871B1 (en) * 2006-06-23 2008-08-29 Thales Sa INERTIAL MEASUREMENT UNIT WITH REINFORCED ACCELERATION
US10410221B2 (en) * 2008-02-07 2019-09-10 Urban Science Applications, Inc. System and method for determining a grouping of segments within a market
US7840381B2 (en) * 2008-10-03 2010-11-23 Honeywell International Inc. Method and apparatus for determining the operational state of a navigation system
US7979231B2 (en) * 2008-11-13 2011-07-12 Honeywell International Inc. Method and system for estimation of inertial sensor errors in remote inertial measurement unit
US9599474B2 (en) * 2009-04-06 2017-03-21 Honeywell International Inc. Technique to improve navigation performance through carouselling
US8095250B2 (en) * 2009-05-21 2012-01-10 Honeywell International Inc. Real-time compensation of inertial sensor bias errors under high spin rate conditions
EP2504711A4 (en) 2009-11-24 2014-02-26 Yost Engineering Inc Combining redundant inertial sensors to create a virtual sensor output
CN101958010B (en) * 2010-09-03 2011-12-28 清华大学 Correlation function test method for arranged effect of aircraft movement measuring sensor
US8812235B2 (en) 2011-02-13 2014-08-19 Honeywell International Inc. Estimation of N-dimensional parameters while sensing fewer than N dimensions
CN102175095B (en) * 2011-03-02 2013-06-19 浙江大学 Strap-down inertial navigation transfer alignment algorithm parallel implementation method
US8812233B2 (en) 2011-12-27 2014-08-19 Caterpillar Inc. Error detection for inertial measurement units
CN102636081B (en) * 2011-12-29 2014-10-15 南京航空航天大学 Transfer alignment method and device based on visual movement modeling
CN102932686B (en) * 2012-10-15 2015-06-03 青岛海信信芯科技有限公司 Method for processing sensor data in remote controller
WO2014119825A1 (en) * 2013-01-31 2014-08-07 (주)코어센스 Apparatus for attentuating vibration of acceleromter signal of mems attitude heading reference system, and method for same
CN103744099A (en) * 2013-11-20 2014-04-23 哈尔滨工程大学 Individual soldier navigation method based on equality constraint Kalman filtering
GB2534417B (en) 2015-01-26 2019-06-12 Atlantic Inertial Systems Ltd Multiple sensor integration
CN105203129B (en) * 2015-10-13 2019-05-07 上海华测导航技术股份有限公司 A kind of inertial nevigation apparatus Initial Alignment Method
US10871777B2 (en) * 2017-11-30 2020-12-22 Uatc, Llc Autonomous vehicle sensor compensation by monitoring acceleration
CN108072364A (en) * 2017-12-29 2018-05-25 中国电子科技集团公司第十三研究所 Micro-inertia measuring device
CN110793549B (en) * 2019-11-07 2023-11-14 湖南航天机电设备与特种材料研究所 Quick offline data analysis system of inertial measurement unit
CN111624552B (en) * 2020-05-25 2022-08-30 中国地质大学(武汉) Underground pipeline positioning system and method based on acoustic wave transit time measurement
CN111678538B (en) * 2020-07-29 2023-06-09 中国电子科技集团公司第二十六研究所 Dynamic level error compensation method based on speed matching
CN112781614B (en) * 2020-12-23 2022-12-13 北京航天自动控制研究所 Rocket double-strapdown inertial measurement unit reference consistency compensation method
CN114088116B (en) * 2021-11-30 2023-11-10 北京航空航天大学 Deformation compensation method for shock absorber in inertial navigation system based on light aiming method
CN116502478B (en) * 2023-06-29 2023-09-01 中国电建集团华东勘测设计研究院有限公司 Submarine topography monitoring-based pile-off auxiliary decision-making method for self-lifting platform

Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6409687B1 (en) * 1998-04-17 2002-06-25 Massachusetts Institute Of Technology Motion tracking system
US6415223B1 (en) * 1999-11-29 2002-07-02 American Gnc Corporation Interruption-free hand-held positioning method and system thereof
US6421622B1 (en) * 1998-06-05 2002-07-16 Crossbow Technology, Inc. Dynamic attitude measurement sensor and method
US6477465B1 (en) * 1999-11-29 2002-11-05 American Gnc Corporation Vehicle self-carried positioning method and system thereof
US6498996B1 (en) * 1999-08-04 2002-12-24 Honeywell International Inc. Vibration compensation for sensors
US20030137433A1 (en) * 2002-01-23 2003-07-24 Schiller Peter J. Gyroscopic navigation system and method
US20030176970A1 (en) * 2002-03-15 2003-09-18 Ching-Fang Lin Interruption free navigator
US6714870B1 (en) * 1999-10-19 2004-03-30 Halliburton Energy Services, Inc. Method of and apparatus for determining the path of a well bore under drilling conditions
US6826478B2 (en) 2002-04-12 2004-11-30 Ensco, Inc. Inertial navigation system for mobile objects with constraints
US6829524B2 (en) 2001-08-20 2004-12-07 Wisys Technology Foundation, Inc. Method and apparatus for estimating yaw rate in a wheeled vehicle and stability system
US6853947B1 (en) * 1998-06-05 2005-02-08 Crossbow Technology Dynamic attitude measurement method and apparatus
US6859727B2 (en) 2003-01-08 2005-02-22 Honeywell International, Inc. Attitude change kalman filter measurement apparatus and method
US6918186B2 (en) * 2003-08-01 2005-07-19 The Charles Stark Draper Laboratory, Inc. Compact navigation system and method
WO2005075939A1 (en) 2004-02-04 2005-08-18 Bae Systems Plc Method for reducing bias error in a vibrating structure gyroscope
US20060100781A1 (en) * 1999-11-29 2006-05-11 Ching-Fang Lin Self-contained/interruption-free positioning method and system thereof
US20060224321A1 (en) * 2005-03-29 2006-10-05 Honeywell International Inc. Method and apparatus for high accuracy relative motion determination using inertial sensors
US20060287824A1 (en) * 2005-01-29 2006-12-21 American Gnc Corporation Interruption free navigator

Patent Citations (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6409687B1 (en) * 1998-04-17 2002-06-25 Massachusetts Institute Of Technology Motion tracking system
US6853947B1 (en) * 1998-06-05 2005-02-08 Crossbow Technology Dynamic attitude measurement method and apparatus
US6421622B1 (en) * 1998-06-05 2002-07-16 Crossbow Technology, Inc. Dynamic attitude measurement sensor and method
US6498996B1 (en) * 1999-08-04 2002-12-24 Honeywell International Inc. Vibration compensation for sensors
US6714870B1 (en) * 1999-10-19 2004-03-30 Halliburton Energy Services, Inc. Method of and apparatus for determining the path of a well bore under drilling conditions
US6738714B2 (en) * 1999-11-29 2004-05-18 American Gnc Corporation Vehicle self-carried positioning method and system thereof
US20060100781A1 (en) * 1999-11-29 2006-05-11 Ching-Fang Lin Self-contained/interruption-free positioning method and system thereof
US6477465B1 (en) * 1999-11-29 2002-11-05 American Gnc Corporation Vehicle self-carried positioning method and system thereof
US6415223B1 (en) * 1999-11-29 2002-07-02 American Gnc Corporation Interruption-free hand-held positioning method and system thereof
US6829524B2 (en) 2001-08-20 2004-12-07 Wisys Technology Foundation, Inc. Method and apparatus for estimating yaw rate in a wheeled vehicle and stability system
US20030137433A1 (en) * 2002-01-23 2003-07-24 Schiller Peter J. Gyroscopic navigation system and method
US6853315B2 (en) * 2002-01-23 2005-02-08 Triad Sensors, Inc. Piezoelectric rate sensor system and method
US20030176970A1 (en) * 2002-03-15 2003-09-18 Ching-Fang Lin Interruption free navigator
US6826478B2 (en) 2002-04-12 2004-11-30 Ensco, Inc. Inertial navigation system for mobile objects with constraints
US6859727B2 (en) 2003-01-08 2005-02-22 Honeywell International, Inc. Attitude change kalman filter measurement apparatus and method
US6918186B2 (en) * 2003-08-01 2005-07-19 The Charles Stark Draper Laboratory, Inc. Compact navigation system and method
WO2005075939A1 (en) 2004-02-04 2005-08-18 Bae Systems Plc Method for reducing bias error in a vibrating structure gyroscope
US20060287824A1 (en) * 2005-01-29 2006-12-21 American Gnc Corporation Interruption free navigator
US20060224321A1 (en) * 2005-03-29 2006-10-05 Honeywell International Inc. Method and apparatus for high accuracy relative motion determination using inertial sensors

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
Lund et. al. U.S. Appl. No. 60/666,256. *
Welch et al., "An introduction to Kalman Filter," pp. 1-16, Apr. 5, 2004.

Cited By (36)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9261978B2 (en) 2004-04-30 2016-02-16 Hillcrest Laboratories, Inc. 3D pointing devices and methods
US8629836B2 (en) 2004-04-30 2014-01-14 Hillcrest Laboratories, Inc. 3D pointing devices with orientation compensation and improved usability
US9298282B2 (en) 2004-04-30 2016-03-29 Hillcrest Laboratories, Inc. 3D pointing devices with orientation compensation and improved usability
US11157091B2 (en) 2004-04-30 2021-10-26 Idhl Holdings, Inc. 3D pointing devices and methods
US9575570B2 (en) 2004-04-30 2017-02-21 Hillcrest Laboratories, Inc. 3D pointing devices and methods
US10782792B2 (en) 2004-04-30 2020-09-22 Idhl Holdings, Inc. 3D pointing devices with orientation compensation and improved usability
US8937594B2 (en) 2004-04-30 2015-01-20 Hillcrest Laboratories, Inc. 3D pointing devices with orientation compensation and improved usability
US10514776B2 (en) 2004-04-30 2019-12-24 Idhl Holdings, Inc. 3D pointing devices and methods
US9946356B2 (en) 2004-04-30 2018-04-17 Interdigital Patent Holdings, Inc. 3D pointing devices with orientation compensation and improved usability
US10159897B2 (en) 2004-11-23 2018-12-25 Idhl Holdings, Inc. Semantic gaming and application transformation
US11154776B2 (en) 2004-11-23 2021-10-26 Idhl Holdings, Inc. Semantic gaming and application transformation
US20100060573A1 (en) * 2008-09-09 2010-03-11 Apple Inc. Methods and apparatus for incremental prediction of input device motion
US8766915B2 (en) * 2008-09-09 2014-07-01 Apple Inc. Methods and apparatus for incremental prediction of input device motion
US8519313B2 (en) * 2008-12-01 2013-08-27 Raytheon Company Projectile navigation enhancement method
US20100133374A1 (en) * 2008-12-01 2010-06-03 Geswender Chris E Projectile navigation enhancement method
US8290744B2 (en) 2009-01-14 2012-10-16 The Charles Stark Draper Laboratory, Inc. Integrated rate isolation sensor
US20110172950A1 (en) * 2009-01-14 2011-07-14 Tye Brady Integrated rate isolation sensor
US8242423B2 (en) * 2009-06-02 2012-08-14 Raytheon Company Missile navigation method
US8566055B1 (en) * 2010-02-12 2013-10-22 Lockheed Martin Corporation Gyro indexing compensation method and system
US8626359B2 (en) 2010-11-05 2014-01-07 Sikorsky Aircraft Corporation Implementation of Kalman filter linear state estimator for actuator equalization
RU2486468C1 (en) * 2012-01-31 2013-06-27 Открытое акционерное общество "Концерн "Центральный научно-исследовательский институт "Электроприбор" Angular speed meter
US9316664B2 (en) 2012-08-14 2016-04-19 Honeywell International Inc. High frequency disturbance detection and compensation
US9880193B2 (en) 2012-08-15 2018-01-30 Qualcomm Incorporated Device driven inertial interference compensation
US10473690B2 (en) 2012-08-15 2019-11-12 Qualcomm Incorporated Device driven inertial interference compensation
US9008757B2 (en) 2012-09-26 2015-04-14 Stryker Corporation Navigation system including optical and non-optical sensors
US9687307B2 (en) 2012-09-26 2017-06-27 Stryker Corporation Navigation system and method for tracking objects using optical and non-optical sensors
US10575906B2 (en) 2012-09-26 2020-03-03 Stryker Corporation Navigation system and method for tracking objects using optical and non-optical sensors
US9271804B2 (en) 2012-09-26 2016-03-01 Stryker Corporation Method for tracking objects using optical and non-optical sensors
US11529198B2 (en) 2012-09-26 2022-12-20 Stryker Corporation Optical and non-optical sensor tracking of objects for a robotic cutting system
US20140139374A1 (en) * 2012-11-21 2014-05-22 Raytheon Company Kalman filtering with indirect noise measurements
US9223007B2 (en) * 2012-11-21 2015-12-29 Raytheon Company Kalman filtering with indirect noise measurements
US9835470B2 (en) * 2014-03-27 2017-12-05 Honeywell International Inc. MEMS sensor filtering with error feedback
US20150276429A1 (en) * 2014-03-27 2015-10-01 Honeywell International Inc. Mems sensor filtering with error feedback
US9909872B2 (en) 2014-07-08 2018-03-06 Honeywell International Inc. Systems and methods for inertial reference system alignment
CN105318873A (en) * 2014-07-31 2016-02-10 精工爱普生株式会社 Position calculation method and position calculation device
US20160033284A1 (en) * 2014-07-31 2016-02-04 Seiko Epson Corporation Position calculation method and position calculation device

Also Published As

Publication number Publication date
US20070100550A1 (en) 2007-05-03
WO2007050163A1 (en) 2007-05-03
EP1941236A1 (en) 2008-07-09
EP1941236B1 (en) 2013-05-08

Similar Documents

Publication Publication Date Title
US7421343B2 (en) Systems and methods for reducing vibration-induced errors in inertial sensors
US7979231B2 (en) Method and system for estimation of inertial sensor errors in remote inertial measurement unit
EP1837627B1 (en) Methods and systems for implementing an iterated extended kalman filter within a navigation system
EP1200802B1 (en) Vibration compensation for sensors
US6859727B2 (en) Attitude change kalman filter measurement apparatus and method
US8185309B2 (en) Enhanced inertial system performance
US8024119B2 (en) Systems and methods for gyrocompass alignment using dynamically calibrated sensor data and an iterated extended kalman filter within a navigation system
US8019538B2 (en) System and method for high accuracy relative navigation
KR101135782B1 (en) System for navigation redundancy
CA3003298A1 (en) Gnss and inertial navigation system utilizing relative yaw as an observable for an ins filter
Borodacz et al. Review and selection of commercially available IMU for a short time inertial navigation
JP6910258B2 (en) Systems and methods to compensate for the lack of sensor measurements in heading systems
Noureldin et al. Inertial navigation system
Park et al. GPS-aided gyroscope-free inertial navigation systems
CN117053782A (en) Combined navigation method for amphibious robot
CN116594000A (en) Laser Doppler velocimeter online calibration method and device based on position observation
Falletti et al. The Kalman Filter and its Applications in GNSS and INS
KR20210066613A (en) High reliability integrated embedded navigation system
TWI636236B (en) Method for determining states of a system by means of an estimation filter, device for determining a position of an object and unmanned aerial vehicle
Arden The MEMS/GPS strapdown navigator

Legal Events

Date Code Title Description
AS Assignment

Owner name: HONEYWELL INTERNATIONAL INC., NEW JERSEY

Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:HAWKINSON, WESLEY J.;REEL/FRAME:016694/0966

Effective date: 20051025

STCF Information on status: patent grant

Free format text: PATENTED CASE

FPAY Fee payment

Year of fee payment: 4

FPAY Fee payment

Year of fee payment: 8

MAFP Maintenance fee payment

Free format text: PAYMENT OF MAINTENANCE FEE, 12TH YEAR, LARGE ENTITY (ORIGINAL EVENT CODE: M1553); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY

Year of fee payment: 12