Vehicle driving road slope prediction method, device, equipment, medium and product

By combining the data of the acceleration sensor and the angular velocity sensor, the slope of the car's driving road surface is predicted, which solves the problem of low detection accuracy of a single sensor and improves the accuracy of slope detection.

CN119928874AActive Publication Date: 2025-05-06FAW JIEFANG AUTOMOTIVE CO
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
CN202510257219.8
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2025-03-05
Publication Date
2025-05-06
Estimated Expiration
2045-03-05

AI Technical Summary

Technical Problem

In the prior art, when detecting the slope of the vehicle's driving road surface through a single sensor, there is a problem of low accuracy.

Method used

By determining the target angular velocity data and historical pavement slope value of the target vehicle, calculate the angular velocity slope prediction value; based on the angular velocity slope prediction value, determine the target acceleration data and acceleration slope prediction value; then calculate the target pavement slope value based on the angular velocity slope prediction value;

Benefits of technology

Improve the accuracy of road slope detection and avoid the problem of low accuracy when detecting a single sensor.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119928874A_ABST
    Figure CN119928874A_ABST
Patent Text Reader

Abstract

The invention discloses a vehicle driving road slope prediction method, device and equipment, a medium and a product. The method comprises the following steps: determining target angular velocity data of a target vehicle at a current time node; acquiring a historical road surface slope value under the previous time node, and determining an angular velocity slope predicted value according to the historical road surface slope value and the target angular velocity data; determining target acceleration data of the target vehicle at the current time node based on the angular velocity gradient predicted value; determining an acceleration gradient predicted value according to the target acceleration data; and determining a target road surface gradient value of the target vehicle at the current time node according to the acceleration gradient predicted value and the angular velocity gradient predicted value. According to the technical scheme, the vehicle driving road slope detection accuracy is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of automobile control technology, and in particular to a method, device, equipment, medium and product for predicting the slope of a road surface on which a vehicle is traveling. Background Art

[0002] In automobile control systems, accurate information about the slope of the road the car is traveling on is crucial to vehicle power control, fuel economy improvement, comfort, etc. For example, in automobile starting control, the selection of starting gear and clutch torque control are closely related to the slope of the road.

[0003] The current mainstream slope estimation method is to detect through a single sensor, such as an accelerometer or a gyroscope sensor, etc. The sensor-based detection method has certain errors, resulting in low slope detection accuracy. Summary of the invention

[0004] The present invention provides a method, device, equipment, medium and product for predicting the slope of a road surface on which a vehicle is traveling, so as to improve the accuracy of detecting the slope of a road surface on which a vehicle is traveling.

[0005] According to one aspect of the present invention, a method for predicting the slope of a road surface on which a vehicle is traveling is provided, the method comprising:

[0006] Determine the target angular velocity data of the target vehicle at the current time node;

[0007] Obtaining a historical road surface slope value at a previous time node, and determining an angular velocity slope prediction value according to the historical road surface slope value and the target angular velocity data;

[0008] Determining target acceleration data of the target vehicle at a current time node based on the angular velocity gradient prediction value;

[0009] Determining an acceleration gradient prediction value according to the target acceleration data;

[0010] A target road surface slope value of the target vehicle at the current time node is determined according to the acceleration slope prediction value and the angular velocity slope prediction value.

[0011] According to another aspect of the present invention, a device for predicting the slope of a road surface on which a vehicle is traveling is provided, the device comprising:

[0012] A target angular velocity determination module is used to determine the target angular velocity data of the target vehicle at the current time node;

[0013] An angular velocity gradient prediction module is used to obtain a historical road surface gradient value at a previous time node, and determine an angular velocity gradient prediction value based on the historical road surface gradient value and the target angular velocity data;

[0014] A target acceleration determination module, used to determine the target acceleration data of the target vehicle at the current time node based on the angular velocity gradient prediction value;

[0015] An acceleration gradient prediction module, used to determine an acceleration gradient prediction value according to the target acceleration data;

[0016] The road surface gradient value prediction module is used to determine the target road surface gradient value of the target vehicle at the current time node according to the acceleration gradient prediction value and the angular velocity gradient prediction value.

[0017] According to another aspect of the present invention, an electronic device is provided, the electronic device comprising:

[0018] at least one processor; and

[0019] a memory communicatively connected to the at least one processor; wherein,

[0020] The memory stores a computer program that can be executed by the at least one processor, and the computer program is executed by the at least one processor so that the at least one processor can execute the vehicle driving road slope prediction method described in any embodiment of the present invention.

[0021] According to another aspect of the present invention, a computer-readable storage medium is provided, wherein the computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the vehicle driving road slope prediction method described in any embodiment of the present invention when executed.

[0022] According to another aspect of the present invention, a computer program product is provided. The computer program product includes a computer program. When the computer program is executed by a processor, the above-mentioned vehicle driving road slope prediction method is implemented.

[0023] The technical solution of the embodiment of the present invention determines the target angular velocity data of the target vehicle at the current time node, and determines the angular velocity slope prediction value based on the historical road surface slope value and the target angular velocity data; determines the target acceleration data of the target vehicle at the current time node based on the angular velocity slope prediction value; determines the acceleration slope prediction value based on the target acceleration data; determines the target road surface slope value of the target vehicle at the current time node based on the acceleration slope prediction value and the angular velocity slope prediction value. In the process of estimating the target road surface slope value of the target vehicle, the above technical solution comprehensively considers the acceleration sensor data and the angular velocity sensor data, and uses the acceleration data fusion method of the two sensors to perform slope estimation, thereby improving the accuracy of road surface slope estimation and avoiding the problem of low accuracy of short-term or long-term estimation results in the process of using a single sensor for slope estimation.

