Vehicle body motion realization method and apparatus

Abstract
Various state amounts of a vehicle body detected by various types of sensors are captured (step 102). A maximum frictional force Fimax is calculated for each of wheels (steps 104 to 110). By use of the maximum frictional force Fimax and other physical quantities, a performance function not dependent on respective magnitudes of a vehicle body generating force and a yaw moment is defined, which performance function is prepared by means of a performance function in a case in which the vehicle body generating force is larger than the yaw moment, and a performance function in a case in which the vehicle body generating force is not larger than the yaw moment (step 112). A resultant force qi of tire generating forces acting on respective wheels is calculated by means of a third performance function (step 114), and braking and driving forces of each wheel, and a steering angle of each wheel are obtained by means of the calculated direction in which the resultant force of tire generating forces acts on the wheels (step 116). Based on the obtained braking and driving forces and steering wheel of each of the wheels, these wheels are each controlled (step 118).
Description
TECHNICAL FIELD

The present invention relates to a vehicle body motion realization method and apparatus, and particularly to a vehicle body motion realization method and apparatus in which a vehicle realizes a predetermined vehicle body motion.


BACKGROUND ART

Japanese Patent Application No. 2003-024177 discloses four-wheel individual steering and individual braking/driving control which maximizes vehicle body generating force in the process of realizing a desired direction in which vehicle body generating force acts, and a yaw moment. In this technique, a utilization factor of a road surface friction coefficient μ between a tire of each wheel and the road surface (hereinafter referred to as μ utilization factor) derives an optimum control rule which minimizes μ utilization factor on the assumption that the direction in which tire generating force acts is considered as a constant manipulated amount.


Further, Japanese Patent Application Laid-Open (JP-A) No. 11-348753 proposes control of braking force based on slip ratio target values of respective wheels for obtaining target yaw moment, vehicle longitudinal force and lateral force being calculated based on variations of yaw moment, vehicle longitudinal force and lateral force to small variations in the slip ratio between the respective wheels.


PROBLEMS TO BE SOLVED BY THE INVENTION

In the apparatus disclosed in the aforementioned Japanese Patent Application No. 2003-024177, a yaw moment is assumed to be small compared with necessary vehicle body generating force, and an optimum solution is derived based on a performance function corresponding to a ratio between a desired vehicle body generating force and a utilization factor of a road surface friction coefficient that is a friction coefficient between the road surface and a tire on the assumption that a direction in which tire generating force acts on each wheel is in the range of ±π/2 to the direction in which vehicle body generating force acts.


However, at the time of inhibiting a spin occurring on, for example, a road surface of which friction coefficient μ is low, or the like, a required yaw moment becomes larger in relation to the vehicle body generating force, no optimum solution can be derived on the assumption that the direction in which tire generating force acts on each wheel is in the range of ±π/2 to the direction in which vehicle body generating force acts, as described in the apparatus of the aforementioned patent application. Further, in the technique disclosed in the aforementioned JP-A No. 11-348753, a steepest descent calculation method using an inverse matrix of four rows and four columns in a braking force distribution logic for obtaining a slip ratio of each wheel is carried out, and a calculation load thereof is large.


The present invention has been achieved in the aforementioned circumstances, and an object of the present invention is to provide a vehicle body motion realization method and apparatus, which allows realization of a predetermined vehicle body motion irrespective of respective magnitudes of a vehicle body generating force and a yaw moment.


Disclosure of the Invention


In order to achieve the aforementioned object, a first invention is a vehicle body motion realization method in which a direction in which tire generating force acts is calculated for each wheel by means of a performance function including the direction in which the tire generating force acts, so as to realize desired yaw moment and vehicle body generating force for obtaining a predetermined vehicle body motion, and the vehicle body motion is realized by using the calculated direction in which the tire generating force acts, wherein the performance function is a performance function corresponding to a ratio between a sum of respective squares of the desired vehicle body generating force and yaw moment, and a utilization factor of a road surface frictional coefficient, which is a frictional coefficient between a road surface which is supposed to have a constant condition for each of wheels, and a tire.


Namely, according to the aforementioned invention, a direction in which tire generating force acts is calculated for each wheel by means of a performance function including the direction in which the tire generating force acts, so as to realize desired yaw moment and vehicle body generating force for obtaining a predetermined vehicle body motion, and the vehicle body motion is realized by using the calculated direction in which the tire generating force acts.


In this case, when it is assumed that the yaw moment is smaller compared with the vehicle body generating force, even if the direction in which the tire generating force acts is calculated for each wheel by means of a performance function corresponding to the ratio between the desired vehicle body generating force and the utilization factor of a road surface frictional coefficient that is a frictional coefficient between a road surface and a tire, so as to realize the desired yaw moment and vehicle body generating force, in a case in which the yaw moment is not smaller compared with the vehicle body generating force, the predetermined vehicle body motion cannot be properly realized even if the resultant force of tire generating forces is used.


Accordingly, in the present invention, as the performance function used in the present invention, a performance function corresponding to a ratio between the sum of respective squares of the desired vehicle body generating force and yaw moment, and the utilization factor of a road surface frictional coefficient, which is a frictional coefficient between a road surface which is supposed to have a constant condition, and a tire is used.


In this manner, according to the present invention, a performance function including respective magnitudes of the vehicle body generating force and the yaw moment is used. Therefore, as long as the direction in which the tire generating force acts is calculated from the performance function and is used, the predetermined vehicle body motion can be properly realized regardless of a balance between the magnitudes of the desired vehicle body generating force and yaw moment.


