Apparatus and method for measuring speed of a moving object

• US 7,289,898 B2
• Filed: 03/28/2006
• Issued: 10/30/2007
• Est. Priority Date: 05/13/2005
• Status: Active Grant

• Current Assignee: Samsung Electronics Co. Ltd.
• Original Assignee: Samsung Electronics Co. Ltd.
• Inventors: Lee, Jae-Myeon, Hong, Hyun-Su
• Primary Examiner(s): Black; Thomas
• Assistant Examiner(s): Peche; Jorge O
• Application Number:
  US11/391,595
• Publication Number:
  US 20060293826A1
• Time in Patent Office: 581 Days
• Field of Search: 701/1, 701/38, 701/41, 701/213, 701/215, 701/96, 701/116, 734/88, 298/40, 297/40, 297/43, 298/32, 89/411.1, 89/370.1, 702/150, 340/988, 342/357, 364/566, 364/449.7
• US Class Current: 701/96
• CPC Class Codes: B60W 2520/16 Pitch
• CPC Class Codes: B60W 2520/18 Roll
• CPC Class Codes: G01C 21/16 by integrating acceleration or speed, i.e. inertial navigation
• CPC Class Codes: G01P 15/00 Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
• CPC Class Codes: G01P 15/18 in two or more dimensions
• CPC Class Codes: G01P 7/00 Measuring speed by integrating acceleration measuring travelled distance by double integration of acceleration G01C21/16

Abstract

An apparatus and method for measuring the speed of a moving object is provided. A first acceleration along the moving direction of the moving object and a second acceleration along the lateral direction of the moving object are measured. A first angular speed along the lateral direction of the moving object and a second angular speed along the lower direction of the moving object are measured. The roll angle of the moving object using the second acceleration, the second angular speed, and a previous speed of the moving object in the moving direction of the moving object, and a previous road inclination angle with respect to the moving direction of the moving object are calculated. A road inclination angle is calculated using the calculated roll angle, the first angular speed, and the second angular speed. A pure motion acceleration in the moving direction of the moving object is calculated using the calculated road inclination angle and the speed of the moving object is calculated using the pure motion acceleration of the moving object.

Claims

1. An apparatus for measuring the speed of a moving object using a Dead Reckoning (DR) system connected to the object, the apparatus comprising:

accelerometers for measuring a first acceleration along a moving direction of the moving object and a second acceleration along a lateral direction of the moving object;

gyroscopes for measuring a first angular speed along the lateral direction of the moving object and a second angular speed along a lower direction of the moving object;

a roll angle calculator for calculating a roll angle of the moving object using the second acceleration, the second angular speed, a previous speed of the moving object in the moving direction of the moving object, and a previous road inclination angle with respect to the moving direction of the moving object;

an inclination angle calculator for calculating a road inclination angle using the calculated roll angle, the first angular speed, and the second angular speed; and

a speed calculator for calculating a pure motion acceleration in the moving direction of the moving object using the calculated road inclination angle and for calculating the speed of the moving object using the pure motion acceleration of the moving object.

2. The apparatus of claim 1, further comprising a data storage unit for storing the calculated road inclination angle and the calculated speed in the moving direction of the moving object and for providing the previous road inclination angle and the previous speed in the moving direction of the moving object to the roll angle calculator.

3. The apparatus of claim 1, wherein the roll angle calculator uses predetermined initial values in the absence of either the previous speed in the moving direction of the moving object or the previous road inclination angle with respect to the moving direction of the moving object.

4. The apparatus of claim 1, wherein the speed calculator arranges an equation for the second acceleration to an equation for the roll angle of the moving object and substitutes the second acceleration, the second angular speed, the previous speed in the moving direction of the moving object, and the previous road inclination angle with respect to the moving direction of the moving object into the equation for the roll angle of the moving object, thereby calculating the roll angle of the moving object.

5. The apparatus of claim 1, wherein the roll angle calculator calculates a gravitational acceleration component included in the first acceleration using the road inclination angle and subtracts the gravitational acceleration component from the first acceleration, thereby calculating the pure motion acceleration in the moving direction of the moving object.

6. The apparatus of claim 1, wherein the first and second accelerations are two axis accelerations.

