Apparatus and method for measuring speed of a moving object

0Associated
Cases 
0Associated
Defendants 
0Accused
Products 
48Forward
Citations 
0
Petitions 
1
Assignment
First Claim
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.
1 Assignment
0 Petitions
Accused Products
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.
71 Citations
View as Search Results
Motion sensing and processing on mobile devices  
Patent #
US 7,907,838 B2
Filed 05/18/2010

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Altimeter with calibration  
Patent #
US 20110077898A1
Filed 11/04/2010

Current Assignee
Trimble Navigation Limited

Sponsoring Entity
Trimble Navigation Limited

Method and apparatus for estimating behaviors of vehicle using GPS signals  
Patent #
US 7,885,765 B2
Filed 07/26/2007

Current Assignee
DENSO Corporation

Sponsoring Entity
DENSO Corporation

Vertically integrated 3axis MEMS angular accelerometer with integrated electronics  
Patent #
US 7,934,423 B2
Filed 12/10/2007

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Method and apparatus for estimating behaviors of vehicle using GPS signals  
Patent #
US 20110093198A1
Filed 12/20/2010

Current Assignee
DENSO Corporation

Sponsoring Entity
DENSO Corporation

Dual mode sensing for vibratory gyroscope  
Patent #
US 8,020,441 B2
Filed 02/05/2008

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Vertically integrated 3axis MEMS accelerometer with electronics  
Patent #
US 8,047,075 B2
Filed 06/21/2007

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

INTEGRATED MULTIAXIS MOTION SENSOR  
Patent #
US 20100071467A1
Filed 09/24/2008

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

LOW INERTIA FRAME FOR DETECTING CORIOLIS ACCELERATION  
Patent #
US 20100064805A1
Filed 09/12/2008

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

SENSOR DEVICE  
Patent #
US 20100154540A1
Filed 12/07/2009

Current Assignee
Panasonic Corporation

Sponsoring Entity
Panasonic Corporation

Integrated Motion Processing Unit (MPU) With MEMS Inertial Sensing And Embedded Digital Electronics  
Patent #
US 20090007661A1
Filed 07/06/2007

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Velocity detection, position detection and navigation system  
Patent #
US 7,505,865 B2
Filed 08/28/2006

Current Assignee
Sony Corporation

Sponsoring Entity
Sony Corporation

Vertically integrated 3axis MEMS angular accelerometer with integrated electronics  
Patent #
US 20090145225A1
Filed 12/10/2007

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

INTERFACING APPLICATION PROGRAMS AND MOTION SENSORS OF A DEVICE  
Patent #
US 20090184849A1
Filed 04/21/2008

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

DUAL MODE SENSING FOR VIBRATORY GYROSCOPE  
Patent #
US 20090193892A1
Filed 02/05/2008

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

MOBILE DEVICES WITH MOTION GESTURE RECOGNITION  
Patent #
US 20090265671A1
Filed 10/15/2008

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

CONTROLLING AND ACCESSING CONTENT USING MOTION PROCESSING ON MOBILE DEVICES  
Patent #
US 20090303204A1
Filed 06/16/2009

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Acceleration compensated inclinometer  
Patent #
US 20090309793A1
Filed 06/11/2008

Current Assignee
Trimble Navigation Limited

Sponsoring Entity
Trimble Navigation Limited

Method and apparatus for estimating behaviors of vehicle using GPS signals  
Patent #
US 20080027645A1
Filed 07/26/2007

Current Assignee
DENSO Corporation

Sponsoring Entity
DENSO Corporation

Sensor Configuration  
Patent #
US 20080092643A1
Filed 10/19/2005

Current Assignee
Schlumberger Technology Corporation

Sponsoring Entity
Schlumberger Technology Corporation

VERTICALLY INTEGRATED 3AXIS MEMS ACCELEROMETER WITH ELECTRONICS  
Patent #
US 20080314147A1
Filed 06/21/2007

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Velocity detection, position detection and navigation system  
Patent #
US 20070067137A1
Filed 08/28/2006

Current Assignee
Sony Corporation

