A control system and method for an unmanned intelligent rock drilling rig, and a storage medium.

By using an unmanned intelligent rock drilling rig control system, which utilizes environmental data for decision-making and planning, the problem of traditional hydraulic rock drilling rigs relying on manual operation has been solved. This has enabled automatic coordination of the rock drilling mechanism and safe driving of the vehicle, thereby improving construction efficiency and safety.

CN117868677BActive Publication Date: 2026-11-10GUANGDONG VOCATIONAL & TECHNICAL COLLEGE
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
CN202311727974.5
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2023-12-14
Publication Date
2026-11-10
Estimated Expiration
2043-12-14

AI Technical Summary

Technical Problem

Traditional hydraulic rock drilling rigs require manual operation, which can lead to over-drilling or under-drilling due to differences in operator skill, affecting project schedule and cost, and potentially causing safety accidents.

Method used

Design an unmanned intelligent rock drilling rig control system, including a remote control terminal, a driving planning module, a control module, and a control device. It uses radar and image detection components to collect environmental data, and makes decisions and plans through the driving planning module to achieve coordination of the rock drilling mechanism and automatic driving of the vehicle.

Benefits of technology

The system enables automatic coordination of the rock drilling mechanism and vehicle movement under harsh working conditions, avoiding erroneous commands caused by data delays and improving construction efficiency and safety.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN117868677B_ABST
    Figure CN117868677B_ABST
Patent Text Reader

Abstract

This invention discloses an unmanned intelligent rock drilling rig control system and method, and a storage medium. The control system includes: a remote control terminal for displaying vehicle status, acquiring user commands, and generating control data based on the user commands; a driving planning module, wirelessly connected to the remote control terminal and mounted on the vehicle body, for detecting the current communication status, collecting current environmental data, determining the vehicle status based on the current environmental data, and planning the target task based on the control data; a control module, communicatively connected to the driving planning module and mounted on the vehicle body, for determining control commands based on the target task; and a control device, connected to the rock drilling mechanism and the vehicle body, for adjusting the action mode of the rock drilling mechanism and driving the vehicle body according to the control commands. Combining unmanned driving technology with the rock drilling rig solves the problems of work coordination and adaptation between rock drilling mechanisms, as well as the inaccurate data analysis caused by information delays.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention relates to the technical field of rock drilling rigs, and particularly to an unmanned intelligent rock drilling rig control system and method, and a storage medium. Background Technology

[0002] With the deepening of urbanization in China, developing advanced intelligent and connected construction equipment to improve labor efficiency has become a hot topic. With the development of computers and networks, more and more cars are equipped with Level 12 and above autonomous driving technology.

[0003] In existing technologies, traditional hydraulic rock drilling rigs provide favorable conditions for tunnel excavation using the drill-and-blast method, accelerating construction speed, increasing labor productivity, improving workers' working conditions, and reducing their workload. However, traditional hydraulic rock drilling rigs cannot be operated manually, and differences in the skill level of operators often lead to serious "over-excavation" or "under-excavation," which not only adversely affects the project's schedule and cost but also causes safety accidents such as tunnel collapses. Summary of the Invention

[0004] The purpose of this invention is to provide an unmanned intelligent rock drilling rig control system and method, and a storage medium, to solve one or more technical problems existing in the prior art, and at least provide a beneficial option or create conditions.

[0005] The solution to the technical problem of this invention is to provide an unmanned intelligent rock drilling rig control system and method, and a storage medium.

[0006] According to a first aspect of the present invention, a control system for an unmanned intelligent rock drilling rig is provided. The unmanned intelligent rock drilling rig includes a vehicle body and a rock drilling mechanism. The control system includes:

[0007] The remote control terminal is used to display vehicle status, obtain user commands, and generate control data based on the user commands.

[0008] The driving planning module, which communicates wirelessly with the remote control terminal, is installed on the vehicle body. It is used to detect the current communication status, collect current environmental data under the current communication status, determine the vehicle status based on the current environmental data, and plan the target task based on the control data.

[0009] The control module, which is communicatively connected to the driving planning module, is mounted on the vehicle body and is used to determine control commands based on the target task.