[0024] It should be understood that the contents described in this section are not intended to identify the key or important features of the embodiments of the present invention, nor are they intended to limit the scope of the present invention. Other features of the present invention will become easily understood through the following description. BRIEF DESCRIPTION OF THE DRAWINGS

[0025] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the drawings required for use in the description of the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.

[0026] Figure 1 is a flow chart of a method for predicting the slope of a road surface on which a vehicle is traveling provided according to Embodiment 1 of the present invention;

[0027] Figure 2 is a flow chart of a method for predicting the slope of a road surface on which a vehicle is traveling provided according to a second embodiment of the present invention;

[0028] Figure 3 is a flow chart of a method for predicting the slope of a road surface on which a vehicle is traveling provided according to a third embodiment of the present invention;

[0029] Figure 4 is a schematic diagram of the structure of a device for predicting the slope of a road surface on which a vehicle is traveling, provided according to a fourth embodiment of the present invention;

[0030] Figure 5 It is a schematic diagram of the structure of an electronic device for implementing the method for predicting the slope of a road surface on which a vehicle is traveling according to an embodiment of the present invention. DETAILED DESCRIPTION

[0031] In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.

[0032] It should be noted that the terms "first", "second", etc. in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.

[0033] Embodiment 1

[0034] Figure 1 This is a flow chart of a method for predicting the slope of a road surface during vehicle driving provided in the first embodiment of the present invention. This embodiment can be applied to the case of predicting the slope of a road surface during vehicle driving. The method can be executed by a vehicle road surface slope prediction device. The vehicle road surface slope prediction device can be implemented in the form of hardware and / or software. The vehicle road surface slope prediction device can be configured in an electronic device. Figure 1 As shown, the method includes:

[0035] S110, determining target angular velocity data of the target vehicle at the current time node.

[0036] S120, obtaining the historical road surface slope value at the previous time node, and determining the angular velocity slope prediction value according to the historical road surface slope value and the target angular velocity data.

[0037] S130. Determine target acceleration data of the target vehicle at the current time node based on the angular velocity gradient prediction value.

[0038] S140: Determine the acceleration gradient prediction value according to the target acceleration data.

[0039] S150. Determine a target road surface slope value of the target vehicle at the current time node according to the acceleration slope prediction value and the angular velocity slope prediction value.

[0040] The target vehicle may be a vehicle for which a road slope value is to be predicted in real time during driving. The prediction of the road slope value during driving of the target vehicle may be a real-time prediction or a timed prediction. The current time node may be the moment or time point at which the road slope value prediction is currently being performed.

[0041] The target angular velocity data may be angular velocity data detected by a gyroscope sensor; in order to improve the accuracy of determining the angular velocity data, the error caused by the zero drift of the sensor may also be considered in the process of determining the angular velocity data.

[0042] In an optional embodiment, determining target angular velocity data of the target vehicle at the current time node includes: obtaining sensor angular velocity data of the target vehicle at the current time node; and obtaining reference angular velocity data of the target vehicle in a preset time period after power-on, and determining an angular velocity zero drift estimate value based on the reference angular velocity data; determining the target angular velocity data of the target vehicle at the current time node based on the sensor angular velocity data and the angular velocity zero drift estimate value.

[0043] Among them, the sensor angular velocity data can be obtained by real-time or timed detection of the gyroscope sensor. The preset time period after the target vehicle is powered on can be pre-set by relevant technical personnel according to actual needs, for example, several collection cycles (such as 100 to 500) within a short time (such as 0.5 to 2 seconds) after power-on.

[0044] Specifically, the sensor angular velocity data collected by the gyroscope sensor at the current time node is obtained. The reference angular velocity data collected in several sampling cycles within a short period of time after the target vehicle is powered on is obtained. The average value of the reference angular velocity data is determined as the angular velocity zero drift estimation value of the sensor angular velocity collected by the gyroscope sensor. For example, the angular velocity zero drift estimation value w bias is determined as follows:

[0045]

[0046] Among them, w i represents the i-th reference angular velocity data; n represents the number of reference angular velocity data.

[0047] The sensor angular velocity data w sensor and the angular velocity zero drift estimate w bias The difference between them is determined as the target angular velocity data w of the target vehicle at the current time node k. obj,k .

[0048] w obj,k =w sensor,k -w bias,k ;

[0049] For example, the predicted angular velocity slope value θ at the current time node k is pre,k The determination method is as follows.

[0050] θ pre,k =θ k-1 +w obj,k Δt;

[0051] Among them, θ k-1 Represents the historical road slope value θ at the previous time node k-1 k-1 ; Δt represents the time difference between the previous time node and the current time node; w obj,k Represents the target angular velocity data at the current time node k.

[0052] Based on the angular velocity gradient prediction value, the target acceleration data of the target vehicle at the current time node is determined. It should be noted that the error range of the angular velocity data can be known through calibration, while the error range of the acceleration data is unknown but has a certain mapping relationship with the angular velocity data. The error range of the acceleration data can be determined based on the error range of the angular velocity data and the angular velocity gradient prediction value. The target acceleration data is the acceleration difference between the sensor acceleration data and the vehicle longitudinal acceleration data. The target acceleration data can be thresholded through the error range of the acceleration data, thereby improving the accuracy of determining the target acceleration data.

