A mobile phone positioning and navigation system and method applied to mines

Through the UWB/ZigBee wireless positioning system and low-power Bluetooth BLE module, combined with mining mobile phones and positioning base stations, precise positioning and path navigation in coal mines are achieved, and the problem that the existing technology cannot meet the multifunctional needs of intelligent mining construction is solved. , reduces system construction costs and improves applicability.

CN113596727BActive Publication Date: 2024-11-26CHINA COAL TECH & ENG GRP CHONGQING RES INST CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202110927742.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-08-10
Publication Date
2024-11-26
Estimated Expiration
2041-08-10

AI Technical Summary

Technical Problem

The existing coal mine positioning system cannot achieve precise positioning and navigation functions, and cannot meet the multifunctional needs of positioning, calling and navigation in the intelligent construction of mines.

Method used

UWB/ZigBee wireless positioning system and wireless communication system, combined with low-power Bluetooth BLE module, precise positioning, location query and path navigation are achieved through positioning base stations and mining mobile phones, meeting the multifunctional needs of intelligent mining construction.

Benefits of technology

It realizes precise positioning, location query and path navigation functions in the mine, reduces the cost of system construction, meets the multifunctional needs of intelligent mining construction, has strong system applicability and broad market prospects.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN113596727B_ABST
    Figure CN113596727B_ABST
Patent Text Reader

Abstract

The present invention relates to a mobile phone positioning and navigation system and method applied to mines, and belongs to the field of mine positioning technology. The method adopts UWB / ZigBee precise positioning technology, designs a highly integrated positioning module, embeds it inside a mine mobile phone, and adopts low-power Bluetooth to realize two-way communication with the mine mobile phone. The method requires the installation of a UWB / ZigBee precise positioning system underground in a coal mine to realize full mine tunnel coverage of wireless positioning signals. The positioning module is embedded inside the shell of the mine mobile phone, and the positioning module obtains the position coordinate information based on the UWB / ZigBee wireless positioning technology and sends it to the mine mobile phone via Bluetooth. The mine mobile phone downloads and updates the mine GIS tunnel map through WIFI or 4G / 5G wireless network, realizes the positioning function of the mine mobile phone according to the position coordinate information of the positioning module, inputs the position coordinate information of the target object, and adopts the shortest path algorithm to realize the navigation function of the mine mobile phone.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of mine positioning, and relates to a mobile phone positioning and navigation system and method applied to mines. Background Art

[0002] At present, the "coal mine navigation and positioning system" invented by Xi'an University of Science and Technology includes multiple constant magnetic sources, multiple electrically controlled magnetic sources, positioning terminals and servers. Multiple constant magnetic sources and multiple electrically controlled magnetic sources are installed in coal mines. The positioning terminal is located in the coal mine, which is used to measure the magnetic field strength and magnetic field change frequency at the location, and compare the measured data with the preset magnetic field map to obtain the actual location of the positioning terminal. The server stores the preset magnetic field map, and compares the measured data sent by the positioning terminal with the magnetic field strength and magnetic field change frequency in the preset magnetic field map, determines the actual location of the positioning terminal and sends it to the positioning terminal. However, the positioning system and method of this technology do not belong to the mainstream positioning technology in coal mines, and the location coordinate information is not fully presented to users, so that the promotion effect of the system is poor.

[0003] The "A method and system for underground precise positioning and azimuth determination based on UWB technology DS-TWR" invented by Nanjing North Road Intelligent Control Technology Co., Ltd. includes: bilateral two-way ranging between the tag and the omnidirectional positioning antenna A; the omnidirectional positioning antenna A sends the distance of the tag relative to the A antenna to the positioning base station; the omnidirectional positioning antenna B calculates the azimuth of the tag by monitoring the wireless data between the tag and the omnidirectional positioning antenna A bound to the omnidirectional positioning antenna B, and sends the azimuth of the tag to the positioning base station; the positioning base station locates the position information of the tag relative to the positioning base station based on the distance and azimuth of the tag, and reports the position information of the tag relative to the positioning base station to the ground server; the ground server locates the absolute position of the tag based on the absolute position of the positioning base station and the position of the tag relative to the positioning base station. However, this system is only a positioning system and method, and the user terminal cannot obtain the position coordinate information and cannot realize the navigation function.

