A mine unmanned vehicle detection and position feedback system based on UWB technology

Through the mine unmanned vehicle detection and position feedback system based on UWB technology, the problems of medium and high-precision positioning and environmental detection in the deep mine mining are solved, and high-precision acquisition and security guarantee of the internal environment of the mine are achieved, reducing deployment complexity and power consumption.

CN111479233BActive Publication Date: 2024-11-15BEIJING INST OF TECH
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202010178819.2
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2020-03-15
Publication Date
2024-11-15
Estimated Expiration
2040-03-15

AI Technical Summary

Technical Problem

During the deep mining of mines, existing positioning technologies are difficult to achieve high-precision positioning, and they cannot effectively detect the internal environment of the mine, resulting in greater safety hazards.

Method used

Adopting a mine unmanned vehicle detection and position feedback system based on UWB technology, wireless communication between the unmanned vehicle module and the single reference point positioning base station module and fixed node module is achieved, high-precision positioning and environmental information collection, and transmission is carried out through the self-organized network. Data is processed and controlled by the terminal module.

Benefits of technology

It realizes high-precision detection and location feedback of the internal environment of the mine, improves the safety of mine staff, reduces deployment difficulty, and realizes automation and remote control in complex environments through low-power wireless modules.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN111479233B_ABST
    Figure CN111479233B_ABST
Patent Text Reader

Abstract

The present invention relates to a mine unmanned vehicle detection and position feedback system based on UWB technology, belonging to the field of wireless communication, detection and positioning technology. The unmanned vehicle system includes an unmanned vehicle module, a single reference point positioning base station module, a fixed node module and a terminal module; the unmanned vehicle module collects environmental information, and wirelessly communicates with the single reference point positioning base station module in the area to obtain position information, and finally transmits the environmental information and position information in the form of wireless signals; the fixed node on the mine wall detects the pressure of the mine wall, and transmits the transmitted wireless signal to the user terminal; after the user receives the internal environment and position information of the mine, he sends instructions from the established route to control each module in the unmanned vehicle system. The system can realize automation and remote control, and only a single reference point positioning base station module is needed to position the unmanned vehicle, without the need to assemble a wireless communication base station, which reduces the deployment difficulty and can perform directional control on each module.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a mine unmanned vehicle detection and position feedback system based on UWB technology, belonging to the technical field of wireless communication, detection and positioning. Background Art

[0002] Mineral resources are non-renewable resources and basic materials, which are very important for national economic construction. Mining mineral resources has become an indispensable part of the national economic construction process. With the depletion of shallow resources, my country has gradually entered the deep mining stage in terms of resource mining. As the mining depth gradually deepens, sudden situations such as rock burst, gas, and water inrush may occur, posing a huge threat to the safety of life and property. Predicting sudden dangers is very important for the safe and reliable operation of deep mining and for protecting the lives of mine workers.

[0003] The Global Navigation Satellite System (GNSS) is one of the most widely used wireless positioning systems so far. However, GNSS has great limitations. Taking the GPS positioning system as an example, the satellite signal reaching the ground is very weak and cannot penetrate dense buildings, resulting in the inability to accurately position in indoor environments with obstacles such as indoors and tunnels. Even in the most ideal wireless communication environment, the positioning accuracy of civil satellites can only reach the meter level, and the error of GPS civil positioning can reach within 5 meters, which cannot meet the requirements of high-precision positioning. Moreover, the cost of purchasing positioning terminal equipment is relatively high. UWB positioning technology has the advantages of strong penetration ability, high multipath resolution, strong anti-interference ability, etc., and is very suitable for short-distance, high-precision wireless positioning.

[0004] UWB (Ultra Wideband) is a carrier-free communication technology that uses nanosecond to microsecond non-sinusoidal narrow pulses to transmit data, which is fundamentally different from traditional narrowband wireless communication methods. In the UWB positioning process, the specific location of a reference base station is first determined, and then the location information of the UWB tag on the positioning target relative to the reference base station is obtained through the installed positioning base station, and finally transmitted to the host. Some people call it a revolutionary progress in the field of radio and believe that it may become a popular technology for short-distance wireless communications in the future.

[0005] As an emerging wireless transmission technology, UWB technology has many advantages in the field of construction monitoring: First, UWB technology has strong anti-interference ability and is highly immune to interference from other radios. Therefore, the positioning needs of UWB technology indoors, outdoors, and near walls have become feasible: Second, UWB technology can achieve three-dimensional dynamic positioning. The number of positioning base stations in the UWB positioning system determines the positioning dimension. A 10Hz system can locate UWB tags at a resolution of several centimeters. When there are four or more positioning base stations at different heights, three-dimensional precise positioning can be obtained. The more positioning base stations at different heights, the higher the positioning accuracy; Third, UWB technology has a high data transmission rate and can achieve a transmission rate of more than 100Mbps.

[0006] At the current stage, by deploying positioning base stations in the mine construction area, and giving positioning tags to mine personnel, mine cars, and materials, the positions of people, vehicles, and objects can be accurately located in real time and the data can be uploaded to the background through wireless transmission, so as to achieve tracking and positioning management of construction personnel and vehicles and daily attendance. However, in this way, construction personnel may still encounter danger. If the environment inside the mine is detected before the workers enter the mine, the danger of deep mining can be reduced. Therefore, we are committed to proposing an unmanned vehicle system that works in the mine, can detect the complex environmental information inside the mine, and can perform high-precision positioning of its location. Summary of the invention

[0007] The purpose of the present invention is to further enhance the detection of the internal environment of the mine and improve the detection and positioning accuracy. A mine unmanned vehicle detection and position feedback system based on UWB technology is proposed.

[0008] The core idea of ​​the present invention is: the sensor unit transmits the collected environmental information to the corresponding unmanned vehicle module, and the unmanned vehicle module communicates wirelessly with the single reference point positioning base station module in the area to obtain a position signal. Specifically, the single reference point positioning base station module receives the multipath UWB signal sent from the on-board positioning unit in the unmanned vehicle module, calculates the position of the unmanned vehicle according to TDOA and feeds it back to the unmanned vehicle module, and then the environmental information and the position of the unmanned vehicle are processed by the calculation and control unit and transmitted to the on-board communication unit and sent out, and then transmitted to the fixed node on the mine wall through a self-organizing network composed of multiple on-board communication units. The fixed node can detect the pressure of the mine wall and also transmit the transmitted wireless signal to the user terminal; after the user receives the internal environment and position information of the mine, it sends an instruction to the unmanned vehicle module through the newly established route to realize the control of the unmanned vehicle module.

[0009] The mine unmanned vehicle detection and position feedback system based on UWB technology includes an unmanned vehicle module, a single reference point positioning base station module, a fixed node module and a terminal module;

[0010] The terminal module includes but is not limited to a smart phone, a PAD, a tablet computer or a handheld mobile electronic device; the number of unmanned vehicle modules is n, and the arrangement of the unmanned vehicles in the mine is distributed;

[0011] Each unmanned vehicle module includes an on-board communication unit, a memory unit, an on-board power supply unit, an on-board positioning unit, a computing and control unit, a mobile unit, and a sensor unit; the number of single reference point positioning base station modules is k, and each single reference point positioning base station module includes a base station signal processing unit, an array antenna unit, a base station communication unit, and a base station power supply unit; the number of fixed node modules is m, and each fixed node module includes a fixed node power supply unit, a fixed node signal processing unit, a wireless communication unit, and a fixed node sensor unit;

[0012] m is less than n; n is greater than k; the terminal module includes a terminal calculation and control unit;

[0013] The wireless communication unit includes an antenna and a wireless communication chip, the fixed node sensor unit includes at least one pressure sensor, the fixed node signal processing unit includes a single chip microcomputer with a high-performance processor; the fixed node power supply unit includes a lithium battery with large battery capacity and light weight;

[0014] The array antenna unit in each single reference point positioning base station module includes an antenna and a radio frequency combiner; the number of antennas is not less than 4; the base station communication unit includes an antenna and a wireless communication chip; the base station signal processing unit includes a UWB positioning chip and a related development board; the base station power supply unit includes a battery with a large battery capacity;

[0015] The vehicle communication unit in each unmanned vehicle module includes an antenna and a wireless communication chip; the memory unit includes a memory; the vehicle positioning unit includes a UWB positioning chip and an antenna; the mobile unit includes at least two motors; the sensor unit includes but is not limited to an IMU, a light sensor, a temperature sensor, a sound sensor, a smoke sensor, a CO sensor, a combustible gas sensor, an infrared sensor, and a camera; the computing and control unit includes a single-chip microcomputer with multiple ports; the vehicle power supply unit includes a lithium battery with large battery capacity and light weight;

