A method for estimating center of mass position based on suspension height sensor

By obtaining the suspension height change amount and its geometric relationship, and combining the force distributed by the sensor, the center of mass position and spring mass of the car is calculated in real time, the problem of the inability to calculate the center of mass position in the existing technology is solved, and the safety and performance of the car are improved.

CN115195759BActive Publication Date: 2024-11-22TONGJI UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210808373.6
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-07-11
Publication Date
2024-11-22
Estimated Expiration
2042-07-11

AI Technical Summary

Technical Problem

The prior art cannot calculate the center of mass position of the vehicle equipped with three suspension height sensors in real time, resulting in limited performance optimization and safety improvement.

Method used

By obtaining the suspension height change and its geometric relationship, the vertical force is calculated, and combined with the geometric relationship of the sensor distribution, the center of mass position and spring mass of the car are estimated in real time.

Benefits of technology

Real-time calculation of the center of mass position of a car equipped with three suspension height sensors is achieved, which improves the safety and performance optimization capabilities of the vehicle, makes up for the gaps in the existing technology, and the calculation process is simple and easy to operate.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115195759B_ABST
    Figure CN115195759B_ABST
Patent Text Reader

Abstract

The present application discloses a method for estimating the center of mass position based on a suspension height sensor, and the method for estimating the center of mass position based on the suspension height sensor includes: obtaining a first height change of a current target vehicle through a sensor; obtaining a second height change according to the first height change and the geometric relationship corresponding to the first height change; and obtaining the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change. The present application solves the problem that a vehicle equipped with three suspension height sensors cannot calculate the center of mass position.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of vehicle technology, and in particular to a method for estimating a center of mass position based on a suspension height sensor. Background Art

[0002] Due to the uncertainty of the weight and position of the cargo and the number and position of the passengers, the sprung mass and center of mass position of the car also change accordingly. The change of the center of mass position and the sprung mass will cause a great change in the performance of the car, such as the braking performance, acceleration performance, anti-roll performance, etc. Therefore, the real-time measurement of the sprung mass and center of mass position of the car is a key step in improving the performance of the car, which can make the judgment of the motion state of the whole vehicle more accurate when controlling the car, thereby optimizing the control effect and improving the safety, comfort and other aspects of the target vehicle.

[0003] Since the current real-time calculation method of the center of mass position of a car only considers the use of four suspension height sensors for measurement, and car developers, for economic considerations, have led to many models on the market being equipped with only three suspension height sensors, the existing solution is unable to calculate the center of mass position of such models. Summary of the invention

[0004] The main purpose of this application is to provide a method for estimating the center of mass position based on a suspension height sensor, aiming to solve the problem that a vehicle model equipped with three suspension height sensors cannot calculate the center of mass position.

[0005] To achieve the above object, the present application provides a method for estimating the center of mass position based on a suspension height sensor, the method for estimating the center of mass position based on the suspension height sensor comprising:

[0006] Acquire a first height change of the current target vehicle through a sensor;

[0007] Obtaining a second height change amount according to the first height change amount and a geometric relationship corresponding to the first height change amount;

[0008] Based on the second height change and the force relationship corresponding to the second height change, the center of mass position of the target vehicle is obtained.

[0009] Optionally, the first height variation includes a height variation of a middle portion of a front axle, a height variation of a left side of a rear axle, and a height variation of a right side of a rear axle, and the step of obtaining a second height variation according to the first height variation and a geometric relationship corresponding to the first height variation includes:

[0010] Based on the height changes of the left side of the rear axle and the right side of the rear axle, obtaining the height change of the middle part of the rear axle;

[0011] Based on the height change of the left side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle, obtaining the height change of the left side of the front axle;

[0012] Based on the height change of the right side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle, obtaining the height change of the right side of the front axle;

[0013] The second height change is obtained based on the height change of the left side of the front axle, the height change of the right side of the front axle, the height change of the left side of the rear axle, and the height change of the right side of the rear axle.

[0014] Optionally, the step of obtaining the height change of the left side of the front axle based on the height change of the left side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle comprises:

[0015] Calculating the height change of the middle part of the front axle and the height change of the middle part of the rear axle to obtain the height change difference of the whole vehicle;

[0016] The height change of the left side of the rear axle and the height change difference of the whole vehicle are calculated to obtain the height change of the left side of the front axle.

[0017] Optionally, the step of obtaining the height change of the right side of the front axle based on the height change of the right side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle comprises:

[0018] The height change of the right side of the rear axle and the height change difference of the whole vehicle are calculated to obtain the height change of the right side of the front axle.

[0019] Optionally, the step of obtaining the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change includes:

[0020] Obtaining a corresponding vertical force according to the second height change and the force relationship;

[0021] Based on the positions of the sensors, obtaining the distance between the sensors;

[0022] Based on the distance and the vertical force, a center of mass plane coordinate point of the center of mass position is obtained, and the center of mass plane coordinate point is located in a preset coordinate system;

[0023] The center of mass position is obtained based on the preset initial center of mass height and the distance, the second height change, and the center of mass plane coordinate point.

[0024] Optionally, the distance includes a first length and a second length, and the step of obtaining a centroid plane coordinate point of the centroid position based on the distance and the vertical force, wherein the centroid plane coordinate point is located in a preset coordinate system, includes:

[0025] According to the geometric relationship corresponding to the vertical force, the coordinate system is created to obtain the corresponding reference point;

[0026] Calculate a first coordinate based on the reference point, the first length, and the vertical force;

[0027] Calculate the second coordinate based on the reference point, the second length, and the vertical force;

[0028] The centroid plane coordinate point is obtained based on the first coordinate and the second coordinate.

[0029] Optionally, after the step of obtaining the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change, the step further includes:

[0030] Based on a preset proportionality coefficient and a force relationship corresponding to the second height change, the sprung mass of the target vehicle is obtained.

[0031] Optionally, before the step of obtaining the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change, the step further includes:

[0032] Through a preset bench test, each test height change and the test vertical force corresponding to the test height change are obtained, and the test height change is one or more;

[0033] Based on the test height change and the test vertical force, the force relationship corresponding to each test height change is obtained.

