Vehicle operating parameter determination system and method

0Associated
Cases 
0Associated
Defendants 
0Accused
Products 
18Forward
Citations 
0
Petitions 
1
Assignment
First Claim
1. A method of estimating a steering angle offset value in a vehicle having a relative position steering angle sensor, said method comprising:
 providing a mathematical expression for calculating an estimated steering angle offset value, {circumflex over (δ)}off, based upon at least one measured value of a vehicle operating parameter wherein said mathematical expression is definable by;
selecting a mathematical model to describe the dynamic behavior of the vehicle which includes a first variable, δ, representing the steering angle of the vehicle, wherein said mathematical model includes at least one of a Kalman filter and a state observer; and
substituting, for said first variable, δ, the sum of a second variable, δUncenter, representing the relative steering angle position and a third variable, δoff, representing the steering angle offset in said model to provide said mathematical expression;
obtaining said at least one measured value for said vehicle; and
estimating said steering angle offset value using said at least one measured value and said mathematical expression.
1 Assignment
0 Petitions
Accused Products
Abstract
A system and method for estimating an operating parameter of a vehicle such as the steering angle offset or body slip angle. The method includes providing a dynamic vehicle model which is valid when the yaw rate and slip angle of the vehicle are either constant or changing. The vehicle model is reformulated to allow for the direct estimation of the steering angle offset value and/or the body slip angle. Estimation of an operating parameter of the vehicle may also include the use of a model difference term which is defined by the difference between a value estimated using the model and a measured value. A method for filtering the steering angle offset value is also provided. The filtering method may utilize a variable filter coefficient which varies in response to changes in the dynamic behavior of the vehicle.
70 Citations
View as Search Results
Determining steering angle of steering column of vehicle  
Patent #
US 9,073,569 B2
Filed 03/19/2013

Current Assignee
Mitsubishi Electric Research Laboratories

Sponsoring Entity
Mitsubishi Electric Research Laboratories

System and method for determining a steering angle for a vehicle and system and method for controlling a vehicle based on same  
Patent #
US 9,205,869 B2
Filed 09/29/2011

Current Assignee
Honda Motor Company

Sponsoring Entity
Honda Motor Company

Position Estimation Device and Position Estimation Method  
Patent #
US 20110208496A1
Filed 02/17/2011

Current Assignee
Clarion Co. Ltd.

Sponsoring Entity
Clarion Co. Ltd.

Position estimation device and position estimation method  
Patent #
US 9,057,781 B2
Filed 02/17/2011

Current Assignee
Clarion Co. Ltd.

Sponsoring Entity
Clarion Co. Ltd.

System and method for stochastically predicting the future states of a vehicle  
Patent #
US 8,489,317 B2
Filed 08/29/2008

Current Assignee
Toyota Motor Corporation

Sponsoring Entity
Toyota Motor Corporation

System for estimating vehicle states for rollover reduction  
Patent #
US 20080281482A1
Filed 05/07/2007

Current Assignee
GM Global Technology Operations LLC

Sponsoring Entity
GM Global Technology Operations LLC

System for estimating vehicle states for rollover reduction  
Patent #
US 7,848,864 B2
Filed 05/07/2007

Current Assignee
GM Global Technology Operations LLC

Sponsoring Entity
GM Global Technology Operations LLC

METHOD AND SYSTEM FOR PREDICTING A FUTURE POSITION OF A VEHICLE USING NUMERICAL INTEGRATION  
Patent #
US 20080071469A1
Filed 10/30/2006

Current Assignee
Toyota Motor Corporation

Sponsoring Entity
Toyota Motor Corporation

Method and system for predicting a future position of a vehicle using numerical integration  
Patent #
US 7,865,299 B2
Filed 10/30/2006

Current Assignee
Toyota Motor Corporation

Sponsoring Entity
Toyota Motor Corporation

Semiactive antiroll system  
Patent #
US 20060287791A1
Filed 06/20/2006

Current Assignee
Tenneco Automotive Operating Company Incorporated

Sponsoring Entity
Tenneco Automotive Operating Company Incorporated

Semiactive suspension system with antiroll for a vehicle  
Patent #
US 7,751,959 B2
Filed 06/20/2006

Current Assignee
Tenneco Automotive Operating Company Incorporated

Sponsoring Entity
Tenneco Automotive Operating Company Incorporated

Method for controlling an electric power steering system  
Patent #
US 20060000662A1
Filed 04/06/2005

Current Assignee
Robert Bosch Automotive Steering GmbH

Sponsoring Entity
Robert Bosch Automotive Steering GmbH

Method for controlling an electric power steering system  
Patent #
US 7,398,854 B2
Filed 04/06/2005

Current Assignee
Robert Bosch Automotive Steering GmbH

Sponsoring Entity
ZF Lenksysteme GmbH

Signal processing method, signal processing program, recording medium storing the signal processing program and signal processor  
Patent #
US 20050159931A1
Filed 01/18/2005

Current Assignee
Mitutoyo Corporation

Sponsoring Entity
Mitutoyo Corporation

Signal processing method, signal processing program, recording medium storing the signal processing program and signal processor  
Patent #
US 7,188,054 B2
Filed 01/18/2005

Current Assignee
Mitutoyo Corporation

Sponsoring Entity
Mitutoyo Corporation

ACKERMAN ANGLE CORRECTION IN A STEERING SYSTEM FOR A LOW SPEED TURN  
Patent #
US 20060095188A1
Filed 11/01/2004

Current Assignee
Honda Motor Company

Sponsoring Entity
Honda Motor Company

Ackerman angle correction in a steering system for a low speed turn  
Patent #
US 7,085,641 B2
Filed 11/01/2004

Current Assignee
Honda Motor Company

Sponsoring Entity
Honda Motor Company

Method for detecting a real value of a manipulated variable, particularity of a steering angle  
Patent #
US 20060247838A1
Filed 06/24/2004

Current Assignee
Continental Teves AG Company HG

Sponsoring Entity
Continental Teves AG Company HG

Vehicle behavior control apparatus  
Patent #
US 6,405,113 B1
Filed 10/26/2000

Current Assignee
Honda Giken Kogyo Kabushiki Kaisha

Sponsoring Entity
Honda Giken Kogyo Kabushiki Kaisha

Vehicle steering control system based on vehicle body side slip angle  
Patent #
US 6,345,218 B1
Filed 02/09/2000

Current Assignee
Honda Giken Kogyo Kabushiki Kaisha

Sponsoring Entity
Honda Giken Kogyo Kabushiki Kaisha

Turning behavior state detecting system for vehicle  
Patent #
US 6,349,256 B1
Filed 09/07/1999

Current Assignee
Honda Giken Kogyo Kabushiki Kaisha

Sponsoring Entity
Honda Giken Kogyo Kabushiki Kaisha

Process for determining ideal vehicular performance  
Patent #
US 6,233,505 B1
Filed 07/23/1999

Current Assignee
Continental Teves AG Company HG

Sponsoring Entity
Continental Teves AG Company HG

Wheel slip angle detecting system for vehicle  
Patent #
US 6,223,116 B1
Filed 07/08/1999

Current Assignee
Honda Giken Kogyo Kabushiki Kaisha

Sponsoring Entity
Honda Giken Kogyo Kabushiki Kaisha

Method and system for computing a vehicle body slip angle in a vehicle movement control  
Patent #
US 6,233,513 B1
Filed 11/17/1998

Current Assignee
ABE MASATO, Honda Giken Kogyo Kabushiki Kaisha

Sponsoring Entity
ABE MASATO, Honda Giken Kogyo Kabushiki Kaisha

Process for determining vehicle dynamics  
Patent #
US 6,130,706 A
Filed 09/08/1998

Current Assignee
AlcatelLucent USA Inc.

Sponsoring Entity
AlcatelLucent USA Inc.

Method for determining steering position of automotive steering mechanism  
Patent #
US 5,787,375 A
Filed 04/01/1996

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Global Technologies LLC

Method for determining steering position of automotive steering mechanism  
Patent #
US 5,790,966 A
Filed 04/01/1996

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Global Technologies LLC

Method for determining a center position of a vehicle steering system  
Patent #
US 5,732,372 A
Filed 06/09/1995

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Global Technologies LLC

Vehicle steering wheel position sensing apparatus  
Patent #
US 5,434,784 A
Filed 08/26/1994

Current Assignee
Hughes Aircraft Company

Sponsoring Entity
General Motors Corporation

Method for determining a vehicle steering wheel center position  
Patent #
US 5,465,210 A
Filed 08/18/1994