[0004] At present, the largest number of personnel positioning systems in coal mines are based on radio frequency identification technology (RFID), which can only achieve regional positioning, but not precise positioning. With the continuous development of positioning technology, ZigBee and UWB positioning technologies are gradually promoted and applied in the market. Among them, UWB precise positioning technology has the characteristics of high positioning accuracy, strong anti-interference ability, fast communication rate and large concurrent capacity, and ZigBee precise positioning technology has the characteristics of low cost, low power consumption and long communication distance. Therefore, precise positioning systems based on UWB and ZigBee positioning technologies have been widely promoted and applied in coal mines. However, the positioning terminal only provides precise positioning function. Some positioning terminals are integrated with lighting mining lamps, which have lighting and positioning functions, but still cannot meet the multi-functional requirements of intelligent construction of mines for positioning terminals, such as positioning, calling and navigation.

[0005] In summary, in order to meet the multi-functional requirements of the positioning terminal and realize accurate positioning, location query, path navigation and two-way communication, a mobile phone positioning and navigation system and method for mines is needed. Summary of the invention

[0006] In view of this, an object of the present invention is to provide a mobile phone positioning and navigation system and method for use in mines.

[0007] In order to achieve the above object, the present invention provides the following technical solutions:

[0008] A mobile phone positioning and navigation system used in mines, including a UWB / ZigBee positioning system and a wireless communication system;

[0009] The UWB / ZigBee positioning system includes a positioning server, a positioning base station and a mining mobile phone containing a positioning module;

[0010] The wireless communication system is suitable for mining mobile phones;

[0011] The positioning base station includes 2 UWB channels and 2 ZigBee channels;

[0012] The UWB channel is used for UWB precise positioning between the positioning base station and the positioning module;

[0013] The ZigBee channel is used for network connection between the positioning base station and the positioning module and slot resource management during UWB ranging;

[0014] The positioning module includes 1 UWB channel, 1 ZigBee channel and 1 Bluetooth BLE module channel;

[0015] The UWB channel is used for UWB precise positioning;

[0016] The ZigBee channel is used to scan the network and apply for UWB ranging time slot resources;

[0017] The low-power Bluetooth BLE module channel is used for data communication with the mining mobile phone;

[0018] The positioning module is embedded in the shell of the mining mobile phone. The positioning module obtains the position coordinate information based on the UWB / ZigBee wireless positioning technology and sends it to the mining mobile phone through the low-power Bluetooth BLE module;

[0019] The mining mobile phone downloads and updates the mine GIS tunnel map through the wireless communication system, realizes the positioning function of the mining mobile phone according to the position coordinate information of the positioning module, queries the position coordinate information of the target object, and uses the shortest path algorithm to realize the navigation function of the mining mobile phone.

[0020] Optionally, the wireless communication system includes a WIFI wireless communication system, a 4G wireless communication system and a 5G wireless communication system.

[0021] Optionally, the positioning base station includes a processor, a photoelectric conversion, two UWB modules and two ZigBee modules;

[0022] The photoelectric conversion, two UWB modules and two ZigBee modules are respectively connected to the processor data;

[0023] The photoelectric conversion is used for mutual cascading between positioning base stations or access to industrial Ethernet ring network, two UWB modules are used for UWB precise positioning between positioning base stations and positioning modules, and two ZigBee modules are used for network connection and UWB ranging time slot resource management between positioning base stations and positioning modules.

[0024] Optionally, the positioning module includes a processor, a UWB module, a ZigBee module and a Bluetooth BLE module;