Sponsoring Entity
Sony Corporation

Acceleration compensated inclinometer  
Patent #
US 8,150,651 B2
Filed 06/11/2008

Current Assignee
Trimble Navigation Limited

Sponsoring Entity
Trimble Navigation Limited

Low inertia frame for detecting coriolis acceleration  
Patent #
US 8,141,424 B2
Filed 09/12/2008

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Method and apparatus for estimating behaviors of vehicle using GPS signals  
Patent #
US 8,170,797 B2
Filed 12/20/2010

Current Assignee
DENSO Corporation

Sponsoring Entity
DENSO Corporation

Integrated motion processing unit (MPU) with MEMS inertial sensing and embedded digital electronics  
Patent #
US 8,250,921 B2
Filed 07/06/2007

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Sensor device with timewise linked sensing signals  
Patent #
US 8,276,448 B2
Filed 12/07/2009

Current Assignee
Panasonic Corporation

Sponsoring Entity
Panasonic Corporation

Motion sensing and processing on mobile devices  
Patent #
US 8,351,773 B2
Filed 03/11/2011

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

INCLINATION ANGLE COMPENSATION SYSTEMS AND METHODS  
Patent #
US 20130080112A1
Filed 09/28/2011

Current Assignee
Caterpillar Incorporated

Sponsoring Entity
Caterpillar Incorporated

Controlling and accessing content using motion processing on mobile devices  
Patent #
US 8,462,109 B2
Filed 06/16/2009

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Accelerometer using acceleration  
Patent #
US 8,498,793 B1
Filed 02/22/2012

Current Assignee
Trimble Navigation Limited

Sponsoring Entity
Trimble Navigation Limited

Wafer scale chip scale packaging of vertically integrated MEMS sensors with electronics  
Patent #
US 8,508,039 B1
Filed 05/08/2008

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Inclinometer Using Acceleration  
Patent #
US 8,532,899 B1
Filed 02/17/2012

Current Assignee
Trimble Navigation Limited

Sponsoring Entity
Trimble Navigation Limited

Low inertia frame for detecting coriolis acceleration  
Patent #
US 8,539,835 B2
Filed 03/22/2012

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Inclinometer with calibration  
Patent #
US 8,566,034 B1
Filed 12/02/2010

Current Assignee
Trimble Navigation Limited

Sponsoring Entity
Trimble Navigation Limited

Interfacing application programs and motion sensors of a device  
Patent #
US 8,952,832 B2
Filed 04/21/2008

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Vertically integrated 3axis MEMS angular accelerometer with integrated electronics  
Patent #
US 8,960,002 B2
Filed 04/28/2011

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Integrated motion processing unit (MPU) with MEMS inertial sensing and embedded digital electronics  
Patent #
US 8,997,564 B2
Filed 06/08/2012

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Inclination angle compensation systems and methods  
Patent #
US 9,020,776 B2
Filed 09/28/2011

Current Assignee
Caterpillar Incorporated

Sponsoring Entity
Caterpillar Incorporated

Seismic sensor with four uniaxial motion sensing elements having substantially the same angle to the vertical and horizontal directions  
Patent #
US 9,057,643 B2
Filed 03/11/2013

Current Assignee
Schlumberger Technology Corporation

Sponsoring Entity
Schlumberger Technology Corporation

AccelerometerBased Hill Angle Estimation  
Patent #
US 20150176989A1
Filed 12/23/2013

Current Assignee
Verizon Patent and Licensing Incorporated

Sponsoring Entity
Verizon Patent and Licensing Incorporated

Inclination detection systems and methods  
Patent #
US 9,145,144 B2
Filed 09/28/2011

Current Assignee
Caterpillar Incorporated

Sponsoring Entity
Caterpillar Incorporated

Altimeter with calibration  
Patent #
US 9,157,737 B2
Filed 11/04/2010

Current Assignee
Trimble Navigation Limited

Sponsoring Entity
Trimble Navigation Limited