Current Assignee
GM Global Technology Operations LLC

Sponsoring Entity
General Motors Corporation

Method and apparatus for determining steering position of automotive steering mechanism  
Patent #
US 5,422,810 A
Filed 05/05/1994

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Motor Company

Method and system for estimating the neutral point of a steering wheel  
Patent #
US 5,311,432 A
Filed 12/10/1992

Current Assignee
Mitsubishi Jidosha Kogyo Kabushiki Kaisha

Sponsoring Entity
Mitsubishi Jidosha Kogyo Kabushiki Kaisha

Neutral position detector for steering wheels having a first and second rotors with aligned slots  
Patent #
US 5,243,188 A
Filed 09/25/1992

Current Assignee
KABUSHIKI KAISHA TOAKI RIKA DENKI SEISAKUSHO

Sponsoring Entity
KABUSHIKI KAISHA TOAKI RIKA DENKI SEISAKUSHO

Steering angle detecting apparatus for motor vehicles based on the phase difference between a steering angle detection signal and steering angle estimated signal  
Patent #
US 5,343,393 A
Filed 06/04/1991

Current Assignee
Nippondenso Co. Ltd.

Sponsoring Entity
Nippondenso Co. Ltd.

Method and apparatus for learning neutral position of vehicle steering angle  
Patent #
US 5,253,172 A
Filed 01/23/1991

Current Assignee
Mitsubishi Jidosha Kogyo Kabushiki Kaisha

Sponsoring Entity
Mitsubishi Jidosha Kogyo Kabushiki Kaisha

Steering handle neutral position estimating apparatus  
Patent #
US 5,065,323 A
Filed 05/03/1990

Current Assignee
Nissan Motor Co. Ltd.

Sponsoring Entity
Nissan Motor Co. Ltd.

Steering handle neutral position estimating apparatus  
Patent #
US 5,121,322 A
Filed 05/03/1990

Current Assignee
Nissan Motor Co. Ltd.

Sponsoring Entity
Nissan Motor Co. Ltd.

Method of detecting absolute steering angle of steering angle sensor for vehicle  
Patent #
US 5,065,324 A
Filed 03/16/1990

Current Assignee
Fuji Heavy Industries Limited

Sponsoring Entity
Fuji Heavy Industries Limited

Method and apparatus for determining the center position of a vehicular steering system  
Patent #
US 4,999,776 A
Filed 11/30/1989

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
FORD MOTOR COMPANY DEARBORN MI A CORP. OF DE

Apparatus and method for detecting neutral steering angle of steering wheel system for vehicle  
Patent #
US 5,032,996 A
Filed 09/18/1989

Current Assignee
Nissan Motor Co. Ltd.

Sponsoring Entity
Nissan Motor Co. Ltd.

Steering wheel turning angle detector and method for controlling yawing for vehicle  
Patent #
US 5,001,637 A
Filed 07/27/1989

Current Assignee
Honda Giken Kogyo Kabushiki Kaisha

Sponsoring Entity
Honda Giken Kogyo Kabushiki Kaisha

Steering angle middle point detecting apparatus  
Patent #
US 4,961,474 A
Filed 07/10/1989

Current Assignee
Koyo Seiko Co. Ltd.

Sponsoring Entity
Koyo Seiko Co. Ltd.

Steering angle detecting system for automotive vehicles  
Patent #
US 4,996,657 A
Filed 03/15/1989

Current Assignee
Honda Giken Kogyo Kabushiki Kaisha

Sponsoring Entity
Honda Giken Kogyo Kabushiki Kaisha

Failsafe system for vehicular driving characteristics control system  
Patent #
US 4,939,654 A
Filed 06/08/1988

Current Assignee
ATSUGI MOTOR PARTS COMPANY LIMITED, Nissan Motor Co. Ltd.

Sponsoring Entity
ATSUGI MOTOR PARTS COMPANY LIMITED, Nissan Motor Co. Ltd.

Vehicle steering angle control system  
Patent #
US 4,947,328 A
Filed 05/17/1988

Current Assignee
Nissan Motor Co. Ltd.

Sponsoring Entity
Nissan Motor Co. Ltd.

Apparatus for automatically setting steering center for use in power steering apparatus  
Patent #
US 4,856,607 A
Filed 04/05/1988

Current Assignee
TOKAI TRW CO. LTD.

Sponsoring Entity
TOKAI TRW CO. LTD.

Automotive system for dynamically determining road adhesion  
Patent #
US 4,882,693 A
Filed 12/28/1987

Current Assignee
Ford Motor Company

Sponsoring Entity
Ford Motor Company

Distance based method and apparatus for determining the center position of a vehicular steering system  
Patent #
US 4,867,466 A
Filed 12/16/1987

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Motor Company

Rear wheel steering apparatus  
Patent #
US 4,884,647 A
Filed 11/30/1987

Current Assignee
Mitsubishi Jidosha Kogyo Kabushiki Kaisha

Sponsoring Entity
Mitsubishi Jidosha Kogyo Kabushiki Kaisha

Vehicle steer angle control system based on mathematical model  
Patent #
US 4,840,389 A
Filed 10/09/1987

Current Assignee
Nissan Motor Co. Ltd.

Sponsoring Entity
Nissan Motor Co. Ltd.

Steering control apparatus for motor vehicles  
Patent #
US 4,836,319 A
Filed 07/20/1987

Current Assignee
Nippondenso Co. Ltd.

Sponsoring Entity
Nippondenso Co. Ltd.

Method and apparatus for determining the center position of a vehicular steering system  
Patent #
US 4,722,545 A
Filed 05/04/1987

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Motor Company

Steering angle control system for wheeled vehicle  
Patent #
US 4,834,204 A
Filed 03/13/1987

Current Assignee
Nissan Motor Co. Ltd.

Sponsoring Entity
Nissan Motor Co. Ltd.

Power steering apparatus and control system for power steering apparatus having a steering wheel angle detection device  
Patent #
US 4,803,629 A
Filed 01/07/1987

Current Assignee
Hitachi Ltd.

Sponsoring Entity
Hitachi Ltd.

Model solving type vehicle steering control system with parameter identification  
Patent #
US 4,718,685 A
Filed 12/08/1986

Current Assignee
Nissan Motor Co. Ltd.

Sponsoring Entity
Nissan Motor Co. Ltd.

Steering control system for wheeled vehicle  
Patent #
US 4,706,979 A
Filed 07/09/1986

Current Assignee
Nissan Motor Co. Ltd.

Sponsoring Entity
Nissan Motor Co. Ltd.

Method of processing signal of a steering angle sensor  
Patent #
US 4,720,791 A
Filed 06/26/1986

Current Assignee
Koyo Seiko Co. Ltd.

Sponsoring Entity
Koyo Seiko Co. Ltd.

Vehicle control system for controlling side slip angle and yaw rate gain  
Patent #
US 4,767,588 A
Filed 04/11/1986

Current Assignee
Nissan Motor Co. Ltd.

Sponsoring Entity
Nissan Motor Co. Ltd.

Vehicle steering control system using desired vehicle model  
Patent #
US 4,706,771 A
Filed 01/28/1986

Current Assignee
Nissan Motor Co. Ltd.

Sponsoring Entity
Nissan Motor Co. Ltd.

Apparatus for steering an automotive vehicle  
Patent #
US 4,652,011 A
Filed 12/23/1985

Current Assignee
AUDI AG. POSTFACH 2 20 D8070 INGOLSTADT WEST GERMANY

Sponsoring Entity
AUDI AG. POSTFACH 2 20 D8070 INGOLSTADT WEST GERMANY

Control system for multistable suspension unit  
Patent #
US 4,621,833 A
Filed 12/16/1985

Current Assignee
Ford Global Technologies LLC

Sponsoring Entity
Ford Motor Company

System for controlling cornering characteristics of wheeled vehicle  
Patent #
US 4,690,431 A
Filed 09/09/1985

Current Assignee
Nissan Motor Co. Ltd.

Sponsoring Entity
Nissan Motor Co. Ltd.

Suspension system for motor vehicle having variable suspension characteristics  
Patent #
US 4,564,214 A
Filed 03/15/1984

Current Assignee
MAZDA KABUSHIKI KAISHA

Sponsoring Entity
MAZDA KABUSHIKI KAISHA

Shock absorber control unit for use of a vehicle suspension  
Patent #
US 4,575,116 A
Filed 12/19/1983

Current Assignee
Ibaraki Toyota Jidosha Kabushiki Kaisha