Further, the direction in which the tire generating force acts may be calculated for each wheel by carrying out linearization of restriction conditions of the desired yaw moment and vehicle body generating force and using the performance function. Thus, when the restriction conditions of the desired yaw moment and vehicle body generating force are linearized, calculating load can be reduced.


Specifically, for example, when the aforementioned wheels are four in number with two front wheels and two rear wheels, the direction in which the tire generating force acts on each wheel is obtained by means of a pseudo-inverse matrix of two rows and four columns prepared from the two linearized restriction conditions of the desired yaw moment and vehicle body generating force, and from the performance function.


A vehicle body motion realization method according to the second invention comprises: calculating means that calculates a direction in which tire generating force acts for each wheel based on detecting means for detecting state amounts of a vehicle, and a performance function including a direction in which tire generating force acts, so as to realize desired yaw moment and vehicle body generating force for obtaining a predetermined vehicle body motion; and control means that controls a steering angle of each wheel and braking and driving forces of each wheel based on the direction in which the tire generating force acts, which is calculated by said calculating means for each wheel, a value of the performance function used in calculation of the direction in which the tire generating force acts, and a utilization factor of a road surface frictional coefficient, which is a frictional coefficient between a road surface and a tire calculated based on the desired yaw moment and vehicle body generating force. The vehicle body motion realization apparatus of the present invention has the same operation and effect as those of the invention as described above, and therefore, description thereof will be omitted.


The calculating means of the vehicle body motion realization apparatus according to the present invention can be made to operate as below as is the case with the foregoing. Namely, the direction in which the tire generating force acts is calculated for each wheel by means of the performance function in which the desired yaw moment and vehicle body generating force are defined as restriction conditions. In this case, the direction in which the tire generating force acts may also be calculated for each wheel by carrying out linearization of the restriction states of the desired yaw moment and the vehicle body generating force, and also by using the performance function. For example, in a case in which the aforementioned wheels are four in number with two front wheels and two rear wheels, the direction in which the tire generating force acts may be calculated by means of a pseudo-inverse matrix of two rows and four columns prepared from the two restriction conditions of the linearized desired yaw moment and vehicle body generating force and from the performance function.





BRIEF DESCRIPTION OF THE DRAWING


FIG. 1 is a diagram showing a relationship between a critical lateral force and a yaw moment in a vehicle model with right-and-left two wheels.



FIG. 2 is a diagram showing a relationship between a vehicle body generating force and a yaw moment when in a critical state.



FIG. 3 is a diagram showing a vehicle model.



FIG. 4 is a diagram showing a coordinate system corresponding to a vehicle body generating force.



FIG. 5 is schematic structural diagram of a vehicle body motion realization apparatus according to an embodiment of the present invention.



FIG. 6 is a flow chart showing a vehicle body motion realization program for realizing a vehicle body motion realization method.



FIGS. 7A to 7D are diagrams showing calculation results for directions in which generating forces act on respective wheels according to the embodiment of the present invention.





BEST MODE FOR CARRYING OUT THE INVENTION

Referring now to the attached drawings, an embodiment of the present invention will be hereinafter described in detail.


Initially, using a performance function corresponding to a ratio between a sum of squares of a vehicle body generating force and a yaw moment in an embodiment of the present invention, and a utilization factor (μ utilization factor) of a road surface friction coefficient μ between a tire and a road surface, a principle of calculating the acting direction of a resultant of tire generating forces will be described.


First, a description of a relationship between a vehicle body generating force and a yaw moment at the time of critical running will be given.


There has been conventionally derived a control rule which maximizes a vehicle body generating force when a desired yaw moment and a direction in which a vehicle body generating force acts are given. However, there exists a trade-off relationship between the magnitude of vehicle body generating force and the yaw moment, and in a case in which a large yaw moment is obtained, the vehicle body generating force becomes smaller. To this end, when a yaw moment that exceeds the limit is required, it is necessary to consider as to which of the vehicle body generating force and the yaw moment should be prioritized and to adjust inputs (desired vehicle body generating force and yaw moment) to a control rule leading logic. Here, with the aim of utilizing for the aforementioned adjustment, a trade-off relationship between a vehicle body generating force and a yaw moment is derived in an approximate manner.



FIG. 1 represents a vehicle motion model approximated with right-and-left two wheels. In this model, it is assumed that load movement of each of the wheels therebetween is ignored and that lateral forces of critical friction are outputted from both of the right-and-left two wheels. At this time, if braking and driving forces having a magnitude u are applied to each of these right and left wheels, a yaw moment Mz is given as below.

Mz=2lu  (1)

wherein l represents a distance from the centroid of a vehicle to each wheel. Further, the resultant force F of lateral forces turns out to be the following expression.









F
=

2





(

µmg
2

)

2

-

u
2








(
2
)








wherein μ represents the road surface μ, m represents the mass of a vehicle, and g represents a gravitational acceleration. From the relationship between them, the following expression (3) is given.

√{square root over ((lF)2+Mz2)}=lμmg  (3)

