Mining area scene road slope calculation method, system and equipment and readable storage medium

By using the preset map and real-time data of the vehicle positioning device, identifying the vehicle positioning status and calculating the slope value, the problem of inaccurate slope calculation in the mining area scene is solved, the accuracy and reliability of slope calculation are improved, and the vehicle is ensured in the mining area. safe operation.

CN118907113AActive Publication Date: 2024-11-08DONGFENG COMML VEHICLE CO LTD
View PDF 9 Cites 0 Cited by

Patent Information

Application Number
CN202410966316.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-18
Publication Date
2024-11-08
Estimated Expiration
2044-07-18

AI Technical Summary

Technical Problem

In mining areas, traditional road slope calculation methods are disturbed by noise and longitudinal acceleration, resulting in unstable positioning information, which in turn affects the accuracy of slope calculation.

Method used

Real-time positioning points are obtained through preset maps and vehicle-mounted positioning devices corresponding to the target mining area scene, identify the positioning status of the vehicle, and calculate the slope value of the current position based on the real-time slope and pitch angle values, and can still provide it even when the positioning is lost. Accurate slope calculation.

Benefits of technology

It significantly improves the accuracy and reliability of road slope calculations, ensuring the safe driving and operation of vehicles in the mining environment.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118907113A_ABST
    Figure CN118907113A_ABST
Patent Text Reader

Abstract

A mining area scene road gradient calculation method, system and device and a readable storage medium relate to the field of truck intelligent driving, and specifically comprise the steps of determining a positioning state of a target vehicle based on a preset map corresponding to a target mining area scene and a real-time positioning point acquired by a vehicle-mounted positioning device; determining a real-time slope reference value based on a real-time slope value and a real-time pitch angle value corresponding to the real-time positioning point when it is detected that the positioning state of the target vehicle is a positioning non-lost state or a positioning state from a non-lost state to a lost state; determining a current position gradient value corresponding to the target vehicle according to a preset map, the real-time gradient reference value and the real-time pitch angle value; and when it is detected that the positioning state of the target vehicle is a positioning loss state, determining a current position slope value based on a preset slope reference calibration value corresponding to a preset map and the real-time pitch angle value. The slope value of the current position is determined in combination with the real-time slope reference value and the real-time pitch angle data, and the accuracy of road slope calculation is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of intelligent driving of trucks, and specifically to a method, system, device and readable storage medium for calculating the slope of a road in a mining area. Background Art

[0002] In the complex scenes under the mine, accurate calculation of road slope is crucial to vehicle control. The slope is usually expressed as a percentage, that is, the ratio of the change in road height to the horizontal distance. Existing slope calculation methods are mainly aimed at simple scenes such as straight roads or highways, and rely on direct acquisition of IMU (Inertial Measurement Unit) or map data. However, in the underground mine environment, the road conditions vary greatly, and the traditional single slope calculation method is no longer applicable.

[0003] The traditional kinematics-based method uses IMU sensors to fuse acceleration and angular velocity data to estimate the slope, but it may be affected by large noise and longitudinal acceleration when the vehicle is moving, which in turn affects the accuracy of the slope calculation; especially in a closed mine environment, the real-time acquisition of vehicle positioning status information is unstable, resulting in a low accuracy rate in road slope calculation. Therefore, how to provide a road slope calculation method suitable for mining scenarios to improve the accuracy of slope calculation is an urgent problem to be solved. Summary of the invention

[0004] The present application provides a method, system, device and readable storage medium for calculating the road slope in a mining area scenario, which can solve the technical problem of low accuracy in calculating the road slope in a mining area scenario existing in the prior art.

[0005] In a first aspect, an embodiment of the present application provides a method for calculating the slope of a road in a mining area scenario, the method comprising:

[0006] Determine the positioning state of the target vehicle based on a preset map corresponding to the target mining scene and the real-time positioning points obtained by the vehicle-mounted positioning device, wherein the positioning state of the target vehicle includes a positioning non-lost state, a positioning from never lost to lost state, and a positioning lost state;

[0007] When it is detected that the positioning state of the target vehicle is a positioning non-lost state or a positioning state from never lost to lost state, a real-time slope reference value is determined based on a real-time slope value and a real-time pitch angle value corresponding to the real-time positioning point;

[0008] Determine the current position slope value corresponding to the target vehicle according to the preset map, the real-time slope reference value and the real-time pitch angle value;

[0009] When it is detected that the positioning state of the target vehicle is a positioning lost state, a current position slope value corresponding to the target vehicle is determined based on a preset slope reference calibration value corresponding to the preset map and the real-time pitch angle value.