[0010] A control device, connected to the rock drilling mechanism and the vehicle body, is used to adjust the action mode of the rock drilling mechanism and drive the vehicle body according to the control command.

[0011] Furthermore, a control system for an unmanned intelligent rock drilling rig also includes:

[0012] The CAN data exchange and storage module is communicatively connected to the control module and the driving planning module, respectively, and is used to store the vehicle status and the driving mode.

[0013] The wireless communication module is connected to both the driving planning module and the remote control terminal, enabling the driving planning module and the remote control terminal to establish a wireless communication connection.

[0014] Furthermore, the driving planning module includes an environmental detection unit; the environmental detection unit is used to detect the current operating environment of the vehicle body and to collect the current environmental data.

[0015] Furthermore, the environmental detection unit includes:

[0016] The radar component is used to scan the current working environment and collect the vehicle's position and pose data.

[0017] An image detection component is used to acquire images of the current working environment to obtain image data;

[0018] The current environment data includes image data and pose data.

[0019] Furthermore, the control device includes;

[0020] A drive component, connected to the vehicle body, is used to drive the vehicle body to move according to the control command;

[0021] An adjustment component, connected to the rock drilling mechanism, is used to control the rock drilling mechanism to switch to the corresponding action mode according to the control command.

[0022] According to a second aspect of the present invention, a control method for an unmanned intelligent rock drilling rig control system is provided, applied to an unmanned intelligent rock drilling rig control system described in a first aspect of the present invention, the control method comprising:

[0023] The remote control terminal acquires user commands and generates control data based on the user commands.

[0024] The driving planning module detects the current communication status and obtains the current environmental data under the current communication status;

[0025] The driving planning module determines the vehicle status based on the current environmental data and judges whether the vehicle status is in a normal state based on the control data.

[0026] If so, then plan the target task based on the current environmental data and control data;

[0027] The control module determines the control command based on the target task, and the control device adjusts the action mode of the rock drilling mechanism and drives the vehicle body to move according to the control command.

[0028] Furthermore, determining whether the vehicle status is in a normal state specifically includes:

[0029] The driving planning module acquires the data transmission speed of the control data and the data acquisition speed of the current environmental data;

[0030] The driving planning module determines the current communication mode based on the current communication status and obtains the set transmission speed and set acquisition speed corresponding to the current communication mode;

[0031] Calculate the transmission error between the data transmission speed and the set transmission speed, and the acquisition error between the data acquisition speed and the set acquisition speed. Based on the transmission error and the acquisition error, determine whether the driving planning module has a data exchange delay.

[0032] If not, then the vehicle status is normal.

[0033] Furthermore, determining whether the vehicle status is in a normal state also includes:

[0034] When the vehicle is in an abnormal state, the driving planning module corrects the current environmental data based on the acquisition error and the current communication status in order to plan the target task.

[0035] Furthermore, the planning objectives and tasks specifically include:

[0036] The driving planning module uses the current environmental data and a trajectory optimization algorithm to plan the optimal target trajectory so that the vehicle travels along the target trajectory.

[0037] The driving planning module determines the corresponding action mode of switching the rock drilling mechanism based on the control data;

[0038] The target task includes the target trajectory and the action pattern.

[0039] According to a third aspect of the present invention, a storage medium is provided storing computer-executable instructions for executing a control method for an unmanned intelligent rock drilling rig control system as described in a second aspect of the present invention.

[0040] The beneficial effects of this invention are as follows: In the harsh working conditions of a rock drilling rig, environmental data is collected, and control data sent from a remote control terminal is integrated with the collected current environmental data. The driving planning module then makes decisions and plans the target tasks of the rock drilling rig, coordinating the drilling mechanisms on the rig and driving its movement. This solves the problems of coordination and adaptation between drilling mechanisms, as well as information delays that lead to inaccurate data analysis, preventing the rock drilling rig from operating under incorrect instructions and thus avoiding risks. Attached Figure Description

[0041] Figure 1 This is a partial structural schematic diagram of an unmanned intelligent rock drilling rig control system provided by the present invention;

