Vehicle center of mass position calculation method, system, device and storage medium
Calculating the center of mass position of the car through inertial measurement sensors, the problem of economic reduction caused by adding sensors in the prior art is solved, and real-time, accurate calculation and economic improvement of the center of mass position of the car is achieved.
Patent Information
- Application Number
- CN202210808562.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-07-11
- Publication Date
- 2024-11-05
- Estimated Expiration
- 2042-07-11
AI Technical Summary
In the prior art, in order to calculate the position of the center of mass in real time, multiple suspension height or pressure sensors need to be added, resulting in a reduction in vehicle economy.
By obtaining vehicle parameter information and the attitude angle change measured by the inertial measurement sensor, calculating the rotation matrix, determining the height change amount and vertical force at the suspension support point, and then calculating the position of the car's centroid, only one inertial measurement unit is needed ( IMU), no need to add multiple suspension height or pressure sensors.
Real-time calculation of the center of mass position of non-active suspension vehicles is achieved, which improves the accuracy and economicality of automobile performance and reduces vehicle costs.
Smart Images

Figure CN115092169B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of vehicle technology, and in particular to a method, system, device and storage medium for calculating the center of mass position of a vehicle. Background Art
[0002] Due to the uncertainty of the weight and position of the cargo and the number and position of passengers, the mass and center of mass of the car also change. The change of the center of mass position and mass will lead to significant changes in the performance of the car, such as the braking performance, acceleration performance, anti-roll performance, etc. Therefore, real-time measurement of the mass and center of mass of the car is a key step in improving the performance of the car.
[0003] Currently, most of the real-time calculation methods for the center of mass position of a vehicle use suspension height or pressure sensors for measurement. However, for vehicles equipped with non-active suspension, adding multiple suspension height or pressure sensors will significantly reduce the vehicle's economy. Summary of the invention
[0004] The main purpose of the present application is to provide a method, system, device and storage medium for calculating the center of mass position of a vehicle, aiming to solve the technical problem in the prior art that adding multiple suspension height or pressure sensors will significantly reduce the economy of the vehicle.
[0005] To achieve the above object, the present application provides a method for calculating the center of mass position of a vehicle, the method comprising:
[0006] Acquire vehicle parameter information of the target vehicle, and calculate the initial center of mass position of the target vehicle based on the vehicle parameter information and a preset spatial coordinate system;
[0007] Acquire the attitude angle change measured by the preset inertial measurement sensor within the preset update period, and determine the target rotation matrix at the current moment based on the attitude angle change;
[0008] Based on the initial center of mass position, the vehicle parameter information and the target rotation matrix, calculate the height change corresponding to each suspension support point in the target vehicle, and determine the vertical force corresponding to each suspension support point based on each of the height changes;
[0009] Based on the vehicle parameter information, the initial center of mass position, the corresponding vertical force and height change at each suspension support point, the target center of mass position is calculated, and the target center of mass position is used as the initial center of mass position, and the center of mass position is used as the initial center of mass position, and the execution step is returned: the attitude angle change measured by the preset inertial measurement sensor within the preset update period is obtained, and based on the attitude angle change, the target rotation matrix at the current moment is determined.
[0010] Optionally, the vehicle parameter information includes a width distance between suspension support points on the left side of the front axle and the right side of the front axle, and a length distance between suspension support points on the left side of the front axle and the left side of the rear axle in the target vehicle;
[0011] The height changes corresponding to the respective suspension support points include the height changes corresponding to the suspension support points on the left side of the front axle, the right side of the front axle, the left side of the rear axle and the right side of the rear axle of the target vehicle;
[0012] The vertical forces corresponding to the various suspension support points include the vertical forces corresponding to the suspension support points on the left side of the front axle, the right side of the front axle, the left side of the rear axle and the right side of the rear axle of the target vehicle.
[0013] Optionally, the attitude angle change comprises attitude angle changes corresponding to the X-axis, the Y-axis and the Z-axis in the preset spatial coordinate system; and the step of determining the target rotation matrix at the current moment based on the attitude angle change comprises:
[0014] Based on the attitude angle changes corresponding to the X-axis, Y-axis and Z-axis, respectively calculate the rotation matrices corresponding to the X-axis, Y-axis and Z-axis;
[0015] The product of the rotation matrices of the X-axis, Y-axis, and Z-axis is calculated to obtain the target rotation matrix.
[0016] Optionally, the step of calculating the height variation corresponding to each suspension support point in the target vehicle based on the initial center of mass position, the vehicle parameter information and the target rotation matrix comprises:
[0017] Constructing a target space coordinate system with the initial centroid position as the coordinate origin;
[0018] Based on the initial center of mass position and the vehicle parameter information, calculating the support point coordinate position corresponding to each suspension support point in the target space coordinate system;
[0019] Based on the coordinate position of each support point, the target rotation matrix and the initial center of mass position, the height change corresponding to each suspension support point is calculated respectively.
[0020] Optionally, the step of calculating the target center of mass position based on the vehicle parameter information, the initial center of mass position, the vertical forces corresponding to each suspension support point, and the height variation comprises:
[0021] Calculating the center of mass plane coordinates of the target vehicle based on the width distance, the length distance and the vertical forces corresponding to the respective suspension support points;
[0022] Calculating the center of mass height of the target vehicle based on the coordinate position, the height position in the initial center of mass position, and the height change at each suspension support point;
[0023] The target center of mass position is determined based on the center of mass plane coordinates and the center of mass height.
[0024] Optionally, before the step of calculating the height variation corresponding to each suspension support point in the target vehicle, the step further includes:
[0025] Through the preliminary bench test, each test height change and the test vertical force corresponding to the test height change are obtained;
[0026] Based on the test height change and the test vertical force, determining a corresponding relationship between the test height change and the test vertical force;
[0027] The step of determining the vertical force corresponding to each suspension support point based on each of the height changes comprises:
[0028] Based on the corresponding relationship and each of the height changes, the vertical forces corresponding to each of the suspension support points are calculated respectively.
[0029] Optionally, after the step of determining the vertical force corresponding to each suspension support point based on each of the height changes, the vehicle center of mass position calculation method further includes:
[0030] The sprung mass of the target vehicle is calculated based on the gravitational acceleration and the corresponding vertical forces at the respective suspension support points.
[0031] The present application also provides a vehicle center of mass position estimation system, the vehicle center of mass position estimation system is a virtual system, and the vehicle center of mass position estimation system includes:
[0032] A first calculation module, used to obtain vehicle parameter information of the target vehicle, and calculate an initial center of mass position of the target vehicle and a sensor position of a preset inertial measurement sensor based on the vehicle parameter information and a preset spatial coordinate system;
[0033] A determination module, used to obtain the attitude angle change measured by a preset inertial measurement sensor within a preset update period, and determine the target rotation matrix at the current moment based on the attitude angle change;
[0034] A second calculation module is used to calculate the height change corresponding to each suspension support point in the target vehicle based on the initial center of mass position, the vehicle parameter information and the target rotation matrix, and determine the vertical force corresponding to each suspension support point based on each height change;
[0035] The third calculation module is used to calculate the target center of mass position based on the vehicle parameter information, the initial center of mass position, the corresponding vertical force and height change at each suspension support point, and use the target center of mass position as the initial center of mass position, and use the center of mass position as the initial center of mass position, and return to the execution step: obtain the attitude angle change measured by the preset inertial measurement sensor within the preset update period, and determine the target rotation matrix at the current moment based on the attitude angle change.
[0036] The present application also provides a vehicle center of mass position estimation device, which is a physical device. The vehicle center of mass position estimation device includes: a memory, a processor, and a vehicle center of mass position estimation program stored in the memory. The vehicle center of mass position estimation program is executed by the processor to implement the steps of the vehicle center of mass position calculation method as described above.
[0037] The present application also provides a storage medium, which is a computer-readable storage medium. The computer-readable storage medium stores a vehicle center of mass position estimation program, and the vehicle center of mass position estimation program is executed by a processor to implement the steps of the vehicle center of mass position calculation method as described above.
[0038] The present application provides a method, system, device and storage medium for calculating the center of mass position of a vehicle. The present application first obtains vehicle parameter information of a target vehicle, and based on the vehicle parameter information and a preset spatial coordinate system, calculates the initial center of mass position of the target vehicle and the sensor position of a preset inertial measurement sensor; obtains the attitude angle change measured by the preset inertial measurement sensor within a preset update period, and determines the target rotation matrix at the current moment based on the attitude angle change; calculates the height change corresponding to each suspension support point in the target vehicle based on the initial center of mass position, the vehicle parameter information and the target rotation matrix, and determines the vertical force corresponding to each suspension support point based on each height change; calculates the target vehicle based on the vehicle parameter information, the initial center of mass position, the vertical force corresponding to each suspension support point and the height change. The target center of mass position is determined, and the target center of mass position is used as the initial center of mass position, and the center of mass position is used as the initial center of mass position, and the execution step is returned to: the attitude angle change measured by the preset inertial measurement sensor within the preset update period is obtained, and based on the attitude angle change, the target rotation matrix at the current moment is determined, and the target rotation matrix is calculated based on the attitude angle change provided by the inertial measurement unit (IMU), so as to obtain the vertical force between the axle (or wheel) and the frame (or load-bearing body) at the four suspension support points based on the target rotation matrix and the center of mass position at the previous moment, and then the center of mass position of the whole vehicle is calculated, so that there is no need to add multiple suspension height or pressure sensors, and only one inertial measurement unit (IMU) needs to be added to complete the calculation and update of the center of mass position of the vehicle equipped with non-active suspension, so that the vehicle is more economical. BRIEF DESCRIPTION OF THE DRAWINGS
[0039] The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the present application and, together with the description, serve to explain the principles of the present application.
[0040] In order to more clearly illustrate the technical solutions in the embodiments of the present application or the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, for those skilled in the art, other drawings can be obtained based on these drawings without any creative work.
[0041] Figure 1 This is a schematic diagram of the flow chart of the first embodiment of the method for calculating the center of mass position of a vehicle of the present application;
[0042] Figure 2 A schematic diagram of a spatial coordinate system constructed with the left side of the front bridge as the coordinate origin in this application;
[0043] Figure 3A schematic diagram of a flow chart of a third embodiment of a method for calculating a vehicle center of mass position of the present application;
[0044] Figure 4 This is a flow chart of a fourth embodiment of a method for calculating the center of mass position of a vehicle of the present application;
[0045] Figure 5 This is a flow chart of the method for calculating the center of mass position of a vehicle in this application;
[0046] Figure 6 A schematic diagram of the structure of a vehicle center of mass position estimation device in a hardware operating environment involved in an embodiment of the present application;
[0047] Figure 7 Schematic diagram of the functional modules of the vehicle center of mass position estimation device of the present application.
[0048] The purpose, features and advantages of the present invention will be further described with reference to the accompanying drawings in conjunction with the embodiments. DETAILED DESCRIPTION
[0049] 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.
[0050] The present application provides a method for calculating the center of mass position of a vehicle. In the first embodiment of the method for calculating the center of mass position of a vehicle of the present application, refer to Figure 1 , the vehicle center of mass position calculation method includes:
[0051] Step S10, obtaining vehicle parameter information of the target vehicle, and calculating the initial center of mass position of the target vehicle and the sensor position of the preset inertial measurement sensor based on the vehicle parameter information and a preset spatial coordinate system;
[0052] In this embodiment, 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.
[0053] It should be noted that the preset inertial measurement sensor is an IMU inertial measurement sensor. Preferably, an IMU inertial measurement sensor is arranged on the target vehicle to measure the vehicle's attitude angle information. The preset spatial coordinate system is a spatial coordinate system constructed with the suspension support point of the target vehicle as the coordinate origin. The vehicle parameter information includes the width distance between the suspension support points on the left side of the front axle and the right side of the front axle in the target vehicle, and the length distance between the suspension support points on the left side of the front axle and the left side of the rear axle.
[0054] As an implementable method, specifically, the width distance between the suspension support points on the left side of the front axle and the right side of the front axle in the target vehicle, and the length distance between the suspension support points on the left side of the front axle and the left side of the rear axle are measured or determined, and then one suspension support point is selected from the four suspension support points of the target vehicle as the coordinate origin to construct the preset spatial coordinate system. In this embodiment, preferably, a spatial coordinate system is constructed with the left side of the front axle as the coordinate origin, and then based on the width distance and the length distance, the initial center of mass position of the target vehicle and the sensor position are calculated on the preset spatial coordinate system, for example, with reference to Figure 2 , Figure 2 This is a schematic diagram of the spatial coordinate system constructed with the left side of the front axle as the coordinate origin in this application, wherein the direction is the direction of the XYZ coordinate system specified in GB / T 19234-2003, that is, the positive direction of the X-axis points to the rear of the vehicle, the positive direction of the Y-axis points to the right side of the vehicle, and the positive direction of the Z-axis points to the roof. d represents the width distance between the suspension support points on the left side of the front axle and the right side of the front axle, l represents the length distance between the suspension support points on the left side of the front axle and the left side of the rear axle, and the sensor position is set to (0, d / 2, 0).
[0055] Step S20, obtaining the attitude angle change measured by the preset inertial measurement sensor within the preset update period, and determining the target rotation matrix at the current moment based on the attitude angle change;
[0056] In the present embodiment, it should be noted that the preset update period is the time interval for updating the center of mass position. For example, if the preset update period is 30 minutes, the center of mass position is updated every 30 minutes. Specifically, within the preset update period, the preset inertial measurement sensor is used to measure the attitude angle change of the target vehicle on the X-axis, Y-axis and Z-axis in the preset spatial coordinate system. Furthermore, based on the attitude angle change corresponding to the X-axis, Y-axis and Z-axis, the rotation matrices corresponding to the X-axis, Y-axis and Z-axis are calculated respectively. Furthermore, the product of the rotation matrices of the X-axis, Y-axis and Z-axis is calculated to obtain the target rotation matrix.
[0057] Wherein, the step of determining the target rotation matrix at the current moment based on the attitude angle change comprises:
[0058] Step S21, based on the attitude angle changes corresponding to the X-axis, Y-axis and Z-axis, respectively calculate the rotation matrices corresponding to the X-axis, Y-axis and Z-axis;
[0059] Step S21, calculating the product of the rotation matrices of the X-axis, Y-axis and Z-axis to obtain the target rotation matrix.
[0060] In this embodiment, specifically, based on the attitude angle changes corresponding to the X-axis, Y-axis and Z-axis, the rotation matrices corresponding to the X-axis, Y-axis and Z-axis are calculated respectively, wherein it should be noted that the XYZ three-axis direction after the preset inertial measurement sensor is installed is the same as the direction of the preset space coordinate system, wherein the formula for calculating the target rotation matrix is related to the attitude angle rotation mode (external rotation and internal rotation) and the rotation order, when the attitude angle adopts external rotation mode and rotates in the XYZ order, the calculation formula is as follows:
[0061]
[0062]
[0063]
[0064] Furthermore, the product of the rotation matrices of the X-axis, Y-axis, and Z-axis is calculated, and the product result is used as the target rotation matrix. The calculation formula is as follows:
[0065]
[0066] Among them, Yaw represents the attitude angle change corresponding to the Z axis, Pitc represents the attitude angle change corresponding to the Y axis, Roll represents the attitude angle change corresponding to the X axis, and R Z (Yaw) represents the rotation matrix corresponding to the Z axis, R Y (Pitch) represents the rotation matrix corresponding to the Y axis, R X (Roll) represents the rotation matrix corresponding to the X-axis, and R represents the target rotation matrix.
[0067] Step S30, calculating the height change corresponding to each suspension support point in the target vehicle based on the initial center of mass position, the vehicle parameter information and the target rotation matrix, and determining the vertical force corresponding to each suspension support point based on each height change;
[0068] In this embodiment, it should be noted that the height change corresponding to each suspension support point includes the height change at four suspension support points corresponding to the left side of the front axle, the right side of the front axle, the left side of the rear axle and the right side of the rear axle of the target vehicle, and the vertical force corresponding to each suspension support point includes the vertical force at four suspension support points corresponding to the left side of the front axle, the right side of the front axle, the left side of the rear axle and the right side of the rear axle of the target vehicle, wherein the height change is the height change between the axle and the frame, the axle and the load-bearing body, the wheel and the frame, or the wheel and the load-bearing body at the suspension support point, and the vertical force is the vertical force between the axle and the frame, the axle and the load-bearing body, the wheel and the frame, or the wheel and the load-bearing body at the suspension support point.
[0069] As an implementable method, specifically, first, a target space coordinate system is constructed with the initial center of mass position as the coordinate origin, and then based on the width distance and length distance in the vehicle parameter information, the support point coordinate positions corresponding to each suspension support point in the target vehicle in the target space coordinate system are calculated. For example, following the example of step S10 above, assuming that the space coordinate system is constructed with the left side of the front axle as the coordinate origin, the initial center of mass position is calculated to be (x0, y0, z0), the width distance is d, and the length distance is l, and then a new target space coordinate system is constructed with the initial center of mass position (x0, y0, z0) as the coordinate origin. In the target space coordinate system, the support point coordinate position on the left side of the front axle is calculated to be (-x0, -y0, -z0), the support point coordinate position on the right side of the front axle is (-x0, d-y0, -z0), the support point coordinate position on the right side of the rear axle is (l-x0, -y0, -z0), and the support point coordinate position on the right side of the rear axle is (l-x0, d-y0, -z0). Furthermore, based on the coordinate position of each support point, the target rotation matrix and the height coordinate of the Z axis in the initial center of mass position, the height change corresponding to each suspension support point is calculated respectively. Furthermore, before calculating the vertical force, the test vertical force corresponding to different test height changes is obtained through a pre-set bench test, and the corresponding relationship between the vertical forces of the height changes is determined according to each test height change and its corresponding test vertical force, wherein the bench test is an existing mature technology and will not be described in detail here, and then based on the corresponding height change at each suspension support point and the corresponding relationship between the vertical forces of the height changes measured by the bench test, the vertical forces corresponding to each suspension support point are calculated respectively.
[0070] Step S40, based on the vehicle parameter information, the initial center of mass position, the corresponding vertical force and height change at each suspension support point, calculate the target center of mass position, and use the target center of mass position as the initial center of mass position, and use the center of mass position as the initial center of mass position, return to the execution step: obtain the attitude angle change measured by the preset inertial measurement sensor within the preset update period, and determine the target rotation matrix at the current moment based on the attitude angle change.
[0071] In this embodiment, specifically, firstly, based on the width distance, the length distance and the vertical forces corresponding to the respective suspension support points, the coordinate position of the target vehicle's center of mass on the XOY plane is calculated according to the relationship between the vertical forces at the respective suspension support points, and then based on the coordinate position, the height position in the initial center of mass position and the height change at the respective suspension support points, the center of mass height of the target vehicle is calculated, and further, based on the center of mass plane coordinates and the center of mass height, the target center of mass position is determined, and after calculating the updated target center of mass position, the target center of mass position is used as the initial center of mass position, and the execution step is returned to: obtaining the attitude angle change measured by the preset inertial measurement sensor within the preset update period, and determining the target rotation matrix at the current moment based on the attitude angle change, so as to calculate the center of mass position corresponding to the next preset update period.
[0072] Additionally, after the step of determining the vertical force corresponding to each suspension support point based on each of the height changes, the vehicle center of mass position calculation method further includes:
[0073] Step a1, calculating the sprung mass of the target vehicle based on the gravitational acceleration and the corresponding vertical forces at the respective suspension support points.
[0074] In this embodiment, specifically, the calculation formula of the sprung mass is as follows:
[0075]
[0076] Among them, F fl Indicates the vertical force at the left suspension support point of the front axle, F fr It represents the vertical force at the right suspension support point of the front axle, F rl Indicates the vertical force at the left suspension support point of the rear axle, F rr represents the vertical force at the right suspension support point of the rear axle, and 9.8 represents the gravitational acceleration.
[0077] The embodiment of the present application adopts the above scheme, that is, obtaining the vehicle parameter information of the target vehicle, and calculating the initial center of mass position of the target vehicle and the sensor position of the preset inertial measurement sensor based on the vehicle parameter information and the preset spatial coordinate system; obtaining the attitude angle change measured by the preset inertial measurement sensor within a preset update period, and determining the target rotation matrix at the current moment based on the attitude angle change; calculating the height change corresponding to each suspension support point in the target vehicle based on the initial center of mass position, the vehicle parameter information and the target rotation matrix, and determining the vertical force corresponding to each suspension support point based on each height change; calculating the target center of mass position based on the vehicle parameter information, the initial center of mass position, the vertical force corresponding to each suspension support point and the height change, and converting the target center of mass position into the target center of mass. The target center of mass position is used as the initial center of mass position, and the center of mass position is used as the initial center of mass position, and the execution step is returned to: the attitude angle change measured by the preset inertial measurement sensor within the preset update period is obtained, and based on the attitude angle change, the target rotation matrix at the current moment is determined, so that the target rotation matrix is calculated based on the attitude angle change provided by the inertial measurement unit (IMU), and then the vertical force between the axle (or wheel) and the frame (or load-bearing body) at the four suspension support points is obtained based on the target rotation matrix and the center of mass position at the previous moment, and then the center of mass position of the whole vehicle is calculated, so there is no need to add multiple suspension height or pressure sensors, and only one inertial measurement unit (IMU) needs to be added to complete the calculation of the center of mass position of the vehicle equipped with non-active suspension, making the vehicle more economical.
[0078] Further, refer to Figure 3 Based on the first embodiment of the present application, in another embodiment of the present application, the step of calculating the height change corresponding to each suspension support point in the target vehicle based on the initial center of mass position, the vehicle parameter information and the target rotation matrix includes:
[0079] Step A10, constructing a target space coordinate system with the initial centroid position as the coordinate origin;
[0080] Step A20, calculating the support point coordinate position corresponding to each suspension support point in the target space coordinate system based on the initial center of mass position and the vehicle parameter information;
[0081] Step A30, based on the coordinate position of each support point, the target rotation matrix and the initial center of mass position, respectively calculate the height change corresponding to each suspension support point.
[0082] In this embodiment, specifically, the initial centroid position is used as the coordinate origin, and the three directions of the XYZ axis are consistent with the directions of the above-mentioned preset spatial coordinate system, so as to construct the target spatial coordinate system, and then in the target spatial coordinate system, based on the initial centroid position, the width distance and the length distance of the target vehicle, the corresponding support point coordinate position of each suspension support point is calculated respectively, and further, based on the coordinate position of each support point, the target rotation matrix and the initial centroid position, the corresponding height change amount at each suspension support point is calculated respectively, wherein, following the above example, assuming that the preset spatial coordinate system is constructed with the left side of the front bridge as the coordinate origin, the formula for calculating the height change amount is as follows:
[0083]
[0084] Wherein, R represents the target rotation matrix, (x0, y0, z0) represents the initial center of mass position, z0 represents the height position of the z axis in the initial center of mass position, and z fl Indicates the height change at the left suspension support point of the front axle, z fr Indicates the height change at the right suspension support point of the front axle, z rl Indicates the height change at the left suspension support point of the rear axle, z rr Indicates the height change at the right suspension support point of the rear axle.
[0085] This embodiment adopts the above scheme, that is, constructs a target space coordinate system with the initial center of mass position as the coordinate origin, and then calculates the support point coordinate position corresponding to each suspension support point in the target space coordinate system based on the initial center of mass position and the vehicle parameter information. Furthermore, based on each support point coordinate position, the target rotation matrix and the initial center of mass position, the corresponding height change at each suspension support point is calculated respectively, and the rotation matrix is calculated based on the vehicle attitude angle change measured by the inertial measurement sensor. Then, based on the rotation matrix and the center of mass position at the previous moment, the vertical force at the four suspension support points is obtained, thereby realizing real-time update of the center of mass position of the entire vehicle and improving the safety of the vehicle.
[0086] Further, refer to Figure 4 Based on the first embodiment of the present application, in another embodiment of the present application, the step of calculating the target center of mass position based on the vehicle parameter information, the initial center of mass position, the vertical force corresponding to each suspension support point, and the height change includes:
[0087] Step A20, calculating the center of mass plane coordinates of the target vehicle based on the width distance, the length distance and the vertical forces corresponding to the respective suspension support points;
[0088] Step A30, calculating the center of mass height of the target vehicle based on the coordinate position, the height position in the initial center of mass position and the height change at each suspension support point;
[0089] Step A40, determining the target center of mass position based on the center of mass plane coordinates and the center of mass height.
[0090] In this embodiment, it should be noted that the center of mass plane coordinates represent the coordinate position of the center of mass on the XOY plane, and the center of mass height represents the coordinate position of the center of mass in the Z-axis direction. Specifically, based on the width distance, the length distance and the vertical forces corresponding to each suspension support point, the coordinate position (x, y) of the center of mass of the target vehicle on the XOY plane of the preset space coordinate system is calculated according to the preset position calculation formula, wherein, following the above example, assuming that the preset space coordinate system is constructed with the left side of the front bridge as the coordinate origin, the preset position calculation formula is as follows:
[0091]
[0092]
[0093] Where x represents the x-axis coordinate position on the XOY plane, y represents the y-axis coordinate position on the XOY plane, and F fl Indicates the vertical force at the left suspension support point of the front axle, F fr It represents the vertical force at the right suspension support point of the front axle, F rl Indicates the vertical force at the left suspension support point of the rear axle, F rr Represents the vertical force at the suspension support point on the right side of the rear axle.
[0094] Further, based on the coordinate position, the height position in the initial center of mass position, the height change at the right suspension support point of the front axle, and the height change at the left suspension support point of the rear axle, or based on the coordinate position, the height position in the initial center of mass position, the height change at the left suspension support point of the front axle, and the height change at the right suspension support point of the rear axle, the coordinate position z of the center of mass of the target vehicle on the Z axis is calculated, wherein the coordinate position calculation formula on the Z axis is as follows:
[0095] or
[0096]
[0097] Wherein, z represents the mass center height. Thus, based on the mass center plane coordinates and the mass center height, the target mass center position can be determined.
[0098] The embodiment of the present application adopts the above scheme, that is, based on the width distance, the length distance and the corresponding vertical force at each suspension support point, the center of mass plane coordinates of the target vehicle are calculated, and then based on the coordinate position, the height position in the initial center of mass position and the height change at each suspension support point, the center of mass height of the target vehicle is calculated. Further, based on the center of mass plane coordinates and the center of mass height, the target center of mass position is determined, and the target center of mass position corresponding to the current update cycle is calculated based on the corresponding vertical force and height change at each suspension support point. Therefore, there is no need to add multiple suspension height or pressure sensors. Only one inertial measurement unit (IMU) needs to be added to complete the calculation and update of the center of mass position of a vehicle equipped with a non-active suspension, making the vehicle more economical.
[0099] Reference Figure 5 , Figure 5 The present invention is a flow chart of the method for calculating the center of mass position of a vehicle, wherein the initial center of mass coordinates represent the initial center of mass position, the sensor coordinates represent the sensor position, the update period represents the preset update period, the three attitude angle changes represent the attitude angle changes corresponding to the X-axis, Y-axis and Z-axis, the rotation matrix represents the target rotation matrix, and the height changes between the axle (or wheel) and the frame (or load-bearing body) at the four suspensions represent the height changes between the axle and the frame, the axle and the load-bearing body, the wheel and the frame, or the wheel and the load-bearing body at each suspension support point. The height change amount, the vertical force between the axle (or wheel) and the frame (or load-bearing body) at the four suspensions of the whole vehicle represents the vertical force between the axle and the frame, the axle and the load-bearing body, the wheel and the frame, or the wheel and the load-bearing body at each suspension support point, the height change amount and the vertical force relationship between the axle (or wheel) and the frame (or load-bearing body) represents the corresponding relationship, the position of the center of mass in the XOY plane represents the center of mass plane coordinates, the vehicle mass represents the sprung mass of the target vehicle, and the position of the center of mass in the z-axis direction represents the center of mass height.
[0100] Reference Figure 6 , Figure 6 It is a schematic diagram of the structure of a vehicle center of mass position estimation device in the hardware operating environment involved in the embodiment of the present application.
[0101] like Figure 6As shown, the vehicle center of mass position estimation device may include: a processor 1001, such as a CPU, a memory 1005, and a communication bus 1002. The communication bus 1002 is used to realize the connection and communication between the processor 1001 and the memory 1005. The memory 1005 may be a high-speed RAM memory or a stable memory (non-volatile memory), such as a disk memory. The memory 1005 may also be a storage device independent of the aforementioned processor 1001.
[0102] Optionally, the vehicle center of mass position estimation device may also include a rectangular user interface, a network interface, a camera, an RF (Radio Frequency) circuit, a sensor, an audio circuit, a WiFi module, etc. The rectangular user interface may include a display screen (Display), an input submodule such as a keyboard (Keyboard), and the optional rectangular user interface may also include a standard wired interface and a wireless interface. The network interface may optionally include a standard wired interface and a wireless interface (such as a WIFI interface).
[0103] Those skilled in the art will understand that Figure 6 The structure of the vehicle center of mass position estimation device shown in the figure does not constitute a limitation on the vehicle center of mass position estimation device, and may include more or fewer components than shown in the figure, or combine certain components, or arrange the components differently.
[0104] like Figure 6 As shown, the memory 1005 as a computer storage medium may include an operating system, a network communication module, and a vehicle center of mass position estimation program. The operating system is a program that manages and controls the hardware and software resources of the vehicle center of mass position estimation device, and supports the operation of the vehicle center of mass position estimation program and other software and / or programs. The network communication module is used to realize the communication between the components inside the memory 1005, and the communication with other hardware and software in the vehicle center of mass position estimation system.
[0105] exist Figure 6 In the vehicle center of mass position estimation device shown, the processor 1001 is used to execute the vehicle center of mass position estimation program stored in the memory 1005 to implement the steps of any of the above-mentioned vehicle center of mass position calculation methods.
[0106] The specific implementation of the vehicle center of mass position estimation device of the present application is basically the same as the various embodiments of the above-mentioned vehicle center of mass position calculation method, and will not be repeated here.
[0107] In addition, please refer to Figure 7 , Figure 7: is a functional module diagram of the vehicle center of mass position estimation device of the present application. The present application also provides a vehicle center of mass position estimation system, and the vehicle center of mass position estimation system includes:
[0108] A first calculation module, used to obtain vehicle parameter information of the target vehicle, and calculate an initial center of mass position of the target vehicle and a sensor position of a preset inertial measurement sensor based on the vehicle parameter information and a preset spatial coordinate system;
[0109] A determination module, used to obtain the attitude angle change measured by a preset inertial measurement sensor within a preset update period, and determine the target rotation matrix at the current moment based on the attitude angle change;
[0110] A second calculation module is used to calculate the height change corresponding to each suspension support point in the target vehicle based on the initial center of mass position, the vehicle parameter information and the target rotation matrix, and determine the vertical force corresponding to each suspension support point based on each height change;
[0111] The third calculation module is used to calculate the target center of mass position based on the vehicle parameter information, the initial center of mass position, the corresponding vertical force and height change at each suspension support point, and use the target center of mass position as the initial center of mass position, and use the center of mass position as the initial center of mass position, and return to the execution step: obtain the attitude angle change measured by the preset inertial measurement sensor within the preset update period, and determine the target rotation matrix at the current moment based on the attitude angle change.
[0112] Optionally, the determining module is further used for:
[0113] Based on the attitude angle changes corresponding to the X-axis, Y-axis and Z-axis, respectively calculate the rotation matrices corresponding to the X-axis, Y-axis and Z-axis;
[0114] The product of the rotation matrices of the X-axis, Y-axis, and Z-axis is calculated to obtain the target rotation matrix.
[0115] Optionally, the second calculation module is further used for:
[0116] Constructing a target space coordinate system with the initial centroid position as the coordinate origin;
[0117] Based on the initial center of mass position and the vehicle parameter information, calculating the support point coordinate position corresponding to each suspension support point in the target space coordinate system;
[0118] Based on the coordinate position of each support point, the target rotation matrix and the initial center of mass position, the height change corresponding to each suspension support point is calculated respectively.
[0119] Optionally, the third calculation module is further used for:
[0120] Calculating the center of mass plane coordinates of the target vehicle based on the width distance, the length distance and the vertical forces corresponding to the respective suspension support points;
[0121] Calculating the center of mass height of the target vehicle based on the coordinate position, the height position in the initial center of mass position, and the height change at each suspension support point;
[0122] The target center of mass position is determined based on the center of mass plane coordinates and the center of mass height.
[0123] Optionally, the vehicle center of mass position estimation system is further used for:
[0124] Through the preliminary bench test, each test height change and the test vertical force corresponding to the test height change are obtained;
[0125] Based on the test height change and the test vertical force, a corresponding relationship between the test height change and the test vertical force is determined.
[0126] Optionally, the vehicle center of mass position estimation system is further used for:
[0127] Based on the corresponding relationship and each of the height changes, the vertical forces corresponding to each of the suspension support points are calculated respectively.
[0128] Optionally, the vehicle center of mass position estimation system is further used for:
[0129] The sprung mass of the target vehicle is calculated based on the gravitational acceleration and the corresponding vertical forces at the respective suspension support points.
[0130] The specific implementation of the vehicle center of mass position estimation system of the present application is basically the same as the various embodiments of the above-mentioned vehicle center of mass position calculation method, and will not be repeated here.
[0131] An embodiment of the present application provides a storage medium, which is a computer-readable storage medium, and the computer-readable storage medium stores one or more programs, and the one or more programs can also be executed by one or more processors to implement the steps of the vehicle center of mass position calculation method described in any one of the above items.
[0132] The specific implementation of the computer-readable storage medium of the present application is basically the same as the various embodiments of the above-mentioned vehicle center of mass position calculation method, and will not be repeated here.
[0133] 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 processing scope of the present application.
Claims
1. A method for calculating the center of mass position of a vehicle, characterized in that: The vehicle center of mass position calculation method comprises: Acquire vehicle parameter information of the target vehicle, and calculate the initial center of mass position of the target vehicle based on the vehicle parameter information and a preset spatial coordinate system; Acquire the attitude angle change measured by a preset inertial measurement sensor within a preset update period, and determine the target rotation matrix at the current moment based on the attitude angle change; Based on the initial center of mass position, the vehicle parameter information and the target rotation matrix, calculate the height change corresponding to each suspension support point in the target vehicle, and determine the vertical force corresponding to each suspension support point based on each of the height changes; Based on the vehicle parameter information, the initial center of mass position, the vertical forces and height changes corresponding to the various suspension support points, the target center of mass position is calculated, and the target center of mass position is used as the initial center of mass position, and the execution step is returned to: the attitude angle change measured by the preset inertial measurement sensor within the preset update period is obtained, and based on the attitude angle change, the target rotation matrix at the current moment is determined; Wherein, the vehicle parameter information includes the width distance between the suspension support points on the left side of the front axle and the right side of the front axle in the target vehicle, and the length distance between the suspension support points on the left side of the front axle and the left side of the rear axle; the height change corresponding to each suspension support point includes the height change at the suspension support points corresponding to the left side of the front axle, the right side of the front axle, the left side of the rear axle and the right side of the rear axle of the target vehicle; the vertical force corresponding to each suspension support point includes the vertical force at the suspension support points corresponding to the left side of the front axle, the right side of the front axle, the left side of the rear axle and the right side of the rear axle of the target vehicle; The step of calculating the target center of mass position based on the vehicle parameter information, the initial center of mass position, the vertical forces corresponding to each suspension support point, and the height variation comprises: Calculating the center of mass plane coordinates of the target vehicle based on the width distance, the length distance and the vertical forces corresponding to the respective suspension support points; Calculating the center of mass height of the target vehicle based on the center of mass plane coordinates of the target vehicle, the height position in the initial center of mass position, and the height change at each suspension support point; Determining the target center of mass position based on the center of mass plane coordinates and the center of mass height; Wherein, before the step of calculating the height variation corresponding to each suspension support point in the target vehicle, the method further includes: Through the preliminary bench test, each test height change and the test vertical force corresponding to the test height change are obtained; Based on the test height change and the test vertical force, determining a corresponding relationship between the test height change and the test vertical force; The step of determining the vertical force corresponding to each suspension support point based on each of the height changes comprises: Based on the corresponding relationship and each of the height changes, the vertical forces corresponding to each of the suspension support points are calculated respectively.
2. The method for calculating the center of mass position of a vehicle according to claim 1, characterized in that: The attitude angle change includes attitude angle changes corresponding to the X-axis, Y-axis and Z-axis in the preset space coordinate system; The step of determining the target rotation matrix at the current moment based on the attitude angle change comprises: Based on the attitude angle changes corresponding to the X-axis, Y-axis and Z-axis, respectively calculate the rotation matrices corresponding to the X-axis, Y-axis and Z-axis; The product of the rotation matrices of the X-axis, Y-axis, and Z-axis is calculated to obtain the target rotation matrix.
3. The method for calculating the center of mass position of a vehicle according to claim 1, characterized in that: The step of calculating the height variation corresponding to each suspension support point in the target vehicle based on the initial center of mass position, the vehicle parameter information and the target rotation matrix comprises: Constructing a target space coordinate system with the initial centroid position as the coordinate origin; Based on the initial center of mass position and the vehicle parameter information, calculating the support point coordinate position corresponding to each suspension support point in the target space coordinate system; Based on the coordinate position of each support point, the target rotation matrix and the initial center of mass position, the height change corresponding to each suspension support point is calculated respectively.
4. The method for calculating the center of mass position of a vehicle according to claim 1, characterized in that: After the step of determining the vertical force corresponding to each suspension support point based on each of the height changes, the vehicle center of mass position calculation method further includes: The sprung mass of the target vehicle is calculated based on the gravitational acceleration and the corresponding vertical forces at the respective suspension support points.
5. A vehicle center of mass position estimation system, characterized in that: The vehicle center of mass position estimation system comprises: A first calculation module, used to obtain vehicle parameter information of the target vehicle, and calculate an initial center of mass position of the target vehicle and a sensor position of a preset inertial measurement sensor based on the vehicle parameter information and a preset spatial coordinate system; A determination module, used to obtain the attitude angle change measured by a preset inertial measurement sensor within a preset update period, and determine the target rotation matrix at the current moment based on the attitude angle change; A second calculation module is used to calculate the height change corresponding to each suspension support point in the target vehicle based on the initial center of mass position, the vehicle parameter information and the target rotation matrix, and determine the vertical force corresponding to each suspension support point based on each height change; The third calculation module is used to calculate the target center of mass position based on the vehicle parameter information, the initial center of mass position, the vertical force corresponding to each suspension support point, and the height change, and use the target center of mass position as the initial center of mass position, and use the center of mass position as the initial center of mass position, and return to the execution step: obtain the attitude angle change measured by the preset inertial measurement sensor within the preset update period, and determine the target rotation matrix at the current moment based on the attitude angle change; Wherein, the vehicle parameter information includes the width distance between the suspension support points on the left side of the front axle and the right side of the front axle in the target vehicle, and the length distance between the suspension support points on the left side of the front axle and the left side of the rear axle; the height change corresponding to each suspension support point includes the height change at the suspension support points corresponding to the left side of the front axle, the right side of the front axle, the left side of the rear axle and the right side of the rear axle of the target vehicle; the vertical force corresponding to each suspension support point includes the vertical force at the suspension support points corresponding to the left side of the front axle, the right side of the front axle, the left side of the rear axle and the right side of the rear axle of the target vehicle; Wherein, the third calculation module is further used for: Calculating the center of mass plane coordinates of the target vehicle based on the width distance, the length distance and the vertical forces corresponding to the respective suspension support points; Calculating the center of mass height of the target vehicle based on the center of mass plane coordinates of the target vehicle, the height position in the initial center of mass position, and the height change at each suspension support point; Determining the target center of mass position based on the center of mass plane coordinates and the center of mass height; Wherein, the vehicle center of mass position estimation system is also used for: Before the step of calculating the height variation corresponding to each suspension support point in the target vehicle, each test height variation and the test vertical force corresponding to the test height variation are obtained through a preliminary bench test; Based on the test height change and the test vertical force, determining a corresponding relationship between the test height change and the test vertical force; The step of determining the vertical force corresponding to each suspension support point based on each of the height changes comprises: Based on the corresponding relationship and each of the height changes, the vertical forces corresponding to each of the suspension support points are calculated respectively.
6. A vehicle center of mass position estimation device, characterized in that: The vehicle center of mass position estimation device comprises: a memory, a processor and a vehicle center of mass position estimation program stored in the memory, The vehicle center of mass position estimation program is executed by the processor to implement the steps of the vehicle center of mass position calculation method according to any one of claims 1 to 4.
7. A storage medium, the storage medium being a computer-readable storage medium, characterized in that: The computer-readable storage medium stores a vehicle center of mass position estimation program, and the vehicle center of mass position estimation program is executed by a processor to implement the steps of the vehicle center of mass position calculation method as described in any one of claims 1 to 4.