[0010] In combination with the first aspect, in one implementation, the number of the real-time positioning points is multiple, and the real-time slope reference value is determined based on the real-time slope value and the real-time pitch angle value corresponding to the real-time positioning point, including:

[0011] The real-time slope values ​​and the real-time pitch angle values ​​corresponding to the multiple real-time positioning points are averaged to obtain the real-time slope average value and the real-time pitch angle average value;

[0012] The real-time slope average value and the real-time pitch angle average value are subjected to difference processing to obtain a real-time slope reference value.

[0013] In combination with the first aspect, in one implementation, determining the current position slope value corresponding to the target vehicle according to the preset map, the real-time slope reference value and the real-time pitch angle value includes:

[0014] When it is detected that the target vehicle is in a state where the positioning is not lost, the slope value of the current position is obtained based on the preset map;

[0015] When it is detected that the target vehicle is in a state from never-lost positioning to lost positioning, the current position slope value is determined based on the real-time slope reference value and the real-time pitch angle value.

[0016] In combination with the first aspect, in one implementation, determining the slope value of the current position based on the real-time slope reference value and the real-time pitch angle value includes:

[0017] Substituting the real-time slope reference value and the real-time pitch angle value into a first calculation formula to obtain the current position slope value, the first calculation formula is:

[0018]

[0019] In the formula, It is the multiplication factor for converting radian units to angle units; VehDa_rSlop_mp is the slope value of the current position; IMU_pitch is the real-time pitch angle value; pitch_ZERO is the real-time slope reference value.

[0020] In combination with the first aspect, in one implementation, determining the current position slope value corresponding to the target vehicle based on the preset slope reference calibration value corresponding to the preset map and the real-time pitch angle value includes:

[0021] Substituting the preset slope reference calibration value and the real-time pitch angle into a second calculation formula to obtain the current position slope value, the second calculation formula is:

[0022]

[0023] In the formula, It is the multiplication factor for converting radian units to angle units; VehDa_rSlop_mp is the slope value of the current position; IMU_pitch is the real-time pitch angle value; pitch_ZERO_tmp is the preset slope reference calibration value.

[0024] In a second aspect, an embodiment of the present application provides a system for calculating the slope of a road in a mining area scenario, and the system for calculating the slope of a road in a mining area scenario includes:

[0025] A first processing module, which is used to determine the positioning state of the target vehicle based on a preset map corresponding to the target mining area scene and the real-time positioning points obtained by the vehicle-mounted positioning device, wherein the positioning state of the target vehicle includes a positioning non-lost state, a positioning from never lost to lost state, and a positioning lost state;

[0026] A second processing module is used to determine a real-time slope reference value based on a real-time slope value and a real-time pitch angle value corresponding to a real-time positioning point when it is detected that the positioning state of the target vehicle is a positioning non-lost state or a positioning state from never lost to lost state;

[0027] A third processing module, which is used to determine the current position slope value corresponding to the target vehicle according to the preset map, the real-time slope reference value and the real-time pitch angle value;

[0028] The fourth processing module is used to determine the current position slope value corresponding to the target vehicle based on the preset slope reference calibration value corresponding to the preset map and the real-time pitch angle value when it is detected that the positioning state of the target vehicle is a positioning lost state.

[0029] In conjunction with the second aspect, in one implementation, the number of the real-time positioning points is multiple, and the second processing module is specifically configured to:

[0030] The real-time slope values ​​and the real-time pitch angle values ​​corresponding to the multiple real-time positioning points are averaged to obtain the real-time slope average value and the real-time pitch angle average value;

[0031] The real-time slope average value and the real-time pitch angle average value are subjected to difference processing to obtain a real-time slope reference value.

[0032] In conjunction with the second aspect, in one implementation, the third processing module is specifically configured to:

[0033] When it is detected that the target vehicle is in a state where the positioning is not lost, the slope value of the current position is obtained based on the preset map;

[0034] When it is detected that the target vehicle is in a state from never-lost positioning to lost positioning, the current position slope value is determined based on the real-time slope reference value and the real-time pitch angle value.

[0035] In the third aspect, an embodiment of the present application provides a mining scene road slope calculation device, which includes a processor, a memory, and a mining scene road slope calculation program stored in the memory and executable by the processor, wherein when the mining scene road slope calculation program is executed by the processor, the steps of the mining scene road slope calculation method as described in any of the above items are implemented.

[0036] In a fourth aspect, an embodiment of the present application provides a computer-readable storage medium, on which a mining scene road slope calculation program is stored. When the mining scene road slope calculation program is executed by a processor, the steps of the mining scene road slope calculation method as described in any of the above items are implemented.