[0016] The connection relationship between the modules and units in the mine unmanned vehicle detection and position feedback system is as follows:

[0017] The vehicle positioning unit, vehicle communication unit, memory unit, mobile unit and sensor unit in each unmanned vehicle module are connected to the computing and control unit; in each single reference point positioning base station module, the array antenna unit is connected to the base station signal processing unit, and the base station signal processing unit is connected to the base station communication unit; the fixed node sensor unit in each fixed node module is connected to the fixed node signal processing unit, and the fixed node signal processing unit is connected to the wireless communication unit;

[0018] The terminal module maintains connection with the fixed node module or the unmanned vehicle module through wireless signals; each node establishes a multi-hop route to communicate with the terminal module through a self-organizing network formed between nodes; the i-th unmanned vehicle module maintains connection with the j-th single reference point positioning base station module by sending and receiving wireless signals through their respective communication units, and at the same time, the on-board positioning unit in the i-th unmanned vehicle module maintains connection with the array antenna unit in the j-th single reference point positioning base station module by sending UWB signals; wherein, the i-th unmanned vehicle module is located within the positioning range of the j-th single reference point positioning base station module, and 1<=i<=n, 1<=j<=k;

[0019] Specifically: the on-board power supply unit supplies power to each unit in the unmanned vehicle module, the two motors in the mobile unit are connected to the computing and control unit, the IMU, light sensor, temperature sensor, sound sensor, smoke sensor, CO sensor, combustible gas sensor, infrared sensor, and camera in the sensor unit are connected to the computing and control unit, the UWB positioning chip in the on-board positioning unit is connected to the computing and control unit, the wireless communication chip in the on-board communication unit is connected to the computing and control unit, and the memory in the memory unit is connected to the computing and control unit;

[0020] Single reference point positioning base station module: the base station power supply unit supplies power to each unit in the single reference point positioning base station module, multiple antennas in the array antenna unit are connected to the RF combiner, the RF combiner is connected to the base station signal processing unit, and the wireless communication chip in the base station communication unit is connected to the base station signal processing unit; Fixed node module: the fixed node power supply unit supplies power to each unit in the fixed node module, the pressure sensor is connected to the fixed node signal processing unit, and the wireless communication chip in the wireless communication unit is connected to the fixed node signal processing unit;

[0021] The functions of each module and unit in the mine unmanned vehicle detection and position feedback system are as follows:

[0022] 1. Drone module:

[0023] Computing and control unit: processes various digital and analog signals and sends control signals to each unit;

[0024] Sensor unit: detects environmental conditions in the mine and converts environmental information into digital or analog signals;

[0025] Vehicle positioning unit: sends out UWB signals to facilitate positioning operations;

[0026] On-board communication unit: transmits and receives wireless signals, and converts wireless signals into digital signals to achieve wireless communication with the single reference point positioning base station module, other unmanned vehicle modules and fixed node modules;

[0027] Mobile unit: receives PWM signals from the computing and control unit and drives two motors to rotate;

[0028] Memory unit: stores the time, speed and direction data of each movement of the car and caches the image data taken by the camera;

[0029] On-board power supply unit: provides power to each unit in the current unmanned vehicle module;

[0030] 2. Single reference point positioning base station module:

[0031] Base station signal processing unit: processes various digital signals and UWB signals, and sends control signals to each unit;

[0032] Array antenna unit: receives multipath UWB signals sent by the vehicle positioning unit in the unmanned vehicle module;

[0033] Base station communication unit: sends and receives wireless signals and converts them into digital signals to achieve communication with the unmanned vehicle module;

[0034] Base station power supply unit: provides power to other units;

[0035] 3. Fixed node module:

[0036] Fixed node signal processing unit: processes various digital and analog signals, and sends control signals to each unit; Fixed node sensor unit: collects environmental information of the mine wall and the surrounding environment, and converts it into digital or analog signals; Wireless communication unit: sends and receives wireless signals, and converts wireless signals into digital signals to achieve communication with the unmanned vehicle module and other fixed node modules; Fixed node power supply unit: supplies power to other units;

[0037] 4.Terminal module:

[0038] Terminal computing and control unit: processes digital signals from fixed nodes and displays environmental information to the outside world; sends control signals to nodes to achieve control of all modules.

[0039] The workflow of the unmanned vehicle system is as follows:

[0040] Unmanned vehicle module:

[0041] Step 1: The vehicle power module supplies power, and the computing and control unit initializes the input and output settings of each port connected to other units;

[0042] Step 2: The vehicle communication unit starts to send and receive wireless signals;

[0043] Step 3: The calculation and control unit determines whether the communication unit receives a wireless signal sent from a fixed node or a mobile node;

[0044] Among them, fixed nodes refer to fixed node modules; mobile nodes refer to other unmanned vehicle modules;

[0045] 3.A: If the calculation and control unit determines that the communication unit has not received the wireless signal, return to step 2;

[0046] 3.B: If the calculation and control unit determines that the communication unit receives the wireless signal, proceed to step 4;

[0047] Step 4: The calculation and control unit determines whether the wireless signal is a signal for controlling the unmanned vehicle module;

[0048] 4.A: If the computing and control unit determines that the wireless signal is not a signal for controlling the unmanned vehicle, it further determines whether the wireless signal is a danger warning signal; if it is not a danger warning message, jump to step 6, otherwise, the computing and control unit sends a danger warning digital signal to the on-board communication unit, and the on-board communication unit converts the digital signal into a wireless signal and broadcasts it to the surrounding nodes; then the computing and control unit reads all the previous mobile operation data of the unmanned vehicle stored in the memory module, and based on this data, controls the mobile unit to drive the unmanned vehicle back to the starting point of the mine; after execution, return to step 2 in the unmanned vehicle module;

[0049] 4.B: If the calculation and control unit determines that the wireless signal is a signal for controlling the unmanned vehicle, proceed to step 5;

[0050] Step 5: The calculation and control unit determines the type of wireless signal and performs the following operations:

[0051] 5.A: If the wireless signal is a signal returned by the terminal to control the unmanned vehicle, the calculation and control unit reads all the previous movement operation data of the unmanned vehicle stored in the memory module, and controls the mobile unit to drive the unmanned vehicle back to the starting point of the mine based on these data; after the execution is completed, return to step 2;

[0052] 5.B: If the wireless signal is a signal for collecting sensor data controlled by the terminal, the computing and control unit reads the analog or digital signals of each sensor and converts the analog signals into appropriate digital signals; then, the computing and control unit adds information about the signal transmission destination at the beginning of the sensor digital signal, and specifies that the signal destination is the terminal; then the computing and control unit transmits the processed sensor signal to the vehicle communication unit, and the communication unit transmits the sensor data signal in reverse to the upstream node according to the route of the received wireless signal; after the execution is completed, return to step 2.

[0053] 5.C: If the wireless signal is a signal for the terminal to control the movement of the unmanned vehicle, the computing and control unit transmits a corresponding PWM signal to the mobile unit according to the control signal sent by the terminal. After receiving the PWM signal, the two motors in the mobile unit rotate in the specified direction and speed respectively, driving the unmanned vehicle to rotate, move forward, and move backward. At the same time, the computing and control unit stores the direction, speed, and time of the unmanned vehicle's movement in the memory unit. After the execution is completed, return to step 2;

[0054] 5.D: If the wireless signal is a signal for obtaining location information controlled by the terminal, the computing and control unit controls the vehicle-mounted positioning unit to send a UWB signal to the single reference point positioning module in the area according to the control signal sent by the terminal, and the vehicle-mounted communication unit sends a wireless signal to the base station communication unit requesting to establish a connection; then, the computing and control unit determines whether the wireless signal about the location of the unmanned vehicle module sent from the single reference point positioning base station module is received; if not, continue to determine whether the wireless signal about the location of the unmanned vehicle module sent from the single reference point positioning base station module is received; if the wireless signal about the location of the unmanned vehicle module sent from the single reference point positioning base station module is received, then the computing and control unit adds information about the signal transmission destination at the beginning of the digital signal about the location information, specifies the signal destination as the terminal, and sends it to the vehicle-mounted communication unit, and then the vehicle-mounted communication unit transmits the location signal in reverse to the upstream node according to the route of the received wireless signal; after execution, return to step 2;

