Method and apparatus for measuring speed of land vehicle using accelerometer

• US 7,032,450 B2
• Filed: 07/07/2004
• Issued: 04/25/2006
• Est. Priority Date: 12/26/2003
• Status: Active Grant

• Current Assignee: Samsung Electronics Co. Ltd.
• Original Assignee: Samsung Electronics Co. Ltd.
• Inventors: Hong, Hyun-Su, Kim, Jin-Won, Lee, Kook-Yeon, Lee, Yoon-Deock
• Primary Examiner(s): KWOK, HELEN C
• Application Number:
  US10/885,984
• Publication Number:
  US 20050139004A1
• Time in Patent Office: 657 Days
• Field of Search: 73488-492, 735/140.2, 702/96, 702/141, 702/142, 701/1, 701/70
• US Class Current: 73/488
• CPC Class Codes: G01P 7/00 Measuring speed by integrating acceleration measuring travelled distance by double integration of acceleration G01C21/16

Abstract

Disclosed is an apparatus and a method for measuring the speed of a land vehicle using an accelerometer. The method includes the steps of storing measurement data provided from an accelerometer; analyzing the measurement data to determine whether the vehicle is stopped; calculating a road angle using the measurement data of the accelerometer when it is determined, upon analysis, that the vehicle is moving; determining the sign of the road angle when the road angle is greater than a threshold value; compensating for a gravitational acceleration component included in the measurement data of the accelerometer using the road angle; and calculating the speed of the vehicle based on the acceleration of the vehicle with the gravitational acceleration component compensated. It is possible to reduce the number of expensive gyroscopes needed for a vehicle speed measuring apparatus, thereby reducing the cost of the apparatus.

Claims

1. A method for measuring the speed of a moving land vehicle using an accelerometer, comprising the steps of:

storing measurement data provided from an accelerometer;

analyzing the measurement data to determine whether the vehicle is stopped;

calculating a road angle using the measurement data of the accelerometer when it is determined, upon analysis, that the vehicle is moving;

determining a sign of the road angle when the road angle is greater than a threshold value;

compensating for a gravitational acceleration component included in the measurement data of the accelerometer using the road angle; and

calculating the speed of the vehicle based on the acceleration of the vehicle with the gravitational acceleration component compensated.

2. The method according to claim 1, wherein said storing step stores measurement data provided from a biaxial accelerometer.

3. The method according to claim 2, wherein said analyzing step determines that the vehicle is stopped, if measurement data f_c provided from the accelerometer at certain points of time and previous measurement data f_pre are consecutively determined to be identical and the frequency of such consecutive determinations is greater than a threshold value.

4. The method according to claim 2, wherein said road angle calculating step calculates the road angle by subtracting irregular constants from x-axis and y-axis measurement values of the biaxial accelerometer, multiplying the x-axis and y-axis measurement values, with the irregular constants subtracted therefrom, by trigonometric functions to obtain corresponding products and finding the sum of corresponding products.

5. The method according to claim 4, wherein said road angle calculating step multiplies the x-axis and y-axis measurement values, with the irregular constants from subtracted therefrom, by sin α

and cos α

as denoted in Equation (a) to obtain corresponding products, finds the sum of the corresponding products as denoted in Equation (b) to create Equation (c), and calculates the road angle using Equation (c), as set forth below;

{circumflex over (f)}_x sin α

=a sin α

cos α

+g sin²α

cos θ

+g sin α

cos α

sin θ

{circumflex over (f)}_y cos α

=−

a sin α

cos α

+g sin²α

cos θ

−

g sin α

cos α

sin θ

 

 

(a)

{circumflex over (f)}_x sin α

+{circumflex over (f)}_y cos α

=g cos θ

 

 

(b)

θ

₁=arccos {({circumflex over (f)}_x sin α

+{circumflex over (f)}_y cos α

)/g} 

 

(c)

wherein f_x and f_y are values obtained by subtracting the irregular constants from the x-axis and y-axis measurement values of the accelerometer;

g is a gravitational constant;

α

is a mounting angle of the accelerometer; and

θ

is an angle of road inclination.

6. The method according to claim 4, wherein said determining step subtracts the irregular constants from the x-axis and y-axis measurement values of the biaxial accelerometer, multiplies each of the two x-axis and y-axis measurement values, with the irregular constants subtracted therefrom, by corresponding trigonometric functions to obtain two corresponding measurement values, and determines the sign of the road angle using a difference between the two corresponding measurement values.

7. The method according to claim 6, wherein said determining step multiplies the x-axis and y-axis measurement values, with the irregular constants subtracted therefrom, by cos α

and sin α

as denoted in Equation (d), subtracts the y-axis measurement value from the x-axis measurement value as denoted in Equation (e) to create Equation (f), and determines the sign of the road angle using Equation (f), as set forth below;

