GPSEnhanced Vehicle Velocity Estimation

0Associated
Cases 
0Associated
Defendants 
0Accused
Products 
20Forward
Citations 
0
Petitions 
8
Assignments
First Claim
1. A method of estimating vehicle velocity for a vehicle using a singleantenna global positioning system (GPS), the method comprising the steps of:
 measuring an absolute speed and a course heading angle of the vehicle using the singleantenna GPS;
measuring yaw rates of the vehicle independently of the GPS;
calculating an integrated yaw rate of the vehicle as a function of the measured yaw rates over a period of time;
determining a yaw angle as a function of an initialized yaw angle and the integrated yaw rate;
calculating a side slip angle as a function of the yaw angle and the course heading angle provided by the GPS;
determining the vehicle velocity as a function of the absolute speed and the side slip angle; and
providing the vehicle velocity to a vehicle dynamic control application.
8 Assignments
0 Petitions
Accused Products
Abstract
A method is provided for estimating vehicle velocity for a vehicle using a singleantenna global positioning system (GPS). An absolute speed and a course angle of the vehicle is measured using the singleantenna GPS. The yaw rates of the vehicle are measured independently of the GPS. An integrated yaw rate of the vehicle is calculated as a function of the measured yaw rates over a period of time. A yaw angle is determined as a function of a reference yaw angle and the integrated yaw rate. Aside slip angle is calculated as a function of the estimated yaw angle and the course angle provided by the GPS. The vehicle velocity is determined as a function of the absolute speed and the side slip angle. The vehicle velocity is provided to a vehicle dynamic control application.
28 Citations
View as Search Results
Using telematics data including position data and vehicle analytics to train drivers to improve efficiency of vehicle use  
Patent #
US 10,223,935 B2
Filed 07/24/2018

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

Method and apparatus for matching vehicle ECU programming to current vehicle operating conditions  
Patent #
US 10,241,966 B2
Filed 07/21/2017

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

Method and apparatus for matching vehicle ECU programming to current vehicle operating conditions  
Patent #
US 10,289,651 B2
Filed 07/21/2017

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

Method and apparatus for changing vehicle behavior based on current vehicle location and zone definitions created by a remote user  
Patent #
US 10,099,706 B2
Filed 11/18/2016

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

Method and apparatus for GPS based Zaxis difference parameter computation  
Patent #
US 10,102,096 B2
Filed 07/01/2016

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

Vehicle performance based on analysis of drive data  
Patent #
US 9,527,515 B2
Filed 01/25/2016

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

Vehicle location accuracy  
Patent #
US 9,650,039 B2
Filed 03/20/2015

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Global Technologies LLC

Automatic incorporation of vehicle data into documents captured at a vehicle using a mobile computing device  
Patent #
US 9,563,869 B2
Filed 05/27/2014

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

Using telematics data including position data and vehicle analytics to train drivers to improve efficiency of vehicle use  
Patent #
US 10,056,008 B1
Filed 03/14/2014

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

Mobile computing device for fleet telematics  
Patent #
US 10,185,455 B2
Filed 10/04/2013

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

Using social networking to improve driver performance based on industry sharing of driver performance data  
Patent #
US 9,412,282 B2
Filed 12/21/2012

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

Method and apparatus for 3D accelerometer based slope determination, realtime vehicle mass determination, and vehicle efficiency analysis  
Patent #
US 9,489,280 B2
Filed 12/21/2012

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

METHOD AND APPARATUS FOR GPS BASED SLOPE DETERMINATION, REALTIME VEHICLE MASS DETERMINATION, AND VEHICLE EFFICIENCY ANALYSIS  
Patent #
US 20130166170A1
Filed 12/18/2012

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

Method and apparatus for GPS based slope determination, realtime vehicle mass determination, and vehicle efficiency analysis  
Patent #
US 9,280,435 B2
Filed 12/18/2012

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

Method and apparatus for GPS based slope determination, realtime vehicle mass determination, and vehicle efficiency analysis  
Patent #
US 9,384,111 B2
Filed 12/18/2012

Current Assignee
Zonar Systems Incorporated

Sponsoring Entity
Zonar Systems Incorporated

Lane tracking system  
Patent #
US 9,139,203 B2
Filed 11/04/2011