[0025] The Bluetooth BLE module, UWB module and ZigBee module are respectively connected to the processor data;

[0026] The positioning module is embedded in the shell of the mining mobile phone. The positioning module realizes two-way data communication with the mining mobile phone through the Bluetooth BLE module. The positioning module uses UWB / ZigBee wireless positioning technology and the positioning base station to complete precise positioning, obtain location coordinate information, and send it to the mining mobile phone through the Bluetooth BLE module.

[0027] A mobile phone positioning and navigation method based on the system, the method is:

[0028] Three positioning base stations are set up in the mine tunnel, with network addresses 3, 4 and 5, 400 meters apart, and the left side of the positioning base station is positive + and the right side is negative -;

[0029] The positioning base stations are arranged starting from the mine tunnel entrance and then moved forward in sequence until the entire mine is installed;

[0030] The positioning base station has 1 branch in the linear lane, 2 branches at the "T" intersection, and 3 branches at the "X" intersection;

[0031] After the positioning base station is installed, a mine tunnel location coordinate model is established, and mine tunnel positioning and path navigation are carried out.

[0032] Optionally, the mine tunnel position coordinate model is established as follows:

[0033] (11) According to the actual installation location of the positioning base station, determine the coordinates of all positioning base stations in the mine GIS tunnel map;

[0034] (12) Setting the network address, effective coverage distance value and directional characteristics of the positioning base station;

[0035] (13) Establish a logical connection relationship diagram of positioning base stations, and map any location in the mine GIS tunnel map to the coverage distance value of a certain positioning base station;

[0036] (14) Add important places in the mine tunnels to the mine GIS tunnel map, mark the location coordinate information, and bind it with the network address, distance and direction of the positioning base station.

[0037] Optionally, the mine tunnel positioning is:

[0038] In the mine tunnels, a base station is installed at a certain distance to achieve full coverage of the tunnels;

[0039] UWB point-to-point ranging based on TOF technology requires four communications when the positioning module obtains the ranging result: ranging request frame POLL, ranging response frame RESP, ranging data frame FINAL and ranging report frame REPORT;

[0040] The distance calculation formula between the positioning module and the positioning base station is:

[0041]

[0042] Where: T SP Indicates the sending timestamp of the ranging request frame; T RP Indicates the receiving timestamp of the ranging request frame; T SR Indicates the sending timestamp of the ranging response frame; T RR Indicates the receiving timestamp of the ranging response frame; T SF Indicates the sending timestamp of the ranging data frame; T RFIndicates the receiving timestamp of the ranging data frame; C is the speed of light, 3.0×10 8 m / s;

[0043] According to the one-dimensional linear space characteristics of the mine tunnel, the two UWB antennas of the positioning base station must be installed in pairs, with a distance D between them. Δ ;

[0044] The distance measurement results of the two UWB antennas of the identification module and the positioning base station are D1 and D2 respectively. The mechanism for determining the direction of the positioning module is as follows:

[0045] (21) D2<D1 and D2>D Δ When , the positioning module is on the left side of the positioning base station, the distance is D2, and the direction is positive;

[0046] (22) D1<D2 and D1>D Δ When , the positioning module is on the right side of the positioning base station, the distance is D1, and the direction is negative;

[0047] (23)D1<D Δ And D2<D Δ When the positioning module is between the two UWB antennas of the positioning base station, the distance is D1 or D2;

[0048] After the positioning base station completes the precise positioning of the positioning module, it informs the positioning module through the ranging report frame REPORT, and the positioning module obtains the position coordinate information, that is, the address of the positioning base station, the positioning distance value and the direction characteristics;

[0049] The mining mobile phone displays the specific location and surrounding environment of the positioning module on the mine tunnel map based on the location coordinate information of the positioning module, including the address of the positioning base station, the positioning distance value and the direction characteristics, and updates it in real time.

[0050] Optionally, the path navigation is:

[0051] According to the UWB precise positioning results between the positioning module of the mining mobile phone and the positioning base station, the current position coordinate information is obtained, including the address, positioning distance value and direction characteristics of the positioning base station. After the target object is input, the position coordinate information of the target object is obtained through the mine GIS tunnel map, including the address, positioning distance value and direction characteristics of the positioning base station;

[0052] Given the current location coordinate information or the starting location coordinate information and the location coordinate information of the target object, the path navigation between the two can be completed by traversing and querying the logical connection relationship diagram of the positioning base station. The specific process is as follows:

[0053] (31) Determine the current location or departure location and find the corresponding node in the positioning base station logical relationship diagram;

[0054] (32) Find out which branch nodes the graph node has;

[0055] (33) Selecting a branch node from the plurality of branch nodes in ascending order of the positioning base station address as a temporary path node and storing it in the navigation path cache queue;

[0056] (34) Determine whether the temporary path node is the location coordinate information of the target object. If so, the path node stored in the navigation path cache queue is the navigation path; if not, enter (35);

[0057] (35) Find out which branch nodes the temporary path node has, remove the branch nodes that have been queried, and if there are no branch nodes, delete the temporary path node from the navigation path cache queue, return to the previous level according to the navigation path cache queue, and repeat (35); if there are still branch nodes, select a branch node as a temporary path node in the order of the positioning base station address from small to large, and store it in the navigation path cache queue, and repeat (34).

[0058] The beneficial effects of the present invention are:

[0059] (1) Based on the linear positioning characteristics of mine tunnels, a single base station method and distance difference algorithm are used to realize direction judgment, which reduces the number of positioning base stations by half, thereby reducing the cost of system construction.

[0060] (2) The accurate positioning of mining mobile phones is fast and can update the location coordinate information in real time. The positioning module directly obtains the location coordinate information (the address of the positioning base station, the positioning distance value and the direction characteristics) and displays the current location and surrounding environment on the mine GIS tunnel map.

[0061] (3) The path navigation algorithm is simple. It is based on the graph nodes corresponding to the location coordinate information, and then traverses and queries the logical connection relationship diagram of the positioning base station, and presents the image through the mine GIS tunnel map, thereby realizing path navigation.

[0062] (4) The mining mobile phone is highly integrated with functions such as precise positioning, location query, path navigation and two-way communication, which meets the requirements of intelligent mine construction. The system has strong applicability and broad market prospects.

[0063] 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

[0064] 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:

[0065] Figure 1 This is the architecture diagram of the mine mobile phone positioning and navigation system;

[0066] Figure 2 Design block diagram for positioning base station hardware;

[0067] Figure 3 Design block diagram for the hardware of mining mobile phone (including positioning module);

[0068] Figure 4 To locate the effective coverage of base stations 3, 4, and 5;

[0069] Figure 5 To locate the logical connection relationship between base stations 3, 4, and 5;

[0070] Figure 6 A schematic diagram of the installation location of the positioning base station;

[0071] Figure 7 To locate the logical connection relationship diagram of the base station;

[0072] Figure 8 This is the flow chart of UWB point-to-point ranging;

[0073] Fig. 9 Schematic diagram of UWB precise positioning direction judgment. DETAILED DESCRIPTION

[0074] 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.

[0075] 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.

[0076] 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.

[0077] 1 System Architecture

[0078] like Figure 1 As shown in the figure, the mine mobile phone positioning and navigation system needs to install the UWB / ZigBee precise positioning system, including the positioning server, positioning base station and mine mobile phone (including positioning module). At the same time, it is necessary to install a wireless communication system suitable for the mine mobile phone, such as a WIFI wireless communication system or a 4G / 5G wireless communication system.