[0042] Figure 2 This is a flowchart illustrating a control system for an unmanned intelligent rock drilling rig provided by the present invention.

[0043] Reference numerals: 100, vehicle body; 200, propulsion beam; 210, drill arm; 220, hydraulic rock drill; 300, wireless communication module; 310, image detection component. Detailed Implementation

[0044] To make the objectives, technical solutions, and advantages of this application clearer, the following detailed description is provided in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative and should not be construed as limiting the scope of the invention.

[0045] It should be noted that although functional modules are divided in the system diagram, in some cases, the steps shown or described may be executed in a different order than the module division or flowchart shown in the system. The terms "first," "second," etc., in the specification, claims, and the aforementioned drawings are used to distinguish similar objects and are not necessarily used to describe a specific order or sequence.

[0046] In the description of this invention, it should be noted that, unless otherwise explicitly defined, terms such as "setting," "installation," and "connection" should be interpreted broadly, and those skilled in the art can reasonably determine the specific meaning of the above terms in this invention in conjunction with the specific content of the technical solution.

[0047] Reference Figure 1 The unmanned intelligent rock drilling rig includes: a vehicle body 100 and a rock drilling mechanism, which includes: a propulsion beam 200, a hydraulic rock drill 220, a rock drill auxiliary arm, and a drill arm 210.

[0048] Unmanned intelligent rock drilling rigs can select different rock drilling mechanisms for different working conditions.

[0049] Reference Figure 1In an embodiment of the first aspect of the present invention, an unmanned intelligent rock drilling rig control system includes: a remote control terminal, a driving planning module, a control module, and a control device.

[0050] The remote control terminal is wirelessly connected to the driving planning module to enable wireless communication between the vehicle body 100 and the remote control terminal, thereby enabling remote control of the vehicle body 100.

[0051] The remote control terminal is equipped with a remote control display screen and a remote control console. The remote control display screen can show the vehicle status and the action mode of the rock drilling mechanism. The remote control console can obtain user commands, respond to user commands, generate control data based on user commands, and wirelessly send the control data to the driving planning module.

[0052] The driving planning module is installed on the vehicle body 100. The driving planning module is communicatively connected to the control module and wirelessly connected to the remote control terminal.

[0053] The driving planning module detects the current communication status and collects current environmental data based on that status. The vehicle status is then determined using this environmental data.

[0054] The driving planning module receives control data sent by the remote control terminal. Based on the current environmental data and control data, it plans the target task for the trolley's operation and sends the target task to the control module.

[0055] The control module is installed on the vehicle body 100 and is communicatively connected to the driving planning module. The control module receives the target task sent by the driving planning module, determines the control command based on the target task, and sends the control command to the control device.

[0056] The control device is installed on the vehicle body 100 and is connected to both the rock drilling mechanism and the vehicle body 100. The control device receives control commands and controls the movement of the rock drilling mechanism, including the propulsion beam 200, the hydraulic rock drill 220, the hydraulic rock drill 220 auxiliary arm, and the drill arm 210. The control device also controls the movement of the vehicle body 100 through control commands.

[0057] In some embodiments, the control module also receives the action pattern feedback from the rock drilling mechanism through the control device, and sends the feedback action pattern to the driving planning module. The driving planning module can also analyze the feedback action pattern, and through the current environmental data, the analyzed feedback action pattern and the control data, it can better plan the target task. The driving planning module also sends the feedback action pattern to the remote control terminal so that the remote control display can remotely monitor the action pattern of the rock drilling mechanism.

[0058] The driving planning module and the control module of the rock drilling rig are merged into a single unit. The rock drilling rig will then operate fully automatically, locating blasting holes, anchor bolt holes, and grouting holes; it will also perform functions such as drilling, feedback, and adjustment. This achieves the integration of unmanned driving technology with the rock drilling rig.

[0059] In the harsh working conditions of a rock drilling rig, environmental data is collected, and control data sent from the remote control terminal is integrated with the collected current environmental data. The driving planning module then makes decisions and plans the target tasks of the rock drilling rig, coordinating the drilling mechanisms on the rig and driving the movement of the vehicle body 100. This solves the problems of coordination and adaptation between drilling mechanisms, as well as information delays that lead to inaccurate data analysis, preventing the rock drilling rig from operating under incorrect instructions and causing risks.