[0055] Step 6: After the computing and control unit determines that the wireless signal is not a signal for controlling the unmanned vehicle module, the computing and control unit further determines whether the destination of the wireless signal is a terminal; if the destination is a terminal, the on-board communication unit transmits the signal in reverse to the upstream node according to the established route; if the destination is not a terminal, the on-board communication unit transmits a request to the downstream node to establish a route to the target node; after execution, return to step 2.

[0056] The workflow of the single reference point positioning base station module is as follows:

[0057] Step 1: The base station power supply unit supplies power, and the base station signal processing unit initializes the input and output settings of the ports connected to each unit, and the counter counts to 0;

[0058] Step 2: The array antenna unit starts to receive the UWB signal;

[0059] Step 3: The base station signal processing unit determines whether a signal is transmitted from the array antenna unit and performs the following operations:

[0060] 3.A: If a signal is transmitted from the array antenna unit, the counter in the base station signal processing unit is incremented by 1; and it is determined whether the counter reaches 4; if it reaches 4, the counter is reset and step 4 is performed; if it does not reach 4, the counter is returned to step 2;

[0061] 3.B: If there is no signal coming from the array antenna unit, return to step 2;

[0062] Step 4: The base station signal processing unit calculates the position of the unmanned vehicle module that sends the UWB signal based on the TDOA algorithm and the time difference between the UWB signals from the four antennas;

[0063] Step 5: The base station communication unit establishes a connection according to the signal for establishing a connection sent by the unmanned vehicle module;

[0064] Step 6: The base station signal processing unit processes the location signal and transmits it to the base station communication unit. The base station communication unit converts the location signal into a wireless signal and sends it to the unmanned vehicle module. After executing the operation, return to step 2.

[0065] Fixed node module workflow:

[0066] Step 1: The fixed node power supply unit supplies power, and the fixed node signal processing unit initializes the input and output settings of the port connected to the sensor;

[0067] Step 2: The wireless communication unit starts to send and receive wireless signals;

[0068] Step 3: The fixed node signal processing unit determines whether the wireless communication unit receives a wireless signal sent from other fixed nodes or mobile nodes. If no wireless signal is received from other fixed nodes or mobile nodes, the process returns to step 2; otherwise, if a wireless signal is received from other fixed nodes or mobile nodes, the process proceeds to step 4.

[0069] Step 4: The fixed node signal processing unit determines whether the wireless signal is a signal for controlling the node to read sensor data; and performs the following operations:

[0070] 4.A: If the wireless signal is not a signal for controlling the node to read sensor data, the fixed node signal processing unit further determines whether the destination of the wireless signal is a terminal; if the destination of the wireless signal is a terminal, the fixed node signal processing unit controls the wireless communication unit to transmit the wireless signal to the upstream node according to the established route; if the destination of the wireless signal is not a terminal, the fixed node signal processing unit controls the wireless communication unit to transmit a request to establish a route to the target node to the downstream node; after completing the operation, return to step 2;

[0071] 4.B: If the wireless signal is a signal for controlling the node to read sensor data, the fixed node signal processing unit reads the digital or analog signal of the pressure sensor and converts the analog signal into a digital signal; after the operation is completed, proceed to step 5;

[0072] Step 5: The fixed node signal processing unit determines whether the parameter about the pressure size detected by the pressure sensor exceeds the dangerous value. If so, the fixed node signal processing module sends a dangerous warning digital signal to the wireless communication unit. The wireless communication unit converts the digital signal into a wireless signal and broadcasts it to the surrounding nodes. After the operation is completed, it returns to step 2 of the fixed node module workflow; if the parameter does not exceed the dangerous value, proceed to step 6;

[0073] Step 6: The fixed node signal processing unit adds information about the signal transmission destination at the beginning of the digital signal about the sensor data, specifies the signal destination as the terminal, and then transmits the digital signal to the wireless communication unit. The wireless communication unit converts the digital signal into a wireless signal and then transmits the sensor data signal in reverse to the upstream node according to the route of the received wireless signal. After completing the operation, return to step 2.

[0074] Beneficial Effects

[0075] The mine unmanned vehicle detection and position feedback system based on UWB technology proposed in the present invention has the following beneficial effects compared with the detection system currently used in mines:

[0076] 1. The position feedback system can be automated and remotely controlled. Mine workers can detect the environmental conditions inside the mine before entering the mine. Mine workers can understand the possibility of danger in the mine, report on dangerous environmental conditions, and transmit back environmental parameters and the location of the unmanned vehicle, which is conducive to protecting the lives of mine workers;

[0077] 2. The system locates the unmanned vehicle through a single reference point positioning base station based on UWB technology: on the one hand, it draws on the advantages of UWB positioning technology such as high precision, low energy consumption, and strong anti-interference performance; on the other hand, for the unmanned vehicle module, only a single reference point positioning base station module is needed to locate the unmanned vehicle, which reduces the difficulty of deployment;

[0078] 3. The modules in the system communicate with each other through low-power wireless modules and communicate through a self-organizing network composed of wireless communication units of each node, without the need to assemble a base station; therefore, the system is easier to implement in mines with complex environments;

[0079] 4. The system is very user-friendly. Each module keeps in touch with the user through wireless signals. The user only needs to operate on the terminal to understand the environmental conditions in the mine. The user can also perform directional control on each module in the system. BRIEF DESCRIPTION OF THE DRAWINGS

[0080] Figure 1 This is a schematic diagram of the composition and connection of a mine unmanned vehicle detection and position feedback system based on UWB technology of the present invention;

[0081] Figure 2 This is a working flow chart of an unmanned vehicle module of Example 1 of a mine unmanned vehicle detection and position feedback system based on UWB technology of the present invention;

[0082] Figure 3 This is a working diagram of a single reference point positioning base station module of Example 1 of a mine unmanned vehicle detection and position feedback system based on UWB technology of the present invention;

[0083] Figure 4 This is a working diagram of a fixed node module of Example 1 of a mine unmanned vehicle detection and position feedback system based on UWB technology of the present invention;

[0084] Figure 5 This is a schematic diagram of the system composition and connection of Embodiment 2 of a mine unmanned vehicle detection and position feedback system based on UWB technology of the present invention;

[0085] Figure 6 It is a schematic diagram of the system composition and connection of different types of unmanned vehicle modules of Example 2 of a mine unmanned vehicle detection and position feedback system based on UWB technology of the present invention;

[0086] Figure 7 This is a working flow chart of the unmanned vehicle module of Example 2 of a mine unmanned vehicle detection and position feedback system based on UWB technology of the present invention;

[0087] Figure 8This is a working flow chart of a single reference point positioning base station module of Example 2 of a mine unmanned vehicle detection and position feedback system based on UWB technology of the present invention;

[0088] Fig. 9 It is a working flow chart of a fixed node module of Example 2 of a mine unmanned vehicle detection and position feedback system based on UWB technology of the present invention. DETAILED DESCRIPTION

[0089] The specific implementation of the unmanned vehicle detection and position feedback system of the present invention is described in detail below with reference to the accompanying drawings and specific embodiments.

[0090] Example 1

[0091] This embodiment describes the application of the mine unmanned vehicle detection and position feedback system based on UWB technology in a small mine (module and unit composition as shown in FIG. Figure 1 Specific implementation shown).

[0092] Considering that the underground environment of small and medium-sized mines is not complicated, the distance between vehicles is short, the detection time of each vehicle is short, but the amount of information that each vehicle needs to transmit is large. Therefore, in terms of communication mode, it is proposed to consider using a high-efficiency WiFi communication mode. Therefore, specifically in this embodiment, the wireless communication unit is replaced by a fixed node WiFi communication unit, the base station communication unit is replaced by a base station WiFi communication unit; and the vehicle-mounted communication unit is replaced by a vehicle-mounted WiFi communication unit.

[0093] In specific implementation, the unmanned vehicle module includes an on-board WiFi communication unit, a memory unit, an on-board power supply unit, an on-board positioning unit, a computing and control unit, a mobile unit and a sensor unit; the single reference point positioning base station module includes a base station signal processing unit, a base station WiFi communication unit, an array antenna unit and a base station power supply unit; the fixed node module includes a fixed node signal processing unit, a fixed node WiFi communication unit, a pressure sensor and a fixed node power supply unit; the terminal module includes a terminal computing and control unit.