The expression (3) is discussed on the assumption of no load movement or the like, but it represents the relationship between a vehicle body generating force, a yaw moment and the road surface μ. This expression (3) can also be considered as the extension to a four-wheel model by defining “l” as an average distance between the centroid of a vehicle and a position of each wheel. FIG. 2 shows the relationship of the expression (3) wherein μ=0.78 and l=1.5[m], and the relationship between the yaw moment and a maximized vehicle body generating force when a control rule derived based on a conventional logic (a direction in which a vehicle body generating force acts=0, π/4, π/2, roll rigidity distribution =one by application of an optimum map) in the light of load movement, or even load nonlinear characteristics of a friction circle, is applied to a detailed model in light of load movement of four wheels, or even load nonlinear characteristics of a friction circle. The expression (3) represents the relationship derived on the assumption of no load movement, but it can be found that even in a state in which load movement or load nonlinear characteristics of a friction circle is still further considered, a relatively good approximation is obtained.


It is assumed that as shown in FIG. 3, a direction θ in which force applied to a vehicle body acts as resultant force of tire generating forces acting on four wheels, and a magnitude Fimax (i=1: front left wheel, 2: front right wheel, 3: rear left wheel, and 4: rear right wheel) of a critical friction circle of each of the wheels are known, a direction in which tire generating force acts on each of the wheels (an angle qi formed by an acting direction of the resultant force and a single-wheel generating force) for uniformly maximizing the grip margin level of each wheel is obtained with desired yaw moment and vehicle body generating force being ensured. To this end, modeling of restriction conditions for ensuring desired yaw moment and vehicle body generating force is first carried out. When coordinate transformation is carried out in which a direction in which the resultant force of tire generating forces on four wheels acts is designated as x axis and a direction perpendicular to the x axis is designated as y axis, a position of each tire, (x, y)=(ai, bi), can be described as below (see FIG. 4):










a
1

=




T
f

2


cos





θ

-


L
f


sin





θ






(
4
)







a
2

=



-


T
f

2



cos





θ

-


L
f


sin





θ






(
5
)







a
3

=




T
r

2


cos





θ

+


L
r


sin





θ






(
6
)







a
4

=



-


T
r

2



cos





θ

+


L
r


sin





θ






(
7
)







b
1

=




T
f

2


sin





θ

+


L
f


cos





θ






(
8
)







b
2

=



-


T
f

2



sin





θ

+


L
f


cos





θ






(
9
)







b
3

=




T
r

2


sin





θ

-


L
r


cos





θ






(
10
)







b
4

=



-


T
r

2



sin





θ

-


L
r


cos





θ






(
11
)








Note that θ is set to be 0 at the time of direct-advance acceleration and the counterclockwise direction is defined as the positive direction. Further, when a yaw moment to be produced around the centroid of a vehicle at a current time point is designated as Mz0, a vehicle body generating force is designated as F0, and the μ utilization factor of each wheel is designated as γ, the following restriction conditions would exist in the direction in which tire generating force acts on each of the wheels (to define the counterclockwise direction as the positive direction in relation to a direction in which the resultant force of generating forces acts, that is, an angle qi formed by the acting direction of the resultant force of generating forces and a single-wheel generating force).











γ






F

1





max



sin






q
1


+

γ






F

2





max



sin






q
2


+

γ






F

3





max



sin






q
3


+

γ






F

4

max



sin






q
4



=
0




(
12
)








γ






F

1





max



cos






q
1


+

γ






F

2





max



cos






q
2


+

γ






F

3





max



cos






q
3


+

γ






F

4

max



cos






q
4



=

F
0





(
13
)









-

a
1



γ






F

1





max



cos






q
1


+


a
2


γ






F

2





max



cos






q
2


-


a
3


γ






F

3





max



cos






q
3


-


a
4


γ






F

4

max



cos






q
4


+


b
1


γ






F

1





max



sin






q
1


+


b
2


γ






F

2





max



sin






q
2


+


b
3


γ






F

3





max



sin






q
3


+


b
4


γ






F

4

max



sin






q
4



=

M

z





0






(
14
)








The aforementioned expression (12) can be described as follows:

F1 max sin q1+F2 max sin q2+F3 max sin q3+F4 max sin q4=0  (15)

Further, when the aforementioned expressions (13) and (14) are organized by deleting γ from each of the expressions (13) and (14), the following expression is given.












b
1







F
0



F

1





max



sin






q
1


+


b
2







F
0



F

2





max



sin






q
2


+


b
3







F
0



F

3





max



sin






q
3


+


b
4







F
0



F

4

max



sin






q
4


-


(



a
1



F
0


+

M

z





0



)



F

1

max



cos






q
1


-


(



a
2



F
0


+

M

z





0



)



F

2

max



cos






q
2


-


(



a
3



F
0


+

M

z





0



)



F

3

max



cos






q
3


-


(



a
4



F
0


+

M

z





0



)



F

4

max



cos






q
4



=
0




(
16
)








The restriction conditions are resultingly described as in the expressions (15) and (16).


When the magnitude of vehicle body generating force required is sufficiently larger than the yaw moment as in the conventional art, the direction in which tire generating force acts on each wheel is close to the direction in which vehicle body generating force acts, and it is considered that the relationship −π/2<qi<π/2 has been established. In this case, the problem of maximizing the grip margin level, that is, the problem of minimizing the μ utilization factor can be replaced by the problem of obtaining the relationship −π/2<qi<π/2 that maximizes the following expression (17) as a performance function (first performance function) based on the aforementioned expression (13) that is the restriction condition of vehicle body generating force.












J
=


F
0

γ







=



F

1

max



cos






q
1


+


F

2

max



cos






q
2


+


F

3

max



cos






q
3


+


F

4

max



cos






q
4










(
17
)








