Intrinsic safety control device and system for mining inspection robot
By integrating high-precision digital encoder, acceleration sensor and wireless communication module into the intrinsic safety controller of mining inspection robots, the problem of insufficient independent operation and motion perception capabilities in the existing technology is solved, and multi-sensor data acquisition is realized With transmission, it supports downhole 5G and wifi signals, improving the reliability and autonomy of the robot in the downhole environment.
Patent Information
- Application Number
- CN202323371745.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Utility models(China)
- Current Assignee / Owner
- Filing Date
- 2023-12-12
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2033-12-12
AI Technical Summary
The existing intrinsic safety controllers of mining patrol robots cannot operate independently when offline from the on-hole monitoring system network, and have poor motion perception capabilities and do not have high-precision attitude perception capabilities.
An intrinsic safety control device for mining patrol robots is designed, including high-precision digital encoder, high-speed CAN bus module, 6-axis acceleration sensor, storage module and RFID positioning module, combined with RS485 data bus module, wireless communication module and switch. It realizes multi-sensor data acquisition and transmission, supports downhole 5G and wifi signals, and has independent operation and remote upgrade functions.
It realizes robot walking status detection and control, multi-sensor data acquisition and transmission, supports offline autonomous operation and remote upgrade, and improves the reliability and autonomy of the robot in an underground environment.
Smart Images

