A road slope dynamic update method considering vehicle control state

By identifying the vehicle's active control status and motion information to dynamically update the road slope, the problem of inaccurate slope estimation in the autonomous driving system is solved, and the stability of vehicle control and driving experience are improved.

CN115339459BActive Publication Date: 2024-11-15CHONGQING CHANGAN TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202211049818.3
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-08-30
Publication Date
2024-11-15
Estimated Expiration
2042-08-30

AI Technical Summary

Technical Problem

The prior art is difficult to effectively estimate road slope in autonomous driving systems, especially in low-speed motion and changing ramp scenarios, resulting in unstable vehicle control and affecting driving experience.

Method used

By identifying the status information of the vehicle's active control stage and collecting motion information, combining acceleration sensor data, the road slope is dynamically updated, taking into account the vehicle's motion state and control instructions, weight calculation and filtering are used to improve the accuracy of slope estimation.

Benefits of technology

It improves the accuracy and consistency of road slope estimation, reduces the impact of body suspension disturbance on acceleration sensor signals, ensures smoothness of the active control process, and improves the driving experience.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115339459B_ABST
    Figure CN115339459B_ABST
Patent Text Reader

Abstract

The present invention discloses a method for dynamically updating the road slope taking into account the vehicle control state. On the basis of calculating the slope by an acceleration sensor in common use, the method combines the state information of the vehicle in the active control stage and other motion information (excluding the acceleration sensor information) to judge the driving scene in the active control process, and further obtains the confidence of the calculated slope, so as to avoid the erroneous estimation of the road slope caused by the acceleration sensor signal disturbance caused by the disturbance of the vehicle body suspension in the vehicle motion control process. At the same time, considering the change trend of the combined target command information and the motion state of the vehicle, the slope scene with large change is updated in a relatively timely manner, so as to ensure the smoothness of the active control process and improve the driving experience in the vehicle active control process.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of autonomous driving, and in particular to a method for dynamically updating a road slope taking into account a vehicle control state. Background Art

[0002] Autonomous driving technology plays a vital role in the development of the smart car industry. From perception, decision-making to motion control, each link closely affects the driving experience of autonomous driving. Road slope information affects the control amount of vehicle motion control and road slope, and has an important impact on the longitudinal motion control of the vehicle or the information decision of the vehicle, especially for the low-speed motion control of the vehicle. Due to the constraints of the deviation control amount range, it is easy to cause the vehicle to stop and go due to insufficient drive control or excessive control amount for variable slope scenes, which in turn affects the driving experience. CN105799708A proposes a method for estimating the road slope using a gravity acceleration sensor: determining whether the condition for estimating the road slope by using a gravity acceleration sensor is met; when the condition for estimating the road slope by using a gravity acceleration sensor is met, estimating the road slope by using the gravity acceleration sensor and updating the road slope; comparing the estimated rate of change of the road slope with a first predetermined value; when the estimated rate of change of the road slope is greater than or equal to the first predetermined value, comparing the difference between the estimated road slope and the filtered road slope with a second predetermined value; and when the difference between the estimated road slope and the filtered road slope is greater than or equal to the second predetermined value, filtering the estimated road slope by changing the coefficient of the filter. This method has great constraints on information such as vehicle gear, steering wheel angle and vehicle speed when estimating the slope for human driving scenes, and cannot be effectively applied to automatic driving systems, especially for automatic parking systems, there are still disadvantages such as low vehicle speed and frequent gear switching. Summary of the invention

[0003] The purpose of the present invention is to overcome the deficiencies of the prior art and provide a method for dynamically updating the road slope taking into account the vehicle control state.

[0004] To achieve the above object, the technical solution provided by the present invention is: a method for dynamically updating the road slope taking into account the vehicle control state, comprising:

[0005] Identify status information of the vehicle during active control phase;

[0006] Collect vehicle motion information including acceleration sensor data;

[0007] The road slope is dynamically updated based on the status information of the vehicle's active control phase and the vehicle's motion information.

[0008] Furthermore, the states of the vehicle active control phase include waiting, vehicle start, start timeout, dynamic speed control, and vehicle brake stop. The switching between the states is as follows:

[0009] 1) When no control target information is received, the vehicle is in a waiting state during the active control phase;

[0010] 2) After receiving the control target information, the actual gear information of the vehicle is made consistent with the target gear according to the target gear information. When the gears are consistent and there is target speed / target distance information, the vehicle enters the vehicle starting state during the active control phase;

