Active suspension vehicle and control method
20240208289 ยท 2024-06-27
Inventors
- Fan Zhang (Zibo, CN)
- Jiguo Yang (Zibo, CN)
- Xuejian JIAO (Zibo, CN)
- Lijun Li (Zibo, CN)
- Xianyue Gang (Zibo, CN)
Cpc classification
B60G17/016
PERFORMING OPERATIONS; TRANSPORTING
B60G2401/14
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
The present invention discloses an active suspension vehicle and a control method controlling the same. Each wheel of the vehicle is equipped with a telescopically adjustable active actuator. The control method begins by constructing a load and deformation joint control matrix of the vehicle and measuring the current vehicle parameters; then determining vertical displacement excitation of wheels at a next moment, and pre-calculating passive responses of vehicle height, attitude, and wheel loads at the said next moment; determining the vehicle height, attitude, and feasible wheel load expectations at the said next moment, and inverse-calculating adjustment strokes of the suspension; finally, performing active suspension adjustment to chase the vehicle height, attitude, and feasible wheel load expectations in real-time. The disclosure implements synchronous vehicle height, attitude, and wheel loads control for multi-axle vehicles, thus significantly improving their passability, maneuverability, and stability under extreme off-road terrains.
Claims
1. A control method for controlling an active suspension vehicle, the active suspension vehicle comprising: a vehicle body; a wheel carriage assembly, comprising two or more axles and a plurality of wheels associated therewith, with the wheel carriage assembly being connected to the vehicle body and operable to lift and rotate the axle relative to the vehicle body; an active suspension system, comprising a plurality of active actuator and shock absorber assemblies, with the active actuator and shock absorber assembly being connected to the vehicle body and the wheel carriage assembly through each end, and the active actuator being operable to extend and shorten along an axis of the active actuator and shock absorber assembly; a sensing system, comprising a front-road preview system, a body state measurement system, a vehicle speed measurement system, a driving measurement system, and a control system, with the sensing system and the active suspension system being connected to the control system as input end and output end, respectively; wherein the control method comprises the following steps: step 1, setting a Cartesian coordinate system defined with a center of mass of the vehicle body as an origin, an x-axis parallel to an axis of the vehicle body and pointing in a driving direction of the active suspension vehicle, a z-axis pointing vertically upward, and a y-axis pointing to a left side of a driver; each of the plurality of the active actuators being denoted with a corresponding subscript number with each of the plurality of the wheels; step 2, measuring a load and deformation joint control matrix of the active suspension vehicle and storing in the control system by the following steps: placing the active suspension vehicle on a horizontal road; driving an j-th active actuator of the active suspension system, j=1, 2, . . . n, to actively extend with other active actuators remaining inactive, measuring a displacement of the active actuator in real-time via a corresponding displacement sensor of the body state measurement system until a unit displacement being generated; measuring a load increment of each of the plurality of the wheels via a corresponding force sensor of the body state measurement system; storing the load increment of each of the plurality of the wheels in order from 1 to n in rows 1 to n of the j-th column of a matrix as ?f.sub.1j, ?f.sub.2j, . . . ?f.sub.nj; at the same time, measuring increments of a roll angle and a pitch angle of the vehicle body via an attitude sensor of the body state measurement system, and storing angle increments in rows n+1 to n+2 of the j-th column of the matrix as ??.sub.xj, ??.sub.yj; performing the measurements and the data storage until the load and deformation joint control matrix being constructed and stored in the control system as follows:
2. The control method controlling the active suspension vehicle of claim 1, wherein determining the vertical height excitation array comprises the following steps: step 1, retrieving vehicle attitude parameters from the body state measurement system, point cloud data of the actual road from the front-road preview system, and performing grid filtering of the point cloud data to obtain a filtered point cloud data of the actual road in front of the active suspension vehicle; step 2, retrieving driving and steering parameters from the vehicle speed measurement system and the driving measurement system, the vehicle attitude parameters from the body state measurement system, and conducting the path planning procedure to obtain a driving path and corresponding arrival time for each of the plurality of the wheels; step 3, retrieving the vertical height excitation data that each of the plurality of the wheels will be subjected to at the next moment of the present moment based on the filtered point cloud data and the driving path and corresponding arrival time; constituting the vertical height excitation array for the step 4 of claim 1 to use.
3. The active suspension vehicle controlled by the control method of claim 1, wherein: the sensing system comprises the front-road preview system, the body state measurement system, the vehicle speed measurement system, the driving measurement system, and the control system; the front-road preview system comprises at least a Lidar transmits the point cloud data of the actual road in front of the active suspension vehicle within a longitudinal distance from the wheels of a first axle to at least one times of vehicle length to the control system; the body state measurement system comprises at least one attitude sensor transmits the roll angle, the pitch angle, a yaw angle of the vehicle body and their corresponding angular velocities and angular accelerations to the control system, force sensors transmit a supporting load of each of the plurality of the active actuators to the control system, according to which the load of the corresponding wheel is calculated as a function of the supporting load, displacement sensors transmit a telescopic displacement of each of the plurality of the active actuators to the control system, according to which the vehicle height is calculated as a function of the telescopic displacement; the vehicle speed measurement system comprises wheel speed sensors installed on the wheels on at least both sides of the front and rear axles, and is matched with corresponding force sensors on each of the plurality of the active actuators; the system mentioned above transmits the calculated driving speed of the active suspension vehicle to the control system based on wheel speed of loaded wheels; the driving measurement system transmits driver's inputs at least from steering wheel, throttle, brake to the control system; the control system comprises a storage unit stores the load and deformation joint control matrix of the active suspension vehicle, and the expectations of vehicle height, vehicle attitude, and wheel load distribution for extreme off-road terrain.
Description
DESCRIPTION OF FIGURES
[0040]
[0041]
[0042]
EMBODIMENTS
[0043] In order to make the purpose, technical solutions, and advantages of the present disclosure more clear, the disclosure will be further described in detail with the attached drawings and embodiments. The following contents, in particular, take the active suspension system, sensing system, and control system of a three-axle independent active suspension vehicle shown in
[0044] As shown in
[0045] The body state measurement system 14a comprises attitude sensor 10 measuring the roll angle, the pitch angle, and the yaw angle of the body 3, and their corresponding angular velocities and angular accelerations; force sensors 11 measuring a supporting load (use two force sensors 11 measuring the pressure of each fluid line of each fluid sealing chamber 13b, and calculating the absolute value of the fluid line load difference based on the areas of the fluid sealing chamber 13b with and without the rod, and then calculating the current supporting load of the corresponding active actuator) of each of the plurality of the active actuators 13, according to which the wheel loads is defined as a function of the supporting load; a displacement sensor 12 measuring a telescopic displacement of each of the plurality of the active actuators 13, according to which the vehicle height is defined as a function of the telescopic displacement. A person skilled in the art should be aware that the force sensor 11, the displacement sensor 12, and attitude sensor 10 included in the body state measurement system 14a are limited to this embodiment configuration, there are various configurations and methods to obtain the body state parameters obtained by the body state measurement system 14a, and these different configurations and methods are also within the scope of the present disclosure.
[0046] The front-road preview system 14b comprises sensors measuring road features within a longitudinal distance from the wheels of a first axle to at least one time of vehicle length, and within a horizontal view range of at least 120? degrees along the longitudinal front of the vehicle. A person skilled in the art should be aware that the front-road preview system 14b can be combined in many different ways, for example, a laser radar can be used to scan the point cloud array of the front road, a machine vision method can be used to obtain the road features in front. These different methods and their combinations are also within the scope of the present disclosure.
[0047] The vehicle speed measurement system 14c comprises wheel speed sensors 17 installed on wheels on both sides of the front and rear axles, and is matched with corresponding force sensor 11 on each wheel; the system 14c determines whether a wheel is unloaded and sliding based on signals of the corresponding force sensors 11, then determines the driving speed of the vehicle based on wheel speed of loaded wheels. A person skilled in the art should be aware that the wheel speed sensor 17 currently of the vehicle speed measurement system 14c is only a minimum configuration, and with the increase in the number of axles more wheel speed sensors 17 can be used for accurately determining the driving speed of the vehicle.
[0048] The driving measurement system 14d comprises sensors measuring the driver's inputs from the steering wheel, throttle, brake, etc, and in combination with body state and motion parameters measured by the body state measurement system 14a and vehicle speed measurement system 14c, to determine future driving and steering parameters. A person skilled in the art should be aware that the driving measurement system 14d is used to obtain the vehicle state and motion parameters such as the wheel angle and steering wheel angle, and the way of obtaining each parameter is not limited by the present disclosure, for example, different ways of obtaining the wheel angle and the steering wheel angle such as using angle sensors for direct measurement or calculating by motion parameters are also within the scope of the present disclosure.
[0049] The control system 16 determines the relationship between the upcoming driving route and the driving time of each wheel by joint planning of the body state measurement system 14a, the front-road preview system 14b, the vehicle speed measurement system 14c, and the driving measurement system 14d. According to the joint planning of the control system, an upcoming vertical displacement excitation data of each wheel is defined as a data array of the road features and the driving time on the upcoming driving route.
[0050] The future expectations of vehicle height, attitude, and wheel load distribution of the active suspension vehicle is a predefined data array that adapts to the road features of the upcoming driving route, and is determined by the control system 16 based on the road features and driving time of the upcoming driving route, as well as the current vehicle height, attitude, and wheel loads of the body 3.
[0051] Based on the above hardware configuration of the active suspension vehicle, the control system 16 will invoke the control method to determine the telescopic adjustment stroke of the active actuator 13. The active telescopic adjustment of the active actuator 13 is implemented in driving so that when the vehicle driving on the upcoming driving route, the vehicle height and attitude chase vehicle height and attitude expectations in real-time, while at the same time, wheel load distribution of each wheel chases feasible wheel load expectations synchronously and in real-time.
[0052] In order to elaborate the control method, it is necessary to define the center of mass of the body 3 as the origin of the Cartesian coordinate system, the x-axis parallel to the ground and points in the driving direction of the vehicle, the z-axis points vertically upward, the y-axis points to the left side of the driver. The longitudinal and transverse coordinates of each wheel are in turn denoted as (x.sub.i, y.sub.i), i=1, 2, . . . n. The serial number of the wheel is in the same order as the serial number of the active actuator 13. The total weight of the body 3 is noted as G. The specific steps of the control method are as follows:
[0053] Step 101, constructing a load and deformation joint control matrix of the active suspension vehicle and storing in the control system 16 by the following steps: placing the active suspension vehicle on a horizontal road; driving an j-th active actuator 13 of the active suspension system 15, j=1, 2, . . . n, to actively extend with other active actuators 13 remaining inactive, measuring a displacement of the active actuator 13 in real-time via a corresponding displacement sensor 12 of the body state measurement system until a unit displacement being generated; measuring a load increment of each of the plurality of the wheels via a corresponding force sensor 11 of the body state measurement system; storing the load increment of each of the plurality of the wheels in order from 1 to n in rows 1 to n of the j-th column of a matrix as ?f.sub.1j, ?f.sub.2j, . . . ?f.sub.nj.
[0054] At the same time, measuring increments of a roll angle and a pitch angle of vehicle body via an attitude sensor of the body state measurement system, and storing angle increments in rows n+1 to n+2 of the j-th column of the matrix as ??.sub.xj, ??.sub.yj; performing the measurements and the data storage until the load and deformation joint control matrix being constructed and stored in the control system as follows:
[0055] Step 102, measuring the current wheel loads. Measuring the pressure of each fluid line of each fluid sealing chamber 13b using the force sensor 11, and calculating the absolute value of the fluid line load difference based on the areas of the fluid sealing chamber 13b with and without the rod; then calculating the current load of the corresponding wheel F.sub.i.sup.c
wherein, P.sub.1 is the fluid line pressure of the rod chamber, S.sub.1 is the area of the rod chamber, P.sub.2 is the fluid line pressure of the rodless chamber, and S.sub.2 is the area of the rodless chamber.
[0056] Step 103, measuring the roll angle ?.sub.x.sup.c and the pitch angle ?.sub.y.sup.c of the vehicle body 3 at the present moment in an actual road via the attitude sensor 10.
[0057] Step 104, using the front-road preview system 14b to measure the road features within a longitudinal distance from the wheels of a first axle to at least one times of vehicle length, and within a horizontal view range of at least 120? degrees along the longitudinal front of the vehicle.
[0058] Step 105, detecting the driver's inputs at least from the steering wheel, the throttle, the brake.
[0059] Step 106, obtaining the vehicle state and motion parameters based on the body state measurement system 14a, the vehicle speed measurement system 14c, and the driving measurement system 14d.
[0060] Step 107, planning the upcoming driving route based on the road features in front obtained in the step 104, the driver inputs detected in the step 105, and the vehicle state and motion parameters obtained in the step 106. Then defining the upcoming vertical displacement excitation of each wheel as a data array of the road features and the driving time on the upcoming driving route.
[0061] Step 108, determining the vehicle height and attitude expectations and solving the feasible wheel load expectations. The control system 16 predefines the vehicle height expectation and the vehicle attitude expectations of the active suspension vehicle based on the road features and the driving time on the upcoming driving route described in the step 107. Wherein, the vehicle height and attitude expectations can be set according to different practical requirements. At the same time, the control system 16 should also predefines wheel load distribution expectations F.sub.i.sup.s that are adapted to the road features on the upcoming driving route, and determines the feasible wheel load expectations by the following steps: [0062] firstly, initial wheel load expectations F.sub.i*.sup.1, i=1, 2, . . . n is solved by taking the minimum mean square deviation between the wheel loads F.sub.i and the wheel load distribution expectations F.sub.i.sup.s as the optimization objective, and mechanical equilibrium conditions as constraints, based on the following equation
wherein, F.sub.i.sup.s=F.sub.i* is the mandatory wheel load expectations set for certain focused wheels, and
is the uniformity wheel load expectations set for the other general wheels, wherein p is the number of wheels with mandatory wheel load distribution
and
are the vertical force equilibrium constraint for the vehicle, and the torque equilibrium constraints around the x-axis and around the y-axis, respectively.
[0063] The initial wheel load expectations F.sub.i*.sup.1 for each wheel can be obtained by solving the equation (5). However, since this method takes the minimum mean square deviation of all wheel loads as the optimization objective, the result of the solution may not be able to obtain the global optimal solution for some special wheel load distribution expectations, so it should be further optimized. Therefore, taking the initial wheel load expectations F.sub.i*.sup.1 as initial value of optimization, setting the effective optimization range of wheel loads which is 0?F.sub.i?F.sub.i*.sup.1 for certain focused wheels, and coefficients ? and ? (e.g. 0.5 and 1.5) are superimposed on the solution of Eq.(5) to form the space ?F.sub.i*.sup.1?F.sub.i??F.sub.i*.sup.1 for general wheels, still taking the mechanical equilibrium conditions as constraints, to invoke the optimization algorithm to solve for the feasible wheel load expectations F.sub.i*, i=1, 2, . . . n, for driving on the road features of the vertical height excitation array at the next moment.
[0064] Step 109, setting a unit time interval with the present moment as the time starting point, and picking up the vertical height excitation array [d.sub.1 . . . d.sub.i . . . d.sub.n].sup.T that each wheel will be subjected at a next moment of the present moment based on the upcoming vertical displacement excitation data array of each wheel described in the step 107; and calculating the average value
[0065] Wherein the unit time interval, the value of which is determined by the control system 16 according to the complexity of the road features on the upcoming driving route.
[0066] Step 110, constructing the pre-calculation equation for passive responses of vehicle attitude and wheel loads. Constructing the pre-calculation equation for passive responses of vehicle attitude and wheel loads without control based on the load and deformation joint control matrix obtained in the step 101, the wheel loads at the present moment obtained in the step 102, the roll angle and the pitch angle of the body 3 at the present moment obtained in the step 103, and the vertical height excitation array obtained in the step 108
wherein the control system selecting matrix elements under corresponding unit displacement excitation of the vertical height excitation array of wheels that will be subjected at a next moment of the present moment, and then performs the pre-calculation.
[0067] Step 111, solving ahead of time the passive responses of the vehicle height, attitude, and wheel loads. Solving the pre-calculation equation for passive responses of vehicle attitude and wheel loads constructed in the step 110 to obtain the vehicle height, attitude, and wheel loads when driving on the road with road features of the vertical height excitation array at the next moment. In equation (5), F.sub.i.sup.v, i=1, 2, . . . n is the pre-calculated load that each of the plurality of the wheels will bear when driving on the road with road features of the vertical height excitation array at the next moment. ?.sub.j.sup.v, j=x, y is the pre-calculated roll angle and pitch angle that the body 3 will generate when driving on the road with road features of the vertical height excitation array at the next moment. the average value
[0068] Step 112, constructing the inverse-calculation equation for active suspension adjustment. Constructing the inverse-calculation equation for active suspension adjustment based on the load and deformation joint control matrix obtained in the step 101, the passive responses of vehicle attitude and wheel loads at the next moment obtained in the step 111, and the vehicle attitude expectations and the feasible wheel load expectations at the next moment obtained in the step 111
wherein, ?.sub.j*, j=x, y, is the stated vehicle attitude expectations. Wherein the control system selecting matrix elements under corresponding unit displacement excitation of the vertical height excitation array of wheels that will be subjected at a next moment of the present moment, and then performs the inverse-calculation.
[0069] Step 113, solving the inverse-calculation equation for active suspension adjustment constructed in the step 112 to obtain the basic array of active suspension adjustment [a.sub.1 . . . a.sub.i . . . a.sub.n].sup.T, and calculating its average value ?.
[0070] Step 114, subtracting the average value a from the basic array of active suspension adjustment, and compensating the vehicle height expectation a.sub.h described in the step 111, to obtain the active suspension adjustment stroke, which satisfies
[0071] Solving equation (8) yields the modified array of active suspension adjustment [a.sub.1* . . . a.sub.i* . . . a.sub.n*].sup.T that synchronously achieves the vehicle height expectation, vehicle attitude expectations, and feasible wheel load expectations when the active suspension vehicle driving on the road with road features of the vertical height excitation array at the next moment.
[0072] Step 115, implementing active adjustment of the suspension. The control system 16 controls the active suspension vehicle to drive on the road with road features of the vertical height excitation array at the next moment, and in the meanwhile controls each of the plurality of the active actuators 13 to implement the active telescopic adjustment, thus synchronously completing the active adjustment of the modified array of active suspension adjustment at the next moment, and achieving a synchronous and active control of vehicle height, attitude, and wheel load distribution in a unit time interval.
[0073] Step 116, [0074] judging whether the vehicle passed the extreme off-road terrain by the subjective decision of the driver or the objective decision of the controller based on the road characteristics: if yes, end the active control; and If no, go back to step 3 and re-perform step 3 based on the constructed load and deformation joint control matrix, resolving the active suspension adjustment stroke and performing cyclic control until the vehicle passed the extreme off-road terrain.
[0075] More intuitively, the following is an example of the right front wheel of a three-axle vehicle steps onto the boss 4 to illustrate the specific implementation of the control method:
[0076] First, features of the boss 4 is scanned by the front-road preview system 14b as shown in
[0077] Then, it is assumed that the control system 16 plans the right front wheel to step on the boss 4 with empty load at the next moment, thus, the wheel load distribution expectation is maintaining the load balance of the other five wheels, and the vehicle height and attitude expectation is maintaining the vehicle height and attitude stable. Define the stable vehicle attitude as the attitude expectations, that is, ?.sub.j*=[0,0].sup.T. For the specific size and load characteristics, define the following wheel load distribution expectations according to step 108, that is F.sub.i*={0, 0.3G, 0.2G, 0.06G, 0.17G, 0.27G}.sup.T. By substituting the passive responses of vehicle attitude and wheel loads, the vehicle attitude and wheel load distribution expectations into the inverse-calculation equation for active suspension adjustment, the active adjustment stroke {a.sub.i} of each suspension for the targeted vehicle attitude and wheel load distribution expectation when the right front wheel of the vehicle steps onto the boss 4 can be calculated
[0078] Next, calculate the average value ? of the active adjustment amount {a.sub.i}. Since the stable vehicle height is defined as the vehicle height expectation, then a.sub.h=0. After correction, the modified array of active suspension adjustment [a.sub.1* . . . a.sub.i* . . . a.sub.n*].sup.T is obtained.
[0079] Finally, according to the modified array of active suspension adjustment, the control system 16 controls the active suspension vehicle to step onto the boss 4 at the next moment, and at the same time controls the active actuator 13 to implement active telescopic adjustment, thus synchronously completed the active adjustment of the modified array of active suspension adjustment at the next moment. As shown in
[0080] Finally, it should be noted that the above is only a preferred embodiment of the present disclosure and the technical principles applied. It will be understood by those persons skilled in the art that the disclosure is not limited to the particular embodiments described herein and that various variations, readjustments, and substitutions are apparent to those skilled in the art without departing from the scope of protection of the disclosure. Thus, although the disclosure has been described in some detail by the above embodiments, the disclosure is not limited to the above embodiments but may include many more equivalent embodiments without departing from the idea of the disclosure, the scope of which is determined by the scope of the appended claims.