ACTIVE SUSPENSION INERTIA REGULATION METHOD BASED ON VEHICLE-FRONT TERRAIN, AND CONTROL SYSTEM

20230286347 · 2023-09-14

Assignee

Inventors

Cpc classification

International classification

Abstract

Disclosed in the present invention are an inertial regulation method of active suspensions based on terrain ahead of a vehicle and a control system thereof. According to the scanned terrain ahead of the vehicle, a center of mass trajectory and attitude history are calculated when the vehicle passes through the terrain ahead of the vehicle with passive suspensions. After smoothing the trajectory, the active suspension is controlled to make the vehicle drives according to the smoothed trajectory. During this period, a smoothness coefficient is adjusted to make each suspension stroke be limited within a limit stroke, and according to the supporting force and stroke of each active suspension calculated from a dynamics model, the impedance control based on force-displacement is carried out on an actuator of the suspension. The present invention can significantly improve the driving comfort and handling stability of the vehicle driving on an uneven road surface.

Claims

1. An inertial regulation method of active suspensions based on terrain ahead of a vehicle, comprising the following steps: S1: calculating trajectories of ground-contacted points of wheels and elevation information of ground-contacted point of each wheel when the vehicle passes through the terrain ahead of the vehicle; according to position coordinates of the vehicle in a geodetic coordinate system measured by an inertial measurement unit and a dual-antenna GPS positioning system, and the terrain ahead of the vehicle scanned by a laser radar and a steering angle of each wheel, calculating, by vehicle kinematics, the trajectories T.sub.1, T.sub.2, . . . , T.sub.m of all ground-contacted points of wheels when the vehicle is driving on the terrain ahead of the vehicle, wherein j=1, 2, . . . , m, and m is a number of wheels; and calculating the elevation information of each planning data point on the trajectory of ground-contacted point of each wheel by an interpolation algorithm; S2: calculating a trajectory of center of mass and an attitude history when the vehicle passes through the terrain ahead of the vehicle with passive suspensions; S21: according to a vehicle speed, a steering angle, a driving/braking force of each wheel and a rolling friction coefficient of the wheel on the ground, calculating, from a vehicle dynamics model, a 6-dimensional coordinate history {X.sub.i Y.sub.i Z.sub.i α.sub.i β.sub.i γ.sub.i}.sup.T of a vehicle coordinate system, the trajectory of center of mass and the attitude history {X.sub.Wi Y.sub.Wi Z.sub.Wi α.sub.Wi β.sub.Wi γ.sub.Wi}.sup.T when the vehicle drives with the passive suspensions along the trajectories T.sub.1, T.sub.2, . . . , T.sub.m of the ground-contacted points of wheels in step S1, wherein, X.sub.Wi, Y.sub.Wi, Z.sub.Wi, α.sub.Wiβ.sub.Wi, γ.sub.Wi are three-dimensional coordinates and three-dimensional attitude angles of the center of mass of the vehicle respectively, wherein i=0, 1, 2, . . . , n, and n is the number of planned data points; S22: taking a smoothness coefficient as ζ, performing a smoothing process crossing a start point on the trajectory of the center of mass and attitude history of the passive suspension vehicle in step S21 to obtain a smoothing function {X.sub.W(t.sub.i), Y.sub.W(t.sub.i), Z.sub.W(t.sub.i), α.sub.W(t.sub.i), β.sub.W(t.sub.i), γ.sub.W(t.sub.i)}.sup.T of the trajectory of the center of mass and attitude history; S3: based on the above-mentioned smooth-processed trajectory of the center of mass and attitude history, calculating the suspension stroke history s.sub.i,j and suspension supporting force history W.sub.i,j when the vehicle passes through the terrain ahead of the vehicle with the active suspensions; S31: taking the smooth-processed center of mass trajectory and attitude history of the vehicle in step S22 as inputs to calculate the stroke history s.sub.i,j.sup.R and speed history {dot over (s)}.sub.i,j.sup.R of each suspension relative to the passive suspension when the vehicle passes through the terrain ahead of the vehicle with the active suspensions, wherein j=1, 2, . . . , m, and m is the number of wheels; S32: under the conditions of the same speed of vehicle, steering angle, driving/braking force of each wheel and rolling friction coefficient of the wheel on the ground as in step S21, according to the stroke history s.sub.i,j.sup.R and speed history {dot over (s)}.sub.i,j.sup.R of active suspension relative to passive suspension obtained in step S31, calculating, from a dynamics model, a stroke history s.sub.i,j and a supporting force history W.sub.ij of each suspension relative to the median position when the vehicle passes through the terrain ahead of the vehicle with the active suspensions; S4: according to the stroke history s.sub.i,j and the supporting force history W.sub.ij of each suspension relative to the median position when the vehicle passes through the terrain ahead of the vehicle with the active suspensions, performing an impedance control based on force-displacement on a suspension actuator.

2. The inertial regulation method according to claim 1, wherein, in the steps S21 and S32, the vehicle dynamics model and solving thereof are as follows: establishing a fixed coordinate system OXYZ, which is fixedly connected with the ground, wherein the coordinate system takes a reference point O of the inertial measurement unit as the origin of coordinates, the front of the vehicle as a positive direction of Y axis, the right direction of the vehicle as a positive direction of X axis, and the upward direction perpendicular to the XOY plane as a positive direction of Z axis; in order to determine the position of the vehicle in the fixed coordinate system, introducing a vehicle coordinate system oxyz, which is fixedly connected with a vehicle body, wherein the vehicle coordinate system coincides with the fixed coordinate system at an initial position, and positioning coordinates in the fixed coordinate system are X, Y, Z, α, β, γ respectively; in order to improve a calculation speed, regarding the vehicle as a rigid body, setting the weight thereof as M and the coordinate thereof in the vehicle coordinate system as W (x.sub.W, y.sub.W, z.sub.W), wherein the vehicle has m wheels and has m corresponding suspensions, the active suspension is simplified to a parallel connection of an actuator, a spring and a damper; setting the control method of active suspension as a displacement control; setting the stiffness coefficients of suspension springs respectively as K.sub.S1, K.sub.S2, . . . , K.sub.Sm, and the damping coefficients of suspension dampers respectively as C.sub.S1, C.sub.S2, . . . , C.sub.Sm; simplifying a tire as a parallel connection of a vertical spring and a damper, and ignoring the influence of lateral and tangential elasticity and damping of the tire on vehicle dynamics characteristics; setting the stiffness coefficients of vertical springs of all tires as K.sub.W1, K.sub.W2, . . . , K.sub.Wm, and setting the damping coefficients of vertical dampers of all tires as C.sub.W1, C.sub.W2, . . . , C.sub.Wm; setting the above-mentioned dampers to be viscous dampers; and setting the above-mentioned springs as nonlinear springs and approximating the springs by piecewise linear; wherein the above is the dynamics model of the active suspension vehicle, which has 6 degrees of freedom; if the actuator in each suspension is removed, the above-mentioned dynamics model becomes the dynamics model of the passive suspension vehicle; when the suspension spring and damper are not provided in the design of partial active suspension, the suspension spring and damper in the above dynamics model of the active suspension vehicle should be omitted; establishing a kinematic differential equation of the vehicle dynamics model by a Lagrange equation, which is expressed by matrix as follows:
[M.sub.6×6]{{umlaut over (q)}.sub.6}+[C.sub.6×6]{{dot over (q)}.sub.6}+[K.sub.6×6]{q.sub.6}={F.sub.6} in the formula, [M.sub.6×6], [C.sub.6×6] and [K.sub.6×6] are a weight matrix, a damping matrix and a stiffness matrix respectively, all of which are 6×6 symmetric square matrices; and {F.sub.6} is a force matrix which is a 6×1 array; taking a displacement vector of the vehicle in the fixed coordinate system as:
{q.sub.6}={X,Y,Z,α,β,γ}.sup.T constructing a dynamics matrix based on the above kinematic differential equation as follows:
{{umlaut over (q)}.sub.6}=[M.sub.6×6].sup.−1{F.sub.6}−[M.sub.6×6].sup.−1[C.sub.6×6]{{dot over (q)}.sub.6}−[M.sub.6×6].sub.−1[K.sub.6×6]{q.sub.6} setting a state variable as: { q 12 } = { { q 6 } { q . 6 } } = { X Y Z α β γ X . Y . Z . α . β . γ . } T substituting the state variable into the dynamics matrix to obtain a state equation as follows: { q . 12 } = [ E ] { q 12 } + { F * } wherein , [ E ] = [ [ 0 ] 6 × 6 [ I ] 6 × 6 - [ M 6 × 6 ] - 1 [ K 6 × 6 ] - [ M 6 × 6 ] - 1 [ C 6 × 6 ] ] , { F * } = { { 0 } 6 [ M 6 × 6 ] - 1 { F 6 } } the above state equation can be solved by a fourth order Runge-Kutta method to obtain the value of the state variable {q.sub.12}.