Current Assignee
GM Global Technology Operations LLC

Sponsoring Entity
GM Global Technology Operations LLC

GPS BASED PITCH SENSING FOR AN INTEGRATED STABILITY CONTROL SYSTEM  
Patent #
US 20110087398A1
Filed 09/23/2010

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Global Technologies LLC

GPS based pitch sensing for an integrated stability control system  
Patent #
US 9,403,415 B2
Filed 09/23/2010

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Global Technologies LLC

Systems and Methods for Controlling a Vehicle Along a Road With a Road Bank  
Patent #
US 20110257827A1
Filed 04/19/2010

Current Assignee
GM Global Technology Operations LLC

Sponsoring Entity
GM Global Technology Operations LLC

Systems and methods for controlling a vehicle along a road with a road bank  
Patent #
US 8,509,993 B2
Filed 04/19/2010

Current Assignee
GM Global Technology Operations LLC

Sponsoring Entity
GM Global Technology Operations LLC

Dynamicbased method of estimating the absolute roll angle of a vehicle body  
Patent #
US 20090299546A1
Filed 05/28/2008

Current Assignee
Delphi Technologies Inc.

Sponsoring Entity
Delphi Technologies Inc.

Vehicle AntiSkid Brake Control System and Its Control Method  
Patent #
US 20080319611A1
Filed 01/25/2006

Current Assignee
BYD Company Limited

Sponsoring Entity
BYD Company Limited

Integrated vehicle control system using dynamically determined vehicle conditions  
Patent #
US 20070067085A1
Filed 09/19/2005

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Global Technologies LLC

Navigation system applications of sigmapoint Kalman filters for nonlinear estimation and sensor fusion  
Patent #
US 20050251328A1
Filed 04/04/2005

Current Assignee
Wan Eric A., Julier Simon J., Merwe Rudolph van der

Sponsoring Entity
Wan Eric A., Julier Simon J., Merwe Rudolph van der

Method for determining a longitudinal vehicle velocity by compensating individual wheel speeds  
Patent #
US 6,847,875 B2
Filed 10/30/2003

Current Assignee
Ford Motor Company, Ford Global Technologies LLC

Sponsoring Entity
Ford Motor Company, Ford Global Technologies LLC

Method for determining a longitudinal vehicle velocity by compensating individual wheel speeds using pitch attitude  
Patent #
US 6,915,193 B2
Filed 10/30/2003

Current Assignee
Ford Motor Company, Ford Global Technologies LLC

Sponsoring Entity
Ford Motor Company, Ford Global Technologies LLC

Vehicle dynamics measuring apparatus and method using multiple GPS antennas  
Patent #
US 6,671,587 B2
Filed 02/05/2002

Current Assignee
Ford Motor Company

Sponsoring Entity
Ford Motor Company

Vehicle guidance system  
Patent #
US 5,815,825 A
Filed 02/26/1996

Current Assignee
Ibaraki Toyota Jidosha Kabushiki Kaisha

Sponsoring Entity
Ibaraki Toyota Jidosha Kabushiki Kaisha

20 Claims
 1. A method of estimating vehicle velocity for a vehicle using a singleantenna global positioning system (GPS), the method comprising the steps of:
 measuring an absolute speed and a course heading angle of the vehicle using the singleantenna GPS;
measuring yaw rates of the vehicle independently of the GPS;
calculating an integrated yaw rate of the vehicle as a function of the measured yaw rates over a period of time;
determining a yaw angle as a function of an initialized yaw angle and the integrated yaw rate;
calculating a side slip angle as a function of the yaw angle and the course heading angle provided by the GPS;
determining the vehicle velocity as a function of the absolute speed and the side slip angle; and
providing the vehicle velocity to a vehicle dynamic control application.  View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19)
 measuring an absolute speed and a course heading angle of the vehicle using the singleantenna GPS;
 20. A system for determining a vehicle velocity for a vehicle comprising:
 a singleantenna global positioning system (GPS) for providing an absolute speed and a course heading angle of the vehicle;