[0011] 3) When the vehicle is in the vehicle starting state during the active control phase, after the vehicle speed reaches the set threshold according to the acceleration control command given by the system, the vehicle enters the dynamic speed control phase; when the vehicle is in the vehicle starting state during the active control phase, and the system's acceleration control command continues to control for more than the set time, if the vehicle speed does not rise to the starting purpose, the vehicle enters the starting timeout state during the active control phase;

[0012] 4) When the vehicle is in the start timeout state during the active control phase, the system will increase the acceleration control command of the start control based on the length of the timeout period until the vehicle speed exceeds the set threshold, and the system switches from the start timeout state to the dynamic speed control state;

[0013] 5) When the vehicle is in the dynamic speed control state during the active control phase, the system dynamically calculates the target acceleration and deceleration control instructions according to the target vehicle speed. When the target distance is less than the set threshold, the system enters the braking phase;

[0014] 6) When the vehicle is in the braking state during the active control stage, the system calculates the dynamic command to stop the vehicle to the vicinity of the target position based on the relationship between the target distance and the actual vehicle speed, completing one-time control of the vehicle; when the vehicle is stationary and exceeds the set time, the vehicle active control stage returns to the waiting state from the braking stage.

[0015] Furthermore, the vehicle's motion information also includes wheel speed direction, wheel speed pulse, vehicle speed, vehicle motion direction and vehicle actual gear position information.

[0016] Furthermore, the road slope is dynamically updated according to the state information of the vehicle active control stage and the movement information of the vehicle, including:

[0017] Processing and calculating the collected vehicle motion information to obtain the vehicle motion acceleration, the vehicle single motion distance and the vehicle motion state;

[0018] The road slope is dynamically updated based on the motion acceleration, the vehicle's single motion distance, the vehicle's motion state, and the state information of the vehicle's active control phase obtained by identification.

[0019] Furthermore, the collected vehicle motion information is processed and calculated to obtain the vehicle motion acceleration, the vehicle single motion distance and the vehicle motion state, including:

[0020] Calculation of vehicle single movement distance:

[0021] 1) When the vehicle is stationary and the vehicle active control stage is not in the waiting state, the travel distance of each wheel is calculated according to the number of wheel speed pulse changes in a single cycle of a single wheel and the wheel speed direction and the movement direction information of the vehicle. Finally, the single wheel travel distance calculated by each wheel is weighted according to the deviation size to obtain the vehicle single movement travel distance;

[0022] 2) When the vehicle is stationary and the vehicle active control phase is in a waiting state, the vehicle single movement distance is reset to 0;

[0023] Motion acceleration calculation:

[0024] 1) The vehicle's acceleration is initially obtained by performing differential calculation on the vehicle speed;

[0025] 2) Use low-pass filtering to filter and smooth the motion acceleration to obtain the final motion acceleration;

[0026] Sensor acceleration processing:

[0027] 1) To judge the validity and handle abnormal values ​​of the acceleration values ​​from the longitudinal acceleration sensor;

[0028] 2) According to the value of the acceleration, the upper and lower limits are limited and filtered to obtain the processed sensor acceleration;

[0029] Vehicle motion state processing:

[0030] The vehicle's motion state is determined based on the vehicle's motion acceleration, sensor acceleration, wheel speed pulses and the vehicle's actual gear position, including constant speed, acceleration, deceleration, stationary, rapid acceleration and rapid deceleration.

[0031] Furthermore, the road slope is dynamically updated according to the motion acceleration, the vehicle's single motion distance, the vehicle's motion state, and the state information of the vehicle's active control phase obtained by identification, including:

[0032] When the vehicle is at rest, the calculated road slope value at rest is used as the final output road slope value;

[0033] When the vehicle is in a nearly uniform speed state, the road slope is obtained by weighting the slope value of the previous cycle and the slope value in the nearly uniform speed state and their confidence;

[0034] When the vehicle is in an acceleration state, the road slope is obtained by weighting the slope value of the previous cycle and the slope value in the acceleration state and their confidence;

[0035] When the vehicle is in a deceleration state, the road slope is obtained by weighting the slope value of the previous cycle and the slope value in the deceleration state and their confidence.

[0036] Furthermore, according to the definition of the vehicle active control stage, the waiting state, the vehicle starting state, and the braking state all involve the vehicle being stationary; considering that the vehicle does not move during the starting process but the vehicle body pitch angle will change, and the vehicle body shakes during the braking process, the road slope update process in the stationary state is as follows:

[0037] 1) When the vehicle is in the waiting state during the active control phase, according to the definition of sensor acceleration, the sensor acceleration at this time is positively correlated with the road slope value. The road slope value is obtained by multiplying the sensor acceleration at this time by the road slope coefficient related to the actual gear position of the vehicle;

[0038] 2) When the vehicle is in the vehicle starting state during the active control phase, the road slope value is obtained by multiplying the sensor acceleration by the road slope coefficient related to the actual gear position of the vehicle within the set time of entering the vehicle starting state;

[0039] 3) Except for the two cases 1) and 2), the road slope value is not updated when the vehicle is stationary, and the road slope value is maintained during this period.

[0040] Furthermore, when the vehicle's acceleration is close to 0, the vehicle is considered to be in a nearly uniform motion state. In this state, the slope confidence and slope are calculated as follows:

[0041] 1) Slope confidence calculation:

[0042] This state determines the slope confidence based on the vehicle's travel distance. The longer the vehicle's travel path, the higher the slope confidence.

[0043] 2) Slope calculation:

[0044] When the vehicle is not stationary, if the calculated motion acceleration is close to 0, that is, within the set threshold range, the road slope value under uniform speed is obtained by multiplying the sensor acceleration by the slope coefficient related to the actual gear position of the vehicle.

[0045] Furthermore, when the vehicle is in a non-stationary state and the calculated motion acceleration is greater than a set threshold, the slope confidence and slope calculation in the acceleration state are performed, and the calculation steps are as follows:

[0046] 1) Slope confidence calculation:

[0047] The slope confidence is determined based on the acceleration and deceleration control command change rate, the motion acceleration change rate, the sensor acceleration change rate, and the vehicle's single motion distance. The relationship between these factors and the confidence in the acceleration state is as follows:

[0048] (1. The greater the rate of change of motion acceleration and the acceleration rate of the sensor, the lower the slope confidence;

[0049] (2. The longer the vehicle's driving path is, the greater the degree of slope variation is. The longer the driving path is, the higher the slope confidence is.

[0050] (3. When the acceleration command change rate decreases and exceeds the set threshold or there is a large deceleration command, and the motion acceleration change rate increases and exceeds the set threshold, it indicates that there is a downhill scene with a large slope change. At this time, the confidence of the calculated slope value representing the vehicle going downhill is high, while the confidence of the slope value representing the vehicle going uphill is low;

[0051] 2) Acceleration state slope calculation:

[0052] The acceleration state slope calculation is divided into the following two cases:

[0053] (1) The vehicle active control stage has not entered the vehicle start timeout stage: Without considering the influence of vehicle body shaking disturbance, the sensor acceleration is the superposition of the motion acceleration and the sensor acceleration of the vehicle in the static state. The slope of the road is equal to the vehicle sensor acceleration minus the vehicle motion acceleration multiplied by the slope coefficient related to the actual gear position of the vehicle;

[0054] (2) The vehicle enters the vehicle start timeout stage during the active control phase: The start timeout problem usually occurs when encountering an uphill scene with a sudden change in slope or a protruding obstacle such as a speed bump. For protruding obstacles, there is a phenomenon of going downhill immediately after going uphill. The rate of change of the motion acceleration can be used to distinguish whether it is a slope change or a protruding obstacle. When it is confirmed that a slope change is encountered, the slope estimate value obtained by the target torque is obtained by looking up the table according to the size of the requested target acceleration command and the empirical value. At the same time, the slope value estimated by the sensor is obtained by multiplying the difference between the sensor acceleration value and the motion acceleration by the slope coefficient value related to the actual gear position. Finally, the two are weighted to obtain the road slope estimate value when the slope change is large.

[0055] Furthermore, when the vehicle is in motion and the calculated motion acceleration is less than a set threshold, the slope confidence and slope calculation in the acceleration state are performed, and the calculation steps are as follows:

[0056] 1) Slope confidence calculation:

[0057] The slope confidence is determined based on the acceleration and deceleration command change rate, the motion acceleration change rate, the sensor acceleration change rate, and the vehicle's single motion distance. The relationship between these factors and the slope confidence in the deceleration state is as follows:

[0058] The greater the rate of change of motion acceleration and sensor acceleration, the lower the slope confidence;

[0059] (2) The longer the driving path, the greater the degree of slope variation. The longer the vehicle's driving path, the higher the slope confidence.

[0060] (3) When the acceleration command change rate is increasing but the motion acceleration change rate is decreasing and both exceed the set threshold, it is considered that an uphill scene with a slope change is encountered. At this time, the estimated slope value represents the slope value of the vehicle going uphill with a high confidence, while the slope value representing the downhill has a low confidence;

[0061] 2) Slope calculation in deceleration state:

[0062] In the deceleration state, the slope of the road is equal to the vehicle's sensor acceleration minus the vehicle's motion acceleration multiplied by the slope coefficient related to the vehicle's actual gear position.

[0063] The beneficial effects of implementing the present invention are:

[0064] On the basis of the commonly used calculation of slope by acceleration sensor, combined with the state information of the vehicle in the active control stage and other motion information (excluding acceleration sensor information), the driving scene in the active control process is judged, and the confidence of the calculated slope is further obtained to avoid the erroneous estimation of the road slope caused by the acceleration sensor signal disturbance caused by the disturbance of the body suspension during the vehicle motion control process. At the same time, considering the change trend of the target command information and the vehicle's motion state, the slope scene with large changes is updated in a more immediate manner to ensure the smoothness of the active control process and improve the driving experience during the vehicle active control process. BRIEF DESCRIPTION OF THE DRAWINGS

[0065] Figure 1 A principle flow chart of a method for dynamically updating a road slope taking into account a vehicle control state according to the present invention;

[0066] Figure 2 This is the state schematic diagram of the vehicle active control stage;

[0067] Figure 3 Dynamically update the diagram for slope. DETAILED DESCRIPTION

[0068] The present invention will be further described below in conjunction with specific embodiments:

[0069] like Figure 1 As shown, this embodiment provides a method for dynamically updating the road slope taking into account the vehicle control state, comprising the following steps:

[0070] S1. Identify the status information of the vehicle active control stage;

[0071] The states of the vehicle active control phase include waiting, vehicle start, start timeout, dynamic speed control, and vehicle braking. Figure 2 As shown, the switching between the various states is as follows:

[0072] 1) When no control target information is received, the vehicle is in a waiting state during the active control phase;

[0073] 2) After receiving the control target information, the actual gear information of the vehicle is made consistent with the target gear according to the target gear information. When the gears are consistent and there is target speed / target distance information, the vehicle enters the vehicle starting state during the active control phase;

[0074] 3) When the vehicle is in the vehicle starting state during the active control phase, after the vehicle speed reaches the set threshold according to the acceleration control command given by the system, the vehicle enters the dynamic speed control phase; when the vehicle is in the vehicle starting state during the active control phase, and the system's acceleration control command continues to control for more than the set time, if the vehicle speed does not rise to the starting purpose, the vehicle enters the starting timeout state during the active control phase;

[0075] 4) When the vehicle is in the start timeout state during the active control phase, the system will increase the acceleration control command of the start control based on the length of the timeout period until the vehicle speed exceeds the set threshold, and the system switches from the start timeout state to the dynamic speed control state;

[0076] 5) When the vehicle is in the dynamic speed control state during the active control phase, the system dynamically calculates the target acceleration and deceleration control instructions according to the target vehicle speed. When the target distance is less than the set threshold, the system enters the braking phase;

[0077] 6) When the vehicle is in the braking state during the active control stage, the system calculates the dynamic command to stop the vehicle to the vicinity of the target position based on the relationship between the target distance and the actual vehicle speed, completing one-time control of the vehicle; when the vehicle is stationary and exceeds the set time, the vehicle active control stage returns to the waiting state from the braking stage.

[0078] S2, collecting vehicle movement information, including: wheel speed direction, wheel speed pulse, vehicle speed, acceleration sensor data, vehicle movement direction and vehicle actual gear position information;

[0079] S3, dynamically updating the road slope according to the state information of the vehicle active control stage and the movement information of the vehicle, including:

[0080] Processing and calculating the collected vehicle motion information to obtain the vehicle motion acceleration, the vehicle single motion distance and the vehicle motion state;

[0081] The road slope is dynamically updated based on the motion acceleration, the vehicle's single motion distance, the vehicle's motion state, and the state information of the vehicle's active control phase obtained by identification.

[0082] The collected vehicle motion information is processed and calculated to obtain the vehicle motion acceleration, the vehicle single motion distance and the vehicle motion state, including:

[0083] Calculation of vehicle single movement distance:

[0084] 1) When the vehicle is stationary and the vehicle active control stage is not in the waiting state, the travel distance of each wheel is calculated according to the number of wheel speed pulse changes in a single cycle of a single wheel and the wheel speed direction and the movement direction information of the vehicle. Finally, the single wheel travel distance calculated by each wheel is weighted according to the deviation size to obtain the vehicle single movement travel distance;

[0085] 2) When the vehicle is stationary and the vehicle active control phase is in a waiting state, the vehicle single movement distance is reset to 0;

[0086] Motion acceleration calculation:

[0087] 1) The vehicle's acceleration is initially obtained by performing differential calculation on the vehicle speed;

[0088] 2) Use low-pass filtering to filter and smooth the motion acceleration to obtain the final motion acceleration;

[0089] Sensor acceleration processing:

[0090] 1) To judge the validity and handle abnormal values ​​of the acceleration values ​​from the longitudinal acceleration sensor;

[0091] 2) According to the value of the acceleration, the upper and lower limits are limited and filtered to obtain the processed sensor acceleration;

[0092] Vehicle motion state processing:

[0093] The vehicle's motion state is determined based on the vehicle's motion acceleration, sensor acceleration, wheel speed pulses and the vehicle's actual gear position, including constant speed, acceleration, deceleration, stationary, rapid acceleration and rapid deceleration.

[0094] like Figure 3As shown, the road slope is dynamically updated according to the motion acceleration, the vehicle's single motion distance, the vehicle's motion state, and the state information of the vehicle's active control phase obtained by identification, specifically including:

[0095] When the vehicle is at rest, the calculated road slope value at rest is used as the final output road slope value;

[0096] When the vehicle is in a nearly uniform speed state, the road slope is obtained by weighting the slope value of the previous cycle and the slope value in the nearly uniform speed state and their confidence;

[0097] When the vehicle is in an acceleration state, the road slope is obtained by weighting the slope value of the previous cycle and the slope value in the acceleration state and their confidence;

[0098] When the vehicle is in a deceleration state, the road slope is obtained by weighting the slope value of the previous cycle and the slope value in the deceleration state and their confidence.

[0099] In the above,

[0100] According to the definition of the vehicle active control stage, the waiting state, vehicle starting state and braking state all involve the vehicle being stationary; considering that the vehicle does not move during the starting process but the vehicle body pitch angle will change and the vehicle body shakes during the braking process, the road slope update process in the stationary state is as follows:

[0101] 1) When the vehicle is in the waiting state during the active control phase, according to the definition of sensor acceleration, the sensor acceleration at this time is positively correlated with the road slope value. The road slope value is obtained by multiplying the sensor acceleration at this time by the road slope coefficient related to the actual gear position of the vehicle;

[0102] 2) When the vehicle is in the vehicle starting state during the active control phase, the road slope value is obtained by multiplying the sensor acceleration by the road slope coefficient related to the actual gear position of the vehicle within the set time of entering the vehicle starting state;

[0103] 3) Except for the two cases 1) and 2), the road slope value is not updated when the vehicle is stationary, and the road slope value is maintained during this period.

[0104] When the vehicle's acceleration is close to 0, the vehicle is considered to be in a nearly uniform motion state. In this state, the slope confidence and slope are calculated as follows:

[0105] 1) Slope confidence calculation:

[0106] This state determines the slope confidence based on the vehicle's travel distance. The longer the vehicle's travel path, the higher the slope confidence.

[0107] 2) Slope calculation:

[0108] When the vehicle is not stationary, if the calculated motion acceleration is close to 0, that is, within the set threshold range, the road slope value under uniform speed is obtained by multiplying the sensor acceleration by the slope coefficient related to the actual gear position of the vehicle.

[0109] When the vehicle is not stationary and the calculated motion acceleration is greater than the set threshold, the slope confidence and slope calculation under acceleration are performed. The calculation steps are as follows:

[0110] 1) Slope confidence calculation:

[0111] The slope confidence is determined based on the acceleration and deceleration control command change rate, the motion acceleration change rate, the sensor acceleration change rate, and the vehicle's single motion distance. The relationship between these factors and the confidence in the acceleration state is as follows:

[0112] (1. The greater the rate of change of motion acceleration and the acceleration rate of the sensor, the lower the slope confidence;

[0113] (2. The longer the vehicle's driving path is, the greater the degree of slope variation is. The longer the driving path is, the higher the slope confidence is.

[0114] (3. When the acceleration command change rate decreases and exceeds the set threshold or there is a large deceleration command, and the motion acceleration change rate increases and exceeds the set threshold, it indicates that there is a downhill scene with a large slope change. At this time, the confidence of the calculated slope value representing the vehicle going downhill is high, while the confidence of the slope value representing the vehicle going uphill is low;

[0115] 2) Acceleration state slope calculation:

[0116] The acceleration state slope calculation is divided into the following two cases:

[0117] (1) The vehicle active control stage has not entered the vehicle start timeout stage: Without considering the influence of vehicle body shaking disturbance, the sensor acceleration is the superposition of the motion acceleration and the sensor acceleration of the vehicle in the static state. The slope of the road is equal to the vehicle sensor acceleration minus the vehicle motion acceleration multiplied by the slope coefficient related to the actual gear position of the vehicle;

[0118] (2) The vehicle enters the vehicle start timeout stage during the active control phase: The start timeout problem usually occurs when encountering an uphill scene with a sudden change in slope or a protruding obstacle such as a speed bump. For protruding obstacles, there is a phenomenon of going downhill immediately after going uphill. The rate of change of the motion acceleration can be used to distinguish whether it is a slope change or a protruding obstacle. When it is confirmed that a slope change is encountered, the slope estimate value obtained by the target torque is obtained by looking up the table according to the size of the requested target acceleration command and the empirical value. At the same time, the slope value estimated by the sensor is obtained by multiplying the difference between the sensor acceleration value and the motion acceleration by the slope coefficient value related to the actual gear position. Finally, the two are weighted to obtain the road slope estimate value when the slope change is large.

[0119] When the vehicle is in motion and the calculated motion acceleration is less than the set threshold, the slope confidence and slope calculation under acceleration are performed. The calculation steps are as follows:

[0120] 1) Slope confidence calculation:

[0121] The slope confidence is determined based on the acceleration and deceleration command change rate, the motion acceleration change rate, the sensor acceleration change rate, and the vehicle's single motion distance. The relationship between these factors and the slope confidence in the deceleration state is as follows:

[0122] The greater the rate of change of motion acceleration and sensor acceleration, the lower the slope confidence;

[0123] (2) The longer the driving path, the greater the degree of slope variation. The longer the vehicle's driving path, the higher the slope confidence.

[0124] (3) When the acceleration command change rate is increasing but the motion acceleration change rate is decreasing and both exceed the set threshold, it is considered that an uphill scene with a slope change is encountered. At this time, the estimated slope value represents the slope value of the vehicle going uphill with a high confidence, while the slope value representing the downhill has a low confidence;

[0125] 2) Slope calculation in deceleration state:

[0126] In the deceleration state, the slope of the road is equal to the vehicle's sensor acceleration minus the vehicle's motion acceleration multiplied by the slope coefficient related to the vehicle's actual gear position.

[0127] The embodiments described above are only preferred embodiments of the present invention and are not intended to limit the scope of implementation of the present invention. Therefore, all changes made according to the shape and principle of the present invention should be included in the protection scope of the present invention.

Claims

1. A method for dynamically updating road slope considering vehicle control status, characterized in that: include: Identify status information of the vehicle during active control phase; Collect vehicle motion information including acceleration sensor data; The road slope is dynamically adjusted based on the state information of the vehicle active control phase and the vehicle motion information. Status update; The road slope is dynamically adjusted based on the state information of the vehicle active control phase and the vehicle motion information. Status updates, including: The collected vehicle motion information is processed and calculated to obtain the vehicle motion acceleration, vehicle The vehicle's single movement distance and vehicle movement status; Based on the motion acceleration, vehicle single motion distance, vehicle motion state and recognition The status information of the vehicle's active control phase dynamically updates the road slope; Based on the motion acceleration, vehicle single motion distance, vehicle motion state and recognition The status information of the vehicle active control stage dynamically updates the road slope, including: When the vehicle is stationary, the road slope calculation value at rest is used as the final output road Slope value; When the vehicle is in a nearly uniform speed state, according to the slope value of the previous cycle and the slope value in the nearly uniform speed state and its confidence weighted to obtain the road slope; When the vehicle is in the acceleration state, according to the slope value of the previous cycle and the slope value in the acceleration state and Its confidence is weighted to obtain the road slope; When the vehicle is in a deceleration state, the slope value of the previous cycle and the slope value in the deceleration state and their The confidence is weighted to obtain the road slope.