[0079] The positioning base station has 2 UWB channels and 2 ZigBee channels. The UWB channel is used for UWB precise positioning between the positioning base station and the positioning module, and the ZigBee channel is used for network connection and UWB ranging time slot resource management between the positioning base station and the positioning module. The positioning module has 1 UWB channel, 1 ZigBee channel and 1 low-power Bluetooth (BLE) channel. The UWB channel is used for UWB precise positioning, the ZigBee channel is used to scan the network and apply for UWB ranging time slot resources, and the power-saving Bluetooth (BLE) channel is used for data communication with the mining mobile phone. The positioning module is embedded in the shell of the mining mobile phone. The positioning module obtains the location coordinate information based on the UWB / ZigBee wireless positioning technology and sends it to the mining mobile phone through power-saving Bluetooth (BLE). The mining mobile phone downloads and updates the mine GIS tunnel map through WIFI or / 4G / 5G wireless network. According to the location coordinate information of the positioning module, the positioning function of the mining mobile phone is realized, the location coordinate information of the target object is queried, and the navigation function of the mining mobile phone is realized by using the shortest path algorithm.

[0080] Shortest path algorithm: Based on the logical relationship diagram of the positioning base station, it aims to find the shortest path between the source coordinates and the destination coordinates. The most commonly used shortest path algorithm is the Dijkstra algorithm, which is used to calculate the shortest path from one node to all other nodes, expanding outward from the starting point until it reaches the end point.

[0081] 2 Positioning Base Station Hardware Design

[0082] The positioning base station includes a processor, photoelectric conversion, two UWB modules and two ZigBee modules. The hardware design block diagram is as follows: Figure 2 shown.

[0083] Photoelectric conversion is used for mutual cascading between positioning base stations or access to industrial Ethernet ring network. Two UWB modules are used for UWB precise positioning between positioning base stations and positioning modules. Two ZigBee modules are used for network connection and UWB ranging time slot resource management between positioning base stations and positioning modules.

[0084] 3 Hardware design of mining mobile phone (including positioning module)

[0085] A positioning module is added to an ordinary mining mobile phone to form a new mining mobile phone. The positioning module includes a processor, a UWB module, a ZigBee module, and a low-power Bluetooth (BLE) module. The hardware design block diagram is shown in the following figure. Figure 3 shown.

[0086] The positioning module is embedded in the shell of the mining mobile phone. The positioning module realizes two-way data communication with the mining mobile phone through low-power Bluetooth (BLE). The positioning module uses UWB / ZigBee wireless positioning technology and the positioning base station to complete precise positioning, obtain location coordinate information, and send it to the mining mobile phone through low-power Bluetooth (BLE).

[0087] 4 Mine tunnel location coordinate model

[0088] The mine tunnel is a linear structure in the horizontal direction. After the positioning base stations are installed, they have a tree-like logical connection relationship with each other. The positioning base station has characteristics such as network address, distance and direction. The network address of the positioning base station is unique in the UWB / ZigBee precise positioning system. The distance and direction determine the precise positioning effective coverage range of the positioning base station. Suppose that three positioning base stations are installed in a mine tunnel, with network addresses 3, 4, and 5, and a distance of 400 meters. The left side of the positioning base station is positive (+) and the right side is negative (-). The effective coverage range of these three positioning base stations is as follows: Figure 4 As shown, the logical connection relationship is as follows Figure 5 shown.

[0089] The positioning base station is arranged from the entrance of the mine tunnel, and then moved forward until the whole mine is installed. The positioning base station generally has only one branch in the linear tunnel, two branches at the "T" intersection, three branches at the "X" intersection, and so on. After the positioning base station is installed, the installation position is as follows: Figure 6 As shown, the logical connection relationship is as follows Figure 7 shown.

[0090] The steps to establish the mine tunnel location coordinate model are as follows:

[0091] (11) According to the actual installation location of the positioning base station, determine the coordinates of all positioning base stations in the mine GIS tunnel map;

[0092] (12) Setting the network address, effective coverage distance value, and directional characteristics of the positioning base station;