[0037] The beneficial effects brought by the technical solution provided in the embodiments of the present application include:

[0038] The positioning state of the target vehicle (not lost, from never lost to lost, lost) is accurately identified by the preset map corresponding to the target mining scene and the real-time positioning point obtained by the vehicle-mounted positioning device. This precise state identification avoids the problem of unstable positioning caused by signal interference or environmental occlusion; when the positioning state of the target vehicle is detected to be a positioning non-lost state or a positioning from never lost to lost state, the real-time slope reference value is determined according to the real-time slope and pitch angle value, and the current position slope value corresponding to the target vehicle is determined according to the preset map, the real-time slope reference value and the real-time pitch angle value; when the positioning state of the target vehicle is detected to be a positioning lost state, the slope value of the current position is determined according to the preset slope reference calibration value and the real-time pitch angle value, and the accurate calculation of the road slope is still provided when the positioning information is unavailable, ensuring the safe driving and operation of the vehicle in the mining environment. The present application effectively avoids the problem of unstable vehicle positioning information in the closed environment of the mining area, and significantly improves the accuracy and reliability of the road slope calculation. BRIEF DESCRIPTION OF THE DRAWINGS

[0039] Figure 1 This is a flow chart of an embodiment of a method for calculating the road slope in a mining area scenario of the present application;

[0040] Figure 2 For this application Figure 1 A detailed flow chart of step S10;

[0041] Figure 3 For this application Figure 1 Detailed flow chart of step S20;

[0042] Figure 4 This is a schematic diagram of the architecture of an embodiment of a system for calculating the road slope in a mining area scenario of the present application;

[0043] Figure 5 This is a schematic diagram of the hardware structure of a mining scene road slope calculation device involved in the embodiment of the present application. DETAILED DESCRIPTION

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

[0045] In order to make the objectives, technical solutions and advantages of the present application clearer, the implementation methods of the present application will be further described in detail below with reference to the accompanying drawings.

[0046] In a first aspect, an embodiment of the present application provides a method for calculating the slope of a road in a mining area scenario.

[0047] In one embodiment, referring to Figure 1 , Figure 1 This is a flow chart of an embodiment of the method for calculating the road slope in a mining area scenario of this application. Figure 1 As shown in the figure, the method for calculating the road slope in the mining area scenario includes:

[0048] Step S10: Determine the positioning status of the target vehicle based on a preset map corresponding to the target mining scene and the real-time positioning points obtained by the vehicle-mounted positioning device, wherein the positioning status of the target vehicle includes a positioning non-lost state, a positioning from never lost to lost state, and a positioning lost state.

[0049] Exemplarily, in an embodiment of the present application, a preset map corresponding to the target mining scene can be recorded in advance, and the on-board positioning device includes a laser radar, a global positioning system, an inertial navigation system, etc. The embodiment of the present application can obtain the real-time positioning point corresponding to the target vehicle through the laser radar. The real-time positioning point represents the x, y, and z values ​​corresponding to the target vehicle in the world coordinate system; for example, the distance between each real-time positioning point is set to 10 cm, and 100 real-time positioning points can be selected, then the total distance corresponding to the real-time positioning point is 0.1m*100=1m.

[0050] Specifically, the real-time positioning points obtained by the lidar are matched with the coordinate points in the preset map, and whether the positioning status of the vehicle is normal is judged according to the matching results; if the real-time positioning points obtained by the lidar are consistent with the coordinate points in the map, indicating that the positioning points match normally, then the positioning status of the target vehicle is a positioning not lost state.

[0051] It should be noted that a counting variable threshold pitch_ZERO_flag can be set to determine whether the positioning data of the target vehicle is a normal value within a certain period of time by accumulation, wherein the specific value of the counting variable threshold pitch_ZERO_flag can be determined according to actual needs and is not limited here; for example, the counting variable threshold pitch_ZERO_flag can be set to 100. Then, if the real-time positioning point obtained by the laser radar is inconsistent with the coordinate point in the map, it indicates that the positioning point matching is abnormal. At this time, the value of the real-time counting variable pitch_ZERO_flags is detected again, and the size between the real-time counting variable pitch_ZERO_flags and the counting variable threshold pitch_ZERO_flag is used to determine whether the target vehicle is in a state from never lost to lost or in a state of lost positioning.

[0052] Step S20: When it is detected that the positioning state of the target vehicle is a positioning non-lost state or a positioning state from never lost to lost state, a real-time slope reference value is determined based on the real-time slope value and the real-time pitch angle value corresponding to the real-time positioning point.

