A UWB terminal autonomous positioning method based on wireless clock synchronization
By adopting the autonomous positioning method of UWB terminals with wireless clock synchronization at the coal mine site, using UWB base station packets and TOF ranging, the problem of insufficient positioning concurrency is solved, and high-precision and efficient positioning of coal mine personnel is achieved, and multiple terminals on the coal mine site are met. Positioning needs.
Patent Information
- Application Number
- CN202210869758.3
- 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
At this stage, the positioning system of the on-site personnel of coal mines cannot further increase the positioning concurrency and cannot meet the increasing demands of positioning terminals. Especially in the environment of high signal-to-noise ratio and electromagnetic interference, the traditional base station or central station positioning engine solution has the accuracy and Efficiency limitations.
Adopt the UWB terminal autonomous positioning method based on wireless clock synchronization, and group the UWB base stations, each group includes one master base station and three slave base stations, and use TOF ranging and timing allocation to realize information frame broadcast, and the positioning terminal receives and synchronizes the time stamp. , calculate the distance difference, combine the base station coordinates to perform coordinate calculation, and upload the final positioning coordinates through wireless communication.
It realizes high-precision clock synchronization, theoretically, infinitely improves the positioning concurrency, fast positioning speed, no need to upload timestamps to the central station, and can provide efficient positioning services in complex environments.
Smart Images

