A high-precision positioning method and sensor
By utilizing anchor nodes and interference effects in wireless sensor networks, combined with UWB and GPS technologies, the problems of low positioning accuracy and large power consumption in the existing technology are solved, and a high-precision and low-power positioning method is realized to satisfy users need.
Patent Information
- Application Number
- CN202210785462.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-07-05
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2042-07-05
AI Technical Summary
The existing wireless communication equipment has low positioning accuracy in continuous scanning mode and consumes too much power, which cannot meet users' needs for high-precision positioning.
Multiple anchor nodes are used to estimate unknown node locations, and by establishing a wireless sensor network, using interference effect and UWB ultra-wideband three-dimensional algorithm, combining WiFi and GPS modules, the vibration period of the node is calculated by receiving and processing single tone signals transmitted by gateway nodes. In order to obtain positioning information, reduce hardware costs and power consumption.
It realizes high-precision positioning, reduces the power consumption of the equipment, simplifies the equipment design, and meets users' needs for high-precision positioning.
Smart Images

Figure CN115334446B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of positioning technology, and in particular to a high-precision positioning method and a sensor. Background Art
[0002] Wireless communication technology is widely used in electronic devices. Once the wireless connector in the electronic device is turned on, nearby wireless devices can be detected. For example, a smartphone will display nearby Bluetooth devices and the signal strength of the devices after turning on Bluetooth. The search unit of the wireless module of the mobile electronic device can be maintained in a continuous scanning mode through program control. In this continuous scanning mode, the device searches for nearby available wireless signal devices and locates them. Although the continuous scanning mode usually does not require user intervention, it may be power-intensive, consuming too much power and with low positioning accuracy, which cannot meet the user's positioning needs for the device. For this reason, we propose a high-precision positioning method and sensor. Summary of the invention
[0003] The purpose of the present invention is to solve the shortcomings of the prior art and to propose a high-precision positioning method and sensor.
[0004] In order to achieve the above object, the present invention adopts the following technical solutions:
[0005] A high-precision positioning method comprises the following steps:
[0006] Step 1: Set up a detection area and transform the problem of estimating the position of an unknown node using multiple anchor nodes: Assume that the anchor nodes are P1(X1, Y1), P2(X2, Y2)...Pn(Xn, Yn), the unknown node P(x, y), the true distance is r1, r2,...rn, the sensor ranging error range is ε1, ε2,...εn, and the measured distance from the anchor node to the unknown node is d1, d2,...dn.
[0007] Step 2: Diagnose whether it is the initial positioning;
[0008] Step 3: Establish a model. In a wireless sensor network consisting of N sensor nodes, all nodes are randomly deployed. The capability model is established by measuring the energy of sound signals emitted by an unknown target source.
[0009] Step 4: Module packaging;
[0010] Step 5: Interference positioning: By adding gateway transmitting nodes at different locations and transmitting single-tone signals in different time slots, several hyperbolic equations with the gateway node as the focus can be obtained. The location information of the node to be located can be obtained by solving them together.
[0011] Step 6: Measure the node vibration period. The receiving node will obtain the number of node vibration periods by squaring the interference signal and passing it through a low-pass filter.
[0012] As a further preferred embodiment of the present technical solution: in the step 2, determine whether it is the initial positioning. If it is the initial positioning, calculate the two-dimensional coordinates and the height value through the UWB ultra-wideband three-dimensional algorithm, and then keep the data. If it is not the initial positioning, obtain the previously maintained two-dimensional coordinates and the height value, and then update the height value through the UWB ultra-wideband.
[0013] As a further preferred embodiment of the present technical solution: in step 3, the mathematical model of the sound signal energy received by the sensor node is:
[0014] Among them, Yt is the total energy received by the i-th sensor, Yst represents the energy attenuation value when the energy of the target source is transferred to the i-th node, S represents the gain of the i-th sensor, S represents the energy value of the target sound source, and d1 represents the distance from the i-th sensor to the target.
[0015] As a further preferred embodiment of the present technical solution: in step 5, the single tone signal transmitted by the gateway anchor node A:
[0016] S1=Acos(2πf1t+φ1) (1)
[0017] The single tone signal transmitted by the gateway anchor node B:
[0018] S2=Bcos(2πf2t+φ2) (2)
[0019] In a line-of-sight environment, the received signal of receiving node C is as follows, where nt is the noise signal:
[0020] S = A'cos[2πf1(t+d AC / c)+φ1]+B′cos[2πf2(t+d BC / c)+φ2]+n t (3)
[0021] After transformation, we get the signal:
[0022] S = A′cos[2πf1t+(2πf1d AC / c+φ1)]+B′cos[2πf2t+(2πf2d BC / c+φ2)]+n1 (4)
[0023] The signal at the receiving end is obtained after the signal is squared and low-pass filtered:
[0024] S′=A0B0cos[2π(f1-f2)t+(2πf1d AC / c-2πf2d BC / c+φ1-φ2)]+n0 (5)
[0025] The vibration period of signal S' in time period tn is n1, and the following expression is obtained:
[0026] 2πn1=2π(f1-f2)t n +
[0027] (2πf1d AC / c-2πf2d BC / c+φ1-φ2) (6)
[0028] Similarly, for the receiving node D whose position is known, the following signal expression can be obtained:
[0029] 2πn2=2π(f1-f2)t n +(2πf1d AD / c-2πf2d BD / c+φ1-φ2)(7) (7)
[0030] Subtracting (6) from (7) yields:
[0031] n1-n2=(d AC -d AD ) / λ1+(d BD -d BC ) / λ2 (8)
[0032] The accumulated phase in (6) consists of two parts: 2π(f1-f2)tn is the accumulated phase caused by the fixed frequency difference, and 2πfd / C-2πf2dBC / c+λ1-λ2 is the accumulated phase caused by the distance difference and the initial phase. The receiving node can obtain the distance equation containing dAC, dBC and the initial phase by measuring the vibration period of the received interference signal; dAC, dBC are unknown quantities, and φ1-φ2 is also an unknown quantity. If a reference receiving node with a known position is added, φ1-φ2 can be solved by (6); and dAC-dBC is a signed value. When positioning, point C is located on one of the branches of the hyperbola with A and B as the focus.
[0033] As a further preferred embodiment of the present technical solution: when positioning a node, multiple gateway nodes are required to operate in time slots, and the receiving node often has unpredictable movements, so the time slot will be set shorter, and a certain measurement error will inevitably be introduced when the receiving node measures the vibration period. It can be seen from formula (8) that when the node position is fixed, the vibration period measurement error is inversely proportional to the wavelength of the single-tone signal; it can be seen from formula (6) that when the receiving node measures the vibration period, 2π(f1-f2)tn will directly affect the measurement difficulty. When f1-f2 is as small as possible, the measurement difficulty of the receiving end can be reduced, thereby reducing the hardware cost.
[0034] The present invention also provides a sensor for a high-precision positioning method, comprising a sensor body, a positioning module fixedly installed on the front side of the sensor body, a node carrier, a main controller, a slave controller, a WiFi module and a GPS module fixedly installed on the front side of the positioning module, the node carrier is signal-connected to the main controller, the main controller is signal-connected to the WiFi module, the slave controller is signal-connected to the GPS module, and both the main controller and the slave controller are signal-connected to the sensor body.
[0035] As a further preferred embodiment of the present technical solution: the node carrier is used to store all node information in the detection area, the main controller is used to control the WiFi module and the sensor body, the slave controller is used to control the GPS module and the sensor body, the WiFi module is used to perform network communication and establish a model by connecting to the network, and the GPS module cooperates with the WiFi module to perform interference positioning.
[0036] Compared with the prior art, the present invention has the following beneficial effects:
[0037] The WSN positioning method based on the interference effect of the present invention only needs to measure the phase of the received signal at each receiving node to achieve distributed positioning, has the advantages of simple equipment, high positioning accuracy, and low power consumption, and can meet the user's needs for positioning the device. BRIEF DESCRIPTION OF THE DRAWINGS
[0038] Figure 1 A flow chart of a high-precision positioning method proposed by the present invention;
[0039] Figure 2 A schematic diagram of positioning of a high-precision positioning method proposed by the present invention;
[0040] Figure 3 A schematic diagram of the structure of a sensor for a high-precision positioning method proposed in the present invention.
[0041] In the figure: 100, sensor body; 1, positioning module; 2, node carrier; 3, main controller; 4, slave controller; 5, WiFi module signal; 6, GPS module. DETAILED DESCRIPTION
[0042] The technical solutions in the embodiments of the present invention will be described clearly and completely below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, rather than all the embodiments.
[0043] Reference Figure 1-2 , a high-precision positioning method, comprising the following steps;
[0044] Step 1: Set up a detection area and transform the problem of estimating the position of an unknown node using multiple anchor nodes: Assume that the anchor nodes are P1(X1, Y1), P2(X2, Y2)...Pn(Xn, Yn), the unknown node P(x, y), the true distance is r1, r2,...rn, the sensor ranging error range is ε1, ε2,...εn, and the measured distance from the anchor node to the unknown node is d1, d2,...dn.
[0045] Step 2: Diagnose whether it is the first positioning. If it is the first positioning, calculate the two-dimensional coordinates and height value through the UWB ultra-wideband three-dimensional algorithm, and then keep the data. If it is not the first positioning, obtain the previously kept two-dimensional coordinates and height value, and then update the height value through the UWB ultra-wideband.
[0046] Step 3: Establish a model. In a wireless sensor network consisting of N sensor nodes, all nodes are randomly deployed. The ability model is established by measuring the energy of the sound signal emitted by an unknown target source. The mathematical model of the sound signal energy received by the sensor node is:
[0047] Where Yt is the total energy received by the i-th sensor, Yst is the energy attenuation value when the energy of the target source is transferred to the i-th node, S is the gain of the i-th sensor, S is the energy value of the target sound source, and d1 is the distance from the i-th sensor to the target;
[0048] Step 4: Module packaging;
[0049] Step 5: Interference positioning: By adding gateway transmitting nodes at different locations and transmitting single-tone signals in different time slots, several hyperbolic equations with the gateway node as the focus can be obtained. The location information of the node to be located can be obtained by solving them together. This is a method of indirectly measuring distance by measuring phase information. The node can realize its own positioning only by receiving the signal sent by the gateway node, which greatly reduces the node energy consumption.
[0050] The single tone signal transmitted by the gateway anchor node A:
[0051] S1=A cos(2π f1t+φ1) (1)
[0052] The single tone signal transmitted by the gateway anchor node B:
[0053] S2=B cos(2πf2t+φ2) (2)
[0054] In a line-of-sight environment, the received signal of receiving node C is as follows, where nt is the noise signal:
[0055] S = A'cos[2πf1(t+d AC / c)+φ1]+B′cos[2πf2(t+d BC / c)+φ2]+n t (3)
[0056] After transformation, we get the signal:
[0057] S = A′cos[2πf1t+(2πf1d AC / c+φ1)]+B′cos[2πf2t+(2πf2d BC / c+φ2)]+n t (4)
[0058] The signal at the receiving end is obtained after the signal is squared and low-pass filtered:
[0059] S′=A0B0cos[2π(f1-f2)t+(2πf1d AC / c-2πf2d BC / c+φ1-φ2)]+n0 (5)
[0060] The vibration period of signal S' in time period tn is n1, and the following expression is obtained:
[0061] 2πn1=2π(f1-f2)t n +
[0062] (2πf1d AC / c-2πf2d BC / c+φ1-φ2) (6)
[0063] Similarly, for the receiving node D whose position is known, the following signal expression can be obtained:
[0064] 2πn2=2π(f1-f2)t n +(2πf1d AD / c-2πf2d BD / c+φ1-φ2)(7) (7)
[0065] Subtracting (7) from (7) yields:
[0066] n1-n2=(d AC -d AD ) / λ1+(d BD -d BD ) / λ2 (8)
[0067] The accumulated phase in (6) consists of two parts: 2π(f1-f2)tn is the accumulated phase caused by the fixed frequency difference, and 2πfd / C-2πf2dBC / c+λ1-λ2 is the accumulated phase caused by the distance difference and the initial phase. The receiving node can obtain the distance equation containing dAC, dBC and the initial phase by measuring the vibration period of the received interference signal; dAC, dBC are unknown quantities, and φ1-φ2 is also an unknown quantity. If a reference receiving node with a known position is added, φ1-φ2 can be solved by (6); and dAC-dBC is a signed value. When positioning, point C is located at the double focal point with A and B as the focus. On one branch of the curve, when locating the node, multiple gateway nodes need to operate in time slots, and the receiving node often has unpredictable movements, so the time slot will be set shorter, and a certain measurement error will inevitably be introduced when the receiving node measures the vibration period. It can be seen from formula (8) that when the node position is fixed, the vibration period measurement error is inversely proportional to the wavelength of the single tone signal; it can be seen from formula (6) that when the receiving node measures the vibration period, 2π(f1-f2)tn will directly affect the measurement difficulty. When f1-f2 is as small as possible, the measurement difficulty of the receiving end can be reduced, and the hardware cost can be reduced;
[0068] Step 6: Measure the node vibration period. The receiving node will obtain the number of node vibration periods by squaring the interference signal and passing it through a low-pass filter.
[0069] Reference Figure 3The present embodiment also provides a sensor for a high-precision positioning method, including a sensor body 100, a positioning module 1 is fixedly installed on the front side of the sensor body 100, a node carrier 2, a main controller 3, a slave controller 4, a WiFi module 5 and a GPS module 6 are fixedly installed on the front side of the positioning module 1, the node carrier 2 is signal-connected to the main controller 3, the main controller 3 is signal-connected to the WiFi module 5, the slave controller 4 is signal-connected to the GPS module 6, the main controller 3 and the slave controller 4 are both signal-connected to the sensor body 100, the node carrier 2 is used to store all node information in the detection area, the main controller 3 is used to control the WiFi module 5 and the sensor body 100, the slave controller 4 is used to control the GPS module 6 and the sensor body 100, the WiFi module 5 is used to perform network communication and establish a model by connecting to the network, and the GPS module 6 cooperates with the WiFi module 5 to perform interference positioning.
[0070] The above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can make equivalent replacements or changes according to the technical scheme and inventive concept of the present invention within the technical scope disclosed by the present invention, which should be covered by the protection scope of the present invention.
Claims
1. A high-precision positioning method, characterized in that: The following steps are involved: Step 1: Set up a detection area and transform the problem of estimating the position of an unknown node using multiple anchor nodes: Assume that the anchor nodes are P1(X1, Y1), P2(X2, Y2)...Pn(Xn, Yn), the unknown node P(x, y), the true distance is r1, r2,...rn, the sensor ranging error range is ε1, ε2,...εn, and the measured distance from the anchor node to the unknown node is d1, d2,...dn. Step 2: Diagnose whether it is the initial positioning; Step 3: Establish a model. In a wireless sensor network consisting of N sensor nodes, all nodes are randomly deployed. The capability model is established by measuring the energy of sound signals emitted by an unknown target source. Step 4: Module packaging; Step 5: Interference positioning: By adding gateway transmitting nodes at different locations and transmitting single-tone signals in different time slots, several hyperbolic equations with the gateway node as the focus can be obtained. The location information of the node to be located can be obtained by solving them together. Step 6: Measure the node vibration period. The receiving node will obtain the number of node vibration periods by squaring the interference signal and passing it through a low-pass filter.
2. A high-precision positioning method according to claim 1, characterized in that: In step 2, determine whether it is the initial positioning. If it is the initial positioning, calculate the two-dimensional coordinates and height value through the UWB ultra-wideband three-dimensional algorithm, and then keep the data. If it is not the initial positioning, obtain the previously maintained two-dimensional coordinates and height value, and then update the height value through the UWB ultra-wideband.
3. A high-precision positioning method according to claim 1, characterized in that: In step 3, the mathematical model of the sound signal energy received by the sensor node is: Among them, Yt is the total energy received by the i-th sensor, Yst represents the energy attenuation value when the energy of the target source is transferred to the i-th node, S represents the gain of the i-th sensor, S represents the energy value of the target sound source, and d1 represents the distance from the i-th sensor to the target.
4. A high-precision positioning method according to claim 1, characterized in that: In step 5, the single tone signal transmitted by the gateway anchor node A: S1=Acos(2πf1t+φ1) (1) The single tone signal transmitted by the gateway anchor node B: S2=Bcos(2πf2t+φ2) (2) In a line-of-sight environment, the received signal of receiving node C is as follows, where nt is the noise signal: S=A′cos[2πf1(t+d AC / c)+φ1]+B′coS[2πf2(t+d BC / c)+φ2]+n t (3) After transformation, we get the signal: S=A′cos[2πf1t+(2πf1d AC / c+φ1)]+B′cos[2πf2t+(2πf2d BC / c+φ2)]+n t (4) The signal at the receiving end is obtained after the signal is squared and low-pass filtered: S′=A0B0cos[2π(f1-f2)t+(2πf1d AC / c-2πf2d BC / c+φ1-φ2)]+n0 (5) The vibration period of signal S' in time period tn is n1, and the following expression is obtained: 2πn1=2π(f1-f2)t n +(2πf1d AC / c-2πf2d BC / c+φ1-φ2) (6) Similarly, for the receiving node D whose position is known, the following signal expression can be obtained: 2πn2=2π(f1-f2)t n +(2πf1d AD / c-2πf2d BD / c+φ1-φ2) (7) Subtracting (6) from (7) yields: n1-n2=(d AC -d AD ) / λ1+(d BD -d BC ) / λ2 (8) The accumulated phase in (6) consists of two parts: 2π(f1-f2)tn is the accumulated phase caused by the fixed frequency difference, and 2πfd / C-2πf2dBC / c+λ1-λ2 is the accumulated phase caused by the distance difference and the initial phase. The receiving node can obtain the distance equation containing dAC, dBC and the initial phase by measuring the vibration period of the received interference signal; dAC, dBC are unknown quantities, and φ1-φ2 is also an unknown quantity. If a reference receiving node with a known position is added, φ1-φ2 can be solved by (6); dAC-dBC is a signed value. When positioning, point C is located on one of the branches of the hyperbola with A and B as foci.
5. A high-precision positioning method according to claim 4, characterized in that: When locating a node, multiple gateway nodes are required to operate in time slots. However, the receiving node often has unpredictable movements, so the time slot will be set shorter. When the receiving node measures the vibration period, a certain measurement error will inevitably be introduced. From formula (8), it can be seen that when the node position is fixed, the vibration period measurement error is inversely proportional to the wavelength of the single tone signal. From (6), it can be seen that when the receiving node measures the vibration period, 2π(f1-f2)tn will directly affect the measurement difficulty. When f1-f2 is as small as possible, the measurement difficulty of the receiving end can be reduced, thereby reducing the hardware cost.