[0060] Reference Figure 1 In some embodiments of the first aspect of the present invention, the control system further includes: a wireless communication module 300 and a CAN data exchange and storage module.

[0061] The CAN data exchange and storage module communicates with the control module and the driving planning module. The CAN data exchange and storage module can store the action mode of the rock drilling mechanism on the rock drilling rig and the vehicle status determined by the driving planning module in real time, thereby recording it into the database of the unmanned driving system and sending it back to the remote control terminal.

[0062] The wireless communication module 300 is connected to the driving planning module and also to the remote control terminal to enable wireless communication between the driving planning module and the remote control terminal.

[0063] Due to the harsh working environment of rock drilling rigs, different communication modules can be selected for different working conditions to achieve communication connectivity. For example, inside a tunnel, a local area network connection can be used, and a base station can be established outside the tunnel to enable unmanned operation of the rock drilling rig within a certain distance; or, in scenarios where 5G communication modules are receiving normal signals, a 5G network connection can be used, without distance limitations.

[0064] This application can detect the data transmission speed and data acquisition speed under different connection methods through a driving planning module. Simultaneously, it records the set transmission and acquisition speeds for different connection methods under manual control, thereby forming a database for the autonomous driving system. This addresses the issue of inaccurate data analysis caused by information delays.

[0065] Reference Figure 1 In some embodiments of the first aspect of the present invention, the driving planning module includes an environmental detection unit.

[0066] The environmental detection unit detects the current operating environment of the vehicle body 100, thereby obtaining current environmental data. This current environmental data includes image data and pose data.

[0067] The environmental detection unit includes a radar component and an image detection component 310.

[0068] The radar components include millimeter-wave radar and lidar. The radar components scan the current operating environment of the vehicle 100 and collect the position and pose data of the vehicle 100 under the current operating environment.

[0069] Because the working environment of the rock drilling rig is harsh, with large variations in temperature and light intensity, and it is often located in places with weak signal reception, such as mine tunnels, millimeter-wave radar is installed around the vehicle body 100, and lidar is installed on the top of the vehicle body 100.

[0070] The image detection component 310 includes a monocular camera and a sensing camera. The image detection component 310 acquires image data of the current working environment.

[0071] By recognizing image and pose data, obstacles are detected, a high-precision SLAM map is built, obstacle data based on the map is obtained, and the optimal target trajectory is planned using trajectory optimization algorithms to achieve autonomous movement of the rock drilling rig.

[0072] Different working environments can impose certain limitations on sensors; the combination of millimeter-wave radar and lidar used on the rock drilling rig can effectively avoid perception obstacles caused by environmental issues; at the same time, monocular cameras and perception cameras provide effective environmental perception for the driving planning module.

[0073] Reference Figure 1 In some embodiments of the first aspect of the present invention, the control device includes a drive component and an adjustment component.

[0074] The drive component is connected to the vehicle body 100. The drive component receives control commands sent by the control module and drives the vehicle body 100 to move along the optimal target trajectory.

[0075] The adjustment component is connected to the rock drilling mechanism. The adjustment component receives control commands from the control module and switches the corresponding action mode of the rock drilling mechanism through the control commands.

[0076] For example, if the control command is to drive vehicle 100 to a designated location, advancing 3 meters to that location, then based on the current environmental data, the optimal target trajectory to reach the designated location is planned. Following this trajectory, the drive component controls vehicle 100 to move to the designated location. The adjustment component controls the propulsion beam 200 to advance, switching the corresponding action mode, and also controls the hydraulic rock drill 220 to drill, switching the corresponding action mode as well.

[0077] An embodiment of the second aspect of the present invention applies the unmanned intelligent rock drilling rig control system of the embodiment of the first aspect of the present invention. (See also...) Figure 2 In some embodiments of the second aspect of the present invention, the control method of the unmanned intelligent rock drilling rig control system includes:

[0078] S100: The remote control terminal acquires user commands and generates control data based on the user commands.

[0079] In this embodiment, the remote control terminal acquires and responds to user commands. The remote control terminal is equipped with a remote control display screen and a remote control console. The remote control display screen can display the vehicle status and the operation mode of the rock drilling mechanism. The remote control console can acquire and respond to user commands, generate control data based on user commands, and wirelessly send the control data to the driving planning module.

[0080] In other words, users can view the vehicle status of the rock drilling rig and the operation of the rock drilling mechanism through a remote control display screen, and then generate user commands through the remote control console. The remote control console responds to user commands and generates control data, which can include controlling the drill arm to advance 1 meter in coordination with the propulsion beam or controlling the hydraulic rock drill to drill a grouting hole.

[0081] S200, the driving planning module detects the current communication status and obtains the current environmental data under the current communication status.

[0082] In this embodiment, due to the harsh working environment of the rock drilling rig, different communication modules can be selected for different working conditions to achieve communication connectivity. Furthermore, the different connection methods between the driving planning module and the remote control terminal under different working conditions result in the inability to transmit the vehicle status and movement patterns of the rock drilling rig to the remote control terminal in a timely manner for monitoring.

[0083] The driving planning module detects the current communication status, and under the current communication status, it detects the current operating environment of the vehicle, thereby obtaining the current environmental data.

[0084] In the S300, the driving planning module determines the vehicle status based on current environmental data and judges whether the vehicle status is normal based on control data.

[0085] In this embodiment, the driving planning module determines the vehicle status of the rock drilling rig based on the current environmental data collected by S200. It also confirms whether the vehicle status is normal based on the received control data. This ensures that the rock drilling rig will not fail to automatically correct itself due to data exchange delays, leading to abnormal vehicle status.

[0086] By manipulating data, it can be determined whether there is a data delay, which could prevent the drilling rig's information from being transmitted to the remote control terminal for monitoring in a timely manner.

[0087] If it is an S400, then the target task for vehicle operation is planned based on the current environmental data and control data.

[0088] In this embodiment, when the vehicle is in a normal state, the driving planning module plans the optimal target trajectory based on the current environmental data and determines the switching action mode of the rock drilling mechanism based on the control data. The target task includes: the target trajectory of the vehicle movement and the switching action mode of the rock drilling mechanism. The driving planning module sends the target task to the control module.

[0089] In the S500, the control module determines the control instructions based on the target task, and the control device adjusts the action mode of the rock drilling mechanism and drives the vehicle body according to the control instructions.

[0090] In this embodiment, the control module receives the target task sent by the driving planning module. Based on the target task, the control module determines the adjustment instructions for the rock drilling mechanism and the drive vehicle. The control module then sends the adjustment instructions to the control device.

[0091] The control device receives control commands, adjusts the rock drilling mechanism, switches the rock drilling mechanism's action mode, and also drives the vehicle to move.

[0092] The driving planning module will be integrated with the control module of the rock drilling rig to form a unified system. The rock drilling rig will then operate in a fully automated manner, locating blasting holes, anchor bolt holes, and grouting holes; it will also be able to perform functions such as drilling, feedback, and adjustment.

[0093] In the harsh working conditions of rock drilling rigs, environmental data is collected, and control data sent from the remote control terminal is integrated with the collected current environmental data. The driving planning module makes decisions and plans the target tasks of the rock drilling rig, coordinating the drilling mechanisms on the rig and driving its movement. This solves the problems of coordination and adaptation between drilling mechanisms, as well as information delays that lead to inaccurate data analysis, preventing the rock drilling rig from operating under incorrect commands and causing risks.

[0094] In some embodiments of the second aspect of the present invention, in S300, the process of determining whether the vehicle status is normal specifically includes the following steps:

[0095] S310, under the current communication state, the driving planning module obtains the data transmission speed when receiving control data and the data acquisition speed when collecting current environmental data.

[0096] In this embodiment, under the current communication state, the driving planning module detects the data transmission speed when receiving control data and the data acquisition speed when collecting current environmental data.