[0093] (13) A logical connection relationship diagram of the positioning base stations is established. Any position in the mine GIS tunnel diagram can be mapped to the coverage distance value of a certain positioning base station, such as positioning base station (12) is positive 200m, positioning base station (16) is negative 350m, etc.

[0094] (14) Add important places in the mine tunnels to the mine GIS tunnel map, mark the location coordinate information, and bind it with the network address, distance and direction of the positioning base station.

[0095] 5 Algorithm for accurate positioning of mine tunnels

[0096] In the mine tunnels, a base station is installed at certain intervals to achieve full coverage of the tunnels, and a one-dimensional positioning algorithm can meet the needs of on-site applications.

[0097] like Figure 8 As shown in the figure, for UWB point-to-point ranging based on TOF technology, the positioning module generally needs four communications to obtain the ranging result: ranging request frame (POLL); ranging response frame (RESP); ranging data frame (FINAL); ranging report frame (REPORT).

[0098] The distance calculation formula between the positioning module and the positioning base station is:

[0099]

[0100] Where: T SP Indicates the sending timestamp of the ranging request frame; T RP Indicates the receiving timestamp of the ranging request frame; T SR Indicates the sending timestamp of the ranging response frame; T RR Indicates the receiving timestamp of the ranging response frame; T SF Indicates the sending timestamp of the ranging data frame; T RF Indicates the receiving timestamp of the ranging data frame; C is the speed of light, 3.0×10 8 m / s.

[0101] According to the one-dimensional linear space characteristics of the mine tunnel, the two UWB antennas of the positioning base station must be installed in pairs, with a distance D between them. Δ .

[0102] like Fig. 9As shown in the figure, the distance measurement results of the two UWB antennas of the identification module and the positioning base station are D1 and D2 respectively. The mechanism for determining the direction of the positioning module is as follows:

[0103] (21) D2<D1 and D2>D Δ When , the positioning module is on the left side of the positioning base station, the distance is D2, and the direction is positive;

[0104] (22) D1<D2 and D1>D Δ When , the positioning module is on the right side of the positioning base station, the distance is D1, and the direction is negative;

[0105] (23)D1<D Δ And D2<D Δ When the positioning module is located between the two UWB antennas of the positioning base station, the distance is D1 or D2.

[0106] After the positioning base station completes the precise positioning of the positioning module, it tells the positioning module through the ranging report frame (REPORT), and the positioning module can obtain the location coordinate information, that is, the address of the positioning base station, the positioning distance value and the direction characteristics.

[0107] Based on the location coordinate information of the positioning module (the address of the positioning base station, the positioning distance value and the direction characteristics), the mining mobile phone can display the specific location of the positioning module and the surrounding environment on the mine tunnel map and update it in real time.

[0108] 6 Path Navigation Algorithm

[0109] Based on the UWB precise positioning results between the mining mobile phone (positioning module) and the positioning base station, the current position coordinate information (the address of the positioning base station, the positioning distance value and the direction characteristics) can be obtained. After entering the target object, the position coordinate information of the target object (the address of the positioning base station, the positioning distance value and the direction characteristics) can be obtained through the mine GIS tunnel map.

[0110] Given the current location coordinate information or the starting location coordinate information and the location coordinate information of the target object, the path navigation between the two can be completed by traversing and querying the logical connection relationship diagram of the positioning base station. The specific process is as follows:

[0111] (31) Determine the current position or the starting position, find the corresponding node (referred to as "graph node") in the positioning base station logical relationship graph, and the graph node corresponding to the positive 300 meters from the positioning base station (15) is "15, positive";

[0112] (32) Find out which branch nodes the graph node has. Figure 7 As shown, the graph node "15, positive" has two branch nodes: "11, negative", "15, negative", and the graph node "3, negative" has three branch nodes: "3, positive", "4, positive", and "7, positive";

[0113] (33) Selecting a branch node from the plurality of branch nodes in ascending order of the positioning base station address as a temporary path node and storing it in the navigation path cache queue;