[0053] According to the target acceleration data a x , determine the predicted value θ of the acceleration slope at the current time node k obs The way is as follows.

[0054]

[0055] Among them, a x,k Represents the target acceleration data at the current time node k; g represents the gravitational acceleration.

[0056] According to the acceleration slope prediction value and the angular velocity slope prediction value, the target road slope value of the target vehicle at the current time node is determined. Specifically, the target road slope value can be obtained by weighted summation according to the pre-set weight values ​​corresponding to the acceleration slope prediction and the angular velocity slope prediction. Among them, the weight values ​​corresponding to the acceleration slope prediction and the angular velocity slope prediction can be pre-set by relevant technical personnel based on actual experience values ​​or experimental values ​​or actual needs.

[0057] The technical solution of the embodiment of the present invention determines the target angular velocity data of the target vehicle at the current time node, and determines the angular velocity slope prediction value based on the historical road surface slope value and the target angular velocity data; determines the target acceleration data of the target vehicle at the current time node based on the angular velocity slope prediction value; determines the acceleration slope prediction value based on the target acceleration data; determines the target road surface slope value of the target vehicle at the current time node based on the acceleration slope prediction value and the angular velocity slope prediction value. In the process of estimating the target road surface slope value of the target vehicle, the above technical solution comprehensively considers the acceleration sensor data and the angular velocity sensor data, and uses the acceleration data fusion method of the two sensors to perform slope estimation, thereby improving the accuracy of road surface slope estimation and avoiding the problem of low accuracy of short-term or long-term estimation results in the process of using a single sensor for slope estimation.

[0058] Embodiment 2

[0059] Figure 2 This is a flow chart of a method for predicting the slope of a vehicle road surface provided in the second embodiment of the present invention. This embodiment is optimized and improved on the basis of the above-mentioned technical solutions.

[0060] Furthermore, the step "determine the target acceleration data of the target vehicle at the current time node based on the angular velocity slope prediction value" is refined into "obtain the sensor acceleration data and the current vehicle speed data of the target vehicle at the current time node; determine the longitudinal acceleration data based on the current vehicle speed data; determine the reference acceleration data based on the sensor acceleration data and the longitudinal acceleration data; determine the acceleration error range interval based on the angular velocity slope prediction value; determine the target acceleration data based on the acceleration error range interval based on the reference acceleration data." to improve the method of determining the target acceleration data.

[0061] It should be noted that for the parts not described in detail in the embodiments of the present invention, reference can be made to the descriptions of other embodiments. Figure 2 As shown, the method comprises the following specific steps:

[0062] S210: Determine the target angular velocity data of the target vehicle at the current time node.

[0063] S220: Obtain the historical road surface slope value at the previous time node, and determine the angular velocity slope prediction value according to the historical road surface slope value and the target angular velocity data.

[0064] S230: Obtain sensor acceleration data and current vehicle speed data of the target vehicle at the current time node.

[0065] S240: Determine longitudinal acceleration data according to current vehicle speed data.

[0066] S250: Determine reference acceleration data according to the sensor acceleration data and the longitudinal acceleration data.

[0067] S260: Determine an acceleration error range based on the angular velocity gradient prediction value.

[0068] S270: Determine target acceleration data according to the reference acceleration data and based on the acceleration error range.

[0069] S280: Determine the acceleration gradient prediction value according to the target acceleration data.

[0070] S290. Determine a target road surface slope value of the target vehicle at the current time node according to the acceleration slope prediction value and the angular velocity slope prediction value.

[0071] The sensor acceleration data of the target vehicle at the current time node can be obtained by detecting the acceleration sensor, and the current vehicle speed data can be obtained through the CAN (Controller Area Network) bus. Optionally, the high-frequency noise of the sensor angular velocity data and the current vehicle speed data can be filtered out by a low-pass filter.

[0072] For the current vehicle speed data v can Differentiate to obtain the original longitudinal acceleration data a of the target vehicle veh , let the current time node be k, and the specific determination method is as follows.

[0073]

[0074] Among them, v can,k represents the current vehicle speed data at the current time node k; v can,k-1 represents the historical vehicle speed data at the previous time node k-1; Δt represents the time difference between the current time node k and the previous time node k-1.

[0075] According to the sensor acceleration data a at the current time node k sensor,k and longitudinal acceleration data a veh,k , determine the reference acceleration data a x,k The way is as follows.

[0076] a x,k =a sensor,k -a veh,k ;

[0077] Based on the angular velocity slope prediction value, the acceleration error range is determined. It should be noted that the angular velocity error range is known through calibration, and the acceleration error range can be determined based on the correlation between the angular velocity data and the acceleration data.

[0078] In an optional embodiment, based on the angular velocity slope prediction value, the acceleration error range interval is determined, including: obtaining the angular velocity interval upper limit value and the angular velocity interval lower limit value of the angular velocity error range interval, and obtaining the slope estimation error at the previous time node; according to the angular velocity interval upper limit value and the angular velocity slope prediction value, based on the slope estimation error, determining the acceleration interval upper limit value of the angular velocity error range interval; and, according to the angular velocity interval lower limit value and the angular velocity slope prediction value, based on the slope estimation error, determining the acceleration interval lower limit value of the angular velocity error range interval.