2. A method for dynamically updating a road slope taking into account a vehicle control state according to claim 1, It is characterized in that The states of the vehicle active control phase include waiting state, vehicle starting state, starting over The waiting state, vehicle start state and vehicle brake state are There is a static state in both the start timeout state and the dynamic speed control state. state, acceleration state, and deceleration state; Waiting state, vehicle start state, start timeout state, dynamic speed control state and vehicle brake stop state The switching between the states is as follows: 1) When no control target information is received, the vehicle is in a waiting state during the active control phase; 2) After receiving the control target information, the vehicle actual gear information and the target gear information are adjusted according to the target gear information. When the gear position is consistent and there is target speed / target distance information, the vehicle active control stage is entered. Enter the vehicle starting state; 3) When the vehicle is in the starting state during the active control phase, follow the acceleration control instructions given by the system. After the vehicle speed reaches the set threshold, the vehicle active control phase enters the dynamic speed control phase; The vehicle is in the starting state during the control phase, and the acceleration control command of the system continues to control and exceeds the set If the vehicle speed does not rise to the starting point within the specified time, the vehicle will enter the active control stage. Enter the start timeout state; 4) When the vehicle is in the start timeout state during the active control phase, the system will increase or decrease the speed based on the length of the timeout. The acceleration control command of the large start control is used until the vehicle speed exceeds the set threshold, and the system switches from the start timeout state to the start timeout state. Switch to dynamic speed control state; 5) When the vehicle is in the dynamic speed control state during the active control phase, the system dynamically calculates the target speed. Target acceleration and deceleration control instructions: when the target distance is less than the set threshold, the system enters the braking stage; 6) When the vehicle is in the braking state during the active control phase, the system The speed relationship is calculated and the dynamic command is used to stop the vehicle to the vicinity of the target position, completing the primary control of the vehicle; when the vehicle After being stationary for a set time, the vehicle active control phase returns from the braking phase to the Waiting state.

3. A method for dynamically updating road slope considering vehicle control state according to claim 2, characterized in that: The vehicle's motion information also includes wheel speed direction, wheel speed pulse, vehicle speed, vehicle motion direction and vehicle actual gear position information.

4. A method for dynamically updating a road slope taking into account a vehicle control state according to claim 1, It is characterized in that The collected vehicle motion information is processed and calculated to obtain the vehicle motion acceleration. Speed, distance traveled in a single vehicle movement, and vehicle movement status, including: Calculation of vehicle single movement distance: 1) When the vehicle is stationary and the vehicle active control phase is not in the waiting state, the vehicle is automatically The number of wheel speed pulse changes, wheel speed direction and vehicle movement direction information are calculated for each vehicle. The distance traveled by each wheel is calculated and then the individual wheel distance traveled is calculated according to the deviation. Weighted processing is performed to obtain the vehicle's single movement distance; 2) When the vehicle is stationary and the vehicle active control phase is in the waiting state, the vehicle single movement distance Reset to 0; Motion acceleration calculation: 1) The vehicle's acceleration is initially obtained by performing differential calculation on the vehicle speed; 2) Use low-pass filtering to smooth the motion acceleration and obtain the final motion acceleration. speed; Sensor acceleration processing: 1) Determine the validity of the acceleration values ​​from the longitudinal acceleration sensor and handle abnormal values; 2) According to the value of acceleration, the upper and lower limits are set and filtered. Sensor acceleration; Vehicle motion state processing: Determine the vehicle's speed based on the vehicle's acceleration, sensor acceleration, wheel speed pulses, and the vehicle's actual gear position. The vehicle's motion state includes constant speed, acceleration, deceleration, stationary, rapid acceleration and rapid deceleration.

5. A method for dynamically updating a road slope taking into account a vehicle control state according to claim 1, It is characterized in that According to the definition of vehicle active control stage, waiting state, vehicle starting state and braking state The dynamic brake stop state is when the vehicle is stationary; consider the vehicle starting process when the vehicle is not moving but the body is bent The elevation angle will change and the vehicle will shake during braking. The road slope will be more The new process is as follows: 1) When the vehicle is in the waiting state during the active control phase, according to the definition of sensor acceleration, The sensor acceleration is positively correlated with the road slope value. Multiply the sensor acceleration at this time by the actual vehicle The gear-related road slope coefficient obtains the road slope value; 2) When the vehicle is in the vehicle start state during the active control phase, the vehicle starts The road slope is obtained by multiplying the sensor acceleration by the road slope coefficient related to the actual gear position of the vehicle. Degree value; 3) Except for cases 1) and 2), the road slope value is not updated when the vehicle is stationary. The road slope value is maintained during this period.

