1. Field of the Invention
The present invention relates to motion control apparatus and method for an automotive vehicle which are capable of controlling a vehicular motion during a steering maneuver input on front road wheels.
2. Description of the Related Art
A Japanese Patent Application First Publication No. Heisei 10-007010 published on Jan. 13, 1998 (which corresponds to a U.S. Pat. No. 5,957,987 issued on Sep. 28, 1999) exemplifies a previously proposed vehicular motion control apparatus. In the above-identified Japanese Patent Application First Publication, a vehicular yaw rate and so on are controlled during a steering operation (maneuver) so that a vehicular stability during a steering wheel operation is maintained. Specifically, a target yaw rate for a response characteristic related to a plane motion of the vehicle on the basis of the steering angle and the vehicle speed to coincide with a predetermined response characteristic is calculated, a rear road wheel steering angular command value required to make the yaw rate developed on the vehicle coincident with its target value is calculated in accordance with a motion equation based on a vehicular specification value. Rear road wheel actual steering angles are controlled to follow a rear road wheel steering angle command value. Thus, this control results in a yaw motion in accordance with a target yaw rate.
The target yaw rate is calculated by setting a response characteristic of the target yaw rate with respect to a change in the steering angle as a first order or second order transfer function and presetting a vehicle speed dependent constant in accordance with a vehicle speed. Thus, a steering response characteristic of the yaw rate during a low speed run is maintained and a vehicular motion which is superior in a steering response characteristic and stability without giving a sense of incompatibility to a vehicle driver during a high speed run can be achieved.
However, in the above-described vehicular motion control apparatus, the vehicle speed dependent constants are stored as skip values (discrete values and not continuous values) as a map stored previously for each vehicle speed. In a case where the vehicle speed during the calculation of the target yaw rate is not coincident with a point on a map axle, a straight line (linear) interpolation is carried out on the basis of points mutually adjacent points on the map to calculate the corresponding vehicle speed dependent constant. Hence, an error due to the execution of the straight line (linear) interpolation gives an ill influence on the target yaw rate. Consequently, there is a high possibility of giving an ill influence on the rear road wheel steering angle. Hence, in a case where the vehicle speed is varied during the steering operation such as a turning braking, the rear road wheel steering angles provide motions other than a desired motion so that there is a possibility that the driver gives an unpleasant feeling (the sense of incompatibility).
It is, therefore, an object of the present invention to provide vehicular motion control apparatus and method which are capable of controlling stably a motion of the vehicle without giving the sense of incompatibility to the driver, even if the vehicle velocity (vehicle speed) is varied during the vehicular motion control in the vehicular motion control apparatus.
The above-described object can be achieved by providing a vehicular motion control apparatus, comprising: a steering angle detecting section that detects a vehicular steering angle; a vehicle speed detecting section that detects a vehicle speed; a vehicular motion control mechanism that is capable of controlling a vehicular motion; a state detecting section that detects a state of the vehicular motion control mechanism; a vehicular motion target value calculating section that calculates a target value of the vehicular motion for a response characteristic on a vehicular plane motion to be enabled to provide a predetermined response characteristic on the basis of detection values of the steering angle and the vehicle speed and vehicle speed dependent constants preset in a form of a map for each vehicle speed; a control command value calculating section that calculates a vehicular motion control mechanism command value required to achieve the target value of the vehicular motion; and a servo calculating section that provides a control signal for a rear road wheel steering actuator in such a manner that a detection value of the state of the vehicular motion control mechanism is made coincident with the motion control mechanism command value; and a vehicle speed variation rate limiter that places a limitation on a vehicle speed variation rate and varies in accordance with the detection value of the vehicular steering angle, the vehicular motion target value calculating section using an output of the vehicle speed variation rate limiter for a map reference vehicle speed and the control command value calculating section using the output of the vehicle speed variation rate limiter to the detection value of the vehicle speed for a control command value calculation.
The above-described object can also be achieved by providing a vehicular motion control method, comprising: detecting a vehicular steering angle; detecting a vehicle speed; providing a vehicular motion control mechanism which is capable of controlling a vehicular motion; detecting a state of the vehicular motion control mechanism; calculating a target value of the vehicular motion for a response characteristic on a vehicular plane motion to be enabled to provide a predetermined response characteristic on the basis of detection values of the steering angle and the vehicle speed and vehicle speed dependent constants preset in a form of a map for each vehicle speed; calculating a vehicular motion control mechanism command value required to achieve the target value of the vehicular motion; and providing a control signal for a rear road wheel steering actuator in such a manner that a detection value of the state of the vehicular motion control mechanism is made coincident with the motion control mechanism command value; and providing a vehicle speed variation rate limiter to place a vehicle speed variation rate limitation on the detection value of the vehicle speed and varying the vehicle speed variation rate limitation in accordance with the detection value of the vehicular steering angle, at the vehicular motion target value calculation, using an output of the vehicle speed variation rate limiter for a map reference vehicle speed and, at the control command value calculation, using the output of the vehicle speed variation rate limiter to the detection value of the vehicle speed for a control command value calculation.
This summary of the invention does not necessarily describe all necessary features so that the invention may also be a sub-combination of these described features.
Reference will hereinafter be made to the drawings in order to facilitate a better understanding of the present invention. Hereinafter, preferred embodiments of a vehicular motion control apparatus according to the present invention will be described. However, the present invention is not limited to these embodiments.
A steering angle variable mechanism 3 includes: knuckle arms 5L and 5R attached onto left and right rear road wheels 2L and 2R; king pin axles 6L and 6R; ball joints 7L and 7R; a tie rod 8 connected to knuckle arms 5L and 5R and formed about ball joints 7L and 7R; a slip screw 9 formed on tie rod 8; and a nut 10 having outer teeth on an outer peripheral surface thereof, the slip screw 9 being formed on tie rod via king pin axles 6L, 6R and ball joints 7L and 7R between knuckle arms 5L and 5R; and outer teeth 12 attached on a revolving axle of a driving motor 11 constituted by a stepping motor and which is meshed with the outer teeth of nut 10. A revolution drive of driving motor 11 moves tie rod 8 in the leftward-and-rearward direction to steer rear left-and-right wheels 2L and 2R. It is noted that a reference numeral 13 denotes a return spring for tie rod 8 to be returned to a neutral position. It is also noted that, in
Vehicle speed motion target value setting section 41 calculates a target yaw rate (yaw velocity) Ψ′* as a vehicular motion target value with respect to a front road wheel angle detection value on the basis of a transfer function between front road wheel steering angle detection value θ and target yaw rate Ψ′* shown in the following equation (1).
φ′*/θ=GΨ′·{ωn2(n1S+1)}/(S2+2ζωnS+ωn2) (1),
wherein S denotes s Laplace transform operator, GΨ′, ωn, n1, and ζ denote vehicle speed dependent constants, namely, GΨ′ denotes a yaw rate gain, ωn denotes a natural (or specific) angular frequency, n1 denotes a zero point corresponding (equivalent) value, and ζ denotes a damping coefficient. These vehicle speed dependent constants are set on the basis of a control map representing a correspondent relationship between a preset vehicle speed and each of the vehicle speed dependent constants.
Hence, by setting vehicle speed dependent constants in accordance with the vehicle speed, the response characteristic on target yaw rate Ψ′*′ provides response characteristic different in dependence on the vehicle speed. In addition, by individually and independently modifying yaw rate gain GΨ′, specific angular frequency ωn, zero-point equivalent value n1, and damping coefficient ζ, the response characteristic which is different only in steady state gain or vibration frequency only can be obtained.
B0=ωn2, B1=2ζωn, F0=n1ωn2, and F1=ωn2−B1·F1.
In rear road wheel steering command value calculating section 42, a reverse calculation of two degrees of freedom vehicular motion equations causes the rear road wheel steering angle δ which can make target yaw rate Ψ′* coincident with actual yaw rate Ψ′ to be calculated so that this provides target rear road wheel steering angle δ*.
δ*=βR+(Vy−LR·Ψ′*)/V (2).
βR=CR/KR
CR=(2LF·CF−Iz·Ψ″*/2)/LR
CF=eKF·βF
βF=θ/N−(Vy+LF·Ψ′*)/V
Vy=∫Vy′dt
V′y=(2CF+2CR)/M−V·Ψ′*, wherein Vy denotes a vehicular lateral velocity, V′y=dVy (described later), βF denotes a front road wheel side slip angle, βR denotes a rear road wheel side slip angle, CF denotes a cornering force of front road wheels, CR denotes a cornering force of rear road wheels, KR denotes a cornering power of a vehicular rear road wheel, eKF denotes an equivalent cornering power of a vehicular front road wheel (although the front road wheel cornering power, a value with a reduction of the cornering power with respect to the steering angle due to an influence of steering rigidity), Iz denotes a yaw inertia moment of the vehicle, M denotes a vehicular weight, and N denotes a steering gear ratio.
Rear road wheel steering angle servo amplifying section 43 carries out a servo calculation using a Robust Model Matching Control on the basis of a deviation between a rear road wheel steering angle command value δ* and a rear road wheel steering angle detection signal δ of rear road wheel steering angle sensor (rear road wheel steering angle detecting section) 17 and the control signal is outputted to rear road wheel steering actuator 11 constituted by the drive motor. The robust model matching technique is exemplified by a U.S. Pat. No. 6,175,799 issued on Jan. 16, 2001. Rear road wheel steering angle servo amplifying section 43, for example, includes a robust compensator which serves as an external disturbance estimator and a model matching compensator which makes whole response characteristic of the rear road wheel steering angle servo calculating section 43 equal to a response characteristic of a normal (standard) model, in order for rear road wheel steering angle servo calculating section 43 to provide a robust control system to such a variation in the rear road wheel steering angle value (δ), (the disclosure of the U.S. Patent described above is herein incorporated by reference).
Next, an operation of the vehicular motion control apparatus in the first embodiment according to the present invention will be described below.
At a step 101, controller 4 reads steering angle detection value θ from front road wheel steering angle sensor (a vehicular steering angle detecting section) 14, vehicle speed detection value V from vehicle speed sensor (vehicle speed detecting section) 16, and a rear road wheel steering angle detection signal δ from rear road wheel steering angle sensor 17.
At a step 102, controller 4 refers to control maps each representing a correspondent relationship between a preset vehicle speed and corresponding one of the vehicle speed dependent constants and sets yaw rate gain GΨ′, damping coefficient ζ, specific angular frequency ωn, and a zero-point equivalent (corresponding) value n1. As appreciated from
A map reference vehicle speed Vmap in which a limitation is placed on a variation rate of vehicle speed V without use of the detection value directly from vehicle speed sensor 2 to refer to each of the control maps. The detailed description thereof will be described later.
Then, at a step 103, controller 4 calculates target yaw rate Ψ′* on the basis of set vehicle speed dependent constants, equation (1), and steering angle detection value θ from the front road wheel steering angle sensor 14.
At a step 104, controller 4 calculates rear road wheel steering angle command value δ* which enables the coincidence of calculated target yaw rate φ′* with actual yaw rate φ′. However, map reference vehicle speed Vmap is also used for the calculation of equation (2) described above. The details of map reference vehicle speed Vmap will be described later. In addition, if the vehicle speed is lower than a predetermined vehicle speed B whish represents a low vehicle speed, the rear road wheel steering angle command value correction processing to correct rear road wheel steering angle command value δ* calculated at a previous control period is executed. The details of the processing will be described later.
At a step 105, controller 4 carries out a servo calculation using, for example, the robust model matching control on the basis of the deviation between rear road wheel steering angle command value δ* and rear road wheel steering angle detection value δ and calculates the control signal to be outputted to rear road wheel steering actuator 3.
(Vehicle Speed Limiter Processing During Vehicle Speed Dependent Calculation)
Next, the detailed explanation of step 102 shown in
Then, if the vehicle speed at a time of referring to each of the control maps, each map representing the correspondence between the detection value of the vehicle speed and the corresponding one of the vehicle speed dependent constants, is moderately varied, an influence caused by the above-described interpolation error is suppressed. Specifically, as shown by a vehicle speed variation rate limit map of a steering angle absolute value-to-vehicle speed variation rate in
At a step 202, controller 4 compares the present value of vehicle speed V(n) presently detected and (a previous value of) map reference vehicle speed Vmap(n−1) previously calculated (before the control period of 10 milliseconds). If present vehicle speed detection value V(n) is larger than the previous value of the map reference vehicle speed (Vmap(n−1)) (namely, V>Vmap) at step 202 the routine goes to a step 203. At step 203, controller 4 compares a first difference of the present value of vehicle speed detection value V(n) from the previous value of map reference vehicle speed Vmap(n−1) (V(n)−Vmap(n−1), namely, V−Vmap) with vehicle speed variation rate limit value dVlimit. If V(n)−Vmap(n−1)>dVlimit (Yes) at step 203, the routine goes to a step 204. If V<Vmap (namely, V(n)<Vmap(n−1) at step 202, the routine goes to a step 205. If the present detection value of vehicle speed V(n) is made equal to the previous value of map reference vehicle speed Vmap (namely, Vmap(n−1)) at step 202 (V=Vmap), the routine goes to a step 207.
In details, after, at step 203, controller 4 compares the first difference of the present value of vehicle speed (n) from map reference vehicle speed Vmap(n−1) with vehicle speed variation rate limit value dVlimit and, if V(n)−Vmap(n−1)>dVlimit (Yes) at step 203, the routine goes to a step 204.
At step 204, controller 4 sets an addition value of Vmap(n−1) to vehicle speed variation rate limit value of dvlimit as the present value of Vmap(n). On the other hand, If V(n)<Vmap(n−1) at step 202 (namely, V<Vmap) at step 202, the routine goes to a step 205.
If a second difference of the present value of vehicle speed V(n) from the previous value of the map reference vehicle speed Vmap(n−1) is larger than limit value dVlimit, namely, if Vmap(n−1)−V(n)≦dvlimit (No at step 205), the routine goes to step 207. At step 206, controller 4 sets a value>dVlimit (V−Vmap>dVlimit) at step 205 (Yes), the routine goes to a step 206. If Vmap(n−1)−V(n)≦dvlimit (No at step 205), the routine goes to step 207. At step 206, controller 4 sets a value of subtraction of dVlimit from Vmap(n−1) as the present Vmap(n) (Vmap(n)=Vmap(n−1)−dVlimit). That is to say, if the variation in vehicle speed V becomes larger in a decrease direction, variation rate of map reference vehicle speed Vmap is limited by dVlimit. At step 207, the present detection value of the vehicle speed V(n) is set to Vmap(n) (Vmap=V). If the variation in vehicle speed is equal to or lower than the vehicle speed variation rate limit value of dVlimit at step 205(No), the routine goes to step 207. If V−Vmap≦dVlimit (namely, V(n)−Vmap(n−1)≦dVlimit) (No) at step 203, the routine goes to step 207. Then, at a step 208, controller 4 reads each vehicle speed dependent constant (yaw rate gain GΨ′, damping coefficient ζ, specific angular frequency ωn, and zero-point equivalent value n1) from each corresponding control map according to the set map reference vehicle speed Vmap(n) and the present process shown in
That is to say, when the control map representing the correspondence between the vehicle speed and vehicle speed dependent constant is referred to, a variation in vehicle speed becomes moderate and an ill influence of the linear interpolation between the values of the respective points present on respective maps on the vehicular motion can be suppressed. In addition, vehicle velocity variation rate limit value dVlimit is varied in accordance with absolute value |θ| of the steering angle so that a situation such that actual vehicle speed V and map reference vehicle speed Vmap are, at any time, made different can be avoided. That is to say, if the steering angle is returned to an approximately neutral state so that the vehicle runs on a straight line road to give V=Vmap. Hence, during the subsequent steering operation, the control is carried out starting from a state in which each vehicle speed dependent constant tuned previously at the present vehicle speed is used.
(Rear Road Wheel Steering Angle Command Value Correction Processing)
Next, rear road wheel steering angle command value calculation and correction processing to be executed at step 104 shown in
That is to say, under a low vehicle speed region in which a control effect due to the 4WS steering is low, a tuning approaching to the characteristic of the two-wheel steering vehicle is carried out. Hence, rear road wheel steering angle command value δ* is calculated to provide approximately zero. However, as described above, such a case of error that rear road wheel steering angle command value δ* that naturally should have been zeroed has a certain value due to the error caused by the linear interpolation will occur. To avoid this, in the low vehicle speed region at which the tuning to approach to naturally the two-wheel steering (2WS) characteristic, rear road wheel steering angle command value δ* is forced to approach to zero so that the ill influence of the error due to the linear interpolation is suppressed.
A rear road wheel steering command value correction processing will be described with reference to an operational flowchart shown in
At a step 401, controller 4 determines whether vehicle speed detection value V of the vehicle speed falls below a predetermined vehicle speed B. If V<B at step 401 (Yes), the routine goes to a step 402. If V≧B at step 402 (No), the routine goes to a step 407. At a step 402, controller 4 determines whether |δ*(n−1)|>α, wherein an absolute value of previously calculated rear road wheel steering command value |δ*(n−1)| and α denotes a rear road wheel steering command value convergence quantity. Rear road wheel steering command value convergence quantity α is a value such that a speed for the absolute value of rear road wheel steering angle command value to approach to zero is set and is incremented or decremented to rear road wheel steering angle command value δ* for each control period. When absolute value of rear road wheel steering angle command value δ* becomes large, the routine goes from step 402 to a step 403. If |δ*(n−1)|≦α (No) at step 402, the routine goes to a step 404. At step 403, controller 4 determines if a sign of previously calculated rear road wheel steering angle command value δ* (n−1) is positive except 0 (>0). If δ* (n−1) is positive at step 403, the routine goes to a step 405. If not positive (No) at step 403, the routine goes to a step 406. At step 404, controller 4 sets the present rear road wheel steering angle command value δ*(n) to zero and the present routine shown in
At step 405, controller 4 sets a subtraction value of rear road wheel steering angle command value convergence quantity α from previously calculated rear road wheel steering angle command value δ*(n−1) to present rear road wheel steering angle command value δ*(n) (δ*(n)=δ*(n−1)−α).
At step 406, controller 4 sets an addition value of rear road wheel steering angle command value convergence quantity α to previously calculated rear road wheel steering angle command value δ*(n−1) as the present rear road wheel steering angle command value δ*(n) (δ*(n)=δ*(n−1)+α). Then, the present routine of
At step 407, controller 4 calculates ordinarily a rear road wheel steering angle command value δ* (refer to equation (2) described above) as the present rear road wheel steering angle command value δ*(n). Then, the present routine in
As described above, it is possible to set accurately rear road wheel steering angle command value δ* to zero under a low vehicle speed region (lower than predetermined vehicle speed B). It becomes possible to eliminate the influence of the error caused by the linear interpolation when each vehicle speed dependent constant is set. A desired characteristic can, thus, be obtained. In addition, since rear road wheel steering angle command value convergence quantity α is set and a moderate convergence of rear road wheel steering angle command value δ* into zero can prevent such a phenomenon that the rear road wheel steering angle becomes abruptly zeroed and that the sense of incompatibility is given to the vehicle driver.
(Simulation)
When the vehicle was decelerated from a point A of vehicle speed, a steering operation of 45° was carried out at a time point of t1 and a deceleration of about 0.28 G was carried out at a time point of t2. In addition, yaw rate gain GΨ′ as one of vehicle speed dependent constants indicated the characteristics shown in
On the other hand, in the case of the present invention, namely, in the case where the limitation on the vehicle speed variation rate was placed, the variation of each control signal was suppressed. Consequently, as shown in
As described above, the vehicular motion control apparatus according to the present invention is not limited to the first embodiment described above. For example, the present invention is applicable to a vehicle in which a front road wheel steering angle providing section is mounted to provide the front road wheels with an auxiliary steering angle. Furthermore, the present invention is applicable to a vehicle in which a braking control section which is capable of controlling the vehicular yaw rate using a brake pressure difference between the left and right brake wheels. If the vehicle speed variation rate limiter is applied to each of the vehicles described above, a control target value (for example, target yaw rate, target lateral speed, or so on) is not varied quickly or abruptly. A further stable vehicular motion control can be achieved.
It is noted that front road wheel steering angle sensor 14 corresponds to a steering angle detecting section, rear road wheel steering angle sensor 17 corresponds to a state detecting section in a broad sense of term, drive motor 11 corresponds to a rear road wheel steering actuator in a broad sense of term, steering angle variable mechanism 3 corresponds to a vehicular motion control mechanism, a rear road wheel steering angle providing section, and vehicular motion controlling means, in a broad sense of term, vehicular target value setting section 41 corresponds to a vehicular motion target value calculating section (means), in a broad sense of term, rear road wheel steering angle command value calculating section 42 corresponds to a control command value calculating section (means), in a broad sense of term, and rear road wheel steering angle servo calculating section 43 corresponds to a servo calculating section(means), in a broad sense of term. It is also noted that target rear road wheel steering angle δ* recited in equation (2) has the same meaning as rear road wheel steering angle command value δ* recited in rear road wheel steering command value calculating section 42 and rear road wheel steering angle servo calculating section 43.
The entire contents of a Japanese Patent Application No. 2003-031556 (filed in Japan on Feb. 7, 2003) are herein incorporated by reference. The scope of the invention is defined with reference to the following claims.
Number | Date | Country | Kind |
---|---|---|---|
2003-031556 | Feb 2003 | JP | national |
Number | Name | Date | Kind |
---|---|---|---|
4836319 | Haseda et al. | Jun 1989 | A |
5343393 | Hirano et al. | Aug 1994 | A |
5521820 | Wakamatsu et al. | May 1996 | A |
5957987 | Sudo et al. | Sep 1999 | A |
6175799 | Tsutsumi et al. | Jan 2001 | B1 |
6615124 | Adachi | Sep 2003 | B1 |
20040088093 | Yao et al. | May 2004 | A1 |
Number | Date | Country |
---|---|---|
10-7010 | Jan 1998 | JP |
Number | Date | Country | |
---|---|---|---|
20040158375 A1 | Aug 2004 | US |