A method for accurate personnel positioning using dual card readers in underground coal mines
By using dual card readers to perform TDOA positioning in the coal mine, combined with TOF ranging and UWB signals, the problems of low positioning accuracy and insufficient refresh rate in the existing technology are solved, and high precision, high concurrency and stability are achieved. Downhole personnel positioning.
Patent Information
- Application Number
- CN202210871658.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-07-22
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2042-07-22
AI Technical Summary
The existing underground personnel positioning system of coal mines cannot meet the needs of high-precision positioning of coal mines due to its short measurement distance, poor stability, susceptibility to environmental interference and low positioning accuracy, especially after the implementation of unmanned driving technology, the refresh rate and concurrency volume are improved. Require.
TDOA positioning is used with dual card readers, and by grouping the card readers, each group consists of a master card reader and a slave card reader, using TOF ranging and UWB signals for precise positioning, combining signal strength and time stamp Perform positioning coordinate calculation to achieve high precision, high refresh rate and high concurrency positioning.
The site positioning accuracy is less than 30cm, the positioning concurrency is high, the stability is high, and there is no need for frequent network switching, meeting the positioning needs of high precision and high refresh rate in coal mines.
Smart Images

Figure CN115278534B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the field of wireless positioning and relates to a method for accurately positioning personnel using double card readers in underground coal mines. Background Art
[0002] Digital mines have become an important trend in the development of coal mines in the future. Among the ten major functional systems of intelligent coal mines, personnel positioning technology is based on advanced computer technology, communication technology, and spatial information technology, and is the only way to achieve modern management and safe production of coal mines under the guidance of high-tech concepts. The current personnel positioning system generally uses wireless communication technologies such as RFID, WiFi, and ZigBee to achieve underground positioning. Due to the short measurement distance, poor stability, susceptibility to environmental interference, and low positioning accuracy, it cannot meet the high-precision positioning requirements of mines. UWB signals have attracted much attention in recent years because they have centimeter-level positioning accuracy, strong penetration, and strong anti-multipath interference capabilities, which meet the standards and requirements for accurate underground personnel positioning.
[0003] Accurate personnel positioning in coal mines usually uses TOF ranging method for ranging. TOF ranging method has high accuracy and strong anti-interference ability, but it has natural disadvantages in ranging direction identification and positioning area roaming. With the promotion of unmanned driving technology in coal mines, there are higher requirements for the refresh rate of accurate positioning. The traditional TOF ranging method can no longer meet the increasingly high application needs of coal mines. A high-precision, high-refresh rate, high concurrency, and fast roaming positioning method is needed to meet the coal mine field application. Summary of the invention
[0004] In view of this, the object of the present invention is to provide a method for accurately locating personnel using dual card readers in underground coal mines.
[0005] In order to achieve the above object, the present invention provides the following technical solutions:
[0006] A method for accurately locating personnel using dual card readers in underground coal mines, comprising the following steps:
[0007] S1: The card readers are grouped, each group consists of a master card reader and a slave card reader, responsible for the positioning of an area;
[0008] S2: After the master card reader is powered on, it will randomly delay for a period of time and then perform TOF distance measurement with the slave card reader;
[0009] S3: The multiple distance measurements are processed by filtering as the distance between the master and slave card readers;
[0010] S4: When the identification card initiates a ranging frame, all areas within the signal coverage receive the ranging frame and calculate the positioning coordinates of the identification card in each positioning area respectively;
[0011] S5: Based on the signal strength of the ranging frame received in each area, determine in which area the identification card is located and its specific position in the area, and determine whether the identification card is roaming.
[0012] Furthermore, the master card reader in the same area initiates a synchronization frame at regular intervals, and the synchronization frame can only be received by the slave card reader paired with it. The synchronization frame sending interval is 100ms~200ms. The UWB clocks of all card readers in the area are synchronized through the synchronization frame. The identification card initiates a ranging frame at a random interval. After receiving the ranging frame, the master and slave card readers in the area send the ranging frame reception timestamp, the synchronization frame sending timestamp and the synchronization frame reception timestamp to the central station positioning engine to solve the identification card positioning coordinates.
[0013] Furthermore, the card reader is composed of a main control MCU, a UWB module, a PA module, a MAC&PHY module, a FLASH, and a DC / DC module. The main control MCU is used to realize the card reader punching function and data interaction with the host computer central station, and the MAC&PHY module is used to realize network data interaction; the main control MCU controls the UWB module to realize the UWB transceiver function, and realizes UWB long-distance data transmission through an external PA module. The DC / DC module steps down the input power supply to adapt to the power supply requirements of the card reader, and collects the power supply information of the intrinsically safe power supply through the RS485 bus. The configuration information of the relevant functions of the card reader is stored in the FLASH.
[0014] Furthermore, after the master card reader is powered on with a random delay, the distance S between the master and slave card readers is measured by the DS-TWR ranging method in the TOF ranging technology. Then, the master card reader will initiate a ranging time synchronization frame at intervals of 100ms to 200ms. Let SYNC1 and SYNC2 be two adjacent time synchronization frames. The master card reader records the sending timestamp each time it sends a time synchronization frame, and the slave card reader also records the receiving timestamp each time it receives a time synchronization frame. T1A and T1B are the sending timestamps of the master card reader's time synchronization frame, and T2A and T2B are the receiving timestamps of the slave card reader. When an identification card sends a ranging frame between two time synchronization frames, the master and slave card readers respectively record the receiving timestamps of the ranging frame.
[0015] ΔT12=(T2C-T2A)+T12-(T1C-T1A) (1)
[0016] The time synchronization coefficient between the master card reader and the slave card reader is:
[0017] (T1B-T1A)=k(T2B-T2A) (2)
[0018] After time synchronization:
[0019] ΔD12=ΔT12*c=((T2C-T2A)*k-(T1C-T1A))*c+S (3)
[0020] Where: ΔT12 represents the time difference between the tag propagation to the master reader and the slave reader; ΔD12 represents the distance difference between the tag propagation to the master reader and the slave reader; T12 represents the time for SYNC1 to propagate from the master reader to the slave reader; S represents the distance between the master reader and the slave reader; T1A represents the timestamp of SYNC1 sending from the master reader; T1B represents the timestamp of SYNC2 sending from the master reader; T1C represents the timestamp of the master reader receiving the tag; T2A represents the timestamp of SYNC1 receiving from the slave reader; T2B represents the timestamp of SYNC2 receiving from the slave reader; T2C represents the timestamp of the slave reader receiving the tag; c represents the speed of light; k represents the clock synchronization coefficient between the master reader r and the slave reader.
[0021] The beneficial effects of the present invention are:
[0022] 1. High on-site positioning accuracy: Using dual card reader TDOA for positioning can ensure that the positioning accuracy is less than 30cm;
[0023] 2. High concurrent volume of on-site positioning: dual card reader TDOA is used for positioning, and the identification card only needs to send a ranging frame once to achieve accurate positioning;
[0024] 3. High on-site positioning stability: The card readers are grouped into positioning areas, and roaming in the positioning area is performed without the need for network switching and other operations.
[0025] Other advantages, objectives and features of the present invention will be described in the following description to some extent, and to some extent, will be obvious to those skilled in the art based on the following examination and study, or can be taught from the practice of the present invention. The objectives and other advantages of the present invention can be realized and obtained through the following description. BRIEF DESCRIPTION OF THE DRAWINGS
[0026] In order to make the purpose, technical solutions and advantages of the present invention more clear, the present invention will be described in detail below in conjunction with the accompanying drawings, wherein:
[0027] Figure 1 It is the flow chart of dual reader TDOA positioning;
[0028] Figure 2 It is a diagram for the group management of card readers;
[0029] Figure 3 This is the TDOA ranging diagram of dual card readers;
[0030] Figure 4 Locate the roaming map for the identification card;
[0031] Figure 5 This is the hardware block diagram of the card reader;
[0032] Figure 6 This is the dual-reader TDOA ranging flow chart. DETAILED DESCRIPTION
[0033] The following describes the embodiments of the present invention by specific examples, and those skilled in the art can easily understand other advantages and effects of the present invention from the contents disclosed in this specification. The present invention can also be implemented or applied through other different specific embodiments, and the details in this specification can also be modified or changed in various ways based on different viewpoints and applications without departing from the spirit of the present invention. It should be noted that the illustrations provided in the following embodiments only illustrate the basic concept of the present invention in a schematic manner, and the following embodiments and features in the embodiments can be combined with each other without conflict.
[0034] Among them, the drawings are only used for illustrative explanations, and they only represent schematic diagrams rather than actual pictures, and should not be understood as limitations on the present invention. In order to better illustrate the embodiments of the present invention, some parts of the drawings may be omitted, enlarged or reduced, and do not represent the size of actual products. For those skilled in the art, it is understandable that some well-known structures and their descriptions in the drawings may be omitted.
[0035] The same or similar numbers in the drawings of the embodiments of the present invention correspond to the same or similar parts; in the description of the present invention, it should be understood that if the terms "upper", "lower", "left", "right", "front", "rear", etc. indicate the orientation or position relationship, they are based on the orientation or position relationship shown in the drawings, which is only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operate in a specific orientation. Therefore, the terms describing the position relationship in the drawings are only used for illustrative purposes and cannot be understood as limiting the present invention. For ordinary technicians in this field, the specific meanings of the above terms can be understood according to specific circumstances.
[0036] like Figure 1 As shown, the present invention provides a method for accurate personnel positioning using dual card readers in coal mines. When dual card readers are used for TDOA positioning in coal mines, the card readers need to be grouped in advance. Each group consists of a master card reader and a slave card reader. A card reader can be a master card reader of a group or a master card reader of multiple groups. Each group of card readers is responsible for positioning an area. After the master card reader is powered on each time, it randomly delays for a period of time and then performs TOF ranging with the slave card reader. The multiple ranging distances are filtered and processed as the distance between the two card readers, such as Figure 2 As shown, area 1 consists of reader 1 and reader 2, and reader 1 is the main reader of the area. Area 2 consists of reader 2 and reader 3. In the area, reader 2 is the main reader, so reader 2 is both a slave reader of area 1 and a master reader of area 2. After power-on, reader 1 and reader 2 measure the distances S1 and S2 between the readers in the two areas respectively after a random delay. The purpose of performing distance measurement after a random delay after power-on is to prevent distance measurement conflicts caused by multiple main readers being powered on at the same time. S1 and S2 can be used in dual-reader TDOA distance measurement calculations.
[0037] like Figure 3 As shown, the master card reader in the same area will initiate a synchronization frame at regular intervals. Only the slave card reader paired with it will receive the synchronization frame. The synchronization frame sending interval is usually between 100ms and 200ms. The synchronization frame can be used to synchronize the UWB clocks of all card readers in the area. The identification card will initiate a ranging frame at regular intervals. Each interval time must be random, which can reduce the probability of conflict when multiple identification cards are ranging. After receiving the ranging frame, the master and slave card readers in the area will send the ranging frame receiving timestamp, the synchronization frame sending timestamp, and the synchronization frame receiving timestamp to the central station positioning engine to solve the identification card positioning coordinates. The identification card only needs to send a ranging frame once to achieve accurate positioning.
[0038] When the identification card initiates a ranging frame, all card readers within the signal coverage will receive the ranging frame. Figure 4 As shown, both area 1 and area 2 receive ranging frames, so area 1 and area 2 will calculate the positioning coordinates of the identification card respectively. Area 1 calculates that the identification card coordinates are within the range of area 1, and area 2 calculates that the identification card coordinates are at the junction of the two areas. Then, combined with the signal strength of the ranging frames received by the two areas, it can be determined that the identification card is located in area 1. When the identification card moves to area 2 and enters the positioning area of area 2, it can be determined that the identification card positioning coordinates are located in area 2, thereby realizing identification card roaming.
[0039] The card reader is composed of the main control MCU, UWB module, PA module, MAC&PHY module, FLASH, DC / DC module, real-time clock RTC module, watchdog module and other components. The main control MCU adopts an ultra-low power standby MCU, which is responsible for the card reader punching function and the data interaction function with the host computer center station. It also adopts a MAC&PHY function integration module to realize the interaction of network data and reduce the network burden of the MCU. The main control MCU controls the UWB module to realize the UWB transceiver function, and realizes UWB long-distance data transmission through an external PA chip. The DC / DC module steps down the input power supply to adapt to the power supply requirements of the card reader, protects the power supply of the card reader, and collects the power supply information of the intrinsically safe power supply through the RS485 bus. The configuration information of the card reader-related functions is stored in the FLASH. After power-on, the configuration information will be read to configure the parameters of the card reader. The real-time clock RTC module is used to provide a time reference for the main control MCU module; the watchdog module is used to monitor and reset the main control MCU module. The hardware block diagram is as follows Figure 5 shown.
[0040] After the master card reader is powered on with a random delay, the distance S between the master and slave card readers is measured by the DS-TWR ranging method in the TOF ranging technology. Then the master card reader will initiate a ranging time synchronization frame at intervals. The synchronization frame sending interval is usually between 100ms and 200ms. Figure 6 As shown in the figure, SYNC1 and SYNC2 are two adjacent time synchronization frames. The master card reader will record the sending timestamp each time it sends a time synchronization frame, and the slave card reader will also record the receiving timestamp each time it receives a time synchronization frame. Therefore, T1A and T1B are the sending timestamps of the master card reader's time synchronization frame, and T2A and T2B are the receiving timestamps of the slave card reader. When an identification card sends a ranging frame between the two time synchronization frames, the master and slave card readers will record the receiving timestamps of the ranging frame respectively. T1C and T2C in the figure below are the receiving timestamps of the ranging frames of the master and slave card readers respectively.
[0041] The following formula can be derived.
[0042] ΔT12=(T2C-T2A)+T12-(T1C-T1A) (1)
[0043] The above formula 1 is based on the assumption that the UWB signal clocks of the two readers, MasterAnchor and SlaveAnchor, are completely synchronized. In real applications, clock synchronization is impossible and clock synchronization between readers is required. Here, the SlaveAnchor clock is synchronized to the MasterAnchor clock. Figure 5It can be seen that the interval between MasterAnchor sending SYNC1 and SYNC2 should be equal to the interval between SlaveAnchor receiving SYNC1 and SYNC2, so the time synchronization coefficient between MasterAnchor and SlaveAnchor can be obtained, and the formula is as follows.
[0044] (T1B-T1A)=k(T2B-T2A) (2)
[0045] After time synchronization of formula 1, the formula is as follows:
[0046] ΔD12=ΔT12*c=((T2C-T2A)*k-(T1C-T1A))*c+S (3)
[0047] Where: ΔT12---The time difference between the tag propagation to the MasterAnchor and the SlaveAnchor;
[0048] ΔD12---The distance difference between the tag propagation to the MasterAnchor and the SlaveAnchor;
[0049] T12---The time for SYNC1 to propagate from MasterAnchor to SlaveAnchor;
[0050] S---the distance between MasterAnchor and SlaveAnchor;
[0051] T1A---SYNC1 sends the time stamp from MasterAnchor;
[0052] T1B---SYNC2 sends the time stamp from MasterAnchor;
[0053] T1C---Time stamp of the moment when MasterAnchor receives the Tag;
[0054] T2A---Time stamp of the moment when SlaveAnchor receives SYNC1;
[0055] T2B---Time stamp of the moment when SlaveAnchor receives SYNC2;
[0056] T2C---Time stamp of the moment when SlaveAnchor receives the Tag;
[0057] c---speed of light;
[0058] k---MasterAnchor and SlaveAnchor clock synchronization coefficient.
[0059] When the MasterAnchor is powered on, the distance S between the MasterAnchor and the SlaveAnchor is measured by TOF. The Tag is located between the two readers, and the sum of the distances from the two readers is S. ΔD12 is the distance difference between the Tag and the two readers. Therefore, the distances between the Tag and the two readers can be solved respectively, realizing the dual-reader TDOA ranging function.
[0060] Finally, it should be noted that the above embodiments are only used to illustrate the technical solution of the present invention rather than to limit it. Although the present invention has been described in detail with reference to the preferred embodiments, those skilled in the art should understand that the technical solution of the present invention can be modified or replaced by equivalents without departing from the purpose and scope of the technical solution, which should be included in the scope of the claims of the present invention.
Claims
1. A method for accurate personnel positioning using dual card readers in underground coal mines, characterized in that: The following steps are involved: S1: The card readers are grouped, each group consists of a master card reader and a slave card reader, responsible for the positioning of an area; S2: After the master card reader is powered on, it will randomly delay for a period of time and then perform TOF distance measurement with the slave card reader; S3: The multiple distance measurements are processed by filtering as the distance between the master and slave card readers; S4: When the identification card initiates a ranging frame, all areas within the signal coverage receive the ranging frame and calculate the positioning coordinates of the identification card in each positioning area respectively; S5: combining the signal strength of the ranging frame received in each area, determining in which area the identification card is located and the specific position in the area, and determining whether the identification card is roaming; The master card reader in the same area initiates a synchronization frame at regular intervals. The synchronization frame can only be received by the slave card reader paired with it. The synchronization frame sending interval is 100ms to 200ms. The UWB clocks of all card readers in the area are synchronized through the synchronization frame. The identification card initiates a ranging frame at random intervals. After receiving the ranging frame, the master and slave card readers in the area send the ranging frame receiving timestamp, the synchronization frame sending timestamp and the synchronization frame receiving timestamp to the central station positioning engine to solve the identification card positioning coordinates; The card reader is composed of a main control MCU, a UWB module, a PA module, a MAC&PHY module, a FLASH, and a DC / DC module. The main control MCU is used to realize the card reader punching function and data interaction with the host computer center station, and the MAC&PHY module is used to realize network data interaction; the main control MCU controls the UWB module to realize the UWB transceiver function, and realizes UWB long-distance data transmission through an external PA module. The DC / DC module performs voltage reduction processing on the input power supply to adapt to the power supply requirements of the card reader, and collects power supply information of the intrinsically safe power supply through the RS485 bus. The configuration information of the card reader related functions is stored in the FLASH; After the master card reader is powered on with a random delay, the distance S between the master and slave card readers is measured by the DS-TWR ranging method in the TOF ranging technology. Then the master card reader will initiate a ranging time synchronization frame at intervals of 100ms to 200ms. Let SYNC1 and SYNC2 be two adjacent time synchronization frames. The master card reader records the sending timestamp each time it sends a time synchronization frame, and the slave card reader also records the receiving timestamp each time it receives a time synchronization frame. T1A and T1B are the sending timestamps of the master card reader's time synchronization frame, and T2A and T2B are the receiving timestamps of the slave card reader. When an identification card sends a ranging frame between two time synchronization frames, the master and slave card readers record the receiving timestamps of the ranging frame respectively. ΔT12=(T2C-T2A)+T12-(T1C-T1A) (1) The time synchronization coefficient between the master card reader and the slave card reader is: (T1B-T1A)=k(T2B-T2A) (2) After time synchronization: ΔD12=ΔT12*c=((T2C-T2A)*k-(T1C-T1A))*c+S (3) Where: ΔT12 represents the time difference between the tag propagation to the master reader and the slave reader; ΔD12 represents the distance difference between the tag propagation to the master reader and the slave reader; T12 represents the time for SYNC1 to propagate from the master reader to the slave reader; S represents the distance between the master reader and the slave reader; T1A represents the timestamp of SYNC1 sending from the master reader; T1B represents the timestamp of SYNC2 sending from the master reader; T1C represents the timestamp of the master reader receiving the tag; T2A represents the timestamp of SYNC1 receiving from the slave reader; T2B represents the timestamp of SYNC2 receiving from the slave reader; T2C represents the timestamp of the slave reader receiving the tag; c represents the speed of light; k represents the clock synchronization coefficient between the master reader r and the slave reader.