7. A method for measuring the speed of a moving object using a Dead Reckoning (DR) system connected to the object, the method comprising the steps of:

measuring a first acceleration along a moving direction of the moving object and a second acceleration along a lateral direction of the moving object, the first and second accelerations are measured using a first and second accelerometer, respectively;

measuring a first angular speed along the lateral direction of the moving object and a second angular speed along a lower direction of the moving object, the first and second angular speeds are measured using a first and second gyroscope, respectively;

calculating a roll angle of the moving object using the second acceleration, the second angular speed, a previous speed of the moving object in the moving direction of the moving object, and a previous road inclination angle with respect to the moving direction of the moving object, the roll angle is measured using a roll angle calculator;

calculating a road inclination angle using the calculated roll angle, the first angular speed, and the second angular speed, the road inclination angle is measured using an inclination angle calculator; and

calculating a pure motion acceleration in the moving direction of the moving object using the calculated road inclination angle and calculating the speed of the moving object using the pure motion acceleration of the moving object, the pure motion acceleration is measured using a speed calculator.

8. The method of claim 7, further comprising storing the calculated road inclination angle and the calculated speed in the moving direction of the moving object.

9. The method of claim 7, further comprising calculating the roll angle of the moving object using predetermined initial values if there is neither the previous speed in the moving direction of the moving object nor the previous road inclination angle.

10. The method of claim 7, wherein the step of calculating the roll angle of the moving object comprises:

arranging an equation for the second acceleration to an equation for the roll angle of the moving object;

acquiring the second acceleration, the second angular speed, the previous speed in the moving direction of the moving object, and the previous road inclination angle with respect to the moving direction of the moving object; and

substituting the second acceleration, the second angular speed, the previous speed in the moving direction of the moving object, and the previous road inclination angle with respect to the moving direction of the moving object into the equation for the roll angle of the moving object, thereby calculating the roll angle of the moving object.

11. The method of claim 7, wherein the step of acquiring the pure motion acceleration in the moving direction of the moving object comprises:

acquiring a gravitational acceleration component included in the first acceleration using the road inclination angle; and

subtracting the gravitational acceleration component from the first acceleration, thereby calculating the pure motion acceleration in the moving direction of the moving object.

12. A computer readable recording medium in which a program for executing a method of measuring the speed of a moving object in a Dead Reckoning (DR) system connected to the object is recorded, the method comprising:

measuring a first acceleration along a moving direction of the moving object and a second acceleration along a lateral direction of the moving object;

measuring a first angular speed along the lateral direction of the moving object and a second angular speed along a lower direction of the moving object;

calculating a roll angle of the moving object using the second acceleration, the second angular speed, a previous speed of the moving object in the moving direction of the moving object, and a previous road inclination angle with respect to the moving direction of the moving object;

calculating a road inclination angle using the calculated roll angle, the first angular speed, and the second angular speed; and

calculating a pure motion acceleration in the moving direction of the moving object using the calculated road inclination angle and calculating the speed of the moving object using the pure motion acceleration of the moving object.

13. The method of claim 12, further comprising storing the calculated road inclination angle and the calculated speed in the moving direction of the moving object.

14. The method of claim 12, further comprising calculating the roll angle of the moving object using predetermined initial values if there is neither the previous speed in the moving direction of the moving object nor the previous road inclination angle.

15. The method of claim 12, wherein the step of calculating the roll angle of the moving object comprises:

arranging an equation for the second acceleration to an equation for the roll angle of the moving object;

acquiring the second acceleration, the second angular speed, the previous speed in the moving direction of the moving object, and the previous road inclination angle with respect to the moving direction of the moving object; and

substituting the second acceleration, the second angular speed, the previous speed in the moving direction of the moving object, and the previous road inclination angle with respect to the moving direction of the moving object into the equation for the roll angle of the moving object, thereby calculating the roll angle of the moving object.

16. The method of claim 12, wherein the step of calculating the pure motion acceleration in the moving direction of the moving object comprises:

acquiring a gravitational acceleration component included in the first acceleration using the road inclination angle; and

subtracting the gravitational acceleration component from the first acceleration, thereby calculating the pure motion acceleration in the moving direction of the moving object.