[0053] Exemplarily, in an embodiment of the present application, when it is detected that the positioning status of the target vehicle is a positioning not lost state or the positioning has changed from never lost to a lost state, the real-time slope value corresponding to the real-time positioning point can be obtained through the laser radar, and the real-time pitch angle corresponding to the real-time positioning point can be obtained through the IMU; then the real-time slope reference value is determined based on the real-time slope value and the real-time pitch angle.

[0054] Step S30: Determine the current position slope value corresponding to the target vehicle according to the preset map, the real-time slope reference value and the real-time pitch angle value.

[0055] Exemplarily, in an embodiment of the present application, when it is detected that the positioning status of the target vehicle is a positioning not lost state or the positioning has changed from never lost to lost state, the current position slope value corresponding to the target vehicle can be determined based on the calculated real-time slope reference value, the slope data corresponding to the coordinate point in the preset map, and the real-time pitch angle.

[0056] Step S40: When it is detected that the positioning state of the target vehicle is a positioning lost state, the current position slope value corresponding to the target vehicle is determined based on the preset slope reference calibration value corresponding to the preset map and the real-time pitch angle value.

[0057] Exemplarily, in the embodiment of the present application, the preset slope reference calibration value can be determined according to actual needs, which is not limited here; for example, the preset slope reference calibration value can be obtained by calibration when the target vehicle is driving on a straight road in a mining scene. When it is detected that the real-time counting variable pitch_ZERO_flags is less than the counting variable threshold pitch_ZERO_flag, it means that the positioning has been in a lost state and there is no slope reference value to be used as a reference. At this time, the current road slope value corresponding to the target vehicle can be determined according to the preset slope reference value and the real-time pitch angle.

[0058] This application accurately identifies the positioning state of the target vehicle (not lost, from never lost to lost, lost) through the preset map corresponding to the target mining scene and the real-time positioning point obtained by the vehicle-mounted positioning device. This precise state recognition avoids the problem of unstable positioning caused by signal interference or environmental occlusion; when the positioning state of the target vehicle is detected to be a positioning non-lost state or a positioning from never lost to lost state, the real-time slope reference value is determined according to the real-time slope and pitch angle value, and the current position slope value corresponding to the target vehicle is determined according to the preset map, the real-time slope reference value and the real-time pitch angle value; when the positioning state of the target vehicle is detected to be a positioning lost state, the slope value of the current position is determined according to the preset slope reference calibration value and the real-time pitch angle value, and the accurate calculation of the road slope is still provided when the positioning information is unavailable, ensuring the safe driving and operation of the vehicle in the mining environment. This application effectively avoids the problem of unstable vehicle positioning information in the closed environment of the mining area, and significantly improves the accuracy and reliability of the road slope calculation.

[0059] Further, in one embodiment, referring to Figure 2 As shown, the number of the real-time positioning points is multiple, and the real-time slope reference value is determined based on the real-time slope value and the real-time pitch angle value corresponding to the real-time positioning point, including:

[0060] Step S101: averaging the real-time slope values ​​and real-time pitch angle values ​​corresponding to a plurality of real-time positioning points to obtain a real-time slope mean value and a real-time pitch angle mean value;

[0061] Step S102: Perform a difference process on the real-time slope mean value and the real-time pitch angle mean value to obtain a real-time slope reference value.

[0062] Exemplarily, in the embodiment of the present application, the number of real-time positioning points is multiple, and the real-time slope average and the real-time pitch angle average can be obtained by averaging the real-time slope values ​​and the real-time pitch angle values ​​of the multiple real-time positioning points, and then the real-time slope average and the real-time pitch angle average are subjected to difference processing to obtain a more accurate real-time slope reference value. Specifically, the following describes a method for determining the real-time slope reference value by taking 10 real-time positioning points as an example:

[0063] Step E1: Obtain the real-time slope values ​​M1, M2, M3, M4, M5, M6, M7, M8, M9, M10 of 10 real-time positioning points and 10 real-time pitch angle values ​​N1, N2, N3, N4, N5, N6, N7, N8, N9, N10.

[0064] Step E2: Calculate the average values ​​of ten groups of slopes and ten groups of pitch angles, and convert the slope percentages into corresponding angle values ​​to obtain the average slope value temp1 and the average pitch angle value temp2.

[0065] Step E3: Calculate the difference between the average slope value temp1 and the average pitch angle value temp2 as the real-time slope reference value, that is, the real-time slope reference value pitch_ZERO=temp1-temp2.