[0034] The embodiment of the present application further proposes a center of mass position estimation device based on a suspension height sensor, and the center of mass position estimation device based on a suspension height sensor comprises:

[0035] An acquisition module, used for acquiring a first height change of the current target vehicle through a sensor;

[0036] a conversion module, configured to obtain a second height change amount according to the first height change amount and a geometric relationship corresponding to the first height change amount;

[0037] A calculation module is used to obtain the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change.

[0038] An embodiment of the present application also proposes a terminal device, which includes a memory, a processor, and a center of mass position estimation program based on a suspension height sensor stored in the memory and executable on the processor. When the center of mass position estimation program based on the suspension height sensor is executed by the processor, the steps of the center of mass position estimation method based on the suspension height sensor as described above are implemented.

[0039] An embodiment of the present application also proposes a computer-readable storage medium, on which is stored a center of mass position estimation program based on a suspension height sensor. When the center of mass position estimation program based on the suspension height sensor is executed by a processor, the steps of the center of mass position estimation method based on the suspension height sensor as described above are implemented.

[0040] The method for estimating the center of mass position based on the suspension height sensor proposed in the embodiment of the present application obtains the first height change of the current target vehicle through the sensor; obtains the second height change based on the first height change and the geometric relationship corresponding to the first height change; obtains the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change. By obtaining the data information of the suspension height sensor and combining the distribution of the sensor

[0041] The geometric relationship can be used to obtain the center of mass position of the target vehicle, which can solve the problem that the 0 model equipped with three suspension height sensors cannot calculate the center of mass position, thereby improving the safety of the target vehicle.

[0042] The application proposal, starting from the problem that many models in the real world of the automotive industry are not equipped with four suspension height sensors, designs a method for dynamically identifying the center of mass position of a vehicle under different numbers of passengers and different load conditions for vehicles equipped with only three suspension height sensors.

[0043] The sprung mass is calculated, which fills the gap in the previous three-suspension height sensor center of mass position estimation algorithm, and the calculation process is simple and easy. Finally, the center of mass position calculated by the method of this application can be simply and quickly embedded in a low computing power platform. BRIEF DESCRIPTION OF THE DRAWINGS

[0044] Figure 1 This is a schematic diagram of a functional module 0 of a terminal device to which the center of mass position estimation device based on a suspension height sensor belongs in this application;

[0045] Figure 2 This is a flow chart of a first exemplary embodiment of a method for estimating a center of mass position based on a suspension height sensor of the present application;

[0046] Figure 3This is a flow chart of a second exemplary embodiment of a method for estimating a center of mass position based on a suspension height sensor of the present application;

[0047] 5 Figure 4 This is a flow chart of a third exemplary embodiment of a method for estimating a center of mass position based on a suspension height sensor of the present application;

[0048] Figure 5 This is a flow chart of a fourth exemplary embodiment of a method for estimating a center of mass position based on a suspension height sensor of the present application;

[0049] Figure 6 Schematic diagram of the coordinate system involved in the method for estimating the center of mass position based on the suspension height sensor of the present application;

[0050] Figure 7 This is a schematic flow chart of the steps involved in the method for estimating the center of mass position based on the suspension height sensor of the present application;

[0051] Figure 8 This is a flowchart of a fifth exemplary embodiment of a method for estimating a center of mass position based on a suspension height sensor of the present application;

[0052] Fig. 9 This is a flowchart of a sixth exemplary embodiment of a method for estimating a center of mass position based on a suspension height sensor of the present application.

[0053] The realization of the purpose, functional features and advantages of this application will be further explained in conjunction with embodiments and with reference to the accompanying drawings. DETAILED DESCRIPTION

[0054] It should be understood that the specific embodiments described herein are only used to explain the present application and are not used to limit the present application.

[0055] The main solution of the embodiment of the present application is: obtain the first height change of the current target vehicle through the sensor; obtain the second height change according to the first height change and the geometric relationship corresponding to the first height change; obtain the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change. By obtaining the data information of the suspension height sensor and combining the geometric relationship of the sensor distribution to obtain the center of mass position of the target vehicle, the problem that the vehicle equipped with three suspension height sensors cannot calculate the center of mass position can be solved, thereby improving the safety of the target vehicle.

[0056] Based on the present application, and considering the problem that many models in the real world of the automotive industry are not equipped with four suspension height sensors, a method for dynamically identifying the center of mass position of a vehicle is designed for vehicles equipped with only three suspension height sensors under different numbers of passengers and different load conditions. At the same time, the sprung mass of the vehicle is also calculated, filling the gap in the previous three-suspension height sensor center of mass position estimation algorithm, and the calculation process is simple and easy. Finally, the center of mass position calculated by the present application method can be simply and quickly embedded in a low-computing power platform.

[0057] The embodiments of the present application take into account that the current real-time calculation method for the center of mass position of a car only considers the use of four suspension height sensors for measurement, and car developers, for economic considerations, have led to many models on the market being equipped with only three suspension height sensors. Therefore, the existing solution cannot calculate the center of mass position of such models.

[0058] Therefore, the embodiment of the present application starts from the problem that many car models in the real-world automotive industry are not equipped with four suspension height sensors, and designs a center of mass position estimation method based on the suspension height sensor in combination with the geometric relationship of the sensor distribution, so as to solve the problem that car models equipped with three suspension height sensors cannot calculate the center of mass position, thereby improving the safety of the target vehicle.

[0059] Specifically, refer to Figure 1 , Figure 1 This is a functional module diagram of the terminal device to which the center of mass position estimation device based on the suspension height sensor belongs. The center of mass position estimation device based on the suspension height sensor can be a device independent of the terminal device that can calculate the height change and vertical force, and it can be carried on the terminal device in the form of hardware or software. The terminal device can be a smart mobile terminal with data processing function such as a mobile phone or a tablet computer, or a fixed terminal device or server with data processing function.

[0060] In this embodiment, the terminal device to which the center of mass position estimation device based on the suspension height sensor belongs includes at least an output module 110 , a processor 120 , a memory 130 and a communication module 140 .

