A method and device for estimating vehicle center of mass sideslip angle
By observing the vehicle status and intelligently selecting the integral processing method, the problem of the inability to accurately observe the vehicle's centroid side deflection angle in the prior art is solved, and the vehicle stability control is improved.
Patent Information
- Application Number
- CN202311585792.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-11-24
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2043-11-24
AI Technical Summary
The prior art cannot accurately observe the changes in the center of mass deflection angle of the vehicle during steering driving in real time, resulting in poor vehicle stability control.
By observing the current state of the vehicle, intelligently select the activation of the integral clear, integral pause or integral recovery status flags, and perform corresponding processing on the center of mass side deflection integrator to determine the original value of the current center of mass side deflection, thereby achieving real-time and accurate center of mass side Decline angle estimate.
Real-time accurate observation and accurate determination of the stability state of the center of mass deflection changes during steering driving is achieved, and the stability control of the vehicle is improved.
Smart Images

Figure CN117400952B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of new energy vehicles, and in particular to a method and device for estimating the sideslip angle of the center of mass of a vehicle. Background Art
[0002] In vehicle stability control, yaw rate and center of mass sideslip angle are two important parameters that characterize vehicle stability. Among them, the effect of yaw rate on vehicle stability is relatively simple, while the effect of center of mass sideslip angle on vehicle stability is relatively complex. Due to the limitations of the test level and test cost of on-board sensors, it is very difficult to achieve real-time and accurate direct measurement of the center of mass sideslip angle during vehicle driving.
[0003] In the existing method of estimating the sideslip angle of the center of mass of a car using the direct integration method, useful sensor signals and noise signals are integrated at the same time, and the integration error will continue to accumulate. The estimation accuracy often cannot meet the requirements, and it is impossible to accurately observe the changes in the sideslip angle of the center of mass of the vehicle during steering in real time and make accurate judgments on the vehicle's stability state, resulting in poor vehicle stability control. Summary of the invention
[0004] In view of this, an embodiment of the present application provides a method and device for estimating the sideslip angle of the vehicle's center of mass, so as to solve the problem in the prior art that it is impossible to accurately observe the change of the sideslip angle of the vehicle's center of mass during turning in real time and make an accurate judgment on the vehicle's stability state, thereby causing poor vehicle stability control.
[0005] According to a first aspect of an embodiment of the present application, a method for estimating a vehicle center of mass sideslip angle is provided, comprising:
[0006] If it is determined that the current vehicle state of the vehicle is in a stationary state or the turning trend is not obvious, the integral clearing state flag is activated, and the center of mass side slip angle integrator is processed to clear the integral, and the current center of mass side slip angle original value of the vehicle is determined to be zero, wherein the center of mass side slip angle integrator is used to calculate and store the current center of mass side slip angle integral value of the vehicle in real time;
[0007] If it is determined that the current vehicle state of the vehicle is tending to a stable state, the integration pause state flag is activated, and the center of mass sideslip angle integrator is subjected to integration pause processing, and the center of mass sideslip angle integral value of the previous cycle calculated and stored by the center of mass sideslip angle integrator is determined as the current center of mass sideslip angle original value of the vehicle;
[0008] If it is determined that the current vehicle state of the vehicle is tending to be unstable, the integral recovery state flag is activated, and the center of mass sideslip angle integrator is subjected to integral recovery processing, and the center of mass sideslip angle integrator is used to calculate the current center of mass sideslip angle integral value of the vehicle, and the current center of mass sideslip angle integral value is determined as the current center of mass sideslip angle original value of the vehicle;
[0009] Based on the current raw value of the sideslip angle at the center of mass, an estimated value of the current sideslip angle at the center of mass of the vehicle is determined and output.
[0010] According to a second aspect of an embodiment of the present application, a vehicle center of mass sideslip angle estimation device is provided, comprising:
[0011] A first determination module is configured to activate an integral clearing state flag bit if it is determined that the current vehicle state of the vehicle is in a stationary state or a state in which the turning trend is not obvious, and to perform integral clearing processing on a center of mass side slip angle integrator, and to determine that the current center of mass side slip angle original value of the vehicle is zero, wherein the center of mass side slip angle integrator is used to calculate and store the current center of mass side slip angle integral value of the vehicle in real time;
[0012] The second determination module is configured to activate an integration pause state flag if it is determined that the current vehicle state of the vehicle is tending to a stable state, and perform integration pause processing on the center of mass sideslip angle integrator, and determine the center of mass sideslip angle integral value of the previous cycle calculated and stored by the center of mass sideslip angle integrator as the current center of mass sideslip angle original value of the vehicle;
[0013] A third determination module is configured to activate an integral recovery state flag if it is determined that the current vehicle state of the vehicle is tending to an unstable state, perform integral recovery processing on the center of mass sideslip angle integrator, calculate a current center of mass sideslip angle integral value of the vehicle using the center of mass sideslip angle integrator, and determine the current center of mass sideslip angle integral value as the current center of mass sideslip angle original value of the vehicle;
[0014] The fourth determination module is configured to determine and output an estimated value of a current center of mass sideslip angle of the vehicle based on the original value of the current center of mass sideslip angle.
[0015] According to a third aspect of an embodiment of the present application, an electronic device is provided, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the steps of the above method when executing the computer program.
[0016] According to a fourth aspect of an embodiment of the present application, a readable storage medium is provided, which stores a computer program, and when the computer program is executed by a processor, the steps of the above method are implemented.
[0017] Compared with the prior art, the beneficial effects of the embodiments of the present application include at least: by observing the current vehicle state of the vehicle, and based on the current vehicle state, determining whether the vehicle is in a stationary state or a state with an unclear turning trend / a state tending to be stable / a state tending to be unstable, and then intelligently selecting to activate the integral clearing state flag / integral pause state flag / integral recovery state flag for different states, so as to realize the integral clearing processing / integral pause processing / integral recovery processing of the center of mass sideslip angle integrator, and determine the current center of mass sideslip angle original value of the vehicle, and finally determine and output the current center of mass sideslip angle estimation value of the vehicle based on the current center of mass sideslip angle original value, so as to realize real-time and accurate observation of the change of the center of mass sideslip angle of the vehicle during turning driving, make accurate judgment on the vehicle stability state, and improve the stability control of the vehicle. BRIEF DESCRIPTION OF THE DRAWINGS
[0018] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative work.
[0019] Figure 1 It is a flow chart of a method for estimating the sideslip angle of the center of mass of a vehicle provided in an embodiment of the present application;
[0020] Figure 2 It is a structural schematic diagram of a vehicle center of mass sideslip angle estimation device provided in an embodiment of the present application;
[0021] Figure 3 It is a structural schematic diagram of an electronic device provided in an embodiment of the present application. DETAILED DESCRIPTION
[0022] In the following description, specific details such as specific system structures, technologies, etc. are provided for the purpose of illustration rather than limitation, so as to provide a thorough understanding of the embodiments of the present application. However, it should be clear to those skilled in the art that the present application may also be implemented in other embodiments without these specific details. In other cases, detailed descriptions of well-known systems, devices, circuits, and methods are omitted to prevent unnecessary details from obstructing the description of the present application.
[0023] A method and device for estimating the sideslip angle of the center of mass of a vehicle according to an embodiment of the present application will be described in detail below with reference to the accompanying drawings.
[0024] Figure 1 It is a flow chart of a vehicle center of mass sideslip angle estimation method provided in an embodiment of the present application. Figure 1The vehicle center of mass sideslip angle estimation method can be executed by the vehicle controller of the new energy vehicle, or by other controllers. Figure 1 As shown, the vehicle center of mass sideslip angle estimation method may specifically include the following steps:
[0025] Step S101, if it is determined that the current vehicle state is stationary or the turning trend is not obvious, then the integral clearing state flag is activated, and the center of mass sideslip angle integrator is integrated and cleared, and the current center of mass sideslip angle original value of the vehicle is determined to be zero, wherein the center of mass sideslip angle integrator is used to calculate and store the current center of mass sideslip angle integral value of the vehicle in real time.
[0026] Among them, the "state with unclear turning tendency" usually refers to the state where the vehicle's driving force reaches the adhesion limit, the vehicle's driving trajectory is basically consistent with the driver's expectations and is easy to control.
[0027] The integral clearing status flag is a flag used to indicate that the integral clearing processing of the center of mass sideslip angle integrator is performed. Numbers, letters, etc. can be used as marks. For example, the number "0" can be used to represent the integral clearing status flag.
[0028] The current original value of the center of mass sideslip angle is a center of mass sideslip angle value determined based on the current vehicle state of the vehicle.
[0029] The current center of mass sideslip angle integral value is related to the vehicle's lateral acceleration (transverse acceleration), longitudinal acceleration, vehicle speed, and yaw rate in the current cycle.
[0030] Lateral acceleration refers to the acceleration in a direction perpendicular to the direction of travel of the vehicle, which is the acceleration caused by the centrifugal force generated when the vehicle turns.
[0031] Longitudinal acceleration is the acceleration component of the vehicle in the direction of travel. It mainly controls the acceleration and deceleration braking of the vehicle and directly reflects the dynamic performance of the vehicle.
[0032] The integral clearing processing is performed on the center of mass sideslip angle integrator, specifically, the current center of mass sideslip angle integral value of the vehicle calculated and stored in real time by the center of mass sideslip angle integrator is cleared and reset to zero.
[0033] Step S102, if it is determined that the current vehicle state of the vehicle is tending to a stable state, the integration pause state flag is activated, and the center of mass sideslip angle integrator is subjected to integration pause processing, and the center of mass sideslip angle integral value of the previous cycle calculated and stored by the center of mass sideslip angle integrator is determined as the current center of mass sideslip angle original value of the vehicle.
[0034] Here, “tending to a stable state” generally refers to a state in which the yaw rate of the vehicle is in a downward trend.
[0035] The integration pause state flag is a flag used to indicate that the integration of the center of mass sideslip angle integrator is paused. It can be marked with numbers, letters, etc. For example, the number "1" can be used to represent the integration pause state flag.
[0036] The center of mass sideslip angle integrator is subjected to integration suspension processing, specifically, the center of mass sideslip angle integrator suspends calculating the current center of mass sideslip angle integral value of the vehicle.
[0037] Step S103, if it is determined that the current vehicle state of the vehicle is tending to an unstable state, the integral recovery state flag is activated, and the center of mass sideslip angle integrator is subjected to integral recovery processing, and the center of mass sideslip angle integrator is used to calculate the current center of mass sideslip angle integral value of the vehicle, and the current center of mass sideslip angle integral value is determined as the current center of mass sideslip angle original value of the vehicle.
[0038] Among them, "tending to an unstable state" usually refers to a state in which the vehicle's driving force reaches the adhesion limit, the vehicle's driving trajectory is inconsistent with the driver's expectations, and it is difficult to control.
[0039] The integral recovery state flag is a flag used to indicate the integral recovery processing of the center of mass sideslip angle integrator. It can be marked with numbers, letters, etc. For example, the number "2" can be used to represent the integral recovery state flag.
[0040] The center of mass sideslip angle integrator is subjected to an integral recovery process, specifically, the center of mass sideslip angle integrator is used to restart the calculation of the current center of mass sideslip angle integral value of the vehicle.
[0041] In order to facilitate distinction, the integral clearing status flag, the integral pausing status flag, and the integral resuming status flag can generally be marked with different numbers or letters.
[0042] Step S104, based on the original value of the current center of mass sideslip angle, determine and output the estimated value of the current center of mass sideslip angle of the vehicle.
[0043] The technical solution provided in the embodiment of the present application observes the current vehicle state of the vehicle, and determines whether the vehicle is in a stationary state or a state with an unclear turning trend / a state tending to be stable / a state tending to be unstable based on the current vehicle state, and then intelligently selects to activate the integral clearing state flag / integral pause state flag / integral recovery state flag for different states to realize the integral clearing processing / integral pause processing / integral recovery processing of the center of mass sideslip angle integrator, and determine the current center of mass sideslip angle original value of the vehicle, and finally, according to the current center of mass sideslip angle original value, determine and output the current center of mass sideslip angle estimation value of the vehicle, so as to realize real-time and accurate observation of the change of the center of mass sideslip angle of the vehicle during turning driving, make accurate judgment on the vehicle stability state, and improve the stability control of the vehicle.
[0044] In some embodiments, determining that the current vehicle state of the vehicle is stationary or has no obvious turning tendency includes:
[0045] Collect the lateral acceleration, yaw rate, vehicle speed and front wheel angle of the vehicle in the current cycle;
[0046] If the absolute value of the front wheel turning angle is less than the preset turning angle threshold, the absolute value of the yaw angular velocity is less than the preset angular velocity threshold, and the absolute value of the lateral acceleration is less than the preset lateral acceleration threshold; or the vehicle speed is less than the preset vehicle speed threshold, it is determined that the current vehicle state of the vehicle is at rest or has no obvious turning trend.
[0047] The current cycle can generally be understood as the current moment, while the previous cycle can be understood as the previous moment.
[0048] The vehicle control unit (VCU) can monitor and collect the vehicle's lateral acceleration, yaw angular velocity, vehicle speed and front wheel angle in real time in the current cycle through sensors installed on new energy vehicles.
[0049] The preset turning angle threshold can be flexibly set according to the actual situation, and can generally be set to 0.15 rad (radians).
[0050] The preset angular velocity threshold can be flexibly set according to actual conditions, and can generally be set to 0.1 rad / s (radians / second).
[0051] The preset lateral acceleration threshold can be flexibly set according to actual conditions, and can generally be set to 0.5m / s 2 .
[0052] The preset vehicle speed threshold can be flexibly set according to actual conditions, and can generally be set to 1km / h (kilometer / hour).
[0053] If the current vehicle state of the vehicle satisfies any one of the following conditions ① or ②, it can be determined that the current vehicle state of the vehicle is in a stable state:
[0054] Condition ①: The absolute value of the vehicle's front wheel steering angle is less than the preset steering angle threshold (such as 0.15 rad), the absolute value of the yaw angular velocity is less than the preset angular velocity threshold (such as 0.1 rad / s), and the absolute value of the lateral acceleration is less than the preset lateral acceleration threshold (such as 0.5 m / s 2 ), indicating that the vehicle’s turning trend is not obvious.
[0055] Condition ②: The vehicle speed is less than a preset speed threshold (such as 1 km / h).
[0056] In some embodiments, determining that the current vehicle state of the vehicle is approaching a stable state includes:
[0057] Collect the vehicle's yaw rate and front wheel angle in the current cycle;
[0058] Calculate the rate of change of yaw rate;
[0059] When the front wheel turning angle is greater than zero, if the rate of change of the yaw angular velocity is less than a preset first threshold value and the rate of change of the yaw angular velocity is greater than a preset second threshold value within the preset time period of the falling edge; or, if the rate of change of the yaw angular velocity is greater than a preset third threshold value, it is determined that the current vehicle state of the vehicle is tending to a stable state, wherein the first threshold value is less than zero, the second threshold value and the third threshold value are both greater than zero, and the second threshold value is less than the third threshold value;
[0060] When the front wheel turning angle is less than zero, if the rate of change of the yaw angular velocity is greater than a preset fourth threshold and the rate of change of the yaw angular velocity is less than a preset fifth threshold within a preset time period on the falling edge; or, the rate of change of the yaw angular velocity is less than a preset sixth threshold, then it is determined that the current vehicle state of the vehicle is tending to a stable state, wherein the fourth threshold is greater than zero, the fifth threshold and the sixth threshold are both less than zero, and the fifth threshold is greater than the sixth threshold.
[0061] When the front wheel turning angle is greater than zero, when the rate of change of the yaw angular velocity is less than the preset first threshold, further monitoring is performed to determine whether the rate of change of the yaw angular velocity is greater than the preset second threshold within the preset time period of the falling edge, so that the turning point can be found quickly and accurately. The third threshold is equivalent to a protection mechanism. When the rate of change of the yaw angular velocity of the vehicle is large (greater than the preset third threshold), the current vehicle state of the vehicle can be directly determined to be a stable state.
[0062] Similarly, when the front wheel turning angle is less than zero, when the rate of change of the yaw angular velocity is greater than the preset fourth threshold, further monitoring is performed to ensure that the rate of change of the yaw angular velocity is less than the preset fifth threshold within the preset time period at the falling edge, so that the turning point can be found quickly and accurately. The sixth threshold is equivalent to a protection mechanism. When the rate of change of the yaw angular velocity of the vehicle is very small (less than the preset sixth threshold), it can be directly determined that the current vehicle state is tending to be stable.
[0063] Specifically, the second-order derivative of the collected yaw angular velocity may be performed to calculate its rate of change.
[0064] In one embodiment, when the front wheel turning angle is greater than zero, the vehicle is in a left turn condition. At this time, if the vehicle satisfies any one of the following conditions ① or ②, it can be determined that the current vehicle state of the vehicle is tending to a stable state.
[0065] Condition ①: The rate of change of the yaw rate (i.e., the second-order derivative of the yaw rate) is less than the preset first threshold (usually a value less than 0, for example, it can be set to -0.03 rad / s2 The yaw rate is greater than a preset second threshold (usually a value greater than 0, for example, 0.01 rad / s) within a preset time period (which can be set according to actual conditions, generally 0.4 s) on the falling edge. 2 ), at this time, the curve at the inflection point is smooth, indicating that the yaw angular velocity begins to converge.
[0066] Condition ②: The rate of change of the yaw angular velocity is greater than a preset third threshold (usually a value greater than 0, and the third threshold is greater than the second threshold, for example, it can be set to 0.04 rad / s 2 ), at this time, the curve at the inflection point jumps, indicating that the yaw angular velocity has converged.
[0067] In another embodiment, when the front wheel turning angle is less than zero, the vehicle is in a right turn condition. At this time, if the vehicle meets any one of the following conditions ③ or ④, it can be determined that the current vehicle state of the vehicle is tending to be stable.
[0068] Condition ③: The rate of change of the yaw angular velocity is greater than the preset fourth threshold (usually a value greater than 0, for example, it can be set to 0.03 rad / s 2 ) and the rate of change of the yaw angular velocity within the preset time (which can be set according to the actual situation, generally can be set to 0.4s) on the falling edge is less than the preset fifth threshold (usually a value less than 0, for example, can be set to -0.01rad / s 2 ), at this time, the curve at the inflection point is smooth, indicating that the yaw angular velocity begins to converge.
[0069] Condition ④: The rate of change of the yaw angular velocity is less than the preset sixth threshold (usually a value less than 0, and the sixth threshold is less than the fifth threshold, for example, it can be set to -0.04 rad / s 2 ), at this time, the curve at the inflection point jumps, indicating that the yaw angular velocity has converged.
[0070] When the current vehicle state of the vehicle is tending to be stable, it indicates that the center of mass sideslip angle tends to decrease. At this time, the integration pause state flag is activated and the center of mass sideslip angle integrator is subjected to integration pause processing.
[0071] In some embodiments, determining that the current vehicle state of the vehicle is tending to be unstable includes:
[0072] Get the vehicle's yaw rate and saved yaw rate value in the current cycle;
[0073] Calculate the angular velocity difference between the absolute value of the yaw angular velocity and the stored yaw angular velocity value;
[0074] If the angular velocity difference is greater than a preset difference threshold, it is determined that the current vehicle state of the vehicle is tending to be unstable.
[0075] In some embodiments, the yaw rate stored value is determined by the following steps:
[0076] When the rising edge of the integration pause state flag is detected to be triggered for the first time, the absolute value of the first yaw angular velocity at the first triggering moment is saved as the yaw angular velocity saved value;
[0077] When it is detected that the integration pause state flag is triggered again, the absolute value of the second yaw angular velocity at the time of re-triggering is compared with the saved value of the yaw angular velocity;
[0078] If the absolute value of the second yaw velocity is greater than the stored yaw velocity value, and the absolute value of the second yaw velocity is greater than a preset yaw velocity threshold, the stored yaw velocity value is updated to the absolute value of the second yaw velocity.
[0079] Specifically, when the vehicle controller detects that the rising edge of the integral pause state flag is triggered for the first time, the absolute value of the first yaw angular velocity collected at the first triggering time (recorded as t1) is saved as the yaw angular velocity saved value. When the vehicle controller detects that the integral pause state flag is triggered again, the re-triggering time (recorded as t n , n is an integer greater than 1) and the currently saved yaw rate value. If the absolute value of the second yaw rate is greater than the saved yaw rate value, and the absolute value of the second yaw rate is greater than a preset yaw rate threshold (which can be flexibly set according to actual conditions, for example, can be set to 0.01 rad / s), the saved yaw rate value is updated to the absolute value of the second yaw rate.
[0080] As an example, assuming that the vehicle controller detects the first trigger of the rising edge of the integral pause state flag, the absolute value γ1 of the first yaw angular velocity collected at the first triggering time t1 is saved as the yaw angular velocity saved value γ Save ; Afterwards, if the vehicle controller detects that the integral pause state flag is triggered for the second time, then compare the absolute value γ2 of the second yaw angular velocity collected at the second triggering time t2 with the absolute value γ1 of the first yaw angular velocity; if the absolute value γ2 of the second yaw angular velocity is greater than the absolute value γ1 of the first yaw angular velocity, and the absolute value γ2 of the second yaw angular velocity is greater than 0.01rad / s, then save the yaw angular velocity value γ Save Update to the absolute value of the second yaw rate γ2. If the absolute value of the second yaw rate γ2 ≤ the absolute value of the first yaw rate γ1, and / or the absolute value of the second yaw rate γ2 < 0.01 rad / s, then the yaw rate value γ is not saved. SaveAfterwards, if the vehicle controller detects that the integral pause state flag is triggered for the third time, then the absolute value of the third yaw angular velocity γ3 collected at the third triggering time t3 is compared with the absolute value of the second yaw angular velocity γ2; if the absolute value of the third yaw angular velocity γ3> the absolute value of the second yaw angular velocity γ2, and the absolute value of the third yaw angular velocity γ3> 0.01rad / s, then the yaw angular velocity saved value γ Save Updated to the absolute value of the third yaw angular velocity γ3. It can be understood that if the vehicle controller detects that the integral pause state flag is triggered for the nth time, the nth triggering time t n The absolute value of the nth yaw rate collected is γ n and the size of the saved value of the yaw angular velocity; if the absolute value of the nth yaw angular velocity γ n > The yaw rate stored value, and the absolute value of the nth yaw rate γ n >0.01rad / s, then save the yaw angular velocity value γ Save Updated to the absolute value of the nth yaw rate γ n .
[0081] The preset difference threshold can be flexibly set according to actual conditions, and can generally be set to -0.05rad / s, etc.
[0082] The angular velocity difference between the absolute value of the yaw angular velocity and the stored yaw angular velocity value can be calculated according to the following formula (1).
[0083] σ=|γ|-γ Save (1)
[0084] In formula (1), σ represents the angular velocity difference, |γ| represents the absolute value of the yaw angular velocity (the current absolute value of the yaw angular velocity), and γ Save Indicates the stored value of the yaw rate.
[0085] If the angular velocity difference between the absolute value of the vehicle's yaw velocity in the current cycle and the saved yaw velocity value is greater than a preset difference threshold (such as -0.05 rad / s), it can be determined that the current vehicle state of the vehicle is tending to be unstable. At this time, the integral recovery state flag is activated, and the center of mass sideslip angle integrator is subjected to integral recovery processing, and the center of mass sideslip angle integrator is used to calculate the current center of mass sideslip angle integral value of the vehicle.
[0086] In some embodiments, calculating the current center of mass sideslip angle integral value of the vehicle using a center of mass sideslip angle integrator includes:
[0087] Get the lateral acceleration, longitudinal acceleration, vehicle speed and yaw rate of the vehicle in the current cycle;
[0088] The lateral acceleration, longitudinal acceleration, vehicle speed and yaw rate are input into the center-of-mass sideslip angle integrator to calculate the current center-of-mass sideslip angle integral value of the vehicle.
[0089] Specifically, the current center of mass sideslip angle integral value of the vehicle can be calculated according to formula (2).
[0090]
[0091] In formula (2), β represents the current center of mass sideslip angle integral value of the vehicle, Ay represents the lateral acceleration (lateral acceleration) of the vehicle, Ax represents the longitudinal acceleration of the vehicle, v represents the vehicle speed, and γ represents the yaw rate of the vehicle.
[0092] In some embodiments, determining and outputting a current center of mass sideslip angle estimate of the vehicle based on a current center of mass sideslip angle raw value includes:
[0093] If the current vehicle state of the vehicle is tending to be stable, then obtaining the saved value of the yaw angular velocity of the vehicle;
[0094] If the saved yaw rate value is greater than the current absolute value of the vehicle's yaw rate, the current center of mass sideslip angle original value is linearly processed to determine and output the current center of mass sideslip angle estimate of the vehicle.
[0095] As an example, if it is determined according to the above steps that the current vehicle state is stationary or the turning trend is not obvious, the integral reset state flag is activated, and the center of mass side slip angle integrator is reset. At this time, the current center of mass side slip angle integral value β is equal to zero, and the current center of mass side slip angle original value β of the vehicle is equal to zero. Raw = is equal to the current center of mass side slip angle integral value β is equal to zero, and at the same time, the yaw rate stored value needs to be cleared in this state, that is, in this state, the yaw rate stored value is equal to zero. In the above state, the vehicle's current center of mass side slip angle estimate value β est is zero.
[0096] If the current vehicle state of the vehicle is determined to be stable according to the above steps, the integration pause state flag is activated, and the center of mass side slip angle integrator is subjected to integration pause processing, and the center of mass side slip angle integral value of the previous cycle calculated and stored by the center of mass side slip angle integrator is determined as the current center of mass side slip angle original value of the vehicle. Afterwards, it is further determined whether the yaw rate stored value is greater than the current yaw rate absolute value of the vehicle in the current cycle. If the yaw rate stored value is greater than the current yaw rate absolute value, the current center of mass side slip angle original value β is calculated according to the following formula (3): Raw Perform linear processing to determine and output the vehicle's current center of mass sideslip angle estimate β estIf the saved yaw rate value is less than the current absolute value of the yaw rate, the original value of the current center of mass sideslip angle is not linearly processed, and the estimated value of the current center of mass sideslip angle of the vehicle is the integrated value of the center of mass sideslip angle of the previous cycle.
[0097]
[0098] In formula (3), β est represents the estimated value of the vehicle's current center of mass sideslip angle, γ Savt represents the saved value of yaw rate, |γ| represents the absolute value of the current yaw rate, β Eaw Indicates the original value of the current center of mass sideslip angle.
[0099] When the yaw rate is greater than the current absolute value of the yaw rate, it indicates that the yaw rate of the vehicle has a convergence trend. At this time, the current original value of the center of mass sideslip angle is linearly processed by the above formula (3), so that the center of mass sideslip angle of the vehicle can change with the change of the yaw rate, making the center of mass sideslip angle closer to the actual situation, the result is more accurate, and the real-time performance is better.
[0100] If the current vehicle state of the vehicle is determined to be unstable according to the above steps, the integral recovery state flag is activated, and the center of mass sideslip angle integrator is processed for integral recovery. The center of mass sideslip angle integral is used to calculate the current center of mass sideslip angle integral value of the vehicle according to the above formula (2). At this time, the original value of the current center of mass sideslip angle β Raw Equal to the current center of mass sideslip angle integral value β, the vehicle's current center of mass sideslip angle estimate β est is the integral value of the current center of mass sideslip angle.
[0101] The technical solution provided by the above embodiment is based on the lateral / longitudinal acceleration, yaw angular velocity and vehicle speed of the vehicle, and directly integrates and calculates the current center of mass sideslip angle integral value; and selects the yaw angular velocity as the main activation judgment index of the integral state flag of the center of mass sideslip angle integrator, and sets the integral mechanism (including integral clearing, integral suspension and integral recovery) by observing the change trend of the center of mass sideslip angle of the vehicle; specifically, if the vehicle is in a stationary state or the turning trend is not obvious, the integral clearing state flag is activated, and the center of mass sideslip angle integrator is cleared; if the vehicle tends to a stable state, the integral suspension state flag is activated, and the center of mass sideslip angle integrator is suspended; if the vehicle tends to an unstable state, the integral recovery state flag is activated, and the center of mass sideslip angle integrator is restored. The integration mechanism can effectively improve the accuracy and real-time performance of the vehicle's center of mass sideslip angle estimation, thereby achieving accurate judgment of vehicle stability and improving vehicle stability.
[0102] It is worth noting that in practical applications, under normal circumstances, the current vehicle state will not simultaneously satisfy at least two of the conditions of being stationary or having an inconspicuous turning trend, tending to a stable state, or tending to an unstable state. Under normal circumstances, the current vehicle state only satisfies any one of the conditions of being stationary or having an inconspicuous turning trend, tending to a stable state, or tending to an unstable state. In some special cases, if one or both of the activation integral clearing state flag bit and the integral pausing state flag bit or the integral resuming state flag bit are satisfied at the same time, the integral clearing process of the center of mass side slip angle integrator is preferentially executed, and then the integral pausing or integral resuming process of the center of mass side slip angle integrator is executed to ensure the accuracy and real-time performance of the estimation result of the center of mass side slip angle.
[0103] All the above optional technical solutions can be arbitrarily combined to form optional embodiments of the present application, which will not be described one by one here.
[0104] The following is an embodiment of the device of the present application, which can be used to execute the embodiment of the method of the present application. For details not disclosed in the embodiment of the device of the present application, please refer to the embodiment of the method of the present application.
[0105] Figure 2 Schematic diagram of a vehicle center of mass side slip angle estimation device provided in an embodiment of the present application. Figure 2 As shown, the vehicle center of mass sideslip angle estimation device includes:
[0106] The first determination module 201 is configured to activate the integral clearing state flag bit if it is determined that the current vehicle state of the vehicle is in a stationary state or a state in which the turning trend is not obvious, and perform integral clearing processing on the center of mass side slip angle integrator, and determine that the current center of mass side slip angle original value of the vehicle is zero, wherein the center of mass side slip angle integrator is used to calculate and store the current center of mass side slip angle integral value of the vehicle in real time;
[0107] The second determination module 202 is configured to activate the integration suspension state flag bit if it is determined that the current vehicle state of the vehicle is tending to a stable state, and perform integration suspension processing on the center of mass sideslip angle integrator, and determine the center of mass sideslip angle integral value of the previous cycle calculated and stored by the center of mass sideslip angle integrator as the current center of mass sideslip angle original value of the vehicle;
[0108] The third determination module 203 is configured to activate the integral recovery state flag bit if it is determined that the current vehicle state of the vehicle is tending to an unstable state, and perform integral recovery processing on the center of mass sideslip angle integrator, and calculate the current center of mass sideslip angle integral value of the vehicle by using the center of mass sideslip angle integrator, and determine the current center of mass sideslip angle integral value as the current center of mass sideslip angle original value of the vehicle;
[0109] The fourth determination module 204 is configured to determine and output a current center of mass sideslip angle estimate value of the vehicle based on the current center of mass sideslip angle original value.
[0110] The technical solution provided in the embodiment of the present application observes the current vehicle state of the vehicle, and determines whether the vehicle is in a stationary state or a state with an unclear turning trend / a state tending to be stable / a state tending to be unstable based on the current vehicle state, and then intelligently selects to activate the integral clearing state flag / integral pause state flag / integral recovery state flag for different states to realize the integral clearing processing / integral pause processing / integral recovery processing of the center of mass sideslip angle integrator, and determine the current center of mass sideslip angle original value of the vehicle, and finally, according to the current center of mass sideslip angle original value, determine and output the current center of mass sideslip angle estimation value of the vehicle, so as to realize real-time and accurate observation of the change of the center of mass sideslip angle of the vehicle during turning driving, make accurate judgment on the vehicle stability state, and improve the stability control of the vehicle.
[0111] In some embodiments, the first determination module 201 includes a first determination unit configured to determine whether the current vehicle state of the vehicle is stationary or has an unclear turning trend.
[0112] The first determining unit includes:
[0113] A first acquisition component is configured to acquire the lateral acceleration, yaw rate, vehicle speed and front wheel angle of the vehicle in a current cycle;
[0114] The first determination component is configured to determine that the current vehicle state of the vehicle is at rest or has no obvious turning trend if the absolute value of the front wheel steering angle is less than a preset steering angle threshold, the absolute value of the yaw angular velocity is less than a preset angular velocity threshold, and the absolute value of the lateral acceleration is less than a preset lateral acceleration threshold; or the vehicle speed is less than a preset vehicle speed threshold.
[0115] In some embodiments, the second determination module 202 includes a second determination unit configured to determine that the current vehicle state of the vehicle is tending to a stable state.
[0116] The second determining unit includes:
[0117] A second collection component is configured to collect the yaw rate and front wheel angle of the vehicle in the current cycle;
[0118] a calculation component configured to calculate a rate of change of a yaw rate;
[0119] A second determination component is configured to determine that the current vehicle state of the vehicle is tending to be a stable state if the rate of change of the yaw angular velocity is less than a preset first threshold value and the rate of change of the yaw angular velocity is greater than a preset second threshold value within a preset time period when the falling edge is maintained when the front wheel turning angle is greater than zero; or the rate of change of the yaw angular velocity is greater than a preset third threshold value, wherein the first threshold value is less than zero, the second threshold value and the third threshold value are both greater than zero, and the second threshold value is less than the third threshold value;
[0120] The third determination component is configured to determine that the current vehicle state of the vehicle is tending to a stable state if the rate of change of the yaw angular velocity is greater than a preset fourth threshold and the rate of change of the yaw angular velocity is less than a preset fifth threshold within a preset time period on the falling edge when the front wheel turning angle is less than zero; or, the rate of change of the yaw angular velocity is less than a preset sixth threshold, wherein the fourth threshold is greater than zero, the fifth threshold and the sixth threshold are both less than zero, and the fifth threshold is greater than the sixth threshold.
[0121] In some embodiments, the third determination module 203 includes a third determination unit, which is configured to determine that the current vehicle state of the vehicle is tending to be unstable.
[0122] The third determining unit includes:
[0123] An acquisition component configured to acquire and store a yaw rate and a yaw rate of the vehicle in a current cycle;
[0124] a difference calculation component configured to calculate an angular velocity difference between an absolute value of the yaw angular velocity and a stored yaw angular velocity value;
[0125] The state determination component is configured to determine that the current vehicle state of the vehicle is tending to be unstable if the angular velocity difference is greater than a preset difference threshold.
[0126] In some embodiments, the yaw rate stored value is determined by the following steps:
[0127] When the rising edge of the integration pause state flag is detected to be triggered for the first time, the absolute value of the first yaw angular velocity at the first triggering moment is saved as the yaw angular velocity saved value;
[0128] When it is detected that the integration pause state flag is triggered again, the absolute value of the second yaw angular velocity at the time of re-triggering is compared with the saved value of the yaw angular velocity;
[0129] If the absolute value of the second yaw velocity is greater than the stored yaw velocity value, and the absolute value of the second yaw velocity is greater than a preset yaw velocity threshold, the stored yaw velocity value is updated to the absolute value of the second yaw velocity.
[0130] In some embodiments, the fourth determining module 204 includes:
[0131] an acquisition unit configured to acquire a saved value of a yaw angular velocity of the vehicle if the current vehicle state of the vehicle is tending to be stable;
[0132] The processing unit is configured to perform linear processing on the original value of the current center of mass sideslip angle if the stored yaw rate value is greater than the current absolute value of the yaw rate of the vehicle, and determine and output the estimated value of the current center of mass sideslip angle of the vehicle.
[0133] In some embodiments, the third determination module 203 includes an integral calculation unit configured to calculate a current center of mass sideslip angle integral value of the vehicle using a center of mass sideslip angle integrator.
[0134] The integral calculation unit includes:
[0135] A parameter acquisition component is configured to acquire the lateral acceleration, longitudinal acceleration, vehicle speed and yaw rate of the vehicle in a current cycle;
[0136] The integral calculation component is configured to input the lateral acceleration, longitudinal acceleration, vehicle speed and yaw rate into the center of mass sideslip angle integrator to calculate the current center of mass sideslip angle integral value of the vehicle.
[0137] It should be understood that the size of the serial numbers of the steps in the above embodiments does not mean the order of execution. The execution order of each process should be determined by its function and internal logic, and should not constitute any limitation on the implementation process of the embodiments of the present application.
[0138] Figure 3 Schematic diagram of an electronic device 3 provided in an embodiment of the present application. Figure 3 As shown, the electronic device 3 of this embodiment includes: a processor 301, a memory 302, and a computer program 303 stored in the memory 302 and executable on the processor 301. When the processor 301 executes the computer program 303, the steps in the above-mentioned method embodiments are implemented. Alternatively, when the processor 301 executes the computer program 303, the functions of the modules / units in the above-mentioned device embodiments are implemented.
[0139] The electronic device 3 may be a desktop computer, a notebook, a PDA, a cloud server, or other electronic device. The electronic device 3 may include, but is not limited to, a processor 301 and a memory 302. Those skilled in the art will appreciate that Figure 3 The electronic device 3 is merely an example and does not limit the electronic device 3 , and may include more or less components than those shown in the figure, or different components.
[0140] The processor 301 may be a central processing unit (CPU), or other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA), or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc.
[0141] The memory 302 may be an internal storage unit of the electronic device 3, for example, a hard disk or memory of the electronic device 3. The memory 302 may also be an external storage device of the electronic device 3, for example, a plug-in hard disk, a smart media card (SMC), a secure digital (SD) card, a flash card, etc. equipped on the electronic device 3. The memory 302 may also include both an internal storage unit of the electronic device 3 and an external storage device. The memory 302 is used to store computer programs and other programs and data required by the electronic device.
[0142] Those skilled in the art can clearly understand that for the convenience and simplicity of description, only the division of the above-mentioned functional units and modules is used as an example. In actual applications, the above-mentioned functions can be assigned to different functional units and modules as needed, that is, the internal structure of the device can be divided into different functional units or modules to complete all or part of the functions described above. The functional units and modules in the embodiments can be integrated into one processing unit, or each unit can exist physically separately, or two or more units can be integrated into one unit. The above-mentioned integrated unit can be implemented in the form of hardware or in the form of software functional units.
[0143] If the integrated module / unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a readable storage medium (e.g., a computer-readable storage medium). Based on this understanding, the present application implements all or part of the processes in the above-mentioned embodiment method, and can also be completed by instructing the relevant hardware through a computer program. The computer program can be stored in a computer-readable storage medium, and the computer program can implement the steps of the above-mentioned various method embodiments when executed by the processor. The computer program may include computer program code, which may be in source code form, object code form, executable file or some intermediate form. Computer-readable storage media may include: any entity or device capable of carrying computer program code, recording medium, U disk, mobile hard disk, disk, optical disk, computer memory, read-only memory (ROM), random access memory (RAM), electric carrier signal, telecommunication signal and software distribution medium, etc.
[0144] The above embodiments are only used to illustrate the technical solutions of the present application, rather than to limit them. Although the present application has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some of the technical features therein. These modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present application, and should all be included in the protection scope of the present application.
Claims
1. A method for estimating a vehicle center of mass sideslip angle, characterized in that: include: If it is determined that the current vehicle state of the vehicle is in a stationary state or a state in which the turning trend is not obvious, the integral clearing state flag is activated, and the center of mass side slip angle integrator is subjected to integral clearing processing, and it is determined that the current center of mass side slip angle original value of the vehicle is zero, wherein the center of mass side slip angle integrator is used to calculate and store the current center of mass side slip angle integral value of the vehicle in real time; If it is determined that the current vehicle state of the vehicle is tending to a stable state, the integration pause state flag is activated, and the center of mass sideslip angle integrator is subjected to integration pause processing, and the center of mass sideslip angle integral value of the previous cycle calculated and stored by the center of mass sideslip angle integrator is determined as the current center of mass sideslip angle original value of the vehicle; If it is determined that the current vehicle state of the vehicle is tending to an unstable state, the integral recovery state flag is activated, and the center of mass sideslip angle integrator is subjected to integral recovery processing, and the center of mass sideslip angle integrator is used to calculate the current center of mass sideslip angle integral value of the vehicle, and the current center of mass sideslip angle integral value is determined as the current center of mass sideslip angle original value of the vehicle; Based on the current raw value of the sideslip angle at the center of mass, an estimated value of the sideslip angle at the center of mass of the vehicle is determined and output.
2. The method according to claim 1, characterized in that Determining that the current vehicle state of the vehicle is stationary or has no obvious turning tendency includes: Collecting the lateral acceleration, yaw rate, vehicle speed and front wheel turning angle of the vehicle in the current cycle; If the absolute value of the front wheel turning angle is less than a preset turning angle threshold, the absolute value of the yaw angular velocity is less than a preset angular velocity threshold, and the absolute value of the lateral acceleration is less than a preset lateral acceleration threshold; or, the vehicle speed is less than a preset vehicle speed threshold, it is determined that the current vehicle state of the vehicle is at rest or has an unclear turning trend.
3. The method according to claim 1, characterized in that: Determining that the current vehicle state of the vehicle is tending to a stable state includes: Collect the vehicle's yaw rate and front wheel angle in the current cycle; calculating a rate of change of the yaw angular velocity; When the front wheel turning angle is greater than zero, if the rate of change of the yaw angular velocity is less than a preset first threshold value and the rate of change of the yaw angular velocity is greater than a preset second threshold value within a preset time period when the falling edge is maintained; or, if the rate of change of the yaw angular velocity is greater than a preset third threshold value, it is determined that the current vehicle state of the vehicle is tending to a stable state, wherein the first threshold value is less than zero, the second threshold value and the third threshold value are both greater than zero, and the second threshold value is less than the third threshold value; When the front wheel turning angle is less than zero, if the rate of change of the yaw angular velocity is greater than a preset fourth threshold and the rate of change of the yaw angular velocity is less than a preset fifth threshold within a preset time period on the falling edge; or, the rate of change of the yaw angular velocity is less than a preset sixth threshold, it is determined that the current vehicle state of the vehicle is tending to a stable state, wherein the fourth threshold is greater than zero, the fifth threshold and the sixth threshold are both less than zero, and the fifth threshold is greater than the sixth threshold.
4. The method according to claim 1, characterized in that: Determining that the current vehicle state of the vehicle is tending to be an unstable state includes: Obtaining the yaw rate and the saved yaw rate value of the vehicle in the current cycle; Calculate the angular velocity difference between the absolute value of the yaw angular velocity and the stored yaw angular velocity value; If the angular velocity difference is greater than a preset difference threshold, it is determined that the current vehicle state of the vehicle is tending to be unstable.
5. The method according to claim 4, characterized in that The stored yaw rate value is determined by the following steps: When it is detected that the rising edge of the integration pause state flag is triggered for the first time, the absolute value of the first yaw angular velocity at the first triggering moment is saved as the yaw angular velocity saved value; When it is detected that the integration pause state flag is triggered again, comparing the absolute value of the second yaw angular velocity at the time of re-triggering with the stored yaw angular velocity value; If the absolute value of the second yaw velocity is greater than the stored yaw velocity value, and the absolute value of the second yaw velocity is greater than a preset yaw velocity threshold, the stored yaw velocity value is updated to the absolute value of the second yaw velocity.
6. The method according to claim 1, characterized in that Determining and outputting a current center of mass sideslip angle estimate value of the vehicle based on the current center of mass sideslip angle original value includes: If the current vehicle state of the vehicle is tending to be stable, obtaining a saved value of the yaw angular velocity of the vehicle; If the stored yaw rate value is greater than the current absolute value of the yaw rate of the vehicle, the current original value of the center of mass sideslip angle is linearly processed to determine and output an estimated value of the current center of mass sideslip angle of the vehicle.
7. The method according to claim 1, characterized in that Calculating the current center of mass sideslip angle integral value of the vehicle by using the center of mass sideslip angle integrator includes: Obtaining the lateral acceleration, longitudinal acceleration, vehicle speed and yaw rate of the vehicle in the current cycle; The lateral acceleration, longitudinal acceleration, vehicle speed and yaw rate are input into the center-of-mass sideslip angle integrator to calculate the current center-of-mass sideslip angle integral value of the vehicle.
8. A vehicle center of mass sideslip angle estimation device, characterized in that: include: A first determination module is configured to activate an integral clearing state flag bit if it is determined that the current vehicle state of the vehicle is in a stationary state or a state in which the turning trend is not obvious, and to perform integral clearing processing on a center of mass side slip angle integrator, and to determine that the current center of mass side slip angle original value of the vehicle is zero, wherein the center of mass side slip angle integrator is used to calculate and store the current center of mass side slip angle integral value of the vehicle in real time; A second determination module is configured to activate an integration pause state flag if it is determined that the current vehicle state of the vehicle is tending to a stable state, and perform integration pause processing on a center of mass sideslip angle integrator, and determine the center of mass sideslip angle integral value of the previous cycle calculated and stored by the center of mass sideslip angle integrator as the current center of mass sideslip angle original value of the vehicle; A third determination module is configured to activate an integral recovery state flag if it is determined that the current vehicle state of the vehicle is tending to an unstable state, perform integral recovery processing on a center of mass sideslip angle integrator, calculate a current center of mass sideslip angle integral value of the vehicle using the center of mass sideslip angle integrator, and determine the current center of mass sideslip angle integral value as a current center of mass sideslip angle original value of the vehicle; The fourth determination module is configured to determine and output an estimated value of a current center of mass sideslip angle of the vehicle based on the current original value of the center of mass sideslip angle.
9. An electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the computer program, the steps of the method according to any one of claims 1 to 7 are implemented.
10. A readable storage medium storing a computer program, characterized in that: When the computer program is executed by a processor, the steps of the method according to any one of claims 1 to 7 are implemented.