[0094] In specific implementation, the terminal computing and control unit in the terminal module includes a smartphone and a computer master control terminal. The smartphone APP is used by underground mine workers to communicate with the unmanned vehicle system. Mine workers can obtain the location of the unmanned vehicle system and the environmental information of its location in the window of the APP interface; the computer master control terminal system software is used by ground monitoring personnel, connected to a fixed node through a data cable or connected to a wireless network, communicates with the unmanned vehicle system, and controls the unmanned vehicle system by clicking different control buttons. The computer master control terminal system software is more complex than the smartphone APP and can comprehensively control each module of the unmanned vehicle system.

[0095] In the specific implementation, the environment of small and medium-sized mines is not very complex, and the area at the bottom of the mine is not large. The number of unmanned vehicles is designed according to the results of the detection and feedback of the environmental information at each location of the mine. When the unmanned vehicle system is in operation, the number of each module should be multiple, and the specific number should be adjusted accordingly according to the geographical environment of the mine. After setting the number of each module, the mine can be further divided into regions. On the mine wall with a decreasing height, a fixed node module is installed every 30 meters or so to realize the detection of the mine wall pressure and the transmission of WiFi signals; the area is honeycombed in the relatively flat area at the bottom of the mine, and the area of ​​each block is about 2,500 square meters. In each block, there is an unmanned vehicle module and a single reference point positioning base station module. The single reference point positioning base station module should be installed in the center of the block, which is conducive to the positioning of the unmanned vehicle module on the one hand, and on the other hand, it reduces the interference of UWB signals from other blocks and improves the positioning accuracy. At the same time, in the normal working mode, the activity range of the unmanned vehicle module is only in this block, which is conducive to the uniform distribution of the unmanned vehicle module.

[0096] After the mine is divided into regions, the number of unmanned vehicle modules and single reference point positioning base station modules is 10. Each unmanned vehicle module is connected to the corresponding single reference point positioning base station module, and both work in the same block. The number of fixed node modules is m=8, and the number of terminal modules is 3. The terminal modules are used by underground mine workers.

[0097] In this embodiment, WiFi signals are used for transmission. In specific implementation, if the amount of data collected is small, the underground wireless communication area is increased, and the terrain detection task is intensified, the detection time of a single unmanned vehicle is short. The fixed node WiFi communication unit, the base station WiFi communication unit, and the vehicle-mounted WiFi communication unit can be collectively replaced with a zigbee wireless transmission module or a Bluetooth transmission module, and the information transmission mode is also modified accordingly.

[0098] Among them, the number of calculation and control units is 1. In the specific implementation, MSP432Launchpad can be used. MSP432Lauchpad has 100 pins, about 80 of which can be used for scheduling. In addition to the ordinary GPIO mode, each pin has many spare functions, such as ADC, UART, etc. It can be used as a sensor output interface and an interface for two-way communication with DWM1000DISCOVERY and ESP8266. At the same time, Launchpad can connect motors, infrared ranging sensors, and collision switches, providing a good hardware foundation for tracking and obstacle avoidance. MSP432Lauchpad comes with a hardware debugger, and obstacle avoidance programs, WiFi signal transceiver programs, positioning calculation programs, and sensor signal acquisition programs are all running on it.

[0099] The vehicle-mounted positioning unit includes 1 antenna and 1 DWM1000DISCOVERY. In the indoor positioning system, DWM1000DISCOVERY is a very small hardware module with a positioning accuracy of about 10 cm. In specific implementation, the IMU unit is an onboard inertial navigation sensor (accelerometer, gyroscope, magnetometer and barometer) that can further improve the positioning accuracy.

[0100] The vehicle-mounted WiFi communication unit includes an ESP8266-01s, which can realize transparent transmission between this MSP432 and other MSP432 through the TCP protocol. At the same time, the area of ​​ESP8266-01s is about 4 square centimeters.

[0101] The mobile unit includes two motors, which can work at different speeds or directions; the sensor unit includes one photosensitive sensor, one temperature sensor, one sound sensor, one smoke sensor, one CO sensor, one combustible gas sensor, three infrared sensors and one camera in specific implementation. The type and number of sensors can be adjusted according to the environmental characteristics of the specific mine. Due to the limited power capacity in the unmanned vehicle module, the number of each sensor in this embodiment is mostly one.

[0102] The memory unit includes 1 memory; the on-board power supply unit includes 2 mobile power supplies; each single reference point positioning base station module includes 1 base station signal processing unit, 1 array antenna unit, 1 base station WiFi communication unit and 1 base station power supply unit; the base station signal processing unit includes 1 DWM1000DISCOVERY.

[0103] The array antenna unit includes 4 antennas and 1 radio frequency combiner; the base station WiFi communication unit includes 1 ESP8266-01s; and the base station power supply unit includes 1 mobile power supply.

[0104] Each fixed node module includes a fixed node signal processing unit, a fixed node WiFi communication unit, a pressure sensor and a fixed node power supply unit. Among them, the fixed node signal processing unit includes a single-chip microcomputer development board. The fixed node WiFi communication unit includes an ESP8266-01s. The fixed node power supply unit includes three mobile power supplies.

[0105] The connection relationship between the modules, units and components in the above-mentioned drone system is as follows:

[0106] The unmanned vehicle module and the single reference point positioning base station module communicate through their respective WiFi communication units and positioning units; different unmanned vehicle modules communicate through their respective on-board WiFi communication units; the unmanned vehicle module and the fixed node module communicate through their respective WiFi communication units; different fixed node modules communicate through their respective fixed node WiFi communication units; the fixed node module is connected to the terminal module via WiFi or a data cable.

[0107] Specifically: in the unmanned vehicle module: the vehicle positioning unit and the vehicle WiFi communication unit are connected to the UART port of the computing and control unit through the serial port, the sensor unit, the mobile unit and the memory unit are connected to the Digital port of the computing and control unit through the serial port, and the vehicle power supply unit is connected to the other units through the power line; in the single reference point positioning base station module: the base station WiFi communication unit is connected to the USART port of the base station signal processing unit through the serial port, the array antenna unit is connected to the base station signal processing unit, and the base station power supply unit is connected to the other units through the power line. In the fixed node module: the pressure sensor is connected to the Digital port of the fixed node signal processing unit through the serial port, the fixed node WiFi communication unit is connected to the UART port of the fixed node signal processing unit through the serial port, and the fixed node power supply unit is connected to the other units through the power line.

[0108] Figure 2 , Figure 3 , Figure 4 These are the workflows of the unmanned vehicle module, the single reference point positioning base station module and the fixed node module of the unmanned vehicle system. Figure 2 It can be seen that after the working mode is turned on, the unmanned vehicle module is first initialized, and then the unmanned vehicle module enters the following cycle:

[0109] The vehicle-mounted WiFi communication module starts to send and receive WiFi signals. When the vehicle-mounted WiFi communication module receives the WiFi signal, the calculation and control unit determines whether the signal is a signal for controlling the unmanned vehicle module and performs the following operations:

[0110] A. If so, the signal type is further determined. When the signal type is a signal for controlling the return of the unmanned vehicle, the computing and control unit starts to read the historical data of the movement of the unmanned vehicle module stored in the memory unit, and performs tracking and return based on this data; when the signal type is a signal for controlling the collection of environmental information, the computing and control unit collects 1000 data for each sensor unit at a frequency of 48MHz, and after processing, transmits them to the adjacent nodes close to the terminal through the on-board WiFi communication unit; if it is a signal for controlling movement, the computing and control unit controls the mobile unit to drive the unmanned vehicle module to move according to this signal, and the data of the movement of the unmanned vehicle will be stored in the memory unit at each movement; if it is a signal for controlling positioning, the on-board positioning unit sends a UWB signal to the single reference point positioning base station module in the block, and the computing and control unit starts to wait for the reception of the position signal sent by the single reference point positioning base station module for positioning the unmanned vehicle module. After receiving the signal, the computing and control unit transmits the processed signal to the adjacent nodes close to the terminal through the on-board WiFi communication unit.

[0111] B. If not, determine whether the signal is a danger warning signal: If so, the computing and control unit sends a danger warning digital signal to the on-board WiFi communication unit, and the on-board WiFi communication unit converts the digital signal into a WiFi signal and broadcasts it to the surrounding nodes; if not, it means that this signal needs to continue to be transmitted to a distant place. After the computing and control unit analyzes the end point of the signal, it will retransmit the signal to the adjacent node in the specified direction to achieve the transmission effect.

[0112] The above is a cyclic workflow.

[0113] from Figure 3 It can be seen that the single reference point positioning base station module is initialized first, and then the single reference point positioning base station module enters the loop:

[0114] The array antenna unit starts to receive UWB signals. When the array antenna unit receives more than 4 UWB signals cumulatively, it selects 4 UWB multipath signals with strong RSS values. The base station signal processing unit calculates the position of the signal source based on the time difference between the arrival of the four UWB multipath signals and the TDOA algorithm, and determines whether this position is within the block area: if this position is within the block area, it means that the signal source is the unmanned vehicle module within this block, and the base station signal processing unit transmits this position signal to the unmanned vehicle module where the signal source is located via the base station WiFi communication unit; if this position is not within the block area, it means that the UWB signal comes from other block areas, and the single reference point positioning base station module does not transmit this position signal.

[0115] The above is a cyclic workflow.

[0116] from Figure 4It can be seen that the fixed node module is initialized first and then enters the loop:

[0117] The fixed node WiFi unit starts to receive WiFi signals. After receiving the signal, the fixed node signal processing unit starts to determine whether the signal is a signal to control the node, and performs the following operations:

[0118] A. If so, it means that the terminal controls this node to read the signal of the pressure sensor data. The fixed node signal processing unit collects the data of 1,000 pressure sensors, takes the average of these data, and then determines whether the value exceeds the set danger parameter. If it exceeds, the fixed node signal processing module sends a danger warning digital signal to the fixed node WiFi communication unit, and the fixed node WiFi communication unit converts the danger warning digital signal into a WiFi signal and broadcasts it to the surrounding nodes; if it does not exceed, the signal carrying the sensor data is transmitted to the adjacent nodes close to the terminal via the fixed node WiFi communication unit.

[0119] B. If not, it means that the signal needs to be transmitted further away. After the fixed node signal processing unit analyzes the end point of the signal, it will retransmit the signal to the adjacent node in the specified direction to achieve the transmission purpose.

[0120] The above is a cyclic workflow. According to the above structure and flowchart, the present application is implemented in a specific application scenario, which can realize environmental condition detection and position feedback of small and medium-sized mines, and provide early warning of dangerous conditions.

[0121] Example 2

[0122] This embodiment describes the specific implementation of the mine unmanned vehicle detection and position feedback system based on UWB technology described in the present invention in a large-scale mine with extremely deep depths.

[0123] In large mines with extremely deep depths, a large number of mobile nodes (unmanned vehicle modules) and fixed nodes (fixed node modules) are required to realize the detection of environmental information and position feedback of the entire mine. In Example 1, there is only one signal transmission channel. When a large amount of data from the node is transmitted, high requirements are placed on the transmission capacity of each node. Therefore, in Example 2, the unmanned vehicle system establishes a self-organizing network, thereby increasing the number of signal transmission channels and making signal transmission more flexible. Each unmanned vehicle module can move freely without being restricted by the region. On the other hand, Example 2 designs different types of unmanned vehicle modules, each of which is responsible for the detection of an environmental parameter, which reduces the computing power requirements of the computing and control units in the unmanned vehicle modules, and is also conducive to the separate transmission of different types of environmental parameters.

[0124] like Figure 5As shown in the figure, the composition of the unmanned vehicle system in a large mine. As can be seen from the figure, the unmanned vehicle system includes an unmanned vehicle module, a single reference point positioning base station module, a fixed node module and a terminal module. The unmanned vehicle module includes a computing and control unit, a vehicle-mounted positioning unit, a vehicle-mounted communication unit, a memory unit, a mobile unit, a sensor unit and a vehicle-mounted power supply unit; the single reference point positioning base station module includes a base station signal processing unit, a base station communication unit, an array antenna unit and a base station power supply unit; the fixed node module includes a fixed node signal processing unit, a wireless communication unit, a pressure sensor and a fixed node power supply unit; the terminal module includes a terminal computing and control unit.

[0125] In specific implementation, the terminal computing and control unit of the terminal module is a smart phone and a computer master control terminal. The smart phone is installed with an unmanned vehicle system control APP, which communicates with the unmanned vehicle system through a wireless network. Mine workers can control the unmanned vehicle system by clicking different control buttons, and can also obtain the location of the unmanned vehicle system and the environmental information of the location in the window of the APP interface; the computer is installed with a master control system software, which can communicate with the unmanned vehicle system by connecting to a fixed node or a wireless network through a data cable. The master control system software on the computer is more complex than the mobile phone APP and can control each module of the unmanned vehicle system more comprehensively. In specific implementation, the APP installed on the smart phone is mainly used by underground mine workers, and the computer master control system software is mainly used by ground monitoring personnel.

[0126] In specific implementation, due to the complex environment in large mines and the large area at the bottom of the mine, one or one unmanned vehicle cannot effectively detect the environmental information of each location in the mine. Therefore, when we design the unmanned vehicle system, the number of each module should be multiple, and the types of unmanned vehicle modules should be multiple. The specific number and type should be adjusted accordingly according to the geographical environment of the mine. In specific installation, on the wall of the mine with a height drop, a circle of fixed node modules is installed on a plane every 30 meters. The number of fixed nodes in each plane depends on the diameter of the hole on this plane, so as to realize the detection of the pressure of the mine wall and the transmission of wireless signals; the area of ​​the relatively flat area at the bottom of the mine is divided into honeycombs, and the area of ​​each block is about 2,500 square meters. In each block, there is a single reference point positioning base station module, which should be installed in the center of the block. On the one hand, it is conducive to the positioning of the unmanned vehicle module, and on the other hand, it reduces the interference of UWB signals from other blocks and improves the positioning accuracy. At the same time, different types of unmanned vehicle modules are designed according to the environmental conditions of the mine, and the number of each type of unmanned vehicle module is set according to the size of the flat area.

[0127] Among them, the number of unmanned vehicle modules is n, and n>20 in the specific implementation; the number of single reference point positioning base stations is k, denoted as the number of single reference point positioning base stations 1, the number of single reference point positioning base stations 2,…the number of single reference point positioning base stations k; the number of fixed node modules is m, denoted as fixed node module 1, fixed node module 2,…, fixed node module m; the number of terminal modules is t, denoted as terminal module 1, terminal module 2,…, terminal module t.

[0128] Each unmanned vehicle module includes a computing and control unit, a vehicle positioning unit, a vehicle communication unit, a memory unit, a mobile unit, a sensor unit and a vehicle power supply unit.

[0129] The number of calculation and control units is 1. In the specific implementation, MSP432Launchpad can be used. MSP432Lauchpad has 100 pins, about 80 of which can be used for scheduling. In addition to the common GPIO mode, each pin has many spare functions, such as ADC, UART, etc. It can be used as a sensor output interface and an interface for two-way communication with DWM1000DISCOVERY and ESP8266. At the same time, Launchpad can connect motors, infrared ranging sensors, and collision switches, providing a good hardware foundation for tracking and obstacle avoidance. MSP432Lauchpad comes with a hardware debugger, and obstacle avoidance programs, wireless signal transceiver programs, positioning operation programs, and sensor signal acquisition programs are all running on it.

[0130] The vehicle-mounted positioning unit includes 1 antenna and 1 DWM1000DISCOVERY. In the indoor positioning system, DWM1000DISCOVERY is a very small hardware module with a positioning accuracy of about 10 cm. The positioning accuracy can be further improved by relying on the onboard inertial navigation sensor (accelerometer, gyroscope, magnetometer and barometer).

[0131] The vehicle communication unit includes an ESP8266-01s, which can realize transparent transmission between this MSP432 and other MSP432 through TCP protocol. At the same time, the area of ​​ESP8266-01s is about 4 square centimeters.

[0132] The mobile unit includes two motors, which can work at different speeds or directions.

[0133] Different types of unmanned vehicle modules such as Figure 6As shown. Different types of unmanned vehicle modules contain different sensor units. The sensor unit in the unmanned vehicle module (gas detection) includes 1 gas sensor, 3 infrared sensors, and 1 camera; the sensor unit in the unmanned vehicle module (smoke detection) includes 1 smoke sensor, 3 infrared sensors, and 1 camera; the sensor unit in the unmanned vehicle module (water seepage detection) includes 1 water leakage sensor, 3 infrared sensors, and 1 camera; the sensor unit in the unmanned vehicle module (soil detection) includes 1 soil composition sensor, 3 infrared sensors, and 1 camera; the sensor unit in the unmanned vehicle module (light detection) includes 1 photosensitive sensor, 3 infrared sensors, and 1 camera; the sensor unit in the unmanned vehicle module (toxic gas detection) includes 1 toxic gas sensor, 3 infrared sensors, and 1 camera.

