Inertial regulation active suspension system based on vehicle posture deviation, and control method thereof
11326985 · 2022-05-10
Assignee
Inventors
- Dingxuan Zhao (Qinhuangdao, CN)
- Mingde Gong (Qinhuangdao, CN)
- Shuang Liu (Qinhuangdao, CN)
- Zhuxin Zhang (Qinhuangdao, CN)
- Zhiguo Sun (Qinhuangdao, CN)
- Bin Yang (Qinhuangdao, CN)
- Tao Ni (Qinhuangdao, CN)
- Qinghe Guo (Qinhuangdao, CN)
- Mengke Yang (Qinhuangdao, CN)
Cpc classification
B60G17/0161
PERFORMING OPERATIONS; TRANSPORTING
B60G2800/0194
PERFORMING OPERATIONS; TRANSPORTING
B60G17/0165
PERFORMING OPERATIONS; TRANSPORTING
B60G2204/62
PERFORMING OPERATIONS; TRANSPORTING
B60G17/00
PERFORMING OPERATIONS; TRANSPORTING
B60G17/0195
PERFORMING OPERATIONS; TRANSPORTING
B60G17/0152
PERFORMING OPERATIONS; TRANSPORTING
B60G17/0162
PERFORMING OPERATIONS; TRANSPORTING
B60G17/018
PERFORMING OPERATIONS; TRANSPORTING
B60G2800/0192
PERFORMING OPERATIONS; TRANSPORTING
B60G21/08
PERFORMING OPERATIONS; TRANSPORTING
B60G17/015
PERFORMING OPERATIONS; TRANSPORTING
International classification
B60G17/015
PERFORMING OPERATIONS; TRANSPORTING
B60G17/016
PERFORMING OPERATIONS; TRANSPORTING
B60G17/018
PERFORMING OPERATIONS; TRANSPORTING
Abstract
An inertial regulation active suspension system based on posture deviation of a vehicle and a control method thereof are provided. The system comprises a vehicle body, an inertial measurement unit, an electronic control unit, a servo controller group, a plurality of wheels, suspension servo actuating cylinders respectively corresponding to the wheels, and displacement sensors for measuring a stroke of the suspension servo actuating cylinders. The electronic control unit reads posture parameters of the vehicle body measured by the inertial measurement unit, and calculates a deviation between the postures of the vehicle body at a current moment and at a previous moment, and then outputs posture control parameters to the servo controller group. The servo controller group controls extension and retraction of each of the suspension servo actuating cylinders according to the posture control parameters and displacement feedback values of the displacement sensors.
Claims
1. An inertial regulation active suspension system based on posture deviation of a vehicle, comprising a vehicle body and a plurality of wheels, an inertial measurement unit, an electronic control unit, a servo controller group, suspension servo actuating cylinders corresponding to the wheels one by one, and displacement sensors, wherein the inertial measurement unit, the electronic control unit and the servo controller group are secured to the vehicle body; the wheels are connected to a lower part of the vehicle body through the suspension servo actuating cylinders; the displacement sensors are used for measuring strokes of the suspension servo actuating cylinders; the electronic control unit is communicated with the inertial measurement unit and the servo controller group, respectively; the servo controller group is communicated with the displacement sensors; the electronic control unit reads vehicle posture parameters measured by the inertial measurement unit, and calculates a posture deviation of the vehicle at a current moment from at a previous moment, and then outputs the posture control parameters to the servo controller group; and the servo controller group controls each of the suspension servo actuating cylinders according to the position and posture control parameters output by the electronic control unit and displacement feedback values of the displacement sensors, so that a centroid of the vehicle moves approximately along a straight line or an arc line to permit a posture of the vehicle body to remain unchanged; all of the wheels are divided into three wheel groups, each of the three wheel groups is provided with one or more wheels; the number of the wheels in at least one of the three wheel groups is more than one, upper chambers of the suspension servo actuating cylinders in the wheel group are communicated with one another and lower chambers of the suspension servo actuating cylinders in the wheel group are communicated with one another, so that the wheel group constitutes a supporting point for supporting the vehicle body, and the three wheel groups constitute three supporting points of the vehicle body; the posture of the vehicle body is controlled by controlling supporting heights of the three supporting points.
2. A control method of the inertial regulation active suspension system based on the posture deviation of the vehicle according to claim 1, wherein a coordinate system OXYZ in which a center point O of the inertial measurement unit is taken as a coordinate origin is established, a right forward direction in which the vehicle travels is defined as a Y-axis positive direction, a right side direction in which the vehicle travels is defined as a X-axis positive direction, and an upward direction perpendicular to a XOY plane is defined as a Z-axis positive direction; a centroid of the vehicle body is defined as W; scanning periods are preset in the electronic control unit; and the control method comprises steps of: 1) in some scanning period, a vertical displacement w.sub.O, a pitch angle α.sub.O and a roll angle β.sub.O of the coordinate origin O are measured by the inertial measurement unit and output to the electronic control unit; 2) the electronic control unit calculates a vertical displacement w.sub.w, a pitch angle α.sub.w, and a roll angle β.sub.w at the centroid W of the vehicle according to a geometric relationship of the centroid W relative to the coordinate origin O and the vertical displacement w.sub.O, the pitch angle α.sub.O and the roll angle β.sub.O of the coordinate origin O; 3) the electronic control unit performs a high-pass filter with a cutoff frequency WET on the vertical displacement w.sub.w, the pitch angle α.sub.w and the roll angle β.sub.w, and after being filtered, the vertical displacement is w.sub.H, the pitch angle is α.sub.H and the roll angle is β.sub.H; wherein the cut-off frequency w.sub.H is determined by following ways: S1, the vertical displacement w.sub.H, the pitch angle α.sub.H and the roll angle β.sub.H output after the high-pass filter all converge to 0 when the vehicle is stationary on a horizontal plane; S2, the vertical displacement w.sub.H the pitch angle α.sub.H and the roll angle β.sub.H output after the high-pass filter converge to a smaller value that is in an error range necessary for stable control of the system, when the vehicle stops at a transverse slope and a longitudinal slope for which a limit is allowed; and S3, a smaller value is selected by the cut-off frequency w.sub.H when conditions of S1 and S2 are satisfied; 4) the vertical displacement w.sub.H, the pitch angle α.sub.H and the roll angle β.sub.H obtained in step 3) are compared with values of the previous scanning period, to calculate variations Δw, Δα, Δβ of the vertical displacement, the pitch angle and the roll angle; and Δw, Δα, Δβ are taken as posture relative correction quantities; a target value of the extension and retraction of each of the suspension servo actuating cylinders of the vehicle is calculated through an inverse kinematics algorithm of a vehicle suspension mechanism, and the target value is transmitted to the servo controller group such that displacement servo control is performed on each of the suspension servo actuating cylinders, thereby realizing the control of the vehicle body posture target, maintaining the vertical displacement w.sub.H, the pitch angle α.sub.H and the roll angle β.sub.H as stable as possible, and making a motion trajectory of the centroid of the vehicle in a straight line or in an arc line while keeping the posture of the vehicle body approximately unchanged.
3. The control method of the inertial regulation active suspension system based on the posture deviation of the vehicle according to claim 2, wherein a calculation formula of the vertical displacement w.sub.w, the pitch angle α.sub.w, and the roll angle β.sub.w, at the centroid W of the vehicle is as follows:
4. The inertial regulation active suspension system based on posture deviation of the vehicle according to claim 1, wherein the at least one of the three wheel groups includes two rear wheels; upper chambers of two suspension servo actuating cylinders corresponding to the two rear wheels are communicated with one another and lower chambers of the two suspension servo actuating cylinders corresponding to the two rear wheels are communicated with one another.
5. The inertial regulation active suspension system based on posture deviation of the vehicle according to claim 4, wherein the upper chambers of the two suspension servo actuating cylinders corresponding to the two rear wheels are communicated with one another through an upper chamber connecting pipeline; and the lower chambers of the two suspension servo actuating cylinders corresponding to the two rear wheels are communicated with one another through a lower chamber connecting pipeline.
6. The inertial regulation active suspension system based on posture deviation of the vehicle according to claim 4, wherein in the at least one of the three wheel groups, the two rear wheels and the suspension servo actuating cylinders thereof have the same structure.
7. The inertial regulation active suspension system based on posture deviation of the vehicle according to claim 1, wherein the vehicle body is provided with three shafts; the three shafts include a front shaft located under the front of the vehicle and two rear shafts; the plurality of wheels include six wheels; the six wheels include two front wheels mounted on the front shaft and four rear wheels mounted on the two rear wheels; the two front wheels belong to one wheel group, upper chambers of two suspension servo actuating cylinders corresponding to the two front wheels are communicated with one another and lower chambers of the two suspension servo actuating cylinders corresponding to the two front wheels are communicated with one another; among the four rear wheels, two rear wheels located at a first side of the vehicle body, belong to one wheel group, upper chambers of two suspension servo actuating cylinders corresponding to the two rear wheels located at the first side of the vehicle body are communicated with one another and lower chambers of the two suspension servo actuating cylinders corresponding to the two rear wheels located at the first side of the vehicle body are communicated with one another; among the four rear wheels, two rear wheels located at a second side of the vehicle body, belong to one wheel group, upper chambers of two suspension servo actuating cylinders corresponding to the two rear wheels located at the second side of the vehicle body are communicated with one another and lower chambers of the two suspension servo actuating cylinders corresponding to the two rear wheels located at the second side of the vehicle body are communicated with one another.
8. The inertial regulation active suspension system based on posture deviation of the vehicle according to claim 7, wherein the upper chambers of the two suspension servo actuating cylinders corresponding to the two front wheels are communicated with one another through a first upper chamber connecting pipeline and lower chambers of the two suspension servo actuating cylinders corresponding to the two front wheels are communicated with one another through a first lower chamber connecting pipeline; the upper chambers of the two suspension servo actuating cylinders corresponding to the two rear wheels located at the first side of the vehicle body are communicated with one another through a second upper chamber connecting pipeline and the lower chambers of the two suspension servo actuating cylinders corresponding to the two rear wheels located at the first side of the vehicle body are communicated with one another through a second lower chamber connecting pipeline; the upper chambers of the two suspension servo actuating cylinders corresponding to the two rear wheels located at the second side of the vehicle body are communicated with one another through a third upper chamber connecting pipeline and lower chambers of the two suspension servo actuating cylinders corresponding to the two rear wheels located at the second side of the vehicle body are communicated with one another through a third lower chamber connecting pipeline.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
DETAILED DESCRIPTION
(13) Hereinafter, the present disclosure will be further described in detail with reference to embodiments below.
(14) The present disclosure provides an inertial regulation active suspension system based on posture deviation, which is suitable for a vehicle active suspension system with three or more wheels.
(15) The conventional three-wheeled vehicles and four-wheeled vehicles are taken as an example to make explanation. A vehicle with more than four wheels can be constructed according to a construction principle and method of the four-wheeled vehicle.
(16) According to the first embodiment, a three-wheeled vehicle inertial regulation active suspension system and a control method thereof are provided.
(17) As shown in
(18) As an example of a three-wheeled vehicle in this embodiment, the wheels and the suspension servo actuating cylinders thereof can form supporting points for the vehicle body, so that the posture of the vehicle body may be controlled in a manner that a plane can be determined by three points.
(19) The inertial measurement unit 1 of the present disclosure may also be a gyroscope and other components capable of measuring inertial parameters.
(20) The control method according to the present disclosure is that a coordinate system OXYZ is established for the whole vehicle and a centroid of the vehicle body is defined as W; a coordinate origin of the coordinate system is a center point O of the inertial measurement unit, and a right forward direction in which the vehicle travels is defined as a Y-axis positive direction, a right side direction in which the vehicle travels is defined as a X-axis positive direction, and an upward direction perpendicular to a XOY plane is defined as a Z-axis positive direction; and at the same time, scanning periods are preset in the electronic control unit. The control method according to the present disclosure comprises steps of:
(21) In the first step, the coordinate origin O is taken as a measuring point. In some scanning period, a vertical displacement w.sub.O, a pitch angle α.sub.O and a roll angle β.sub.O of the coordinate origin O are measured by the inertial measurement unit and output to the electronic control unit. The w.sub.O is a vertical displacement of the vehicle body in a Z-axis direction at the coordinate origin O, α.sub.O is a pitch angle of the vehicle body rotating around a X axis, and the β.sub.O is a roll angle of the vehicle body rotating around a Y axis.
(22) In the second step, the posture parameters at the centroid W of the vehicle are calculated. The centroid of the vehicle body is defined as W. The electronic control unit calculates a vertical displacement w.sub.w, a pitch angle α.sub.w and a roll angle β.sub.w at the centroid W of the vehicle according to a geometric relationship of the centroid W relative to the coordinate origin O and the vertical displacement w.sub.O, the pitch angle α.sub.O and the roll angle β.sub.O of the coordinate origin O. The centroid W of the vehicle body has coordinates x.sub.W, y.sub.W and z.sub.W in the coordinate system OXYZ. The w.sub.w is a vertical displacement of the centroid W of the vehicle in a Z-axis direction, the α.sub.O is a pitch angle when the vehicle rotates in an axis parallel to the X-axis around the centroid W, and the β.sub.w is a roll angle when the vehicle rotates in an axis parallel to the Y-axis around the centroid W. A formula of the centroid W is as follows:
(23)
(24) In the third step, the electronic control unit performs a high-pass filter with a cutoff frequency ω.sub.H on the vertical displacement w.sub.w, the pitch angle α.sub.w and the roll angle β.sub.w, and after being filtered, the vertical displacement w.sub.H, the pitch angle α.sub.H and the roll angle β.sub.H can be obtained. Integral errors that have change frequency slower in w.sub.w, α.sub.w and β.sub.w and the portion changed slowly in w.sub.w, α.sub.w and β.sub.w caused when the vehicle crosses a gentle slope are removed by the high-pass filter. The removal of the latter enables the vehicle to travel along an envelope surface of valleys without allowing the suspension stroke to reach a limit, and trafficability of the vehicle can be improved. The cutoff frequency ω.sub.H can be determined by following experimental processes:
(25) S1, the vertical displacement w.sub.H, the pitch angle α.sub.H and the roll angle β.sub.H output after the high-pass filter all converge to 0 when the vehicle is stationary on a horizontal plane;
(26) S2, the vertical displacement w.sub.H, the pitch angle α.sub.H and the roll angle β.sub.H output after the high-pass filter converge to a smaller value that is in an error range necessary for stable control of the system, when the vehicle stops at a transverse slope and a longitudinal slope for which a limit is allowed; and
(27) S3, a low value is selected by the cut-off frequency w.sub.H when conditions of S1 and S2 are satisfied.
(28) In the fourth step, the vertical displacement w.sub.H, the pitch angle α.sub.H and the roll angle β.sub.H are kept as stable as possible by controlling the extension and retraction of each of the suspension servo actuating cylinders, such that a motion trajectory of the centroid of the vehicle is in a straight line or an arc line and the posture of the vehicle body remains approximately unchanged. Specifically, the vertical displacement w.sub.H, the pitch angle α.sub.H and the roll angle β.sub.H obtained in the third step are compared with the same values in the previous scanning period, to calculate variations Δw, Δα, Δβ of the vertical displacement, the pitch angle and the roll angle; and −Δw, Δα, Δβ are taken as posture relative correction quantities; target values of the extension and retraction amount l.sub.5, l.sub.6 and l.sub.7 of the suspension servo actuating cylinders 5, 6 and 7 of the vehicle are calculated and are transmitted to the servo controller group 12, such that displacement servo control is performed on each of the suspension servo actuating cylinders, thereby realizing the control of the vehicle body posture target, maintaining the vertical displacement w.sub.H, the pitch angle α.sub.H and the roll angle β.sub.H as stable as possible, and making a motion trajectory of the centroid of the vehicle in a straight line or in an arc line while keeping the posture of the vehicle body approximately unchanged. The target values of the extension and retraction amount of the suspension servo actuating cylinders can be calculated through an inverse kinematics algorithm of a vehicle suspension mechanism.
(29) According to the second embodiment, a four-wheeled vehicle inertial regulation active suspension system based on posture deviation and a control method thereof are provided.
(30) As shown in
(31) One of the control methods of the four-wheeled vehicle according to the present disclosure is the same as that in the first embodiment, that is, scanning periods are preset inside the electronic control unit. In some scanning period, the electronic control unit 11 reads the vehicle posture parameters measured by the inertial measurement unit 1, calculates the posture deviation of the vehicle at a current moment from the previous moment, and then outputs posture control parameters to the servo controller group 12. The servo controller group 12 controls action of each of the suspension servo actuating cylinders 5, 6, 7.1 and 7.2 according to the posture control parameters output by the electronic control unit and the displacement feedback values of the displacement sensors, so as to allow the centroid of the vehicle to be movable approximately along a straight line or an arc line and keep the posture of the vehicle body unchanged.
(32) According to the four-wheeled vehicle in this embodiment, upper chambers and lower chambers of the suspension servo actuating cylinders 7.1 and 7.2 corresponding to the wheels 4.1 and 4.2 are individually communicated; that is, the upper chambers of the suspension servo actuating cylinders 7.1 and 7.2 are connected with each other through an upper chamber connecting pipeline 14; the lower chambers of the suspension servo actuating cylinders 7.1 and 7.2 are connected with each other through a lower chamber connecting pipeline 15. As such, function of the wheels 4.1 and 4.2 and the suspension servo actuating cylinders thereof supporting the vehicle body is equivalent to that of the supporting point, while the other two wheels 2 and 3 and the suspension servo actuating cylinders thereof respectively form supporting points for the vehicle body. As for the conventional vehicle, two rear wheels and the suspension servo actuating cylinders thereof have the same structure, so that the equivalent supporting point is considered as a midpoint of an upper hinge point on the suspension servo actuating cylinders 7.1 and 7.2 corresponding to the wheels 4.1 and 4.2. A height of the equivalent supporting point is controlled by controlling an average value (shown by l7 in
(33) A vehicle with four or more wheels may refer to the method of the second embodiment, that is, the vehicle with four or more wheels can be divided into three wheel groups, each of which is provided with one or more wheels. When the number of wheels of the wheel group is more than one, the upper chambers of the suspension servo actuating cylinders in the wheel group are communicated with one another and the lower chambers of the suspension servo actuating cylinders in the wheel group are communicated with one another, so that the wheel group constitutes a supporting point for supporting the vehicle body, and the three wheel groups constitute three supporting points of the vehicle body. The posture of the vehicle body can be controlled by controlling supporting heights of the three supporting points. The present disclosure provides a control method for the vehicle with four or more wheels, which arranges all wheels of the vehicle with more than three wheels into three wheel groups and controls the posture of the vehicle body based on a principle that a plane is determined by three points, thus the control method is suitable for all vehicles with more than three wheels. At the same time, the wheels that are close to each other in position are selected to form the wheel group in order to facilitate for the communication of the upper chambers and the lower chambers of the suspension servo actuating cylinders in the wheel group. The structure and the size of the wheels in the wheel group and the suspension servo actuating cylinders are the same as that of the displacement sensors as possible when being grouped, in order to determine the supporting points of the wheel group. According to the present disclosure, the interference of integral accumulated error signals in signals is reduced by real-time scanning and monitoring the vertical displacement, the pitch angle and the roll angle of the vehicle coordinate origin in each of the periods, and performing the high-pass filter on the scanning values, and then the extension and retraction of the suspension servo actuating cylinder of each of the wheel groups is calculated through the inverse kinematics algorithm of the vehicle suspension mechanism according to the vertical displacement, the pitch angle and the roll angle after being filtered, so as to allow the motion of the vehicle centroid approximately along a straight line or an arc line and keep the posture of the vehicle body approximately unchanged, thus greatly reducing the vibration of the vehicle body.
(34) As development of the present disclosure is proceeded, a comparison test between a posture that a three-axle vehicle equipped with an inertial regulation active suspension system based on posture deviation crosses a triangle obstacle and a posture that a three-axle vehicle equipped with a passive oleo-preumatic suspension system crosses the triangle obstacle is carried out. The three-axle vehicle used in the test is shown in
(35) All triangle obstacles used in the test are shown in
(36)
(37)
(38)
(39)
(40)
(41) As can be seen from the above comparison test, the inertial regulation active suspension system based on posture deviation as proposed by the present disclosure can effectively reduce the vibration of the vehicle body and improve the handling stability and ride comfort of the vehicle.
(42) Ultimately, it should be noted that the above-mentioned embodiments are only used to illustrate the technical solution of the present disclosure, rather than limit the present disclosure. Although the present disclosure has been described in detail with reference to the foregoing embodiments, it should be understood by the person skilled in the art that it is allowable to modify the technical solution described in the foregoing embodiments or equivalently substituting some or all of the technical features; however, these modifications or substitutions do not cause the corresponding technical solutions to substantively depart from the scope of the technical solutions of various embodiments of the present disclosure.