Figure CN221995576U_ABST
Abstract
Description
Technical Field
[0001] The utility model relates to the technical field of inspection robots, in particular to an intrinsically safe control device and system for a mining inspection robot. Background Art
[0002] In recent years, intelligent technology has been widely used in various industries. The development of intelligent coal mines has made unmanned inspection a development trend. Mine inspection robots can completely replace inspection workers, reliably inspect and collect, store and transmit images, sounds, temperature, smoke, methane and other data on site in real time. Through data analysis, it can determine whether there is equipment failure and locate the fault. As the control core of the normal operation of mine inspection robots, intrinsically safe controllers mainly have the functions of collecting sensor data, image and video data, network communication, motion control, etc.
[0003] However, most of the existing intrinsically safe controllers for mining inspection robots are composed of sensor data acquisition modules, wireless communication modules, and motion control modules. Although they have the basic functions for the normal operation of the inspection robots, they have poor autonomy and cannot achieve autonomous operation when they are offline from the well monitoring system network. In addition, they have poor motion perception capabilities and lack high-precision posture perception capabilities.
[0004] Therefore, how to realize a reliable intrinsically safe controller for mining inspection robots is a technical problem that needs to be solved urgently in this field. Utility Model Content
[0005] In order to solve the above technical problems, the utility model proposes the following technical solutions:
[0006] In a first aspect, an embodiment of the utility model provides an intrinsically safe control device for a mining inspection robot, characterized in that it comprises: a controller, a high-precision digital encoder electrically connected to the controller, a high-speed CAN bus module, a 6-axis acceleration sensor, a storage module, and an RFID positioning module;
[0007] Wherein, the high-precision digital encoder is used to realize the acquisition and transmission of speed signals when the inspection robot moves;
[0008] The high-speed CAN bus module is used to collect the obstacle distance detected by the ultrasonic radar and the motion information transmitted by the motor controller;
[0009] The 6-axis acceleration sensor is used to collect and transmit the acceleration, angular velocity, and uphill and downhill angle data of the inspection robot;
[0010] The storage module uses E2ROM and TF card memory to realize the storage and transmission of inspection robot motion parameters, alarm thresholds, path information and OTA upgrade firmware data;
[0011] The RFID positioning module is used to realize the functions of receiving and identifying RFID position signals and transmitting positioning data.
[0012] In a possible implementation, the high-precision digital encoder includes: a photoelectric sensor, wherein the collector of the photoelectric sensor is electrically connected to the first end of the first resistor, the first end of the first capacitor and the positive electrode of the diode respectively; the second end of the first resistor is electrically connected to the intrinsically safe power supply; the cathode of the diode is electrically connected to the second end of the first capacitor and the base of the transistor; the emitter of the transistor is electrically connected to the first end of the second resistor; the collector of the transistor is electrically connected to the negative electrode of the voltage-stabilizing diode and the first end of the third resistor; the emitter of the photoelectric sensor, the second end of the second resistor and the positive electrode of the voltage-stabilizing diode are grounded; The second end of the third resistor is connected to the third port of ACPL-061L-000E; the first end of the fourth resistor is connected to the intrinsically safe power supply; the second end of the fourth resistor is connected to the second port of ACPL-061L-000E; the first end of the fifth resistor is connected to the sixth port of ACPL-061L-000E; the second end of the fifth resistor is used as an output; the fifth port of ACPL-061L-000E is grounded; the eighth port of ACPL-061L-000E is electrically connected to the 3.3V power supply and the first end of the second capacitor; the second end of the second capacitor is grounded.
[0013] In a possible implementation, the 6-axis acceleration sensor includes an acceleration sensor chip, a first VCC port of the acceleration sensor chip is electrically connected to a 5V power supply; a second VCC port of the acceleration sensor chip is electrically connected to a 5V power supply, a first end of a third capacitor, and a first end of a fourth capacitor; a second end of the third capacitor and a second end of the fourth capacitor are grounded; a first GND port and a second GND port of the acceleration sensor chip are grounded; and a serial bus signal is received and sent through a receiving port RX and a sending port TX.
[0014] In a possible implementation, it also includes an RS485 data bus module, which is used to collect smoke, dust, temperature and humidity, harmful gases and tunnel section deformation data during the inspection process of the inspection robot in real time.
[0015] In a possible implementation, a wireless communication module is also included, and the wireless communication module includes: a 5G communication unit and a wifi communication unit, wherein:
[0016] The 5G communication unit is used to realize the data transmission function between the inspection robot controller and the underground 5G base station;
[0017] The wifi communication unit is used to realize data transmission and data roaming functions between the inspection robot controller and the underground wifi base station.
[0018] In a possible implementation, a switch is also included, and the switch is used to realize the relay forwarding function of the inspection robot sensor data, motion control data, system instructions, image and video data, and on-site sound data.
[0019] In a possible implementation, it also includes a wireless remote control module, which includes a 2.4G wireless signal transceiver module and a data transmission module, and is used to realize the movement of the inspection robot and the manual wireless remote control function of alarm closing.
[0020] In a possible implementation, the 2.4G wireless signal transceiver module includes a wireless signal transceiver, the VCC end of the wireless signal transceiver is electrically connected to a 3.3v power supply, a first end of a fifth capacitor, and a first end of a sixth capacitor; the second end of the fifth capacitor and the second end of the sixth capacitor are grounded; the serial bus signal is received and sent through a data input port DIN and a data output port DOUT of the wireless signal transceiver; the first end of the sixth resistor is electrically connected to a 3.3v power supply; the second end of the sixth resistor is electrically connected to a RESET end of the wireless signal transceiver and a first end of a seventh capacitor; the second end of the seventh capacitor is grounded to a GND end.
[0021] In a second aspect, an embodiment of the utility model provides a mining inspection system, including: an inspection robot, a robot remote controller and a remote monitoring system, wherein the control device of the inspection robot adopts the mining inspection robot intrinsically safe control device.
[0022] Compared with the prior art, the beneficial effects of the utility model are:
[0023] 1) The inspection robot control device of the utility model is equipped with a multi-channel RS485 data bus module, which can realize the collection and transmission of multi-sensor data such as laser, smoke, dust, temperature and humidity, and harmful gas detection.
[0024] 2) The inspection robot control device of the utility model is equipped with a high-speed CAN bus module and a high-precision digital encoder, which can realize the detection and control of the robot's walking state.
[0025] 3) The inspection robot control device of the utility model is equipped with a switch, a 5G communication unit, and a wifi communication unit, and is compatible with underground 5G and wifi signals and other functions, realizing the inspection robot sensor data, motion control data, system instructions, image and video data, and on-site sound data transmission functions.
[0026] 4) The inspection robot control device of the utility model is equipped with E2ROM and TF card memory, which can store motion information, motion instructions and path information to support offline autonomous operation, and can store upgrade firmware information to support OTA remote upgrade.
[0027] 5) The inspection robot control device of the utility model is equipped with a 6-axis acceleration sensor, which can realize the collection of the acceleration, angular velocity, and uphill and downhill angle data of the inspection robot, and perform uphill and downhill, acceleration and deceleration, and turning state detection of the inspection robot.
[0028] 6) The inspection robot control device of the utility model is equipped with an RFID positioning sensor, which can realize the functions of RFID position signal reception and identification and positioning data transmission.
[0029] 7) The inspection robot control device of the utility model is equipped with a wireless remote control module, which can realize on-site operation functions such as movement of the inspection robot and alarm shutdown. BRIEF DESCRIPTION OF THE DRAWINGS
[0030] Figure 1 A schematic diagram of the electrical principle of an intrinsically safe control device for a mining inspection robot provided by an embodiment of the utility model;
[0031] Figure 2 A circuit diagram of a high-precision digital encoder provided by an embodiment of the utility model;
[0032] Figure 3 A circuit schematic diagram of a 6-axis acceleration sensor provided in an embodiment of the utility model;
[0033] Figure 4 A circuit schematic diagram of a wireless remote control module provided by an embodiment of the utility model;
[0034] Figure 5 A schematic diagram of a mining inspection system provided in an embodiment of the utility model. DETAILED DESCRIPTION
[0035] The present solution is described below in conjunction with the accompanying drawings and specific implementation methods.
[0036] Figure 1 The electrical principle diagram of the intrinsically safe control device of the mining inspection robot provided by the embodiment of the utility model is shown in FIG. Figure 1 The intrinsically safe control device in this embodiment includes: a controller 4, a high-precision digital encoder 7 electrically connected to the controller, a high-speed CAN bus module 2, a 6-axis acceleration sensor 8, a storage module 11, an RFID positioning module 9, an RS485 data bus module 1, a switch 3, a wireless communication module and a wireless remote control module 10;
[0037] Among them, the circuit schematic diagram of the high-precision digital encoder can be found in Figure 2 The high-precision digital encoder comprises: a photoelectric sensor Q1, wherein the collector of the photoelectric sensor is electrically connected to the first end of the first resistor, the first end of the first capacitor and the positive electrode of the diode respectively; the second end of the first resistor is electrically connected to the intrinsically safe power supply; the cathode of the diode D1 is electrically connected to the second end of the first capacitor and the base of the transistor Q2; the emitter of the transistor Q2 is electrically connected to the first end of the second resistor; the collector of the transistor Q2 is electrically connected to the cathode of the voltage-stabilizing diode D2 and the first end of the third resistor; the emitter of the photoelectric sensor Q1, the second end of the second resistor and the positive electrode of the voltage-stabilizing diode D2 are electrically connected; ground; the second end of the third resistor is connected to the third port of ACPL-061L-000E; the first end of the fourth resistor is connected to the intrinsically safe power supply; the second end of the fourth resistor is connected to the second port of ACPL-061L-000E; the first end of the fifth resistor is connected to the sixth port of ACPL-061L-000E; the second end of the fifth resistor is used as an output; the fifth port of ACPL-061L-000E is grounded; the eighth port of ACPL-061L-000E is electrically connected to the 3.3V power supply and the first end of the second capacitor; the second end of the second capacitor is grounded.
[0038] The speed signal collected by the HPD13 photoelectric sensor is converted into an electrical signal, which is then isolated by the ACPL-061L-000E digital optocoupler and converted into a level signal recognized by the controller, thereby realizing the collection and transmission of the speed signal when the inspection robot is moving.
[0039] The high-speed CAN bus module is used to collect the obstacle distance detected by the ultrasonic radar and the motion information transmitted by the motor controller.
[0040] The 6-axis acceleration sensor is used to collect and transmit the acceleration, angular velocity, and uphill and downhill angle data of the inspection robot. The schematic diagram is shown in Figure 3 The 6-axis acceleration sensor includes an acceleration sensor chip, a first VCC port of the acceleration sensor chip is electrically connected to a 5V power supply; a second VCC port of the acceleration sensor chip is electrically connected to a 5V power supply, a first end of a third capacitor, and a first end of a fourth capacitor; a second end of the third capacitor and a second end of the fourth capacitor are grounded; a first GND port and a second GND port of the acceleration sensor chip are grounded; and a serial bus signal is received and sent through a receiving port RX and a sending port TX.
[0041] The JY60 acceleration sensor chip converts the multi-axis vibration signal into serial bus signals UART_5_TX and UART_5_RX that the controller can recognize and inputs them to the controller. The controller converts the bus data signal into angle and acceleration signals, thereby realizing the collection and transmission of the acceleration, angular velocity and uphill and downhill angle data of the inspection robot.
[0042] The storage module uses E2ROM and TF card memory to realize the storage and transmission of inspection robot motion parameters, alarm thresholds, path information and OTA upgrade firmware data.
[0043] The RFID positioning module is used to realize the RFID position signal reception and identification and positioning data transmission functions.
[0044] The RS485 data bus module is used to collect real-time data on smoke, dust, temperature and humidity, harmful gases, and tunnel section deformation during the inspection process of the inspection robot.
[0045] The wireless communication module includes: a 5G communication unit 5 and a wifi communication unit 6, wherein: the 5G communication unit is used to realize the data transmission function between the inspection robot controller and the underground 5G base station; the wifi communication unit is used to realize the data transmission and data roaming function between the inspection robot controller and the underground wifi base station.
[0046] The wireless remote control module includes a 2.4G wireless signal transceiver module. Figure 4 The 2.4G wireless signal transceiver module includes a wireless signal transceiver, the VCC end of the wireless signal transceiver is electrically connected to a 3.3v power supply, a first end of a fifth capacitor and a first end of a sixth capacitor; the second end of the fifth capacitor and the second end of the sixth capacitor are grounded; the serial bus signal is received and sent through a data input port DIN and a data output port DOUT of the wireless signal transceiver; the first end of the sixth resistor is electrically connected to a 3.3v power supply; the second end of the sixth resistor is electrically connected to a RESET end of the wireless signal transceiver and a first end of a seventh capacitor; the second end of the seventh capacitor is grounded to a GND end.
[0047] The XB3_24UT wireless signal transceiver receives the wireless signal from the remote controller and converts it into serial bus signals UART_2_TX and UART_2_RX, which are input to the controller, thereby realizing manual wireless remote control functions such as the movement of the inspection robot and the alarm shutdown.
[0048] The controller collects robot speed data, obstacle distance detected by ultrasonic radar and motion information transmitted by motor controller through high-precision digital encoder and high-speed CAN bus module respectively. After detecting positioning card signal through RFID positioning unit, the controller detects acceleration, angular velocity, uphill and downhill angle posture signal of inspection robot through 6-axis acceleration sensor, and stores the information into E2ROM and TF card memory. When in online control, the controller will transmit the data to the monitoring system through 5G communication unit or wifi communication unit through the relay of switch, and obtain the motion instruction of monitoring system. When in offline control, the controller will retrieve the motion and path information of E2ROM and TF card memory, and send motion control instruction through high-speed CAN bus module to control the motor to move forward, stop, retreat, decelerate, accelerate and other motion control. During operation, the controller collects smoke, dust, temperature and humidity, harmful gas and deformation of tunnel section in real time during inspection of inspection robot through RS485 data bus module. The switch will relay the data processed by controller, inspection data such as dual-light camera, and send it to remote monitoring system through 5G communication unit or wifi communication unit.
[0049] Corresponding to the intrinsically safe control device of a mining inspection robot provided in the above embodiment, the utility model also provides an embodiment of a mining inspection system.
[0050] See also Figure 5 The mining inspection system 20 in the embodiment of the utility model includes: an inspection robot 201, a robot remote controller 202 and a remote monitoring system 203. The control device of the inspection robot adopts the intrinsically safe control device of the mining inspection robot. The robot remote controller 202 can be used to control the motion of the inspection robot 201 underground. At the same time, the remote monitoring system 203 can also realize the remote instruction issuance to the inspection robot 201.
[0051] In the embodiments of the present invention, "at least one" refers to one or more, and "more than one" refers to two or more. "And / or" describes the association relationship of associated objects, indicating that three relationships may exist. For example, A and / or B may represent the existence of A alone, the existence of A and B at the same time, and the existence of B alone. Among them, A and B may be singular or plural. The character " / " generally indicates that the previous and subsequent associated objects are in an "or" relationship. "At least one of the following" and similar expressions refer to any combination of these items, including any combination of single or plural items. For example, at least one of a, b and c can be represented by: a, b, c, ab, ac, bc, or abc, where a, b, c can be single or multiple.
[0052] It should be noted that, in this article, relational terms such as "first" and "second" are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprise a ..." do not exclude the existence of other identical elements in the process, method, article or device including the elements.
[0053] The above is only a specific implementation of the present invention. Any person skilled in the art can easily think of changes or substitutions within the technical scope disclosed by the present invention, which should be included in the protection scope of the present invention. The protection scope of the present invention should be based on the protection scope of the claims.
Claims
1. An intrinsically safe control device for a mining inspection robot, It is characterized in that include: A controller, a high-precision digital encoder, a high-speed CAN bus module, a 6-axis acceleration sensor, a storage module and an RFID positioning module electrically connected to the controller; wherein: The high-precision digital encoder is used to collect and transmit speed signals when the inspection robot moves; The high-speed CAN bus module is used to collect the obstacle distance detected by the ultrasonic radar and the motion information transmitted by the motor controller; The 6-axis acceleration sensor is used to collect and transmit the acceleration, angular velocity, and uphill and downhill angle data of the inspection robot; The storage module uses E2ROM and TF card memory to realize the storage and transmission of inspection robot motion parameters, alarm thresholds, path information and OTA upgrade firmware data; The RFID positioning module is used to realize the RFID position signal receiving and identifying and the positioning data transmission functions.
2. The intrinsically safe control device for a mining inspection robot according to claim 1, It is characterized in that The high-precision digital encoder comprises: a photoelectric sensor, wherein the collector of the photoelectric sensor is electrically connected to the first end of the first resistor, the first end of the first capacitor and the positive electrode of the diode respectively; the second end of the first resistor is electrically connected to the intrinsically safe power supply; the cathode of the diode is electrically connected to the second end of the first capacitor and the base of the transistor; the emitter of the transistor is electrically connected to the first end of the second resistor; the collector of the transistor is electrically connected to the cathode of the voltage-stabilizing diode and the first end of the third resistor; the emitter of the photoelectric sensor, the second end of the second resistor and the positive electrode of the voltage-stabilizing diode are grounded; the third resistor The second end of the fourth resistor is connected to the third port of ACPL-061L-000E; the first end of the fourth resistor is connected to the intrinsically safe power supply; the second end of the fourth resistor is connected to the second port of the ACPL-061L-000E; the first end of the fifth resistor is connected to the sixth port of the ACPL-061L-000E; the second end of the fifth resistor is used as an output; the fifth port of the ACPL-061L-000E is grounded; the eighth port of the ACPL-061L-000E is electrically connected to the 3.3V power supply and the first end of the second capacitor; the second end of the second capacitor is grounded.
3. The intrinsically safe control device for a mining inspection robot according to claim 1, It is characterized in that The 6-axis acceleration sensor comprises an acceleration sensor chip, wherein a first VCC port of the acceleration sensor chip is electrically connected to a 5V power supply; a second VCC port of the acceleration sensor chip is electrically connected to a 5V power supply, a first end of a third capacitor and a first end of a fourth capacitor; a second end of the third capacitor and a second end of the fourth capacitor are grounded; a first GND port and a second GND port of the acceleration sensor chip are grounded; The serial bus signal is received and sent through the receiving port RX and the transmitting port TX.
4. The intrinsically safe control device for a mining inspection robot according to claim 1, It is characterized in that It also includes an RS485 data bus module, which is used to collect smoke, dust, temperature and humidity, harmful gases and tunnel section deformation data during the inspection process of the inspection robot in real time.
5. The intrinsically safe control device for a mining inspection robot according to claim 1, It is characterized in that It also includes a wireless communication module, which includes: a 5G communication unit and a wifi communication unit, wherein: The 5G communication unit is used to realize the data transmission function between the inspection robot controller and the underground 5G base station; The wifi communication unit is used to realize data transmission and data roaming functions between the inspection robot controller and the underground wifi base station.
6. The intrinsically safe control device for a mining inspection robot according to claim 1, It is characterized in that It also includes a switch, which is used to realize the relay forwarding function of the inspection robot sensor data, motion control data, system instructions, image and video data, and on-site sound data.
7. The intrinsically safe control device for a mining inspection robot according to claim 1, It is characterized in that It also includes a wireless remote control module, which includes a 2.4G wireless signal transceiver module and a data transmission module, and is used to realize the movement of the inspection robot and the manual wireless remote control function of alarm closing.
8. The intrinsically safe control device for a mining inspection robot according to claim 7, It is characterized in that The 2.4G wireless signal transceiver module includes a wireless signal transceiver, the VCC end of the wireless signal transceiver is electrically connected to a 3.3v power supply, a first end of a fifth capacitor and a first end of a sixth capacitor; the second end of the fifth capacitor and the second end of the sixth capacitor are grounded; the serial bus signal is received and sent through a data input port DIN and a data output port DOUT of the wireless signal transceiver; the first end of the sixth resistor is electrically connected to a 3.3v power supply; the second end of the sixth resistor is electrically connected to a RESET end of the wireless signal transceiver and a first end of a seventh capacitor; the second end of the seventh capacitor is grounded to a GND end.
9. A mining inspection system, include: The inspection robot, robot remote controller and remote monitoring system are characterized in that the control device of the inspection robot adopts the intrinsically safe control device of the mining inspection robot according to any one of claims 1 to 8.