[0114] (34) Determine whether the temporary path node is the location coordinate information of the target object. If so, the path node stored in the navigation path cache queue is the navigation path. If not, enter (35);

[0115] (35) Find out which branch nodes the temporary path node has, remove the branch nodes that have been queried, and if there are no branch nodes, delete the temporary path node from the navigation path cache queue, return to the previous level according to the navigation path cache queue, and repeat (35). If there are still branch nodes, select a branch node as a temporary path node in the order of the positioning base station address from small to large, and store it in the navigation path cache queue, and repeat (34).

[0116] The core idea of ​​the mine mobile phone path navigation algorithm is: according to the graph nodes corresponding to the location coordinate information, then traverse and query the logical connection relationship diagram of the positioning base station, output all the graph nodes between the two to the mine GIS tunnel map, and path navigation can be achieved.

[0117] 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 mobile phone positioning and navigation system used in mines, characterized by: Including UWB / ZigBee positioning system and wireless communication system; The UWB / ZigBee positioning system includes a positioning server, a positioning base station and a mining mobile phone containing a positioning module; The wireless communication system is suitable for mining mobile phones; The positioning base station includes 2 UWB channels and 2 ZigBee channels; The UWB channel is used for UWB precise positioning between the positioning base station and the positioning module; The ZigBee channel is used for network connection between the positioning base station and the positioning module and UWB ranging time slot resource management; The positioning module includes 1 UWB channel, 1 ZigBee channel and 1 Bluetooth BLE module channel; The UWB channel is used for UWB precise positioning; The ZigBee channel is used to scan the network and apply for UWB ranging time slot resources; The Bluetooth BLE module channel is used for data communication with the mining mobile phone; The positioning module is embedded in the shell of the mining mobile phone. The positioning module obtains the position coordinate information based on the UWB / ZigBee wireless positioning technology and sends it to the mining mobile phone through the low-power Bluetooth BLE module; The mining mobile phone downloads and updates the mine GIS tunnel map through the wireless communication system, realizes the positioning function of the mining mobile phone according to the position coordinate information of the positioning module, queries the position coordinate information of the target object, and realizes the navigation function of the mining mobile phone by using the shortest path algorithm; The wireless communication system includes a WIFI wireless communication system, a 4G wireless communication system and a 5G wireless communication system; The positioning base station includes a processor, a photoelectric conversion module, two UWB modules and two ZigBee modules; The photoelectric conversion module, the two UWB modules and the two ZigBee modules are respectively connected to the processor data; The photoelectric conversion module is used for mutually cascading or accessing the industrial Ethernet ring network between positioning base stations, the two UWB modules are used for UWB precise positioning between the positioning base station and the positioning module, and the two ZigBee modules are used for network connection and UWB ranging time slot resource management between the positioning base station and the positioning module; The positioning module includes a processor, a UWB module, a ZigBee module and a Bluetooth BLE module; The Bluetooth BLE module, UWB module and ZigBee module are respectively connected to the processor data; The positioning module is embedded in the shell of the mining mobile phone. The positioning module realizes two-way data communication with the mining mobile phone through the Bluetooth BLE module. The positioning module uses UWB / ZigBee wireless positioning technology and the positioning base station to complete precise positioning, obtain the position coordinate information, and send it to the mining mobile phone through the Bluetooth BLE module; The mobile phone positioning and navigation method based on the system is: Three positioning base stations are set up in the mine tunnel, with network addresses 3, 4 and 5, 400 meters apart, and the left side of the positioning base station is positive + and the right side is negative -; The positioning base stations are arranged starting from the mine tunnel entrance and then moved forward in sequence until the entire mine is installed; The positioning base station has 1 branch in the linear lane, 2 branches at the "T" intersection, and 3 branches at the "X" intersection; After the positioning base station is installed, the mine tunnel location coordinate model is established, and the mine tunnel positioning and path navigation are carried out; The mine tunnel position coordinate model is established as follows: (11) According to the actual installation location of the positioning base station, determine the coordinates of all positioning base stations in the mine GIS tunnel map; (12) Setting the network address, effective coverage distance value and directional characteristics of the positioning base station; (13) Establish a logical connection relationship diagram of positioning base stations, and map any location in the mine GIS tunnel map to the coverage distance value of a certain positioning base station; (14) Add important places in the mine tunnels to the mine GIS tunnel map, mark the location coordinate information, and bind it with the network address, distance and direction of the positioning base station; The mine tunnel positioning is as follows: In the mine tunnels, a base station is installed at a certain distance to achieve full coverage of the tunnels; UWB point-to-point ranging based on TOF technology requires four communications when the positioning module obtains the ranging result: ranging request frame POLL, ranging response frame RESP, ranging data frame FINAL and ranging report frame REPORT; The distance calculation formula between the positioning module and the positioning base station is: Where: T SP Indicates the sending timestamp of the ranging request frame; T RP Indicates the receiving timestamp of the ranging request frame; T SR Indicates the sending timestamp of the ranging response frame; T RR Indicates the receiving timestamp of the ranging response frame; T SF Indicates the sending timestamp of the ranging data frame; T RF Indicates the receiving timestamp of the ranging data frame; C is the speed of light, 3.0×10 8 m / s; According to the one-dimensional linear space characteristics of the mine tunnel, the two UWB antennas of the positioning base station must be installed in pairs, with a distance D between them. Δ ; The distance measurement results of the two UWB antennas of the identification positioning module and the positioning base station are D1 and D2 respectively. The mechanism for determining the direction of the positioning module is as follows: (21) D2<D1 and D2>D Δ When , the positioning module is on the left side of the positioning base station, the distance is D2, and the direction is positive; (22) D1<D2 and D1>D Δ When , the positioning module is on the right side of the positioning base station, the distance is D1, and the direction is negative; (23)D1<D Δ And D2<D Δ When the positioning module is between the two UWB antennas of the positioning base station, the distance is D1 or D2; After the positioning base station completes the precise positioning of the positioning module, it informs the positioning module through the ranging report frame REPORT, and the positioning module obtains the position coordinate information, that is, the address of the positioning base station, the positioning distance value and the direction characteristics; The mining mobile phone displays the specific location and surrounding environment of the positioning module on the mine tunnel map based on the location coordinate information of the positioning module, including the address of the positioning base station, the positioning distance value and the direction characteristics, and updates it in real time; The path navigation is: According to the UWB precise positioning results between the positioning module of the mining mobile phone and the positioning base station, the current position coordinate information is obtained, including the address, positioning distance value and direction characteristics of the positioning base station. After the target object is input, the position coordinate information of the target object is obtained through the mine GIS tunnel map, including the address, positioning distance value and direction characteristics of the positioning base station; Given the current location coordinate information or the starting location coordinate information and the location coordinate information of the target object, the path navigation between the two can be completed by traversing and querying the logical connection relationship diagram of the positioning base station. The specific process is as follows: (31) Determine the current location or departure location and find the corresponding node in the positioning base station logical relationship diagram; (32) Find out which branch nodes the graph node has; (33) Selecting a branch node from the plurality of branch nodes in ascending order of the positioning base station address as a temporary path node and storing it in the navigation path cache queue; (34) Determine whether the temporary path node is the location coordinate information of the target object. If so, the path node stored in the navigation path cache queue is the navigation path; if not, enter (35); (35) Find out which branch nodes the temporary path node has, remove the branch nodes that have been queried, and if there are no branch nodes, delete the temporary path node from the navigation path cache queue, return to the previous level according to the navigation path cache queue, and repeat (35); If there are still branch nodes, select a branch node as a temporary path node according to the order of the positioning base station address from small to large, and store it in the navigation path cache queue, and repeat (34).