Accelerometer using acceleration

• US 8,498,793 B1
• Filed: 02/22/2012
• Issued: 07/30/2013
• Est. Priority Date: 06/11/2008
• Status: Active Grant

• Current Assignee: Trimble Navigation Limited (Trimble Inc.)
• Original Assignee: Trimble Navigation Limited (Trimble Inc.)
• Inventors: Loomis, Peter Van Wyck
• Primary Examiner(s): Black, Thomas
• Assistant Examiner(s): LOUIE, WAE LENNY
• Application Number:
  US13/402,018
• Time in Patent Office: 524 Days
• Field of Search: 701/70, 701/45, 702/154, 702/141
• US Class Current: 701/70
• CPC Class Codes: G01C 21/12 executed aboard the object being navigated; Dead reckoning
• CPC Class Codes: G01C 21/30 Map- or contour-matching
• CPC Class Codes: G01C 9/08 Means for compensating acceleration forces due to movement of instrument
• CPC Class Codes: G01S 19/47 the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial

Abstract

An altimeter using speed, forward acceleration and yaw angle rate to measure altitude. The accuracy of the measurement may be improved by compensating for a position offset of an accelerometer; Kalman filtering with an external altitude measurement; and/or compensating for an accelerometer bias. The accelerometer bias may be calculated based on a last incline angle before a dormant time period and/or by Kalman filtering.

Claims

1. An altimeter, comprising:

a yaw compensator configured to use an accelerometer position offset with respect to a rear axle and a yaw angle rate to determine a position offset error; and

an altitude calculator configured to use said position offset error, an acceleration measurement, and a forward speed to calculate an altitude change.

2. The altimeter of claim 1, wherein:

said accelerometer position offset is determined with respect to a turn radius line.

3. The altimeter of claim 1, wherein:

said position offset error is determined according to said position offset times a square of said yaw angle rate.

4. The altimeter of claim 1, further comprising:

a Kalman filter operationally connected to filter said altitude change with external navigation information from at least one external positioning source to estimate a filtered altitude.

5. The altimeter of claim 4, wherein:

said external navigation information is derived from at least one of map matching, GNSS signals, or baro-altitudes.

6. The altimeter of claim 4, wherein:

the Kalman filter is further configured to filter said altitude change to estimate an accelerometer bias and to use said accelerometer bias to estimate said filtered altitude.

7. The altimeter of claim 1, wherein:

the yaw compensator is configured to use said yaw angle rate, said forward speed, and an accelerometer yaw alignment angle with respect to a forward direction to determine a yaw alignment angle error; and

the altitude calculator is further configured to use said yaw alignment angle error to calculate said altitude change.

8. The altimeter of claim 1, further comprising:

a restart bias detector to estimate an accelerometer bias at a restart of motion after a dormant time period, said estimate based on a last said incline angle before said dormant time period; and

wherein;

the altitude calculator is further configured to use said accelerometer bias to calculate said altitude change.

9. An altimeter, comprising:

a restart bias detector to estimate an accelerometer bias at a restart of motion after a dormant time period, said estimate based on a last incline angle before said dormant time period; and

an altitude calculator configured to use said accelerometer bias, an acceleration measurement, and a forward speed for calculating an altitude change.

10. The altimeter of claim 9, further comprising:

a Kalman filter to filter said altitude change with at least one external altitude change to make a better estimate of said accelerometer bias; and

wherein;

the altitude calculator is further configured to use said better estimate of accelerometer bias for calculating a succeeding said altitude change.

11. A method for calculating altitude, comprising:

determining a position offset error based on an accelerometer position offset with respect to a rear axle and a yaw angle rate; and

calculating an altitude change based on said position offset error, an acceleration measurement, and a forward speed.

12. The method of claim 11, wherein:

said accelerometer position offset is determined with respect to a turn radius line.

13. The method of claim 11, wherein:

said accelerometer position offset is determined according to said position offset times a square of said yaw angle rate.

14. The method of claim 11, further comprising:

Kalman filtering said altitude change with external navigation information from at least one external positioning source for providing a filtered altitude.

15. The method of claim 14, wherein:

said external navigation information is derived from at least one of map matching, GNSS signals, or baro-altitudes.

16. The method of claim 14, wherein:

the step of Kalman filtering includes filtering said altitude change for estimating an accelerometer bias and using said accelerometer bias for resolving said filtered altitude.

17. The method of claim 11, further comprising:

determining a yaw alignment angle error based on said yaw angle rate, said forward speed, and an accelerometer yaw alignment angle with respect to a forward direction; and

wherein;

the step of calculating includes using said yaw alignment angle error for calculating said altitude change.

18. The method of claim 11, further comprising:

estimating an accelerometer bias at a restart of motion after a dormant time period based on a last said incline angle before said dormant time period; and

wherein;

the step of calculating includes using said accelerometer bias for calculating said altitude change.

19. A method for calculating altitude, comprising:

estimating an accelerometer bias at a restart of motion after a dormant time period, said estimating based on a last incline angle before said dormant time period; and

calculating an altitude change based on said accelerometer bias, an acceleration measurement, and a forward speed.

20. The method of claim 19, further comprising:

Kalman filtering said altitude change with external navigation information from at least one external positioning source for making a better estimate of said accelerometer bias; and

using said better estimate of accelerometer bias for calculating a succeeding said altitude change.