Controlling and accessing content using motion processing on mobile devices  
Patent #
US 9,292,102 B2
Filed 06/05/2013

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Interfacing application programs and motion sensors of a device  
Patent #
US 9,342,154 B2
Filed 01/06/2015

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Interfacing application programs and motion sensors of a device  
Patent #
US 9,811,174 B2
Filed 04/28/2015

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

MEMS rotation sensor with integrated electronics  
Patent #
US 9,846,175 B2
Filed 01/27/2015

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Integrated motion processing unit (MPU) with MEMS inertial sensing and embedded digital electronics  
Patent #
US 10,288,427 B2
Filed 03/19/2015

Current Assignee
Invensense Incorporated

Sponsoring Entity
Invensense Incorporated

Intelligent vehicle rollover detection methods and systems  
Patent #
US 7,162,343 B2
Filed 09/17/2004

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Global Technologies LLC

Vehicle stabilizing control apparatus  
Patent #
US 20060041367A1
Filed 08/17/2005

Current Assignee
Kabushiki Kaisha Toyota Chuo Kenkyusho

Sponsoring Entity
Kabushiki Kaisha Toyota Chuo Kenkyusho

Roll angle control device for remotecontrolled twowheeled vehicle  
Patent #
US 20060085111A1
Filed 06/16/2003

Current Assignee
Satoru Kojima

Sponsoring Entity
Satoru Kojima

Vehicle rollover detection system  
Patent #
US 7,057,503 B2
Filed 03/19/2003

Current Assignee
TK Holdings Incorporated

Sponsoring Entity
TK Holdings Incorporated

System and method for determining a wheel departure angle for a rollover control system with respect to road roll rate and loading misalignment  
Patent #
US 7,079,928 B2
Filed 02/11/2004

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Global Technologies LLC

VEHICULAR RESTRAINT SYSTEM CONTROL SYSTEM AND METHOD USING MULTIPLE OPTICAL IMAGERS  
Patent #
US 20060208169A1
Filed 08/31/2004

Current Assignee
American Vehicular Sciences LLC

Sponsoring Entity
American Vehicular Sciences LLC

Wheel lifted and grounded identification for an automotive vehicle  
Patent #
US 7,109,856 B2
Filed 06/27/2003

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Global Technologies LLC

ATTITUDE SENSING SYSTEM FOR AN AUTOMOTIVE VEHICLE RELATIVE TO THE ROAD  
Patent #
US 20060235575A1
Filed 04/14/2005

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Global Technologies LLC

System for determining vehicular relative roll angle during a potential rollover event  
Patent #
US 7,136,731 B2
Filed 06/11/2003

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Global Technologies LLC

Apparatus and method for measuring speed of a moving object  
Patent #
US 20060293826A1
Filed 03/28/2006

Current Assignee
Samsung Electronics Co. Ltd.

Sponsoring Entity
Samsung Electronics Co. Ltd.

Angular velocity detection device  
Patent #
US 20040204798A1
Filed 02/04/2004

Current Assignee
Pioneer Corporation

Sponsoring Entity
Pioneer Corporation

Lateral inclination angle detector for passengerprotecting device for use in automotive vehicle  
Patent #
US 6,827,172 B2
Filed 11/22/2002

Current Assignee
DENSO Corporation

Sponsoring Entity
DENSO Corporation

Vehicle rollover detection system  
Patent #
US 20030182041A1
Filed 03/19/2003

Current Assignee
TK Holdings Incorporated

Sponsoring Entity
TK Holdings Incorporated

Method and apparatus for inertial guidance for an automobile navigation system  
Patent #
US 6,282,496 B1
Filed 10/29/1999

Current Assignee
TomTom Navigation B.V

Sponsoring Entity
Visteon Technologies LLC

Roll over detection for an automotive vehicle  
Patent #
US 6,332,104 B1
Filed 12/21/1999

Current Assignee
Ford Motor Company

Sponsoring Entity
Ford Global Technologies LLC

Method and apparatus for eliminating noise in a slope estimation arrangement for a motor vehicle  
Patent #
US 5,925,087 A
Filed 08/27/1993

Current Assignee
Hitachi Ltd.