Further, if the yaw moment Mz0 is sufficiently larger than the vehicle body generating force F0, the aforementioned problem can be replaced by a problem of obtaining the relationship ai−π/2<qi<al+π/2 that maximizes the following expression (18) as a performance function (second performance function) based on the aforementioned expression (14) that is the restriction condition of the yaw moment.













J
=



1
γ







=





-



a
1



F

1

max




M

z





0





cos






q
1


-




a
2



F

2

max




M

z





0




cos






q
2


-




a
3



F

3

max




M

z





0




cos






q
3


-














a
4



F

4

max




M

z





0




cos






q
4


+




b
1



F

1

max




M

z





0




sin






q
1


+




b
2



F

2

max




M

z





0




sin






q
2


+














b
3



F

3

max




M

z





0




sin






q
3


+




b
4



F

4

max




M

z





0




sin






q
4









=






i
=
1

4




F

i





max







(


a
i


M

z





0



)

2

+


(


b
i


M

z





0



)

2





cos


(


q
i

-

α
i


)













where




(
18
)







α
i

=


-

tan

-
1






b
i


a
i







(
19
)








This condition represents that the direction in which tire generating force acts on each wheel generally coincides with the direction in which a desired yaw moment is produced. In this manner, a search region in the acting direction of tire generating force to be obtained varies between a case in which the performance function is set based on the expression (13) that is the restriction condition of vehicle body generating force and a case in which the performance function is set based on the expression (14) that is the restriction condition of yaw moment. In the present embodiment, by taking this property into consideration, a search region adapted to a balance between the magnitudes of desired vehicle body generating force and yaw moment is set by combining these performance functions.


The relationship between the vehicle body generating force and the yaw moment in a critical region is given by the aforementioned expression (3). From the foregoing, by achieving maximization of the following expression (20) serving as the performance function (third performance function), it is considered that the balance between the vehicle body generating force and the yaw moment can be evaluated in a balanced manner.









J
=




(

lF
0

)

2

+

M

z





0

2


γ





(
20
)








The aforementioned expression (20) can be described below from the relationship between the expressions (13) and (14).












J
=




(

lF
0

)

2

+

M

z





0

2


γ







=



l
2



F
0




F
0

γ


+


M

z





0





M

z





0


γ









=





i
=
1

4




l
2



F
0



F

i





max



cos






q
i



+




i
=
1

4




F

i





max





M

z





0




(



-

a
i



cos






q
i


+


b
i


sin






q
i



)











=




i
=
1

4




F

i





max




{



(



l
2



F
0


-


a
i



M

z





0




)


cos






q
i


+


b
i



M

z





0



sin






q
i



}










(
21
)








This problem can be solved by a technique of repeatedly using a pseudo-inverse matrix. First, if the restriction condition of the expression (15) is subjected to Taylor's expansion, it is rewritten as below.














i
=
1

4




F

i





max




{


sin






q

i





0



+


(


q
i

-

q

i





0



)


cos






q

i





0




}



=
0








That





is

,









i
=
1

4




F

i





max



cos







q

i





0


·

q
i




=




i
=
1

4




F

i





max




{



q

i





0



cos






q

i





0



-

sin






q

i





0




}









(
22
)








Further, Taylor's expansion of the expression (16) is described below.














i
=
1

4




b
i



F
0



F

i





max




{


sin






q

i





0



+


(


q
i

-

q

i





0



)


cos






q

i





0




}



=




i
=
1

4




(



a
i



F
0


+

M

z





0



)



F

i





max




{


cos






q

i





0



-


(


q
i

-

q

i





0



)


sin






q

i





0




}











That





is

,









i
=
1

4




F

i





max





{



b
i



F
0


cos






q

i





0



+


(



a

i








F





0



+

M






z





0




)


sin






q






i





0





}

·

q





i





=




i




=




1






4





F






i





max





{



b





i





F





0




(



q






i





0




cos






q

i





0



-

sin






q

i





0




)



+


(



a
i



F
0


+

M

z





0



)



(



q

i





0



sin






q

i





0



+

cos






q

i





0




)



}









(
23
)








where qi0 is qi in the previous step. If the expression (21) is approximated with a secondary Taylor's expansion, it can be described as below.










J
=





i
=
1

4




F

i





max


[







(



l
2



F
0


-


a
i



M

z





0




)

·

{


cos






q

i





0



-

sin







q

i





0




(


q
i

-

q

i





0



)



-



cos






q

i





0



2




(


q
i

-

q

i





0



)

2



}


+


b
i



M

z





0




{


sin






q

i





0



+

cos







q

i





0




(


q
i

-

q

i





0



)



-



sin






q

i





0



2




(


q
i

-

q
i


)

2



}



]


=





i
=
1

4




F

i





max




[



-

1
2




{




(



l
2



F
0


-


a
i



M

z





0




)

·
cos







q

i





0



+


b
i



M

z





0



sin






q

i





0




}



q
i
2


+


{



(



l
2



F
0


-


a
i



M

z





0




)

·

(



q

i





0



cos






q

i





0



-

sin






q

i





0




)


+


b
i




M

z





0




(



q

i





0



sin






q

i





0



+

cos






q

i





0




)




}



q
i


+


(



l
2



F
0


-


a
i



M

z





0




)

·

{




(

1
-


q

i





0

2

2


)

·
cos







q

i





0



-


q

i





0



cos






q

i





0




}


+


b
i



M

z





0




{




(

1
-


q

i





0

2

2


)

·
sin







q

i





0



-


q

i





0



cos






q

i





0




}



]



=








i
=
1

4




F

i





max