3. The inertial regulation method according to claim 2, wherein in the step S21, a specific method of calculating a trajectory of center of mass and an attitude history when the vehicle passes through the terrain ahead of the vehicle with passive suspensions is as follows: calculating three coordinates related to the suspension characteristics in the vehicle trajectory history by a time point {q.sub.12}.sub.i, calculated from the dynamics model, at which the vehicle passes through the terrain ahead of the vehicle with the passive suspensions as follows: { Z W i = Z + z W + y W α i - x W β i α W i = α i β W i = β i , i = 0 , 1 , 2 , .Math. , n the above formula is obtained by assuming that α and β are tiny variables, taking cos α≈1 cos β≈1, sin α≈α, sin β≈β, and ignoring deformation of the vehicle body.

4. The inertial regulation method according to claim 1, wherein in the step S31, specific steps of calculating the stroke history s.sub.i,j.sup.R and speed history {dot over (s)}.sub.i,j.sup.R of each suspension relative to the passive suspension when the vehicle passes through the terrain ahead of the vehicle with the active suspensions are as follows: (1) based on the 6-dimensional coordinate history {X.sub.i Y.sub.i Z.sub.i α.sub.i β.sub.i γ.sub.i}.sup.T of the vehicle coordinate system when the vehicle passes through the terrain ahead of the vehicle with the passive suspensions obtained in S21, solving a vertical displacement history of supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.m on all suspensions by the following formula:
w.sub.i,j.sup.P=Z.sub.i−b.sub.jβ.sub.i+L.sub.jα.sub.i,i=0,1,2, . . . ,n;j=1,2, . . . ,m in the formula, b.sub.j is x coordinate of the supporting point on the suspension numbered j in the oxyz coordinate system; L.sub.j is y coordinate of the supporting point on the suspension numbered j in the oxyz coordinate system; then a vertical speed history of the supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.m on all suspensions is:
{dot over (w)}.sub.i,j.sup.P.sub.i−b.sub.j{dot over (β)}.sub.i+L.sub.j{dot over (α)}.sub.i,i=0,1,2, . . . ,n;j=1,2, . . . ,m (2) according to the function {X.sub.W(t.sub.i), Y.sub.W(t.sub.i), Z.sub.W(t.sub.i), α.sub.W(t.sub.i), β.sub.W(t.sub.i), γ.sub.W(t.sub.i)}.sup.T of the center of mass trajectory and attitude history obtained after smoothing process in S22, inversely calculating a time history function of the three coordinates of the vehicle coordinate system relative to the fixed coordinate system as follows: { Z ( t i ) = Z W ( t i ) - z W - y W α ( t i ) + x W β ( t i ) α ( t i ) = α W ( t i ) β ( t i ) = β W ( t i ) , i = 0 , 1 , 2 , .Math. , n then solving a vertical displacement of the supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.m on all suspensions from z(t.sub.i), α(t.sub.i), β(t.sub.i) as follows:
w.sub.i,j.sup.A=Z.sub.j(t.sub.i)−b.sub.jβ(t.sub.i)+L.sub.jα(t.sub.i),i=0,1,2, . . . ,n;j=1,2, . . . ,m a vertical speed of the supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.m on all suspensions is:
{dot over (w)}.sub.i,j.sup.A.sub.j(t.sub.i)−b.sub.j{dot over (β)}(t.sub.i)+L.sub.j{dot over (α)}(t.sub.i),i=0,1,2, . . . ,n;j=1,2, . . . ,m (3) calculating the stroke history s.sub.i,j.sup.R and speed history {dot over (s)}.sub.i,j.sup.R of each active suspension relative to the passive suspension the stroke history of each active suspension relative to the passive suspension is equal to the difference between the vertical displacement w.sub.i,j history w.sub.i,j of the supporting points on each active suspension after the smoothing process and the vertical displacement history w.sub.i,j.sup.P of the supporting points on the passive suspension before the smoothing process:
s.sub.i,j=w.sub.i,j−w.sub.i,j.sup.P,i=0,1,2, . . . ,n;j=1,2, . . . ,m the speed history of each active suspension relative to the passive suspension is equal to the difference between the vertical speed history {dot over (w)}.sub.i,j of the supporting points on each active suspension after the smoothing process and {dot over (w)}.sub.i,j.sup.P the vertical speed history {dot over (w)}.sub.i,j.sup.P of the supporting points on the passive suspension before the smoothing process:
{dot over (s)}.sub.i,j={dot over (w)}.sub.i,j−{dot over (w)}.sub.i,j.sup.P,i=0,1,2, . . . ,n;j=1,2, . . . ,m.

5. The inertial regulation method according to claim 1, wherein the specific steps of calculating, from a dynamics model of the vehicle, a stroke history s.sub.i,j and a supporting force history W.sub.ij of each suspension of the vehicle when the vehicle passes through the terrain ahead of the vehicle with the active suspensions in step S32 are as follows: (1) solving the vertical displacement history w.sub.i,j′ and vertical speed history {dot over (w)}.sub.i,j′ of the supporting points on each active suspension, wherein according to stroke difference history s.sub.i,j.sup.R and speed difference history {dot over (s)}.sub.i,j.sup.R of the active/passive suspension, solving, from the dynamics model of the vehicle, a new state variable {q.sub.12′}.sub.i when the vehicle passes through the terrain ahead of the vehicle, and substituting displacement variables z.sub.i′, α.sub.i′, β.sub.i′ contained in the new state variable into the following formula to calculate the vertical displacement history of the supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.m on each suspension:
w.sub.i,j′=z.sub.i′−b.sub.jβ.sub.i′+L.sub.jα.sub.i′,i=0,1,2, . . . ,n;j=1,2, . . . ,m substituting the values of speed variables ż.sub.i′, {dot over (α)}.sub.i′, {dot over (β)}.sub.i′ into the following formula to calculate the vertical speed history of the supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.m on all suspensions as follows:
{dot over (w)}.sub.i,j′=ż.sub.i′−b.sub.j{dot over (β)}.sub.i′+L.sub.j{dot over (α)}.sub.i′,i=0,1,2, . . . ,n;j=1,2, . . . ,m (2) solving the stroke history S1 of each active suspension relative to the median position, wherein because the vertical deformation of the tire is far less than the stroke of the active suspension, the vertical deformation of the tire is omitted; the vertical deformation of the tire is compensated in a suspension impedance control in S4; the stroke history of each active suspension relative to the median position is equal to the difference between the vertical displacement history w.sub.i,j′ of the supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.m on all suspensions and the vertical displacement history Δ.sub.i,j of ground-contacted points of all wheels R.sub.1, R.sub.2, . . . , R.sub.m;
s.sub.i,j=w.sub.i,j−w.sub.i,j.sup.P,i=0,1,2, . . . ,n;j=1,2, . . . ,m (3) calculating the supporting force history W.sub.i,j of each active suspension, wherein the supporting force history of each active suspension of the vehicle is as follows:
W.sub.i,j=K.sub.jZ(w.sub.i,j′−s.sub.0−s.sub.i,j.sup.R−Δ.sub.i,j)+C.sub.jZ({dot over (w)}.sub.i,j′−{dot over (s)}.sub.i,j.sup.R−{dot over (Δ)}.sub.i,j),i=0,1,2, . . . ,n;j=1,2, . . . ,m in the formula, Δ.sub.i,j and {dot over (Δ)}.sub.i,j are respectively the vertical displacement history and speed history of the ground-contacted point of wheel.

6. The inertial regulation method according to claim 1, wherein, the specific realization method of performing an impedance control based on force-displacement on a suspension actuator in the S4 is as follows: {circle around (1)} solving the displacement control quantity of suspension impedance control setting the measured value of the current suspension supporting force as W.sub.i,j.sup.c, and using the following formula to express the relationship between the difference between a theoretical supporting force and an actual supporting force of the suspension and an expected suspension stroke increment δ.sub.i,j:
ΔW.sub.i,j=W.sub.i,j−W.sub.i,j.sup.c=M{umlaut over (δ)}.sub.i,j+C{dot over (δ)}.sub.i,j+Kδ.sub.i,ji=0,1,2, . . . ,n;j=1,2, . . . ,m in the formula, M, K and C are target inertia, target stiffness and target damping respectively and reflect the inertia characteristics of spring weight, stiffness characteristics and damping characteristics of tire contacting the ground respectively; the above differential equation can be solved by means of convolution integral:
δ.sub.i,j=∫.sub.0.sup.tΔW.sub.i,j(τ)h.sub.i,j(t−τ)dτ,i=0,1,2, . . . ,n;j=1,2, . . . ,m the function h.sub.i,j(t) in the above formula is the corresponding unit impulse response function of the previous formula; the above formula can be solved by an FFT algorithm; in actual control, since the moving speed and acceleration of each suspension stroke increment δ.sub.i,j of the vehicle are relatively small, it can be considered that {umlaut over (δ)}.sub.i,j≈{dot over (δ)}.sub.i,j≈0 and then a contact force model between the wheel and the ground can be simplified as: δ i , j = Δ W i , j K , i = 0 , 1 , 2 , .Math. , n ; j = 1 , 2 , .Math. , m {circle around (2)}impedance control of active suspensions based on force-displacement setting the measured value of the suspension relative to the median position stroke as s.sub.i,j.sup.c, and designing a disturbance self-rejection controller by taking l.sub.d=l.sub.z+Δl.sub.zs.sub.i,j.sup.d=s.sub.i,j+δ.sub.i,j as a target stroke, so as to realize displacement follow-up control of each suspension actuator.

7. The inertial regulation method according to claim 1, wherein, the S4 further comprises a content for verifying whether the suspension stroke s.sub.i,j.sup.d in the whole history exceeds the limit stroke before the implementation of impedance control based on the force-displacement; the verification formula is:
S.sub.min≤S.sub.i,j.sup.d≤S.sub.max,i=0,1,2, . . . ,n;j=1,2, . . . ,m in the formula, s.sub.min is a lower limit displacement of the suspension; s.sub.max is an upper limit displacement of the suspension; if there is a certain suspension stroke exceeding the limit stroke, the smoothness of a vehicle trajectory curve is reduced first, and the corresponding smoothness coefficient ζ is adjusted, it is handled according to the following two cases respectively: (1) if the smoothness coefficient ζ has not reached a preset smoothness coefficient limit value, then proceeding to step S22; (2) if the smoothness coefficient ζ has reached the limit value and it still cannot meet the condition that each suspension stroke in the whole history does not exceed the limit stroke, finding a first data point with the suspension stroke exceeding the limit stroke according to the time sequence of occurrence, and setting the number of planned data point in step S2 as i.sub.E(1≤i.sub.E≤n), then letting n=i.sub.E and returning to step S21, wherein each suspension stroke in the whole history is made no more than the limit stroke through the above processing.

8. A control system applying the inertial regulation method of active suspensions based on terrain ahead of a vehicle according to claim 1, wherein the system comprises a vehicle body and m wheels, a laser radar, an inertial measurement unit, a dual antenna GPS positioning system, the suspension cylinders corresponding to the wheels, displacement sensors, supporting force sensors and a servo controller group thereof, a vehicle speed sensor, a steering wheel angle sensor, a throttle opening degree sensor, a braking force sensor, an electronic control unit, wherein the laser radar, the inertial measurement unit, the dual-antenna GPS positioning system, the electronic control unit and the servo controller group are fixed on the vehicle body, and the laser radar is installed on the front of the vehicle body for measuring the terrain ahead of the vehicle, and the two antennas of the dual antenna GPS positioning system are separated by a certain distance in space; the wheel is connected to the vehicle body through the suspension cylinder, and the displacement sensor and the supporting force sensor are installed on the suspension cylinder for measuring the stroke and supporting force of the suspension cylinder; the steering wheel angle sensor, the throttle opening degree sensor and the braking force sensor are used to measure a steering angle, a throttle opening degree and a braking strength; the electronic control unit respectively communicates with the inertial measurement unit, the laser radar, the dual antenna GPS positioning system, the steering wheel angle sensor, the throttle opening degree sensor, the braking force sensor, and the servo controller group, and the servo controller group communicates with the displacement sensor and supporting force sensor of the suspension cylinder.

9. A control system applying the inertial regulation method of active suspensions based on terrain ahead of a vehicle according to claim 2, wherein the system comprises a vehicle body and m wheels, a laser radar, an inertial measurement unit, a dual antenna GPS positioning system, the suspension cylinders corresponding to the wheels, displacement sensors, supporting force sensors and a servo controller group thereof, a vehicle speed sensor, a steering wheel angle sensor, a throttle opening degree sensor, a braking force sensor, an electronic control unit, wherein the laser radar, the inertial measurement unit, the dual-antenna GPS positioning system, the electronic control unit and the servo controller group are fixed on the vehicle body, and the laser radar is installed on the front of the vehicle body for measuring the terrain ahead of the vehicle, and the two antennas of the dual antenna GPS positioning system are separated by a certain distance in space; the wheel is connected to the vehicle body through the suspension cylinder, and the displacement sensor and the supporting force sensor are installed on the suspension cylinder for measuring the stroke and supporting force of the suspension cylinder; the steering wheel angle sensor, the throttle opening degree sensor and the braking force sensor are used to measure a steering angle, a throttle opening degree and a braking strength; the electronic control unit respectively communicates with the inertial measurement unit, the laser radar, the dual antenna GPS positioning system, the steering wheel angle sensor, the throttle opening degree sensor, the braking force sensor, and the servo controller group, and the servo controller group communicates with the displacement sensor and supporting force sensor of the suspension cylinder.

10. A control system applying the inertial regulation method of active suspensions based on terrain ahead of a vehicle according to claim 3, wherein the system comprises a vehicle body and m wheels, a laser radar, an inertial measurement unit, a dual antenna GPS positioning system, the suspension cylinders corresponding to the wheels, displacement sensors, supporting force sensors and a servo controller group thereof, a vehicle speed sensor, a steering wheel angle sensor, a throttle opening degree sensor, a braking force sensor, an electronic control unit, wherein the laser radar, the inertial measurement unit, the dual-antenna GPS positioning system, the electronic control unit and the servo controller group are fixed on the vehicle body, and the laser radar is installed on the front of the vehicle body for measuring the terrain ahead of the vehicle, and the two antennas of the dual antenna GPS positioning system are separated by a certain distance in space; the wheel is connected to the vehicle body through the suspension cylinder, and the displacement sensor and the supporting force sensor are installed on the suspension cylinder for measuring the stroke and supporting force of the suspension cylinder; the steering wheel angle sensor, the throttle opening degree sensor and the braking force sensor are used to measure a steering angle, a throttle opening degree and a braking strength; the electronic control unit respectively communicates with the inertial measurement unit, the laser radar, the dual antenna GPS positioning system, the steering wheel angle sensor, the throttle opening degree sensor, the braking force sensor, and the servo controller group, and the servo controller group communicates with the displacement sensor and supporting force sensor of the suspension cylinder.

11. A control system applying the inertial regulation method of active suspensions based on terrain ahead of a vehicle according to claim 4, wherein the system comprises a vehicle body and m wheels, a laser radar, an inertial measurement unit, a dual antenna GPS positioning system, the suspension cylinders corresponding to the wheels, displacement sensors, supporting force sensors and a servo controller group thereof, a vehicle speed sensor, a steering wheel angle sensor, a throttle opening degree sensor, a braking force sensor, an electronic control unit, wherein the laser radar, the inertial measurement unit, the dual-antenna GPS positioning system, the electronic control unit and the servo controller group are fixed on the vehicle body, and the laser radar is installed on the front of the vehicle body for measuring the terrain ahead of the vehicle, and the two antennas of the dual antenna GPS positioning system are separated by a certain distance in space; the wheel is connected to the vehicle body through the suspension cylinder, and the displacement sensor and the supporting force sensor are installed on the suspension cylinder for measuring the stroke and supporting force of the suspension cylinder; the steering wheel angle sensor, the throttle opening degree sensor and the braking force sensor are used to measure a steering angle, a throttle opening degree and a braking strength; the electronic control unit respectively communicates with the inertial measurement unit, the laser radar, the dual antenna GPS positioning system, the steering wheel angle sensor, the throttle opening degree sensor, the braking force sensor, and the servo controller group, and the servo controller group communicates with the displacement sensor and supporting force sensor of the suspension cylinder.

12. A control system applying the inertial regulation method of active suspensions based on terrain ahead of a vehicle according to claim 5, wherein the system comprises a vehicle body and m wheels, a laser radar, an inertial measurement unit, a dual antenna GPS positioning system, the suspension cylinders corresponding to the wheels, displacement sensors, supporting force sensors and a servo controller group thereof, a vehicle speed sensor, a steering wheel angle sensor, a throttle opening degree sensor, a braking force sensor, an electronic control unit, wherein the laser radar, the inertial measurement unit, the dual-antenna GPS positioning system, the electronic control unit and the servo controller group are fixed on the vehicle body, and the laser radar is installed on the front of the vehicle body for measuring the terrain ahead of the vehicle, and the two antennas of the dual antenna GPS positioning system are separated by a certain distance in space; the wheel is connected to the vehicle body through the suspension cylinder, and the displacement sensor and the supporting force sensor are installed on the suspension cylinder for measuring the stroke and supporting force of the suspension cylinder; the steering wheel angle sensor, the throttle opening degree sensor and the braking force sensor are used to measure a steering angle, a throttle opening degree and a braking strength; the electronic control unit respectively communicates with the inertial measurement unit, the laser radar, the dual antenna GPS positioning system, the steering wheel angle sensor, the throttle opening degree sensor, the braking force sensor, and the servo controller group, and the servo controller group communicates with the displacement sensor and supporting force sensor of the suspension cylinder.

13. A control system applying the inertial regulation method of active suspensions based on terrain ahead of a vehicle according to claim 6, wherein the system comprises a vehicle body and m wheels, a laser radar, an inertial measurement unit, a dual antenna GPS positioning system, the suspension cylinders corresponding to the wheels, displacement sensors, supporting force sensors and a servo controller group thereof, a vehicle speed sensor, a steering wheel angle sensor, a throttle opening degree sensor, a braking force sensor, an electronic control unit, wherein the laser radar, the inertial measurement unit, the dual-antenna GPS positioning system, the electronic control unit and the servo controller group are fixed on the vehicle body, and the laser radar is installed on the front of the vehicle body for measuring the terrain ahead of the vehicle, and the two antennas of the dual antenna GPS positioning system are separated by a certain distance in space; the wheel is connected to the vehicle body through the suspension cylinder, and the displacement sensor and the supporting force sensor are installed on the suspension cylinder for measuring the stroke and supporting force of the suspension cylinder; the steering wheel angle sensor, the throttle opening degree sensor and the braking force sensor are used to measure a steering angle, a throttle opening degree and a braking strength; the electronic control unit respectively communicates with the inertial measurement unit, the laser radar, the dual antenna GPS positioning system, the steering wheel angle sensor, the throttle opening degree sensor, the braking force sensor, and the servo controller group, and the servo controller group communicates with the displacement sensor and supporting force sensor of the suspension cylinder.

14. A control system applying the inertial regulation method of active suspensions based on terrain ahead of a vehicle according to claim 7, wherein the system comprises a vehicle body and m wheels, a laser radar, an inertial measurement unit, a dual antenna GPS positioning system, the suspension cylinders corresponding to the wheels, displacement sensors, supporting force sensors and a servo controller group thereof, a vehicle speed sensor, a steering wheel angle sensor, a throttle opening degree sensor, a braking force sensor, an electronic control unit, wherein the laser radar, the inertial measurement unit, the dual-antenna GPS positioning system, the electronic control unit and the servo controller group are fixed on the vehicle body, and the laser radar is installed on the front of the vehicle body for measuring the terrain ahead of the vehicle, and the two antennas of the dual antenna GPS positioning system are separated by a certain distance in space; the wheel is connected to the vehicle body through the suspension cylinder, and the displacement sensor and the supporting force sensor are installed on the suspension cylinder for measuring the stroke and supporting force of the suspension cylinder; the steering wheel angle sensor, the throttle opening degree sensor and the braking force sensor are used to measure a steering angle, a throttle opening degree and a braking strength; the electronic control unit respectively communicates with the inertial measurement unit, the laser radar, the dual antenna GPS positioning system, the steering wheel angle sensor, the throttle opening degree sensor, the braking force sensor, and the servo controller group, and the servo controller group communicates with the displacement sensor and supporting force sensor of the suspension cylinder.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0073] FIG. 1 shows a structural schematic diagram of an inertial regulation system of active suspensions based on terrain ahead of a vehicle;

[0074] FIG. 2 is a dynamics model of a multi-axle active suspension vehicle driving on an uneven slope;

[0075] FIG. 3 is a schematic diagram of impedance control based on force-displacement for a suspension;

[0076] FIG. 4 shows a structural schematic diagram of an inertial regulation system of active suspensions of a three-axle vehicle based on terrain ahead of a vehicle; and

[0077] FIG. 5 is a dynamics model of a three-axle active suspension vehicle driving on an uneven slope.

DESCRIPTION OF THE EMBODIMENTS

[0078] In the following, the present invention is a further described in detail in combination with embodiments: [0079] 1. An inertial regulation system of active suspensions based on terrain ahead of a vehicle

[0080] As shown in FIG. 1, the system comprises terrain 1 ahead of the vehicle, a vehicle body 2 and m wheels 3-1, 3-2, . . . , 3-m, a laser radar 4, an inertial measurement unit 5, a dual antenna GPS positioning system 6-1, 6-2, a vehicle speed sensor 7, a gear position sensor 8, a steering wheel angle sensor 9, a throttle opening degree sensor 10, and a braking force sensor 11, and suspension cylinders 12-1, 12-2, . . . , 12-m corresponding to the wheels and their displacement sensors 13-1, 13-2, . . . , 13-m and supporting force sensors 14-1, 14-2, . . . , 14-m, a servo controller group 15, and an electronic control unit 16, etc. Wherein, the laser radar 4, the inertial measurement unit 5, two antennas 6-1, 6-2 of the dual antenna GPS positioning system, the electronic control unit 16 and the servo controller group 15 are fixed on the vehicle body 2, and the laser radar 4 is installed on the front of the vehicle body 2 for measuring the terrain ahead of the vehicle. The two antennas 6-1, 6-2 of the dual antenna GPS positioning system are separated by a certain distance in space. The wheels 3-1, 3-2, . . . , 3-m is connected to a lower part of the vehicle body 2 through the suspension cylinders 12-1, 12-2, . . . , 12-m. The displacement sensors 13-1, 13-2, . . . , 13-m and the supporting force sensors 14-1, 14-2, . . . , 14-4 installed on the suspension cylinders 12-1, 12-2, . . . , 12-m are used to measure strokes and supporting forces of the suspension cylinders respectively. The electronic control unit 16 respectively communicates with the laser radar 4, the inertial measurement unit 5, the two antennas 6-1, 6-2 of the dual antenna GPS positioning system, the vehicle speed sensor 7, the gear position sensor 8, the steering wheel angle sensor 9, the throttle opening degree sensor 10 and the braking force sensor 11, and the servo controller group 15. The servo controller group 15 communicates with the displacement sensors 13-1, 13-2, . . . , 13-m and the supporting force sensors 14-1, 14-2, . . . , 14-m of the suspension cylinders.

[0081] The inertial regulation method of active suspensions based on the terrain ahead of the vehicle comprises the following steps.

[0082] S1: calculating trajectories of ground-contacted points of wheels and the elevation information of ground-contacted point of each wheel when the vehicle passes through the terrain ahead of the vehicle

[0083] Based on position coordinates of the vehicle in a geodetic coordinate system measured by the inertial measurement unit 5 and two antennas 6-1, 6-2 of the dual-antenna GPS positioning system, the terrain 1 ahead of the vehicle scanned by the laser radar 4 and steering angles θ.sub.1, θ.sub.2, . . . , θ.sub.m of all wheels measured by the steering wheel angle sensor, calculating, by vehicle kinematics, the trajectories T.sub.1, T.sub.2, . . . , T.sub.m of ground-contacted points of wheels 3-1, 3-2, . . . , 3-m when the vehicle is driving on the terrain 1 ahead of the vehicle, wherein m is the number of wheels. Further, calculating the elevation information of each planning data point on the trajectory of ground-contacted point of wheel by an interpolation algorithm.

[0084] S2: calculating a trajectory of center of mass and an attitude history when the vehicle passes through the terrain ahead of the vehicle with passive suspensions

[0085] S21: calculating a trajectory of center of mass and an attitude history when the vehicle passes through the terrain ahead of the vehicle with passive suspensions

[0086] According to a rolling friction coefficient determined by the ground geological conditions, the speed of vehicle measured by the vehicle speed sensor 7, the steering angle measured by the steering wheel angle sensor 9, the driving force of each wheel measured by the gear position sensor 8 and the throttle opening degree sensor 10, the braking force measured by the braking force sensor 11, calculating, from a passive suspension vehicle dynamics model, 6-dimensional coordinate history {X.sub.i Y.sub.i Z.sub.i α.sub.i β.sub.i γ.sub.i}.sup.T of the vehicle coordinate system and the center of mass trajectory and attitude history {X.sub.Wi Y.sub.Wi Z.sub.Wi α.sub.Wi β.sub.Wi γ.sub.Wi.sup.T} of the vehicle when the vehicle drives along the trajectory T.sub.1, T.sub.2, . . . , T.sub.m of ground-contacted points of wheels planned in step S1 with the passive suspensions, wherein, X.sub.Wi, Y.sub.W, Z.sub.Wi, α.sub.Wi, β.sub.Wi, γ.sub.Wi are the three-dimensional coordinates and three-dimensional attitude angle of the center of mass of the vehicle respectively and correspond to all scan cycle nodes t.sub.i=iΔT of the suspension control in a time order, wherein i=0, 1, 2, . . . , n, ΔT represents the scan cycle and n represents the number of planned data points.

[0087] In the dynamics model of passive suspension vehicle, the comprehensive stiffness coefficient and comprehensive damping coefficient of each passive suspension branch chain formed by connecting the spring and damping of the suspension and the spring and damping of the tire in series can be calculated as follows:

[00006] K Zi P = K Si K Wi K Si + K Wi , C Zi P = C Si C Wi C Si + C Wi i = 0 , 1 , 2 , .Math. , n

[0088] S22: smoothing the center of mass trajectory and attitude history of the vehicle in step S21

[0089] Taking the smoothness coefficient as ζ smoothing the center of mass trajectory and attitude history of the passive suspension vehicle driving on the terrain ahead of the vehicle in step S21. In order to improve the processing speed, this kind of smoothing is not for the 6 degrees of freedom space curved surface, but for the 6 degrees of freedom space coordinates independently. There are many commonly used smoothing methods, but the smoothing method applicable to the present invention requires that the smoothed curve must pass a data start point, otherwise it would cause unnecessary vibration of the vehicle. The center of mass trajectory and attitude history after smoothing are {x.sub.W(t.sub.i), y.sub.W(t.sub.i), z.sub.W (t.sub.i), α.sub.W(t.sub.i), β.sub.W(t.sub.i), γ.sub.W(t.sub.i)}.sup.T, i=0, 1, 2, . . . , n, wherein the components are independent of each other and are functions of time.

[0090] S3: based on the smooth-processed trajectory of the center of mass and attitude history, calculating the suspension stroke history s.sub.ij and suspension supporting force history W when the vehicle passes through the terrain ahead of the vehicle with the active suspensions.

[0091] S31: taking the smooth-processed center of mass trajectory and attitude history of the vehicle in step S22 as inputs to calculate the stroke history s.sub.i,j.sup.R and speed history s.sub.i,j.sup.R of each suspension relative to the passive suspension when the vehicle passes through the terrain ahead of the vehicle with the active suspensions, wherein j=1, 2, . . . , m, and m is the number of wheels.

[0092] S32: under the conditions of the same speed of vehicle, steering angle, driving/braking force of each wheel and rolling friction coefficient of the wheel on the ground as in step S21, according to the stroke history s.sub.i,j.sup.R and speed history {dot over (s)}.sub.i,j.sup.R of active suspension relative to passive suspension obtained in step S31, calculating, from an active suspension dynamics model, a stroke history s.sub.ij and a supporting force history W.sub.ij of each suspension relative to the median position when the vehicle passes through the terrain ahead of the vehicle, wherein i=0, 1, 2, . . . , n, j=1, 2, . . . , m.

[0093] Since the actuator of active suspension adopts displacement control, the influence of suspension spring and suspension damping in parallel with the actuator can be ignored in the dynamics calculation of active suspension, and the comprehensive stiffness coefficient and comprehensive damping coefficient of each active suspension branch chain are respectively K.sub.Zi.sup.A=K.sub.Wi, C.sub.Zi.sup.A=C.sub.Wi.

[0094] S4: performing impedance control on the active suspension vehicle based on the force-displacement

[0095] As shown in FIG. 3, s.sub.ij is the active suspension stroke calculated based on step S31, and W.sub.ij is the supporting force of each suspension calculated based on step S32. Correspondingly, s.sub.i,j.sup.c is the actual stroke of each suspension measured through the displacement sensors 13-1, 13-2, . . . , 13-m, W.sub.i,j.sup.c is the actual supporting force of each suspension measured through the supporting force sensors 14-1, 14-2, . . . , 14-m. By comparing the theoretical value W.sub.ij and measured value W.sub.i,j.sup.c of the supporting force of each suspension, the stroke increment δ.sub.i,j of each suspension of the vehicle can be obtained based on the impedance model, so as to obtain the theoretical stroke s.sub.i,j.sup.d=s.sub.i,j+δ.sub.i,j of each suspension after correction, and then compare it with the measured stroke s.sub.i,j.sup.c of each suspension, and finally implement the displacement control of the suspension according to the difference value.

[0096] In the following, taking a three-axle vehicle as an example, and illustrative embodiments, features and methods of the present invention are described in detail with reference to FIG. 4. Other vehicles with three or more wheels can be constructed in the same way as in this example.

[0097] 1. A hardware structure of the system

[0098] The inertial regulation system of the active suspension of a three-axle vehicle based on the terrain ahead of the vehicle is as shown in FIG. 4. The system comprises terrain 1 ahead of the vehicle, a vehicle body 2 and 6 wheels 3-1, 3-2, . . . , 3-6, a laser radar 4, an inertial measurement unit 5, the two antennas 6-1, 6-2 of a dual antenna GPS positioning system, a vehicle speed sensor 7, a gear position sensor 8, a steering wheel angle sensor 9, a throttle opening degree sensor 10, and a braking force sensor 11, and suspension cylinders 12-1, 12-2, . . . , 12-6 corresponding to the wheels 3-1, 3-2, . . . , 3-6 and their displacement sensors 13-1, 13-2, . . . , 13-6 and supporting force sensors 14-1, 14-2, . . . , 14-6, a servo controller group 15, and an electronic control unit 16, etc. Wherein, the laser radar 4, the inertial measurement unit 5, two antennas 6-1, 6-2 of the dual antenna GPS positioning system, the electronic control unit 16 and the servo controller group 15 are fixed on the vehicle body 2, and the laser radar 4 is installed on the front of the vehicle body 2 for measuring the terrain ahead of the vehicle. The two antennas 6-1, 6-2 of the dual antenna GPS positioning system are separated by a certain distance in space. The wheels 3-1, 3-2, . . . , 3-6 is connected to a lower part of the vehicle body 2 through the suspension cylinders 12-1, 12-2, . . . , 12-6. The displacement sensors 13-1, 13-2, . . . , 13-6 and the supporting force sensors 14-1, 14-2, . . . , 14-6 installed on the suspension cylinders 12-1, 12-2, . . . , 12-6 are used to measure strokes and supporting forces of the suspension cylinders respectively. The electronic control unit 16 respectively communicates with the laser radar 4, the inertial measurement unit 5, the two antennas 6-1, 6-2 of the dual antenna GPS positioning system, the vehicle speed sensor 7, the gear position sensor 8, the steering wheel angle sensor 9, the throttle opening degree sensor 10, the braking force sensor 11, and the servo controller group 15. The servo controller group 15 communicates with the displacement sensors 13-1, 13-2, . . . , 13-6 and the supporting force sensors 14-1, 14-2, . . . , 14-6 of the suspension cylinders.

[0099] 2. A dynamics model of a three-axle vehicle and a solving example

[0100] (1) The dynamics model of three-axle active suspension vehicle driving on an uneven slope

[0101] As shown in FIG. 5, establishing a fixed coordinate system OXYZ, which is fixedly connected with the ground, wherein the coordinate system takes a reference point O of the inertial measurement unit as the origin of coordinates, the right of the vehicle as a positive direction of X axis, the front of the vehicle as a positive direction of Y axis, and the upward direction perpendicular to the XOY plane as a positive direction of Z axis; in order to determine the position of the vehicle in the fixed coordinate system, introducing a vehicle coordinate system oxyz, which is fixedly connected with a vehicle body. The vehicle coordinate system coincides with the fixed coordinate system at an initial position, and positioning coordinates in the fixed coordinate system are X, Y, Z, α, β, γ respectively.

[0102] In order to improve a calculation speed, regarding the vehicle as a rigid body, setting the weight thereof as M and the coordinate thereof in the vehicle coordinate system as W (x.sub.W, y.sub.W, z.sub.W). The three-axle vehicle has 6 wheels and has 6 corresponding suspensions. The active suspension is simplified to a parallel connection of an actuator, a spring and a damper. Setting the control method of active suspension as a displacement control; setting the stiffness coefficients of suspension springs respectively as K.sub.S1, K.sub.S2, . . . , K.sub.S6, and the damping coefficients of suspension dampers respectively as C.sub.S1, C.sub.S2, . . . , C.sub.S6. Simplifying a tire as a parallel connection of a vertical spring and a damper, and ignoring the influence of lateral and tangential elasticity and damping of the tire on vehicle dynamics characteristics. Setting the stiffness coefficients of vertical springs of all tires as K.sub.W1, K.sub.W2, . . . , K.sub.W6, and setting the damping coefficients of vertical dampers of all tires as C.sub.W1, C.sub.W2, . . . , C.sub.W6. Setting the above-mentioned dampers as viscous dampers; and setting the above-mentioned springs as nonlinear springs and approximating the springs by piecewise linear.

[0103] The above is the dynamics model of the active suspension vehicle, which has 6 degrees of freedom. If the actuator in each suspension is omitted, the above-mentioned dynamics model becomes the dynamics model of the passive suspension vehicle. At this time, the comprehensive stiffness coefficient and comprehensive damping coefficient of each passive suspension branch chain are as follows:

[00007] K Zi P = K Si K Wi K Si + K Wi , C Zi P = C Si C Wi C Si + C Wi

[0104] In this embodiment, when designing the stroke median position of the active suspension, it corresponds to a balance position of the passive suspension. In this way, when the active suspension is stationary in the median position, the theoretical supporting force of the actuator should be zero, which can minimize the energy consumption of the vehicle due to the use of the active suspension, and at the same time, it can produce small impact when the active/passive suspension is switched. Since the actuator of suspension adopts displacement control, in this embodiment, the functions of the suspension spring and damper in parallel with the actuator in the dynamics model of the active suspension vehicle are omitted, so the comprehensive stiffness coefficient and comprehensive damping coefficient of each active suspension branch chain are:


K.sub.Zi.sup.A=K.sub.Wi,C.sub.Zi.sup.A=C.sub.Wi

[0105] Because of the strong nonlinearity of the suspension branch chain spring, piecewise linear approximation is used in this embodiment, and because each branch chain may be in different linear segments, K.sub.Z1, . . . , K.sub.Z6 and C.sub.Z1, . . . , C.sub.Z6 respectively represents the vertical stiffness and damping of each branch chain. Using Δ.sub.1(t), Δ.sub.2(t), . . . , Δ.sub.6(t) and {dot over (Δ)}.sub.1(t), {dot over (Δ)}.sub.2(t), . . . , {dot over (Δ)}.sub.6(t) to respectively represent the vertical displacement and speed of ground-contacted points R.sub.1, R.sub.2, . . . , R.sub.6 of all wheels caused by road unevenness. When a wheel is off the ground, the elasticity and damping of its corresponding suspension branch chain should be set to zero.

[0106] Since α and β are tiny variables in each scanning cycle, then cos α≈1, cos β≈1; sin α≈α, sin β≈β. The coordinate calculation formula of the center of mass of the vehicle in the fixed coordinate system OXYZ is:

[00008] { X W = X + x W + z W β - y W γ Y W = Y + y W - z W α + x W y Z W = Z + z W + y W α - x W β

[0107] In the formula, x.sub.W, y.sub.W, z.sub.W is the coordinate of the center of mass of the vehicle in the vehicle coordinate system oxyz.

[0108] Based on the dynamics model and Lagrange equation, a motion differential equation of the active suspension vehicle is established, which is expressed by the matrix as follows:


[M.sub.6×6]{{umlaut over (q)}.sub.6}+[C.sub.6×6]{q.sub.6}+[K.sub.6×6]{q.sub.6}={F.sub.6}

[0109] In the formula, [M.sub.6×6], [C.sub.6×6] and [K.sub.6×6] are a weight matrix, a damping matrix and a stiffness matrix respectively, all of which are 6×6 symmetric square matrices; {F.sub.6} is a force matrix which is a 6×1 array; and {q.sub.6} is a column vector of the vehicle coordinate to be solved, and is a 6×1 array. Wherein,

[00009] [ M 6 × 6 ] = [ M 0 0 0 Mz W - My W 0 M 0 - Mz W 0 Mx W 0 0 M My W - Mx W 0 0 - Mz W My W J XX + M ( y W 2 + z W 2 ) - ( J XY + Mx W y W ) - ( J XZ + Mx W z W ) Mz W 0 - Mx W - ( J XY + Mx W y w ) J YY + M ( x W 2 + z W 2 ) - ( J YZ + My W z W ) - My W Mx W 0 - ( J XZ + Mx W z W ) - ( J YZ + My W z W ) J ZZ + M ( x W 2 + y W 2 ) ]

[0110] In the formula, J.sub.XX, J.sub.YY, J.sub.ZZ are the moments of inertia of the vehicle around the x, y and z axises;

[0111] J.sub.XY, J.sub.YZ, J.sub.XZ are the products of inertia of the vehicle around the x/y, y/z and x/z axises.

[00010] [ K 6 × 6 ] = [ 0 0 0 0 0 0 0 0 0 0 0 0 0 0 .Math. j = 1 6 K Zj .Math. j = 1 6 K Zj L j - .Math. j = 1 6 K Zj b j 0 0 0 .Math. j = 1 6 K Zj L j .Math. j = 1 6 K Zj L j 2 - .Math. j = 1 6 K Zj L j b j 0 0 0 - .Math. j = 1 6 K Zj b j - .Math. j = 1 6 K Zj L j b j .Math. j = 1 6 K Zj b j 2 0 0 0 0 0 0 0 ]

[0112] In the formula, K.sub.zj is a vertical comprehensive stiffness coefficient of a j-th suspension branch chain;

[0113] b.sub.j is x coordinate of the supporting point Q.sub.j on the suspension numbered j in the oxyz coordinate system;

[0114] L.sub.j is y coordinate of the supporting point Q.sub.j on the suspension numbered j in the oxyz coordinate system.

[00011] [ C 6 × 6 ] = [ 0 0 0 0 0 0 0 0 0 0 0 0 0 0 .Math. j = 1 6 C Zj .Math. j = 1 6 C Zj L j - .Math. j = 1 6 C Zj b j 0 0 0 .Math. j = 1 6 C Zj L j .Math. j = 1 6 C Zj L j 2 - .Math. j = 1 6 C Zj L j b j 0 0 0 - .Math. j = 1 6 C Zj b j - .Math. j = 1 6 C Zj L j b j .Math. j = 1 6 C Zj b j 2 0 0 0 0 0 0 0 ]

[0115] In the formula, C.sub.Zj is a vertical comprehensive damping coefficient of a j-th suspension.

[00012] { F 6 } = { .Math. j = 1 6 ( P j - F j ) sin θ j + Mg sin λcosϕ .Math. j = 1 6 ( P j - F j ) cos θ j + Mg sin λsinϕ .Math. j = 1 6 K Zj ( s 0 + s j R + Δ j ) + .Math. j = 1 6 C Zj ( s . j R + Δ . j ) - Mg cos λ .Math. j = 1 6 r ( P j - F j ) cos θ j + .Math. j = 1 6 [ K Zj ( s 0 + s j R + Δ j ) L j ] + .Math. j = 1 6 [ C Zj ( s . j R + Δ . j ) L j ] - Mg ( z M sin λsinϕ + y M cos λ ) - .Math. j = 1 6 r ( P j - F j ) sin θ j - .Math. j = 1 6 [ K Zj ( s 0 + s j R + Δ j ) b j ] - .Math. j = 1 6 C Zj ( s . j R + Δ . j ) b j + Mg ( z M sin λcosϕ + x M cos λ ) .Math. j = 1 6 ( P j - F j ) ( b j cos θ j - L j sin θ j ) - Mg ( y M sin λcosϕ - x M sin λsinϕ }

[0116] In the formula, r is a free radius of wheel;

[0117] λ is a slope angle of the terrain ahead of the vehicle;

[0118] φ is an azimuth angle of the vehicle relative to the slope, that is, the included angle between the x axis of the vehicle coordinate system and the descending direction of the slope gradient;

[0119] s.sub.0 is a vertical displacement of the center of mass of the passive suspension vehicle from a free state to a gravity equilibrium state in the horizontal plane;

[0120] Δ.sub.j is a vertical displacement of the ground-contacted point of each wheel caused by road unevenness;

[0121] {dot over (Δ)}.sub.j is a vertical speed of the ground-contacted point of each wheel caused by road unevenness;

[0122] s.sub.j.sup.R is an output stroke of the active suspension relative to the passive suspension in a closed-loop control of actuator displacement, which is 0 in the passive suspension;

[0123] {dot over (s)}.sub.j.sup.R is an output speed of the active suspension relative to the passive suspension in a closed-loop control of actuator displacement, which is 0 in the passive suspensions;

[0124] P.sub.j is a driving force of the j-th wheel;

[0125] F.sub.j is a braking force of the j-th wheel;

[0126] θ.sub.j is a steering angle of the j-th wheel;

[0127] g is the acceleration of gravity.

[0128] (2) a dynamics solving method

[0129] Taking a displacement vector of the vehicle coordinate system in the OXYZ coordinate system as:


{q.sub.6}={X,Y,Z,α,β,γ}.sup.T

[0130] Constructing a dynamics matrix based on the above kinematic differential equation as follows:


{{umlaut over (q)}.sub.6}=[M.sub.6×6].sup.−1{F.sub.6}−[M.sub.6×6].sup.−1[C.sub.6×6]{{dot over (q)}.sub.6}−[M.sub.6×6].sup.−1[K.sub.6×6]{q.sub.6}

[0131] Setting a state variable as:

[00013] { q 12 ] = { { q 6 } { q . 6 } } = { x y z α β γ x . y . z . α . β . γ . } T

[0132] Substituting the state variable into the dynamics matrix to obtain a state equation as follows:

[00014] { q . 12 } = [ E ] { q 12 } + { F * } Wherein , [ E ] = [ [ 0 ] 6 × 6 [ I ] 6 × 6 - [ M 6 × 6 ] - 1 [ K 6 × 6 ] - [ M 6 × 6 ] - 1 [ C 6 × 6 ] ] { F * } = { { 0 } 6 [ M 6 × 6 ] - 1 { F 6 } }

[0133] The above state equation can be solved by a fourth order Runge-Kutta method to obtain the value of the state variable {q.sub.12}.

[0134] 3. The inertial regulation method of active suspensions of the three-axle vehicle based on the terrain ahead of the vehicle comprises the following steps.

[0135] S1: calculating trajectories of the ground-contacted points of wheels and the elevation information of each ground-contacted point

[0136] Based on the position coordinates {x, y, z, α, β, γ}.sup.T of the vehicle coordinate system oxyz measured by the inertial measurement unit 5 and the two antennas 6-1 and 6-2 of the dual-antenna GPS positioning system in the fixed coordinate system OXYZ, the three-dimensional grid terrain ahead of the vehicle in the fixed coordinate system OXYZ obtained by the scanning of the laser radar 4 and coordinate transformation, and the vehicle steering angle measured by the steering wheel angle sensor 9 and the steering angles θ.sub.1, θ.sub.2, . . . , θ.sub.6 of all wheels calculated according to the Ackermann steering principle, calculating, by the kinematics model, the trajectories of T.sub.1, T.sub.2, . . . , T.sub.6 of the ground-contacted points of all wheels 3-1, 3-2, . . . , 3-6 when the vehicle drives on the terrain ahead of the vehicle. Due to the uneven slope, all the 6 trajectories of wheels are curves in space. On this basis, the interpolation algorithm can be used to calculate elevation information of the ground-contacted points R.sub.1, R.sub.2, . . . , R.sub.6 of all wheels in each scanning cycle.

[0137] S2: calculating a trajectory of center of mass and an attitude history when the vehicle passes through the terrain ahead of the vehicle with passive suspensions

[0138] S21: taking the ground rolling friction coefficient f of the wheel determined by the geological conditions of the ground, the vehicle speed v measured by the vehicle speed sensor 7, steering angle θ measured by the steering wheel angle sensor 9 and the steering angles θ.sub.1, θ.sub.2, . . . , θ.sub.6 of all wheels calculated according to the Ackermann principle, the driving forces of all wheels P.sub.1, P.sub.2, . . . , P.sub.6 measured by the gear position sensor 8 and the throttle opening degree sensor 10, the resultant force of the braking force and the rolling friction forces F.sub.1, F.sub.2, . . . , F.sub.6 of all wheels measured by the braking force sensor 11 as inputs, calculating, from the dynamics model of the passive suspension vehicle, the discrete points {q.sub.12}.sub.i={X.sub.i Y.sub.i Z.sub.i α.sub.i β.sub.i γ.sub.i {dot over (X)}.sub.i {dot over (Y)}.sub.i Ż.sub.i {dot over (α)}.sub.i {dot over (β)}.sub.i {dot over (γ)}.sub.i}.sup.T of the trajectories when the vehicle drives along the trajectories T.sub.1, T.sub.2, . . . , T.sub.6 of the ground-contacted points of the wheels in S1, wherein i=0, 1, 2, . . . , n, and n is the number of planned data points. Based on {q.sub.12}.sub.i, calculating three coordinates related to the suspension characteristics in the trajectory history of the center of mass of the vehicle as follows:

[00015] { Z Wi = Z + z W + y W α i - x W β i α Wi = α i β Wi = β i , i = 0 , 1 , 2 , .Math. , n

[0139] S22: smoothing the driving trajectory of the vehicle

[0140] Performing smoothing crossing the start point on the three variables of z.sub.Wi, α.sub.Wi, β.sub.Wi in the trajectory of center of mass and the attitude history of the passive suspension vehicle. The smoothing method in this embodiment uses least square polynomial fitting. Taking the smoothing method of z.sub.Wi as an example, the specific algorithm is as follows.

[0141] For a given data point (t.sub.i, z.sub.Wi), t.sub.i=i×ΔT, i=0, 1, 2, . . . , n, and ΔT is a scanning cycle of the suspension control. A ζ-order polynomial can be used for fitting, in which ζ is the order of the polynomial and can be gradually increased from small to large, and the initial value can be taken as 1.

[00016] z W ( t i ) = .Math. k = 0 ξ a k t i k

[0142] In the formula, k is the power of polynomial;

[0143] α.sub.k is the polynomial coefficient;

[0144] ζ is the order of polynomial.

[0145] This function reflects a change trend of the corresponding data, and it is expected that the sum of the squares of residuals at all data points is minimum. That is,

[00017] K 0 [ z w ( t 0 ) - z w 0 ] 2 + .Math. i = 1 n [ z W ( t i ) - z wi ] 2 = min

[0146] In order to make the polynomial function after fitting pass the start point, in the above formula, [z.sub.w(t.sub.0)−z.sub.w0].sup.2 of is separately listed from the summing formula and multiplied by a larger coefficient K.sub.0 to increase the weight of the start point of data. In practical application, a large enough K.sub.0 can be taken according to the number of planning data points to make the polynomial function after fitting as close as possible to the start point, so as to meet the accuracy requirements expected by the designer.

[0147] Solving the partial derivative of the above formula with respect to a.sub.0, . . . , a.sub.k, so that a ζ order equation set with respect to a.sub.0, . . . , a.sub.k can be obtained, and the values of a.sub.0, . . . , a.sub.k can be calculated through the Cramer rule.

[0148] S3: based on the smooth-processed trajectory of the center of mass and attitude history, calculating the suspension stroke history s.sub.ij and suspension supporting force history W.sub.ij when the vehicle passes through the terrain ahead of the vehicle with the active suspensions.

[0149] S31: taking the smooth-processed center of mass trajectory and attitude history of the vehicle in step S22 as inputs to calculate the stroke history s.sub.i,j.sup.R and speed history {dot over (s)}.sub.i,j.sup.R of each suspension relative to the passive suspension when the vehicle passes through the terrain ahead of the vehicle with the active suspensions, wherein the specific steps are as follows.

[0150] (1) based on the 6-dimensional coordinate history {X.sub.i, Y.sub.i, Z.sub.i, α.sub.i, β.sub.i, γ.sub.i}.sup.T of the vehicle coordinate system when the vehicle passes through the terrain ahead of the vehicle with the passive suspensions obtained in S21, solving a vertical displacement history of supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.6 on all suspensions by the following formula:


w.sub.i,j.sup.P=Z.sub.i−b.sub.jβ.sub.i+L.sub.jα.sub.i,i=0,1,2, . . . ,n;j=1,2, . . . ,6

[0151] then a vertical speed history of the supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.6 on all suspensions is:


{dot over (w)}.sub.i,j.sup.P.sub.i−b.sub.j{dot over (β)}.sub.i+L.sub.j{dot over (α)}.sub.i,i=0,1,2, . . . ,n;j=1,2, . . . ,6

[0152] (2) according to the function {X.sub.W(t.sub.i), Y.sub.W(t.sub.i), Z.sub.W (t.sub.i), α.sub.W(t.sub.i), β.sub.W(t.sub.i), γ.sub.W(t.sub.i)}.sup.T of the center of mass trajectory and attitude history after smoothing in S22, inversely calculating the three relative coordinate time histories of the vehicle coordinate system relative to the fixed coordinate system as follows:

[00018] { Z Wi = Z + z W + y W α i - x W β i α Wi = α i β Wi = β i , i = 0 , 1 , 2 , .Math. , n

[0153] then solving a vertical displacement of the supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.6 of all suspensions from z(t.sub.i), α(t.sub.i), β(t.sub.i) as follows:


w.sub.i,j.sup.A=Z.sub.j(t.sub.i)−b.sub.jβ(t.sub.i)+L.sub.jα(t.sub.i),i=0,1,2, . . . ,n;j=1,2, . . . ,m

[0154] A vertical speed of the supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.6 on all suspensions is:


{dot over (w)}.sub.i,j.sup.A.sub.j(t.sub.i)−b.sub.j{dot over (β)}(t.sub.i)+L.sub.j{dot over (α)}(t.sub.i),i=0,1,2, . . . ,n;j=1,2, . . . ,m

[0155] (3) calculating the stroke history s.sub.i,j.sup.R and speed history {dot over (s)}.sub.i,j.sup.R of each active suspension relative to the passive suspension

[0156] the stroke history of each active suspension relative to the passive suspension is equal to the difference between the vertical displacement w.sub.i,j history w.sub.i,j of the supporting points on each active suspension after the smoothing process and the vertical displacement history w.sub.i,j.sup.P of the supporting points on the passive suspension before the smoothing process:


s.sub.i,j=w.sub.i,j−w.sub.i,j.sup.P,i=0,1,2, . . . ,n;j=1,2, . . . ,6

[0157] the speed history of each active suspension relative to the passive suspension is equal to the difference between the vertical speed history {dot over (w)}.sub.i,j of the supporting points on each active suspension after the smoothing process and {dot over (w)}.sub.i,j.sup.P the vertical speed history {dot over (w)}.sub.i,j.sup.P of the supporting points on the passive suspension before the smoothing process:


{dot over (s)}.sub.i,j={dot over (w)}.sub.i,j−{dot over (w)}.sub.i,j.sup.P,i=0,1,2, . . . ,n;j=1,2, . . . ,6.

[0158] S32: the specific steps of calculating, from a dynamics model of the vehicle, a stroke history s.sub.i,j and a supporting force history W.sub.i,j of each suspension of the vehicle when the vehicle passes through the terrain ahead of the vehicle with the active suspensions are as follows:

[0159] (1) solving the vertical displacement history w.sub.i,j′ and vertical speed history {dot over (w)}.sub.i,j′ of the supporting points on each active suspension,

[0160] wherein according to stroke difference history s.sub.i,j.sup.R and speed difference history {dot over (s)}.sub.i,j.sup.R of the active/passive suspension, solving, from the dynamics model of the vehicle, a new state variable {q.sub.12′}.sub.i when the vehicle passes through the terrain ahead of the vehicle, where i=0, 1, 2, . . . , n. Substituting the displacement variables z.sub.i′, α.sub.i′, β.sub.i′, into the following formula to calculate the vertical displacement history of the supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.6 on all suspensions as follows:


w.sub.i,j′=z.sub.i′−b.sub.jβ.sub.i′+L.sub.jα.sub.i′,i=0,1,2, . . . ,n;j=1,2, . . . ,6

[0161] Substituting the values of speed variables ż.sub.i′, {dot over (α)}.sub.i′, {dot over (β)}.sub.i′ into the following formula to calculate the vertical speed history of the supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.6 on all suspensions as follows:


{dot over (w)}.sub.i,j′=ż.sub.i′−b.sub.j{dot over (β)}.sub.i+L.sub.j{dot over (α)}.sub.i′,i=0,1,2, . . . ,n;j=1,2, . . . ,6

[0162] (2) solving the stroke history s.sub.i,j of each active suspension relative to the median position,

[0163] wherein because the vertical deformation of the tire is far less than the stroke of the active suspension, the vertical deformation of the tire is omitted; the vertical deformation of the tire is compensated in a suspension impedance control in S4. The stroke history of each active suspension relative to the median position is equal to the difference between the vertical displacement history w.sub.i,j′ of the supporting points Q.sub.1, Q.sub.2, . . . , Q.sub.6 on all suspensions and the vertical displacement history Δ.sub.i,j of ground-contacted points of all wheels R.sub.1, R.sub.2, . . . , R.sub.6.


s.sub.i,j=w.sub.i,j−w.sub.i,j.sup.P,i=0,1,2, . . . ,n;j=1,2, . . . ,6

[0164] (3) calculating the supporting force history W.sub.ij of each active suspension

[0165] the supporting force history of each active suspension of the vehicle is as follows:


W.sub.i,j=K.sub.jz(w.sub.i,j′−s.sub.0−s.sub.i,j.sup.R−Δ.sub.i,j)+C.sub.jz({dot over (w)}.sub.i,j′−{dot over (s)}.sub.i,j.sup.R−{dot over (Δ)}.sub.i,j),i=0,1,2, . . . ,n;j=1,2, . . . ,6

[0166] In the formula, Δ.sub.i,j and {dot over (Δ)}.sub.i,j are respectively the vertical displacement history and speed history of the ground-contacted points R.sub.1, R.sub.2, . . . , R.sub.6 of all wheels.

[0167] S4: the specific realization method of performing an impedance control based on force-displacement on a suspension actuator is as follows:

[0168] {circle around (1)}solving the displacement control quantity of suspension impedance control

[0169] Setting the measured value of the current supporting forces of suspensions as W.sub.i,j.sup.c, which can be measured by the supporting force sensors 13-1, 13-2, . . . , 13-6 installed on the suspension cylinder. According to a simplified model of the contact force between the wheel and the ground, the expected stroke increment δ.sub.i,j of the suspension can be obtained as:

[00019] δ i , j = Δ W i , j K = i = 0 , 1 , 2 , .Math. , n ; j = 1 , 2 , .Math. , 6

[0170] In the formula, ΔW.sub.i,j=W.sub.i,j−W.sub.i,j.sup.c; K is the contact stiffness between the wheel and the ground.

[0171] Then the target displacement of each active suspension is:


s.sub.i,j.sup.d=s.sub.i,j+δ.sub.i,ji=0,1,2, . . . ,n;j=1,2, . . . ,6

[0172] {circle around (2)} verifying whether the strokes s.sub.i,j.sup.d of all suspensions in the whole history exceeds the limit of stroke

[0173] The verification formula is:


S.sub.min≤S.sub.i,j.sup.d≤S.sub.max,i=0,1,2, . . . ,n;j=1,2, . . . ,6

[0174] in the formula, s.sub.min is a lower limit displacement of the suspension;

[0175] S.sub.max is an upper limit displacement of the suspension.

[0176] If there is a suspension which exceeds the limit stroke, the smoothness of a vehicle trajectory curve is reduced first, and the corresponding smoothness coefficient ζ is adjusted, it is handled according to the following two cases respectively:

[0177] (1) if the smoothness coefficient ζ has not reached a preset smoothness coefficient limit value, then proceeding to step S22.

[0178] (2) if the smoothness coefficient ζ has reached the limit value and it still cannot meet the condition that each suspension stroke in the whole history does not exceed the limit stroke, finding a first data point with the suspension stroke exceeding the limit stroke according to the time sequence of occurrence, and setting the number of planned data point in step S2 as i.sub.E(1≤i.sub.E≤n), then letting n=i.sub.E and returning to step S21.

[0179] Each suspension stroke in the whole history is made no more than the limit stroke through the above processing.

[0180] S4: performing PID displacement control on the active suspension

[0181] Setting the measured value of the suspension relative to the median position stroke as s.sub.i,j.sup.c, which can be measured by the stroke sensors 12-1, 12-2, . . . , 12-6 installed on the suspension cylinder; and according to the target strokes s.sub.i,j.sup.d of all suspensions after the verification, comparing the target strokes with the measured suspension strokes s.sub.i,j.sup.c, and performing the PID control on the strokes of the active suspensions.

[0182] The above embodiments are only to describe the preferred implementations of the present invention, not to limit the scope of the present invention. On the premise of not deviating from the design spirit of the present invention, various kinds of deformations and improvements of the technical solution of the present invention made by an ordinary person skilled in the art shall fall into the protection scope determined by the claims of the present invention.