[0079] Assume that the angular velocity error range obtained by calibration is err low ≤Δθ err ≤err high , where Δθ err Indicates the angular velocity error, err low and err high They represent the upper and lower limits of the angular velocity range, respectively. x and angular velocity error Δθ err The relationship between them is as follows.

[0080] Δa x =g[sin(θ pre,k )-sinθ pre,k-1 ]+gsin(Δθ err )cos(θ pre,k )

[0081] +gsin(θ err )[cos(θ pre,k )-cosθ pre,k-1 ];

[0082] Among them, θ pre,k is the predicted value of the angular velocity slope at the current time node; θ pre,k-1 Represents the predicted value of the angular velocity slope at the previous time node; θ err θ err Indicates the slope estimation error of the previous cycle. Since the slope is not very large under actual working conditions, sin(θ err )≈0.

[0083] The above relationship can be used to determine Δa x The acceleration error range is the upper limit of the acceleration range a xlow and the lower limit of the acceleration range a xhigh .

[0084] a xlow =g[sin(θ pre,k )-sinθpre,k-1 ]+gsin(err low )cos(θ pre,k )

[0085] +gsin(θ err )[cos(θ pre,k )-cosθ pre,k-1 ];

[0086] a xhigh =g[sin(θ pre,k )-sinθ pre,k-1 ]+gsin(err high )cos(θ pre,k )

[0087] +gsin(θ err )[cos(θ pre,k )-cosθ pre,k-1 ];

[0088] According to the reference acceleration data, based on the acceleration error range, the target acceleration data is determined. Specifically, the target acceleration data is compared with the acceleration error range, and the acceleration data is limited by the upper and lower limits of the acceleration error range.

[0089] In an optional embodiment, target acceleration data is determined based on reference acceleration data and an acceleration error range, including: if the reference acceleration data is within the acceleration error range, the reference acceleration data is determined as the target acceleration data; if the reference acceleration data is not within the acceleration error range, a first difference between the reference acceleration data and an upper limit value of the acceleration range of the acceleration error range, and a second difference between the reference acceleration data and a lower limit value of the acceleration range of the acceleration error range are determined; if the first difference is greater than the second difference, the lower limit value of the acceleration range is determined as the target acceleration data; if the first difference is not greater than the second difference, the upper limit value of the acceleration range is determined as the target acceleration data.

[0090] Exemplarily, if the acceleration error range interval is [a, b], the reference acceleration data is c, and if the reference acceleration data c is within the acceleration error range interval [a, b], the reference acceleration data c is determined as the target acceleration data. If the reference acceleration data c is not within the acceleration error range interval [a, b], the first difference |ac| between the reference acceleration data c and the acceleration interval upper limit a of the acceleration error range interval, and the second difference |bc| between the reference acceleration data c and the acceleration interval lower limit b of the acceleration error range interval are determined. If the first difference is greater than the second difference, it means that the reference acceleration data c is closer to the acceleration interval lower limit, and the acceleration interval lower limit is determined as the target acceleration data. If the first difference is not greater than the second difference, it means that the reference acceleration data c is closer to the acceleration interval upper limit, and the acceleration interval upper limit is determined as the target acceleration data.

[0091] The technical solution of this embodiment determines the longitudinal acceleration data according to the current vehicle speed data, determines the reference acceleration data according to the sensor acceleration data and the longitudinal acceleration data, determines the acceleration error range interval based on the angular velocity gradient prediction value, and determines the target acceleration data based on the acceleration error range interval according to the reference acceleration data. The above technical solution determines the acceleration error range interval in combination with the angular velocity gradient prediction value, and uses the acceleration error range interval to limit the target acceleration data, thereby realizing abnormal processing of the target acceleration data and improving the accuracy of determining the target acceleration data.

[0092] Embodiment 3

[0093] Figure 3 This is a flow chart of a method for predicting the slope of a vehicle road surface provided in Embodiment 3 of the present invention. This embodiment is optimized and improved on the basis of the above-mentioned technical solutions.

[0094] Furthermore, the step of "determining the target road surface slope value of the target vehicle at the current time node based on the acceleration slope prediction value and the angular velocity slope prediction value" is refined into "determining the target gain of the target vehicle at the current time node; determining the target road surface slope value of the target vehicle at the current time node based on the target gain according to the angular velocity slope prediction value and the acceleration slope prediction value." to improve the method of determining the target road surface slope value.

[0095] It should be noted that for the parts not described in detail in the embodiments of the present invention, reference can be made to the descriptions of other embodiments. Figure 3 As shown, the method comprises the following specific steps:

[0096] S310: Determine the target angular velocity data of the target vehicle at the current time node.

[0097] S320: Obtain the historical road surface slope value at the previous time node, and determine the angular velocity slope prediction value according to the historical road surface slope value and the target angular velocity data.

[0098] S330: Determine the target acceleration data of the target vehicle at the current time node based on the angular velocity gradient prediction value.

[0099] S340: Determine the acceleration gradient prediction value according to the target acceleration data.

[0100] S350: Determine the target gain of the target vehicle at the current time node.

[0101] S360: Determine a target road surface slope value of the target vehicle at the current time node according to the angular velocity slope prediction value and the acceleration slope prediction value and based on the target gain.

[0102] Among them, the specific value of the target gain can be pre-set by relevant technical personnel according to actual needs. In order to achieve accurate estimation of the road slope, it can also be iteratively updated in real time when calculating the target road slope value at different time nodes.