[







-

1
2




{




(



l
2



F
0


-


a
i



M

z





0




)

·
cos







q

i





0



+


b
i



M

z





0



sin






q

i





0




}








(


q
i

-

X
i


)

2


+

Y
i


]










where







X
i

=




(



l
2



F
0


-


a
i



M

z





0




)

·

(



q

i





0



cos






q

i





0



-

sin






q

i





0




)


+


b
i




M

z





0




(



q

i





0



sin






q

i





0



+

cos






q

i





0




)








(



l
2



F
0


-


a
i



M

z





0




)

·
cos







q

i





0



+


b
i



M

z





0



sin






q

i





0













Y
i

=



(



l
2



F
0


-


a
i



M

z





0




)

·

{




(

1
-


q

i





0

2

2


)

·
cos







q

i





0



+


q

i





0



sin






q

i





0




}


+


b
i



M

z





0




{




(

1
-


q

i





0

2

2


)

·
sin







q

i





0



-


q

i





0



cos






q

i





0




}


+



{



(



l
2



F
0


-


a
i



M

z





0




)

·

(



q

i





0



cos






q

i





0



-

sin






q

i





0




)


+


b
i




M

z





0




(



q

i





0



sin






q

i





0



+

cos






q

i





0




)




}

2



2



(



l
2



F
0


-


a
i



M

z





0




)

·
cos







q

i





0



+

2


b
i



M

z





0



sin






q

i





0











(
24
)








Here, if the relationship

(l2F0−aiMz0)·cos qi0+biMz0 sin qi0>0  (25)

is given, according to transformation of variable expressed (26) given as below,

pi=√{square root over (Fi max{(l2F0−aiMz0)·cos qi0+biMz0 sin qi0})}·(qi−Xi)  (26)

the maximization problem of the expression (24) becomes a minimization problem of the expression given as below.






K
=




i
=
1

4



p
i
2







Incidentally, the condition in the expression (25) turns out to be the sum of a calculation condition when a performance function is set as in the expression (17) based on the expression (13) that is a restriction condition of vehicle body generating force,

cos qi0>0
that is,
l2F0 cos qi0>0

and a calculation condition when a performance function is set as in the expression (18) based on the expression (14) that is a restriction condition of yaw moment,










a
i


cos






q

i





0



-


b
i


sin






q

i





0





M

z





0



<
0







that





is

,







M

z





0




(



-

a
i



cos






q

i





0



+


b
i


sin






q

i





0




)


>
0

,





and it can be expected that the aforementioned condition is established even when the vehicle body generating force and the yaw moment have the same level of magnitude. At this time, the expressions (22) and (23) into which the expressions (15) and (16) are subjected to a primary Taylor's expansion, can be respectively described as below (see the following expressions (28) and (29)) from the relation of the following expression (27).










q
i

=



1



F

i





max


(




(



l
2



F
0


-


a
i



M

z





0




)

·
cos







q

i





0



+


b
i



M

z





0



sin






q

i





0




}



·

p
i


+

X
i






(
27
)










i
=
1

4







F

i





max




cos






q

i





0








(



l
2



F
0


-


a
i



M

z





0




)

·
cos







q

i





0



+



b
i

·

M

z





0




sin






q

i





0






·

p
i



=




i
=
1

4




F

i





max




{



q

i





0



cos






q

i





0



-

sin






q

i





0



-


X
i


cos






q

i





0




}







(
28
)










i
=
1

4







F

i





max





{



b
i



F
0


cos






q

i





0



+


(



a
i



F
0


+

M

z





0



)


sin






q

i





0




}







(



l
2



F
0


-


a
i



M

z





0




)

·
cos







q

i





0



+


b
i



M

z





0



sin






q

i





0






·

p
i



=




i
=
1

4




F

i





max




{



b
i




F
0



(



q

i





0



cos






q

i





0



-

sin






q

i





0



-


X
i


cos






q

i





0




)



+


(



a
i



F
0


+

M

z





0



)



(



q

i





0



sin






q

i





0



+

cos






q

i





0



-


X
i


sin






q

i





0




)



}







(
29
)








Accordingly, qi that satisfies the expressions (22) and (23) and maximizes the expression (24), that is, minimizes the utilization factor γ of μ can be obtained by repeatedly calculating the following recurrence formula:











[




q
1






q
2






q
3






q
4




]

=



diag
[








D
1




D
2




D
3




D
4




]

·






[




E
11




E
12




E
13




E
14






E
21




E
22




E
23




E
24




]

+

·

[




G
1






G
2




]


+

[








X
1






X
2






X
3






X
4








]








where







D
i

=



1



F

i





max




{




(



l
2



F
0


-


a
i



M

z





0




)

·
cos







q

i





0



+


b
i



M

z





0



sin






q

i





0




}










E

1





i



=






F

i





max




cos






q

i





0








(



l
2



F
0


-


a
i



M

z





0




)

·
cos







q

i





0



+


b
i



M

z





0



sin






q

i





0












E

2





i



=






F

i





max



·

{



b
i



F
0


cos






q

i





0



+


(



a
i



F
0


+

M

z





0



)


sin






q

i





0




}







(



l
2



F
0


-


a
i



M

z





0




)

·
cos







q

i





0



+


b
i



M

z





0



sin






q

i





0












G
1


=





i
=
1

4




F

i





max




{



q

i





0



cos






q

i





0



-

sin






q

i





0



-


X
i


cos






q

i





0




}







G
2



=




i
=
1

4




F

i





max