Figure CN115278533B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the field of wireless positioning and relates to a UWB terminal autonomous positioning method based on wireless clock synchronization. Background Art
[0002] In recent years, with the advancement of intelligent coal mine construction, the personnel positioning system, as one of the ten major functional systems of intelligent coal mines, plays an important role in production safety, personnel management, emergency rescue and other aspects. At this stage, the personnel positioning system has developed to the third generation, which needs to realize the precise positioning of personnel in coal mines. The first generation is based on RFID technology to realize the regional personnel positioning system. The second generation uses RFID, WiFi and other technologies to realize low-precision ranging, thereby establishing a three-dimensional positioning system for coal mines. The third generation is currently being developed with UWB technology as the mainstream technology to achieve the establishment of a high-precision personnel positioning system in coal mines through high-precision time of flight measurement. The UWB system can work under low signal-to-noise ratio conditions, and the power spectrum density emitted by the UWB system is also very low. It is almost hidden in various electromagnetic interference and noise during transmission. Therefore, it has the advantages of low power consumption, low system complexity, good confidentiality, low interception rate, and good confidentiality.
[0003] At present, the positioning of personnel on the coal mine site is all done by the base station or central station positioning engine. This positioning method is relatively simple to implement, but it cannot further improve the positioning concurrency. With the gradual increase of coal mine site positioning terminals, there are higher requirements for positioning concurrency. The terminal positioning is realized by using a similar GPS positioning principle on the coal mine site. Since each positioning terminal performs independent coordinate calculation, the positioning concurrency is theoretically unlimited, which can meet the positioning needs of the increasing number of positioning terminals on the coal mine site. Summary of the invention
[0004] In view of this, an object of the present invention is to provide a UWB terminal autonomous positioning method based on wireless clock synchronization.
[0005] In order to achieve the above object, the present invention provides the following technical solutions:
[0006] A UWB terminal autonomous positioning method based on wireless clock synchronization includes the following steps:
[0007] S1: Group the UWB base stations. Each group includes a master base station and three slave base stations. Each group is responsible for positioning an area.
[0008] S2: The master base station in the positioning area is powered on and performs TOF ranging with the slave base stations in turn;
[0009] S3: The central station positioning engine allocates timing to each base station, and each base station broadcasts information frames in sequence according to the timing;
[0010] S4: The positioning terminal receives information frames from each base station and saves the timestamp, receives information frames from the master base station from the base station and saves the timestamp, and broadcasts the relevant timestamp information through the information frame;
[0011] S5: After the positioning terminal receives the last serial number of the information frame from the base station, it will analyze all the information frames received before and filter out the information frames in the same area;
[0012] S6: Synchronize the sending timestamps of all base stations in the same area to the same time starting point of the positioning terminal;
[0013] S7: The positioning terminal calculates the distance difference between the positioning terminal and any two base stations in the area, and finally uses any three sets of distance difference data from the positioning terminal to the base stations and combines the installation coordinates of the four base stations to realize the coordinate solution of the positioning terminal;
[0014] S8: randomly combine the four base stations in the area to obtain four sets of positioning coordinates, and finally filter the four sets of positioning coordinates, and use the processed coordinates as the positioning coordinates;
[0015] S9: The positioning coordinates are uploaded to the central station positioning engine via wireless communication, and the central station positioning engine displays the coordinates and trajectories.
[0016] Furthermore, the positioning terminal includes a main control MCU module, a UWB module, a DC / DC module, a wireless communication module, a FLASH module, a display module, a real-time clock RTC module, and a watchdog module connected to the main control MCU module; the main control MCU module controls the UWB module to realize the UWB transceiver function, and analyzes the received information frame to solve the positioning coordinates of the positioning terminal; the DC / DC module performs voltage reduction and filtering on the lithium battery supply voltage; the wireless communication module is responsible for uploading the coordinates solved by the main control MCU module and issuing related configurations; the FLASH module stores the positioning terminal configuration information and GIS map information; the display module is used to display the positioning information; 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.
[0017] Further, the master and slave base stations in the positioning area broadcast information frames in sequence according to the information frame broadcasting timing, and immediately after the first round of information frames are broadcast, the second round of broadcasting is carried out, and the broadcasting is carried out in a loop;
[0018] Tag is the positioning terminal, where MAnchor is the main base station in the positioning area, SAnchor1~SAnchorN are slave base stations in the positioning area, TB1 is the timestamp of the previous round of MAnchor broadcast information frame, TB2 is the timestamp of the current round of MAnchor broadcast information frame, TA2 and TC2 respectively represent the timestamps of the time when Tag and SAnchor1 receive the current round of MAnchor broadcast information frame, TBC represents the time required for the information frame to be transmitted from MAnchor to SAnchor1; the distance d1 between MAnchor and SAnchor1 is measured by DS-TWR when MAnchor is powered on, and the value of TBC is solved according to the distance being equal to the speed of light multiplied by time; TC23 is SAnchor The time difference between r1 receiving the MAnchor broadcast information frame and SAnchor1 sending the broadcast information frame. SAnchor1 broadcasts the information frame at TC3, and carries two time interval values, TBC and TC23, in the information frame. Tag receives the information frame broadcast by SAnchor1 at TA3 and records the timestamp. Tag regards the information frame broadcast by SAnchor1 as being sent at TC4 and receiving the information frame at TA4, so that the information frames broadcast by MAnchor and SAnchor1 are sent at the same time. ΔTBC represents the time difference between the MAnchor and SAnchor1 information frames transmitted to the Tag. Similarly, the time difference between any two Anchor information frames broadcast to the Tag in the area is calculated.
[0019] The time synchronization coefficient between Tag and SAnchor1 is:
[0020] TA2-TA1=k(TC2-TC1) (1)
[0021] The formula for solving the time difference after time synchronization is as follows:
[0022]
[0023] ΔTBC represents the time difference between MAnchor and SAnchor1 transmitted to Tag; TA3 represents the timestamp of the information frame received by Tag from SAnchor1; TC3 represents the timestamp of the information frame broadcast by SAnchor1; TC2 represents the timestamp of the information frame received by SAnchor1 from MAnchor; TA2 represents the timestamp of the information frame received by Tag from MAnchor; d1 represents the distance between Manchor and SAnchor; c represents the speed of light; k represents the time synchronization coefficient between Tag and SAnchor1.
[0024] Furthermore, the positioning terminal calculates the reception time difference between any two anchor information frames, and the set of points satisfying the time difference obtains a hyperbola, and three hyperbolas are obtained, and their intersection point is the coordinate of the positioning terminal;
[0025] Let the coordinates of the three base stations MAnchor, SAnchor1, and SAnchor2 be (x a ,y a )、(x b ,y b )、(x c ,y c ), the coordinates of the positioning terminal Tag are (x, y), and the following formula is obtained by intersecting three hyperbolas:
[0026]
[0027] Where: t a Indicates the timestamp of receiving the MAnchor information frame after equivalent; t b Indicates the timestamp of receiving the SAnchor1 information frame after equivalent; t c Indicates the timestamp of receiving the SAnchor2 information frame after equivalent;
[0028] Formula (3) is solved to obtain the specific values of the positioning terminal coordinates (x, y). A positioning area consists of four base stations. Three base station data are randomly selected for solution, and a total of four sets of coordinate values are solved. After the four coordinate values are processed by Kalman filtering, the final positioning terminal coordinate values are obtained.
[0029] Furthermore, the least square method and triangle centroid method are used to deal with the measurement errors existing in real situations and make the best estimate of the positioning terminal coordinates.
[0030] The beneficial effects of the present invention are:
[0031] 1. High precision of synchronous clock: wireless clock synchronization method is used for clock synchronization to ensure clock accuracy;
[0032] 2. Unlimited concurrent positioning: coordinate settlement is performed through the positioning terminal, and the theoretical concurrent positioning is unlimited;
[0033] 3. Fast positioning speed: local solution is performed through the positioning terminal, and there is no need to upload the timestamp to the central station positioning engine for solution.
[0034] 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
[0035] 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:
[0036] Figure 1 This is a flow chart of the UWB terminal self-service positioning method based on wireless clock synchronization according to the present invention;
[0037] Figure 2 A block diagram for positioning terminal;
[0038] Figure 3 This is the hardware block diagram of the positioning terminal;
[0039] Figure 4 It is a timing diagram for positioning the positioning terminal;
[0040] Figure 5 This is a schematic diagram of positioning coordinate solution. DETAILED DESCRIPTION
[0041] 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.
[0042] 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.
[0043] 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.
[0044] like Figure 1 As shown, the present invention provides a UWB terminal autonomous positioning method based on wireless clock synchronization. Before positioning, the UWB base stations are grouped, each group includes a master base station and three slave base stations, and each group of four base stations is responsible for the positioning of an area. The master base station of the group can also be the master base station or slave base station of other groups at the same time. Similarly, the slave base station of the group can also be the master base station or slave base station of other groups. After the master base station of each positioning area is powered on, it will actively perform TOF ranging with the slave base station in sequence. Since the DS-TWR method in TOF ranging is used for ranging, the ranging error caused by the mismatch of the crystal oscillator clock of the two base stations can be minimized, and the result of filtering the multiple ranging distances is used as the distance between the master and slave base stations. The central station positioning engine allocates timing to the base stations. The master and slave base stations broadcast information frames in sequence according to the timing. The positioning terminal will receive information from all information frames and save the timestamps. The slave base station will also receive information frames sent by the master base station and save the timestamps, and broadcast the relevant timestamp information through the information frames. When the positioning terminal receives the last serial number of the slave base station information frame, it will analyze all the information frames received before, and synchronize the sending timestamps of all base stations in the area to the same time starting point of the positioning terminal. In this way, the positioning terminal can solve the distance difference between the positioning terminal and any two base stations in the area. Finally, the positioning terminal coordinates can be solved by using any three sets of distance difference data from the positioning terminal to the base station and combining the installation coordinates of the four base stations. Randomly combining the four base stations can solve four sets of positioning coordinates. Finally, the four sets of positioning coordinates are filtered and processed. The processed coordinates are used as positioning coordinates, and the positioning coordinates are uploaded through wireless communication technologies such as 4G and WiFi. After receiving the coordinate data, the central station positioning engine displays the coordinates and trajectory. The positioning block diagram is as follows Figure 2 shown.
[0045] like Figure 3 As shown in the figure, the positioning terminal is composed of the main control MCU, UWB module, DC / DC, WiFi / 4G, FLASH, LCD display module and other components. The main control MCU uses an ultra-low power standby MCU. The main control MCU controls the UWB module to realize the UWB transceiver function, analyzes the received information frame, solves the positioning terminal positioning coordinates, and combines the GIS map for real-time coordinate display. The DC / DC module performs voltage reduction and filtering on the lithium battery power supply voltage, the WiFi / 4G module is responsible for uploading the coordinates solved by the positioning terminal and issuing related configurations, the FLASH stores the positioning terminal configuration information and GIS map information, and the LCD screen is responsible for displaying the positioning information of the positioning terminal.
[0046] like Figure 4As shown, the master and slave base stations in the positioning area broadcast information frames in sequence according to the information frame broadcast timing. After the first round of information frames are broadcast, the second round of broadcasting is immediately carried out, and the broadcasting is carried out in a loop. As shown in the figure below, Tag is the positioning terminal, where MAnchor is the master base station in the positioning area, SAnchorN is the corresponding slave base station, TB1 is the timestamp of the previous round of information frames broadcast by MAnchor, TB2 is the timestamp of the current round of information frames broadcast by MAnchor, TA2 and TC2 respectively represent the timestamps of the time when Tag and SAnchor1 receive the information frames broadcast by MAnchor in this round, and TBC represents the time required for the information frame to be transmitted from MAnchor to SAnchor1. Since the distance d1 between MAnchor and SAnchor1 has been measured by DS-TWR when MAnchor is powered on, the value of TBC can be solved according to the formula that distance is equal to the speed of light multiplied by time. TC23 is the time difference between SAnchor1 receiving the MAnchor broadcast information frame and SAnchor1 sending the broadcast information frame. SAnchor1 broadcasts the information frame at TC3, and carries two time interval values, TBC and TC23, in the information frame. Tag receives the information frame broadcast by SAnchor1 at TA3 and records the timestamp.
[0047] Since the SAnchor1 broadcast information frame contains the time interval values of TBC and TC23, the Tag can equate the SAnchor1 broadcast information frame to be sent from TC4 and received at TA4, so that the MAnchor and SAnchor1 broadcast information frames are sent at the same time. ΔTBC can represent the time difference between the MAnchor and SAnchor1 information frames transmitted to the Tag. Similarly, the Tag can also equate the receiving timestamps of the SAnchor2, SAnchor3 and SAnchorN broadcast information frames, so that the Tag can obtain the time difference between any two Anchor information frames in the area broadcast to the Tag.
[0048] In the above explanation, the timestamp of the SAnchor1 information frame received by the Tag is equivalent to TA4. The premise of this equivalence is that the clocks of the Tag and SAnchor1 are completely synchronized. In the actual application scenario, this condition is not met, so the clocks of the Tag and SAnchor1 need to be synchronized. In the above figure, the time interval between the previous round of information frame broadcast and the current round of information frame broadcast by MAnchor is fixed, so the interval between the two information frames received by the Tag and SAnchor1 should be the same, so the time synchronization coefficient between the Tag and SAnchor1 can be obtained, and the formula is as follows.
[0049] TA2-TA1=k(TC2-TC1) (1)
[0050] The formula for solving the time difference after time synchronization is as follows:
[0051]
[0052] Where: ΔTBC represents the time difference between MAnchor and SAnchor1 transmitted to Tag; TA3 represents the timestamp of the information frame received by Tag from SAnchor1; TC3 represents the timestamp of the information frame broadcast by SAnchor1; TC2 represents the timestamp of the information frame received by SAnchor1 from MAnchor; TA2 represents the timestamp of the information frame received by Tag from MAnchor; d1 represents the distance between Manchor and SAnchor; c represents the speed of light; k represents the time synchronization coefficient between Tag and SAnchor1.
[0053] like Figure 5 As shown, the positioning terminal calculates the reception time difference of any two Anchor information frames. The points that satisfy the time difference are a hyperbola. At least three hyperbolas are required to solve the positioning coordinates. The intersection point of the three hyperbolas is the coordinate of the positioning terminal.
[0054] The coordinates of the three base stations MAnchor, SAnchor1, and SAnchor2 are (x a ,y a )、(x b ,y b )、(x c ,y c ), the coordinates of the positioning terminal Tag are (x, y), and the following formula can be obtained by intersecting three hyperbolas.
[0055]
[0056] Where: c represents the speed of light; t a Indicates the timestamp of receiving the MAnchor information frame after equivalent; t b Indicates the timestamp of receiving the SAnchor1 information frame after equivalent; t c Indicates the timestamp of receiving the SAnchor2 information frame after the equivalent.
[0057] Solving the above formula can obtain the specific value of the positioning terminal coordinates (x, y). A positioning area consists of four base stations, so three base station data can be randomly selected for solution, and a total of four sets of coordinate values can be solved. After the four coordinate values are processed by Kalman filtering, more accurate identification card coordinate values can be obtained. However, the complex on-site environment, signal interference, non-line-of-sight and other reasons will cause different distance measurement errors for each base station, and the above formula will have no solution. It is necessary to use algorithms such as the least squares method and the triangular centroid method to deal with the measurement errors in the actual situation and make the best estimate of the positioning terminal coordinates.
[0058] 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 UWB terminal autonomous positioning method based on wireless clock synchronization, characterized in that: The following steps are involved: S1: Group the UWB base stations. Each group includes a master base station and three slave base stations. Each group is responsible for positioning an area. S2: The master base station in the positioning area is powered on and performs TOF ranging with the slave base stations in turn; S3: The central station positioning engine allocates timing to each base station, and each base station broadcasts information frames in sequence according to the timing; S4: The positioning terminal receives information frames from each base station and saves the timestamp, receives information frames from the master base station from the base station and saves the timestamp, and broadcasts the relevant timestamp information through the information frame; S5: After the positioning terminal receives the last serial number of the information frame from the base station, it will analyze all the information frames received before and filter out the information frames in the same area; S6: Synchronize the sending timestamps of all base stations in the same area to the same time starting point of the positioning terminal; S7: The positioning terminal calculates the distance difference between the positioning terminal and any two base stations in the area, and finally uses any three sets of distance difference data from the positioning terminal to the base stations and combines the installation coordinates of the four base stations to realize the coordinate solution of the positioning terminal; S8: randomly combine the four base stations in the area to obtain four sets of positioning coordinates, and finally filter the four sets of positioning coordinates, and use the processed coordinates as the positioning coordinates; S9: Upload the positioning coordinates to the central station positioning engine through wireless communication, and the central station positioning engine displays the coordinates and trajectory; The positioning terminal includes a main control MCU module, a UWB module, a DC / DC module, a wireless communication module, a FLASH module, a display module, a real-time clock RTC module, and a watchdog module connected to the main control MCU module; the main control MCU module controls the UWB module to realize the UWB transceiver function, and analyzes the received information frame to solve the positioning coordinates of the positioning terminal; the DC / DC module performs voltage reduction and filtering on the lithium battery supply voltage; the wireless communication module is responsible for uploading the coordinates solved by the main control MCU module and issuing related configurations; the FLASH module stores the positioning terminal configuration information and GIS map information; the display module is used to display the positioning information; 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 master and slave base stations in the positioning area broadcast information frames in sequence according to the information frame broadcasting sequence. After the first round of information frames are broadcast, the second round of broadcasting is immediately followed, and the broadcasting is carried out in a loop; Tag is the positioning terminal, where MAnchor is the main base station in the positioning area, SAnchor1~SAnchorN are slave base stations in the positioning area, TB1 is the timestamp of the previous round of MAnchor broadcast information frame, TB2 is the timestamp of the current round of MAnchor broadcast information frame, TA2 and TC2 respectively represent the timestamps of the time when Tag and SAnchor1 receive the current round of MAnchor broadcast information frame, and TBC represents the time required for the information frame to be transmitted from MAnchor to SAnchor1; the distance d1 between MAnchor and SAnchor1 is measured by DS-TWR when MAnchor is powered on, and the value of TBC is solved according to the distance being equal to the speed of light multiplied by time; TC23 is the time difference between SAnchor1 receiving MAnchor broadcast information frames and SAnchor1 sending broadcast information frames. SAnchor1 broadcasts information frames at TC3, and includes two time intervals, TBC and TC23, in the information frames. Tag receives the information frames broadcast by SAnchor1 at TA3 and records the timestamp. Tag regards the information frames broadcast by SAnchor1 as being sent at TC4 and receiving the information frames at TA4, so that the information frames broadcast by MAnchor and SAnchor1 are sent at the same time. ΔTBC represents the time difference between the information frames of MAnchor and SAnchor1 being transmitted to the Tag. Similarly, the time difference between any two Anchor information frames broadcast to the Tag in the area can be obtained. The time synchronization coefficient between Tag and SAnchor1 is: TA2-TA1=k(TC2-TC1) (1) The formula for solving the time difference after time synchronization is as follows: ΔTBC represents the time difference between MAnchor and SAnchor1 transmitted to Tag; TA3 represents the timestamp of the information frame received by Tag from SAnchor1; TC3 represents the timestamp of the information frame broadcast by SAnchor1; TC2 represents the timestamp of the information frame received by SAnchor1 from MAnchor; TA2 represents the timestamp of the information frame received by Tag from MAnchor; d1 represents the distance between Manchor and SAnchor; c represents the speed of light; k represents the time synchronization coefficient between Tag and SAnchor1; The positioning terminal calculates the reception time difference between any two anchor information frames, and the set of points that satisfy the time difference obtains a hyperbola, and three hyperbolas are obtained, and their intersection point is the coordinate of the positioning terminal; Let the coordinates of the three base stations MAnchor, SAnchor1, and SAnchor2 be (x a ,y a )、(x b ,y b )、(x c ,y c ), the coordinates of the positioning terminal Tag are (x, y), and the following formula is obtained by intersecting three hyperbolas: Where: t a Indicates the timestamp of receiving the MAnchor information frame after equivalent; t b Indicates the timestamp of receiving the SAnchor1 information frame after equivalent; t c Indicates the timestamp of receiving the SAnchor2 information frame after equivalent; Formula (3) is solved to obtain the specific values of the positioning terminal coordinates (x, y). A positioning area consists of four base stations. Three base station data are randomly selected for solution, and a total of four sets of coordinate values are solved. After the four coordinate values are processed by Kalman filtering, the final positioning terminal coordinate values are obtained.
2. The UWB terminal autonomous positioning method based on wireless clock synchronization according to claim 1 is characterized in that: The least squares method and triangle centroid method are used to deal with the measurement errors that exist in real situations and make the best estimate of the positioning terminal coordinates.
