The invention relates to a method and a device for determining a vehicle state, and in particular to a method and a device for determining vehicle states about which knowledge is necessary in order to stabilize a vehicle when a tilting angle is reached.
In modern motor vehicles, the influence of electrical and electronic driving safety systems, for example ESP (Electronic Stability Program) which is intended to prevent a vehicle skidding within fixed physical limits, is always increasing. The aforesaid ESP system controls the yaw rate of the vehicle. Since, for reasons of cost, the intention is to detect critical driving states and movement states of the vehicle with as few sensor means as possible, efforts are made to be able to determine movement variables or movement states using a small number of measured parameters.
DE 41 23 053 discloses a method for determining at least one movement variable of a vehicle. In this context, a transverse velocity and/or a yaw rate of the vehicle, or a movement variable which is dependent thereon, are described with the measurement variables of a transverse acceleration and of a steering angle at both vehicle axles. In order to evaluate the sensed measurement variables, a combination of two adaptive, equivalent Kalman filter pairs is provided, a sum of measurement variables being supplied to one filter pair, and a difference between measurement variables being supplied to the other filter pair.
DE 195 15 055 describes a driving stability control circuit with speed-dependent changeover of the vehicle model, in which circuit a setpoint value of a yaw rate is calculated using a vehicle model. In order to be able to calculate a value which is precise as possible both at very high velocities and at very low velocities using the vehicle model circuit, at least two vehicle models to which suitable velocity ranges are assigned are provided within the vehicle model circuit, switching over occurring between the two models as a function of the velocity range which is currently being used. A hysteresis of the two velocity threshold values at which switching over occurs as well as means for avoiding jumps in the output signal of the vehicle model circuit when the corresponding switching over between the models occurs are described in said document.
However, the two aforesaid known methods and devices are not suitable for determining the transition from a first vehicle state to another vehicle state or movement state of the vehicle, in particular from a rolling movement into a tilting movement, in order to be able to implement corresponding countermeasures, for example by means of a braking intervention for stabilization purposes, in particular in a way which is inherent to this system.
The object on which the present invention is based comprises making available a method and a device for determining a vehicle state, in particular a vehicle movement state, with which a tilting movement of a vehicle can be identified in a way which is reliable and as unambiguous as possible.
This object is achieved according to the invention by means of a method having the features of patent claim 1 and by means of a device for determining a vehicle state having the features of patent claim 12.
Accordingly, the following are provided:
The idea on which the present invention is based consists essentially in estimating movement states of a vehicle, in particular a rolling angle or tilting angle, over an entire rolling movement or tilting movement, in each case different vehicle models, in particular different Kalman filters, being used for the rolling movement and for the tilting movement. The states which are estimated by the vehicle models are weighted as a function of the rolling or tilting behavior present and superimposed so that the transition from the estimates of the vehicle model which is provided for the rolling movement to the estimates of the vehicle model which is provided for the tilting movement takes place in a fluid fashion. Above all, the intention is to ensure that no jump in the estimated variables occurs. In other words: the rolling angle or the tilting angle is intended to be determined continuously over the movement spectrum of the vehicle under consideration, i.e. starting from a rolling movement and going on into the tilting movement.
The formulation “predetermined parameters” used above is to be understood as follows: these variables are those variables as a function of which the states of the vehicle are determined. These variables constitute, as it were the input variables for the vehicle models or Kalman filters. These variables may be measurement variables or variables derived from measurement variables by simple conversion calculations.
Both the vehicle model provided for the rolling movement and the vehicle model provided for the tilting movement use the same variables in each case for determining the states of the vehicle.
Advantageous refinements and developments of the invention can be found in the subclaims and the description with reference to the drawing.
According to one preferred development, the first vehicle model simulates movement states of the vehicle by means of a first Kalman filter, and the second vehicle model simulates movement states of the vehicle by means of a second Kalman filter.
According to a further preferred development, the first state of the vehicle stands for a rolling movement of the vehicle, and the second state of the vehicle stands for a tilting movement of the vehicle, a rolling movement describing a rotational movement about a vehicle longitudinal axis with ground contact with all the wheels, and a tilting movement corresponding to a rotational movement which follows the rolling movement with loss of the ground contact of the wheels of one track. In this context, the rolling movement and/or the tilting movement can occur about the longitudinal axis of the vehicle and/or about an axis which is oriented in the longitudinal direction of the vehicle.
According to a further preferred development, when weighted switching over from the first vehicle model to the second vehicle model occurs, the second vehicle model is initialized with parameters of the state of the first vehicle model. According to a further preferred development, the weighting for the weighted switching over is carried out as a function of an estimated angle, preferably of a rolling angle or tilting angle of the vehicle. It is particularly advantageous if the weighting during the switching over occurs with a rise in the weighting of the second vehicle model which is linear for increasing values of the estimated angle (φ), with a simultaneous linear drop in the weighting of the first vehicle model.
According to a further preferred development, the switching over is carried out when the angle lies between a first predetermined angle value and a second predetermined angle value, the first predetermined angle value preferably describing a vehicle angle at which a first, nonloaded wheel of a track lifts off, and the second predetermined angle value describes the vehicle angle at which a second, nonloaded wheel of the same track loses ground contact.
According to a further preferred development, when the first state is estimated as an interference variable, a longitudinal inclination of the carriageway, a transverse inclination of the carriageway, a transverse inclination rate of the carriageway and/or a coefficient of friction of the carriageway are simulated and also taken into account, the longitudinal inclination of the carriageway being preferably taken into account in conjunction with a sensed longitudinal acceleration of the vehicle.
According to a further preferred development, the longitudinal inclination of the vehicle and the transverse inclination rate of the carriageway are simulated by means of a Markov process. The coefficient of friction of the carriageway is advantageously modeled as a quasi-constant variable.
According to a further preferred development, when tilting of the vehicle is detected as a movement state, individual wheel brakes of the vehicle are selectively activated in order to stabilize the vehicle.
According to a further preferred development, the vehicle mass, the position of the center of gravity of the vehicle, the wheelbase, the track width and/or the rolling characteristic, in particular the rolling rigidity, and/or the damping of the vehicle are taken into account in the modeling of the vehicle.
According to a further preferred development, by means of brake pressures which are made available per wheel by means of the vehicle as well as by means of wheel circumferential speeds which are made available, circumferential forces of individual wheels are estimated, preferably by means of a deterministic Luenberger observer system, from which a vehicle longitudinal acceleration is estimated.
According to a further preferred development, a yaw acceleration measuring device, a transverse acceleration measuring device and preferably a longitudinal acceleration measuring device and/or a rolling rate measuring device are provided for making available the predetermined parameters.
The invention will be explained in more detail below with reference to the exemplary embodiment specified in the schematic figures of the drawing, in which:
In the figures in the drawing, identical or functionally identical elements and features—unless stated otherwise—have been provided with the same reference numbers.
In the second vehicle model, a tilting observer is used to estimate the vehicle state in the second estimation device 11. After this, a weighting process 12 of the state estimated by the rolling observer takes place, and a weighting process 13, separate therefrom, of the state estimated by the tilting observer. The two correspondingly weighted movement state estimations are then added in an adding device Σ, and in this way a combined state estimation 13 is available which corresponds to that of a combined observer. The weighting 12 of the rolling observer and the weighting 13 of the tilting observer 13 during the estimation of state are shown by way of example in
In order to stabilize a tilting movement of vehicles F with a high center of gravity it is possible, by means of selective braking interventions at individual wheels R of such a vehicle F, such as for example a truck or a transporter, to prevent a rollover of these vehicles within predetermined physical limits. In order to be able to effectively operate such a controller concept it is necessary for this system to make available various vehicle states for analysis. However, such states can be sensed or measured directly by existing sensors only to a certain extent. For this reason it is appropriate to estimate the states of the vehicle which are required beyond this by means of an observer method. A basic equation for various observer methods is:
{dot over ({circumflex over (x)})}={circumflex over (f)}({circumflex over (x)}, u)+({circumflex over (x)}, u)·(y−ŷ)ŷ=ĥ({circumflex over (x)}, u) (1)
The difference between different observer methods is the calculation of the feedback matrix K(x, u), in which case, according to the present preferred embodiment, a Kalman filter is used which takes into account the stochastic properties of the system for the calculation of the feedback matrix K(x, u). The various Kalman filters differ here in the model equations {circumflex over (f)}({circumflex over (x)}, u) and ĥ({circumflex over (x)}, u) so that in each case different feedback values are obtained. In order to stabilize a vehicle when a tilting angle φ occurs, generally knowledge of the following vehicle states is assumed: velocity in the longitudinal direction vx of the vehicle, velocity in the transverse direction vy of the vehicle, the rolling angle or tilting angle φ, and the rolling rate or tilting rate {dot over (φ)}. Rolling movement is understood here to be a rotational movement about the longitudinal axis of a vehicle, that is to say the x axis, which arises as a result of spring compression of a vehicle F on one track side. During a rolling movement, all the wheels R have ground contact. If a track of the vehicle is lifted off from the ground, i.e. before the wheels of one side of the vehicle are lifted off form the ground, the rotational movement about the longitudinal axis of the vehicle is referred to below as a tilting movement or tilting. At this point it is to be noted that the rolling movement and/or the tilting movement can take place not only about the longitudinal axis of the vehicle or x axis, but also about an axis which is oriented in the longitudinal direction of the vehicle.
According to one preferred embodiment, in order to be able to observe the abovementioned, necessary vehicle states over the entire rolling movement and tilting movement of a vehicle two different Kalman filters are used for modeling the vehicle. In this context, the first Kalman filter assumes the role of estimating the driving state during the rolling movement, while the second Kalman filter estimates the states during the tilting movement for the modeling of the vehicle. Furthermore, basically, it is also possible to estimate the required vehicle states with an individual Kalman filter while a suitable model is used. The basis for the filter device which is used for estimating the rolling movement is formed by the following movement equations of the horizontal velocities:
{dot over (v)}y=−{dot over (Ψ)}vx+ay{dot over (v)}x={dot over (Ψ)}vy+ax (2)
A change {dot over (v)}y in velocity in the y direction thus corresponds to the negative product of a yaw rate {dot over (Ψ)} and a longitudinal velocity vy of the vehicle in addition to an acceleration ay in the y direction. Furthermore, a change {dot over (v)}x in velocity in the x direction equals the product of the yaw rate {dot over (Ψ)} and of the velocity vy of the vehicle in the transverse direction plus an acceleration ax in the longitudinal direction. If the horizontal accelerations ay, ax which are measured by means of sensors are used within these two equations as input signals, the following linearized system equations for the rolling filter are obtained after transformation from a coordinate system or reference system which is fixed to the vehicle into one which is fixed to the carriageway:
{dot over (v)}x={dot over (Ψ)}vy+g(θ+Θ)+axsensor{dot over (v)}v=−{dot over (Ψ)}vx−g(φ+Φ)+aysensor (3)
Compared to the equation system (2), the product of the acceleration g of the earth and the sum of a vehicle pitching angle θ and a carriageway inclination Θ are added for the term in the longitudinal direction of the vehicle. In the movement equation in the y direction, a subtractive additional term is obtained as a product of the acceleration g of the earth and the sum of the rolling angle φ measured over the carriageway plus the transverse inclination Φ of the carriageway. A differential equation of the rolling dynamics serves as a further basic equation and applies for small rolling angles and results from the law of conservation of angular momentum about the longitudinal axis of the vehicle:
{umlaut over (φ)} for the rolling angle acceleration, Δhs for a shift in the center of gravity, Fsv for the front side force of the wheels, Fsh for the side force of the wheels R of the rear axle Ah, m for the mass of the vehicle, az for the acceleration in the Z direction, which corresponds to the vertical axis in the vehicle F, Mw corresponding to a rolling movement and JXX corresponding to a moment of inertia about the longitudinal axis of the vehicle. If the rolling moment Mw is included in this equation as:
Mw=−cφ·φ−dφ·{dot over (φ)} (5)
where cφand d100 represent predetermined variables which are constant or possibly also dependent on the rolling angle or tilting angle, the side forces of the wheels FSV, Fsh as a result of the transverse acceleration are expressed correspondingly:
Fsv+Fsh=m(ay+gΦ) (6)
The linearized system equation for the rolling dynamics within the vehicle model, preferably within the Kalman filter, is thus obtained as:
where the term w{dot over (φ)} (t) stands for an interference variable term which is dependent on the time, corresponding to stochastic noise. Furthermore, the longitudinal inclination Θ of the carriageway, the transverse inclination Φ of the carriageway, the transverse inclination rate {dot over (Φ)} of the carriageway and the coefficient of friction μ of the carriageway are modeled as interference variables. The longitudinal inclination Θ of the carriageway and the transverse inclination rate {dot over (Φ)} of the carriageway are preferably simulated here by means of a Markov process corresponding to colored noise which can be attributed to white noise since these two variables are stochastic, correlated variables. The coefficient of friction μ of the carriageway is modeled in particular as a quasi-constant variable.
The directions or angles of the different variables are illustrated schematically using
The measuring equations of the vehicle model or Kalman filter responsible for the rolling movement are obtained by applying the law of momentum and the law of conservation of angular momentum and are as follows:
aysensor=(Fsv+Fsh)/m+gφ+va
va
If the vehicle F changes from the rolling movement into the tilting movement according to
Here, the two angles φ1, φ2 define the region in which the weighted switchover process is completed (see
Within this range between φ1 and φ2 there is no uniquely defined assignment, whereas outside this range there is a uniquely defined assignment to one of the two vehicle models, preferably the Kalman filter. This uniform gradual transition of the states from one vehicle model or filter to the other allows a continuous transition of the state estimation without jumps.
The basis for this system equation of the vehicle model which is responsible for the tilting movement, preferably the Kalman filter, is also formed by the law of momentum and the law of conservation of angular momentum. It is notable here that, in contrast to the vehicle model or filter which is responsible for the rolling movement, the system equation differs over the left hand side and right hand side of the vehicle F for the tilting movement. Also, within the system equation of the second vehicle model or filter which is responsible for the tilting movement, nonlinear tire forces are replaced to a great extent by values of acceleration sensors. Written in a generalized form, the system equations of this second Kalman filter are as follows:
the terms Wvy, Wvx and W{dot over (φ)} representing a noise component of the corresponding states and ξ, , λ representing actual variables. The system equations of the individual interference variables Wvy, Wvx, W{dot over (φ)} correspond to those of the vehicle model or Kalman filter which are responsible for the rolling movement. The transverse inclination Φ of the carriageway and transverse inclination rate Φ of the carriageway can however not be estimated with this filter since when a vehicle F tilts there is no difference between the effects of the transverse inclination of the carriageway and the tilting angle. These two interference variables therefore cannot be observed. The nonlinearities which originate from the characteristic curves of the tires are also input into the measuring equation within this filter. The generalized measuring equations of the second filter which is responsible for the tilting movement are obtained as follows from the law of momentum and the law of the conservation of angular momentum:
θ0 representing a static pitch angle component and the term
representing a portion of the acceleration of the earth while MRZ,i represents a restoring moment. All the variables are converted here to a horizontal coordinate system, from which the sin φ, cos φ components follow. Instead of using the yaw acceleration {umlaut over (Ψ)}sensor as measuring variable it is possible to define the yaw rate {dot over (Ψ)} either as a state variable or as a measurement variable. As a result, even though the filter equations of the rolling observer, that is to say of the first vehicle model or Kalman filter, are not linear, it is nevertheless possible to take into account the sensor property, in particular the measuring noise, in the filter more precisely.
By using the braking pressures per wheel made available by an ESP system (electronic stability program) which is preferably present, and by using the knowledge of the rotational speeds of the individual wheels R it is possible to estimate the circumferential forces FUh,v of the individual wheels R of the vehicle F. This is preferably done by means of a deterministic Luenberger observer. Its estimated circumferential forces FU can be used, according to the principle, within the two vehicle models or Kalman filters to replace the longitudinal acceleration sensor for measuring the acceleration in the x direction, that is to say axsensor. Furthermore, by using the estimated circumferential forces Fu it is possible to introduce four additional measuring equations within the Kalman filters. Furthermore, the normal forces of the individual wheels R of the vehicle F are calculated by means of a static model or by means of a dynamic model. These calculated normal forces are required for the tire model which is used within the two Kalman filters.
By means of the present invention it is thus possible to determine a movement state, in particular rolling or tilting of a vehicle, using acceleration information of an acceleration in the y direction ay, a yaw acceleration {umlaut over (Ψ)} and, if appropriate, an acceleration value in the x direction ax, the vehicle state, in particular the rolling angle or tilting angle φ. Furthermore, when modeling a truck in which considerable shifting of the center of gravity occurs as a result of the cargo, the rolling rate {dot over (φ)} is necessary to simulate the vehicle states.
Although the present invention has been described above with reference to preferred exemplary embodiments, it is not restricted thereto but rather can be modified in a variety of ways. A different weighting from the linear weighting of the corresponding vehicle models which is illustrated in
To conclude, the following is to be noted: the following terms used in the statements above “vehicle state”, “state of a vehicle”, “vehicle movement state” and “movement state” are all used synonymously. If, for example, the determination of a vehicle state is mentioned, in accordance with the exemplary embodiments above the determination of a rolling angle or tilting angle as a vehicle movement variable is meant.
Number | Date | Country | Kind |
---|---|---|---|
103 60 728.5 | Dec 2003 | DE | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/EP04/14528 | 12/21/2004 | WO | 11/6/2006 |