[0061] The memory 130 stores an operating system and a center of mass position estimation program based on a suspension height sensor. The center of mass position estimation device based on a suspension height sensor can store the first height change amount of the current target vehicle obtained by the sensor, the second height change amount obtained according to the first height change amount and the geometric relationship corresponding to the first height change amount, the center of mass position of the target vehicle obtained based on the second height change amount and the force relationship corresponding to the second height change amount, and the sprung mass and other information in the memory 130; the output module 110 can be a display screen, etc. The communication module 140 can include a WIFI module, a mobile communication module, a Bluetooth module, etc., and communicates with an external device or server through the communication module 140.

[0062] The following steps are implemented when the center of mass position estimation program based on the suspension height sensor in the memory 130 is executed by the processor:

[0063] Acquire a first height change of the current target vehicle through a sensor;

[0064] Obtaining a second height change amount according to the first height change amount and a geometric relationship corresponding to the first height change amount;

[0065] Based on the second height change and the force relationship corresponding to the second height change, the center of mass position of the target vehicle is obtained.

[0066] Furthermore, when the center of mass position estimation program based on the suspension height sensor in the memory 130 is executed by the processor, the following steps are also implemented:

[0067] Based on the height changes of the left side of the rear axle and the right side of the rear axle, obtaining the height change of the middle part of the rear axle;

[0068] Based on the height change of the left side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle, obtaining the height change of the left side of the front axle;

[0069] Based on the height change of the right side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle, obtaining the height change of the right side of the front axle;

[0070] The second height change is obtained based on the height change of the left side of the front axle, the height change of the right side of the front axle, the height change of the left side of the rear axle, and the height change of the right side of the rear axle.

[0071] Furthermore, when the center of mass position estimation program based on the suspension height sensor in the memory 130 is executed by the processor, the following steps are also implemented:

[0072] Calculating the height change of the middle part of the front axle and the height change of the middle part of the rear axle to obtain the height change difference of the whole vehicle;

[0073] Calculate the height change of the left side of the rear axle and the height change difference of the whole vehicle to obtain the height change of the left side of the front axle;

[0074] The step of obtaining the height change of the right side of the front axle based on the height change of the right side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle comprises:

[0075] The height change of the right side of the rear axle and the height change difference of the whole vehicle are calculated to obtain the height change of the right side of the front axle.

[0076] Furthermore, when the center of mass position estimation program based on the suspension height sensor in the memory 130 is executed by the processor, the following steps are also implemented:

[0077] Obtaining a corresponding vertical force according to the second height change and the force relationship;

[0078] Based on the positions of the sensors, obtaining the distance between the sensors;

[0079] Based on the distance and the vertical force, a center of mass plane coordinate point of the center of mass position is obtained, and the center of mass plane coordinate point is located in a preset coordinate system;

[0080] The center of mass position is obtained based on the preset initial center of mass height and the distance, the second height change, and the center of mass plane coordinate point.

[0081] Furthermore, when the center of mass position estimation program based on the suspension height sensor in the memory 130 is executed by the processor, the following steps are also implemented:

[0082] According to the geometric relationship corresponding to the vertical force, the coordinate system is created to obtain the corresponding reference point;

[0083] Calculate a first coordinate based on the reference point, the first length, and the vertical force;

[0084] Calculate the second coordinate based on the reference point, the second length, and the vertical force;

[0085] The centroid plane coordinate point is obtained based on the first coordinate and the second coordinate.

[0086] Furthermore, when the center of mass position estimation program based on the suspension height sensor in the memory 130 is executed by the processor, the following steps are also implemented:

[0087] Based on a preset proportionality coefficient and a force relationship corresponding to the second height change, the sprung mass of the target vehicle is obtained.

[0088] Furthermore, when the center of mass position estimation program based on the suspension height sensor in the memory 130 is executed by the processor, the following steps are also implemented:

[0089] Through a preset bench test, each test height change and the test vertical force corresponding to the test height change are obtained, and the test height change is one or more;

[0090] Based on the test height change and the test vertical force, the force relationship corresponding to each test height change is obtained.

[0091] Through the above scheme, this embodiment specifically obtains the first height change of the current target vehicle through a sensor; obtains the second height change based on the first height change and the geometric relationship corresponding to the first height change; and obtains the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change.

[0092] By acquiring the data information of the suspension height sensor and combining it with the geometric relationship of the sensor distribution, the center of mass position of the target vehicle can be obtained. This can solve the problem that the vehicle model equipped with three suspension height sensors cannot calculate the center of mass position, thereby improving the safety of the target vehicle. Based on the present application scheme, starting from the problem that many vehicle models in the real-world automotive industry are not equipped with four suspension height sensors, a method for dynamic identification of the center of mass position of a vehicle is designed for vehicles equipped with only three suspension height sensors under different numbers of occupants and different load conditions. At the same time, the sprung mass of the vehicle is also calculated, filling the gap in the previous three-suspension height sensor center of mass position estimation algorithm, and the calculation process is simple and easy. Finally, the center of mass position calculated by the present application method can be simply and quickly embedded in a low-computing power platform.

[0093] Based on the above terminal device architecture but not limited to the above architecture, an embodiment of the method of the present application is proposed.

[0094] Reference Figure 2 , Figure 2 The flowchart of the first exemplary embodiment of the method for estimating the center of mass position based on the suspension height sensor of the present application is shown in FIG. The method for estimating the center of mass position based on the suspension height sensor includes:

[0095] Step S210, obtaining a first height change of the current target vehicle through a sensor;

[0096] Specifically, during the operation of the car, if the speed is too fast, especially on a curve, rollover and skidding accidents are likely to occur. Therefore, the safe speed threshold is calculated by obtaining the center of mass position in real time and accurately, so as to perform electronic throttle and electronic brake control.

[0097] Specifically, the signal feedback from each suspension height sensor and the height information between the axle (or wheel) and the frame (or load-bearing body) in the initial state are received, and the height change between the axle (or wheel) and the frame (or load-bearing body) is calculated based on the signal feedback from the suspension height sensor and the height information in the initial state, wherein the position of the suspension height sensor corresponds to the position of the height change.