Sponsoring Entity
Hitachi Ltd.

Vehicle navigator for calculating distance based on mean acceleration  
Patent #
US 5,986,583 A
Filed 05/09/1997

Current Assignee
Matsushita Electric Industrial Company Limited

Sponsoring Entity
Matsushita Electric Industrial Company Limited

Inertial navigation with gravity deflection compensation  
Patent #
US 5,774,832 A
Filed 04/19/1996

Current Assignee
Honeywell Incorporated

Sponsoring Entity
Honeywell Incorporated

Movement detecting device  
Patent #
US 5,828,987 A
Filed 04/22/1997

Current Assignee
DATA TEC CO. LTD.

Sponsoring Entity
DATA TEC CO. LTD.

Method and apparatus for estimating incline and bank angles of a road surface  
Patent #
US 5,446,658 A
Filed 06/22/1994

Current Assignee
General Motors Corporation

Sponsoring Entity
General Motors Corporation

Process for compensating acceleration sensor errors  
Patent #
US 5,265,472 A
Filed 07/26/1990

Current Assignee
Daimler Benz AG

Sponsoring Entity
Daimler Benz AG

Electronic inclination gauge with acceleration compensation  
Patent #
US 4,531,300 A
Filed 05/07/1984

Current Assignee
Honeywell Incorporated

Sponsoring Entity
Sperry Corporation

Device for tilting the body of a highspeed vehicle relative to an underframe thereof  
Patent #
US 4,267,736 A
Filed 02/09/1977

Current Assignee
Westbeck Navitele AB

Sponsoring Entity
Westbeck Navitele AB

16 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.  View Dependent Claims (2, 3, 4, 5, 6)
 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.  View Dependent Claims (8, 9, 10, 11)
 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.  View Dependent Claims (13, 14, 15, 16)
