Detailed description of the invention
Below in conjunction with the accompanying drawings, the technical scheme proposed invention is further elaborated and illustrates.
The present invention provides a kind of vehicle stability controller method for designing based on variable weight model prediction algorithm, such as Fig. 1
Shown in, the method comprises the following steps:
1. Real-time Collection and process vehicle's current condition information:
First, the car status information that Real-time Collection onboard sensor feeds back, including rotation direction sensor collection
The steering wheel angle signal come, the yaw velocity at vehicle centroid and angle of heel that deflection efficiency sensor (gyroscope) gathers are fast
Degree signal, the acceleration signal longitudinally and laterally that acceleration transducer is measured, pressure transducer detection obtains braking at wheel
The actual pressure signal of pipe.By these signals, after filtering or estimation processes, thus the current steering wheel of real-time update vehicle turns
Angle, yaw velocity, angle of heel, roll velocity, side slip angle, lateral load transfer, longitudinal speed and wheel cylinder braking
The status informations such as pressure.
2. with processing the car status information obtained in real time according to step 1, the holding vehicle yaw stability that makes separate decisions out and
The reference state value of roll stability:
Owing to yaw velocity can react the weaving state of vehicle really, and have can be measured directly excellent
Gesture, the traveling that therefore present invention reacts driver really by the value calculating reference yaw velocity is intended to, as vehicle
Keep the reference state of Yaw stability.In this step, the yaw velocity r of reference is calculated by formula (1)ref:
Wherein: L is car gage, vxFor longitudinal speed, δfFor front wheel angle, k represents stability factor, is to characterize automobile
The important parameter of steady-state response, in the present invention, value is 0.0025s2/m2
For the roll motion of vehicle, the present invention selects the lateral load rate of transform (Lateral-transfer-ratio) to make
For the rollover index of automobile, referred to as LTR.It is defined as tire both sides vertical load difference and vertical load and ratio
Exhausted angle value, shown in expression such as formula (2):
Wherein, FzlRepresent vehicle the near front wheel and the vertical load sum of left rear wheel, FzrRepresent vehicle off-front wheel and off hind wheel
Vertical load sum.
From the expression-form of the lateral load rate of transform it can be seen that LTR is a variable between 0 and 1.Work as LTR
Numerical value when be 0, the vertical load of vehicle left side tire is equal with the vertical load of right side tire, illustrates that vehicle is the most just
In stable traveling;When the numerical value of LTR is 1 when, the vertical load of vehicle left side tire or right side tire is 0, and wheel has
Leave the danger on ground, it is easy to rollover event occurs.Therefore the present invention selects LTR=0 to be to keep vehicle roll stability
Reference state value.
3., based on variable weight model prediction algorithm, with front wheel angle and tire brake force as control variable, design vehicle is horizontal
Pendulum and roll stability integrated manipulator:
(1) system prediction model
For weaving, lateral movement and the roll motion of vehicle, set up the Three Degree Of Freedom auto model conduct simplified
Forecast model.First hypothesis below is made:
I impact not considering wheel steering system, front wheel angle δfInput as system;
II effect ignoring suspension, it is believed that automobile is along the displacement of z-axis, the angle of heel around x-axis with the angle of pitch around y-axis
Zero;
III change not considering tyre load and the impact on tire cornering characteristics of the ground tangential force;
IV ignores aerodynamic effect, and driving force is little;
V automobile is constant along the longitudinal velocity of x-axis.
The present invention uses iso standard vehicle axis system, and zero is located at the barycenter of vehicle, vehicle along headstock to moving ahead
The direction sailed is set to x-axis positive direction, and level is the positive direction of y-axis to the left, and z-axis positive direction is determined by right-hand screw rule.Due toVehicle centroid side drift angle rate of change is obtained according to reaching bright BELL'S THEOREMAbout resulting side force ∑ Fy, yaw make a concerted effort
Square ∑ MzAnd roll resultant moment ∑ MxExpression formula:
Yaw velocity rate of changeAbout resulting side force ∑ Fy, yaw resultant moment ∑ MzAnd roll resultant moment ∑ MxTable
Reach formula:
Roll velocity rate of changeAbout resulting side force ∑ Fy, yaw resultant moment ∑ MzAnd roll resultant moment ∑ MxTable
Reach formula:
Wherein, D=Ixs-ms 2e2/m-IxzIxzs/Iz
In order to describe the relation between side force of tire and side drift angle, the present invention selects linear tire model, it is assumed that left front
Wheel and off-front wheel, left rear wheel and off hind wheel have identical steering characteristic, then vehicle front-wheel side force FyfWith front wheel side drift angle αf、
Trailing wheel side force FyrWith rear wheel-side drift angle αrRelational expression such as following formula (6) shown in:
Therefore tire resulting side force ∑ F is obtainedy, yaw resultant moment ∑ MzAnd roll resultant moment ∑ MxExpression formula such as formula
(7) shown in-(9):
∑Fy=Kfαfcosδf+Krαr (7)
∑Mz=Lf·Kfαfcosδf-Lr·Krαr+ΔMz (8)
In above formula, m is complete vehicle quality, msFor vehicle spring carried mass, LfFor the distance in front-wheel axle center to automobile barycenter, LrFor
Rear axis is to the distance of vehicle centroid, and e is the barycenter distance to roll center of vehicle spring carried mass.G is acceleration of gravity.
vxRepresent longitudinal direction of car speed, vyRepresenting the lateral speed of vehicle, r is yaw velocity, and β is side slip angle, and φ is body of a motor car
Angle of heel, δfIt it is front wheel angle.MzIt is the vehicle yaw moment around z-axis, Δ MzFor additional yaw moment, MxIt is that vehicle is around x-axis
Moment resulting from sidesway.KφFor the roll stiffness of vehicle, CφInclination for vehicle damps, KfFor front-wheel cornering stiffness, KrFor trailing wheel lateral deviation
Rigidity.IzFor complete vehicle quality around the rotary inertia of z-axis, IxzFor complete vehicle quality around x, the product of inertia of z-axis, IxsFor vehicle spring carried mass
Around the rotary inertia of vehicle axis system x-axis, IxzsFor vehicle spring carried mass around vehicle axis system x, the product of inertia of z-axis.
It is independent of driver's input owing to electronic control unit can apply one by wire-controlled steering system to front-wheel
Additional rotation angle, superposes with the go to action of driver thus improves the maneuverability of vehicle, stability and track and keep performance.Cause
This, additional front wheel angle can superpose with go to action as control system a controlled variable, the most comprehensively obtain front round
Angle δfAs shown in following formula (10):
δf=δfd+Δδf (10)
Wherein, Δ δfIt is the additional front wheel angle of control system output, δfdIt is that the steering wheel angle δ of driver is through turning to
Mechanism is applied to the corner on front-wheel, δ and δfdRelational expression such as following formula (11) shown in.
δfd=δ/Isw (11)
In formula: IswFor steering gear ratio.
Yet with tire, there is nonlinear cornering behavior, when side force is in saturation when, course changing control
Can not directly change the lateral dynamic characteristic of vehicle.And differential braking is by four tires are applied different longitudinal direction systems
Power, thus produce the additional yaw moment Δ M around Full Vehicle System z-axiszEven if still having side force is saturated when
Certain effectiveness.Therefore, by front wheel angle and tire brake force simultaneously as control variable.Set tire brake force positive direction
In opposite direction with what vehicle advanced, formula (12) gives additional yaw moment Δ MzBrake force Δ F with four tiresxiPass
System.
Wherein, d1、d2It is respectively vehicle wheel base, Δ FyflFor the near front wheel brake force, Δ FyfrFor off-front wheel brake force,
ΔFyrlFor left rear wheel brake force, Δ FyrrFor off hind wheel brake force.
Basic control of Yaw stability aims at the yaw velocity tracking for reference value, the root of roll stability
This control target is to reduce the lateral load rate of transform of vehicle, and it is controlled for therefore selecting yaw velocity and the lateral load rate of transform
Output.Owing to the vertical load of both sides tire is not easy to measure, through and shifting onto obtain the expression of dynamic lateral load transfer rate LTR
Formula is as follows:
Wherein, d=(d1+d2)/2 are the average wheelspan of front and back wheel, hRFor height of roll center.
From formula (13) it can be seen that LTR along with β, r, φ andChange and change.Therefore it is assumed herein that angle of heel
Rate of change isAnd to select side slip angle, yaw velocity, angle of heel and angle of heel rate of change be state variable i.e. x
=[β, r, φ, p], yaw velocity and the lateral load rate of transform are as controlled output i.e. y=[r;LTR], will additional front round
Angle and tire brake force are as controlling input i.e. u=[Δ δf,ΔFxfl,ΔFxfr,ΔFxrl,ΔFxrr].Due to δfdIt is by driving
Member's output determines, it is impossible to be enough predicted it, therefore in the whole prediction time domain in each sampling period, it is believed that δfdIt is normal
Value.
Composite type (3)-(13), state space equation expression formula continuous time that final arrangement obtains forecast model is as follows:
For the design of subsequent controllers, needing continuous print state-space model discretization, the selection sampling time is Ts
=0.01, after discretization, state-space model can be described as formula (15):
Here definition prediction time domain is p, and control time domain is m, and p > m.Owing to the change of longitudinal speed is continuous and slow
Slow, therefore in prediction time domain, assume that speed is steady state value.Adapt with the rule of Nonlinear Model Predictive Control, it is assumed that car
Current time is k, and vehicle dynamically can obtain based on vehicle's current condition and forecast model in [k+1, k+p] prediction time domain
Arrive.I.e. in the k+p moment, vehicle-state be x (k+p)=F (x (k), u (k), u (k+1) ..., u (k+m) ..., u (k+p-1)).
When the sampling time is more than control time domain m, keep controlling input constant until predicting time domain, i.e. u (k+m-1)=u
(k+m)=u (k+m+1)=...=u (k+p-1).
Therefore the optimum control input in definition k moment:
Accordingly, the prediction output of k moment yaw velocity r can be calculated by above-mentioned state equation (17):
Equally, the lateral load rate of transform LTR prediction output in k moment is as follows:
With prediction output equation (17) corresponding, with reference to yaw velocity should in each prediction time domain real-time update,
Reference input sequence definition is as follows:
(2) based on Fuzzy strategy feedback optimized
Considering Yaw stability and the roll stable sexual demand of vehicle, the yaw velocity r of vehicle reality should use up
Fast tracking is upper with reference to yaw velocity rref, lateral load rate of transform LTR should be tried one's best simultaneously reduction, therefore obtain integrated control
Shown in the object function of device processed such as following formula (20):
J=Γy||(Y1(k+1|k)-R(k+1))||2+Γr||(Y2(k+1|k))||2 (20)
Here, Γy=diag (τy,1,τy,2,…,τy,p), the weight coefficient controlled for vehicle yaw stability, Γr=
diag(τr,1,τr,2,…,τr,p) be vehicle roll stability control weight coefficient, work as ΓyTime relatively large, control system side
Overweighting the control to weaving, actual yaw velocity has preferable tracking effect to its reference value, works as ΓrRelatively large
Time, control system lays particular emphasis on the Roll control to vehicle, the size of the reduction lateral load rate of transform i.e. as far as possible.
Γ in object functionyAnd ΓrRepresent the weight that control system controls for weaving and roll motion respectively,
Both have relative meaning, control to adapt to the different stability energy demand of vehicle, here therefore to realize variable weight
We fix ΓyValue, change ΓrValue.Owing to the lateral load rate of transform of vehicle is directly to characterize the change of vehicle roll state
Amount, and steering wheel angle is to directly result in vehicle the input quantity of rollover occurs, therefore the two parametric variable is to automobile roll shape
The impact of state is maximum.So for the weight coefficient Γ of Roll controlrDesign a Fuzzy Control with two inputs and single output
Device processed, wherein input quantity is lateral load rate of transform LTR and steering wheel angle δ, and output is Roll control weight coefficient Γr。
Owing to there is the degree of danger degree of danger more than sideslip of rollover in vehicle, so working as the rollover danger of vehicle gradually
The when of increase, Roll control weight coefficient also should increase therewith.The aggravation turned to along with driver, the LTR of vehicle also exists
Gradually increasing, this most gradually increases the danger of vehicle side turning, and Roll control is more and more important in integrating control, so
ΓrShould be gradually increased along with the increase of δ and LTR.Here illustrating, when LTR is less when, vehicle rollover is dangerous
Degree is relatively low, ΓrAlong with the increase of δ should be slowly increased;When LTR is bigger when, vehicle rollover degree of danger steeply rises,
Therefore ΓrSize should aggravate along with the increase of δ.
Here, by LTR obfuscation, be divided into 3 grades: S (low), M (in), B (high);δ obfuscation is divided into 3 grades: S (low), M
In (), B (high);By ΓrObfuscation be divided into 4 grades: S (low), M (in), MB (higher), B (high), its membership function such as Fig. 2-4
Shown in.According to above-mentioned theory analysis and emulation experience, final design goes out weight coefficient ΓrConcrete fuzzy control about LTR and δ
Rule, as shown in table 1.
Table 1 fuzzy control rule
Mamdani minimax rationalistic method is used input/output variable to carry out obfuscation and anti fuzzy method computing, finally
Obtain weight coefficient ΓrAbout input quantity LTR and the three-dimensional map curved surface of δ, as shown in Figure 5.Through above-mentioned fuzzy control strategy,
Weight coefficient has carried out optimized design the most at last.
For the stable constraint problem of vehicle, side slip angle first should be madePhase plane movement locus is protected
Hold in stable phase region.I.e. vehiclePhase plane movement locus should meet the inequality constraints shown in formula (21):
Wherein, k, b are stable constraint constant.
Secondly vehicle actual yaw velocity r and reference yaw velocity r is consideredrefDeviation delta r, lateral load transfer
Within the size of rate LTR should be limited to stable threshold, therefore there is the stable constraint shown in formula:
Finally consider the saturated characteristic of Vehicular system frame for movement, control input and should meet the safety shown in following formula about
Bundle:
Wherein, i={fl, fr, rl, rr}, Δ FxiRepresent the brake force of four tires respectively.
Based on above analysis, the most above-mentioned intact stability integrating control problem is described as following optimization problem:
4. the tire desired braking power that step 3 middle controller exports is compared with brake pipe actual pressure, thus decision-making
Go out to brake the supercharging of execution system, pressurize or decompression state, and be converted into corresponding electromagnetic valve action command, simultaneously will step
In rapid 3, the additional front wheel angle of output superposes with the go to action of driver, obtains final front wheel angle;
The optimization problem as shown in formula (24) is solved by nonlinear solution instrument, and by the Section 1 of optimized variable i.e. u
K () is as controller output.Tire brake force Δ FxiCorresponding wheel cylinder expectation pressure is converted to firstly the need of by formula (25)
Power Pdi:
In above formula: i={fl, fr, rl, rr}.PdiFor corresponding wheel cylinder brake pressure.DwRepresenting the diameter of wheel cylinder, C represents
Braking effectiveness factor, RbRepresenting the radius of brake, n represents oil cylinder number, rdRepresent the rolling radius of tire.
As a example by single wheel, the wheel cylinder desired braking pressure P that will obtaini_refWith wheel cylinder actual pressure PiMake deviation can obtain
ΔPi=Pi-Pi_ref.When controlling, according to inclined difference DELTA P of brake pressurei, the pressure for each wheel cylinder carries out boosting, protecting
Pressure and the regulation of three kinds of states of blood pressure lowering.Frequently switching in order to avoid electromagnetic valve here, set the threshold value of pressure divergence as
ΔPth, only when deviation value is beyond this threshold value, just carry out boosting or Decompression Controlling, be converted into electromagnetic valve action command transmission
To actuator.Concrete judgement situation is as follows:
(1) as-Δ Pth< Δ Pi< Δ PthPressurize regulates
(2) as Δ Pi> Δ PthDecompression regulation
(3) as Δ Pi<-Δ PthBoost pressure regulation
Additional front wheel angle is superposed with driver's go to action, the most comprehensively obtains front wheel angle δfFor δfd+Δδf。
5, brake actuator and turn to the electromagnetic valve action command and front wheel angle instruction that executor performs in step 4, makes
Vehicle resume stability:
Front wheel angle signal decision-making in step 4 gone out is applied to turn to actuator, simultaneously by the electromagnetic valve in step 4
Action command is applied to brake actuator, after actuator has performed, makes vehicle recover stable and travels.
Utilize vehicle dynamics simulation software veDYNA, select light auto model, under simulink simulated environment,
Build the controller model realizing above-mentioned control program, under limit open loop operating mode, done emulation experiment: be 0.8 at coefficient of friction
Road on, vehicle accelerates to 80km/h, and given steering wheel angle signal as shown in Figure 6, simulation time is 35 seconds.Its emulation
Result is as illustrated in figures 7 to 13.Find out from simulation result, the intact stability collection under the driving cycles of the limit, designed by the present invention
Become control method that the preferable yaw velocity of vehicle can be made well to follow the tracks of reference value, and the lateral load rate of transform also can
Fluctuate in stable threshold range, meet front wheel angle and tire brake force simultaneously within restriction range, meet vehicle
Yaw stability and roll stability requirement.