[0098] It should be noted that the first height change is preferably a height signal between the axle (or wheel) and the frame (or load-bearing body) measured by each suspension height sensor of the target vehicle (whole vehicle). In other embodiments, it may also be a height signal measured by other devices of the target vehicle, which is not limited to the embodiments of the present application.

[0099] Step S220, obtaining a second height change amount according to the first height change amount and a geometric relationship corresponding to the first height change amount;

[0100] Specifically, because the position of the suspension height sensor corresponds to the position of the height change, the height change (i.e., the second height change) between the axle (or wheel) and the frame (or load-bearing body) at each suspension of the target vehicle (whole vehicle) can be calculated based on the geometric relationship between each suspension height sensor and the size of the first height change.

[0101] Step S230, obtaining the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change.

[0102] Specifically, through a bench test implemented in advance, the test vertical forces corresponding to different test height changes are obtained, and the corresponding force relationship is obtained according to each test height change. In this way, the vertical force corresponding to the second height change (i.e., the current height change obtained in real time) between the axle (or wheel) and the frame (or load-bearing body) at the suspension can be calculated; then, based on the size of each vertical force and the geometric relationship between them, the center of mass plane coordinate point corresponding to the center of mass of the target vehicle (whole vehicle) and the sprung mass are calculated; finally, the center of mass position of the target vehicle (whole vehicle) is calculated according to the second height change, the center of mass plane coordinate point corresponding to the center of mass, and the initial center of mass height.

[0103] This embodiment uses the above scheme to obtain the first height change of the current target vehicle through the sensor; obtain the second height change based on the first height change and the geometric relationship corresponding to the first height change; obtain the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change. By dynamically obtaining the data information of the three suspension height sensors and combining the geometric relationship of the sensor distribution, the center of mass position and can be calculated, which can solve the problem that the center of mass position cannot be calculated when the three suspension height sensors are equipped in the existing vehicle models, thereby improving the safety of the target vehicle.

[0104] Reference Figure 3 , Figure 3 This is a flow chart of a second exemplary embodiment of a method for estimating the center of mass position based on a suspension height sensor of the present application. Figure 2 In the embodiment shown, the first height variation includes the height variation of the middle of the front axle, the height variation of the left side of the rear axle, and the height variation of the right side of the rear axle. Step S220, according to the first height variation and the geometric relationship corresponding to the first height variation, the step of obtaining the second height variation includes:

[0105] Step S310, obtaining a height change of the middle part of the rear axle based on the height change of the left side of the rear axle and the height change of the right side of the rear axle;

[0106] Specifically, the embodiment of the present application designs a method for dynamically identifying the center of mass position of a vehicle under different numbers of passengers and different load conditions for a vehicle equipped with only three suspension height sensors. The locations of the suspension height sensors are: one each at the middle of the front axle, the left side of the rear axle, and the right side of the rear axle of the target vehicle (the whole vehicle).

[0107] The height variation between the axle (or wheel) and the frame (or load-bearing body) at the middle of the front axle, the left side of the rear axle, and the right side of the rear axle is obtained through the feedback signals of the three suspension height sensors and the height information between the axle (or wheel) and the frame (or load-bearing body) in the initial state, that is, the height variation between the axle (or wheel) and the frame (or load-bearing body) at the middle of the front axle, the left side of the rear axle, and the right side of the rear axle, i.e., the height variation of the middle of the front axle (sen fm ), height change of the left side of the rear axle (sen rl ), height change of the right side of the rear axle (sen rr ).

[0108] Since the position of the suspension height sensor corresponds to the position of the height change, the height change of the middle part of the rear axle can be calculated according to the geometric relationship between the three suspension height sensors and the height change of the left side and right side of the rear axle of the target vehicle, as shown in the following formula:

[0109]

[0110] Step S320, obtaining a height change amount of the left side of the front axle based on the height change amount of the left side of the rear axle, the height change amount of the middle part of the rear axle, and the height change amount of the middle part of the front axle;

[0111] Specifically, when the target vehicle is unloaded, the height change of the left side of the rear axle is the same as the height change of the left side of the front axle (in a balanced state). Therefore, the corresponding height change of the middle part of the rear axle is calculated for the height change of the middle part of the front axle, and then the height change difference of the whole vehicle is obtained according to the difference between the height change of the middle part of the front axle and the height change of the middle part of the rear axle; then, the height change of the left side of the rear axle and the height change difference of the whole vehicle are calculated to obtain the height change of the left side of the front axle.

[0112] Step S330, obtaining a height change of the right side of the front axle based on the height change of the right side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle;

[0113] Specifically, when the target vehicle is unloaded, the height change of the right side of the rear axle is the same as the height change of the right side of the front axle (in a balanced state). Therefore, the corresponding height change of the middle part of the rear axle is calculated for the height change of the middle part of the front axle, and then the height change difference of the whole vehicle is obtained according to the difference between the height change of the middle part of the front axle and the height change of the middle part of the rear axle; then, the height change of the right side of the rear axle and the height change difference of the whole vehicle are calculated to obtain the height change of the right side of the front axle.

[0114] Step S340, obtaining the second height change based on the height change of the left side of the front axle, the height change of the right side of the front axle, the height change of the left side of the rear axle, and the height change of the right side of the rear axle.

[0115] Specifically, the second height variation is as follows:

[0116]

[0117] In the formula, z represents the second height change, z fl Indicates the height change of the left side of the front axle, z fr Indicates the height change of the right side of the front axle, z rl Indicates the height change of the left side of the rear axle, z rr Indicates the height change of the right side of the rear axle, sen fm Indicates the height change of the middle part of the front axle, sen rl Indicates the height change of the left side of the rear axle, sen rr Indicates the height change of the right side of the rear axle.

[0118] Further, in step S320, the step of obtaining the height change of the left side of the front axle based on the height change of the left side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle comprises:

[0119] Step S321, calculating the height change of the middle part of the front axle and the height change of the middle part of the rear axle to obtain the height change difference of the whole vehicle;

[0120] Specifically, the height change difference of the whole vehicle is calculated as follows:

[0121]

[0122] Step S322, calculating the height change of the left side of the rear axle and the height change difference of the whole vehicle to obtain the height change of the left side of the front axle;

[0123] Specifically, the height change of the left side of the front axle is calculated as follows:

[0124]

[0125] Further, in step S330, the step of obtaining the height change of the right side of the front axle based on the height change of the right side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle comprises:

[0126] Step S331, calculating the height change of the right side of the rear axle and the height change difference of the whole vehicle to obtain the height change of the right side of the front axle.

[0127] Specifically, the height change of the right side of the front axle is calculated as follows:

[0128]

[0129] This embodiment adopts the above scheme, specifically, based on the height change of the left side of the rear axle and the height change of the right side of the rear axle, obtains the height change of the middle part of the rear axle; calculates the height change of the middle part of the front axle and the height change of the middle part of the rear axle to obtain the height change difference of the whole vehicle; calculates the height change of the left side of the front axle and the height change difference of the whole vehicle; calculates the height change of the right side of the rear axle and the height change difference of the whole vehicle to obtain the height change of the right side of the front axle; based on the height change of the left side of the front axle, the height change of the right side of the front axle, the height change of the left side of the rear axle, and the height change of the right side of the rear axle, obtains the second height change. The height change between the axle and the frame at each suspension is calculated in real time through the geometric relationship of the suspension height sensor, and the center of mass position is obtained by dynamic identification, which solves the problem that the center of mass position cannot be calculated for a vehicle equipped with three suspension height sensors, and improves the calculation efficiency of the center of mass position.

[0130] Reference Figure 4, Figure 4 This is a flow chart of a third exemplary embodiment of a method for estimating the center of mass position based on a suspension height sensor of the present application. Figure 2 In the illustrated embodiment, step S230, based on the second height change and the force relationship corresponding to the second height change, the center of mass position of the target vehicle is obtained.

[0131] Step S400, obtaining a corresponding vertical force according to the second height change and the force relationship;

[0132] Specifically, according to the bench test implemented in advance, the force relationship corresponding to each test height change is obtained. In this way, the corresponding test height change can be obtained through the second height change, and the corresponding force relationship can be obtained, so as to obtain the vertical force between the axle (or wheel) and the frame (or load-bearing body) at the four suspensions of the whole vehicle: the vertical force F on the left side of the front axle fl , vertical force F on the right side of the front axle fr , vertical force on the rear side of the front axle F rl , vertical force F on the right side of the rear axle rr .

[0133] Step S410, obtaining the distance between the sensors based on the positions of the sensors;

[0134] Specifically, according to the geometric positions of the three suspension height sensors in the target vehicle, it is obtained that the distance between the two suspension height sensors of the rear axle is d, and the distance between the front axle suspension height sensor and the midpoints of the two height sensors of the rear axle is l.

[0135] Step S420, obtaining a centroid plane coordinate point of the centroid position based on the distance and the vertical force, wherein the centroid plane coordinate point is located in a preset coordinate system;

[0136] Specifically, the preset coordinate system is used to calculate the center of mass position of the target vehicle. Therefore, a spatial rectangular coordinate system is created according to the geometric relationship between each vertical force, thereby obtaining the reference point of the spatial rectangular coordinate system, wherein the reference point can be set according to the actual situation, and can be any suspension support point (i.e., the position where the vertical force corresponding to the suspension support point is located), and the direction of the spatial rectangular coordinate system can be set according to the actual situation and the reference point. Based on different reference points, the corresponding vertical force is obtained as a parameter of the formula for calculating the center of mass plane coordinate point, thereby obtaining the center of mass plane coordinate point of the center of mass.

[0137] Step S430, obtaining the centroid position based on the preset initial centroid height and the distance, the second height change, and the centroid plane coordinate point.

[0138] It should be noted that the centroid plane coordinate points are obtained from the spatial rectangular coordinate system described in the previous step. Therefore, based on different centroid plane coordinate points, the corresponding second height change is obtained as a parameter for the formula for calculating the centroid position.

[0139] Specifically, according to the initial centroid height, the distance between each sensor, the corresponding second height change, and the centroid plane coordinate point, the current centroid position of the target vehicle (entire vehicle) is obtained. In this embodiment, the position between the axle (or wheel) and the frame (or load-bearing body) at the suspension on the left side of the front axle is preferably used as the reference point, and the second height change selects the height change z of the right side of the front axle. fr , height change of the left side of the rear axle z rl , and then calculate with the coordinate point of the center of mass plane, and calculate the coordinates (x, y) of the center of mass of the whole vehicle on the XOY plane and the initial center of mass height z0, and get the coordinate z of the center of mass in the Z axis direction, and finally get the coordinates (x, y, z) of the center of mass position. The calculation formula of coordinate z is as follows:

[0140]

[0141] In the formula, z represents the z-axis coordinate of the center of mass, z0 represents the initial center of mass height, and z fr Indicates the height change of the right side of the front axle, z rl It represents the height change of the left side of the rear axle, y represents the y-axis coordinate of the center of mass, d represents the distance between the two suspension height sensors of the rear axle, x represents the x-axis coordinate of the center of mass, and l represents the distance between the front axle suspension height sensor and the midpoint of the two height sensors of the rear axle.

[0142] It should be noted that in other embodiments, other suspensions in the target vehicle may also be used as reference points, and the second height variation also changes accordingly. For example, the position between the axle (or wheel) and the frame (or load-bearing body) at the suspension on the left side of the rear axle is selected as the reference point, and the second height variation selects the height variation z of the left side of the rear axle. rl , height change of the right side of the rear axle z rr .

[0143] This embodiment adopts the above scheme, specifically, by obtaining the corresponding vertical force according to the second height change and the force relationship; obtaining the distance between the sensors based on the position of the sensors; obtaining the center of mass plane coordinate point of the center of mass position based on the distance and the vertical force, and the center of mass plane coordinate point is located in a preset coordinate system; obtaining the center of mass position based on the preset initial center of mass height and the distance, the second height change, and the center of mass plane coordinate point. By constructing a spatial rectangular coordinate system through the geometric relationship between the vertical forces, the center of mass position of the target vehicle can be calculated in real time, which can solve the problem that the center of mass position cannot be calculated by the three suspension height sensors of the existing vehicle models, thereby improving the safety of the target vehicle.