1 Specification
This application claims priority under 35 U.S.C. § 119 to an application entitled “Apparatus and Method for Measuring Speed of Moving Object” filed in the Korean Intellectual Property Office on May 13, 2005 and assigned Serial No. 200540359, the contents of which are incorporated herein by reference.
1. Field of the Invention
The present invention generally relates to an apparatus and method for measuring the speed of a moving object, and in particular, to an apparatus and method for measuring the speed of these moving objects based on a roll angle.
2. Description of the Related Art
Generally, moving objects such as vehicles, ships, and aircrafts have an embedded navigation system that determines the position of the moving object (positioning), routes a path to a given destination (routing), and provides the routing results.
In order to determine the position of a moving object and provide a path to the destination, navigation systems should be able to determine the exact position of a vehicle. Therefore, navigation systems generally include a positioning device for position determination. Such positioning devices are classified into two types, one for determining the position using an outside source and the other for determining the position using an inside sensor. A Global Positioning System (GPS) is an example of the former type of positioning device. A Dead Reckoning (DR) system using an inertial sensor is an example of the latter type of positioning device.
A DR system calculates the speed and position of a moving object using a gyroscope for detecting a rotational motion of the moving object and an accelerometer for detecting a straightline motion of the moving object. In particular, the speed of the moving object can be calculated using both speed information acquired from an acceleration measured by the accelerometer and moving direction information acquired from the gyroscope.
In general, the DR system measures the moving direction angle of a vehicle on a road and an acceleration in the moving direction of the vehicle, as well as calculates the moving speed vector of the vehicle using the moving direction angle of the vehicle and the acceleration in the moving direction of the vehicle. In order to measure the moving direction of the vehicle, the DR system requires a gyroscope installed on an axis perpendicular to a plane on which wheel axles (axis of axles) are placed and In order to measure the acceleration in the moving direction of the vehicle, the DR system requires the measurement value of a road inclination angle in addition to an accelerometer installed in the direction of the wheel axle (axis of axle).
The road inclination angle measurement value is required because a specific force component proportional to gravitational acceleration is included in the output of the accelerometer and the specific force component may be calculated from the road inclination angle. Since gravitational acceleration works perpendicularly to the surface of the earth spheroid (a spherical surface perpendicular to the directions of the gravitational acceleration) at all times, the angle of the axis of the accelerometer mounted in the vehicle (fixed in a particular direction within the vehicle) with respect to the surface of the earth spheroid changes, thereby resulting in a change in the specific force component included in the output of the accelerometer.
In other words, if the road inclination angle changes, the direction of the axis of the accelerometer mounted in the vehicle is not perpendicular to the direction of gravitational acceleration. Thus, the accelerometer measures a rate of change in the actual speed of motion (an actual motional acceleration) including a component of gravitational acceleration.
Thus, for accurate speed measurement, a vehicle DR system must subtract the gravitational acceleration {right arrow over (g)} from the measurement value {right arrow over (a)} of the accelerometer and measures the road inclination angle θ to measure the gravitational acceleration {right arrow over (g)}.
The DR system for vehicles can measure the road inclination angle θ using a rotational angle with respect to the forward direction of a vehicle, a rotational angle with respect to the lateral direction of the vehicle perpendicular to the forward direction of the vehicle, and a rotational angle and a roll angle φ with respect to the lower direction of the vehicle perpendicular to the forward direction and the lateral direction of the vehicle. The roll angle φ means the amount of inclination of the vehicle with respect to the forward direction of the vehicle.
Referring to
where ω_{Y }is an angular speed along the Y axis, ω_{Z }is an angular speed along the Z axis, and φ is the roll angle of the vehicle. At this time, the roll angle φ means the angle of inclination of the vehicle along the X axis.
The change rate of the roll angle φ can be expressed in Equation (2) as follows:
where ω_{X }is an angular speed along the X axis. Equations (1) and (2) are wellknown relational expressions related to the change rate of an Euler angle.
Referring to Equation (2), to accurately calculate the change rate
of the roll angle φ, three axis gyroscopes are required for measuring the angular speed ω_{X }along the X axis, the angular speed ω_{Y }along the Y axis, and the angular speed ω_{Z }along the Z axis.
However, generally, a roll motion that is a rotational motion with respect to a wheel axle (axis of axle) (the X axis) connecting the front and rear sides of the vehicle and a straight line motion with respect to an axis (the Z axis) perpendicular to the ground surface is negligible during driving of the vehicle. Thus, conventionally, the road inclination angle θ is calculated only using the angular speed ω_{X }along the X axis and the angular speed ω_{Y }along the Y axis, irrespective of the roll angle φ and the angular speed ω_{Z }along the Z axis in Equation (2).
When the roll angle φ and the angular speed ω_{Z }along the Z axis are neglected, i.e., they are assumed to be 0, Equation (1) is
and the change rate
of the roll angle φ can be given as in Equation (3) by:
where ω_{r }can be calculated from the output of a gyroscope that measures an angular speed along an axis (the Y axis) passing through the lateral sides perpendicular to the forward direction of the vehicle and the road inclination angle θ is obtained by integrating ω_{r}.
However, when there are many curves on the road and thus the roll angle of the vehicle increases, the roll angle of the vehicle has a significant influence upon the road inclination angle. In addition, when the angular speed ω_{Z }along the Z axis is large in Equation (1), even if the roll angle of the vehicle is not large, the roll angle of the vehicle has a significant influence upon the road inclination angle. As a result, a conventional calculation of the road inclination angle θ, which neglects the roll angle of the vehicle, has a significant error.
In other words, in the case where the roll angle of the vehicle has a large influence upon the road inclination angle, the road inclination angle calculated using Equation (3) neglecting the roll angle of the vehicle has a difference with the actual road inclination angle, which increases over time. As a result, there are large differences between measured speed and position and actual speed and position. Thus, the road inclination angle should be calculated based on the roll angle of the vehicle.
In Equation (2), gyroscopes for the X axis, the Y axis, and the Z axis are required to calculate the change rate
of the roll angle φ based on the roll angle
φ. However, to use the gyroscope for three axes, additional gyroscopes must be mounted in a DR system, increasing the manufacturing cost of the DR system for measuring the speed of the vehicle.
It is, therefore, an object of the present invention to provide an apparatus and method for measuring the speed of a moving object based on roll movement.
It is still another object of the present invention to provide an apparatus and method for measuring the speed of a moving object based on roll movement by using an accelerometer, instead of additionally mounting gyroscopes.
To achieve one aspect of the present invention, there is provided an apparatus for measuring the speed of a moving object. The apparatus includes accelerometers, gyroscopes, a roll angle calculator, an inclination angle calculator, and a speed calculator. The accelerometers measure a first acceleration along the moving direction of the moving object and a second acceleration along the lateral direction of the moving object. The gyroscopes measure 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. The roll angle calculator calculates the 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 inclination angle calculator calculates a road inclination angle using the calculated roll angle, the first angular speed, and the second angular speed. The speed calculator calculates pure motion acceleration in the moving direction of the moving object using the calculated road inclination angle and calculates the speed of the moving object using the pure motion acceleration of the moving object.
To achieve another aspect of the present invention, there is also provided a method for measuring the speed of a moving object. The method includes the steps of measuring a first acceleration along the moving direction of the moving object and a second acceleration along the 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 the lower direction of the moving object, calculating the 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.
The above and other objects, features and advantages of the present invention will become more apparent from the following detailed description when taken in conjunction with the accompanying drawings in which:
A preferred embodiment of the present invention will now be described in detail with reference to the annexed drawings. In the following description, a detailed description of known functions and configurations incorporated herein has been omitted for conciseness.
An apparatus for measuring the speed of a moving object according to the present invention calculates the roll angle of the moving object using two axis gyroscopes and two axis accelerometers and measures the speed of the moving object based on the calculated roll angle.
Referring to
According to the present invention, the apparatus for measuring the speed of a moving object includes two gyroscopes that are located on the Y axis and the Z axis perpendicularly to each other, and two accelerometers located on the X axis and the Y axis also perpendicularly to each other.
A Yaxis gyroscope located on the Y axis measures the angular speed ω_{Y }along the Y axis and a Zaxis gyroscope located on the Z axis measures the angular speed ω_{Z }along the Z axis. An Xaxis accelerometer located on the X axis measures an acceleration f_{X }along the X axis and a Yaxis accelerometer located on the Y axis measures an acceleration f_{Y }along the Y axis.
When the constant of the gravitational acceleration is assumed to be g, the acceleration f_{X }along the X axis calculated by the Xaxis accelerometer is expressed in Equation (4) as follows:
f_{X}=a_{X}+g sin θ−ω_{Z}V_{Y}+ω_{Y}V_{Z} (4),
where a_{X }is an actual motion acceleration component of a moving object along the X axis, g is the constant of the gravitational acceleration, g sin θ is a gravitational acceleration component, and −ω_{Z}V_{Y}+ω_{Y}V_{Z }is an acceleration component caused by a rotational motion of the moving object. The acceleration f_{y }along the Yaxis calculated by the Yaxis accelerometer is expressed in Equation (5) as follows:
f_{Y}=a_{Y}−g sin φ cos θ+ω_{Z}V_{X}+ω_{X}V_{Z} (5);
where a_{Y }is an actual motion acceleration component of a moving object along the Y axis, g is the constant of the gravitational acceleration, −g sin θφ cos θ is a gravitational acceleration component, and ω_{Z}V_{X}+ω_{X}V_{Z }is an acceleration component caused by a rotational motion of the moving object.
In Equations (4) and (5), ω_{X }is an angular speed along the X axis, ω_{Y }is an angular speed along the Y axis, ω_{Z }is an angular speed along the Z axis, V_{X }is a speed component along the X axis, V_{Y }is a speed component along the Y axis, and V_{Z }is a speed component along the Z axis. “Since the vehicle nearly moves along a straight line in the direction of the X axis Vy and Vz in equation (4) are close to 0. Thus when Vy and Vz are assumed to be 0, the acceleration fx along the X axis is expressed in Equation (6) as follows:.”
f_{X}=a_{X}+g sin θ (6)
In order to acquire a gravitational acceleration component g sin θ included in the acceleration f_{X }along the X axis in Equation (6), the road inclination angle θ should be calculated first.
The road inclination angle θ can be calculated by integrating Equation (1), i.e.,
By integrating Equation (1), the road inclination angle θ at a time instant t is induced and expressed in Equation (7) as follows:
where θ_{0 }is the initial value of θ.
In order to calculate the road inclination angle θ in Equation (7), the roll angle φ should be acquired first. The roll angle φ can be calculated using Equation (5). When the acceleration component a_{Y }along the Y axis is assumed to be 0 in Equation (5), Equation (5) can be arranged as expressed in Equation (8) as follows:
f_{Y}=−g sin φ cos θ+ω_{Z}V_{X}+ω_{X}V_{Z} (8)
f_{Y }can be expressed as in Equation (9) for the roll angle φ as follows:
φ(sin^{−1}[(−f_{Y}+ω_{Z}V_{X})/g cos θ] (9),
where f_{Y }uses a measurement value of the Yaxis accelerometer, ω_{Z }uses a measurement value of the Zaxis gyroscope, a speed V_{X }along the X axis and the road inclination angle θ use their immediately previous estimates. The immediately previous estimates mean previous estimates V_{X }and θ. When there is no immediately previous estimate, predetermined initial values may be used.
By using the immediately previous estimates V_{X }and θ in Equation (9), the roll angle φ can be given by Equation (10) as follows:
{circumflex over (φ)}=sin^{−1}[(−f_{Y}+ω_{Z}{circumflex over (V)}_{X})/g cos {circumflex over (θ)}] (10)
By substituting a calculated roll angle estimate {circumflex over (θ)} into Equation (1), a road inclination angle change rate {circumflex over ({dot over (θ)} is expressed in Equation (11) as follows:
{circumflex over ({dot over (θ)}=ω_{Y }cos {circumflex over (θ)}−ω_{Z }sin {circumflex over (φ)} (11)
By substituting a measurement value ω_{Y }of the Yaxis gyroscope and a measurement value ω_{Z }of the Zaxis gyroscope into Equation (11), the road inclination angle change rate {circumflex over ({dot over (θ)} is calculated and is then integrated with respect to a time axis to acquire the road inclination angle θ.
The gravitational acceleration component g sin θ included in the acceleration measurement value f_{X }along the X axis in Equation (6) can be acquired using the calculated road inclination angle θ.
By subtracting the gravitational acceleration component g sin θ from the acceleration f_{X }along the X axis, a pure motion acceleration of the moving object along the X axis is acquired as expressed in Equation (12) as follows:
a_{X}=f_{X}−g sin θ (12)
By integrating the pure motion acceleration a_{X }acquired using Equation (12) with respect to the time axis, a pure speed V_{X }of the moving object along the X axis can be acquired.
Thus, the apparatus for measuring the speed of a moving object according to the present invention can accurately measure a pure motion speed of the moving object using the principles described above.
Hereinafter, the configuration of the apparatus for measuring the speed of a moving object according to the present invention will be described in detail below.
The Xaxis accelerometer 110 measures a first acceleration, i.e., the acceleration f_{X }along the X axis. The Yaxis accelerometer 120 measures a second acceleration, i.e., the acceleration f_{Y }along the Y axis. The Yaxis gyroscope 130 measures a first angular speed, i.e., the angular speed ω_{Y }along the Y axis. The Zaxis gyroscope 140 measures a second angular speed, i.e., the angular speed ω_{Z }along the Z axis.
The sensor data processor 150 processes the acceleration measurement values f_{X }and f_{Y }output from the Xaxis accelerometer 110 and the Yaxis accelerometer 120 and the angular speed measurement values ω_{Y }and ω_{Z }output from the Yaxis gyroscope 130 and the Zaxis gyroscope 140. In other words, the sensor data processor 150 corrects the acceleration measurement values f_{X }and f_{Y }and the angular speed measurement values ω_{Y }and ω_{Z }and provides correction data to the roll angle calculator 160.
The roll angle calculator 160 calculates the roll angle φ of a moving object using the acceleration measurement value f_{Y }along the Y axis, the angular speed measurement value ω_{Z }along the Z axis, a previous speed V_{X }along the X axis, and a previous road inclination angle θ. In other words, the roll angle calculator 160 arranges Equation (5) for the acceleration f_{Y }measured by the Yaxis gyroscope 130 to Equation (9) for the roll angle φ. The roll angle calculator 160 calculates the roll angle φ by substituting the acceleration measurement value f_{Y }along the Y axis, the angular speed measurement value ω_{Z }along the Z axis, the previous speed V_{X }along the X axis, and the previous road inclination angle θ into Equation (9). At this time, the previous speed V_{X }along the X axis and the previous road inclination angle θ are immediately previous estimates. The immediately previous estimates mean previous estimates V_{X }and θ. When there is no immediately previous estimate, predetermined initial values may be used.
The inclination angle calculator 170 calculates the road inclination angle θ using the roll angle φ calculated by the roll angle calculator 160, the angular speed ω_{Y }measured by the Yaxis gyroscope 130, and the angular speed ω_{Z }measured by the Zaxis gyroscope 140. In other words, the inclination angle calculator 170 acquires Equation (10) for the roll angle φ using immediately previous estimates V_{X }and θ and calculates a road inclination angle change rate using Equation (11) by substituting Equation (10) into Equation (1). The inclination angle calculator 170 substitutes the calculated roll angle φ, the angular speed ω_{Y }measured by the Yaxis gyroscope 130, and the angular speed ω_{Z }measured by the Zaxis gyroscope 140 into Equation (11) and integrates the road inclination angle change rate with respect to the time axis, thereby calculating the road inclination angle θ.
The speed calculator 180 calculates an accurate speed of the moving object using the road inclination angle θ calculated by the inclination angle calculator 170 and the acceleration measurement value f_{X }along the X axis. In other words, the speed calculator 180 calculates the gravitational acceleration component g sin θ in Equation (6) for the acceleration f_{X }by using the road inclination angle θ. The speed calculator 180 subtracts the gravitational acceleration component g sin θ from the acceleration measurement value f_{X}, thereby calculating the pure motion acceleration of the moving object along the X axis as in Equation (12).
The data storage unit 190 stores the road inclination angle θ calculated by the inclination angle calculator 170 and the pure speed V_{X }of the moving object calculated by the speed calculator 180 and provides the stored previous road inclination angle θ and the stored previous pure speed V_{X }of the moving object to the roll angle calculator 160. Thus, the roll angle calculator 160 can calculate the roll angle φ using the acceleration measurement value f_{Y}, the angular speed measurement value ω_{Z}, the previous pure speed V_{X}, and the previous road inclination angle θ.
Hereinafter, a method for measuring the speed of a moving object according to the present invention will be described in detail.
In step 404 of
In step 406 of
After the acceleration measurement value f_{Y }and the angular speed measurement values ω_{Z }and ω_{Y }are acquired, the roll angle φ is calculated in step 408 of
After calculation of the roll angle X, the road inclination change rate is calculated in step 410 of
In step 412 of
In step 416 of
In other words, according to the present invention, the speed of a moving object can be accurately measured based on the roll angle of the moving object.
Such comparisons are performed because the speed of the moving object measured using a GPS has a small error when compared to an actual speed of the moving object. Thus, in the present invention, it is assumed that the speed of the moving object measured using a GPS is an actual speed of the moving object.
As a first comparison result, referring to
Referring to
As a second comparison result, referring to
Referring to
When
As described above herein, according to the present invention, the speed of the moving object can be accurately measured based on the roll angle of the moving object.
In addition, already mounted accelerometers are used without further mounting of expensive and bulky gyroscopes for measurement based on the roll angle of the moving object, thereby reducing the manufacturing cost of a DR system.
Furthermore, by accurately measuring the speed of the moving object, accuracy in positioning of the moving object using the speed of the moving object can be improved.
While the present invention has been shown and described with reference to a preferred embodiment thereof, it will be understood by those skilled in the art that various changes in form and details may be made therein without departing from the spirit and scope of the invention.