In-vehicle stable platform system employing active suspension and control method thereof

Patent metadata

Field	Value
Publication number	US-11906392-B2
Application number	US-201916980002-A
Country	US
Kind code	B2
Filing date	Aug 1, 2019
Priority date	Sep 10, 2018
Publication date	Feb 20, 2024
Grant date	Feb 20, 2024

Abstract

An in-vehicle stable platform system employing active suspension and a control method thereof is provided. The system includes a vehicle body, an in-vehicle stable platform, an inertial measurement device, an electronic control device, a servo controller set, multiple wheels, and suspension servo actuation cylinders and displacement sensors respectively corresponding to the wheels. The wheels are divided into three groups, which form three support points. The heights of the three support points are controlled to control orientation of the vehicle body. An amount of extension/retraction of the suspension servo actuation cylinders required to cause the in-vehicle stable platform to return to a horizontal level is calculated according to a measured pitch angle and a roll angle of the in-vehicle stable platform, and when a vehicle travels on an uneven road, the extension/retraction of each suspension servo actuation cylinder is controlled to cause the in-vehicle stable platform to be horizontal.

First claim

What is claimed is:

1. A control method of an orientation of a vehicle employing active suspension, characterized in that the vehicle has three or more wheels, the wheels are divided into three groups, which constitute three support points for supporting a vehicle body; heights of the three support points are controlled to control an orientation of the vehicle body; each of the wheel groups has one wheel or multiple wheels therein, when the number of wheels in some wheel group is greater than one, upper chambers and lower chambers of all of the suspension servo actuation cylinders in the wheel group are respectively communicated, and the wheel group forms a support point for supporting the vehicle body, three wheel groups form three support points, so that the orientation of the vehicle body is controlled according to a principle that a plane is determined by three points;
wherein the vehicle comprises a vehicle body, an inertial measurement device, an electronic control device, a servo controller set, multiple wheels, suspension servo actuation cylinders and displacement sensors respectively corresponding to the wheels, wherein the wheels are connected to a lower part of the vehicle body via the suspension servo actuation cylinders, and the displacement sensor is used to measure strokes of the suspension servo actuation cylinders, the electronic control device and servo controller set are secured to the vehicle body, the electronic control device is in communication with the inertial measurement device and the servo controller set, and the servo controller set is in communication with the displacement sensor, the electronic control device reads an orientation parameter measured by the inertial measurement device, calculates an amount of extension/retraction of each of the suspension servo actuation cylinders required to cause the vehicle body to return to a horizontal level, and outputs it to servo controller set, thereby controlling the extension/retraction of each of the suspension servo actuation cylinders;
wherein when the wheel groups are formed, the structures of the wheels in each of the wheel groups and the suspension servo actuation cylinders corresponding thereto and the displacement sensors are the same, and a support point supporting the vehicle body in each of the wheel groups is a geometric center point of the support point of each of the suspension servo actuation cylinders in the group to the vehicle body, and the height of the support point is controlled by controlling the average amount of extension/retraction of each of the suspension servo actuation cylinders in the group.

2. The control method of the orientation of the vehicle employing active suspension according to claim 1 , characterized in that, the method comprises establishing a coordinate system OXYZ fixedly connected with the vehicle body, wherein a coordinate origin O is a centroid of wheel grounding points when the vehicle is horizontal, and an upward direction passing through the coordinate origin O and perpendicular to the plane where an in-vehicle stable platform is located is defined as a Z-axis positive direction, a forward direction of the vehicle is defined as a Y-axis positive direction, and a right direction when the vehicle moves forward is defined as an X-axis positive direction, a heaving displacement of the in-vehicle stable platform along the Z-axis is set as w, a rotation angle around the X-axis is set as a, and a rotation angle around the Y-axis is set as β; scanning periods are preset in the inertial measurement device, and the control method comprises the following steps:
in the first step, in each of the scanning periods, the inertial measurement device measures a pitch angle α 0 and a roll angle β 0 and outputs them to the electronic control device;
in the second step, the electronic control device performs a first-order low-pass filtering with a cutoff frequency f L on the pitch angle α 0 and the roll angle βo, and a filtered pitch angle is α L , a filtered roll angle is β L , the first-order digital low-pass filtering adopts a following recursive algorithm:
y n =αx n +(1− a ) y n-1

wherein, x n is a sampling value of α 0 or β 0 in the current scanning period, y n is a calculating value of α 0 or β 0 in the current scanning period, y n-1 is a calculating value of α 0 or β 0 in the previous scanning period, and a is a filter coefficient;
in the case that the cut-off frequency f L is determined, the calculation method of a is:
a= 2π f L Δt