{



b
i




F
0



(



q

i





0



cos






q

i





0



-

sin






q

i





0



-


X
i


cos






q

i





0




)



+


(



a
i



F
0


+

M

z





0



)



(



q

i





0



sin






q

i





0



+

cos






q

i





0



-


X

i







sin






q

i





0




)



}












(
30
)








In the foregoing, E+ represents a pseudo-inverse matrix. If it is assumed that E is a full row rank, E+ can be obtained as below.

E+=ET·(E·ET)−1

The expression (30) uses the nature that calculation of a pseudo-inverse matrix satisfies the restriction condition and derives a solution Pi that minimizes the Euclidean norm given as below.






K
=




i
=
1

4



P
i
2






Next, a description will be given of a specific structure of the present embodiment.



FIG. 5 shows a vehicle body motion realization apparatus for realizing the vehicle body motion realization method of the present embodiment. Front left and front right wheels of a vehicle 12 are designated as 10FL and 10FR, respectively, and rear left and rear right wheels which are driving wheels of the vehicle are designated as 10RL and 10RR, respectively. The front left and right wheels 10FL and 10FR which serve as a coupled driving wheel and a steering wheel are steered by a power steering device 16 of rack and pinion type driven in response to manipulation of a steering wheel 14 by a vehicle operator via tie rods 18L and 18R.


The braking force of each wheel is controlled by controlling a braking pressure of each of wheel cylinders 24FR, 24FL, 24RR and 24RL using a hydraulic circuit 22 of a braking device 20. Although not shown in the drawing, the hydraulic circuit 22 includes a reservoir, an oil pump, various valve devices and the like. The braking pressure of each wheel cylinder is, at a normal operation, controlled by a master cylinder 28 driven in accordance with a pressing operation of a brake pedal 26 by a driver. Further, if necessary, the braking pressure is controlled by an electric control device 30 as will be described below in detail.


These wheels 10FR to 10RL are respectively provided with vehicle speed sensors 32FR, 32FL, 32RR and 32RL which each detect a wheel speed Vwi (i=fr (front right wheel), fl (front left wheel), rr (rear right wheel), rl (rear left wheel)). A steering column to which the steering wheel 14 is connected is provided with a steering angle sensor 34 that detects a steering angle φ. Further, the vehicle 12 is provided with a yaw rate sensor 36 that detects a raw rate r of the vehicle, a longitudinal acceleration sensor 38 that detects a longitudinal acceleration Gx, a lateral acceleration sensor 40 that detects a lateral acceleration Gy, and a vehicle speed sensor 42 detects a vehicle speed V. Incidentally, the steering angle sensor 34, yaw rate sensor 36 and lateral acceleration sensor 40 detect the steering angle, raw rate and lateral acceleration, respectively, of which positive direction is defined along the left turning direction of the vehicle.


As shown in the drawing, signals which indicate wheel speed Vwi detected by the wheel speed sensors 32FR to 32RL, a signal that indicates a steering angle φ detected by the steering angle sensor 34, a signal that indicates a yaw rate r detected by the yaw rate sensor 36, a signal that indicates a longitudinal acceleration Gx detected by the longitudinal acceleration sensor 38, a signal that indicates a lateral acceleration Gy detected by the lateral acceleration sensor 40, and a signal that indicates a vehicle speed V detected by the vehicle speed sensor 42 are inputted to the electric control device 30. Although not specifically shown in the drawing, the electric control device 30 comprises, for example, CPU, ROM, RAM, and an input/output port device, and includes a microcomputer having a general structure in which the aforementioned elements are connected together by a bilateral common bus. ROM stores therein a vehicle body motion realization program for realizing the vehicle body motion realization method.


Next, the operation of the present embodiment will be described with reference to the flow chart of a vehicle body motion realization program shown in FIG. 6.


In step 102, various state amounts of a vehicle body detected by the aforementioned various sensors are captured.


In step 104, variable i for identifying each wheel is initialized. In step 106, the variable i is incremented.


In step 108, the maximum frictional force Fimax for a wheel identified as the variable i is calculated.


In step 110, it is determined whether the variable i equals the total number i0 of wheels (in the present embodiment, four) or not. If it is determined that the variable i does not equal the total number i0, there still exists some wheel for which the maximum frictional force Fimax has not yet been calculated. Therefore, the routine returns to step 106, and the aforementioned step (step 108) is executed.


Conversely, if it is determined that the variable i equals the total number i0, there exists no wheel for which the maximum frictional force Fimax has not been calculated. Then, in step 112, the function shown in the expression (30) is defined using the maximum frictional forces Fimax obtained by the aforementioned calculation, and other physical quantities. In step 114, the direction in which tire generating force acts on each wheel (qi) is calculated using the function (the expression (30)). In step 116, by means of the calculated directions in which tire generating forces act on respective wheels, and the like, the braking and driving forces and steering angle of each wheel are obtained. In step 118, each wheel is controlled based on the obtained braking and driving forces and steering angle of the wheel.


As described above, according to the present embodiment, a performance function not dependent on respective magnitudes of the vehicle body generating force and the yaw moment, and therefore, as long as the direction in which the tire generating force acts, which is calculated from the performance function, is used, a predetermined vehicle body motion can be properly realized.


Further, in the present embodiment, the direction in which the resultant force of tire generating forces is obtained using desired yaw moment and vehicle body generating force as the restriction conditions. Therefore, it is possible to realize the desired yaw moment and vehicle body generating force and obtain a predetermined vehicle body motion with a high degree of accuracy.