[0097] S320, the driving planning module confirms the current communication mode through the current communication status, and obtains the set transmission speed and set acquisition speed under the current communication mode.

[0098] In this embodiment, the current communication mode of the driving planning module is determined by the current communication status. The set transmission speed and set data acquisition speed of the driving planning module under the current communication mode are then obtained.

[0099] This involves calling the autonomous driving system database to obtain the set transmission speed and set data acquisition speed corresponding to the current communication method under the current operating conditions.

[0100] The formation process of the autonomous driving system database is as follows:

[0101] The system collects data transmission and acquisition speeds of the driving planning module under different communication methods and operating conditions, while also recording human control data to provide data for comparison in the next stage.

[0102] By comparing data manipulated by humans with collected data, the reliability of data transmission and data acquisition in the driving planning module is tested and corrected accordingly, forming an unmanned driving system database, which will be recorded in the driving planning module of the rock drilling rig.

[0103] S330 calculates the transmission error between the data transmission speed and the set transmission speed, calculates the acquisition error between the data acquisition speed and the set acquisition speed, and determines whether there is a data exchange delay in the driving planning module by using the transmission error and acquisition error.

[0104] S331, if not, the vehicle status is normal.

[0105] In this embodiment, in S320, the error amount of data transmission of the driving planning module and the error amount of data acquisition of the driving planning module are calculated, and based on the above two error amounts, it is determined whether there is a data exchange delay.

[0106] Specifically, if the transmission error exceeds the set transmission error threshold and / or the acquisition error exceeds the set acquisition error threshold, the driving planning module is considered to have a data exchange delay. In other words, if either of these errors exceeds the set threshold, the driving planning module is considered to have a delay in acquiring the current environmental data and receiving the control data, resulting in low reliability of the current environmental data and the received control data, and the vehicle is in an abnormal state.

[0107] When both the transmission error and the acquisition error are less than the set transmission error threshold, the driving planning module is considered to have no data exchange delay. The current environmental data and control data are highly reliable, and the vehicle is in a normal state.

[0108] In some embodiments of the second aspect of the present invention, in S300, the process of determining whether the vehicle status is normal further includes the following steps:

[0109] S332, when the vehicle is in an abnormal state, the driving planning module corrects the current environmental data by collecting errors and the current communication status in order to plan the target task.

[0110] In this embodiment, if it is determined that there is a delay between the current environmental data collected by the driving planning module and the control data received, and the reliability of the current environmental data and the control data is low, then the vehicle is determined to be in an abnormal state.

[0111] The driving planning module collects errors and current communication status, corrects the current environmental data, and uses the corrected current environmental data and control data to plan the target task of the rock drilling rig.

[0112] For example: Suppose the driving planning module collects the current environmental data at time N. When the vehicle is in an abnormal state, there is a data exchange delay in the driving planning module. Based on the collection error and the current communication status, the current environmental data collected at time N-1 is determined, and the current environmental data at time N is corrected using the current environmental data collected at time N-1.

[0113] In some embodiments of the second aspect of the present invention, in S400, the planning process of the target task specifically includes the following steps:

[0114] S410, the driving planning module uses the current environmental data and trajectory optimization algorithm to plan the optimal target trajectory so that the vehicle can drive according to the target trajectory;

[0115] In this embodiment, the driving planning module detects obstacles based on the current environmental data, builds a high-precision SLAM map, obtains obstacle data based on the map, uses a trajectory optimization algorithm to plan the optimal target trajectory, and drives the vehicle to move along the optimal target trajectory to achieve autonomous movement of the rock drilling rig.

[0116] S420, the driving planning module determines the switching action mode through control data; the target task includes the target trajectory and action mode.

[0117] In this embodiment, the driving planning module analyzes the action pattern based on the received control data to determine the corresponding action pattern for switching the rock drilling mechanism.

[0118] This application addresses the challenges of coordinating the working position and range of the drilling mechanism on a rock drilling rig due to the harsh working environment and the large amount of data from various sensors; it also resolves the issue of the monitoring center being unable to transmit information in a timely manner due to different connection methods between the driving planning module and the remote control terminal under different working conditions; and it addresses the issues of coordination and adaptation between the driving planning module and the vehicle body and the drilling mechanism, as well as the risks arising from inaccurate data analysis due to information delays and the rock drilling rig operating under incorrect instructions.