[0134] The memory unit includes 1 memory; the vehicle power supply unit includes 2 mobile power supplies. Each single reference point positioning base station module includes 1 base station signal processing unit, 1 array antenna unit, 1 base station communication unit and 1 base station power supply unit. The base station signal processing unit includes 1 DWM1000DISCOVERY. The array antenna unit includes 4 antennas and 1 RF combiner. The base station communication unit includes 1 ESP8266-01s.

[0135] The base station power supply unit includes a mobile power supply. Each fixed node module includes a fixed node signal processing unit, a wireless communication unit, a pressure sensor and a fixed node power supply unit; wherein the fixed node signal processing unit includes a single-chip microcomputer development board.

[0136] The wireless communication unit includes 1 ESP8266-01s. The fixed node power supply unit includes 3 mobile power supplies.

[0137] The connection relationship between the modules, units and components in the above-mentioned drone system is as follows:

[0138] The vehicle positioning unit, vehicle communication unit, memory unit, mobile unit and sensor unit in each unmanned vehicle module are connected to the computing and control unit; in each single reference point positioning base station module, the array antenna unit is connected to the base station signal processing unit, and the base station signal processing unit is connected to the base station communication unit; the fixed node sensor unit in each fixed node module is connected to the fixed node signal processing unit, and the fixed node signal processing unit is connected to the wireless communication unit;

[0139] The terminal module maintains connection with each node (fixed node module or unmanned vehicle module) through wireless signals. Each node can establish a multi-hop route to communicate with the terminal module through the self-organizing network formed between nodes; the i-th (1<=i<=n) unmanned vehicle module and the j-th (1<=j<=k) single reference point positioning base station module are connected by sending and receiving wireless signals through their respective communication units, and at the same time, the vehicle positioning unit in the i-th (1<=i<=n) unmanned vehicle module is connected to the array antenna unit in the j-th (1<=j<=k) single reference point positioning base station module by sending UWB signals. The i-th unmanned vehicle module is located within the positioning range of the j-th single reference point positioning base station module.

[0140] Specifically: in the unmanned vehicle module: the vehicle positioning unit and the vehicle communication unit are connected to the UART port of the computing and control unit through the serial port, the sensor unit, the mobile unit and the memory unit are connected to the Digital port of the computing and control unit through the serial port, and the vehicle power supply unit is connected to the other units through the power line; in the single reference point positioning base station module: the base station communication unit is connected to the USART port of the base station signal processing unit through the serial port, the array antenna unit is connected to the base station signal processing unit, and the base station power supply unit is connected to the other units through the power line. In the fixed node module: the pressure sensor is connected to the Digital port of the fixed node signal processing unit through the serial port, the wireless communication unit is connected to the UART port of the fixed node signal processing unit through the serial port, and the fixed node power supply unit is connected to the other units through the power line.

[0141] Figure 7 , Figure 8 , Fig. 9 These are the workflows of the unmanned vehicle module, the single reference point positioning base station module and the fixed node module of the unmanned vehicle system. The specific workflow is the same as that in the invention content.

[0142] The workflow of the unmanned vehicle system is as follows:

[0143] Drone Module:

[0144] Step 1: The vehicle power module supplies power, and the computing and control unit initializes the input and output settings of each port connected to other units.

[0145] Step 2: The vehicle communication unit starts to send and receive wireless signals.

[0146] Step 3: The calculation and control unit determines whether the vehicle communication unit receives a wireless signal sent from a fixed node or a mobile node (other unmanned vehicle modules).

[0147] 3.A: If the calculation and control unit determines that the vehicle communication unit has not received the wireless signal, return to step 2.

[0148] 3.B: If the calculation and control unit determines that the vehicle communication unit receives the wireless signal, proceed to step 4.

[0149] Step 4: The calculation and control unit further determines whether the wireless signal is a signal for controlling the unmanned vehicle module.

[0150] 4.A: If the computing and control unit determines that the wireless signal is not a signal to control the unmanned vehicle, it further determines whether the wireless signal is a danger warning signal. If it is not a danger warning message, jump to step 6. Otherwise, the computing and control unit sends a danger warning digital signal to the on-board communication unit, and the on-board communication unit converts the digital signal into a wireless signal and broadcasts it to the surrounding nodes. Then the computing and control unit reads all the previous mobile operation data of the unmanned vehicle stored in the memory module, and based on this data, controls the mobile unit to drive the unmanned vehicle back to the starting point of the mine. After execution, return to step 2 in the unmanned vehicle module.

[0151] 4.B: If the calculation and control unit determines that the wireless signal is a signal for controlling the unmanned vehicle, proceed to step 5.

[0152] Step 5: The calculation and control unit determines the type of wireless signal and performs the following operations:

[0153] 5.A: If the wireless signal is a signal returned by the terminal to control the unmanned vehicle, the calculation and control unit reads all the previous movement operation data of the unmanned vehicle stored in the memory module, and controls the mobile unit to drive the unmanned vehicle back to the starting point of the mine based on these data. After the execution is completed, return to step 2.

[0154] 5.B: If the wireless signal is a signal for collecting sensor data controlled by the terminal, the computing and control unit reads the analog or digital signals of each sensor and converts the analog signals into appropriate digital signals. After that, the computing and control unit adds information about the signal transmission destination at the beginning of the sensor digital signal, and specifies that the signal destination is the terminal. The computing and control unit then transmits the processed sensor signal to the on-board communication unit, and the on-board communication unit transmits the sensor data signal in reverse to the upstream node according to the route of the received wireless signal. After execution, return to step 2.

[0155] 5.C: If the wireless signal is a signal from the terminal to control the movement of the unmanned vehicle, the computing and control unit transmits the corresponding PWM signal to the mobile unit according to the control signal sent by the terminal. After receiving the PWM signal, the two motors in the mobile unit rotate in the specified direction and speed respectively, driving the unmanned vehicle to rotate, move forward, move backward, etc. At the same time, the computing and control unit stores the direction, speed, and time of the unmanned vehicle's movement in the memory unit. After execution, return to step 2.

[0156] 5.D: If the wireless signal is a signal for obtaining location information controlled by the terminal, the computing and control unit controls the vehicle-mounted positioning unit to send a UWB signal to the single reference point positioning module in the area according to the control signal sent by the terminal, and the vehicle-mounted communication unit sends a wireless signal to the base station communication unit requesting to establish a connection. Then, the computing and control unit determines whether the wireless signal about the location of the unmanned vehicle module is received from the single reference point positioning base station module. If not, continue to judge and wait. If a wireless signal about the location of the unmanned vehicle module is received from the single reference point positioning base station module, the computing and control unit then adds information about the signal transmission destination at the beginning of the digital signal about the location information, specifies the signal destination as the terminal, and then sends the signal to the vehicle-mounted communication unit, and then the vehicle-mounted communication unit transmits the location signal in reverse to the upstream node according to the route of the received wireless signal. After execution, return to step 2.

[0157] Step 6: After the computing and control unit determines that the wireless signal is not a signal for controlling the unmanned vehicle module, the computing and control unit further determines whether the destination of the wireless signal is a terminal. If the destination is a terminal, the on-board communication unit transmits the signal in reverse to the upstream node according to the established route; if the destination is not a terminal, the on-board communication unit transmits a request to establish a route to the target node to the downstream node. After the execution is completed, return to step 2.

[0158] Single reference point positioning base station module workflow:

[0159] Step 1: The base station power supply unit supplies power, the base station signal processing unit initializes the input and output settings of the ports connected to each unit, and the counter counts to 0.

[0160] Step 2: The array antenna unit starts receiving the UWB signal.

[0161] Step 3: The base station signal processing unit determines whether a signal is transmitted from the array antenna unit and performs the following operations:

[0162] 3.A: If there is a signal coming from the array antenna unit, the counter in the base station signal processing unit is incremented by 1. And it is determined whether the counter reaches 4. If it reaches 4, the counter is reset and step 4 is performed; if it does not reach 4, it returns to step 2.

[0163] 3.B: If there is no signal coming from the array antenna unit, return to step 2.

[0164] Step 4: The base station signal processing unit calculates the position of the unmanned vehicle module that sends the UWB signal based on the TDOA algorithm and the time difference between the UWB signals from the four antennas.

[0165] Step 5: The base station communication unit establishes a connection according to the connection establishment signal sent by the unmanned vehicle module.

[0166] Step 6: The base station signal processing unit processes the location signal and transmits it to the base station communication unit, which converts the location signal into a wireless signal and sends it to the unmanned vehicle module. After executing the operation, return to step 2.