Moreover, in the present embodiment, the restriction conditions of the desired yaw moment and vehicle body generating force are linearized to minimize the utilization factor of longitudinal friction coefficient, thereby resulting in reduction of calculating load.


In the present embodiment, the direction in which the tire generating force acts is calculated for each of the wheels so as to realize the desired yaw moment and vehicle body generating force. This also means that, under the restriction conditions for realization of the desired yaw moment and vehicle body generating force, the grip margin level of each wheel is uniformly maximized, that is, the μ utilization factor is minimized.


In the embodiment as mentioned above, the pseudo-inverse matrix is simply calculated repeatedly, but the present invention is not limited to the same. Alternatively, a penalty function may also be used.


A penalty function having a combination of an evaluation on a deviation between a performance function J(q) to be maximized and the restriction condition is defined in the following expression given as below.










P


(
q
)


=


1

J


(
q
)



+

ρ


(





J
Fy



(
q
)




+




J
FMz



(
q
)





)







(
31
)








where JFy(q) is the left side of the expression (15), JFMz(q) is the left side of the expression (16), and ρ is a positive number. Here, the solution q of the expression (30), and the penalty function relevant to a search point q0 in the previous step are calculated. If p(q)<P(q0), the recurrence formula (30) is recalculated with q=q0. Further, if p(q)>P(q0), the expression {tilde over (q)}=(q+q0)/2 is considered as the next candidate search point, and the penalty function relevant to {tilde over (q)} is calculated.


In this case, if P({tilde over (q)})<P(q), the recurrence formula of the expression (30) is calculated again with q0={tilde over (q)}. Further, if P({tilde over (q)})>P(q), the calculation {tilde over (q)}=({tilde over (q)}+Q0)/2 is carried out repeatedly until the relation P({tilde over (q)})<P(q) is satisfied, and the step of constantly decrementing the penalty function is carried out, thereby achieving convergence of the recurrence formula.


The convergence of the recurrence formula (qi=qi0) satisfies algebraic equations (22) and (23) into which the expressions (15) and (16) are linearized around qi0, and means that qi which maximizes the expression (24) into which the expression (21) is approximated around qi0 becomes qi=qi0. Assuming qi=qi0 in the expressions (22) and (23), the following expressions are given as below.












F

1





max



sin






q
10


+


F

2

max



sin






q
20


+


F

3

max



sin






q
30


+


F

4

max



sin






q
40



=
0




(
32
)









B
1



F
0



F

1

max



sin






q
10


+


b
2



F
0



F

2

max



sin






q
20


+


b
3



F
0



F

3

max



sin






q
3


+


b
4



F
0



F

4

max



sin






q
40


-


(



a
1



F
0


+

M

z





0



)



F

1

max



cos






q
10


-


(



a
2



F
0


+

M

z





0



)



F

2

max



cos






q
20


-


(



a
3



F
0


+

M

z





0



)



F

3

max



cos






q
30


-


(



a
4



F
0


+

M

z





0



)



F

4

max



cos






q
40



=
0




(
33
)








Thus, it can be understood that qi0 satisfies the expressions (15) and (16) and becomes a local optimum solution that maximizes the evaluation function of the expression (21).


Incidentally, the μ utilization factor γ is calculated from the value qi thus derived, based on the following expression (34).









γ
=




(

lF
0

)

2

+

M

z





0

2






i
=
1

4




F

i





max




{



(



l
2



F
0


-


a
i



M

z





0




)


cos






q
i


+


b
i



M

z





0



sin






q
i



}








(
34
)








The logic of the expression (30) can be solved within a domain in which the expression (25) is established, and therefore, an initial value of the recurrence formula also needs to be set within this domain. The expression (25) can be described as below.













(



l
2



F
0


-


a
i



M

z





0




)

·
cos







q

i





0



+


b
i



M

z





0



sin






q

i





0




=






(



l
2



F
0


-


a
i



M

z





0




)

2

+


(


b
i



M

z





0



)

2



·

cos


(


q

i





0


-

α
i


)



>
0





(
35
)





where











α
i

=


tan

-
1






b
i



M

z





0






l
2



F
0


-


a
i



M

z





0










(
36
)








Therefore, it is believed that the following expression (37) is an initial value of the expression (30).










q

i





0


=


α
i

=


tan

-
1






b
i



M

z





0






l
2



F
0


-


a
i



M

z





0











(
37
)








This angle represents the direction in which the tire generating force acts on each of wheels when the desired vehicle body generating force and yaw moment are obtained by generating the tire generating force acting on each wheel in the direction in which the vehicle body generating force acts, which direction is expressed below,










F

F





0


=


F
0

4





(
38
)








and also in the direction in which the yaw moment is produced, which direction is expressed below,










F

Mz





0


=



M

z





0



4

l


.





(
39
)







Further, the μ utilization ratio γ having a value of 1 or more in the calculation based on the expression (34) represents that a target vehicle body generating force and a target yaw moment cannot be achieved under characteristics of tire generating force at the current time point. At this time, if the direction in which tire generating force acts, which is calculated by the expression (30), is realized by the magnitude of a critical friction circle, the vehicle body generating force of F0/γ and the yaw moment of Mz0/γ are obtained. This means that when the target values of vehicle body generating force and yaw moment cannot be achieved, the vehicle body generative force and the yaw moment are uniformly made smaller until respective achievable values thereof are both obtained.