[0103] In an optional embodiment, determining the target gain of the target vehicle at the current time node includes: determining vehicle acceleration data and vehicle angular velocity data of the target vehicle within a preset time window; constructing an observation noise covariance and a process noise covariance based on the vehicle angular velocity data and the vehicle angular velocity data; obtaining the historical error covariance at the previous time node, and determining the target gain of the target vehicle at the current time node based on the observation noise covariance, the process noise covariance and the historical error covariance.

[0104] Specifically, a time window is created. The time window can be created in advance according to actual needs, or can be created based on the current time node. For example, the time window can be the time period between the previous time node and the current time node.

[0105] The vehicle acceleration data and vehicle angular velocity data within the time window are collected, and based on the acceleration data and angular velocity data within the time window, the observation noise covariance R and the process noise covariance Q are estimated. The Kalman filter algorithm is used to calculate the Kalman filter gain K based on the observation noise covariance R and the process noise covariance Q values, and the Kalman filter gain K is determined as the target gain.

[0106] In order to further improve the calculation accuracy of the target gain, the vehicle acceleration data and the vehicle angular velocity data can also be comprehensively considered in the process of constructing the membership function of the observation noise variance R and the process noise covariance Q.

[0107] In an optional embodiment, based on the vehicle angular velocity data and the vehicle angular velocity data, the observation noise covariance and the process noise covariance are constructed, including: determining the number of acceleration data in the vehicle acceleration data that is less than a preset acceleration threshold; and determining the angular velocity integral value of the vehicle angular velocity data in a preset time window; based on the number of acceleration data and the angular velocity integral value, the observation noise covariance and the process noise covariance are constructed.

[0108] Specifically, the acceleration threshold is pre-calibrated, and the number of acceleration data that is less than the preset angular velocity threshold in the acceleration data is determined, which is recorded as n. equal This index is used to characterize the degree to which the vehicle travels at a constant speed. equal The larger the value, the higher the vehicle's uniform speed. equal The smaller the value, the lower the uniform speed of the vehicle. Determine the angular velocity integral value of the vehicle angular velocity data in the preset time window, recorded as I w This index is used to characterize the degree of change in road slope. w The higher it is, the greater the change in road slope; w The lower it is, the smaller the change in road slope is.