[0066] It should be noted that the method for determining the real-time slope reference value can also be implemented through code. Taking 100 real-time positioning points (10 in a group, 10 groups in total) as an example, the specific steps are as follows:

[0067] Step F1: Initialize arrays and variables. Slope_map_array and pitch_imu_array are used to store the slope values ​​and pitch angle values ​​of ten groups of positioning points respectively; pitch_ZERO is the slope reference value.

[0068] Step F2: data filling, use a loop to move the first nine groups of data forward, and assign new values ​​to the positions of the last group, namely the latest slope value slope_map_array and pitch angle value pitch_imu_array.

[0069] Step F3: Calculate the cumulative sum and the average value. Use a loop to calculate the cumulative sum of all values ​​in slope_map_array and pitch_imu_array; divide the cumulative sum by 10 to obtain the average values ​​of the slope and pitch angles, temp3 and temp4.

[0070] Step F4: Convert the slope value by using the inverse tangent function std::atan to convert the slope percentage into an angle value and multiplying it by 57.3 (180 / π) to convert it into degrees.

[0071] Step F5: Calculate the slope reference value pitch_ZERO, that is, the average value of the slope value temp3 minus the average value of the pitch angle temp4.

[0072] Further, in one embodiment, referring to Figure 3 As shown, the current position slope value corresponding to the target vehicle is determined according to the preset map, the real-time slope reference value and the real-time pitch angle value, including:

[0073] Step S201: when it is detected that the target vehicle is in a state where the positioning is not lost, the slope value of the current position is obtained based on a preset map;

[0074] Step S202: when it is detected that the target vehicle is in a state from never-lost to lost positioning, the slope value of the current position is determined based on the real-time slope reference value and the real-time pitch angle value;

[0075] Exemplarily, in the embodiment of the present application, assuming that the positioning loss flag is LocationEx_Flag, when it is detected that the positioning loss flag LocationEx_Flag is 0, it means that the target vehicle is in a state where the positioning is not lost, then the slope value VehDa_rSlop_mp of the current position can be obtained from the map data (preset map) recorded in advance.

[0076] When the positioning loss flag LocationEx_Flag is detected to be 1, it means that the positioning has been lost. At this time, the positioning status of the target vehicle is judged according to the value of the real-time counting variable. When the real-time counting variable pitch_ZERO_flags is detected to be 101 (101>100), it indicates that there was normal positioning data before the positioning was lost. At this time, the corresponding real-time slope reference value is calculated based on the existing normal positioning data, and then the current road slope value is determined based on the real-time slope reference value and the real-time pitch angle.

[0077] Further, in one embodiment, determining the slope value of the current position based on the real-time slope reference value and the real-time pitch angle value includes:

[0078] Substituting the real-time slope reference value and the real-time pitch angle value into a first calculation formula to obtain the current position slope value, the first calculation formula is:

[0079]

[0080] In the formula, It is the multiplication factor for converting radian units to angle units; VehDa_rSlop_mp is the slope value of the current position; IMU_pitch is the real-time pitch angle value; pitch_ZERO is the real-time slope reference value.

[0081] Exemplarily, in the embodiment of the present application, the real-time pitch angle value IMU_pitch and the real-time slope reference value pitch_ZERO are substituted into the following calculation formula to obtain the current position slope value VehDa_rSlop_mp, and the calculation formula is as follows:

[0082]

[0083] Further, in one embodiment, the determining of the current position slope value corresponding to the target vehicle based on the preset slope reference calibration value corresponding to the preset map and the real-time pitch angle value includes:

[0084] Substituting the preset slope reference calibration value and the real-time pitch angle into a second calculation formula to obtain the current position slope value, the second calculation formula is:

[0085]

[0086] In the formula, It is the multiplication factor for converting radian units to angle units; VehDa_rSlop_mp is the slope value of the current position; IMU_pitch is the real-time pitch angle value; pitch_ZERO_tmp is the preset slope reference calibration value.

[0087] Exemplarily, in the embodiment of the present application, the preset slope reference calibration value pitch_ZERO_tmp and the real-time pitch angle IMU_pitch are substituted into the calculation formula to obtain the current position slope value VehDa_rSlop_mp, and the calculation formula is as follows:

[0088]

[0089] In the second aspect, the embodiment of the present application also provides a mining area scene road slope calculation system, referring to Figure 4 As shown, the mining area scene road slope calculation system includes:

[0090] A first processing module, which is used to determine the positioning state of the target vehicle based on a preset map corresponding to the target mining area scene and the real-time positioning points obtained by the vehicle-mounted positioning device, wherein the positioning state of the target vehicle includes a positioning non-lost state, a positioning from never lost to lost state, and a positioning lost state;