[0119] According to an embodiment of a third aspect of the present invention, a storage medium is characterized in that it comprises: storing computer-executable instructions, the computer-executable instructions being used to execute a control method of an unmanned intelligent rock drilling rig control system as described in the second aspect of the present invention.

[0120] The non-transient software program and instructions required to implement the above-described terminal selection method are stored in a memory. When executed by one or more processors, they are executed as the control method of the unmanned intelligent rock drilling rig control system of the second aspect of the present invention.

[0121] It will be understood by those skilled in the art that all or some of the steps and systems in the methods disclosed above can be implemented as software, firmware, hardware, and suitable combinations thereof. Some or all of the physical components can be implemented as software executed by a processor, such as a central processing unit, digital signal processor, or microprocessor, or as hardware, or as an integrated circuit, such as an application-specific integrated circuit. Such software can be distributed on a computer-readable medium, which can include computer storage media (or non-transitory media) and communication media (or transient media). As is known to those skilled in the art, the term computer storage media includes volatile and non-volatile, removable and non-removable media implemented in any method or technology for storing information (such as computer-readable instructions, parameter structures, program modules, or other parameters). Computer storage media includes, but is not limited to, RAM, ROM, EEPROM, flash memory or other memory technologies, CD-ROM, digital versatile disc (DVD) or other optical disc storage, magnetic cartridges, magnetic tape, disk storage or other magnetic storage devices, or any other medium that can be used to store desired information and is accessible to a computer. Furthermore, as is known to those skilled in the art, communication media typically include computer-readable instructions, parameter structures, program modules, or other parameters in modulation parameter signals such as carrier waves or other transmission mechanisms, and may include any information delivery medium.

[0122] The preferred embodiments of the present invention have been described in detail above, but the present invention is not limited to the embodiments described. Those skilled in the art can make various equivalent modifications or substitutions without departing from the spirit of the present invention, and these equivalent modifications or substitutions are all included within the scope defined by the claims of this application.

Claims

1. A control system for an unmanned intelligent rock drilling rig, characterized in that, The unmanned intelligent rock drilling rig includes a vehicle body and a rock drilling mechanism, and the control system includes: The remote control terminal is used to display vehicle status, acquire user commands, and generate control data based on the user commands. A driving planning module, wirelessly connected to the remote control terminal and mounted on the vehicle body, is used to detect the current communication status, collect current environmental data under the current communication status, determine the vehicle status based on the current environmental data, and plan the target task based on the control data, specifically including: The driving planning module determines the vehicle status based on the current environmental data and judges whether the vehicle status is in a normal state based on the control data. If so, then plan the target task based on the current environmental data and control data; The control module determines the control command based on the target task, and the control device adjusts the action mode of the rock drilling mechanism and drives the vehicle body to move according to the control command. The determination of whether the vehicle status is in a normal state specifically includes: The driving planning module acquires the data transmission speed of the control data and the data acquisition speed of the current environmental data; The driving planning module determines the current communication mode based on the current communication status and obtains the set transmission speed and set acquisition speed corresponding to the current communication mode; The transmission error between the data transmission speed and the set transmission speed, and the acquisition error between the data acquisition speed and the set acquisition speed are calculated. Based on the transmission error and the acquisition error, it is determined whether the driving planning module has a data exchange delay. Specifically, this includes: when the transmission error is greater than the set transmission error threshold and / or the acquisition error is greater than the set acquisition error threshold, it is determined that there is a data exchange delay; when the transmission error is less than the set transmission error threshold and the acquisition error is less than the set acquisition error threshold, it is determined that there is no data exchange delay. If not, then the vehicle status is normal; The step of determining whether the vehicle status is in a normal state also includes: When the vehicle is in an abnormal state, the driving planning module corrects the current environmental data based on the acquisition error and the current communication status in order to plan the target task. The specific planning objectives and tasks include: The driving planning module detects obstacles based on the current environmental data, builds a high-precision SLAM map, obtains obstacle data based on the map, and uses a trajectory optimization algorithm to plan the optimal target trajectory so that the vehicle travels along the target trajectory. The driving planning module determines the corresponding action mode of switching the rock drilling mechanism based on the control data; The target task includes the target trajectory and action pattern; The control module, which is communicatively connected to the driving planning module, is mounted on the vehicle body and is used to determine control commands based on the target task. A control device, connected to the rock drilling mechanism and the vehicle body, is used to adjust the action mode of the rock drilling mechanism and drive the vehicle body according to the control command.