[0109] Using the trapezoidal membership function, we establish these two variables n equal and I w The fuzzy subsets of the observed noise variance R and the process noise covariance Q are established using the triangular membership function. Based on actual test experience, the fuzzy logic rules of the two subsets are given to adapt different R and Q values ​​for different working conditions. For example, when the vehicle is traveling at a constant speed (n equal When the road surface is turbulent (I w When the value is high, the gyroscope prediction is trusted, which increases the observation noise variance R; the same is true for Q.

[0110] According to the angular velocity slope prediction value θ pre,k and the predicted value of acceleration slope θ obs,k , based on the target gain K, determine the target road slope value θ of the target vehicle at the current time node k k , the specific implementation method is as follows.

[0111] θ k =(1-K)θ pre,k +Kθ obs,k ;

[0112] The technical solution of this embodiment determines the target gain of the target vehicle at the current time node, and determines the target road slope value of the target vehicle at the current time node based on the target gain according to the angular velocity slope prediction value and the acceleration slope prediction value. By combining the target gain, i.e., the Kalman filter gain, in the process of estimating the road slope value, the estimation accuracy of the target road slope is improved.

[0113] Embodiment 4

[0114] Figure 4 The present invention provides a schematic diagram of the structure of a vehicle road surface slope prediction device provided in the fourth embodiment of the present invention. The vehicle road surface slope prediction device provided in the embodiment of the present invention can be used to predict the road surface slope during the driving process of the vehicle. The vehicle road surface slope prediction device can be implemented in the form of hardware and / or software, such as Figure 4 As shown, the device specifically includes: a target angular velocity determination module 401, an angular velocity gradient prediction module 402, a target acceleration determination module 403, an acceleration gradient prediction module 404 and a road surface gradient value prediction module 405.

[0115] in,

[0116] The target angular velocity determination module 401 is used to determine the target angular velocity data of the target vehicle at the current time node;

[0117] The angular velocity gradient prediction module 402 is used to obtain the historical road gradient value at the previous time node, and determine the angular velocity gradient prediction value according to the historical road gradient value and the target angular velocity data;

[0118] A target acceleration determination module 403 is used to determine the target acceleration data of the target vehicle at the current time node based on the angular velocity gradient prediction value;

[0119] The acceleration gradient prediction module 404 is used to determine the acceleration gradient prediction value according to the target acceleration data;

[0120] The road surface gradient value prediction module 405 is used to determine the target road surface gradient value of the target vehicle at the current time node according to the acceleration gradient prediction value and the angular velocity gradient prediction value.

[0121] The technical solution of the embodiment of the present invention determines the target angular velocity data of the target vehicle at the current time node, and determines the angular velocity slope prediction value based on the historical road surface slope value and the target angular velocity data; determines the target acceleration data of the target vehicle at the current time node based on the angular velocity slope prediction value; determines the acceleration slope prediction value based on the target acceleration data; determines the target road surface slope value of the target vehicle at the current time node based on the acceleration slope prediction value and the angular velocity slope prediction value. In the process of estimating the target road surface slope value of the target vehicle, the above technical solution comprehensively considers the acceleration sensor data and the angular velocity sensor data, and uses the acceleration data fusion method of the two sensors to perform slope estimation, thereby improving the accuracy of road surface slope estimation and avoiding the problem of low accuracy of short-term or long-term estimation results in the process of using a single sensor for slope estimation.

[0122] Optionally, the target angular velocity determination module 401 is specifically configured to:

[0123] Acquiring sensor angular velocity data of the target vehicle at the current time node; and,

[0124] Acquire reference angular velocity data of the target vehicle in a preset time period after power-on, and determine an angular velocity zero drift estimation value according to the reference angular velocity data;

[0125] The target angular velocity data of the target vehicle at the current time node is determined according to the sensor angular velocity data and the angular velocity zero drift estimation value.

[0126] Optionally, the target acceleration determination module 403 includes:

[0127] A speed data acquisition unit, used to acquire sensor acceleration data and current vehicle speed data of the target vehicle at a current time node;

[0128] a longitudinal acceleration determination unit, configured to determine longitudinal acceleration data according to the current vehicle speed data;

[0129] a reference acceleration determination unit, configured to determine reference acceleration data according to the sensor acceleration data and the longitudinal acceleration data;

[0130] An acceleration error interval determination unit, configured to determine an acceleration error range interval based on the angular velocity gradient prediction value;

[0131] The target acceleration determination unit is used to determine the target acceleration data according to the reference acceleration data and based on the acceleration error range interval.

[0132] Optionally, the acceleration error interval determination unit is specifically used to:

[0133] Obtaining an angular velocity interval upper limit value and an angular velocity interval lower limit value of an angular velocity error range, and obtaining a slope estimation error at the previous time node;

[0134] According to the angular velocity interval upper limit value and the angular velocity gradient prediction value, based on the gradient estimation error, determining the acceleration interval upper limit value of the angular velocity error range interval; and,

[0135] According to the angular velocity interval lower limit value and the angular velocity gradient prediction value, based on the gradient estimation error, the acceleration interval lower limit value of the angular velocity error range interval is determined.

[0136] Optionally, the target acceleration determination unit is specifically used to:

[0137] If the reference acceleration data is within the acceleration error range, determining the reference acceleration data as the target acceleration data;

[0138] If the reference acceleration data is not within the acceleration error range, determining a first difference between the reference acceleration data and an upper limit of the acceleration range of the acceleration error range, and a second difference between the reference acceleration data and a lower limit of the acceleration range of the acceleration error range;

[0139] If the first difference is greater than the second difference, determining the lower limit of the acceleration interval as the target acceleration data;

[0140] If the first difference is not greater than the second difference, the upper limit value of the acceleration interval is determined as the target acceleration data.

[0141] Optionally, the road surface slope value prediction module 405 includes:

[0142] A target gain determination unit, used to determine the target gain of the target vehicle at the current time node;

[0143] The slope value prediction unit is used to determine the target road surface slope value of the target vehicle at the current time node based on the target gain according to the angular velocity slope prediction value and the acceleration slope prediction value.

[0144] Optionally, the target gain determination unit includes:

[0145] A related data determination subunit, used to determine the vehicle acceleration data and vehicle angular velocity data of the target vehicle within a preset time window;

[0146] A construction subunit, configured to construct an observation noise covariance and a process noise covariance based on the vehicle angular velocity data and the vehicle angular velocity data;

[0147] The target gain determination subunit is used to obtain the historical error covariance at the previous time node, and determine the target gain of the target vehicle at the current time node according to the observed noise covariance, the process noise covariance and the historical error covariance.

[0148] Optionally, construct subunits, specifically for:

[0149] Determining the number of acceleration data in the vehicle acceleration data that is less than a preset acceleration threshold; and,

[0150] Determine an angular velocity integral value of the vehicle angular velocity data in the preset time window;

[0151] An observation noise covariance and a process noise covariance are constructed according to the acceleration data quantity and the angular velocity integral value.

[0152] The vehicle driving road surface slope prediction device provided in the embodiment of the present invention can execute the vehicle driving road surface slope prediction method provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method.

[0153] Embodiment 5

[0154] Figure 5 A schematic diagram of an electronic device 50 that can be used to implement an embodiment of the present invention is shown. The electronic device is intended to represent various forms of digital computers, such as laptop computers, desktop computers, workstations, personal digital assistants, servers, blade servers, mainframe computers, and other suitable computers. The electronic device can also represent various forms of mobile devices, such as personal digital processing, cellular phones, smart phones, wearable devices (such as helmets, glasses, watches, etc.) and other similar computing devices. The components shown herein, their connections and relationships, and their functions are merely examples and are not intended to limit the implementation of the present invention described and / or required herein.

[0155] like Figure 5As shown, the electronic device 50 includes at least one processor 51, and a memory connected to the at least one processor 51 in communication, such as a read-only memory (ROM) 52, a random access memory (RAM) 53, etc., wherein the memory stores a computer program that can be executed by at least one processor, and the processor 51 can perform various appropriate actions and processes according to the computer program stored in the read-only memory (ROM) 52 or the computer program loaded from the storage unit 58 to the random access memory (RAM) 53. In the RAM 53, various programs and data required for the operation of the electronic device 50 can also be stored. The processor 51, the ROM 52, and the RAM 53 are connected to each other via a bus 54. An input / output (I / O) interface 55 is also connected to the bus 54.

[0156] A number of components in the electronic device 50 are connected to the I / O interface 55, including: an input unit 56, such as a keyboard, a mouse, etc.; an output unit 57, such as various types of displays, speakers, etc.; a storage unit 58, such as a disk, an optical disk, etc.; and a communication unit 59, such as a network card, a modem, a wireless communication transceiver, etc. The communication unit 59 allows the electronic device 50 to exchange information / data with other devices through a computer network such as the Internet and / or various telecommunication networks.

[0157] The processor 51 may be a variety of general and / or special processing components with processing and computing capabilities. Some examples of the processor 51 include, but are not limited to, a central processing unit (CPU), a graphics processing unit (GPU), various special artificial intelligence (AI) computing chips, various processors running machine learning model algorithms, a digital signal processor (DSP), and any appropriate processor, controller, microcontroller, etc. The processor 51 executes the various methods and processes described above, such as a method for predicting the slope of a vehicle driving road.

[0158] In some embodiments, the vehicle driving road surface slope prediction method can be implemented as a computer program, which is tangibly contained in a computer-readable storage medium, such as a storage unit 58. In some embodiments, part or all of the computer program can be loaded and / or installed on the electronic device 50 via the ROM 52 and / or the communication unit 59. When the computer program is loaded into the RAM 53 and executed by the processor 51, one or more steps of the vehicle driving road surface slope prediction method described above can be performed. Alternatively, in other embodiments, the processor 51 can be configured to execute the vehicle driving road surface slope prediction method in any other appropriate manner (for example, by means of firmware).

[0159] Various implementations of the systems and techniques described above herein can be implemented in digital electronic circuit systems, integrated circuit systems, field programmable gate arrays (FPGAs), application specific integrated circuits (ASICs), application specific standard products (ASSPs), systems on chips (SOCs), load programmable logic devices (CPLDs), computer hardware, firmware, software, and / or combinations thereof. These various implementations can include: being implemented in one or more computer programs that can be executed and / or interpreted on a programmable system including at least one programmable processor, which can be a special purpose or general purpose programmable processor that can receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.

[0160] Computer programs for implementing the methods of the present invention may be written in any combination of one or more programming languages. These computer programs may be provided to a processor of a general-purpose computer, a special-purpose computer, or other programmable data processing device, so that when the computer program is executed by the processor, the functions / operations specified in the flow chart and / or block diagram are implemented. The computer program may be executed entirely on the machine, partially on the machine, partially on the machine and partially on a remote machine as a stand-alone software package, or entirely on a remote machine or server.

[0161] In the context of the present invention, a computer-readable storage medium may be a tangible medium that may contain or store a computer program for use by or in combination with an instruction execution system, device or equipment. A computer-readable storage medium may include, but is not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, devices or equipment, or any suitable combination of the foregoing. Alternatively, a computer-readable storage medium may be a machine-readable signal medium. A more specific example of a machine-readable storage medium may include an electrical connection based on one or more lines, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing.

[0162] To provide interaction with a user, the systems and techniques described herein may be implemented on an electronic device having: a display device (e.g., a CRT (cathode ray tube) or LCD (liquid crystal display) monitor) for displaying information to the user; and a keyboard and a pointing device (e.g., a mouse or trackball) through which the user can provide input to the electronic device. Other types of devices may also be used to provide interaction with the user; for example, the feedback provided to the user may be any form of sensory feedback (e.g., visual feedback, auditory feedback, or tactile feedback); and input from the user may be received in any form (including acoustic input, voice input, or tactile input).

[0163] The systems and techniques described herein may be implemented in a computing system that includes backend components (e.g., as a data server), or a computing system that includes middleware components (e.g., an application server), or a computing system that includes frontend components (e.g., a user computer with a graphical user interface or a web browser through which a user can interact with implementations of the systems and techniques described herein), or a computing system that includes any combination of such backend components, middleware components, or frontend components. The components of the system may be interconnected by any form or medium of digital data communication (e.g., a communication network). Examples of communication networks include: a local area network (LAN), a wide area network (WAN), a blockchain network, and the Internet.

[0164] A computing system may include a client and a server. The client and the server are generally remote from each other and usually interact through a communication network. The client and server relationship is generated by computer programs running on the corresponding computers and having a client-server relationship with each other. The server may be a cloud server, also known as a cloud computing server or cloud host, which is a host product in the cloud computing service system to solve the defects of difficult management and weak business scalability in traditional physical hosts and VPS services.

[0165] It should be understood that the various forms of processes shown above can be used to reorder, add or delete steps. For example, the steps described in the present invention can be executed in parallel, sequentially or in different orders, as long as the desired results of the technical solution of the present invention can be achieved, and this document does not limit this.

[0166] The above specific implementations do not constitute a limitation on the protection scope of the present invention. It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and substitutions can be made according to design requirements and other factors. Any modification, equivalent substitution and improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

Claims

1. A method for predicting the slope of a road surface on which a vehicle is traveling, characterized in that: include: Determine the target angular velocity data of the target vehicle at the current time node; Obtaining a historical road surface slope value at a previous time node, and determining an angular velocity slope prediction value according to the historical road surface slope value and the target angular velocity data; Determining target acceleration data of the target vehicle at a current time node based on the angular velocity gradient prediction value; Determining an acceleration gradient prediction value according to the target acceleration data; A target road surface slope value of the target vehicle at the current time node is determined according to the acceleration slope prediction value and the angular velocity slope prediction value.

2. The method according to claim 1, characterized in that The step of determining target angular velocity data of the target vehicle at the current time node includes: Acquiring sensor angular velocity data of the target vehicle at the current time node; and, Acquire reference angular velocity data of the target vehicle in a preset time period after power-on, and determine an angular velocity zero drift estimation value according to the reference angular velocity data; The target angular velocity data of the target vehicle at the current time node is determined according to the sensor angular velocity data and the angular velocity zero drift estimation value.

3. The method according to claim 1, characterized in that The step of determining target acceleration data of the target vehicle at a current time node based on the angular velocity gradient prediction value includes: Obtaining sensor acceleration data and current vehicle speed data of the target vehicle at the current time node; Determining longitudinal acceleration data according to the current vehicle speed data; Determining reference acceleration data according to the sensor acceleration data and the longitudinal acceleration data; Determining an acceleration error range based on the angular velocity slope prediction value; According to the reference acceleration data, target acceleration data is determined based on the acceleration error range.

4. The method according to claim 3, characterized in that The step of determining the acceleration error range based on the angular velocity slope prediction value includes: Obtaining an angular velocity interval upper limit value and an angular velocity interval lower limit value of an angular velocity error range, and obtaining a slope estimation error at the previous time node; According to the angular velocity interval upper limit value and the angular velocity gradient prediction value, based on the gradient estimation error, determining the acceleration interval upper limit value of the angular velocity error range interval; and, According to the angular velocity interval lower limit value and the angular velocity gradient prediction value, based on the gradient estimation error, the acceleration interval lower limit value of the angular velocity error range interval is determined.

5. The method according to claim 3, characterized in that: The step of determining target acceleration data based on the reference acceleration data and the acceleration error range includes: If the reference acceleration data is within the acceleration error range, determining the reference acceleration data as the target acceleration data; If the reference acceleration data is not within the acceleration error range, determining a first difference between the reference acceleration data and an upper limit of the acceleration range of the acceleration error range, and a second difference between the reference acceleration data and a lower limit of the acceleration range of the acceleration error range; If the first difference is greater than the second difference, determining the lower limit of the acceleration interval as the target acceleration data; If the first difference is not greater than the second difference, the upper limit value of the acceleration interval is determined as the target acceleration data.

6. The method according to claim 1, characterized in that The step of determining the target road surface slope value of the target vehicle at the current time node according to the acceleration slope prediction value and the angular velocity slope prediction value includes: Determining a target gain of the target vehicle at a current time node; According to the angular velocity gradient prediction value and the acceleration gradient prediction value, based on the target gain, a target road surface gradient value of the target vehicle at the current time node is determined.

7. The method according to claim 6, characterized in that The determining of the target gain of the target vehicle at the current time node includes: Determining vehicle acceleration data and vehicle angular velocity data of the target vehicle within a preset time window; constructing an observation noise covariance and a process noise covariance based on the vehicle angular velocity data and the vehicle angular velocity data; The historical error covariance at the previous time node is obtained, and the target gain of the target vehicle at the current time node is determined according to the observed noise covariance, the process noise covariance and the historical error covariance.

8. The method according to claim 7, characterized in that The step of constructing the observation noise covariance and the process noise covariance according to the vehicle angular velocity data and the vehicle angular velocity data comprises: Determining the number of acceleration data in the vehicle acceleration data that is less than a preset acceleration threshold; and, Determine an angular velocity integral value of the vehicle angular velocity data in the preset time window; An observation noise covariance and a process noise covariance are constructed according to the acceleration data quantity and the angular velocity integral value.

9. A device for predicting the slope of a road surface on which a vehicle is traveling, characterized in that: include: A target angular velocity determination module is used to determine the target angular velocity data of the target vehicle at the current time node; An angular velocity gradient prediction module is used to obtain a historical road surface gradient value at a previous time node, and determine an angular velocity gradient prediction value based on the historical road surface gradient value and the target angular velocity data; A target acceleration determination module, used to determine the target acceleration data of the target vehicle at the current time node based on the angular velocity gradient prediction value; An acceleration gradient prediction module, used to determine an acceleration gradient prediction value according to the target acceleration data; The road surface gradient value prediction module is used to determine the target road surface gradient value of the target vehicle at the current time node according to the acceleration gradient prediction value and the angular velocity gradient prediction value.

10. An electronic device, characterized in that: The electronic device comprises: at least one processor; and a memory communicatively connected to the at least one processor; wherein, The memory stores a computer program executable by the at least one processor, and the computer program is executed by the at least one processor so that the at least one processor can execute the business query method based on the question-answer model according to any one of claims 1 to 8.

11. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the vehicle driving road surface slope prediction method according to any one of claims 1-8 when executed.

12. A computer program product, characterized in that The computer program product comprises a computer program, which, when executed by a processor, implements the method for predicting the slope of a vehicle driving road according to any one of claims 1-8.

Citation Information

Patent Citations

  • Gradient determination method and device, vehicle and electronic equipment

    CN115923806A

  • Gradient determination method and device, vehicle and storage medium

    CN116729398A

  • Road longitudinal and roll slope estimation method based on Mahony algorithm and frequency domain analysis

    CN118514697A

  • Tractor slope recognition method, device and equipment and storage medium

    CN118618388A

  • Vehicle speed estimation device

    CN118683554A