[0144] Reference Figure 5 , Figure 5 This is a flow chart of a fourth exemplary embodiment of a method for estimating the center of mass position based on a suspension height sensor of the present application. Figure 4 In the embodiment shown, step S420, based on the distance and the vertical force, obtaining the centroid plane coordinate point of the centroid position, wherein the centroid plane coordinate point is located in a preset coordinate system comprises:

[0145] Step S510, creating the coordinate system according to the geometric relationship corresponding to the vertical force, and obtaining the corresponding reference point;

[0146] Specifically, refer to Figure 6 , Figure 6 This is a schematic diagram of the coordinate system involved in the method for estimating the center of mass position based on the suspension height sensor of this application. As shown in the figure, the distance between the two suspension height sensors of the rear axle is d, and the distance between the front axle suspension height sensor and the midpoint of the two height sensors of the rear axle is l; the reference point of the spatial coordinate system is the left front suspension support point, and the direction is the XYZ coordinate system direction specified in GB / T19234-2003: that is, the positive direction of X points to the rear of the vehicle, the positive direction of Y points to the right of the vehicle, and the positive direction of Z points to the roof of the vehicle.

[0147] Step S520, calculating a first coordinate based on the reference point, the first length, and the vertical force;

[0148] Specifically, based on the vertical forces between the axle (or wheel) and the frame (or load-bearing body) on the four suspensions of the vehicle obtained in the previous step, the vertical forces on the left side of the front axle F fl , vertical force F on the right side of the front axle fr , vertical force on the rear side of the front axle F rl , vertical force F on the right side of the rear axle rrAccording to the geometric positions corresponding to the three suspension height sensors in the target vehicle, the distance between the two suspension height sensors on the rear axle of the target vehicle is obtained as the first length (d), and the distance between the front axle suspension height sensor and the midpoints of the two height sensors on the rear axle is obtained as the second length (l).

[0149] The first coordinate is calculated as follows:

[0150]

[0151] In the formula, x represents the x-axis coordinate of the center of mass, l represents the distance between the front axle suspension height sensor and the midpoints of the two rear axle height sensors, F represents the vertical force, and F rl Indicates the vertical force on the left side of the rear axle, F rr Indicates the vertical force on the right side of the rear axle, F fl Indicates the vertical force on the left side of the front axle, F fr Represents the vertical force on the right side of the front axle.

[0152] Step S530, calculating a second coordinate based on the reference point, the second length, and the vertical force;

[0153] Specifically, the second coordinate is calculated as follows:

[0154]

[0155] Specifically, y represents the y-axis coordinate of the center of mass, d represents the distance between the two suspension height sensors of the rear axle, F represents the vertical force, and F rl Indicates the vertical force on the left side of the rear axle, F rr Indicates the vertical force on the right side of the rear axle, F fl Indicates the vertical force on the left side of the front axle, F fr Represents the vertical force on the right side of the front axle.

[0156] Step S540: obtaining the centroid plane coordinate point based on the first coordinate and the second coordinate.

[0157] Specifically, based on the x-axis coordinates and y-axis coordinates obtained in the above steps, the coordinate point (x, y) of the center of mass of the vehicle on the XOY plane is obtained.

[0158] refer to Figure 7 , Figure 7This is a schematic flow chart of the steps involved in the method for estimating the center of mass position based on the suspension height sensor of this application. As shown in the figure, first, for the signal data corresponding to the three suspension height sensors, the height change between the axle (or wheel) and the frame (or load-bearing body) at the four suspensions is calculated; then, based on the height change between the axle (or wheel) and the frame (or load-bearing body) at the suspension of the current target vehicle obtained in advance from the bench test and the vertical force relationship, the vertical force between the axle (or wheel) and the frame (or load-bearing body) at the four suspensions of the current target vehicle (the whole vehicle) is obtained; then, the position of the center of mass of the whole vehicle on the XOY plane and the mass on the spring of the whole vehicle are calculated; finally, based on the height change and the position of the center of mass of the whole vehicle on the XOY plane, the position of the center of mass in the Z-axis direction is obtained, thereby obtaining the center of mass position.

[0159] This embodiment adopts the above scheme, specifically by creating the coordinate system according to the geometric relationship corresponding to the vertical force, and obtaining the corresponding reference point; based on the reference point, the first length, and the vertical force, the first coordinate is calculated; based on the reference point, the second length, and the vertical force, the second coordinate is calculated; based on the first coordinate and the second coordinate, the center of mass plane coordinate point is obtained. The center of mass position of the target vehicle is obtained by calculating the vertical force, and the calculation process is simple and easy, and can be simply and quickly embedded in a low-computing power platform to improve the calculation efficiency.

[0160] Reference Figure 8 , Figure 8 This is a flow chart of a fifth exemplary embodiment of a method for estimating the center of mass position based on a suspension height sensor of the present application. Figure 2 In the embodiment shown, after the step S230 of obtaining the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change, the method further includes:

[0161] Step S810: obtaining the sprung mass of the target vehicle based on a preset proportionality coefficient and a force relationship corresponding to the second height change.

[0162] Specifically, since the sprung mass of the entire vehicle is an indispensable physical quantity for both intelligent driving motion control technology research and actual engineering needs, the present embodiment of the application can calculate the sprung mass of the target vehicle (entire vehicle). According to the force relationship corresponding to the second height change, the vertical force corresponding to the second height change is obtained, and then based on the vertical force and the proportional coefficient, the sprung mass of the target vehicle is obtained. Specifically, it is shown in the following formula:

[0163]

[0164] Where m is the sprung mass of the target vehicle, 9.8 is 9.8 n / kg, F is the vertical force, and F is rl Indicates the vertical force on the left side of the rear axle, F rr Indicates the vertical force on the right side of the rear axle, F fl Indicates the vertical force on the left side of the front axle, F fr Represents the vertical force on the right side of the front axle.

[0165] Through the above scheme, this embodiment specifically obtains the first height change of the current target vehicle through the sensor; obtains the second height change based on the first height change and the geometric relationship corresponding to the first height change; obtains the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change; obtains the sprung mass of the target vehicle based on the preset proportional coefficient and the force relationship corresponding to the second height change. By calculating the vertical force in real time to obtain the sprung mass of the target vehicle, the problems of low calculation efficiency and poor versatility of the traditional weighing system can be solved, and the safety of the target vehicle can be improved.

