Unmanned running control method and system for underground trackless vehicle of coal mine
By using on-board sensors in unmanned vehicles underground in coal mines to obtain environmental characteristic information, and determining driving strategies based on static and dynamic characteristics, the problem of low control accuracy of unmanned vehicles underground in coal mines is solved, and the stability and safety of the system are improved. Improve transportation efficiency.
Patent Information
- Application Number
- CN202411132364.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-16
- Publication Date
- 2024-11-26
AI Technical Summary
It is difficult for unmanned vehicles underground in coal mines to achieve high-precision control in complex environments, resulting in safety hazards and low transportation efficiency.
The driving environment characteristic information is obtained through on-board sensors, combined with static and dynamic characteristics, and the driving control strategy is determined to control the vehicle speed and steering angle of the steering wheel, improving the stability and safety of the unmanned driving system.
It improves the control accuracy, stability and safety of the unmanned driving system of trackless vehicles in coal mines, reduces the risk of accidents, and improves transportation efficiency.
Smart Images

Figure CN119024844A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of digital production and unmanned driving technology in coal mines, and in particular to an unmanned driving control method and system for trackless vehicles in underground coal mines. Background Art
[0002] Intelligent coal mines are the core technical support for the high-quality development of coal mines. Auxiliary transportation of coal mines is the key link in the transportation of coal mine materials and personnel to various positions. Its characteristics such as long transportation journeys, dim road environments, and complex road environments have resulted in a large number of workers in electromechanical transportation, high employment thresholds, and high labor intensity. In this environment, electromechanical transportation accidents have occurred frequently in recent years, posing hidden dangers to coal mine safety management. With the development and mature application of unmanned driving technology in recent years, it has been studied and promoted in the coal mining industry. The application of unmanned driving to improve the level of intelligent coal mine transportation and improve the level of safety management is the main technical route for the current intelligent auxiliary transportation.
[0003] Due to the narrow space underground in coal mines and complex positioning features, manned and unmanned driving often mix during the implementation of unmanned driving. Unmanned vehicle driving requires higher control accuracy and more complete driving decision-making strategies to ensure that unmanned vehicles can effectively control the vehicle's driving path and avoid accidents. Summary of the invention
[0004] The present application aims to solve one of the technical problems in the related art at least to some extent.
[0005] To this end, the first purpose of this application is to propose an unmanned driving control method for trackless vehicles in coal mines, which effectively improves the stability, safety and efficiency of the unmanned driving system of trackless vehicles in coal mines by comprehensively determining the current driving control strategy of the trackless vehicle based on the static characteristics of the driving lane and the dynamic characteristics of the obstacles ahead.
[0006] The second purpose of the present application is to provide an unmanned driving control system for trackless vehicles in coal mines.
[0007] The third objective of the present application is to provide an electronic device.
[0008] A fourth objective of the present application is to provide a computer-readable storage medium.
[0009] A fifth object of the present application is to provide a computer program product.
[0010] To achieve the above-mentioned purpose, the first embodiment of the present application proposes a method for controlling unmanned driving of a trackless vehicle in a coal mine, comprising:
[0011] Using the on-board sensor on the trackless vehicle to obtain the driving environment characteristic information of the vehicle in the process of driving in the underground tunnel; wherein the driving environment characteristic information includes the static characteristics of the driving tunnel and the dynamic characteristics of the obstacles ahead of the driving;
[0012] Determine the current driving section of the vehicle in the lane according to the static characteristics of the driving lane, and determine the road driving state of the vehicle according to the current driving section of the vehicle;
[0013] Determining the dynamic state of the obstacle ahead of the vehicle according to the dynamic characteristics of the obstacle ahead;
[0014] A driving control strategy of the vehicle is determined according to the road driving state and the dynamic state of the obstacle, and the driving speed and steering angle of the steering wheel of the vehicle are controlled according to the driving control strategy.
[0015] To achieve the above-mentioned purpose, the second embodiment of the present application proposes an unmanned driving control system for trackless vehicles in coal mines, comprising:
[0016] A perception module is used to obtain driving environment characteristic information of the vehicle in the process of driving in the underground tunnel by using the on-board sensor of the trackless vehicle; wherein the driving environment characteristic information includes the static characteristics of the driving tunnel and the dynamic characteristics of the obstacles ahead of the driving;
[0017] A static feature recognition module, used to determine the current driving section of the vehicle in the lane according to the static features of the driving lane, and determine the road driving state of the vehicle according to the current driving section of the vehicle;
[0018] A dynamic feature recognition module, used to determine the dynamic state of the obstacle ahead of the vehicle according to the dynamic features of the obstacle ahead;
[0019] A decision module, used to determine the driving control strategy of the vehicle according to the road driving state and the dynamic state of the obstacle;
[0020] A control module is used to control the driving speed and steering angle of the vehicle according to the driving control strategy.
[0021] To achieve the above-mentioned purpose, the third aspect of the present application provides an electronic device, including:
[0022] A processor, and a memory communicatively connected to the processor;
[0023] The memory stores computer-executable instructions;
[0024] The processor executes the computer-executable instructions stored in the memory to implement the method as described in the embodiment of the first aspect.
[0025] To achieve the above-mentioned purpose, the fourth aspect embodiment of the present application proposes a computer-readable storage medium, in which computer execution instructions are stored. When the computer execution instructions are executed by a processor, they are used to implement the method described in the first aspect embodiment.
[0026] To achieve the above-mentioned purpose, the fifth aspect of the present application proposes a computer program product, including a computer program, which implements the method described in the first aspect when executed by a processor.
[0027] The unmanned driving control method, system, electronic device and storage medium for trackless vehicles in underground coal mines provided in the present application utilize on-board sensors to obtain the static characteristics of the driving lane and the dynamic characteristics of obstacles ahead of the trackless vehicle when the trackless vehicle is driving in the underground lane, and comprehensively determine the current driving control strategy of the trackless vehicle based on the static characteristics of the driving lane and the dynamic characteristics of obstacles ahead, thereby improving the accuracy of unmanned driving control, and further effectively improving the stability, safety and efficiency of the unmanned driving system of trackless vehicles in underground coal mines.
[0028] Additional aspects and advantages of the present application will be given in part in the description below, and in part will become apparent from the description below, or will be learned through the practice of the present application. BRIEF DESCRIPTION OF THE DRAWINGS
[0029] The above and / or additional aspects and advantages of the present application will become apparent and easily understood from the following description of the embodiments in conjunction with the accompanying drawings, in which:
[0030] Figure 1 A schematic diagram of a flow chart of an unmanned driving control method for a trackless vehicle in a coal mine provided in an embodiment of the present application;
[0031] Figure 2 A schematic diagram of switching between different driving states provided in an embodiment of the present application;
[0032] Figure 3 A schematic diagram of the structure of an unmanned driving control system for a trackless vehicle in a coal mine provided in an embodiment of the present application;
[0033] Figure 4 A schematic structural diagram of another unmanned driving control system for trackless vehicles in underground coal mines provided in an embodiment of the present application. DETAILED DESCRIPTION
[0034] Embodiments of the present application are described in detail below, and examples of the embodiments are shown in the accompanying drawings, wherein the same or similar reference numerals throughout represent the same or similar elements or elements having the same or similar functions. The embodiments described below with reference to the accompanying drawings are exemplary and are intended to be used to explain the present application, and should not be construed as limiting the present application.
[0035] The following describes the unmanned driving control method and system for trackless vehicles in coal mines according to the embodiments of the present application with reference to the accompanying drawings.
[0036] Figure 1 A flow chart of an unmanned driving control method for a trackless vehicle in an underground coal mine provided in an embodiment of the present application.
[0037] like Figure 1 As shown, the unmanned driving control method of the trackless vehicle in the coal mine includes the following steps:
[0038] Step 101, using the onboard sensor of the trackless vehicle to obtain the driving environment characteristic information of the vehicle in the process of driving in the underground tunnel; wherein the driving environment characteristic information includes the static characteristics of the driving tunnel and the dynamic characteristics of the obstacles ahead of the driving.
[0039] In this application, a variety of on-board sensors can be installed on the trackless vehicle, such as laser radar, camera, ultrasonic sensor, etc. When the trackless vehicle is traveling in the underground tunnel, the vehicle's driving environment characteristic information can be obtained through the various on-board sensors. The driving environment characteristic information may include the static characteristics of the driving tunnel and the dynamic characteristics of the obstacles ahead. In other words, the static characteristics of the driving tunnel, the dynamic characteristics of the obstacles ahead, etc. can be sensed through the various on-board sensors, so that multi-source perception information can be obtained.
[0040] Exemplarily, the static characteristics of the driving lane may include, but are not limited to, geometric characteristics of the lane, structural characteristics of the lane, environmental characteristics of the lane, facility characteristics of the lane, etc.
[0041] For example, the geometric characteristics of the laneway may include the width of the laneway, the height of the laneway, etc., the structural characteristics of the laneway may include the intersection of the laneway, the slope of the laneway, etc., the environmental characteristics of the laneway may include the wall material of the laneway, the lighting conditions of the laneway, etc., and the facility characteristics of the laneway may include various signs in the lane (such as direction signs, safety warning signs, etc.), fixed obstacles (such as protrusions on the laneway wall, equipment foundations), etc.
[0042] Exemplarily, the dynamic characteristics of the obstacle ahead may include, but are not limited to, the relative position information between the obstacle and the vehicle, the distance between the vehicle and the obstacle, the size of the obstacle, the movement state of the obstacle, the speed of the obstacle, the trajectory of the obstacle, etc.
[0043] In the present application, the trackless vehicle may be a trackless rubber-wheeled vehicle or other types of vehicles without tracks in a coal mine, and this is not limited.
[0044] Step 102, determining the current driving section of the vehicle in the lane according to the static characteristics of the driving lane, and determining the road driving state of the vehicle according to the current driving section of the vehicle.
[0045] In the present application, the underground coal mine tunnels can be divided into multiple driving sections in advance according to the different driving modes of the vehicles, such as straight sections, uphill sections, downhill sections, turns, etc. The current driving section of the vehicle in the tunnel can be determined from these driving sections based on the static characteristics of the driving tunnel.
[0046] Exemplarily, multiple sensors may be used to collect features of each driving section in advance, the features of each driving section may be formed into a driving route feature database, the static features of the driving lanes may be matched with the features of each driving section in the driving route database, and the driving section with the highest matching degree may be determined as the current driving section of the vehicle.
[0047] For example, the current driving section of the vehicle can also be determined directly based on the slope of the lane ahead of the vehicle, the curvature of the lane, etc. collected by the vehicle-mounted sensor. For example, it can be determined whether the current driving section of the vehicle is a straight section, an uphill section, a downhill section, or a turning section based on the magnitude relationship between the slope and the preset slope, and the magnitude relationship between the curvature of the lane and the preset curvature.
[0048] In the present application, the road driving state of the vehicle can be determined according to the current driving section of the vehicle and the correspondence between the driving section and the road driving state. For example, if the driving section of the vehicle is a straight section, the road driving state of the vehicle can be determined to be straight, if the driving section of the vehicle is an uphill section, the road driving state of the vehicle can be determined to be uphill, if the driving section of the vehicle is a downhill section, the road driving state of the vehicle can be determined to be downhill, and if the driving section of the vehicle is a turning section, the road driving state of the vehicle can be determined to be turning.
[0049] Step 103: determining the dynamic state of the obstacle ahead of the vehicle according to the dynamic characteristics of the obstacle ahead.
[0050] Exemplarily, the dynamic state of an obstacle may include no obstacle, a sudden obstacle, a stationary obstacle, an oncoming obstacle, a following obstacle, an avoiding obstacle, etc.
[0051] In the present application, the dynamic state of the obstacle in front of the vehicle can be obtained by identifying the obstacle in front of the vehicle and identifying and judging the movement direction and speed of the obstacle based on the dynamic characteristics of the obstacle in front of the vehicle.
[0052] Exemplarily, if it is determined according to the dynamic characteristics of the obstacle ahead that an obstacle suddenly appears in front of the vehicle within a preset sensing range, it is determined that the dynamic state of the obstacle ahead of the vehicle is a sudden obstacle.
[0053] For example, the preset perception range is a perception range of 10 meters in front of the vehicle. At a certain moment, an obstacle appears within the perception range of 10 meters in front of the vehicle. For a period of time before this moment, there is no obstacle in the perception range in front of the vehicle. It can be determined that the dynamic state of the obstacle in front of the vehicle is a sudden obstacle.
[0054] Exemplarily, based on the dynamic characteristics of the obstacle ahead of the vehicle, it can be determined that there is an obstacle outside the preset perception range, and the obstacle is continuously identified, and the characteristic information of the obstacle perceived multiple times is obtained. Based on the distance between the vehicle and the obstacle in front of the vehicle in the characteristic information of the obstacle perceived multiple times, the driving information of the obstacle is determined, and then based on the driving information of the obstacle, the dynamic state of the obstacle ahead of the vehicle is determined.
[0055] When the speed of the obstacle is 0, the dynamic state of the obstacle in front of the vehicle is determined to be a stationary obstacle;
[0056] When the speed of the obstacle is negative, it is considered that the obstacle is in the opposite direction of the vehicle's travel, and the dynamic state of the obstacle in front of the vehicle is determined to be a meeting obstacle;
[0057] When the obstacle speed is a positive number, when the obstacle speed is less than the set threshold, the dynamic state of the obstacle in front of the vehicle is determined to be avoiding the obstacle;
[0058] When the obstacle speed is a positive number, when the obstacle speed is greater than the set threshold, the distance between the vehicle and the obstacle is calculated based on the vehicle speed, the obstacle speed, and the relative acceleration of the vehicle to the obstacle, and then the dynamic state of the obstacle in front of the vehicle is determined based on the distance between the vehicle and the obstacle and the preset safety distance. If the distance between the vehicle and the obstacle is greater than the preset safety distance, the dynamic state of the obstacle in front of the vehicle is determined to be a following obstacle, otherwise it is determined to be a sudden obstacle; in other cases, the dynamic state of the obstacle in front of the vehicle is determined to be no obstacle.
[0059] For example, the distance between the vehicle and the obstacle can be calculated by the following formula:
[0060]
[0061] Where D is the distance between the vehicle and the obstacle, v0 is the speed of the vehicle, and v c is the speed of the obstacle, a cis the relative acceleration of the vehicle relative to the obstacle, a0 is the vehicle braking acceleration, and t0 is the vehicle decision control response time.
[0062] Step 104, determining the driving control strategy of the vehicle according to the road driving state and the dynamic state of the obstacle, and controlling the driving speed and steering angle of the steering wheel of the vehicle according to the driving control strategy.
[0063] As a possible implementation method, a correspondence between the road driving state, the obstacle dynamic state and the driving control strategy can be established. Based on the correspondence, the vehicle's current driving control strategy is determined, and then the vehicle's driving speed and steering wheel steering angle are controlled through the driving control strategy.
[0064] For example, when the road driving state is straight and the obstacle dynamic state is no obstacle, the vehicle's driving control strategy is to continue to go straight; when the road driving state is straight and the obstacle dynamic state is oncoming obstacle, the vehicle's driving control strategy is to pull over.
[0065] As another possible implementation method, the current driving state of the vehicle can be determined according to the road driving state and the dynamic state of the obstacle, and the driving trajectory of the vehicle can be planned according to the current driving state of the vehicle to obtain the driving control strategy of the vehicle. The driving control strategy can include a speed control curve and a steering control curve. According to the speed control curve, the opening of the throttle or brake control valve of the vehicle is controlled, and according to the steering control curve, the steering angle of the steering wheel of the vehicle is controlled.
[0066] For example, the switching conditions between different driving states can be obtained, and according to the switching conditions between different driving states, the switching conditions matching the road driving state and the obstacle dynamic state are determined, and the driving state after switching corresponding to the matching switching conditions is determined as the current driving state of the vehicle. The driving state may include initialization state, normal driving state, following state, lane change and overtaking state, pull-over state, vehicle turning state, fault emergency stop state, etc.
[0067] In other words, a finite state machine can be used to make driving behavior decisions, that is, a finite state machine can be used to determine the current driving state of the vehicle. The sub-state machine can be divided into initialization state, normal driving, following state, lane change overtaking state, pull-over state, vehicle turning state, and fault emergency stop state. Among them, the finite state machine is used to make driving behavior decisions, as follows:
[0068] The vehicle is first in the initialization state. When the obstacle dynamic state is no obstacle, the vehicle enters the normal driving state;
[0069] When the road driving state is straight, uphill or downhill, and the obstacle dynamic state is no obstacle, the vehicle continues to be in a normal driving state;
[0070] When the road driving state is non-straight driving, such as uphill or downhill, and the obstacle dynamic state is non-obstacle-free, that is, there is an obstacle, the vehicle enters the pull-over state; when the obstacle dynamic state switches to obstacle-free, the vehicle returns to the normal driving state;
[0071] When the road driving state is turning and the obstacle dynamic state is no obstacle, the vehicle enters the vehicle turning state; when the vehicle turning state action is completed, the road driving state is straight, and the obstacle dynamic state is no obstacle, the vehicle switches to the normal driving state;
[0072] When the road driving state is turning and the obstacle dynamic state is not obstacle-free, the vehicle enters the pull-over state; when the obstacle dynamic state switches to obstacle-free, the vehicle enters the vehicle turning state;
[0073] When the road driving state is straight driving and the obstacle dynamic state is sudden obstacle, the vehicle enters the fault emergency stop state; when the vehicle enters the fault emergency stop state, the vehicle is inspected, and if there is no problem after the inspection, the vehicle enters the initialization state;
[0074] When the road driving state is straight driving and the obstacle dynamic state is oncoming obstacle, the vehicle enters the pull-over state; when the oncoming obstacle is completed and the obstacle dynamic state switches to no obstacle, the vehicle returns to the normal driving state;
[0075] When the road driving state is straight driving and the obstacle dynamic state is stationary obstacle or avoiding obstacle, the vehicle enters the lane changing and overtaking state;
[0076] When the road driving state is straight driving and the obstacle dynamic state is a following obstacle, the vehicle enters the following state.
[0077] For example, the switching between different driving states and the corresponding switching conditions can be found in Figure 2 For example, when the vehicle is in a normal driving state, when the vehicle's road driving state is straight and the dynamic state of the obstacle is a following obstacle, that is, the switching condition for switching from the normal driving state to the following state is met, the vehicle enters the following state; for another example, when the vehicle is in a normal driving state, when the vehicle's road driving state is straight and the dynamic state of the obstacle is a stationary obstacle or the speed of the obstacle is less than the set threshold.
[0078] In the process of controlling the throttle or brake control valve opening of the vehicle using the speed control curve, the controlled speed of the vehicle after the control using the control valve opening in the control curve may not match the expected speed due to different road conditions during actual control. Therefore, the speed of the vehicle after the throttle or brake control valve opening of the vehicle is adjusted to the target opening can be obtained, and the throttle or brake control valve opening of the vehicle can be fine-tuned according to the comparison between the speed of the vehicle after control and the speed matching the target opening. Among them, the target opening is the throttle or brake control valve opening in the speed control curve. Therefore, according to the current vehicle speed comparison feedback, the throttle or brake control valve opening can be fine-tuned in real time to improve the accuracy of speed control.
[0079] In the process of controlling the steering wheel steering angle of the vehicle using the steering control curve, due to different road conditions during actual control, the heading angle of the vehicle after being controlled using the steering wheel steering angle in the control curve may not match the expected heading angle. Therefore, the heading angle of the vehicle after the steering wheel steering angle of the vehicle is adjusted to the target angle can be obtained, and the steering angle of the vehicle's steering wheel can be fine-tuned according to the comparison between the heading angle of the vehicle after control and the heading angle matching the target angle. Among them, the target angle is the steering wheel steering angle in the steering control curve. Therefore, according to the current vehicle heading angle comparison feedback, the steering wheel steering angle can be fine-tuned in real time to improve the accuracy of the heading angle control.
[0080] In the embodiment of the present application, by utilizing on-board sensors to obtain the static characteristics of the driving lane and the dynamic characteristics of obstacles ahead of the trackless vehicle when it is traveling in the underground lane, the current driving control strategy of the trackless vehicle is comprehensively determined based on the static characteristics of the driving lane and the dynamic characteristics of obstacles ahead, thereby improving the accuracy of unmanned driving control, and further effectively improving the stability, safety and efficiency of the unmanned driving system of trackless vehicles in coal mines.
[0081] In order to implement the above-mentioned embodiments, the present application also proposes an unmanned driving control system for trackless vehicles in underground coal mines.
[0082] Figure 3 A schematic structural diagram of an unmanned driving control system for trackless vehicles in underground coal mines provided in an embodiment of the present application.
[0083] like Figure 3 As shown, the unmanned driving control system 300 for trackless vehicles in underground coal mines includes:
[0084] The perception module 310 is used to obtain the driving environment characteristic information of the vehicle in the process of driving in the underground tunnel by using the on-board sensor of the trackless vehicle; wherein the driving environment characteristic information includes the static characteristics of the driving tunnel and the dynamic characteristics of the obstacles ahead of the driving;
[0085] The static feature recognition module 320 is used to determine the current driving section of the vehicle in the lane according to the static features of the driving lane, and determine the road driving state of the vehicle according to the current driving section of the vehicle;
[0086] A dynamic feature recognition module 330 is used to determine the dynamic state of the obstacle ahead of the vehicle according to the dynamic features of the obstacle ahead;
[0087] A decision module 340, configured to determine a driving control strategy of the vehicle according to the road driving state and the dynamic state of the obstacle;
[0088] The control module 350 is used to control the driving speed and steering angle of the vehicle through the driving control strategy.
[0089] Furthermore, in a possible implementation of the embodiment of the present application, the static feature recognition module 320 is used to:
[0090] According to different driving modes of the vehicle, the lane is divided into a plurality of driving sections, and the characteristics of each driving section are collected in advance to form a driving route database;
[0091] The static features of the driving lane are matched with the features of each driving segment in the driving route database to determine the current driving segment of the vehicle.
[0092] Furthermore, in a possible implementation of the embodiment of the present application, the dynamic feature recognition module 330 is used to:
[0093] If it is determined according to the dynamic characteristics of the obstacle ahead that an obstacle suddenly appears within the preset sensing range ahead of the vehicle, determining that the dynamic state of the obstacle ahead of the vehicle is a sudden obstacle;
[0094] If it is determined that there is an obstacle outside the preset sensing range according to the dynamic characteristics of the obstacle ahead, and the obstacle is continuously identified, the characteristic information of the obstacle sensed multiple times is obtained;
[0095] Determining the driving information of the obstacle according to the distance between the vehicle and the obstacle in front of the vehicle in the obstacle feature information sensed multiple times; wherein the driving information includes the speed, acceleration, and driving direction of the obstacle;
[0096] When the speed of the obstacle is 0, determining that the dynamic state of the obstacle in front of the vehicle is a stationary obstacle;
[0097] When the speed of the obstacle is a negative number, determining that the dynamic state of the obstacle in front of the vehicle is an oncoming obstacle;
[0098] When the speed of the obstacle is a positive number and the speed of the obstacle is less than a set threshold, determining that the dynamic state of the obstacle in front of the vehicle is to avoid the obstacle;
[0099] When the speed of the obstacle is a positive number and is greater than a set threshold, the distance between the vehicle and the obstacle is calculated based on the vehicle's driving speed, the speed of the obstacle, and the relative acceleration of the vehicle to the obstacle, and the dynamic state of the obstacle in front of the vehicle is determined based on the distance between the vehicle and the obstacle and a preset safety distance.
[0100] Furthermore, in a possible implementation of the embodiment of the present application, the distance between the vehicle and the obstacle is calculated by the following formula:
[0101]
[0102] Where D is the distance between the vehicle and the obstacle, v0 is the speed of the vehicle, and v c is the speed of the obstacle, a c is the relative acceleration of the vehicle relative to the obstacle, a0 is the braking acceleration of the vehicle, and t0 is the decision control response time of the vehicle.
[0103] Furthermore, in a possible implementation of the embodiment of the present application, the decision module 340 is used to:
[0104] Determining the current driving state of the vehicle according to the road driving state and the dynamic state of the obstacle;
[0105] According to the current driving state of the vehicle, the driving trajectory of the vehicle is planned to obtain the driving control strategy of the vehicle; wherein the driving control strategy includes a speed control curve and a steering control curve;
[0106] The control module 350 is used to: control the opening of the throttle or brake control valve of the vehicle according to the speed control curve; and control the steering angle of the steering wheel of the vehicle according to the steering control curve.
[0107] Furthermore, in a possible implementation of the embodiment of the present application, the decision module 340 is used to:
[0108] Finite state machine is used to make driving behavior decisions. The sub-state machine is divided into initialization state, normal driving, following state, lane change and overtaking state, pull-over state, vehicle turning state and emergency stop state.
[0109] The vehicle is first in an initialization state, and when the obstacle dynamic state is no obstacle, the vehicle enters a normal driving state;
[0110] When the road driving state is straight or uphill or downhill, and the obstacle dynamic state is no obstacle, the vehicle continues to be in a normal driving state;
[0111] When the road driving state is uphill or downhill and the obstacle dynamic state is not obstacle-free, the vehicle enters a pull-over parking state; when the obstacle dynamic state switches to obstacle-free, the vehicle returns to a normal driving state;
[0112] When the road driving state is turning and the obstacle dynamic state is no obstacle, the vehicle enters the vehicle turning state; when the vehicle turning state action is completed, the road driving state is straight driving and the obstacle dynamic state is no obstacle, the vehicle switches to the normal driving state;
[0113] When the road driving state is turning and the obstacle dynamic state is not obstacle-free, the vehicle enters a pull-over parking state; when the obstacle dynamic state switches to obstacle-free, the vehicle enters a vehicle turning state;
[0114] The road driving state is straight driving, the obstacle dynamic state is a sudden obstacle, and the vehicle enters a fault emergency stop state;
[0115] When the road driving state is straight driving and the obstacle dynamic state is a meeting obstacle, the vehicle enters a pull-over parking state; when the meeting is completed and the obstacle dynamic state is switched to no obstacle, the vehicle returns to a normal driving state;
[0116] When the road driving state is straight driving and the obstacle dynamic state is a stationary obstacle or an obstacle avoiding state, the vehicle enters a lane changing and overtaking state;
[0117] When the road driving state is straight driving and the obstacle dynamic state is a following vehicle obstacle, the vehicle enters a following vehicle state.
[0118] Furthermore, in a possible implementation of the embodiment of the present application, the system may also include:
[0119] A control valve opening fine-tuning module is used to obtain the speed of the vehicle after the throttle or brake control valve opening of the vehicle is adjusted to a target opening; and fine-tune the throttle or brake control valve opening of the vehicle according to the comparison between the speed of the vehicle after control and the speed matching the target opening.
[0120] Furthermore, in a possible implementation of the embodiment of the present application, the system may also include:
[0121] A steering wheel steering angle fine-tuning module is used to obtain the heading angle of the vehicle after the steering wheel steering angle of the vehicle is adjusted to a target angle; and fine-tune the steering angle of the steering wheel of the vehicle according to the comparison between the heading angle of the vehicle after control and the heading angle matching the target angle.
[0122] For example, the control module 350 may include a speed control module and a steering control module, and the corresponding system structure diagram may be as follows: Figure 4 shown.
[0123] It should be noted that the above explanation of the embodiment of the unmanned driving control method for trackless vehicles in coal mines is also applicable to the unmanned driving control system for trackless vehicles in coal mines of this embodiment, and will not be repeated here.
[0124] In the embodiment of the present application, by utilizing on-board sensors to obtain the static characteristics of the driving lane and the dynamic characteristics of obstacles ahead of the trackless vehicle when it is traveling in the underground lane, the current driving control strategy of the trackless vehicle is comprehensively determined based on the static characteristics of the driving lane and the dynamic characteristics of obstacles ahead, thereby improving the accuracy of unmanned driving control, and further effectively improving the stability, safety and efficiency of the unmanned driving system of trackless vehicles in coal mines.
[0125] In order to implement the above embodiments, the present application also proposes an electronic device, comprising: a processor, and a memory communicatively connected to the processor; the memory stores computer-executable instructions; the processor executes the computer-executable instructions stored in the memory to implement the method provided by the above embodiments.
[0126] In order to implement the above embodiments, the present application also proposes a computer-readable storage medium, in which computer-executable instructions are stored. When the computer-executable instructions are executed by a processor, they are used to implement the methods provided by the above embodiments.
[0127] In order to implement the above embodiments, the present application also proposes a computer program product, including a computer program, which implements the methods provided by the above embodiments when executed by a processor.
[0128] The collection, storage, use, processing, transmission, provision and disclosure of user personal information involved in this application are in compliance with relevant laws and regulations and do not violate public order and good morals.
[0129] It should be noted that personal information from users should be collected for legitimate and reasonable purposes and should not be shared or sold outside of these legitimate uses. In addition, such collection / sharing should be carried out after receiving the user's informed consent, including but not limited to notifying the user to read the user agreement / user notice and sign the agreement / authorization including authorization of relevant user information before the user uses the function. In addition, any necessary steps should be taken to protect and safeguard access to such personal information data and ensure that others who have access to personal information data comply with its privacy policy and procedures.
[0130] The present application is expected to provide an implementation scheme for users to selectively block the use or access of personal information data. That is, the present disclosure is expected to provide hardware and / or software to prevent or block access to such personal information data. Once the personal information data is no longer needed, the risk can be minimized by limiting data collection and deleting the data. In addition, when applicable, such personal information is de-identified to protect the privacy of the user.
[0131] In the description of the aforementioned embodiments, the description with reference to the terms "one embodiment", "some embodiments", "example", "specific example", or "some examples" etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present application. In this specification, the schematic representations of the above terms do not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or more embodiments or examples in a suitable manner. In addition, those skilled in the art may combine and combine the different embodiments or examples described in this specification and the features of the different embodiments or examples, without contradiction.
[0132] In addition, the terms "first" and "second" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Therefore, the features defined as "first" and "second" may explicitly or implicitly include at least one of the features. In the description of this application, the meaning of "plurality" is at least two, such as two, three, etc., unless otherwise clearly and specifically defined.
[0133] Any process or method description in a flowchart or otherwise described herein may be understood to represent a module, fragment or portion of code comprising one or more executable instructions for implementing the steps of a custom logical function or process, and the scope of the preferred embodiments of the present application includes alternative implementations in which functions may not be performed in the order shown or discussed, including performing functions in a substantially simultaneous manner or in the reverse order depending on the functions involved, which should be understood by technicians in the technical field to which the embodiments of the present application belong.
[0134] The logic and / or steps represented in the flowchart or otherwise described herein, for example, can be considered as an ordered list of executable instructions for implementing logical functions, and can be embodied in any computer-readable medium for use by an instruction execution system, device or apparatus (such as a computer-based system, a system including a processor, or other system that can fetch instructions from an instruction execution system, device or apparatus and execute the instructions), or in combination with these instruction execution systems, devices or apparatuses. For the purpose of this specification, "computer-readable medium" can be any device that can contain, store, communicate, propagate or transmit a program for use by an instruction execution system, device or apparatus, or in combination with these instruction execution systems, devices or apparatuses. More specific examples of computer-readable media (a non-exhaustive list) include the following: an electrical connection with one or more wires (electronic device), a portable computer disk box (magnetic device), a random access memory (RAM), a read-only memory (ROM), an erasable and programmable read-only memory (EPROM or flash memory), a fiber optic device, and a portable compact disk read-only memory (CDROM). In addition, the computer-readable medium may even be paper or other suitable medium on which the program is printed, since the program may be obtained electronically, for example, by optically scanning the paper or other medium and then editing, interpreting or processing in other suitable ways if necessary, and then stored in a computer memory.
[0135] It should be understood that the various parts of the present application can be implemented by hardware, software, firmware or a combination thereof. In the above-mentioned embodiments, multiple steps or methods can be implemented by software or firmware stored in a memory and executed by a suitable instruction execution system. For example, if implemented by hardware, as in another embodiment, it can be implemented by any one of the following technologies known in the art or their combination: a discrete logic circuit having a logic gate circuit for implementing a logic function for a data signal, a dedicated integrated circuit having a suitable combination of logic gate circuits, a programmable gate array (PGA), a field programmable gate array (FPGA), etc.
[0136] A person skilled in the art may understand that all or part of the steps in the method for implementing the above-mentioned embodiment may be completed by instructing related hardware through a program, and the program may be stored in a computer-readable storage medium, which, when executed, includes one or a combination of the steps of the method embodiment.
[0137] In addition, each functional unit in each embodiment of the present application may be integrated into a processing module, or each unit may exist physically separately, or two or more units may be integrated into one module. The above-mentioned integrated module may be implemented in the form of hardware or in the form of a software functional module. If the integrated module is implemented in the form of a software functional module and sold or used as an independent product, it may also be stored in a computer-readable storage medium.
[0138] The storage medium mentioned above may be a read-only memory, a magnetic disk or an optical disk, etc. Although the embodiments of the present application have been shown and described above, it can be understood that the above embodiments are exemplary and cannot be understood as limiting the present application. A person of ordinary skill in the art may change, modify, replace and modify the above embodiments within the scope of the present application.
Claims
1. A method for controlling unmanned driving of trackless vehicles in coal mines, characterized in that: include: Using the on-board sensor on the trackless vehicle to obtain the driving environment characteristic information of the vehicle in the process of driving in the underground tunnel; wherein the driving environment characteristic information includes the static characteristics of the driving tunnel and the dynamic characteristics of the obstacles ahead of the driving; Determine the current driving section of the vehicle in the lane according to the static characteristics of the driving lane, and determine the road driving state of the vehicle according to the current driving section of the vehicle; Determining the dynamic state of the obstacle ahead of the vehicle according to the dynamic characteristics of the obstacle ahead; A driving control strategy of the vehicle is determined according to the road driving state and the dynamic state of the obstacle, and the driving speed and steering angle of the steering wheel of the vehicle are controlled according to the driving control strategy.
2. The method according to claim 1, characterized in that The step of determining the current driving section of the vehicle in the lane according to the static characteristics of the lane includes: According to different driving modes of the vehicle, the lane is divided into a plurality of driving sections, and the characteristics of each driving section are collected in advance to form a driving route database; The static features of the driving lane are matched with the features of each driving segment in the driving route database to determine the current driving segment of the vehicle.
3. The method according to claim 1, characterized in that According to the dynamic characteristics of the obstacle ahead, Determining the dynamic state of an obstacle ahead of the vehicle includes: If it is determined according to the dynamic characteristics of the obstacle ahead that an obstacle suddenly appears within the preset sensing range ahead of the vehicle, determining that the dynamic state of the obstacle ahead of the vehicle is a sudden obstacle; If it is determined that there is an obstacle outside the preset sensing range according to the dynamic characteristics of the obstacle ahead, and the obstacle is continuously identified, the characteristic information of the obstacle sensed multiple times is obtained; Determining the driving information of the obstacle according to the distance between the vehicle and the obstacle in front of the vehicle in the obstacle feature information sensed multiple times; wherein the driving information includes the speed, acceleration, and driving direction of the obstacle; When the speed of the obstacle is 0, determining that the dynamic state of the obstacle in front of the vehicle is a stationary obstacle; When the speed of the obstacle is a negative number, determining that the dynamic state of the obstacle in front of the vehicle is an oncoming obstacle; When the speed of the obstacle is a positive number and the speed of the obstacle is less than a set threshold, determining that the dynamic state of the obstacle in front of the vehicle is to avoid the obstacle; When the speed of the obstacle is a positive number and is greater than a set threshold, the distance between the vehicle and the obstacle is calculated based on the vehicle's driving speed, the speed of the obstacle, and the relative acceleration of the vehicle to the obstacle, and the dynamic state of the obstacle in front of the vehicle is determined based on the distance between the vehicle and the obstacle and a preset safety distance.
4. The method according to claim 3, characterized in that The distance between the vehicle and the obstacle is calculated by the following formula: Where D is the distance between the vehicle and the obstacle, v0 is the speed of the vehicle, and v c is the speed of the obstacle, a c is the relative acceleration of the vehicle relative to the obstacle, a0 is the braking acceleration of the vehicle, and t0 is the decision control response time of the vehicle.
5. The method according to claim 1, characterized in that The determining of the driving control strategy of the vehicle according to the road driving state and the dynamic state of the obstacle, and controlling the driving speed and steering angle of the steering wheel of the vehicle according to the driving control strategy, comprises: Determining the current driving state of the vehicle according to the road driving state and the dynamic state of the obstacle; According to the current driving state of the vehicle, the driving trajectory of the vehicle is planned to obtain the driving control strategy of the vehicle; wherein the driving control strategy includes a speed control curve and a steering control curve; According to the speed control curve, controlling the opening of the throttle or brake control valve of the vehicle; According to the steering control curve, the steering angle of the steering wheel of the vehicle is controlled.
6. The method according to claim 5, characterized in that The determining the current driving state of the vehicle according to the road driving state and the dynamic state of the obstacle includes: Finite state machine is used to make driving behavior decisions. The sub-state machine is divided into initialization state, normal driving, following state, lane change and overtaking state, pull-over state, vehicle turning state and emergency stop state. The vehicle is first in an initialization state, and when the obstacle dynamic state is no obstacle, the vehicle enters a normal driving state; When the road driving state is straight or uphill or downhill, and the obstacle dynamic state is no obstacle, the vehicle continues to be in a normal driving state; When the road driving state is uphill or downhill and the obstacle dynamic state is not obstacle-free, the vehicle enters a pull-over parking state; when the obstacle dynamic state switches to obstacle-free, the vehicle returns to a normal driving state; When the road driving state is turning and the obstacle dynamic state is no obstacle, the vehicle enters the vehicle turning state; when the vehicle turning state action is completed, the road driving state is straight driving and the obstacle dynamic state is no obstacle, the vehicle switches to the normal driving state; When the road driving state is turning and the obstacle dynamic state is not obstacle-free, the vehicle enters a pull-over parking state; when the obstacle dynamic state switches to obstacle-free, the vehicle enters a vehicle turning state; When the road driving state is straight driving and the obstacle dynamic state is a sudden obstacle, the vehicle enters a fault emergency stop state; When the road driving state is straight driving and the obstacle dynamic state is a meeting obstacle, the vehicle enters a pull-over parking state; when the meeting is completed and the obstacle dynamic state is switched to no obstacle, the vehicle returns to a normal driving state; When the road driving state is straight driving and the obstacle dynamic state is a stationary obstacle or an obstacle avoiding state, the vehicle enters a lane changing and overtaking state; When the road driving state is straight driving and the obstacle dynamic state is a following vehicle obstacle, the vehicle enters a following vehicle state.
7. The method according to claim 5, characterized in that Also includes: Acquiring the speed of the vehicle after adjusting the opening of the throttle or brake control valve of the vehicle to a target opening; According to the comparison between the speed of the vehicle after control and the speed matching the target opening, the opening of the throttle or brake control valve of the vehicle is fine-tuned.
8. The method according to claim 5, characterized in that Also includes: Acquiring the heading angle of the vehicle after adjusting the steering wheel steering angle of the vehicle to a target angle; According to the comparison between the heading angle of the vehicle after control and the heading angle matching the target angle, the steering angle of the steering wheel of the vehicle is fine-tuned.
9. An unmanned driving control system for trackless vehicles in coal mines, characterized in that: include: A perception module is used to obtain driving environment characteristic information of the vehicle in the underground lane by using the on-board sensor of the trackless vehicle; wherein the driving environment characteristic information includes static characteristics of the driving lane and dynamic characteristics of obstacles ahead of the vehicle; A static feature recognition module, used to determine the current driving section of the vehicle in the lane according to the static features of the driving lane, and determine the road driving state of the vehicle according to the current driving section of the vehicle; A dynamic feature recognition module, used to determine the dynamic state of the obstacle ahead of the vehicle according to the dynamic features of the obstacle ahead; A decision module, used to determine the driving control strategy of the vehicle according to the road driving state and the dynamic state of the obstacle; A control module is used to control the driving speed and steering angle of the vehicle according to the driving control strategy.