{circumflex over (f)}_x cos α

=a cos²α

+g sin α

cos θ

+g cos²α

cos α

sin θ

{circumflex over (f)}_y =sin α

−

a sin²α

+g sin α

cos α

cos θ

−

g sin²α

sin θ

 

 

(d)

{circumflex over (f)}_x cos α

−

{circumflex over (f)}_y sin α

=a+g sin θ

{circumflex over (f)}_x cos α

−

{circumflex over (f)}_y sin α

−

a=g sin θ

 

 

(e)

θ

=arcsin {({circumflex over (f)}_x cos α

−

{circumflex over (f)}_y sin α

−

a)/g} 

 

(f)

wherein f_x and f_y are values obtained by subtracting the irregular constants from the x-axis and y-axis measurement values of the accelerometer;

g is a gravitational constant;

α

is a mounting angle of the accelerometer; and

θ

is an angle of road inclination.

8. The method according to claim 1, wherein said compensating step calculates a gravitational acceleration component included in the measurement data of the acceleration using the road angle and removes the gravitational acceleration component from the measurement data of the accelerometer.

9. An apparatus for measuring the speed of a moving land vehicle using a biaxial accelerometer, comprising the steps of:

an acceleration measuring section for measuring a current acceleration of the vehicle from the accelerometer mounted in the vehicle;

an acceleration storing section for storing information about accelerations measured by the acceleration measuring section on a measurement time basis;

a gravitational acceleration compensating section for analyzing measurement data provided from the accelerometer to determine whether the vehicle is stopped, calculating a road angle using the measurement data when it is determined that the vehicle is moving, determining a sign of the road angle when the road angle is greater than a threshold value, and compensating for a gravitational acceleration component included in the measurement data of the accelerometer using the road angle; and

a speed calculating section for calculating the speed of the vehicle based on a real acceleration of the vehicle received from the gravitational acceleration compensating section.

10. The apparatus according to claim 9, wherein said gravitational acceleration compensating section determines that the vehicle is stopped, if measurement data f_c provided from the accelerometer at certain points of time and previous measurement data f_pre are consecutively determined to be identical and the frequency of such consecutive determinations is greater than a threshold value.

11. The apparatus according to claim 9, wherein said gravitational acceleration compensating section multiplies x-axis and y-axis measurement values, with irregular constants subtracted therefrom, by sin α

and cos α

, respectively as denoted in Equation (a) to obtain corresponding x-axis and y-axis products, finds the sum of the x-axis and y-axis products as denoted in Equation (b) to create Equation (c), and calculates the road angle using Equation (c), as set forth below;

{circumflex over (f)}_x sin α

=a sin α

cos α

+g sin²α

cos θ

+g sin α

cos α

sin θ

{circumflex over (f)}_y cos α

=−

a sin α

cos α

+g sin²α

cos θ

−

g sin α

cos α

sin θ

 

 

(a)

{circumflex over (f)}_x sin α

+{circumflex over (f)}_y cos α

=g cos θ

 

 

(b)

θ

₁=arccos {({circumflex over (f)} sin α

+{circumflex over (f)}_y cos α

)/g} 

 

(c)

wherein f_x and f_y are values obtained by subtracting the irregular constants from the corresponding x-axis and y-axis measurement values of the accelerometer;

g is a gravitational constant;

α

is a mounting angle of the accelerometer; and

θ

is an angle of road inclination.

12. The apparatus according to claim 9, wherein said gravitational acceleration compensating section multiplies x-axis and y-axis measurement values, with irregular constants subtracted therefrom, by cos α

and sin α

as denoted in Equation (d) to obtain corresponding x-axis and y-axis measurement values, subtracts the y-axis measurement value from the x-axis measurement value as denoted in Equation (e) to create Equation (f), and determines the sign of the road angle using Equation (f), as set forth below;

{circumflex over (f)}_x cos α

=a cos²α

+g sin α

cos θ

+g cos²α

cos α

sin θ

{circumflex over (f)}_y=sin α

−

a sin²α

+g sin α

cos α

cos θ

−

g sin²α

sin θ

 

 

(d)

{circumflex over (f)}_x cos α

−

{circumflex over (f)}_y sin α

=a+g sin θ

{circumflex over (f)}_x cos α

−

{circumflex over (f)}_y sin α

−

a=g sin θ

 

 

(e)

wherein f_x and f_y are values obtained by subtracting the irregular constants from the x-axis and y-axis measurement values of the accelerometer;

g is a gravitational constant;

α

is a mounting angle of the accelerometer; and

θ

is an angle of road inclination.

13. The apparatus according to claim 9, wherein said gravitational acceleration compensating section calculates a gravitational acceleration component included in the measurement data of the accelerometer using the road angle and removes the gravitational acceleration component from the measurement data.