[0091] A second processing module is used to determine a real-time slope reference value based on a real-time slope value and a real-time pitch angle value corresponding to a real-time positioning point when it is detected that the positioning state of the target vehicle is a positioning non-lost state or a positioning state from never lost to lost state;

[0092] A third processing module, which is used to determine the current position slope value corresponding to the target vehicle according to the preset map, the real-time slope reference value and the real-time pitch angle value;

[0093] The fourth processing module is used to determine the current position slope value corresponding to the target vehicle based on the preset slope reference calibration value corresponding to the preset map and the real-time pitch angle value when it is detected that the positioning state of the target vehicle is a positioning lost state.

[0094] Furthermore, in one embodiment, the number of the real-time positioning points is multiple, and the second processing module is specifically used for:

[0095] The real-time slope values ​​and the real-time pitch angle values ​​corresponding to the multiple real-time positioning points are averaged to obtain the real-time slope average value and the real-time pitch angle average value;

[0096] The real-time slope average value and the real-time pitch angle average value are subjected to difference processing to obtain a real-time slope reference value.

[0097] Furthermore, in one embodiment, the third processing module is specifically used for:

[0098] When it is detected that the target vehicle is in a state where the positioning is not lost, the slope value of the current position is obtained based on the preset map;

[0099] When it is detected that the target vehicle is in a state from never-lost positioning to lost positioning, the current position slope value is determined based on the real-time slope reference value and the real-time pitch angle value.

[0100] Furthermore, in one embodiment, the third processing module is further configured to:

[0101] Substituting the real-time slope reference value and the real-time pitch angle value into a first calculation formula to obtain the current position slope value, the first calculation formula is:

[0102]

[0103] In the formula, It is the multiplication factor for converting radian units to angle units; VehDa_rSlop_mp is the slope value of the current position; IMU_pitch is the real-time pitch angle value; pitch_ZERO is the real-time slope reference value.

[0104] Furthermore, in one embodiment, the fourth processing module is further configured to:

[0105] Substituting the preset slope reference calibration value and the real-time pitch angle into a second calculation formula to obtain the current position slope value, the second calculation formula is:

[0106]

[0107] In the formula, It is the multiplication factor for converting radian units to angle units; VehDa_rSlop_mp is the slope value of the current position; IMU_pitch is the real-time pitch angle value; pitch_ZERO_tmp is the preset slope reference calibration value.

[0108] This application accurately identifies the positioning state of the target vehicle (not lost, from never lost to lost, lost) through the preset map corresponding to the target mining scene and the real-time positioning point obtained by the vehicle-mounted positioning device. This precise state recognition avoids the problem of unstable positioning caused by signal interference or environmental occlusion; when the positioning state of the target vehicle is detected to be a positioning non-lost state or a positioning from never lost to lost state, the real-time slope reference value is determined according to the real-time slope and pitch angle value, and the current position slope value corresponding to the target vehicle is determined according to the preset map, the real-time slope reference value and the real-time pitch angle value; when the positioning state of the target vehicle is detected to be a positioning lost state, the slope value of the current position is determined according to the preset slope reference calibration value and the real-time pitch angle value, and the accurate calculation of the road slope is still provided when the positioning information is unavailable, ensuring the safe driving and operation of the vehicle in the mining environment. This application effectively avoids the problem of unstable vehicle positioning information in the closed environment of the mining area, and significantly improves the accuracy and reliability of the road slope calculation.

[0109] Among them, the functional implementation of each module in the above-mentioned mining scene road slope calculation system corresponds to the various steps in the above-mentioned mining scene road slope calculation method embodiment, and its functions and implementation processes will not be repeated here one by one.

[0110] In a third aspect, an embodiment of the present application provides a device for calculating the slope of a road in a mining area scenario. The device for calculating the slope of a road in a mining area scenario may be a personal computer (PC), a laptop computer, a server, or other device with data processing capabilities.

[0111] Reference Figure 5 , Figure 5 The hardware structure diagram of the mining area scene road slope calculation device involved in the embodiment of the present application is shown in FIG. In the embodiment of the present application, the mining area scene road slope calculation device may include a processor, a memory, a communication interface, and a communication bus.

[0112] The communication bus may be of any type and is used to interconnect the processor, the memory, and the communication interface.