FIGS. 7A to 7D are results of the directions in which generating forces act on respective wheels obtained based on the expression (30), as an example of calculation, when the direction in which the vehicle body generating force acts is expressed as π/2. In this case, the recurrence formula of the expression (30) is solved with l=1.5 m. In the case shown in FIG. 7A, that is, when the target vehicle body generating force is larger compared with the target yaw moment (F0=1000[N], Mz0=1000[Nm]) and the μ utilization ratio γ of each wheel is 0.6585, and also in the case shown in FIG. 7B, that is, when the target yaw moment is larger compared with the target vehicle body generating force (F0=1000[N], Mz0=10000[Nm]) and the μ utilization ratio γ of each wheel is 0.4218, it can be understood that proper solutions can be obtained for both of the target values. Incidentally, in cases shown in FIGS. 7A and 7B, the following relationship is obtained.

(l2F0−ajMz0)cos qi0+biMz0 sin qi0>0

Further, even in cases shown in FIGS. 7C and 7D, that is, even when the target vehicle body generating force and the target yaw moment are both set to be large values (F0=10000[N], Mz0=±10000[Nm] (in FIG. 7C, Mz0=10000[Nm], and in FIG. 7D, Mz0=−10000[Nm]), it can be understood that appropriate solutions are obtained. Moreover, a domain in which the expression (31) is established, which domains corresponds to a search domain of the optimum solution, is indicated by dots in the diagrams shown in FIG. 7. These domains vary properly in accordance with the magnitudes of vehicle body generating force and yaw moment both to be required. As a result, it can be understood that the logic for obtaining the direction in which generating force acts on each wheel does not need to be switched to another based on the magnitudes of the vehicle body generating force and the yaw moment, and the direction in which generative force acts on each wheel can be constantly calculated using the expression (30).


Effects of the Invention


As described above, the present invention has the effect that, since a performance function including respective magnitudes of a vehicle body generating force and a yaw moment is used, as long as a direction in which a tire generating force acts, calculated from the performance function, is used, a predetermined vehicle body motion can be properly realized regardless of a balance of magnitudes of desired vehicle body generating force and yaw moment.

Claims
  • 1. A vehicle body motion realization method, comprising: calculating a direction in which tire generating force acts for each wheel of a vehicle by means of a performance function including the direction in which tire generating force acts, so as to realize desired yaw moment and vehicle body generating force for obtaining a predetermined vehicle body motion, and the vehicle body motion is realized by using the calculated direction in which the tire generating force acts,wherein said performance function is a performance function corresponding to a ratio between a sum of respective squares of the desired vehicle body generating force and yaw moment, and a utilization factor of a road surface frictional coefficient that is a frictional coefficient between a road surface which is supposed to have a constant condition for each of wheels, and a tire; andat least one of regulating a steering angle of each wheel and regulating braking and driving forces of each wheel based on the calculated direction in which the tire generating force acts.
  • 2. The vehicle body motion realization method according to claim 1, wherein the direction in which the tire generating force acts is calculated for each wheel by means of the performance function in which the desired yaw moment and vehicle body generating force are defined as restriction conditions.
  • 3. The vehicle body motion realization method according to claim 2, wherein the direction in which the tire generating force acts is calculated for each wheel by carrying out linearization of the restriction conditions of the desired yaw moment and vehicle body generating force and also using said performance function.
  • 4. The vehicle body motion realization method according to claim 3, wherein said wheels are four in number with two front wheels and two rear wheels, and wherein the direction in which the tire generating force acts is calculated for each wheel by means of a pseudo-inverse matrix of two lines and four columns, which is prepared from the two restriction conditions of said linearized desired yaw moment and vehicle body generating force and the performance function.
  • 5. A vehicle body motion realization apparatus comprising: calculating means that calculates a direction in which tire generating force acts for each wheel based on detecting means for detecting state amounts of a vehicle, and a performance function including a direction in which tire generating force acts, so as to realize desired yaw moment and vehicle body generating force for obtaining a predetermined vehicle body motion; andcontrol means that controls at least one of a steering angle of each wheel and braking and driving forces of each wheel based on the direction in which the tire generating force acts, which direction is calculated by said calculating means for each wheel, a value of the performance function used in calculation of the direction in which the tire generating force acts, and a utilization factor of a road surface frictional coefficient, that is, a frictional coefficient between a road surface and a tire, which utilization factor is calculated based on the desired yaw moment and vehicle body generating force, wherein said performance function is a performance function corresponding to a ratio between a sum of respective squares of the desired vehicle body generating force and yaw moment, and a utilization factor of a road surface frictional coefficient that is a frictional coefficient between a road surface which is supposed to have a constant condition for each of wheels, and a tire.
Priority Claims (1)
Number Date Country Kind
2003-385729 Nov 2003 JP national
PCT Information
Filing Document Filing Date Country Kind 371c Date
PCT/JP2004/017221 11/12/2004 WO 00 5/2/2006
Publishing Document Publishing Date Country Kind
WO2005/047073 5/26/2005 WO A
US Referenced Citations (4)
Number Name Date Kind
6308126 Yokoyama et al. Oct 2001 B2
6360150 Fukushima et al. Mar 2002 B1
7315777 Ono Jan 2008 B2
20030149515 Hessmert et al. Aug 2003 A1
Foreign Referenced Citations (4)
Number Date Country
A 06-099796 Apr 1994 JP
A 11-348753 Dec 1999 JP
A 2003-024177 Jan 2003 JP
A 2003-175749 Jun 2003 JP
Related Publications (1)
Number Date Country
20070055432 A1 Mar 2007 US