6. A method for dynamically updating a road slope taking into account a vehicle control state according to claim 1, It is characterized in that When the vehicle's acceleration is close to 0, the vehicle is considered to be in a near-uniform speed. In the motion state, the slope confidence and slope are calculated as follows: 1) Slope confidence calculation: This state determines the slope confidence based on the vehicle's driving distance. The longer the vehicle's driving path, the higher the slope confidence. The higher the credibility; 2) Slope calculation: When the vehicle is not stationary, if the calculated motion acceleration is close to 0, that is, within the set threshold Within the value range, the uniform speed is obtained by multiplying the sensor acceleration by the slope coefficient related to the actual gear position of the vehicle. The road slope value under normal conditions.

7. A method for dynamically updating a road slope taking into account a vehicle control state according to claim 1, It is characterized in that When the vehicle is not stationary and the calculated motion acceleration is greater than the set threshold The slope confidence and slope calculation under acceleration state are performed, and the calculation steps are as follows: 1) Slope confidence calculation According to the acceleration and deceleration control command change rate, motion acceleration change rate, sensor acceleration change rate The slope confidence is determined by the speed and the distance traveled by the vehicle in a single movement; Under accelerated conditions, these factors and The relationship between confidence levels is as follows: (1. The greater the rate of change of motion acceleration and the acceleration rate of the sensor, the lower the slope confidence; (2. The longer the vehicle's driving path is, the greater the degree of slope change. The higher the slope confidence; (3. When the acceleration command change rate decreases and exceeds the set threshold or there is a large deceleration command, If the acceleration rate of motion increases and exceeds the set threshold, it means that there is a large slope change. In the downhill scenario, the confidence level of the calculated slope value indicating that the vehicle is going downhill is high, while the confidence level of the calculated slope value indicating that the vehicle is going downhill is high. The confidence level of the uphill slope value is low; 2) Acceleration state slope calculation: The acceleration state slope calculation is divided into the following two cases: (1) The vehicle has not entered the vehicle start timeout phase during the active control phase: without considering the vehicle body shaking disturbance In the case of motion, the sensor acceleration is composed of the motion acceleration and the sensor acceleration of the vehicle at rest. The road slope is equal to the vehicle's sensor acceleration minus the vehicle's motion acceleration multiplied by The slope coefficient is related to the actual gear position of the vehicle; (2) The vehicle enters the vehicle start timeout stage during the vehicle active control phase: This is often the case when encountering uphill scenes with a sudden change in slope or protruding obstacles such as speed bumps. There is a phenomenon that the obstacle goes uphill and then downhill immediately. According to the change rate of motion acceleration, it is different when encountering a slope change. If the vehicle encounters a protruding obstacle, the vehicle will accelerate according to the requested target. The slope estimate obtained by the target torque is obtained by looking up the size and empirical value in the table. At the same time, according to the sensor acceleration The difference between the value and the motion acceleration is multiplied by the slope coefficient value related to the actual gear to obtain the slope estimated by the sensor. Finally, the two are weighted to obtain the estimated road slope when the slope changes greatly.

8. A method for dynamically updating a road slope taking into account a vehicle control state according to claim 1, It is characterized in that When the vehicle is in motion and the calculated motion acceleration is less than the set threshold, The slope confidence and slope calculation under the acceleration state are as follows: 1) Slope confidence calculation: According to the acceleration and deceleration command change rate, motion acceleration change rate, sensor acceleration change The speed and the distance traveled by the vehicle in a single movement determine the slope confidence; these factors and the slope in the deceleration state The degree-confidence relationship is as follows: (1) The greater the rate of change of motion acceleration and the acceleration rate of the sensor, the lower the slope confidence; (2) The longer the driving path, the greater the degree of slope change. The longer the vehicle's driving path, The higher the slope confidence; (3) When the acceleration command change rate is increasing but the motion acceleration change rate is decreasing and both exceed the set In the case of a threshold, it is considered that an uphill scene with a slope change is encountered. At this time, the estimated slope value represents the vehicle's uphill The confidence level of the slope value of a slope is high, while the confidence level of the slope value representing a downhill slope is low; 2) Slope calculation in deceleration state: In the deceleration state, the slope of the road is equal to the vehicle's sensor acceleration minus the vehicle's motion acceleration. Then multiply it by the slope factor associated with the vehicle's actual gear.