[0166] Reference Fig. 9 , Fig. 9 This is a flow chart of a sixth exemplary embodiment of a method for estimating the center of mass position based on a suspension height sensor of the present application. Figure 2 In the embodiment shown, before the step S230, based on the second height change amount and the force relationship corresponding to the second height change amount, obtaining the center of mass position of the target vehicle, the method includes:

[0167] Step S101, obtaining each test height change and the test vertical force corresponding to the test height change through a preset bench test, wherein the test height change is one or more;

[0168] Specifically, the bench test is used to test the performance of the engine and related components of the target vehicle. Therefore, through the bench test, each test height change between the axle (or wheel) and the frame (or load-bearing body) is obtained, and the vertical force corresponding to each test height change is obtained. Among them, the test height change has one or more height changes, and correspondingly, the test vertical force has one or more vertical forces.

[0169] Step S102, based on the test height change and the test vertical force, obtain the force relationship corresponding to each test height change.

[0170] Specifically, according to the relationship between the test height variation obtained in the previous step and the corresponding test vertical force, the corresponding vertical force relationship between the axle (or wheel) and the frame (or load-bearing body) is obtained. In this way, when the center of mass position needs to be calculated in real time, the corresponding test height variation is obtained through the second height variation, and the corresponding force relationship is obtained, thereby correspondingly obtaining the magnitude of the vertical force between the axle (or wheel) and the frame (or load-bearing body) on the four suspensions of the target vehicle (complete vehicle).

[0171] This embodiment uses the above scheme, specifically through a preset bench test, to obtain each test height change and the test vertical force corresponding to the test height change, wherein the test height change is one or more; based on the test height change and the test vertical force, the force relationship corresponding to each test height change is obtained. By obtaining the force relationship corresponding to each test height change through a bench test, the vertical force corresponding to the current height change can be obtained. The calculation process is simple and easy, and can be simply and quickly embedded in a low-computing power platform to improve computing efficiency.

[0172] In addition, the embodiment of the present application further proposes a center of mass position estimation device based on a suspension height sensor, and the center of mass position estimation device based on a suspension height sensor includes:

[0173] An acquisition module, used for acquiring a first height change of the current target vehicle through a sensor;

[0174] a conversion module, configured to obtain a second height change amount according to the first height change amount and a geometric relationship corresponding to the first height change amount;

[0175] A calculation module is used to obtain the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change.

[0176] For the principle and implementation process of calculating the centroid position in this embodiment, please refer to the above embodiments and will not be repeated here.

[0177] In addition, an embodiment of the present application also proposes a terminal device, which includes a memory, a processor, and a center of mass position estimation program based on a suspension height sensor stored in the memory and executable on the processor. When the center of mass position estimation program based on the suspension height sensor is executed by the processor, the steps of the center of mass position estimation method based on the suspension height sensor as described above are implemented.

[0178] Since the center of mass position estimation program based on the suspension height sensor adopts all the technical solutions of all the aforementioned embodiments when executed by the processor, it has at least all the beneficial effects brought by all the technical solutions of all the aforementioned embodiments, which will not be described one by one here.

[0179] In addition, an embodiment of the present application also proposes a computer-readable storage medium, on which a center of mass position estimation program based on a suspension height sensor is stored. When the center of mass position estimation program based on the suspension height sensor is executed by a processor, the steps of the center of mass position estimation method based on the suspension height sensor as described above are implemented.

[0180] Since the center of mass position estimation program based on the suspension height sensor adopts all the technical solutions of all the aforementioned embodiments when executed by the processor, it has at least all the beneficial effects brought by all the technical solutions of all the aforementioned embodiments, which will not be described one by one here.

[0181] Compared with the prior art, the method for estimating the center of mass position based on the suspension height sensor proposed in the embodiment of the present application obtains the first height change of the current target vehicle through the sensor; obtains the second height change according to the geometric relationship corresponding to the first height change; obtains the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change. By obtaining the data information of the suspension height sensor and combining the geometric relationship of the sensor distribution to obtain the center of mass position of the target vehicle, the problem that the vehicle model equipped with three suspension height sensors cannot calculate the center of mass position can be solved, thereby improving the safety of the target vehicle. Based on the scheme of the present application, starting from the problem that many models in the real world automobile industry are not equipped with four suspension height sensors, a method for dynamic identification of the center of mass position of a vehicle is designed for vehicles equipped with only three suspension height sensors under different numbers of passengers and different load conditions. At the same time, the sprung mass of the vehicle is also calculated, which fills the gap in the center of mass position estimation algorithm of the previous three suspension height sensors, and the calculation process is simple and easy. Finally, the center of mass position calculated by the method of the present application can be simply and quickly embedded in a low computing power platform.

[0182] It should be noted that, in this article, the terms "include", "comprises" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, article or system including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or system. In the absence of further restrictions, an element defined by the sentence "comprises a ..." does not exclude the existence of other identical elements in the process, method, article or system including the element.

[0183] The serial numbers of the above-mentioned embodiments of the present application are for description only and do not represent the advantages or disadvantages of the embodiments.

[0184] Through the description of the above implementation methods, those skilled in the art can clearly understand that the above-mentioned embodiment methods can be implemented by means of software plus a necessary general hardware platform, and of course by hardware, but in many cases the former is a better implementation method. Based on such an understanding, the technical solution of the present application, or the part that contributes to the prior art, can be embodied in the form of a software product, which is stored in a storage medium (such as ROM / RAM, magnetic disk, optical disk) as above, and includes a number of instructions for a terminal device (which can be a mobile phone, a computer, a server, a controlled terminal, or a network device, etc.) to execute the method of each embodiment of the present application.

[0185] The above are only preferred embodiments of the present application, and are not intended to limit the patent scope of the present application. Any equivalent structure or equivalent process transformation made using the contents of the present application specification and drawings, or directly or indirectly applied in other related technical fields, are also included in the patent protection scope of the present application.

Claims

