Methods and systems for vertical trajectory determination

• US 10,222,213 B2
• Filed: 10/01/2015
• Issued: 03/05/2019
• Est. Priority Date: 10/01/2014
• Status: Expired due to Fees

• Current Assignee: Intel Corporation
• Original Assignee: Intel Corporation
• Inventors: Zihajehzadeh, Shaghayegh, Park, Jung Wook, Hoskinson, Reynald Antoine, Abdollahi, Hamid
• Primary Examiner(s): Bui, Bryan
• Application Number:
  US15/507,549
• Publication Number:
  US 20170307376A1
• Time in Patent Office: 1,251 Days
• CPC Class Codes: A61B 5/1122 of movement trajectories
• CPC Class Codes: A63B 5/16 Training devices for jumping; Devices for balloon-jumping; Jumping aids A63B25/02, A63B25/10 take precedence
• CPC Class Codes: G01C 21/165 combined with non-inertial navigation instruments
• CPC Class Codes: G01C 21/24 specially adapted for cosmonautical navigation
• CPC Class Codes: G01C 21/28 with correlation of data from several navigational instruments
• CPC Class Codes: G01C 5/06 by using barometric means
• CPC Class Codes: G01P 15/13 by measuring the force required to restore a proofmass subjected to inertial forces to a null position
• CPC Class Codes: G06F 18/295 Markov models or related models, e.g. semi-Markov models; Markov random fields; Networks embedding Markov models
• CPC Class Codes: G06F 2218/00 Aspects of pattern recognition specially adapted for signal processing
• CPC Class Codes: G06F 2218/12 Classification; Matching
• CPC Class Codes: G06V 40/23 Recognition of whole body movements, e.g. for sport training

Abstract

This disclosure provides a vertical position and velocity determination system for inertial measurement unit (IMU) integrated with a barometric altimeter in the same device (IMU-baro). The system includes a rate of turn input connected to receive a measured IMU-baro rate of turn; an acceleration input connected to receive a measured IMU-baro acceleration; a barometric pressure input connected to receive a measured IMU-baro altitude; a first Kalman filter connected to the rate of turn input and to the acceleration input to estimate a roll and pitch of the IMU-baro based on the measured IMU-baro rate of turn and the measured IMU-baro acceleration; and a second Kalman filter connected to the acceleration input, to the barometric pressure input, and to the first Kalman filter.

Claims

1. A vertical position and velocity determination system for an inertial measurement unit (IMU) integrated with a barometric altimeter in an IMU-baro, the vertical position and velocity determination system comprising:

a rate of turn input connected to receive a measured IMU-baro orientation;

an acceleration input connected to receive a measured IMU-baro acceleration;

a barometric pressure input connected to receive a measured IMU-baro altitude;

a first Kalman filter connected to the rate of turn input and to the acceleration input to estimate a roll and pitch of the IMU-baro based on the measured IMU-baro orientation and the measured IMU-baro acceleration; and

a second Kalman filter connected to the acceleration input, to the barometric pressure input, and to the first Kalman filter, the second Kalman filter cascaded with the first Kalman filter to receive the estimate of the roll and pitch of the IMU-baro from the first Kalman filter and to estimate vertical position and vertical velocity of the IMU-baro based on the measured IMU-baro acceleration, a barometric pressure measured using a barometric altimeter, and the estimate of the roll and pitch of the IMU-baro.

2. The vertical position and velocity determination system of claim 1, further comprising a zero velocity update detector connected to both the acceleration input and the second Kalman filter to provide a zero velocity signal to the second Kalman filter when still phases are detected at the acceleration input.

3. The vertical position and velocity determination system of claim 1, further comprising a Rauch-Tung-Striebel (RTS) trajectory smoother, wherein the RTS trajectory smoother stores the estimate of the vertical position and vertical velocity and a covariance of the estimate of the roll and pitch, and recursively updates the estimate the vertical position and velocity and the covariance in a backward sweep.

4. The vertical position and velocity determination system of claim 1, wherein the barometric pressure input is connected to a micro-electromechanical systems barometric altimeter and the rate of turn input and acceleration input are connected to a micro-electromechanical systems inertial measurement unit (MEMS-IMU).

5. The vertical position and velocity determination system of claim 4, wherein the MEMS-IMU comprises a tri-axial accelerometer and a tri-axial gyroscope.

6. The vertical position and velocity determination system of claim 1, wherein the IMU-baro is part of a wearable electronic device.

7. A computer program product, comprising a non-transitory computer readable storage medium having a computer readable program code embodied therein, said computer readable program code adapted to be executed to implement a method for determining vertical position and velocity of an inertial measurement unit with integrated altimeter barometer in an IMU-baro, the method comprising:

measuring a rate of turn of the IMU-baro, an acceleration of the IMU-baro, and a barometric pressure;

estimating, according to a first Kalman filter operation, a roll and pitch of the IMU-baro based on the rate of turn and the acceleration;

providing the roll and pitch from the first Kalman filter operation to a second Kalman filter operation;

estimating, according to the second Kalman filter operation, a vertical position and a vertical velocity of the IMU-baro based on the acceleration, the barometric pressure, and the roll and pitch; and

determining the vertical position and velocity of the IMU-baro based on the estimate of the vertical position and the vertical velocity; and

,

outputting the vertical position and the vertical velocity based on the determination.

8. The computer program product of claim 7, wherein the method executed by the computer readable program code comprises detecting still phases of the IMU-baro when the acceleration of the IMU-baro is below a threshold and providing a zero velocity signal to the second Kalman filter operation when still phases are detected.

9. The computer program product of claim 7, wherein the method executed by the computer readable program code comprises smoothing the vertical position and velocity by storing the estimate of the vertical position and the vertical velocity and a covariance of the estimate of the roll and pitch, and recursively updating the estimate of the vertical position and the vertical velocity and the covariance in a backward sweep.

10. An apparatus for determining an altitude of an IMU-baro, the apparatus comprising:

a rate of turn input connected to receive a measured orientation of the IMU-baro;

an acceleration input connected to receive a measured acceleration of the IMU-baro;

a barometric pressure input connected to receive a measured barometric pressure of the IMU-baro;

a first Kalman filter configured to estimate a roll and pitch of the IMU-baro based on the measured orientation and the measured acceleration; and

a second Kalman filter connected to the first Kalman filter in a cascade arrangement to receive the estimate of the roll and pitch of the IMU-baro, the second Kalman filter configured to;

estimate a vertical position and a vertical velocity of the IMU-baro based on the estimate of the roll and pitch of the IMU-baro, the measured acceleration, and a measured barometric pressure, and

output the estimate of the vertical position and the vertical velocity of the IMU-baro.

11. The apparatus of claim 10, further comprising a zero velocity update detector connected to both the acceleration input and the second Kalman filter to provide a zero velocity signal to the second Kalman filter when still phases are detected at the acceleration input.

12. The apparatus of claim 10, wherein the barometric pressure input is connected to a micro-electromechanical systems barometric altimeter and the rate of turn input and acceleration input are connected to a micro-electromechanical systems inertial measurement unit (MEMS-IMU).

13. The apparatus of claim 12, wherein the MEMS-IMU comprises a tri-axial accelerometer and a tri-axial gyroscope.

14. The apparatus of claim 10, further comprising a Rauch-Tung-Striebel (RTS) trajectory smoother, wherein the RTS trajectory smoother stores the estimate of the vertical position and the vertical velocity and a covariance of the estimate of the roll and pitch, and recursively updates the estimated vertical position and velocity and the covariance in a backward sweep.

15. The apparatus of any one of claim 10, wherein the IMU-baro is part of a wearable electronic device.