1. Field of the Invention
The present invention relates to a vehicle dynamics control system and a method of controlling the vehicle dynamics. More particularly, the invention relates to a vehicle dynamics control system and a method of controlling the vehicle dynamics using integrated steering-traction/braking control for controlling a steering angle and traction or a steering angle and a braking force in an integrated manner to provide integrated control with an equalized steering angle of right and left wheels.
2. Description of the Related Art
The integrated steering-traction/braking control for controlling the steering angle and traction or braking force of a vehicle in an integrated manner is well known in the art for obtaining target vehicle force and moment indicating a target vehicle longitudinal force, a target vehicle lateral force, and a target yaw moment. In this integrated steering-traction/braking control, steering and traction/braking are independently controlled for each wheel such that the magnitude and the direction of force at each wheel are calculated and obtained for maximizing the tire grip margin of each wheel, that is, for minimizing the μ rate of each wheel (see, e.g., JP-A-2004-249971). Here, the symbol μ denotes the coefficient of friction between a tire and the road.
However, the magnitude of the force at each wheel calculated in the above related art may often differ from each other due to the respective calculations for wheels. Therefore, independent steering of the right and left wheels is required to obtain the calculated tire force of each wheel. The above control is thus not suitable for vehicles that have a steering mechanism that only can control the steering with an identical steering angle at the right and left wheels.
The present invention provides a vehicle dynamics control system and a method of controlling the vehicle dynamics such that calculations are performed to obtain the equalized steering angle of right and left wheels during an integrated steering-traction/braking control and therefore the integrated steering-traction/braking control suitable even for vehicles having a steering mechanism that only can control with the identical steering angle for right and left wheels.
A first aspect of the present invention is directed to a vehicle dynamics control system including tire force calculation means for calculating a tire force at each wheel to achieve target vehicle force and target vehicle moment that indicates the target vehicle longitudinal force, a target vehicle lateral force, and a target yaw moment; longitudinal μ rate calculation means for calculating a longitudinal μ rate, which is obtained by normalizing a longitudinal force of each tire with a size of each tire friction circle representing the maximum tire force of each wheel; steering angle calculation means for calculating a steering angle equalized for the right and left wheels based on the longitudinal μ rate of each tire, a lateral force of each tire, and a vertical load of each tire; and control means for controlling vehicle dynamics based on the calculated steering angle.
A second aspect of the present invention is directed to a method of controlling vehicle dynamics that includes calculating a tire force of each wheel to achieve target vehicle force and moment indicating a target vehicle longitudinal force, a target vehicle lateral force, and a target yaw moment; calculating a longitudinal μ rate, which is obtained by normalizing a longitudinal force of each tire with the size of each tire friction circle representing the maximum tire force of each wheel; calculating a steering angle equalized for right and left wheels based on the longitudinal μ rate of each tire, a lateral force of each tire, and a vertical load of each tire; and controlling vehicle dynamics based on the steering angle calculated.
A third aspect of the present invention is directed to a vehicle dynamics control system that includes a tire force calculation section for calculating a tire force of each wheel to achieve target vehicle force and moment indicating a target vehicle longitudinal force, a target vehicle lateral force, and a target yaw moment; a longitudinal μ rate calculation section for calculating a longitudinal μ rate, which is obtained by normalizing a longitudinal force of each tire with a size of each tire friction circle representing the maximum tire force of each wheel; a steering angle calculation section for calculating a steering angle equalized for right and left wheels based on the longitudinal μ rate of each tire, a lateral force of each tire, and a vertical load of each tire; and a control section for controlling vehicle dynamics based on the steering angle calculated.
In the above aspects, it is found that a specific relation is always achieved between the longitudinal μ rate and decreasing characteristics of the lateral force along with the longitudinal force irrespective of road friction or the steering angle. By using this finding, the lateral force is distributed to the right and left wheels in order to obtain an equalized steering angle for the right and left wheels, and the vehicle is intended to be controlled with the equalized steering angle for the right and left wheels obtained by calculations in an integrated manner. Thus, the equalized steering angle for the right and left wheels is calculated by using the tire force of each wheel optimally calculated subject to four-wheel distributed steering in order to maintain the sum of the lateral forces generated on right and left tires of front or rear wheels. Therefore, the vehicle is controlled with the equalized steering angle for the right and left wheels in an integrated manner.
The steering angle equalized for the right and left wheels is calculated by approximating with a parabola the relation between the longitudinal μ rate in case of a constant lateral slip and a normalized lateral force that the lateral force of each tire is normalized with the maximum lateral force, and by distributing an optimum lateral force of each tire for achieving the target vehicle force and moment assuming that the lateral force, when a longitudinal slip equals to zero, is proportional to a vertical load and based on a ratio of the lateral force of each tire when the lateral slip of right and left tires are the same.
According to the above aspects, because the equalized steering angle for right and left wheels is calculated when performing the integrated steering-traction/braking control, the integrated steering-traction/braking control can be adapted to even the vehicle having a steering mechanism that only can control with an identical steering angle for right and left wheels.
The foregoing and/or further objects, features and advantages of the invention will become more apparent from the following description of example embodiments with reference to the accompanying drawings, in which like numerals are used to represent like elements and wherein:
In the following description, the present invention will be described in more detail in terms of example embodiments.
One embodiment of the present invention will be described hereinafter in detail with reference to accompanying drawings. First, the principle of a coordinate control between steering and traction and between steering and braking in a vehicle with four-wheel distributed steering and traction/braking system, in other words, integrated control, will be described.
Assuming that the sizes of friction circles Fi of wheels are known (where, i=1, 2, 3, and 4, and 1: left front wheel, 2: right front wheel, 3: left rear wheel, and 4: right rear wheel), the directions of the tire force and the μ rate of the wheels are evaluated in order to minimize the upper limit of the μ rate of wheel (maximum value in four wheels), while the designated target vehicle force (longitudinal force Fx0, and lateral force Fy0) and target yaw moment Mz0 (target vehicle force and moment) are attained. The size of the friction circle of each tire is expressed as the magnitude of the maximum tire force at each wheel and estimated from factors such as load or speed of each wheel and Self-Aligning Torque.
First, a constraint is modeled that the target resultant of vehicle forces and the target yaw moment (target vehicle force and moment) are gained. When the coordinate conversion is performed such that the direction of the resultant of tire forces is converted to X-axis and the direction perpendicular to the X-axis to Y-axis, tire positions (x, y)=(li, di) are defined as the following Eqs. (1) to (8).
Here, Tf is the front wheel track, Tr is the rear wheel track, Lf is the distance between the center of gravity of the vehicle and the midpoint of the front wheel track, Lr, is a distance between the center of gravity of the vehicle and the midpoint of the rear wheel track, li is the distance between X-axis and a ground contact point of a tire, and di is a distance between Y-axis and a ground contact point of a tire.
If the upper limit of μ rate at each wheel is γ, the tire μ rate representing the ratio to the upper limit γ at each wheel is ri, and the direction of each tire force is qi (the counter clockwise direction be the positive direction on the X-axis), the tire forces at each wheel (Fxi, Fyi) may be expressed as the following Eqs. (9) and (10).
Fxi=γriFi cos qi (9)
Fyi=γriFi sin qi (10)
The vehicle forces (longitudinal force Fx0 and lateral force Fy0), which are the resultants of the tire forces at the wheels, and the yaw moment Mz0 may be expressed with the following constraints.
When both sides of the Eq. (11) are multiplied by the lateral force Fy0, both sides of the Eq. (12) are multiplied by the longitudinal force Fx0, and the resulting Eq. (12) is subtracted from the resulting Eq. (11), the following Eq. (14) that the upper limit γ or μ rate is eliminated is derived.
When both sides of the Eq. (11) are multiplied by the moment Mz0, both sides of the Eq. (13) are multiplied by the longitudinal force Fx0 and the resulting Eq. (13) is subtracted from the resulting Eq. (11), the following Eq. (15) that the upper limit γ is eliminated is derived.
In addition, when the both sides of the Eq. (12) are multiplied by the yaw moment Mz0, the both sides of the Eq. (13) are multiplied by the lateral force Fy0, and the resulting Eq. (13) is subtracted from the resulting Eq. (12), the following Eq. (16) that the upper limit γ of μ rate is eliminated is derived.
Then, adding both of the Eqs. (14) to (16) that the upper limit γ of μ rate is eliminated derives the following Eq. (17).
When the both sides of Eqs. (11), (12), and (13) are multiplied by d02Fx0, l02Fy0, and Mz0, respectively, and the resulting three equations are added, the following Eq. (18) is derived.
Here, d0 and l0 are constants that respectively adjust the dimensions of the force and moment. In this embodiment, the d0 and l0 are defined as the following Eqs. (19) and (20).
The magnitude MF0 of the target vehicle force and moment is defined through the following Eq. (21).
The constraints are used in the following Eqs. (22) and (23) that are derived by eliminating the upper limit γ of μ rate from Eqs. (13) and (18) and normalized with the magnitude MF0 of the target vehicle force and moment.
The constraints of the above Eqs. (22) and (23) work when any two of Fx0, Fy0, and Mz0 become zero. The normalization is performed for improving the computation accuracy in the fixed-point arithmetic using a computer such as an ECU or a program.
The following Eq. (24) is defined as a performance function J intending to minimize the upper limit γ of μ rate.
This performance function is expressed as (constant)/(upper limit γ of μ rate), and maximizing the solution of the Eq. (24) implies minimizing the μ rate. By substitution of the above Eq. (18) into the performance function, the performance function is expressed as the following Eq. (25).
When the direction of each tire force qi and the tire μ rate ri are obtained for maximizing the solution of the Eq. (25), the upper limit γ of μ rate is minimized.
Therefore, the nonlinear optimization problem can be formulated as follows. That is, the direction of each tire force qi and the tire μ rate ri are derived in order to satisfy the constraints of the Eqs. (22) and (23) and to maximize the solution of the Eq. (25).
A distribution algorithm of each tire force is described next. In addition to the problem of the related art that the μ rate of each wheel is equally determined, this embodiment requires to include the tire μ rate ri into parameters. In this embodiment, a repeat operation is performed using the algorithm for individually optimizing the direction of each tire force qi and the tire μ rate ri each time, so that the direction of each tire force qi and the tire μ rate ri can be obtained.
To find a constant μ rate friction circle, the direction of each tire force qi is first solved using a sequential quadratic programming algorithm as the related art with the tire u rate ri fixed.
By performing first-order approximation of sin qi and cos qi as the following Eqs. (26) and (27), the constraints of the above Eqs. (22) and (23) can be linearized relative to the direction of each tire force qi as the following Eqs. (28) and (29).
When sin qi and cos qi are approximated by a second-order Taylor expansion as the following Eqs. (30) and (31), the performance function J of the above Eq. (25) is expressed as the following Eq. (32).
By transforming variables as the following Eq. (37), the performance function J of the Eq. (25) is expressed as the following Eq. (38) and transformed to the minimization of p-Euclidean norm.
The linearly approximated constraints are expressed as the following Eq. (39).
The minimal solution of Euclidean norm for satisfying the above Eq. (39) is derived by using the following Eq. (44).
Here, A+ represents the pseudo-inverse of matrix A.
The direction of each tire force q is expressed as the following Eq. (45)
According to the direction of each tire force qi (=q1, q2, q3, q4), q is expressed as the following equation.
q=[q1q2q3q4]T
Here, a penalty function P is defined as the following Eq. (46) where ρ is a positive constant (1.0). When the penalty function of Eq. (46) is calculated by using the direction of each tire force qi derived in Eq. (45) and if the penalty function P shows a decline, convergence calculations are performed in a recursive manner that calculations of Eqs. (33) to (35), Eqs. (40) to (43), and Eq. (45) are repeatedly performed.
The μ rate using the direction of each tire force qi derived by the above algorithm is calculated with the following Eq. (49) derived from Eqs. (24) and (28). The Eq. (49) shows that the μ rate is defined as the proportion of the square of the magnitude of the target vehicle force and moment on the performance function.
The correction of tire μ rate will be described next. When the tire μ rate ri (=r1, r2, r3, r4) is changed to ri+dri (where dri is an amount of change) and corrected, the above Eqs. (22) and (23) representing the constraints of the target vehicle force and moment are expressed as the following Eqs. (50) and (51).
When the tire μ rate ri is changed, the direction of each tire force qi and the performance function are also changed. Therefore, q of Eq. (45) is required to be corrected to q+dq, for example, in order to satisfy the constraints of the target vehicle force and moment when the tire μ rate ri is changed to ri+dri. Here, the amount of change dq representing the direction of each tire force q is expressed as the following Eq. (54)
Here, dq is expressed as the following equation with the amount of change dqi (=dq1, dq2, dq3, dq4) of the direction of each tire force.
dq=[dq1dq2dq3dq4]T
In this embodiment, satisfying the constraints of the target vehicle force and moment is only considered, and therefore the correction is undefined. That is, an indefinite number of the correction methods is proposed; however, this embodiment applies the correction method using the derived pseudo-inverse matrix for simplifying the calculation. At that time, the performance function J of Eq. (25) changes to J+dJ. Here, the amount of change dJ is expressed as the following Eq. (55).
The amount of change dJ of the performance function J is therefore expressed as the following Eq. (56) derived from the approximate partial differentiation of the performance function J.
Here, D1i and D2i are defined as the following Eqs. (57) and (58).
In this embodiment, the interior point is searched according to the steepest-descent method such that r (=[r1r2r3r4]T) is changed as the following Eq. (59) in the range 0-1, and the repeat operation proceeds to the next step. Here, r0 denotes the previous value of the tire μ rate r in the repeat operation, and k denotes a positive constant. By this method, the tire μ rate r is corrected to be smaller in case that the performance function J is changed to be larger.
In this case, with the change of the tire μ rate r, q is corrected to q+dq in order to satisfy the constraints of the vehicle force and moment. Here, dq is expressed as the following Eq. (54).
The upper limit γ of μ rate is calculated according to the above Eq. (49) by using the angle qi derived as described above.
A specific structure of this embodiment using the above principle will be described next with reference to
The calculation means 10 is connected to a tire force calculation device 12 for calculating the tire force of each wheel and each tire μ rate ri from the size of the utilization friction circle and the target vehicle force and moment, which are the target values of vehicle longitudinal force, vehicle lateral force, and yaw moment. This calculation device 12 is connected with control means 14 for attaining the calculated each tire force with the vehicle integrated control.
The tire force calculation device 12 is provided with tire force direction calculation means 12A for calculating the direction of each tire force qi for minimizing the upper limit γ of μ rate according to the above Eq. (45) with the constraints for achieving the target vehicle force and moment using the target vehicle force and moment and the utilization friction circle of each tire calculated with the utilization friction circle calculation means 10.
The calculation means 12A is connected with tire μ rate calculation means 12B for calculating the tire μ rate ri according to the above Eq. (59) to decrease the upper limit γ of μ rate with the constraints for achieving the target vehicle force and moment. The calculation means 12B changes the tire μ rate ri in the range 0-1. When the performance function J varies greatly, the calculation means 12B changes the tire μ rate ri to be small.
The calculation means 12B also outputs the previous value in the repeat operation of the tire μ rate by the calculation means 12B to the utilization friction circle calculation means 10.
In addition, the calculation means 12B is connected with tire force direction correction means 12C for correcting the direction of each tire force along with the calculation of the tire μ rate according to the Eq. (54) and corresponding to the tire μ rate in order to achieve the target vehicle force and moment.
The correction means 12C outputs the previous value of the direction of each tire force to the tire force direction calculation means 12A.
The correction means 12C is connected with tire force calculation means 12D for calculating each tire force from the tire μ rate, the corrected direction of each tire force, and the minimized upper limit of μ rate. This calculation means 12D calculates tire forces Fxi and Fyi at each wheel according to the Eqs. (9) and (10).
The calculation means 12D is connected with μ rate and steering angle calculation means 12E for calculating a longitudinal μ rate and an equalized steering angle for the right and left wheels.
As shown in
The vertical load at each tire may be measured by a sensor disposed at each wheel and estimated based on the longitudinal acceleration, the lateral acceleration, the height of the center of gravity of the vehicle from the ground, and the vehicle weight when stopping.
Next, the principle of calculating the equalized steering angle for the right and left wheels in the μ rate and steering angle calculation means 12E will be described.
First, in order to simplify the expression of the tire longitudinal and lateral forces as the tire force according to a brush model, the longitudinal slip κx the lateral slip κy and combined slip κ are defined as follows.
Here, vx is longitudinal tire position speed, vy is lateral tire position speed, vw is tire rotational speed, Ks is longitudinal tire stiffness, and Kβ is lateral tire stiffness.
The direction θ of tire force coincides with the direction of slip, that is, the direction θ is assumed to satisfy the following Eq. (63).
The tire longitudinal force Fx and lateral force Fy are expressed as the following Eqs. (64) to (67) in accordance with a tire gripping range and a full slipping range.
Here, μ denotes road friction, and Fz denotes a vertical load.
The longitudinal and lateral tire stiffness are proportional to the vertical load, that is, the stiffness is assumed to be expressed as the following Eqs. (68) and (69).
Ks=Kx0Fz(68)
Kβ=Kβ0Fz(69)
The lateral force Fy in the gripping range is expressed as the following Eq. (70) using the above Eqs. (63), (65), and (68).
The above Eq. (70) shows that the lateral force Fy is proportional to the vertical load and more specifically, proportional only to the vertical load in the vicinity of the origin where the slip is small without being affected by road friction.
The equalization of the steering angles for the right and left wheels will be described next.
In the integrated steering-traction/braking control for controlling the steering angle and the traction or the steering angle and the braking force in an integrated manner, the target tire force is attained with the control of the steering angle and the traction/braking force in the gripping range. Therefore,
In
According to the normalization, the relation between the longitudinal μ rate (normalized longitudinal force) in case of the constant lateral slip and the normalized lateral force may be approximated with approximately one parabola independent of the value of lateral slip or the road friction. In this embodiment, the characteristics approximated with the parabola may be approximated by the following Eq. (71).
{circumflex over (F)}
y=1−0.45·{circumflex over (F)}x2 (71)
Although the longitudinal μ rate is expressed with a quadratic function of normalized lateral force, the longitudinal μ rate may be approximated by other functions such as a quartic function or may be shown in a map.
According to
F
yl
:F
yR
={circumflex over (F)}
yL
·F
yL|κ
Considering the Eq. (72) and Eq. (71) defining the relation between the normalized lateral force and the longitudinal μ rate and the fact that the lateral force when the longitudinal slip equals to zero is approximately proportional to the vertical load as indicated in the above Eq. (70), the ratio of lateral force for right and left tires is expressed as the following Eq. (73).
Here, the subscripts “L” and “R” denote the left and right wheels, respectively. If the redistribution of the sum of lateral force commanding values for the right and left tires calculated with optimum distribution is implemented according to the Eq. (73), the integral control is attained for equalizing the lateral slip of the right and left tires, that is, for achieving the target vehicle force and moment with the equalized steering angle of the right and left wheels.
More specifically, if the longitudinal and lateral forces of the right and left tires calculated by an optimum distribution algorithm of tire forces are FxL, FxR, FyL, and FyR, respectively, the lateral forces are calculated with the following Eqs. (74) and (75).
In addition, the lateral slips at that time are expressed as the following Eqs. (76) and (77).
Thus, the slip angles βL and βR of tires are expressed as the following Eqs. (78) and (79).
The steering angles dL and dR are expressed as the following Eqs. (80) and (81) by using a vehicle slip angle β and yaw angular velocity r.
Here, l is a distance from an axle to the center of gravity, which is Lf in case of a front axle and -Lr in case of a rear axle. The right and left steering angles obtained from Eqs. (80) and (81) may differ slightly from each other due to the approximate result of the tire characteristics. Therefore, this embodiment uses the average value of the right and left steering angles as a steering angle. The steering angle may be calculated in consideration of Ackerman Mechanism.
Then, the coordinate control between the traction and the steering angle or between the braking force and the steering angle of the vehicle is performed by using the traction/braking force of each tire and the steering angle of each wheel, calculated as described above, as the operation amount.
When performing the coordinate control, the control means controls a steering actuator and a traction/braking actuator and also controls the steering angle of each wheel required to attain the each target tire force or the steering angle and the traction/braking force of each wheel.
For the control means 14, braking force control means, traction control means, front wheel steering control means, or rear wheel steering control means described as follows may be used.
The braking force control means may include control means used in a so-called Electronic Stability Control (ESC) that controls the braking force of each wheel independently of the driver's operation, control means mechanically separated from the driver's operation for arbitrarily controlling the braking force of each wheel through a signal line (so-called Brake-by-Wire), and other means.
The traction control means may include control means for controlling the traction by controlling engine torque through the throttle opening, retarding the angle of an ignition timing advance, or the amount of fuel injection, control means for controlling the traction by controlling the gear position of a transmission, control means for controlling the traction in at least one of lateral and longitudinal directions by controlling a torque transfer system, and other means.
The front wheel steering control means may include controlling means for controlling the steering angle of the right and left front wheels to the equalized steering angle overlapped with the driver's operation of the steering wheel, control means mechanically separated from the driver's operation for controlling the steering angle of the right and left front wheels to the equalized steering angle independently of the operation of the steering wheel (so-called Steer-by Wire), and other means.
The rear wheel steering control means may include controlling means for controlling the steering angle of the right and left rear wheels to the equalized steering angle corresponding to the driver's operation of the steering wheel, control means mechanically separated from the driver's operation for controlling the steering angle of the right and left rear wheels to the equalized steering angle independently of the operation of the steering wheel, and other means.
The aforementioned utilization friction circle calculation means 10, the tire force calculation device 12 (the tire force direction calculation means 12A, the tire μ rate calculation means 12B, the tire force direction correction means 12C, the tire force calculation means 12D, and the μ rate and steering angle calculation means 12E), and the control means 14 may be configured with one or plural computer(s). In this case, the computer stores a program for allowing the computer to function as the aforementioned means.
The simulation result of the above embodiment will be described next.
While the invention has been described with reference to example embodiments thereof, it should be understood that the invention is not limited to the described embodiments or constructions. To the contrary, the invention is intended to cover various modifications and equivalent arrangements. In addition, while the various elements of the example embodiments are shown in various combinations and configurations, other combinations and configurations, including more, less or only a single element, are also within the spirit and scope of the invention.
Number | Date | Country | Kind |
---|---|---|---|
2006-101066 | Mar 2006 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/IB2007/000834 | 3/30/2007 | WO | 00 | 7/2/2008 |