1. A method for estimating the center of mass position based on a suspension height sensor, characterized in that: The method for estimating the center of mass position based on the suspension height sensor comprises the following steps: Acquire a first height change of the current target vehicle through a sensor; According to the first height change amount and the geometric relationship corresponding to the first height change amount, a second height change amount is obtained, wherein the second height change amount is a height difference between an axle and a frame at a suspension of the target vehicle, and the first height change amount includes a height change amount of a middle portion of a front axle, a height change amount of a left side of a rear axle, and a height change amount of a right side of a rear axle; The step of obtaining the second height change amount according to the first height change amount and the geometric relationship corresponding to the first height change amount comprises: Based on the height changes of the left side of the rear axle and the right side of the rear axle, obtaining the height change of the middle part of the rear axle; Based on the height change of the left side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle, obtaining the height change of the left side of the front axle; Based on the height change of the right side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle, obtaining the height change of the right side of the front axle; Based on the height change of the left side of the front axle, the height change of the right side of the front axle, the height change of the left side of the rear axle, and the height change of the right side of the rear axle, the second height change is obtained; Based on the second height change and the force relationship corresponding to the second height change, obtaining the center of mass position of the target vehicle; Wherein, the step of obtaining the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change includes: Obtaining a corresponding vertical force according to the second height change and the force relationship; Based on the positions of the sensors, obtaining the distance between the sensors; Based on the distance and the vertical force, a centroid plane coordinate point of the centroid position is obtained, the centroid plane coordinate point is located in a preset coordinate system, and the distance includes a first length and a second length; Wherein, the step of obtaining the centroid plane coordinate point of the centroid position based on the distance and the vertical force, wherein the centroid plane coordinate point is located in a preset coordinate system comprises: creating the coordinate system according to the geometric relationship corresponding to the vertical force to obtain the corresponding reference point; calculating the first coordinate based on the reference point, the first length, and the vertical force; calculating the second coordinate based on the reference point, the second length, and the vertical force; and obtaining the centroid plane coordinate point based on the first coordinate and the second coordinate; The center of mass position is obtained based on the preset initial center of mass height and the distance, the second height change, and the center of mass plane coordinate point.

2. The method for estimating the center of mass position based on the suspension height sensor according to claim 1, characterized in that: The step of obtaining the height change of the left side of the front axle based on the height change of the left side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle comprises: Calculating the height change of the middle part of the front axle and the height change of the middle part of the rear axle to obtain the height change difference of the whole vehicle; Calculate the height change of the left side of the rear axle and the height change difference of the whole vehicle to obtain the height change of the left side of the front axle; The step of obtaining the height change of the right side of the front axle based on the height change of the right side of the rear axle, the height change of the middle part of the rear axle, and the height change of the middle part of the front axle comprises: The height change of the right side of the rear axle and the height change difference of the whole vehicle are calculated to obtain the height change of the right side of the front axle.

3. The method for estimating the center of mass position based on the suspension height sensor according to claim 1, characterized in that: After the step of obtaining the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change, the method further includes: Based on a preset proportionality coefficient and a force relationship corresponding to the second height change, the sprung mass of the target vehicle is obtained.

4. The method for estimating the center of mass position based on the suspension height sensor according to claim 1, characterized in that: Before the step of obtaining the center of mass position of the target vehicle based on the second height change and the force relationship corresponding to the second height change, the method further includes: Through a preset bench test, each test height change and the test vertical force corresponding to the test height change are obtained, and the test height change is one or more; Based on the test height change and the test vertical force, the force relationship corresponding to each test height change is obtained.

5. A center of mass position estimation device based on a suspension height sensor, characterized in that: The center of mass position estimation device based on the suspension height sensor includes: An acquisition module, used for acquiring a first height change of the current target vehicle through a sensor; a conversion module, configured to obtain a second height change amount according to the first height change amount and a geometric relationship corresponding to the first height change amount, wherein the second height change amount is a height difference between an axle and a frame at a suspension of the target vehicle, and the first height change amount includes a height change amount of a middle portion of a front axle, a height change amount of a left side of a rear axle, and a height change amount of a right side of a rear axle; The conversion module is further used to obtain a height change amount of the middle part of the rear axle based on the height change amount of the left side of the rear axle and the height change amount of the right side of the rear axle; obtain a height change amount of the left side of the front axle based on the height change amount of the left side of the rear axle, the height change amount of the middle part of the rear axle, and the height change amount of the middle part of the front axle; obtain a height change amount of the right side of the front axle based on the height change amount of the right side of the rear axle, the height change amount of the middle part of the rear axle, and the height change amount of the middle part of the front axle; obtain the second height change amount based on the height change amount of the left side of the front axle, the height change amount of the right side of the front axle, the height change amount of the left side of the rear axle, and the height change amount of the right side of the rear axle; A calculation module, configured to obtain a center of mass position of the target vehicle based on the second height change and a force relationship corresponding to the second height change; The calculation module is further used to obtain a corresponding vertical force according to the second height change and the force relationship; obtain a distance between the sensors based on the positions of the sensors; obtain a centroid plane coordinate point of the centroid position based on the distance and the vertical force, the centroid plane coordinate point is located in a preset coordinate system, and the distance includes a first length and a second length; The calculation module is also used to create the coordinate system according to the geometric relationship corresponding to the vertical force to obtain the corresponding reference point; calculate the first coordinate based on the reference point, the first length, and the vertical force; calculate the second coordinate based on the reference point, the second length, and the vertical force; obtain the center of mass plane coordinate point based on the first coordinate and the second coordinate; obtain the center of mass position based on the preset initial center of mass height and the distance, the second height change, and the center of mass plane coordinate point.

6. A terminal device, characterized in that: The terminal device includes a memory, a processor, and a center of mass position estimation program based on a suspension height sensor stored in the memory and executable on the processor. When the center of mass position estimation program based on the suspension height sensor is executed by the processor, the steps of the center of mass position estimation method based on the suspension height sensor as described in any one of claims 1-4 are implemented.

7. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a center of mass position estimation program based on a suspension height sensor, and when the center of mass position estimation program based on a suspension height sensor is executed by a processor, the steps of the center of mass position estimation method based on a suspension height sensor as described in any one of claims 1-4 are implemented.