[0113] The communication interface includes input / output (I / O) interface, physical interface and logical interface, etc., which are used to realize the interconnection of devices inside the mining scene road slope calculation device, and the interface used to realize the interconnection between the mining scene road slope calculation device and other devices (such as other computing devices or user devices). The physical interface can be an Ethernet interface, a fiber optic interface, an ATM interface, etc.; the user device can be a display (Display), a keyboard (Keyboard), etc.

[0114] The memory can be various types of storage media, such as random access memory (RAM), read-only memory (ROM), non-volatile RAM (NVRAM), flash memory, optical storage, hard disk, programmable ROM (PROM), erasable PROM (EPROM), electrically erasable PROM (EEPROM), etc.

[0115] The processor may be a general-purpose processor, and the general-purpose processor may call the mining scene road slope calculation program stored in the memory, and execute the mining scene road slope calculation method provided in the embodiment of the present application. For example, the general-purpose processor may be a central processing unit (CPU). Among them, the method executed when the mining scene road slope calculation program is called can refer to the various embodiments of the mining scene road slope calculation method of the present application, which will not be repeated here.

[0116] Those skilled in the art will understand that Figure 5 The hardware structure shown in the figure does not constitute a limitation on the present application, and may include more or less components than shown in the figure, or combine certain components, or arrange the components differently.

[0117] In a fourth aspect, an embodiment of the present application also provides a readable storage medium.

[0118] The readable storage medium of the present application stores a mining scene road slope calculation program, wherein when the mining scene road slope calculation program is executed by a processor, the steps of the mining scene road slope calculation method as described above are implemented.

[0119] Among them, the method implemented when the mining scene road slope calculation program is executed can refer to the various embodiments of the mining scene road slope calculation method of the present application, and will not be repeated here.

[0120] The terms "including" and "having" and any variations thereof in the specification and claims of this application and the above-mentioned drawings 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 limited to the listed steps or units, but optionally includes steps or units that are not listed, or optionally includes other steps or units inherent to these processes, methods, products or devices. The terms "first", "second" and "third" are used to distinguish different objects, etc., and do not represent a sequence, nor do they limit "first", "second" and "third" to different types.

[0121] In the description of the embodiments of the present application, "exemplary", "for example" or "for example" are used to indicate examples, illustrations or descriptions. Any embodiment or design described as "exemplary", "for example" or "for example" in the embodiments of the present application should not be interpreted as being more preferred or more advantageous than other embodiments or designs. Specifically, the use of words such as "exemplary", "for example" or "for example" is intended to present related concepts in a specific way.

[0122] In the description of the embodiments of the present application, unless otherwise specified, “ / ” means or, for example, A / B can mean A or B; the “and / or” in the text is merely a description of the association relationship of associated objects, indicating that three relationships may exist, for example, A and / or B can mean: A exists alone, A and B exist at the same time, and B exists alone. In addition, in the description of the embodiments of the present application, “multiple” refers to two or more than two.

[0123] In some processes described in the embodiments of the present application, multiple operations or steps that appear in a specific order are included, but it should be understood that these operations or steps may not be executed in the order in which they appear in the embodiments of the present application or in parallel, and the sequence number of the operation is only used to distinguish the different operations, and the sequence number itself does not represent any execution order. In addition, these processes may include more or fewer operations, and these operations or steps may be executed in sequence or in parallel, and these operations or steps may be combined.

[0124] It should be noted that the serial numbers of the above-mentioned embodiments of the present application are only for description and do not represent the advantages or disadvantages of the embodiments.

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

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

Claims

1. A method for calculating the road slope in a mining area, characterized in that: The method for calculating the road slope in the mining area scenario includes: Determine the positioning state of the target vehicle based on a preset map corresponding to the target mining scene and the real-time positioning points obtained by the vehicle-mounted positioning device, wherein the positioning state of the target vehicle includes a positioning non-lost state, a positioning from never lost to lost state, and a positioning lost state; When it is detected that the positioning state of the target vehicle is a positioning non-lost state or a positioning state from never lost to lost state, a real-time slope reference value is determined based on a real-time slope value and a real-time pitch angle value corresponding to the real-time positioning point; Determine the current position slope value corresponding to the target vehicle according to the preset map, the real-time slope reference value and the real-time pitch angle value; When it is detected that the positioning state of the target vehicle is a positioning lost state, a current position slope value corresponding to the target vehicle is determined based on a preset slope reference calibration value corresponding to the preset map and the real-time pitch angle value.

2. The method for calculating the road slope in a mining area scene according to claim 1, characterized in that: The number of the real-time positioning points is multiple, and the real-time slope reference value is determined based on the real-time slope value and the real-time pitch angle value corresponding to the real-time positioning point, including: The real-time slope values ​​and the real-time pitch angle values ​​corresponding to the multiple real-time positioning points are averaged to obtain the real-time slope average value and the real-time pitch angle average value; The real-time slope average value and the real-time pitch angle average value are subjected to difference processing to obtain a real-time slope reference value.