Sponsoring Entity
Ibaraki Toyota Jidosha Kabushiki Kaisha

Vehicle suspension system  
Patent #
US 4,555,126 A
Filed 10/17/1983

Current Assignee
Mazda Motor Corporation

Sponsoring Entity
Mazda Motor Corporation

Power steering device for a vehicle  
Patent #
US 4,392,540 A
Filed 12/31/1980

Current Assignee
TOKAI TRW CO. LTD.

Sponsoring Entity
TOKAI TRW CO. LTD.

Antiroll system for vehicles  
Patent #
US 4,345,661 A
Filed 02/08/1980

Current Assignee
Honda Giken Kogyo Kabushiki Kaisha

Sponsoring Entity
Honda Giken Kogyo Kabushiki Kaisha

Hydraulic damper  
Patent #
US 4,313,529 A
Filed 11/05/1979

Current Assignee
Tokico Limited

Sponsoring Entity
Tokico Limited

Vehicleattitude control device  
Patent #
US 3,895,816 A
Filed 03/08/1974

Current Assignee
Honda Giken Kogyo Kabushiki Kaisha

Sponsoring Entity
Honda Giken Kogyo Kabushiki Kaisha

APPARATUS FOR OFFSETTING CENTRIFUGAL FORCE AFFECTING MOTOR VEHICLES  
Patent #
US 3,608,925 A
Filed 05/07/1969

Current Assignee
Murphy Peter H.

Sponsoring Entity
Murphy Peter H.

18 Claims
 1. A method of estimating a steering angle offset value in a vehicle having a relative position steering angle sensor, said method comprising:
 providing a mathematical expression for calculating an estimated steering angle offset value, {circumflex over (δ)}
, based upon at least one measured value of a vehicle operating parameter wherein said mathematical expression is definable by;off
selecting a mathematical model to describe the dynamic behavior of the vehicle which includes a first variable, δ, representing the steering angle of the vehicle, wherein said mathematical model includes at least one of a Kalman filter and a state observer; and
substituting, for said first variable, δ, the sum of a second variable, δ , representing the relative steering angle position and a third variable, δUncenter , representing the steering angle offset in said model to provide said mathematical expression;off
obtaining said at least one measured value for said vehicle; and
estimating said steering angle offset value using said at least one measured value and said mathematical expression.  View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14)
 providing a mathematical expression for calculating an estimated steering angle offset value, {circumflex over (δ)}
 15. A method of filtering a plurality of time indexed values in a process for determining a steering angle position of a vehicle having a relative position steering angle sensor, said method comprising:
 estimating a plurality of time indexed steering angle offset values using at least one of a Kalman filter and a state observer;
filtering a plurality of time indexed values which are a function of said plurality of time indexed steering angle offset values using a variable filter coefficient, F , said variable filter coefficient, Fk , being determined using an uncertainty factor, Uk , said uncertainty factor, Uk , being determined using at least one value from the group including yaw rate of the vehicle, estimated steering angle position and the lateral acceleration of the vehicle.k  View Dependent Claims (16, 17, 18)
 estimating a plurality of time indexed steering angle offset values using at least one of a Kalman filter and a state observer;