[0167] Fixed node module workflow:

[0168] Step 1: The fixed node power supply unit supplies power, and the fixed node signal processing unit initializes the input and output settings of the port connected to the sensor;

[0169] Step 2: The wireless communication unit sends and receives wireless signals;

[0170] Step 3: The fixed node signal processing unit determines whether the wireless communication unit receives wireless signals sent from other fixed nodes or mobile nodes. If no wireless signals are received from other fixed nodes or mobile nodes, return to step 2; otherwise, if wireless signals are received from other fixed nodes or mobile nodes, proceed to step 4.

[0171] Step 4: The fixed node signal processing unit determines whether the wireless signal is a signal for controlling the node to read sensor data. And performs the following operations:

[0172] 4.A: If the wireless signal is not a signal for controlling the node to read sensor data, the fixed node signal processing unit further determines whether the destination of the wireless signal is a terminal. If the destination of the wireless signal is a terminal, the fixed node signal processing unit controls the wireless communication unit to transmit the signal in reverse to the upstream node according to the established route; if the destination of the wireless signal is not a terminal, the fixed node signal processing unit controls the wireless communication unit to transmit a request to the downstream node to establish a route to the target node. After completing the operation, return to step 2.

[0173] 4.B: If the wireless signal is a signal for controlling the node to read sensor data, the fixed node signal processing unit reads the digital or analog signal of the pressure sensor and converts the analog signal into a digital signal. After the operation is completed, proceed to step 5.

[0174] Step 5: The fixed node signal processing unit determines whether the pressure parameter detected by the pressure sensor exceeds the dangerous value, and performs the following operations.

[0175] 5.A: If the parameter exceeds the dangerous value, the fixed node signal processing module sends a danger warning digital signal to the wireless communication unit, and the wireless communication unit converts the digital signal into a wireless signal and broadcasts it to the surrounding nodes; after executing the operation, it returns to step 2 of the fixed node module workflow.

[0176] 5.B: If the parameter does not exceed the danger level, proceed to step 6.

[0177] Step 6: The fixed node signal processing unit adds information about the signal transmission destination at the beginning of the digital signal about the sensor data, specifies the signal destination as the terminal, and transmits the digital signal to the wireless communication unit. The wireless communication unit converts the digital signal into a wireless signal and transmits the sensor data signal in reverse to the upstream node according to the route of the received wireless signal. After the operation is completed, return to step 2.

[0178] The above is only a preferred embodiment of the present invention, and the present invention should not be limited to the contents disclosed in the embodiment and the drawings. Any equivalent or modification completed without departing from the spirit disclosed in the present invention shall fall within the scope of protection of the present invention.

Claims