3. The method for calculating the slope of a mining area road according to claim 1, characterized in that: Determining the current position slope value corresponding to the target vehicle according to the preset map, the real-time slope reference value and the real-time pitch angle value includes: When it is detected that the target vehicle is in a state where the positioning is not lost, the slope value of the current position is obtained based on the preset map; When it is detected that the target vehicle is in a state from never-lost positioning to lost positioning, the current position slope value is determined based on the real-time slope reference value and the real-time pitch angle value.

4. The method for calculating the slope of a mining area road according to claim 3, characterized in that: The step of determining the slope value of the current position based on the real-time slope reference value and the real-time pitch angle value comprises: Substituting the real-time slope reference value and the real-time pitch angle value into a first calculation formula to obtain the current position slope value, the first calculation formula is: In the formula, It is the multiplication factor for converting radian units to angle units; VehDa_rSlop_mp is the slope value of the current position; IMU_pitch is the real-time pitch angle value; pitch_ZERO is the real-time slope reference value.

5. The method for calculating the slope of a mining area road according to claim 1, characterized in that: The step of determining the current position slope value corresponding to the target vehicle based on the preset slope reference calibration value corresponding to the preset map and the real-time pitch angle value includes: Substituting the preset slope reference calibration value and the real-time pitch angle into a second calculation formula to obtain the current position slope value, the second calculation formula is: In the formula, It is the multiplication factor for converting radian units to angle units; VehDa_rSlop_mp is the slope value of the current position; IMU_pitch is the real-time pitch angle value; pitch_ZERO_tmp is the preset slope reference calibration value.

6. A mining area road slope calculation system, characterized in that: The mining area scene road slope calculation system includes: A first processing module, which is used to determine the positioning state of the target vehicle based on a preset map corresponding to the target mining area scene and the real-time positioning points obtained by the vehicle-mounted positioning device, wherein the positioning state of the target vehicle includes a positioning non-lost state, a positioning from never lost to lost state, and a positioning lost state; A second processing module is used to determine a real-time slope reference value based on a real-time slope value and a real-time pitch angle value corresponding to a real-time positioning point when it is detected that the positioning state of the target vehicle is a positioning non-lost state or a positioning state from never lost to lost state; A third processing module, which is used to determine the current position slope value corresponding to the target vehicle according to the preset map, the real-time slope reference value and the real-time pitch angle value; The fourth processing module is used to determine the current position slope value corresponding to the target vehicle based on the preset slope reference calibration value corresponding to the preset map and the real-time pitch angle value when it is detected that the positioning state of the target vehicle is a positioning lost state.

7. The mining area scene road slope calculation system according to claim 6, characterized in that: The number of the real-time positioning points is multiple, and the second processing module is specifically used for: The real-time slope values ​​and the real-time pitch angle values ​​corresponding to the multiple real-time positioning points are averaged to obtain the real-time slope average value and the real-time pitch angle average value; The real-time slope average value and the real-time pitch angle average value are subjected to difference processing to obtain a real-time slope reference value.

8. The mining area scene road slope calculation system according to claim 6, characterized in that: The third processing module is specifically used for: When it is detected that the target vehicle is in a state where the positioning is not lost, the slope value of the current position is obtained based on the preset map; When it is detected that the target vehicle is in a state from never-lost positioning to lost positioning, the current position slope value is determined based on the real-time slope reference value and the real-time pitch angle value.

9. A mining area road slope calculation device, characterized in that: The mining scene road slope calculation device includes a processor, a memory, and a mining scene road slope calculation program stored in the memory and executable by the processor, wherein when the mining scene road slope calculation program is executed by the processor, the steps of the mining scene road slope calculation method as described in any one of claims 1 to 5 are implemented.

10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a mining scene road slope calculation program, wherein when the mining scene road slope calculation program is executed by a processor, the steps of the mining scene road slope calculation method as described in any one of claims 1 to 5 are implemented.

Citation Information

Patent Citations

  • Road gradient measurement method, terminal equipment and storage medium

    CN112304281A

  • Method and device for estimating slope of road surface, vehicle and computer readable storage medium

    CN113442932A

  • Vehicle control method, device, equipment and medium

    CN114655212A

  • Vehicle control method, device and system, vehicle and storage medium

    CN117302220A

  • Road surface gradient determination method and device and electronic equipment

    CN118220163A