wherein Δt is the scanning period, an unit of which is s; f L is the cut-off frequency, an unit of which is Hz;
in the third step, according to the values of α L and β L obtained in the previous second step, the electronic control device takes w=0 and −α L and −β L as relative correction values of the orientation of the in-vehicle stable platform, calculates the target values of the amount of extension/retraction of the suspension servo actuation cylinders of the vehicle, and transmits the target values to the servo controller set to perform displacement servo control on the suspension servo actuation cylinders, so as to cause the in-vehicle stable platform to be horizontal during traveling; when the target values of the amount of the extension/retraction of the suspension servo actuation cylinders are calculated by an inverse kinematics algorithm of a vehicle suspension mechanism with the three support points; when the servo controller set performs displacement control on the suspension servo actuation cylinders, the extension/retraction of the suspension servo actuation cylinders is controlled according to target values of the stroke and the amount of the extension/retraction of the suspension servo actuation cylinder measured by the displacement sensor, so as to cause the in-vehicle stable platform to be horizontal during traveling.

3. An in-vehicle stable platform employing active suspension for a six-wheeled vehicle, characterized in that, the in-vehicle stable platform comprises a vehicle body ( 13 ), an in-vehicle stable platform ( 14 ) fixedly connected with the vehicle body, an inertial measurement device ( 1 ), an electronic control device ( 11 ), a servo controller set ( 12 ), wheels ( 2 . 1 , 2 . 2 , 3 . 1 , 3 . 2 , 4 . 1 , 4 . 2 ), suspension servo actuation cylinders ( 5 . 1 , 5 . 2 , 6 . 1 , 6 . 2 , 7 . 1 , 7 . 2 ) corresponding to the wheels ( 2 . 1 , 2 . 2 , 3 . 1 , 3 . 2 , 4 . 1 , 4 . 2 ) one by one, and corresponding displacement sensors ( 8 . 1 , 8 . 2 , 9 . 1 , 9 . 2 , 10 . 1 , 10 . 2 );
wherein the inertial measurement device ( 1 ) is secured to the in-vehicle stable platform ( 14 ), and wheels ( 2 . 1 , 2 . 2 , 3 . 1 , 3 . 2 , 4 . 1 , 4 . 2 ) are connected to a lower part of the vehicle body via the suspension servo cylinders ( 5 . 1 , 5 . 2 , 6 . 1 , 6 . 2 , 7 . 1 , 7 . 2 ) respectively; the displacement sensors ( 8 . 1 , 8 . 2 , 9 . 1 , 9 . 2 , 10 . 1 , 10 . 2 ) are used to measure strokes of the suspension servo actuation cylinders ( 5 . 1 , 5 . 2 , 6 . 1 , 6 . 2 , 7 . 1 , 7 . 2 ), respectively, the electronic control device ( 11 ) and the servo controller set ( 12 ) are secured to the vehicle body ( 13 ), the electronic control device ( 11 ) is in communication with the inertial measurement device ( 1 ) and the servo controller set ( 12 ), the servo controller set ( 12 ) is in communication with the displacement sensors ( 8 . 1 , 8 . 2 , 9 . 1 , 9 . 2 , 10 . 1 , 10 . 2 ), and the servo controller set ( 12 ) receives the measurement signals of the displacement sensors, the electronic control device ( 11 ) reads the orientation parameters measured by the inertial measurement device ( 1 ), calculates an amount of extension/retraction of each of the suspension servo actuation cylinders ( 5 . 1 , 5 . 2 , 6 . 1 , 6 . 2 ,

Assignees

• Univ Yanshan

Inventors

• Zhao Dingxuan
• Gong Mingde
• Liu Shuang
• Sun Zhiguo
• Zhang Zhuxin
• Yang Bin
• Ni Tao
• Guo Qinghe
• Yang Mengke

Classifications

• G01M17/04 Primary

  Suspension or damping · CPC title

• B60G17/018 Primary

  characterised by the use of a specific signal treatment or control method · CPC title

• B60G17/0152

  characterised by the action on a particular type of suspension unit (B60G17/01941 takes precedence) · CPC title

• B60G17/0161

  mainly during straight-line motion (B60G17/0164 takes precedence) · CPC title

• B60G17/0195

  characterised by the regulation being combined with other vehicle control systems {(conjoint control of vehicle sub-units including control of suspension systems B60W10/22)} · CPC title