2. The unmanned intelligent rock drilling rig control system according to claim 1, characterized in that, Also includes: The CAN data exchange and storage module is communicatively connected to the control module and the driving planning module, respectively, and is used to store the vehicle status and the driving mode. The wireless communication module is connected to both the driving planning module and the remote control terminal, enabling the driving planning module and the remote control terminal to establish a wireless communication connection.

3. The unmanned intelligent rock drilling rig control system according to claim 1, characterized in that, The driving planning module includes an environmental detection unit; the environmental detection unit is used to detect the current operating environment of the vehicle body and to collect the current environmental data.

4. The unmanned intelligent rock drilling rig control system according to claim 3, characterized in that, The environmental detection unit includes: The radar component is used to scan the current working environment and collect the vehicle's position and pose data. An image detection component is used to acquire images of the current working environment to obtain image data; The current environment data includes image data and pose data.

5. The unmanned intelligent rock drilling rig control system according to claim 1, characterized in that, The control device includes: A drive component, connected to the vehicle body, is used to drive the vehicle body to move according to the control command; An adjustment component, connected to the rock drilling mechanism, is used to control the rock drilling mechanism to switch to the corresponding action mode according to the control command.

6. A control method for an unmanned intelligent rock drilling rig control system, characterized in that, The method, applied to an unmanned intelligent rock drilling rig control system according to any one of claims 1 to 5, comprises: The remote control terminal acquires user commands and generates control data based on the user commands. The driving planning module detects the current communication status and obtains the current environmental data under the current communication status; The driving planning module determines the vehicle status based on the current environmental data and judges whether the vehicle status is in a normal state based on the control data. If so, then plan the target task based on the current environmental data and control data; The control module determines the control command based on the target task, and the control device adjusts the action mode of the rock drilling mechanism and drives the vehicle body to move according to the control command. The determination of whether the vehicle status is in a normal state specifically includes: The driving planning module acquires the data transmission speed of the control data and the data acquisition speed of the current environmental data; The driving planning module determines the current communication mode based on the current communication status and obtains the set transmission speed and set acquisition speed corresponding to the current communication mode; The transmission error between the data transmission speed and the set transmission speed, and the acquisition error between the data acquisition speed and the set acquisition speed are calculated. Based on the transmission error and the acquisition error, it is determined whether the driving planning module has a data exchange delay. Specifically, this includes: when the transmission error is greater than the set transmission error threshold and / or the acquisition error is greater than the set acquisition error threshold, it is determined that there is a data exchange delay; when the transmission error is less than the set transmission error threshold and the acquisition error is less than the set acquisition error threshold, it is determined that there is no data exchange delay. If not, then the vehicle status is normal; The step of determining whether the vehicle status is in a normal state also includes: When the vehicle is in an abnormal state, the driving planning module corrects the current environmental data based on the acquisition error and the current communication status in order to plan the target task. The specific planning objectives and tasks include: The driving planning module detects obstacles based on the current environmental data, builds a high-precision SLAM map, obtains obstacle data based on the map, and uses a trajectory optimization algorithm to plan the optimal target trajectory so that the vehicle travels along the target trajectory. The driving planning module determines the corresponding action mode of switching the rock drilling mechanism based on the control data; The target task includes the target trajectory and the action pattern.

7. A storage medium, characterized in that, include: The system stores computer-executable instructions for performing the control method of the unmanned intelligent rock drilling rig control system as described in any one of claims 6.

Citation Information

Patent Citations

  • Drill jambo remote control method

    CN112253082A