1 Specification
This application claims priority under 35 U.S.C. 119(e) of both U.S. provisional patent application Ser. No. 60/408,162 filed on Sep. 4, 2002 entitled VEHICLE OPERATING PARAMETER DETERMINATION METHOD and U.S. provisional patent application Ser. No. 60/401,124 filed on Aug. 5, 2002 entitled VEHICLE OPERATING PARAMETER DETERMINATION METHOD the disclosures of both of which are hereby incorporated herein by reference.
BACKGROUND OF THE INVENTION1. Field of the Invention
The present invention relates to methods for determining operating parameters of a motor vehicle and, more particularly, to the estimation of the steering angle position and body slip angle of a vehicle based upon data received from various vehicle sensors.
2. Description of the Related Art
Many motor vehicles today have electronic stability program (“ESP”) systems which include an electronic controller which utilize data signals obtained from various vehicle sensors to make complex calculations and automatically implement actions based upon those calculations.
One of the values that is generally required by such ESP systems is the vehicle steering angle position which may be measured by a steering angle sensor (“SAS”). There are different classes of SAS sensors. Some SAS sensors, such as Class III sensors, provide accurate values immediately after the ignition key is placed in the ON condition. Other SAS sensors, such as Class I sensors, provide values which are relative to the position of the steering wheel when the ignition key is turned to the ON condition. In other words, these sensors transmit a zero value signal when the key ON condition is initiated regardless of the actual steering angle position and processing of the SAS signal is required to compute an accurate steering angle value. A variety of different methods are known for processing a relative position SAS signal to estimate the actual steering angle.
The slip angle of the vehicle body, i.e., the angle between the vehicle travel direction and the vehicle heading, is another operating parameter of the vehicle which has an impact on the stability of the motor vehicle and may be used by a stability control system.
SUMMARY OF THE INVENTIONThe present invention provides improved methods and systems for estimating the body slip angle and actual steering angle position of a motor vehicle based upon signals received from various vehicle sensors.
Vehicle dynamics models oftentimes include a variable representing the steering angle value of the vehicle. In vehicles having a relative position steering angle sensor the absolute or true steering angle, δ, is equal to the sum of the relative steering angle position, δ<HIL><SB>Uncenter</SB></HIL>, provided by the steering angle sensor, and the steering angle offset, δ<HIL><SB>off</SB></HIL>, this relationship is represented by the following equation: δ=δ<HIL><SB>Uncenter</SB></HIL>+δ<HIL><SB>off</SB></HIL>.
The inventors of the present application have developed a method of directly estimating the steering angle offset value which recognizes that, because the steering angle offset value is a constant value during any one discrete vehicle trip, the sum of the relative value of the steering angle and the offset may be substituted for the absolute steering angle value in a vehicle dynamics model. The inventors of the present invention have also utilized such substitutions to develop vehicle models which provide a mathematical expression in which the steering angle offset value, δ<HIL><SB>off</SB></HIL>, is a state variable and can be directly estimated from the mathematical expression. As used herein, a variable is a state variable with respect to a particular mathematical expression when it can be directly calculated from such mathematical expression.
After reformulating the vehicle model so that the steering angle offset value, δ<HIL><SB>off</SB></HIL>, is a state variable, the Kalman filter or a state observer may be applied to the reformulated vehicle model to facilitate the estimation of the steering angle offset value, δ<HIL><SB>off</SB></HIL>. The mathematical expression provided by the application of the Kalman filter or state observer to the reformulated vehicle model may also be used to provide for the estimation of other vehicle operating parameters such as the vehicle body slip angle and yaw rate. The measured vehicle operating parameters which form the input values for such mathematical expressions may include the relative steering angle position, yaw rate, longitudinal speed, and lateral acceleration of the vehicle.
The inventors of the present application have also developed a method for filtering the resulting values of the steering angle offset which uses a variable filter coefficient and which may also be used with alternative methods of estimating steering angle offset values. The filter coefficient is dependent upon an uncertainty factor which is defined so that it will vary with the dynamic behavior of the vehicle. The vehicle operating parameters which may be used in the determination of the uncertainty factor include the yaw rate, steering angle position and the lateral acceleration of the vehicle.
The invention comprises, in one form thereof, a system and/or method for estimating a steering angle offset value in a motor vehicle having a relative position steering angle sensor. The method includes providing a mathematical expression for calculating an estimated steering angle offset value, {circumflex over (δ)}<HIL><SB>off</SB></HIL>, based upon at least one measured value of a vehicle operating parameter. The mathematical expression is definable by selecting a mathematical model to describe the dynamic behavior of the vehicle which includes a first variable, δ, representing the steering angle of the vehicle; and substituting, for the first variable, δ, the sum of a second variable, δ<HIL><SB>Uncenter</SB></HIL>, representing the relative steering angle position and a third variable, δ<HIL><SB>off</SB></HIL>, representing the steering angle offset in the model to thereby provide the mathematical expression for calculating the estimated steering angle offset value, {circumflex over (δ)}<HIL><SB>off</SB></HIL>. The method also includes obtaining the at least one measured value for the vehicle and estimating the steering angle offset value using the at least one measured value and the mathematical expression.
The at least one measured value of the method may include the yaw rate of the vehicle, the relative steering angle position and the longitudinal velocity of the vehicle. The lateral acceleration of the vehicle may also be included in the measured values used with this method.
In alternative embodiments of this invention, the slip angle of the vehicle body may also be estimated from the mathematical expression provided by this method.
In one embodiment, the model used by this method may be equation (1.1) presented below and the substitution of the sum of the second and third variables into the model may result in equation (1.3) which is also presented below. The mathematical expression provided by the method may comprise either equation (1.4) or (1.6) which are presented below.
The method may also include a filtering process which uses a variable filter coefficient. The variable filter coefficient may be calculated using an uncertainty factor which is determined using at least one value from the group including the yaw rate of the vehicle, the relative steering angle position and the lateral acceleration of the vehicle.
The invention comprises, in another form thereof, a system and method for filtering a plurality of time indexed values in a process for determining a steering angle position of a vehicle having a relative steering angle sensor. The method includes estimating a plurality of time indexed steering angle offset values. The method also includes filtering a plurality of time indexed values which are a function of said plurality of time indexed steering angle offset values using a variable filter coefficient, F<HIL><SB>k</SB></HIL>. The variable filter coefficient, F<HIL><SB>k</SB></HIL>, is determined using an uncertainty factor, U<HIL><SB>k</SB></HIL>. The uncertainty factor, U<HIL><SB>k</SB></HIL>, is determined using at least one value from the group including the yaw rate of the vehicle, the relative steering angle position and the lateral acceleration of the vehicle.
For some embodiments of this method, the plurality of time indexed values are identical to the plurality of time indexed steering angle offset values. The uncertainty factor, U<HIL><SB>k</SB></HIL>, may be determined using equation (2.5) presented below and the filtering of values may use equation (2.1) presented below.
The invention comprises, in still another form thereof, a system and method of controlling a vehicle. The method includes providing a mathematical expression for estimating first and second vehicle operating parameters. The mathematical expression is definable by selecting a mathematical model to describe the dynamic behavior of the vehicle and reformulating the model. The mathematical expression includes a model difference term which is dependent upon a difference between an estimated value of the second vehicle operating parameter and a measured value of the second vehicle operating parameter. A signal representing a measured value of the second vehicle operating parameter is obtained. The method also includes estimating the first vehicle operating parameter using the mathematical expression wherein calculation of an estimated value for the first parameter includes using the measured value represented by the signal in the model difference term. The estimated value of the first parameter is then output for use in the vehicle's electronic control system.
The method may include first and second parameters which are selected from the group including the steering angle offset, the yaw rate and the body slip angle of the vehicle. In one embodiment of the invention, the first parameter is the steering angle offset and the second parameter is the yaw rate of the vehicle. The mathematical expression used to estimate the first parameter may be equation (1.6a) which is presented below.
The invention comprises, in another form thereof, a system and/or method for estimating a vehicle body slip angle which includes the use of vehicle dynamics model which is valid under operating conditions wherein the yaw rate or slip angle are changing to estimate the vehicle body slip angle. Different sets of input signals may be used with the model to perform the estimations. One such set of input signals, include signals representing the relative steering angle position, the longitudinal speed of the vehicle and the yaw rate of the vehicle. The lateral acceleration of the vehicle may also be included in the input signals. It is also possible for an input signal representing the absolute or actual steering angle position to be substituted for the signal representing the relative position steering angle position.
The present invention may be used with vehicles which include either an absolute position steering angle sensor (which provides a signal indicating the accurate steering angle position immediately upon starting the vehicle) or a relative position steering angle sensor (which requires the signal to be corrected to account for the steering angle offset).
For vehicles which have an absolute position steering angle sensor, embodiments of the present invention may be used to estimate the vehicle body slip angle. For vehicles which have a relative position steering angle sensor, alternative embodiments of the present invention may be used to estimate the steering angle offset value and/or the vehicle body slip angle. The present invention also provides a method for filtering the steering angle offset value.
An advantage of the present invention is that it provides a method for directly estimating both the body slip angle and the steering angle offset value of the vehicle.
Another advantage of the present invention is that it provides a relatively accurate value for the body slip angle and the steering angle position when the vehicle is in either a steady state or a nonsteady state of operation. As used herein, a nonsteady state of operation refers to a state of operation wherein the yaw rate or the body slip angle of the vehicle is changing.
Yet another advantage of the present invention is that it provides a method for estimating the body slip angle and steering angle which can utilize different sets of vehicle operating parameters as input data. For example, the method can be used to estimate the body slip angle and steering angle offset based upon the yaw rate, relative steering angle position and longitudinal velocity of the vehicle, or, the inputs may additionally include the lateral acceleration of the vehicle.
Still another advantage of the present invention is that it provides a filtering method for use in determining the steering angle offset which includes a variable filter coefficient wherein the filter coefficient varies in response to vehicle operating parameters which reflect the dynamic behavior of the vehicle such as the yaw rate, relative steering angle position and lateral acceleration of the vehicle.
BRIEF DESCRIPTION OF THE DRAWINGSThe above mentioned and other features and objects of this invention, and the manner of attaining them, will become more apparent and the invention itself will be better understood by reference to the following description of embodiments of the invention taken in conjunction with the accompanying drawings, wherein:
<FGREF>FIG. 1</FGREF> is a flow chart representing one embodiment of the present invention.
<FGREF>FIG. 2</FGREF> is a flow chart representing the estimation of body slip angle and steering angle offset values based upon a first set of vehicle operating parameter signals.
<FGREF>FIG. 3</FGREF> is a flow chart representing the estimation of body slip angle and steering angle offset values based upon a second set of vehicle operating parameter signals.
<FGREF>FIG. 4</FGREF> is flow chart representing the estimation of body slip angle and steering angle values based upon a third set of vehicle operating parameter signals.
<FGREF>FIG. 5</FGREF> is a graphical representation of data gathered during a first test of the present invention in which the vehicle's initial movement was in a straight forward path.
<FGREF>FIG. 6</FGREF> is a graphical representation of data gathered during a second test of the present invention in which the vehicle's initial movement was a turning movement.
<FGREF>FIG. 7</FGREF> is a graphical representation of additional data associated with the estimation and filtering of the steering angle offset value gathered during the first test of the present invention.
<FGREF>FIG. 8</FGREF> is a graphical representation of the estimated value of the steering angle offset gathered during the first test of the present invention.
<FGREF>FIG. 9</FGREF> is schematic illustration of a vehicle.
Corresponding reference characters indicate corresponding parts throughout the several views. Although the exemplification set out herein illustrates the invention, in multiple forms, the embodiments disclosed below are not intended to be exhaustive or to be construed as limiting the scope of the invention to the precise forms disclosed.7
DESCRIPTION OF THE PRESENT INVENTIONReferring to the drawings, <FGREF>FIG. 1</FGREF> illustrates a flow chart representing one embodiment of the present invention. The embodiment of the invention illustrated in <FGREF>FIG. 1</FGREF> may be implemented in a vehicle having an ESP system which includes a electronic control unit (“ECU”) and various sensors for detecting vehicle operating parameters which include an SAS, yaw rate, longitudinal speed and lateral acceleration sensors. <FGREF>FIG. 9</FGREF> schematically represents a vehicle 10 which has a heading indicated by line 16, i.e., the direction in which the longitudinal axis of vehicle 10 is pointed, and is traveling in a direction indicated by line 18. The angle 20 between heading 16 and travel direction 18 is the slip angle of vehicle 10.
In the embodiment represented by the flow chart in <FGREF>FIG. 1</FGREF>, a comprehensive vehicle dynamics model is formulated which is valid not only when the vehicle is in a steady state but also when the vehicle is in a nonsteady state of operation. More specifically, the vehicle dynamics model which is used is valid not only when the yaw rate and body slip angle of the vehicle are constant (i.e., in a steady state) but also when the yaw rate and/or body slip angle of the vehicle are changing (i.e., a nonsteady state). A vehicle dynamics model which has been reformulated such that the steering angle offset value is a state variable is used in the embodiment represented in FIG. 1. The Kalmanfilter or a state observer is applied to the reformulated vehicle model to estimate the steering angle offset, δ<HIL><SB>off</SB></HIL>, and other vehicle operating parameters such as the body slip angle, β. This process for estimating the steering angle offset and body slip angle is discussed in greater detail below and is represented by box 12 in the Figures. The use of a vehicle dynamics model which is valid in a nonsteady state allows the estimation process to be used in a wide range of driving and road conditions.
The estimated steering angle offset values, {circumflex over (δ)}<HIL><SB>off</SB></HIL>, are then filtered and combined with the steering angle value, δ<HIL><SB>Uncenter</SB></HIL>, to provide a true steering angle position, δ<HIL><SB>Center</SB></HIL>, value. This filtering and determination process is discussed in greater detail below and is represented by box 14 in FIG. 1. The estimated operating parameter values, e.g., the body slip angle and yaw rate, provided by the estimation process 12, together with the estimated steering angle position provided by the filtering and determination process 14, may then be used by the ESP system to control the operation of the vehicle as represented by box 15 in FIG. 1. The use of ESP systems to control a vehicle to maintain the stability of the vehicle based upon input data representing various operating parameters of the vehicle such as the steering angle position, longitudinal speed, and yaw rate of the vehicle, is known to those having ordinary skill in the art.
To implement the present invention, a vehicle dynamics model must first be formulated for the vehicle in which the present invention will be employed. The model used to describe the vehicle dynamics may be a simplified linear model. The model includes the steering angle position and can be reformulated, as described below, so that the steering angle offset is a state variable. Reformulating the model so that steering angle offset is a state variable facilitates the use of the Kalmanfilter or a stateobserver with the model in the estimation of a value for the steering angle offset. More complex vehicle models including the steering angle position and which may be reformulated so that the steering angle offset is a state variable may also be used.
Equation (1.1) presented below is a linear vehicle dynamics model: <CWU><MATHUS><MATHEMATICA></MATHEMATICA><MATHML><math><mtable><mtr><mtd><mrow><mrow><mo>[</mo><mtable><mtr><mtd><mover><mi>β</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mover><mi>ψ</mi><mi>¨</mi></mover></mtd></mtr></mtable><mo>]</mo></mrow><mo>=</mo><mrow><mrow><mrow><mo>[</mo><mtable><mtr><mtd><mrow><mo></mo><mfrac><mrow><msub><mi>C</mi><mi>v</mi></msub><mo>+</mo><msub><mi>C</mi><mi>h</mi></msub></mrow><mrow><mi>m</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><mi>v</mi></mrow></mfrac></mrow></mtd><mtd><mrow><mfrac><mrow><mrow><msub><mi>C</mi><mi>h</mi></msub><mo></mo><msub><mi>l</mi><mi>h</mi></msub></mrow><mo></mo><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msub><mi>l</mi><mi>v</mi></msub></mrow></mrow><mrow><mi>m</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><msup><mi>v</mi><mn>2</mn></msup></mrow></mfrac><mo></mo><mn>1</mn></mrow></mtd></mtr><mtr><mtd><mfrac><mrow><mrow><msub><mi>C</mi><mi>h</mi></msub><mo></mo><msub><mi>l</mi><mi>h</mi></msub></mrow><mo></mo><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msub><mi>l</mi><mi>v</mi></msub></mrow></mrow><msub><mi>J</mi><mi>z</mi></msub></mfrac></mtd><mtd><mrow><mo></mo><mfrac><mrow><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msubsup><mi>l</mi><mi>v</mi><mn>2</mn></msubsup></mrow><mo>+</mo><mrow><msub><mi>C</mi><mi>h</mi></msub><mo></mo><msubsup><mi>l</mi><mi>h</mi><mn>2</mn></msubsup></mrow></mrow><mrow><msub><mi>J</mi><mi>z</mi></msub><mo></mo><mi>v</mi></mrow></mfrac></mrow></mtd></mtr></mtable><mo>]</mo></mrow><mo></mo><mrow><mo>[</mo><mtable><mtr><mtd><mi>β</mi></mtd></mtr><mtr><mtd><mover><mi>ψ</mi><mo>.</mo></mover></mtd></mtr></mtable><mo>]</mo></mrow></mrow><mo>+</mo><mrow><mrow><mo>[</mo><mtable><mtr><mtd><mfrac><msub><mi>C</mi><mi>v</mi></msub><msub><mi>mvi</mi><mi>s</mi></msub></mfrac></mtd></mtr><mtr><mtd><mfrac><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msub><mi>l</mi><mi>v</mi></msub></mrow><mrow><msub><mi>J</mi><mi>z</mi></msub><mo></mo><msub><mi>i</mi><mi>s</mi></msub></mrow></mfrac></mtd></mtr></mtable><mo>]</mo></mrow><mo>·</mo><mi>δ</mi></mrow></mrow></mrow></mtd><mtd><mrow><mo>(</mo><mn>1.1</mn><mo>)</mo></mrow></mtd></mtr></mtable></math></MATHML><EMI></EMI></MATHUS></CWU>
wherein:
β represents the body slip angle;
{dot over (ψ)} represents the yaw rate;
δ represents the steering angle and is the system input signal;
m represents the mass of the vehicle;
v represents the longitudinal speed of the vehicle;
J<HIL><SB>z </SB></HIL>represents the inertia moment of the vehicle around its mass center point;
i<HIL><SB>s </SB></HIL>represents the steering angle ratio;
C<HIL><SB>v </SB></HIL>represents the cornering stiffness value of front tires;
C<HIL><SB>h </SB></HIL>represents the cornering stiffness value of the rear tires;
l<HIL><SB>v </SB></HIL>represents the distance from the front axle to the mass center point of the vehicle; and
l<HIL><SB>h </SB></HIL>represents the distance from the rear axle to the mass center point of the vehicle.
If the vehicle utilizes a relative position steering angle sensor and the steering angle offset δ<HIL><SB>off </SB></HIL>is unknown, the absolute steering angle δ can be calculated in accordance with equation (1.2) as the sum of the relative steering angle δ<HIL><SB>Uncenter </SB></HIL>and the steering angle offset δ<HIL><SB>off </SB></HIL>as follows:
<F>δ=δ<HIL><SB>Uncenter</SB></HIL>+δ<HIL><SB>off</SB></HIL> (1.2)</F>
The value for the steering angle offset, δ<HIL><SB>off</SB></HIL>, is a constant value during any one vehicle trip. The inventors of the present application have used this characteristic of the steering angle offset, δ<HIL><SB>off</SB></HIL>, to rewrite equation (1.1) as follows: <CWU><MATHUS><MATHEMATICA></MATHEMATICA><MATHML><math><mtable><mtr><mtd><mrow><mrow><mrow><mo>[</mo><mtable><mtr><mtd><mover><mi>β</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mover><mi>ψ</mi><mi>¨</mi></mover></mtd></mtr><mtr><mtd><msub><mover><mi>δ</mi><mo>.</mo></mover><mi>Off</mi></msub></mtd></mtr></mtable><mo>]</mo></mrow><mo>=</mo><mrow><mrow><mrow><mo>[</mo><mtable><mtr><mtd><mfrac><mrow><msub><mi>C</mi><mi>v</mi></msub><mo>+</mo><msub><mi>C</mi><mi>h</mi></msub></mrow><mrow><mi>m</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><mi>v</mi></mrow></mfrac></mtd><mtd><mrow><mfrac><mrow><mrow><msub><mi>C</mi><mi>h</mi></msub><mo></mo><msub><mi>l</mi><mi>h</mi></msub></mrow><mo></mo><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msub><mi>l</mi><mi>v</mi></msub></mrow></mrow><mrow><mi>m</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><msup><mi>v</mi><mn>2</mn></msup></mrow></mfrac><mo></mo><mn>1</mn></mrow></mtd><mtd><mfrac><msub><mi>C</mi><mi>v</mi></msub><mrow><mi>m</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><mi>v</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><msub><mi>i</mi><mi>s</mi></msub></mrow></mfrac></mtd></mtr><mtr><mtd><mfrac><mrow><mrow><msub><mi>C</mi><mi>h</mi></msub><mo></mo><msub><mi>l</mi><mi>h</mi></msub></mrow><mo></mo><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msub><mi>l</mi><mi>v</mi></msub></mrow></mrow><msub><mi>J</mi><mi>z</mi></msub></mfrac></mtd><mtd><mrow><mo></mo><mfrac><mrow><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msubsup><mi>l</mi><mi>v</mi><mn>2</mn></msubsup></mrow><mo>+</mo><mrow><msub><mi>C</mi><mi>h</mi></msub><mo></mo><msubsup><mi>l</mi><mi>h</mi><mn>2</mn></msubsup></mrow></mrow><mrow><msub><mi>J</mi><mi>z</mi></msub><mo></mo><mi>v</mi></mrow></mfrac></mrow></mtd><mtd><mfrac><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msub><mi>l</mi><mi>v</mi></msub></mrow><mrow><msub><mi>J</mi><mi>z</mi></msub><mo></mo><msub><mi>i</mi><mi>s</mi></msub></mrow></mfrac></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable><mo>]</mo></mrow><mo></mo><mrow><mo>[</mo><mtable><mtr><mtd><mi>β</mi></mtd></mtr><mtr><mtd><mover><mi>ψ</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><msub><mi>δ</mi><mrow><mi>O</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><mi>ff</mi></mrow></msub></mtd></mtr></mtable><mo>]</mo></mrow></mrow><mo>+</mo><mrow><mrow><mo>[</mo><mtable><mtr><mtd><mfrac><msub><mi>C</mi><mi>v</mi></msub><mrow><mi>m</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><mi>v</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><msub><mi>i</mi><mi>s</mi></msub></mrow></mfrac></mtd></mtr><mtr><mtd><mfrac><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msub><mi>l</mi><mi>v</mi></msub></mrow><mrow><msub><mi>J</mi><mi>z</mi></msub><mo></mo><msub><mi>i</mi><mi>s</mi></msub></mrow></mfrac></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable><mo>]</mo></mrow><mo>·</mo><msub><mi>δ</mi><mi>Uncenter</mi></msub></mrow></mrow></mrow><mo>,</mo></mrow></mtd><mtd><mrow><mo>(</mo><mn>1.3</mn><mo>)</mo></mrow></mtd></mtr></mtable></math></MATHML><EMI></EMI></MATHUS></CWU>
which is a third order state equation. In equation (1.3), β, {dot over (ψ)}, δ<HIL><SB>Off</SB></HIL>, define the state variables. Using time index k, equation (1.3) can be approximately formulated in a standard discrete matrix form:
<F>x(k+1)=A(k)x(k)+b(k)·u(k)</F>
<F>y(k)=c<HIL><SP>T</SP></HIL>x(k) (1.4)</F>
with <CWU><MATHUS><MATHEMATICA></MATHEMATICA><MATHML><math><mrow><mi>A</mi><mo>=</mo><mrow><mo>[</mo><mtable><mtr><mtd><msub><mi>a</mi><mn>11</mn></msub></mtd><mtd><msub><mi>a</mi><mn>12</mn></msub></mtd><mtd><msub><mi>b</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><msub><mi>a</mi><mn>21</mn></msub></mtd><mtd><msub><mi>a</mi><mn>22</mn></msub></mtd><mtd><msub><mi>b</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable><mo>]</mo></mrow></mrow></math></MATHML><EMI></EMI></MATHUS></CWU> x<HIL><SP>T</SP></HIL>=[β{dot over (ψ)}δ<HIL><SB>Off</SB></HIL>]<CWU><MATHUS><MATHEMATICA></MATHEMATICA><MATHML><math><mtable><mtr><mtd><mrow><mi>b</mi><mo>=</mo><mrow><mo>[</mo><mtable><mtr><mtd><msub><mi>b</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><msub><mi>b</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable><mo>]</mo></mrow></mrow></mtd><mtd><mrow><mo>(</mo><mn>1.5</mn><mo>)</mo></mrow></mtd></mtr></mtable></math></MATHML><EMI></EMI></MATHUS></CWU> u=δ<HIL><SB>Uncenter</SB></HIL>
and wherein
c<HIL><SP>T </SP></HIL>represents an output vector.
The output vector c<HIL><SP>T </SP></HIL>is dependent upon the measurable signals which are available as discussed in greater detail below.
Representing the process noise by v(k) and the measurement noise by w(k) and assuming both the process noise and the measurement noise to be independent random variables having an average value of zero, equation (1.4) can be rewritten as follows:
x(k+1)=A(k)x(k)+b(k)·u(k)+v(k)
<F>y(k)=c<HIL><SP>T</SP></HIL>x(k)+w(k) (1.6)</F>
In accordance with modern control theory, a stateobserver can be applied to equation (1.4) and the Kalmanfilter can be applied to equation (1.6). In both cases, the state vector x(k) is estimated. Several different approaches may be used to resolve the vehicle dynamics model depending upon the signals which are available for input into the model and the desired output values. Four different approaches are described below.
In the first approach, the signals which are input into the model are the measured values for the yaw rate and longitudinal speed of the vehicle. The yaw rate and longitudinal vehicle speed may be either directly measured by sensor or be calculated from other directly measured values. For example, the longitudinal vehicle speed may be calculated from signals received from wheel speed sensors. In this first approach, the output vector c<HIL><SP>T </SP></HIL>is defined as follows:
<F>c<HIL><SP>T</SP></HIL>=[010]. (1.7)</F>
Employing equation (1.7), the Kalmanfilter or stateobserver can be applied to equations (1.4) and (1.6) respectively to obtain the steering angle offset value. The first approach thereby yields a steering angle offset value which may then be used by the ESP system.
In the second approach, the lateral acceleration a<HIL><SB>y </SB></HIL>is also available. The slip angle β can be obtained by integrating β using the relationship:
<F>a<HIL><SB>y</SB></HIL>=v·({dot over (β)}+{dot over (ψ)}). (1.8)</F>
The slip angle β which is thereby obtained is considered a measurement signal. In this second approach, the output vector c<HIL><SP>T </SP></HIL>is defined as follows:
<F>c<HIL><SP>T</SP></HIL>=[110]. (1.9)</F>
Employing equation (1.9), the Kalmanfilter or stateobserver can be applied to equations (1.4) and (1.6) respectively to obtain the steering angle offset value. The second approach thereby yields a slip angle value and steering angle offset value which may then be used by the ESP system.
The third approach is the same as the first approach except that the value for the slip angle which is calculated when estimating the steering angle offset value is provided as an output value so that it may be utilized by the ESP system. This third approach yields estimated values for both the slip angle and the steering angle offset.
The fourth approach is applicable where the steering angle offset value is a known input or where the vehicle employs a steering angle sensor which provides the absolute steering angle position rather than a relative steering angle position value. In this fourth approach, the Kalmanfilter or a stateobserver may be used with equation (1.1). Using the measured value of the yaw rate, the vehicle body slip angle may be calculated in a manner similar to that employed by the third approach. This fourth approach thereby yields an estimated value for the slip angle. It is not necessary to estimate a value for the steering angle offset in this fourth approach because the actual steering angle position is a known value.
<FGREF>FIGS. 23</FGREF> provide a graphical representation of the input and output values of the different approaches described above. <FGREF>FIG. 2</FGREF> represents both the first and third approaches. In the first approach, however, the estimated body slip angle, although calculated, is not output to the ESP system. <FGREF>FIG. 3</FGREF> represents the second approach and <FGREF>FIG. 4</FGREF> represents the fourth approach.
<FGREF>FIG. 5</FGREF> illustrates the measurement and estimation signals of a test conducted using the first approach described above. The initial movement of the vehicle is straight ahead on an asphalt road. The input signal for the steering angle position is a relative position value instead of an absolute steering angle position. The value displayed for δ<HIL><SB>center </SB></HIL>represents the absolute or true steering angle position. The value displayed for δ<HIL><SB>Uncenter </SB></HIL>represents the relative steering angle position output of the sensor and is associated with an unknown steering angle offset value. In the test illustrated in <FGREF>FIG. 5</FGREF>, the steering angle offset value is −18.5 degrees. The value displayed for {circumflex over (δ)}<HIL><SB>off </SB></HIL>represents the estimated steering angle offset value. The estimation process begins when the vehicle first starts to move. In the test illustrated in <FGREF>FIG. 5</FGREF>, the estimated value for the steering angle offset converges with the actual value after 3.1 seconds. The value displayed for {circumflex over (β)} represents the estimated vehicle body slip angle.
<FGREF>FIG. 6</FGREF> illustrates the measurement and estimation signals of a second test. The second test is similar to the first test except that the vehicle is turning on an asphalt road when it is first launched into movement. In this second test example, the estimated steering angle offset value {circumflex over (δ)}<HIL><SB>off </SB></HIL>off converges with actual offset value of 6.7 degrees after 8.4 seconds. Thus, it took a longer time for the estimated offset value to converge with the actual offset value when the model addressed the more dynamic conditions of a turn as opposed to the straight forward path of the first test illustrated in FIG. 5. The values of the relative steering angle position, δ<HIL><SB>Uncenter</SB></HIL>, and the measured yaw rate, ψ<HIL><SB>Mess</SB></HIL>, are indicative of the dynamic cornering behavior of the vehicle.
One embodiment utilizing the Kalman filter with the first approach discussed above will now be further described.
The estimation process uses the linear vehicle dynamics model discussed above. The measured relative steering angle position, longitudinal vehicle speed and yaw rate are the input values used in the estimation of the steering angle position offset value {circumflex over (δ)}<HIL><SB>off</SB></HIL>. This process used to obtain the steering angle position offset value {circumflex over (δ)}<HIL><SB>off </SB></HIL>is represented by box 12 in FIG. 1.
The resulting estimated offset value {circumflex over (δ)}<HIL><SB>off </SB></HIL>is then filtered and added to the relative steering angle position δ<HIL><SB>Uncenter </SB></HIL>to determine an estimated steering angle value. This filtering and determination process is represented by box 14 in FIG. 1.
As discussed above, the steering angle offset value may be estimated using equation (1.3): <CWU><MATHUS><MATHEMATICA></MATHEMATICA><MATHML><math><mtable><mtr><mtd><mrow><mrow><mo>[</mo><mtable><mtr><mtd><mover><mi>β</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mover><mi>ψ</mi><mi>¨</mi></mover></mtd></mtr><mtr><mtd><msub><mover><mi>δ</mi><mo>.</mo></mover><mi>Off</mi></msub></mtd></mtr></mtable><mo>]</mo></mrow><mo>=</mo><mrow><mrow><mrow><mo>[</mo><mtable><mtr><mtd><mfrac><mrow><msub><mi>C</mi><mi>v</mi></msub><mo>+</mo><msub><mi>C</mi><mi>h</mi></msub></mrow><mrow><mi>m</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><mi>v</mi></mrow></mfrac></mtd><mtd><mrow><mfrac><mrow><mrow><msub><mi>C</mi><mi>h</mi></msub><mo></mo><msub><mi>l</mi><mi>h</mi></msub></mrow><mo></mo><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msub><mi>l</mi><mi>v</mi></msub></mrow></mrow><mrow><mi>m</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><msup><mi>v</mi><mn>2</mn></msup></mrow></mfrac><mo></mo><mn>1</mn></mrow></mtd><mtd><mfrac><msub><mi>C</mi><mi>v</mi></msub><mrow><mi>m</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><mi>v</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><msub><mi>i</mi><mi>s</mi></msub></mrow></mfrac></mtd></mtr><mtr><mtd><mfrac><mrow><mrow><msub><mi>C</mi><mi>h</mi></msub><mo></mo><msub><mi>l</mi><mi>h</mi></msub></mrow><mo></mo><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msub><mi>l</mi><mi>v</mi></msub></mrow></mrow><msub><mi>J</mi><mi>z</mi></msub></mfrac></mtd><mtd><mrow><mo></mo><mfrac><mrow><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msubsup><mi>l</mi><mi>v</mi><mn>2</mn></msubsup></mrow><mo>+</mo><mrow><msub><mi>C</mi><mi>h</mi></msub><mo></mo><msubsup><mi>l</mi><mi>h</mi><mn>2</mn></msubsup></mrow></mrow><mrow><msub><mi>J</mi><mi>z</mi></msub><mo></mo><mi>v</mi></mrow></mfrac></mrow></mtd><mtd><mfrac><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msub><mi>l</mi><mi>v</mi></msub></mrow><mrow><msub><mi>J</mi><mi>z</mi></msub><mo></mo><msub><mi>i</mi><mi>s</mi></msub></mrow></mfrac></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable><mo>]</mo></mrow><mo></mo><mrow><mo>[</mo><mtable><mtr><mtd><mi>β</mi></mtd></mtr><mtr><mtd><mover><mi>ψ</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><msub><mi>δ</mi><mrow><mi>O</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><mi>ff</mi></mrow></msub></mtd></mtr></mtable><mo>]</mo></mrow></mrow><mo>+</mo><mrow><mrow><mo>[</mo><mtable><mtr><mtd><mfrac><msub><mi>C</mi><mi>v</mi></msub><mrow><mi>m</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><mi>v</mi><mo></mo><mstyle><mtext> </mtext></mstyle><mo></mo><msub><mi>i</mi><mi>s</mi></msub></mrow></mfrac></mtd></mtr><mtr><mtd><mfrac><mrow><msub><mi>C</mi><mi>v</mi></msub><mo></mo><msub><mi>l</mi><mi>v</mi></msub></mrow><mrow><msub><mi>J</mi><mi>z</mi></msub><mo></mo><msub><mi>i</mi><mi>s</mi></msub></mrow></mfrac></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable><mo>]</mo></mrow><mo>·</mo><mrow><msub><mi>δ</mi><mi>Uncenter</mi></msub><mo>.</mo></mrow></mrow></mrow></mrow></mtd><mtd><mrow><mo>(</mo><mn>1.3</mn><mo>)</mo></mrow></mtd></mtr></mtable></math></MATHML><EMI></EMI></MATHUS></CWU>
Also as discussed above, by using a time index k, this equation can be approximately formulated in a standard discrete matrix form:
<F>x(k+1)=A(k)x(k)+b(k)·u(k)+v(k)</F>
<F>y(k)=c<HIL><SP>T</SP></HIL>x(k)+w(k) (1.6)</F>
wherein (for the first approach described above): <CWU><MATHUS><MATHEMATICA></MATHEMATICA><MATHML><math><mrow><mrow><mi>A</mi><mo>=</mo><mrow><mo>[</mo><mtable><mtr><mtd><msub><mi>a</mi><mn>11</mn></msub></mtd><mtd><msub><mi>a</mi><mn>12</mn></msub></mtd><mtd><msub><mi>b</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><msub><mi>a</mi><mn>21</mn></msub></mtd><mtd><msub><mi>a</mi><mn>22</mn></msub></mtd><mtd><msub><mi>b</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable><mo>]</mo></mrow></mrow><mo>,</mo></mrow></math></MATHML><EMI></EMI></MATHUS></CWU> x<HIL><SP>T</SP></HIL>=[β{dot over (ψ)}δ<HIL><SB>Off</SB></HIL>],
<CWU><MATHUS><MATHEMATICA></MATHEMATICA><MATHML><math><mtable><mtr><mtd><mrow><mrow><mi>b</mi><mo>=</mo><mrow><mo>[</mo><mtable><mtr><mtd><msub><mi>b</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><msub><mi>b</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable><mo>]</mo></mrow></mrow><mo>,</mo></mrow></mtd><mtd><mrow><mo>(</mo><mrow><mn>1.5</mn><mo></mo><mi>a</mi></mrow><mo>)</mo></mrow></mtd></mtr></mtable></math></MATHML><EMI></EMI></MATHUS></CWU> u=δ<HIL><SB>Uncenter </SB></HIL>and
<F>c<HIL><SP>T</SP></HIL>=[010].</F>
To obtain equation (1.6), the process noise v(k) and measurement noise w(k) are assumed to be independent random variables having an average value of zero. These model equations are then used to obtain an estimate of δ<HIL><SB>off</SB></HIL>.
As mentioned above, a stateobserver can be applied to equation (1.4) or the Kalmanfilter can be applied to equation (1.6). In this embodiment, the Kalmanfilter is applied to equation (1.6). In both cases the state vector x(k) is estimated. The general form of the estimation in both cases can be given as:
<F>ˆ(k+1)=A(k)ˆ(k)+b(k)·u(k)+K(k)(y−ŷ)</F>
<F>ŷ(k)=c<HIL><SP>T</SP></HIL>ˆ(k) (1.6a)</F>
wherein ˆ(k)=[{circumflex over (β)}{circumflex over (ψ)}{circumflex over (δ)}<HIL><SB>Off</SB></HIL>]<HIL><SP>T </SP></HIL>and represents the estimated values of the body slip angle, yaw rate and steering angle offset, i.e., β, {dot over (ψ)}, δ<HIL><SB>Off</SB></HIL>. K(k) is the gain matrix calculated from A(k), b(k) and c<HIL><SP>T </SP></HIL>given by Equation (1.5) the use of such gain matrixes is known in the art.
The integration of the differential equation (1.6a) provides estimated values for the body slip angle, yaw rate and steering angle offset value. Thus, equation (1.6a) yields an estimate for the steering angle offset and each of the two measurable values (yaw rate and body slip angle) described by y(k). If measured values are available for either or both of these operating parameters, the estimated values may be compared to the measured values. The difference between the estimated values and the measured values, (y−ŷ), is referred to as the model difference or model error. If such an approach is taken, the determination of the estimated values may be made after the estimated values have converged with the corresponding measured value(s), i.e., when (y−ŷ)=0.
Returning to the gain matrix K(k) of equation (1.6a), the gain matrix K(k) will differ depending upon whether equation (1.6a) is obtained from the application of the Kalmanfilter to equation (1.6) or a stateobserver to equation (1.4). When equation (1.6a) is obtained by applying the Kalmanfilter to equation (1.6), the gain matrix K(k) may be defined as follows:
K(k)=P(k)c[c<HIL><SP>T </SP></HIL>(k)P(k)c+R(k)]<HIL><SP>−1</SP></HIL>
<F>P(k+1)=A(k)M(k)A<HIL><SP>T</SP></HIL>(k)+Q(k),</F>
<F>M(k)=P(k)−K(k)c<HIL><SP>T</SP></HIL>P(k) (1.6b)</F>
wherein R(k) and Q(k) are adjustable matrixes and relate to noise. When equation (1.6a) is obtained by applying a stateobserver to equation (1.4), the gain matrix K(k) may be defined as follows:
<F>K(k)=P(k)c[c<HIL><SP>T</SP></HIL>(k)P(k)c+I]<HIL><SP>−1</SP></HIL></F>
<F>P(k+1)=A(k)M(k)A<HIL><SP>T</SP></HIL>(k)</F>
<F>M(k)=P(k)−K(k)c<HIL><SP>T</SP></HIL>P(k) (1.6c)</F>
wherein I is an unit matrix. As discussed above, the difference between the estimated values and the measured values is referred to as the model difference or model error. According to Kalmanfilter and stateobserver theory, for equation (1.6a) the defined signals ˆ(k) will converge to x(k) and ŷ will converge to y, i.e., the estimated state variables will converge to their true values and the estimates of the measurable signals will converge to the measured values. In other words, the model error tends toward zero.
One embodiment of the filtering and determination process represented by box 14 will now be described. In the exemplary embodiment, the values obtained for doff are filtered in accordance with the following equation:
<F>δ<HIL><SB>Off,k+1</SB></HIL>=δ<HIL><SB>Off,k</SB></HIL>+F<HIL><SB>k</SB></HIL>·({circumflex over (δ)}<HIL><SB>Off</SB></HIL>−δ<HIL><SB>Off,k</SB></HIL>). (2.1)</F>
wherein:
k represents the time index; and
F<HIL><SB>k </SB></HIL>represents the filter coefficient.
This filtering process functions similar to a lowpass filter.
Filter coefficients are typically constant. The filter coefficient utilized in this process is not a constant, however, but a function which depends on the uncertainty of the estimated signal and is defined as follows:
<F>F<HIL><SB>k</SB></HIL>=T(1−Q<HIL><SB>k</SB></HIL>) (2.2)</F>
wherein:
<F>Q<HIL><SB>k+1</SB></HIL>=Q<HIL><SB>k</SB></HIL>+T(1−Q<HIL><SB>k</SB></HIL>) (2.3)</F>
and T is a timevarying coefficient which is defined as:
T=c<HIL><SB>0</SB></HIL>(1−U<HIL><SB>k</SB></HIL>Q<HIL><SB>k</SB></HIL>) (2.4)
wherein:
c<HIL><SB>0 </SB></HIL>represents a constant which may be used to adjust the value of T; and
U<HIL><SB>k </SB></HIL>represents the uncertainty of the estimated signals.
The value of U<HIL><SB>k </SB></HIL>is representative of the scattered range of values which surround the signal being estimated. There are multiple ways of calculating a value for U<HIL><SB>k </SB></HIL>and the value of U<HIL><SB>k </SB></HIL>advantageously varies with the current driving situation, e.g., whether the vehicle is in a long turn, on a rough road or whether the steering angle is being rapidly changed. For the filter to accurately reflect the dynamic behavior of the vehicle, it is desirable for the uncertainty factor U<HIL><SB>k </SB></HIL>to reflect the current dynamic characteristics of the vehicle. The uncertainty factor U<HIL><SB>k </SB></HIL>of the present embodiment is defined as follows:
<F>U<HIL><SB>k</SB></HIL>=c<HIL><SB>ψ</SB></HIL>({dot over (ψ)}·∫{dot over (ψ)}dt)+c<HIL><SB>δ</SB></HIL>·δ<HIL><SB>uncenter</SB></HIL>+{circumflex over (δ)}<HIL><SB>off</SB></HIL>+C<HIL><SB>y</SB></HIL>α<HIL><SB>y</SB></HIL>−{circumflex over (δ)}<HIL><SB>y</SB></HIL>, (2.5)</F>
wherein:
{dot over (ψ)} represents the yaw rate of the vehicle;
a<HIL><SB>y </SB></HIL>represents the lateral acceleration of the vehicle; and
c<HIL><SB>p</SB></HIL>, c<HIL><SB>δ</SB></HIL>, and c<HIL><SB>y </SB></HIL>represent normalization factors to maintain U<HIL><SB>k</SB></HIL><1.
The first term of equation (2.5) is dependent upon the yaw rate and reflects uncertainty associated with the change of driving direction. The second term of equation (2.5) is equivalent to the estimated steering angle and reflects uncertainty associated with a change in driving direction as represented by a change in the steering angle. For example, the steering angle will have a greater effect on the uncertainty when it is larger, e.g., larger than 30°, and the second term reflects a larger uncertainty for larger steering angle magnitudes. The third term of equation (2.5) is used if the measured value of the lateral acceleration is available. This third term reflects the deviation between the estimated lateral acceleration and the measured lateral acceleration and, thus, reflects an objective measurement of the deviation between the model used to estimate the dynamic behavior of the vehicle and the actual measured behavior of the vehicle.
As set forth above in equation (2.3), Q is auxiliary signal and tends toward 1.0 as k approaches ∞. Consequently, the filtered signal reaches a steady state as k approaches ∞. This allows the value of Q to be used as an indicator for determination, i.e., a Q<HIL><SB>set </SB></HIL>may be chosen and when Q=Q<HIL><SB>set </SB></HIL>the filtering process is complete, the “flag” value is set at 1 and a final value for the steering angle offset is selected. For example, Q<HIL><SB>set </SB></HIL>may be defined within the following range:
<F>0.9<Q<HIL><SB>set</SB></HIL><1.0. (2.6)</F>
The first test described above and having results illustrated in <FGREF>FIG. 5</FGREF>, successfully utilized the above described method using the Kalmanfilter with the first approach. <FGREF>FIGS. 7 and 8</FGREF> further illustrate the results of this first test. The center graph shown in <FGREF>FIG. 7</FGREF> displays the true or absolute steering angle position δ<HIL><SB>center</SB></HIL>, the uncorrected relative steering angle position signal δ<HIL><SB>Uncenter</SB></HIL>, and the estimated steering angle offset value {circumflex over (δ)}<HIL><SB>off</SB></HIL>. As mentioned above, the actual steering angle offset value for this first test was −18.5 degrees and it took 3.1 seconds for the system to converge on this value. The bottom graph of <FGREF>FIG. 7</FGREF> illustrates the values of Q and variable filter coefficient F as the estimated offset value converges with the actual steering angle offset value. The top graph of <FGREF>FIG. 7</FGREF> illustrates the value of the flag.
<FGREF>FIG. 8</FGREF> illustrates the value of the estimated steering angle offset value. Both the filtered, δ<HIL><SB>off</SB></HIL>, and unfiltered, {circumflex over (δ)}<HIL><SB>off</SB></HIL>, values of the estimated steering angle offset value are illustrated. The more variable line indicates the unfiltered estimated value.
The value of Q<HIL><SB>set </SB></HIL>selected for this test was 0.98 and when the value of Q reached 0.98 the flag was set and a final estimated value of the steering angle offset value was selected to continuously correct the relative steering angle position signal. As can be seen in the top graph of <FGREF>FIG. 7</FGREF>, it took slightly longer than 5 seconds for the value of Q to reach the Q<HIL><SB>set </SB></HIL>value of 0.98 and the flag to be set at 1. Upon the setting of the flag to 1, the final estimated value of the steering angle offset is used to correct the output of the relative position steering angle sensor until the vehicle is turned off. The process for estimating the steering angle offset value is repeated when the ignition is once again turned on.
The value of Q<HIL><SB>set </SB></HIL>may be selected for a particular vehicle system after conducting numerous tests and empirically determining the length of time required for the estimated value of the steering angle offset to converge with the actual offset value under various conditions. With this empirical data, an appropriate value for Q<HIL><SB>set </SB></HIL>may be selected.
While this invention has been described as having an exemplary design, the present invention may be further modified within the spirit and scope of this disclosure. This application is therefore intended to cover any variations, uses, or adaptations of the invention using its general principles.