1. A mine unmanned vehicle detection and position feedback system based on UWB technology, characterized by: It includes unmanned vehicle module, single reference point positioning base station module, fixed node module and terminal module; Among them, the terminal module includes a smart phone, a PAD, a tablet computer or a handheld mobile electronic device; the number of unmanned vehicle modules is n; each unmanned vehicle module includes a vehicle-mounted communication unit, a memory unit, a vehicle-mounted power supply unit, a vehicle-mounted positioning unit, a computing and control unit, a mobile unit and a sensor unit; the number of single reference point positioning base station modules is k, and each single reference point positioning base station module includes a base station signal processing unit, an array antenna unit, a base station communication unit and a base station power supply unit; the number of fixed node modules is m, and each fixed node module includes a fixed node power supply unit, a fixed node signal processing unit, a wireless communication unit and a fixed node sensor unit; The terminal module includes a terminal calculation and control unit; The wireless communication unit includes an antenna and a wireless communication chip, the fixed node sensor unit includes at least one pressure sensor, the fixed node signal processing unit includes a single chip microcomputer with a high-performance processor; the fixed node power supply unit includes a lithium battery with large battery capacity and light weight; The array antenna unit in each single reference point positioning base station module includes an antenna and a radio frequency combiner; the base station communication unit includes an antenna and a wireless communication chip; the base station signal processing unit includes a UWB positioning chip and a related development board; the base station power supply unit includes a battery with a large battery capacity; The on-board communication unit in each unmanned vehicle module includes an antenna and a wireless communication chip; the memory unit includes a memory; the on-board positioning unit includes a UWB positioning chip and an antenna; the mobile unit includes at least two motors; the sensor unit includes an IMU, a light sensor, a temperature sensor, a sound sensor, a smoke sensor, a CO sensor, a combustible gas sensor, an infrared sensor and a camera; the computing and control unit includes a single-chip microcomputer with multiple ports; the on-board power supply unit includes a lithium battery with large battery capacity and light weight; The connection relationship between the modules and units in the mine unmanned vehicle detection and position feedback system is as follows: The vehicle positioning unit, vehicle communication unit, memory unit, mobile unit and sensor unit in each unmanned vehicle module are connected to the computing and control unit; in each single reference point positioning base station module, the array antenna unit is connected to the base station signal processing unit, and the base station signal processing unit is connected to the base station communication unit; the fixed node sensor unit in each fixed node module is connected to the fixed node signal processing unit, and the fixed node signal processing unit is connected to the wireless communication unit; The terminal module maintains connection with the fixed node module or the unmanned vehicle module through wireless signals; each node establishes a multi-hop route to communicate with the terminal module through a self-organizing network formed between nodes; the i-th unmanned vehicle module maintains connection with the j-th single reference point positioning base station module by sending and receiving wireless signals through their respective communication units, and at the same time, the on-board positioning unit in the i-th unmanned vehicle module maintains connection with the array antenna unit in the j-th single reference point positioning base station module by sending UWB signals; wherein, the i-th unmanned vehicle module is located within the positioning range of the j-th single reference point positioning base station module; Specifically: the on-board power supply unit supplies power to each unit in the unmanned vehicle module, the two motors in the mobile unit are connected to the computing and control unit, the IMU, light sensor, temperature sensor, sound sensor, smoke sensor, CO sensor, combustible gas sensor, infrared sensor, and camera in the sensor unit are connected to the computing and control unit, the UWB positioning chip in the on-board positioning unit is connected to the computing and control unit, the wireless communication chip in the on-board communication unit is connected to the computing and control unit, and the memory in the memory unit is connected to the computing and control unit; Single reference point positioning base station module: the base station power supply unit supplies power to each unit in the single reference point positioning base station module, multiple antennas in the array antenna unit are connected to the RF combiner, the RF combiner is connected to the base station signal processing unit, and the wireless communication chip in the base station communication unit is connected to the base station signal processing unit; Fixed node module: the fixed node power supply unit supplies power to each unit in the fixed node module, the pressure sensor is connected to the fixed node signal processing unit, and the wireless communication chip in the wireless communication unit is connected to the fixed node signal processing unit; The functions of each module and unit in the mine unmanned vehicle detection and position feedback system are as follows: Computing and control unit in the unmanned vehicle module: processes various digital and analog signals and sends control signals to each unit; Sensor unit: detects environmental conditions in the mine and converts environmental information into digital or analog signals; On-board positioning unit: sends out UWB signals to facilitate positioning operations; On-board communication unit: sends and receives wireless signals and converts them into digital signals to achieve wireless communication with the single reference point positioning base station module, other unmanned vehicle modules and fixed node modules; Mobile unit: receives PWM signals from the computing and control unit and drives two motors to rotate; Memory unit: stores the time, speed and direction data of each movement of the car and caches the image data taken by the camera; On-board power supply unit: provides power to each unit in the current unmanned vehicle module; The base station signal processing unit in the single reference point positioning base station module processes various digital signals and UWB signals and sends control signals to each unit; the array antenna unit receives the multipath UWB signal sent by the vehicle positioning unit in the unmanned vehicle module; the base station communication unit sends and receives wireless signals and converts them into digital signals to achieve communication with the unmanned vehicle module; the base station power supply unit supplies power to other units; Fixed node signal processing unit in the fixed node module: processes various digital and analog signals, and sends control signals to each unit; fixed node sensor unit: collects environmental information of the mine wall and the surrounding environment, and converts it into digital or analog signals; wireless communication unit: sends and receives wireless signals, and converts wireless signals into digital signals to achieve communication with the unmanned vehicle module and other fixed node modules; fixed node power supply unit supplies power to other units; Terminal computing and control unit in the terminal module: processes digital signals from fixed nodes and displays environmental information to the outside world; sends control signals to nodes to achieve control of all modules; The working process of the unmanned vehicle module includes the following steps: Step 1: The vehicle power module supplies power, and the computing and control unit initializes the input and output settings of each port connected to other units; Step 2: The vehicle communication unit starts to send and receive wireless signals; Step 3: The calculation and control unit determines whether the communication unit receives a wireless signal sent from a fixed node or a mobile node. If the calculation and control unit determines that the communication unit does not receive a wireless signal, the process returns to step 2; if the calculation and control unit determines that the communication unit receives a wireless signal, the process proceeds to step 4; Step 4: The calculation and control unit determines whether the wireless signal is a signal for controlling the unmanned vehicle module, specifically: 4A: If the calculation and control unit determines that the wireless signal is not a signal for controlling the unmanned vehicle, it further determines whether the wireless signal is a danger warning signal; if it is not a danger warning message, jump to step 6, otherwise, the calculation and control unit sends a danger warning digital signal to the on-board communication unit, and the on-board communication unit converts the digital signal into a wireless signal and broadcasts it to the surrounding nodes; then the calculation and control unit reads all the previous movement operation data of the unmanned vehicle stored in the memory module, and controls the mobile unit to drive the unmanned vehicle back to the starting point of the mine based on these data; after the execution is completed, return to step 2 in the unmanned vehicle module; 4B: If the calculation and control unit determines that the wireless signal is a signal for controlling the unmanned vehicle, proceed to step 5; Step 5: The calculation and control unit determines the type of wireless signal and performs the following operations: 5A: If the wireless signal is a signal returned by the terminal controlling the unmanned vehicle, the calculation and control unit reads all the previous movement operation data of the unmanned vehicle stored in the memory module, and controls the mobile unit to drive the unmanned vehicle back to the starting point of the mine based on these data, and returns to step 2 after the execution is completed; 5B: If the wireless signal is a signal for collecting sensor data controlled by the terminal, the computing and control unit reads the analog or digital signal of each sensor and converts the analog signal into a suitable digital signal; then, the computing and control unit adds information about the signal transmission destination at the beginning of the sensor digital signal, and specifies that the signal destination is the terminal; then the computing and control unit transmits the processed sensor signal to the on-board communication unit, and the communication unit transmits the sensor data signal in reverse to the upstream node according to the route of the received wireless signal, and returns to step 2 after the execution is completed; 5C: If the wireless signal is a signal for the terminal to control the movement of the unmanned vehicle, the computing and control unit transmits a corresponding PWM signal to the mobile unit according to the control signal sent by the terminal. After receiving the PWM signal, the two motors in the mobile unit rotate in the specified direction and speed respectively, driving the unmanned vehicle to rotate, move forward and move backward; at the same time, the computing and control unit stores the direction, speed and time of the unmanned vehicle's movement in the memory unit, and returns to step 2 after the execution is completed; 5D: If the wireless signal is a signal for obtaining location information controlled by the terminal, the computing and control unit controls the vehicle-mounted positioning unit to send a UWB signal to the single reference point positioning module in the area according to the control signal sent by the terminal, and the vehicle-mounted communication unit sends a wireless signal to the base station communication unit requesting to establish a connection; then, the computing and control unit determines whether the wireless signal about the location of the unmanned vehicle module sent from the single reference point positioning base station module is received; if not, continue to determine whether the wireless signal about the location of the unmanned vehicle module sent from the single reference point positioning base station module is received; if the wireless signal about the location of the unmanned vehicle module sent from the single reference point positioning base station module is received, then the computing and control unit adds information about the signal transmission destination at the beginning of the digital signal about the location information, specifies the signal destination as the terminal, and sends it to the vehicle-mounted communication unit, and then the vehicle-mounted communication unit transmits the location signal in reverse to the upstream node according to the route of the received wireless signal, and returns to step 2 after execution; Step 6: After the computing and control unit determines that the wireless signal is not a signal for controlling the unmanned vehicle module, the computing and control unit further determines whether the destination of the wireless signal is a terminal; if the destination is a terminal, the on-board communication unit transmits the signal in reverse to the upstream node according to the established route; if the destination is not a terminal, the on-board communication unit transmits a request to establish a route to the target node to the downstream node, and returns to step 2 after the execution is completed; The working process of the single reference point positioning base station module includes the following steps: Step 1: The base station power supply unit supplies power, and the base station signal processing unit initializes the input and output settings of the ports connected to each unit, and the counter counts to 0; Step 2: The array antenna unit starts to receive the UWB signal; Step 3: The base station signal processing unit determines whether a signal is transmitted from the array antenna unit and performs the following operations: 3A: If a signal is transmitted from the array antenna unit, the counter in the base station signal processing unit is incremented by 1; and it is determined whether the counter reaches 4; if it reaches 4, the counter is reset and step 4 is performed; if it does not reach 4, the process returns to step 2; 3B: If there is no signal coming from the array antenna unit, return to step 2; Step 4: The base station signal processing unit calculates the position of the unmanned vehicle module that sends the UWB signal based on the TDOA algorithm and the time difference between the UWB signals from the four antennas; Step 5: The base station communication unit establishes a connection according to the signal for establishing a connection sent by the unmanned vehicle module; Step 6: The base station signal processing unit processes the location signal and transmits it to the base station communication unit. The base station communication unit converts the location signal into a wireless signal and sends it to the unmanned vehicle module. After the operation is executed, return to step 2; The working process of the fixed node module includes the following steps: Step 1: The fixed node power supply unit supplies power, and the fixed node signal processing unit initializes the input and output settings of the port connected to the sensor; Step 2: The wireless communication unit starts to send and receive wireless signals; Step 3: The fixed node signal processing unit determines whether the wireless communication unit receives a wireless signal sent from other fixed nodes or mobile nodes. If no wireless signal is received from other fixed nodes or mobile nodes, the process returns to step 2; otherwise, if a wireless signal is received from other fixed nodes or mobile nodes, the process proceeds to step 4. Step 4: The fixed node signal processing unit determines whether the wireless signal is a signal for controlling the node to read sensor data; and performs the following operations: 4A: If the wireless signal is not a signal for controlling the node to read sensor data, the fixed node signal processing unit further determines whether the destination of the wireless signal is a terminal; if the destination of the wireless signal is a terminal, the fixed node signal processing unit controls the wireless communication unit to transmit the wireless signal to the upstream node according to the established route; if the destination of the wireless signal is not a terminal, the fixed node signal processing unit controls the wireless communication unit to transmit a request to establish a route to the target node to the downstream node; after the operation is performed, return to step 2; 4B: If the wireless signal is a signal for controlling the node to read sensor data, the fixed node signal processing unit reads the digital or analog signal of the pressure sensor and converts the analog signal into a digital signal; after the operation is completed, proceed to step 5; Step 5: The fixed node signal processing unit determines whether the parameter about the pressure size detected by the pressure sensor exceeds the dangerous value. If so, the fixed node signal processing module sends a dangerous warning digital signal to the wireless communication unit. The wireless communication unit converts the digital signal into a wireless signal and broadcasts it to the surrounding nodes. After the operation is completed, it returns to step 2 of the fixed node module workflow; if the parameter does not exceed the dangerous value, proceed to step 6; Step 6: The fixed node signal processing unit adds information about the signal transmission destination at the beginning of the digital signal about the sensor data, specifies the signal destination as the terminal, and then transmits the digital signal to the wireless communication unit. The wireless communication unit converts the digital signal into a wireless signal and then transmits the sensor data signal in reverse to the upstream node according to the route of the received wireless signal. After completing the operation, return to step 2.

2. The mine unmanned vehicle detection and position feedback system based on UWB technology according to claim 1 is characterized by: The unmanned vehicle modules are arranged in a distributed manner in the mine.

3. The mine unmanned vehicle detection and position feedback system based on UWB technology according to claim 1 is characterized by: m is less than n.

4. The mine unmanned vehicle detection and position feedback system based on UWB technology according to claim 1 is characterized by: n is greater than k.

5. The mine unmanned vehicle detection and position feedback system based on UWB technology according to claim 1 is characterized by: The value ranges of i and j are 1<=i<=n and 1<=j<=k respectively.

6. The mine unmanned vehicle detection and position feedback system based on UWB technology according to claim 1 is characterized by: The number of antennas in the array antenna unit in each single reference point positioning base station module is not less than 4.

7. The mine unmanned vehicle detection and position feedback system based on UWB technology according to claim 1 is characterized by: In step 3, fixed nodes refer to fixed node modules; mobile nodes refer to other unmanned vehicle modules.

Citation Information

Cited By

  • Underground coal mine intelligent unmanned vehicle positioning method and system

    CN120686300A