vehicle sensors for providing yaw rate measurements independent of the GPS; and
a processor for calculating an integrated yaw rate, a yaw angle a side slip angle, and a vehicle velocity;
wherein integrated yaw rate of the vehicle is determined as a function of the measured yaw rates over a period of time, wherein the yaw angle is determined as a function of a reinitialized yaw angle and the integrated yaw rate, wherein the side slip angle is determined as a function of the determined yaw angle and the course angle provided by the GPS, wherein the vehicle velocity is determined as a function of the absolute speed and the side slip angle, and wherein the vehicle velocity is provided to a vehicle dynamic control application.
 a singleantenna global positioning system (GPS) for providing an absolute speed and a course heading angle of the vehicle;
1 Specification
An embodiment relates generally to vehicle velocity estimation.
Various vehicle safety and control systems benefit when utilizing an accurate longitudinal and/or lateral vehicle velocity. Devices for accurately measuring longitudinal and lateral velocity measurements, such as multiantenna GPS or optical sensors, are either too expensive or externally intrusive. The use of other types of sensors to measure longitudinal and lateral velocity, such as wheel speed sensors or even lateral acceleration sensors, have difficulties in providing accurate measurements when excessive wheel slip is present or when a banked road is present.
SUMMARY OF INVENTIONAn advantage of an embodiment is estimation of vehicle longitudinal and lateral velocities using singleantenna GPS data which provides greater accuracy than typical sensors utilized on vehicles. The GPS measurement data provides greater accuracy of the course heading angle and absolute speed which is used to estimate the longitudinal and lateral velocities. Use of a singleantenna GPS reduces cost as opposed to a multiantenna GPS and eliminates the requirement of expensive and high quality sensors when accurate velocity data is required. Moreover, vehicle dynamic applications benefit from having accurate data for controlling vehicle dynamic operations of the vehicle.
An embodiment contemplates a method for estimating vehicle velocity for a vehicle using a singleantenna global positioning system (GPS). An absolute speed and a course angle of the vehicle are measured using the singleantenna GPS. The yaw rates of the vehicle are measured independently of the GPS. An integrated yaw rate of the vehicle is calculated as a function of the measured yaw rates over a period of time. A yaw angle is determined as a function of a reference yaw angle and the integrated yaw rate. A side slip angle is calculated as a function of the estimated yaw angle and the course angle provided by the GPS. The vehicle velocity is determined as a function of the absolute speed and the side slip angle. The vehicle velocity is provided to a vehicle dynamic control application.
An embodiment contemplates a system for determining a vehicle velocity for a vehicle. A singleantenna global positioning system (GPS) provides an absolute speed and a course angle of the vehicle. Vehicle sensors provide yaw rate measurements independent of the GPS. A processor calculates an integrated yaw rate, a yaw angle, a side slip angle, and a vehicle velocity. Integrated yaw rate of the vehicle is determined as a function of the measured yaw rates over a period of time. The yaw angle is determined as a function of a reference yaw angle and the integrated yaw rate. The side slip angle is determined as a function of the estimated yaw angle and the course angle provided by the GPS. The vehicle velocity is determined as a function of the absolute speed and the side slip angle. The vehicle velocity is provided to a vehicle dynamic control application.
BRIEF DESCRIPTION OF DRAWINGSFIG. 1 is a vehicle velocity estimation system for a vehicle.
FIG. 2 is an illustration of a velocity vector model of a vehicle.
FIG. 3 is a flowchart for estimating longitudinal velocities and lateral velocities.
DETAILED DESCRIPTIONThere is shown in FIG. 1 a system 10 for determining a longitudinal velocity and a lateral velocity of a vehicle. The system includes a single antenna global positioning system (GPS) 12, and at least one sensor 14 that includes, but is not limited to, a yaw rate sensor, accelerometer, and velocity sensor. The system 10 further includes a processor 16 for processing the data received from the single antenna GPS 12 and the at least one sensor 14. The processor 16 determines a longitudinal velocity and a lateral velocity based on the data received by the single antenna GPS 12 and the at least one sensor 14. The longitudinal velocity and lateral velocity obtained from the processor 16 are provided to various vehicle safety and control systems which benefit from knowing an accurate vehicle longitudinal velocity and lateral velocity.
The single antenna GPS 12 utilizes only one antenna. GPS typically provides a very good velocity measurement that includes a velocity direction (i.e., course heading) and magnitude (i.e., absolute speed). For example, GPS velocity is significantly more accurate than the position data provided by a GPS, with errors on the order of 3 cm/s (1σ, horizontal velocity) and 6 cm/s (vertical velocity) without any differential corrections. Multiantenna GPS, which has more than two GPS antennas, also provides accurate yaw angles. A sideslip angle β can be determined by the course heading and yaw angle which is used to determine the lateral and longitudinal velocities.
FIG. 2 illustrates a velocity vector model of a vehicle. Given a longitudinal velocity v<sub>x </sub>and a lateral velocity v<sub>y </sub>at any point on the vehicle, the sideslip angle β can be determined. The sideslip angle is defined by the following equation:
<maths id="MATHUS00001" num="00001"><math overflow="scroll"><mtable><mtr><mtd><mrow><mi>β</mi><mo>=</mo><mrow><mrow><msup><mi>tan</mi><mrow><mo></mo><mn>1</mn></mrow></msup><mo></mo><mrow><mo>(</mo><mfrac><msub><mi>v</mi><mi>y</mi></msub><msub><mi>v</mi><mi>x</mi></msub></mfrac><mo>)</mo></mrow></mrow><mo>.</mo></mrow></mrow></mtd><mtd><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mtd></mtr></mtable></math></maths>
The sideslip angle β at a center of gravity (CG) is shown in FIG. 2. If the longitudinal and lateral velocities are not known, the sideslip angle β can be expressed by the following equation:
<FORM>β=γ−ψ (2)</FORM>
where β is a sideslip angle, γ is a velocity direction (i.e., course heading angle) of the vehicle, and ψ is the yaw angle of the vehicle.
Once the sideslip angle β is determined and the absolute speed ∥V∥ (i.e., the magnitude of the velocity vector of the vehicle) is obtained by the singleantenna GPS, the longitudinal velocity v<sub>x </sub>and the lateral velocity v<sub>y </sub>can be obtained by the following equations:
<FORM>v<sub>x</sub>=∥V∥cos(β) (3)</FORM>
<FORM>v<sub>y</sub>=∥V∥sin(β). (4)</FORM>
A singleantenna GPS provides a direct measurement of the velocity vector γ and the absolute speed ∥V∥; however, a singleantenna GPS does not provide a direct measurement of the vehicle yaw angle ψ. While a multiantenna GPS provides altitude measurements, such as yaw, pitch, and roll, the singleantenna GPS is limited to providing absolute speed and course heading angle with respect to the earth in addition to a position measurement. The yaw angle ψ cannot be directly measured by the singleantenna GPS. Therefore, the yaw angle ψ must be calculated using GPS data and vehicle sensor data as opposed to a direct measurement in order to calculate the sideslip angle β.
To obtain the yaw angle ψ, yaw rate data is used in cooperation with GPS data to estimate the yaw angle ψ. The yaw angle ψ is estimated by integrating yaw rate sensor measurements over a period of time. One drawback of integrating yaw rate measurements is that pure integration over time accumulates sensor errors such as noise and bias of the sensors. This contamination of noise and bias depends entirely on the quality of a yaw rate sensor. While bias and noise level of typical yaw rate sensors may not be high, the result is that the integration of the yaw rate sensor measurements is only valid for a few tens of seconds. Integration errors due to noise and bias grow quickly as time goes forward. An example of the error of a yaw rate integration, which is not meant to be a definitive time limit, is that the error becomes larger than 0.5 degrees in about 25 seconds. Therefore, the integration process needs to be either reset and initialized or updated continuously. With a lack of an accurate yaw angle measurement, the integration process cannot be updated continuously. Therefore, the yaw rate integration must be reinitialized after a period of time.
To reinitialize the yaw angle, a determination is made that the sideslip angle β is zero when the vehicle is traveling in a straightforward direction. It is determined from eq. (2) that the yaw angle ψ is equal to the course heading γ when the sideslip angle β is zero:
<FORM>γ=ψ (5)</FORM>
<FORM>when</FORM>
<FORM>β=0. (6)</FORM>
As a result, when the vehicle is going straight, the yaw angle ψ is reinitialized to the course heading angle γ. The yaw rate is also reinitialized by purging the past yaw rate and measuring yaw rates over a next period of time. A new integrated yaw rate is determined for the next period of time and used thereafter to update the yaw angle. The equation for estimating yaw angle as function of the integrated yaw rate and reinitialized yaw angle is as follows:
<maths id="MATHUS00002" num="00002"><math overflow="scroll"><mtable><mtr><mtd><mrow><mover><mi>ψ</mi><mo>^</mo></mover><mo>=</mo><mrow><mrow><msubsup><mo>∫</mo><mn>0</mn><mi>t</mi></msubsup><mo></mo><mrow><msub><mi>r</mi><mi>m</mi></msub><mo></mo><mstyle><mspace width="0.2em" height="0.2ex"/></mstyle><mo></mo><mrow><mo></mo><mi>t</mi></mrow></mrow></mrow><mo>+</mo><msub><mi>ψ</mi><mn>0</mn></msub></mrow></mrow></mtd><mtd><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mtd></mtr></mtable></math></maths>
where {circumflex over (ψ)} is the estimated yaw angle, r<sub>m </sub>is the yaw rate sensor measurement, ψ<sub>0 </sub>is the reinitialized yaw angle, and t is a duration of time in which yaw rate sensor measurements are integrated.
As a result, the side slip angle is estimated using the estimated yaw angle as determined in eq. (7) and the course heading angle γ as provided by the singleantenna GPS as indicated by the following equation:
<FORM>{circumflex over (β)}=γ<sub>m</sub><sup>GPS</sup>−{circumflex over (ψ)} (8)</FORM>
wherein {circumflex over (β)} is the estimated side slip angle, γ<sub>m</sub><sup>GPS </sup>is the course heading angle as measured by the singleantenna GPS, and {circumflex over (ψ)} is the estimated yaw angle determined by the integrated yaw rate.
In the event that the vehicle is continues traveling along a turn (i.e., nonstraightforward direction) in which the side slip cannot be reinitialized to zero, then the side slip angle {circumflex over (β)} can be estimated using the techniques described in copending application having a Ser. No. 12/276,965, filed on Nov. 24, 2008, which is incorporated by reference in its entirety.
Once the estimated side slip angle {circumflex over (β)} is known, estimated longitudinal velocities and lateral velocities can be calculated as follows using the absolute speed ∥V∥ determined by the singleantenna GPS and the estimated side slip angle {circumflex over (β)}:
<FORM>{circumflex over (v)}<sub>x</sub>=∥V∥cos({circumflex over (β)}) (9)</FORM>
<FORM>{circumflex over (v)}<sub>y</sub>=∥V∥sin({circumflex over (β)}) (10)</FORM>
An issue may still exist due to the update rate of the GPS velocity measurement when used to estimate the side slip angle, lateral velocity, and longitudinal velocity for vehicle dynamic applications. That is, vehicle dynamic applications benefit from receiving timely information and performing control actions accordingly. Some GPS receivers commonly have a 120 Hz update rate. Some vehicle dynamic applications, such as, but not limited to, vehicle stability control system require a faster update rate. Moreover, delays in measurements that are a result of the time required to process the signals form GPS satellites may take anywhere from tens of milliseconds to hundreds of milliseconds. This delay becomes even more significant when the GPS measurements are used with other vehicle sensor measurements such as the yaw rate sensor measurements. Due to the transmission and processing delays in the GPS system, the delayed GPS measurements and the other vehicle sensor measurements must be synchronized. The delay can be synchronized using the PPS (pulseper second) signal from the GPS receiver. PPS is a pulse signal that has either a rising or falling edge on each second in GPS time. As a result, each GPS measurement sample has a GPS time stamp and the GPS measurements can be synchronized with other sensor measurements since there is no delay in PPS through the GPS receiver.
To synchronize the GPS measurements and other sensor measurements, the delay is first determined using the PPS signal from the GPS receiver. The sensor measurements are buffered since there is no delay with respect to processing the sensor measurements. The buffered data associated with the beginning of the delay are utilized as the starting points and the estimated lateral velocity and longitudinal velocity are summed or reintegrated up to the current timestamp using the buffered data.
To incorporate the buffered data of the delay, let k be a past time and t<sub>k </sub>as a current time step, but the data is retrieved from time k steps in the past. At time t<sub>k</sub>, the following equations are based on the GPS measurement data:
<FORM>{circumflex over (v)}<sub>x</sub>(t)=∥V<sub>GPS</sub>(k)∥cos({circumflex over (β)}(k)) (11)</FORM>
<FORM>{circumflex over (v)}<sub>y</sub>(t)=∥V<sub>GPS</sub>(k)∥sin s({circumflex over (β)}(k)) (12)</FORM>
The goal is to find {circumflex over (v)}<sub>x</sub>(t) and {circumflex over (v)}<sub>y</sub>(t) where t represents the current time stamp. To determine {circumflex over (v)}<sub>x</sub>(t) and {circumflex over (v)}<sub>y</sub>(t) at the current time stamp t, various sensor measurements as well as calculated values obtained from the last GPS update k until the current time t are buffered. The various sensor measurements and calculated values include α<sub>x,m</sub>, α<sub>y,m</sub>, ψ, bank angle, and grade angles. Values that are not obtained through sensor measurements may be determined using the following relationships:
<FORM>α<sub>y,m</sub>={dot over (v)}<sub>y,estimate</sub>+r<sub>m</sub>·v<sub>x,sensor</sub>+α<sub>y,bias</sub>+g·sin φ<sub>r</sub>+w<sub>αy,m</sub> (13)</FORM>
<FORM>α<sub>x,m</sub>={dot over (v)}<sub>x,estimate</sub>−r<sub>m</sub>·v<sub>y,sensor</sub>+α<sub>x,bias</sub>+g·sin θ<sub>r</sub>+w<sub>αx,m</sub> (14)</FORM>
where α<sub>y,m </sub>is a lateral accelerometer measurement, α<sub>x,bias </sub>is a lateral accelerometer bias, r<sub>m </sub>is a yaw rate at a sensor location, {dot over (v)}<sub>y,estimate </sub>is a lateral velocity at the center of gravity of the vehicle, α<sub>y,bias </sub>is the lateral acceleration bias of a sensor, g is the gravity, φ<sub>r </sub>is the road grade, w<sub>αy,m </sub>is lateral accelerometer noise, α<sub>x,m </sub>is the longitudinal acceleration, {dot over (v)}<sub>x,estimate </sub>is the longitudinal velocity at the center of gravity of the vehicle, α<sub>x,bias </sub>is the longitudinal acceleration bias of the sensor, θ is the road grade, and w<sub>αx,m </sub>is longitudinal accelerometer noise.
For each discrete instance of time over the period of the delay (e.g., each k step), a new {circumflex over (v)}<sub>x</sub>(t) and {circumflex over (v)}<sub>y</sub>(t) is determined. The following equation represent the longitudinal velocity at a next instant of time within the delay period:
<FORM>{circumflex over (v)}<sub>x</sub>(t<sub>k+1</sub>)={circumflex over (v)}<sub>x</sub>(t<sub>k</sub>)+T<sub>s</sub>·(α<sub>x,m</sub>+r<sub>m</sub>·{circumflex over (v)}<sub>y</sub>(t<sub>k</sub>)−g·sin θ<sub>r</sub>) (15)</FORM>
where {circumflex over (v)}<sub>x</sub>(t<sub>k+1</sub>) is the longitudinal velocity at timestamp k+1, {circumflex over (v)}<sub>x</sub>(t<sub>k</sub>) is the longitudinal velocity at timestamp k, T<sub>s </sub>is the timestamp at a respective k, α<sub>x,m </sub>is the longitudinal velocity at the timestamp k, r<sub>m </sub>is the measured yaw rate, {circumflex over (v)}<sub>y </sub>(t<sub>k</sub>) is the lateral velocity at timestamp k, g is the gravity, θ is the road grade.The following equation represents the lateral velocity at a next time instance within the delay:
<FORM>{circumflex over (v)}<sub>y</sub>(t<sub>k+1</sub>)={circumflex over (v)}<sub>y</sub>(t<sub>k</sub>)+T<sub>s</sub>·(α<sub>y,m</sub>−r<sub>m</sub>·{circumflex over (v)}<sub>x</sub>(t<sub>k</sub>)−g·sin φ<sub>r</sub>) (16)</FORM>
where {circumflex over (v)}<sub>y</sub>(t<sub>k+1</sub>) is the lateral velocity at timestamp k+1, {circumflex over (v)}<sub>y</sub>(t<sub>k</sub>) is the lateral velocity at timestamp k, T<sub>s </sub>is the timestamp at a respective k, α<sub>y,m </sub>is the lateral velocity at the timestamp k, r<sub>m </sub>is the measured yaw rate, {circumflex over (v)}<sub>x</sub>(t<sub>k</sub>) is the longitudinal velocity at timestamp k, g is the gravity, and φ<sub>r </sub>is the road grade.
Since the bias and noise of the sensors are part of the measurement data, the bias and noise variables are dropped from the equation. After the longitudinal and lateral velocities are estimated for each instant of time (i.e., k steps), longitudinal and lateral vehicle velocities of the current timestamp based on the synchronization of the GPS measurements and buffered sensor measurement data are determined. The longitudinal velocity for the current timestamp is represented by the following formula:
<maths id="MATHUS00003" num="00003"><math overflow="scroll"><mtable><mtr><mtd><mrow><mrow><msub><mover><mi>v</mi><mo>^</mo></mover><mi>x</mi></msub><mo></mo><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow><mo>=</mo><mrow><mrow><munderover><mo>∑</mo><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>k</mi></munderover><mo></mo><mrow><msub><mover><mi>v</mi><mo>^</mo></mover><mi>x</mi></msub><mo></mo><mrow><mo>(</mo><msub><mi>t</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow></mrow><mo>+</mo><mrow><msub><mi>T</mi><mi>s</mi></msub><mo>·</mo><mrow><mo>(</mo><mrow><msub><mi>a</mi><mrow><mi>x</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>+</mo><mrow><msub><mi>r</mi><mrow><mi>m</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>·</mo><mrow><msub><mover><mi>v</mi><mo>^</mo></mover><mi>y</mi></msub><mo></mo><mrow><mo>(</mo><msub><mi>t</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow></mrow><mo></mo><mrow><mrow><mi>g</mi><mo>·</mo><mi>sin</mi></mrow><mo></mo><mstyle><mspace width="0.3em" height="0.3ex"/></mstyle><mo></mo><msub><mi>θ</mi><mrow><mi>r</mi><mo>,</mo><mi>i</mi></mrow></msub></mrow></mrow><mo>)</mo></mrow></mrow></mrow></mrow></mtd><mtd><mrow><mo>(</mo><mn>17</mn><mo>)</mo></mrow></mtd></mtr></mtable></math></maths>
where {circumflex over (v)}<sub>x</sub>(t) is the longitudinal velocity at time t, {circumflex over (v)}<sub>x</sub>(t<sub>i</sub>) is the longitudinal velocity at each timestamp i, T<sub>s </sub>is the time at each timestamp i, α<sub>x,m </sub>is the longitudinal acceleration at each timestamp i, r<sub>m,i </sub>is the measured yaw rate at time instant i, {circumflex over (v)}<sub>y</sub>(t<sub>i</sub>) is the lateral velocity at each timestamp i, g is the gravity, and θ is the road grade at each timestamp i.
Similarly, the lateral velocity of the current timestamp may be represented by the following equation:
<maths id="MATHUS00004" num="00004"><math overflow="scroll"><mtable><mtr><mtd><mrow><mrow><msub><mover><mi>v</mi><mo>^</mo></mover><mi>y</mi></msub><mo></mo><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow><mo>=</mo><mrow><mrow><munderover><mo>∑</mo><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>k</mi></munderover><mo></mo><mrow><msub><mover><mi>v</mi><mo>^</mo></mover><mi>y</mi></msub><mo></mo><mrow><mo>(</mo><msub><mi>t</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow></mrow><mo>+</mo><mrow><msub><mi>T</mi><mi>s</mi></msub><mo>·</mo><mrow><mo>(</mo><mrow><msub><mi>a</mi><mrow><mi>y</mi><mo>,</mo><mi>i</mi></mrow></msub><mo></mo><mrow><msub><mi>r</mi><mrow><mi>m</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>·</mo><mrow><msub><mover><mi>v</mi><mo>^</mo></mover><mi>x</mi></msub><mo></mo><mrow><mo>(</mo><msub><mi>t</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow></mrow><mo></mo><mrow><mrow><mi>g</mi><mo>·</mo><mi>sin</mi></mrow><mo></mo><mstyle><mspace width="0.3em" height="0.3ex"/></mstyle><mo></mo><msub><mi>φ</mi><mrow><mi>r</mi><mo>,</mo><mi>i</mi></mrow></msub></mrow></mrow><mo>)</mo></mrow></mrow></mrow></mrow></mtd><mtd><mrow><mo>(</mo><mn>18</mn><mo>)</mo></mrow></mtd></mtr></mtable></math></maths>
where {circumflex over (v)}<sub>y</sub>(t) is the lateral velocity at time t, {circumflex over (v)}<sub>y</sub>(t<sub>i</sub>) is the lateral velocity at each timestamp i, T<sub>s </sub>is the time at each timestamp i, α<sub>y,m </sub>is the lateral acceleration at each timestamp i, r<sub>m,i </sub>is the measured yaw rate at time instant i, {circumflex over (v)}<sub>x</sub>(t<sub>i</sub>) is the longitudinal velocity at each timestamp i, g is the gravity, and φ<sub>r,i </sub>is the road bank at each timestamp i.
The longitudinal vehicle velocity {circumflex over (v)}<sub>y</sub>(t) and lateral vehicle velocity {circumflex over (v)}<sub>y </sub>(t<sub>k+1</sub>) for the current time stamp obtained from eq. (17) and eq. (18) are provided to vehicle dynamic applications to determine control actions based on the current operating conditions of the vehicle.
FIG. 3 illustrates a flow chart for determining the longitudinal and lateral velocities for a current timestamp. In step 20, the absolute speed of the vehicle and the course heading angle are retrieved from a singleantenna GPS.
In step 21, yaw rates are obtained from vehicle sensors independent of GPS. In step 22, the yaw rates measured over a period of time are integrated for determining a yaw angle.
In step 23, the yaw angle is estimated (eq. (7)) as a function of the integrated yaw rate and the current yaw angle. Errors in the sensor measurement data due to the quality of the sensor require the integrated yaw rate and the current yaw angle be reinitialized after a period of time. As discussed earlier, the yaw angle is equal to the course heading angle when the vehicle is driving in a straightforward direction. Therefore, after the period of time has expired, the system determines if the vehicle is traveling in the straightforward direction for reinitializing the yaw angle to that of the course heading angle or reinitializes the yaw angle using an estimate slip angle according to method described in copending application Ser. No. 12/276,965.
In step 24, the side slip angle is estimated (eq. (8)) using the estimated yaw angle determined in step 23 and the course heading angle as measured by the singleantenna GPS.
In step 25, the vehicle velocity is determined as a function of the absolute speed and the side slip angle using eq. (9) and (10). Due to the update rate and delays in processing the data in the GPS receiver, estimates must me made for a current time stamp since the data processed in eq. (9) and (10) is using past data (i.e., delayed data).
In step 26, a delay of the GPS signal in relation to the vehicle sensor measurement data is determined using the PPS in the GPS signal.
In step 27, sensor measurements data is buffered for synchronization.
In step 28, vehicle longitudinal and lateral velocities at each time instance of the delay are determined by synchronizing the GPS measurements with the vehicle sensor measurements using the equations shown in eq. (13)(16).
In step 29, an estimated longitudinal velocity and estimated lateral velocity are determined using each of the discrete velocity calculations in eq. (15)(16). The estimated longitudinal and lateral velocities are determined using a summation process as shown eq. (17)(18). Alternatively, an integral function may be substituted in eq. (17)(18) by integrating each time step due to the updates that occur to longitudinal and lateral velocity estimations after each step in time.
It should be understood that the above process is used when GPS data is present. In those instances when GPS is not available, then a next best estimation technique may be used to determine the longitudinal and lateral velocities such as those described in copending application Ser. No. 12/276,965; however, the above estimation technique described herein may be reexecuted when the GPS becomes available, since the use of the GPS data provides greater accuracy than vehicle sensors which are subject to errors and bias over time.
While certain embodiments of the present invention have been described in detail, those familiar with the art to which this invention relates will recognize various alternative designs and embodiments for practicing the invention as defined by the following claims.