CN116106823A - TDOA-PDOA combined positioning method based on particle swarm optimization - Google Patents
TDOA-PDOA combined positioning method based on particle swarm optimization Download PDFInfo
- Publication number
- CN116106823A CN116106823A CN202310131914.0A CN202310131914A CN116106823A CN 116106823 A CN116106823 A CN 116106823A CN 202310131914 A CN202310131914 A CN 202310131914A CN 116106823 A CN116106823 A CN 116106823A
- Authority
- CN
- China
- Prior art keywords
- pdoa
- tdoa
- particle swarm
- cost function
- swarm optimization
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Withdrawn
Links
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000005457 optimization Methods 0.000 title claims abstract description 23
- 239000002245 particle Substances 0.000 title claims abstract description 13
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 18
- 238000004364 calculation method Methods 0.000 claims abstract description 6
- 239000013598 vector Substances 0.000 claims description 6
- 239000002131 composite material Substances 0.000 claims description 2
- 238000004088 simulation Methods 0.000 abstract description 6
- 230000008901 benefit Effects 0.000 abstract description 5
- 238000005259 measurement Methods 0.000 abstract description 4
- 238000013459 approach Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000009466 transformation Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 238000007476 Maximum Likelihood Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 230000001627 detrimental effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0257—Hybrid positioning
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
The invention relates to a TDOA-PDOA joint positioning method based on particle swarm optimization, which combines the TDOA and PDOA measurement to form a joint cost function utilizing all available information, combines the influence average of the TDOA and the PDOA, improves the positioning precision, solves the optimization problem through quasi-Newton optimization and initializes a PSO algorithm, defines the PSO search space, improves the possibility of converging the solution of the node position to a global optimal value, reduces the total calculation complexity, and increases the population scale, wherein the root mean square error of the algorithm tends to converge to the lower limit; and the simulation experiment result shows that the combination method provided by the inventor has obvious advantages in position estimation.
Description
Technical Field
The invention relates to the technical field of positioning methods, in particular to a TDOA-PDOA combined positioning method based on particle swarm optimization.
Background
Along with the rapid development of Wireless Sensor Network (WSN) technology and a positioning method thereof, positioning becomes one of basic services for WSN data acquisition. Positioning accuracy generally depends on the accuracy of the distance estimation. Due to limitations in the size, power consumption and cost of sensor nodes, research into efficient positioning algorithms meeting the basic accuracy requirements of WSNs has met new challenges.
Disclosure of Invention
The invention provides a TDOA-PDOA combined positioning method based on particle swarm optimization for effectively solving the problems.
In order to solve the technical problems, the invention adopts the following technical scheme:
a TDOA-PDOA combined positioning method based on particle swarm optimization comprises the following steps of;
Wherein,,、/>is the lower and upper limit of the space covered by the anchor point,/->Is in combination with->Vectors of the same dimension;,/>is the standard deviation of TDOA error, +.>Is an all 1 vector, +.>Is a scaling factor;
Step 4, defining a composite functionSolving to obtain the estimated position of p by using PSO particle swarm optimization algorithm>:
given signal frequency,/>Is at the frequency +.>PDOA between the signals received at anchors Ri and Rj;
wherein->And->The variance of the TDOA and PDOA estimation errors in square seconds, respectively; />Is the PDOA variance in square radians.
after the technical scheme is adopted, compared with the prior art, the invention has the following advantages:
the invention combines the TDOA and PDOA measurement to form a combined cost function utilizing all available information, combines the influence average of the TDOA and the PDOA, improves the positioning precision, solves the optimization problem through quasi-Newton optimization, initializes the PSO algorithm, defines the PSO search space, improves the possibility of converging the solution of the node position to the global optimal value, reduces the total calculation complexity, and increases the population scale, the root mean square error of the algorithm tends to converge to the lower bound; and the simulation experiment result shows that the combination method provided by the inventor has obvious advantages in position estimation.
The invention will now be described in detail with reference to the drawings and examples.
Drawings
FIG. 1 is a schematic diagram of a conventional gas turbineAnd->A relation diagram of the performance and the number s of groups;
Description of the embodiments
The principles and features of the present invention are described below with reference to the drawings, the examples are illustrated for the purpose of illustrating the invention and are not to be construed as limiting the scope of the invention.
1. TDOA method
Consider a 2D or 3D space with N anchors R1, R2, an. P is the target to be located, and for any signal the difference in arrival time between anchor Ri and anchor Rj at point p is given by:
wherein I II 2 the L2 norm is represented by the number, and v is the signal propagation velocity. This formula gives the exact (true) TDOA. In practice, we have to rely on the estimated value τij of TDOA. With time synchronization maintained between the receivers, two methods can be used to estimate TDOA. By transferring the received signals to a central processor, a cross-correlation based method may be used to obtain the TDOA estimate. Another approach is to make TDOA estimates based on independently estimating the time of arrival of the signal at each anchor, thereby calculating the time difference.
Using the TDOA information acquired by any one of the above or other methods, the target position may be estimated. In the present invention, we use the maximum likelihood method, which can be expressed as follows:
From equation (3), we can see that for a particular,/>May be a convex function. However, in general, the function +.>Must be handled in a non-convex optimization framework. For this reason, convex relaxation is a method representing an effective way.
PDOA method
Here the number of the elements is the number,is the PDOA between the signals received at anchors Ri and Rj at frequency fm. Since PDOA is a conventional estimate, it is given by:
wherein the method comprises the steps ofE [ -pi, pi) is the covered PDOA, (-pi)>The remainder of a divided by b is returned.
For a given estimated PDOA, we create the following cost function:
in equation (6), the covered PDOA can be calculated using (5). Scalar->Is a weighting factor given by:
wherein the method comprises the steps ofAnd->Is the variance of the TDOA and PDOA estimation errors in square seconds; />Is the PDOA variance in square radians. A practical way to estimate the error variance of TDOA and PDOA is to use the signal-to-noise ratio.
(6) The PDOA cost function set forth in (2) may be related to the TDOA cost function. From the definition of the wrap function, it is easy to see
Based on equation (8), equation (6) can be said to represent another form of TDOA location where the residual is subject to a nonlinear transformation by a convolution function. This transformation is not unique, which makes the cost function difficult to optimize.
3. TDOA-FPOA joint cost function
It is contemplated that the TDOA and PDOA measurements may be combined to form a joint cost function that utilizes all available information. We propose a simple way to achieve this by using a complex function given by the following formula
Wherein the method comprises the steps ofAnd->Are defined in equations (3) and (6), respectively. It is important to note here that the cost functionThe effects of TDOA and PDOA are not combined on average. Retrospective (6) and formula (7), we observe +.>Has been variance +.>And (5) weighting. Furthermore, different frequency pairs->The influence of (2) is weighted by the inverse of the corresponding PDOA error variance.
4. Optimization
In the present invention we consider a positioning based on cost functions (6) and (9). The target position can be estimated by solving for the global minimum:
or (b)
To avoid having local minima as the final result, PSO particle swarm optimization is used. PSO surrounds an initial pointA set of candidate solutions (swarm size s) is initialized. However, it is not always guaranteed that the PSO finds a global minimum, as the colony size and search area determine performance.
Two key processes to achieve good performance are: 1) The initial point of the PSO algorithm is set judiciously, 2) the boundary of the search space is set.
In order to provide a good starting point for PSO, we rely on solving the classical TDOA problem, equation (2), as a means to obtain a good starting point. To accomplish this task, there are a number of methods with well-known performance characteristics. I.e. using quasi-newton optimization to solve the optimization problem, equation (2), and initialize the PSO algorithm. We define the search space of the PSO as:
wherein,,、/>is the lower and upper limit of the space covered by the anchor point,/->Is in combination with->Vectors of the same dimension;,/>is the standard deviation of TDOA error, +.>Is an all 1 vector, +.>Is a scaling factor.
We used in all tests. By using equation (12) and equation (13), we can set the boundaries of the PSO's search space. Defining the boundary in this way improves the convergence of the solutions of equation (10) and equation (11) to globalThe likelihood of an optimal value, while reducing the overall computational complexity.
5. Summary of TDOA-PDOA positioning methods
1) Using the TDOA measurements, the initial position is calculated by solving equation (2) using quasi-newton optimization.
2) Defining a lower limit of the search space using equation (12) and equation (13)And upper limit->。
3) Comparative example: algorithm 1 (TDOA-PDOA-1) was used: executing the formula (1) and the formula (2), and then solving the formula (10) using PSO.
4) The invention comprises the following steps: algorithm 2 (TDOA-PDOA-2) was used: executing the formula (1) and the formula (2), and then solving the formula (11) using PSO.
Note that for algorithm 1, although TDOA is missing from the expression of the cost function, the use of TDOA information is still necessary for successful initialization of the algorithm.
Simulation of
To simplify the representation of the results, we tested the approach we proposed using one specific anchor configuration (n=8). The receiver is located atWhere a is formed ofm 2 Is a square of (c). In all simulations, d=2.5 m was used.
For simplicity we consider the problem of two-dimensional positioning of the target on the same plane as the anchor point. All simulation results given in the following subsections are for(all coordinates are given in m) target. For a single audio frequency, calculate using equation (1)TDOA, while the covered PDOA is calculated based on equation (5). />(e.g., m=1). However, the result can be easily extended to the case of multi-frequency/multi-carrier. TDOA and PDOA errors are modeled as zero mean and zero standard difference, respectively>And->Is a gaussian noise of (c). Is provided with->Root Mean Square Error (RMSE) was used as a performance metric. For each simulation, RMSE was calculated from 5000 trials.
The proposed method yields two algorithms, TDOAPDOA-1 and TDOA-PDOA-2, which are summarized in section 5. The performance of the proposed method is compared with the linear closed form method (TDOALinear), the SDP relaxation method (TDOA-SDP) [ iterative optimization method (TDOA-Iter). TDOA location-based CRLB (CRLB-T), PDOA location-based lower bound (LB-P), and joint TDOA-PDOA lower bound (LB-J) are also used to compare performance.
In fig. 1, we studied the effect of population numbers of particle swarm algorithm on the performance of both algorithms. The setting considers the TDOA error standard deviation(normalized by multiplying the signal propagation speed), PDOA error standard deviationAnd a size of +.>Is used for searching the space of the search. As population size increases, the root mean square error of the proposed algorithm tends to converge to a lower bound. However, in the case of TDOA informationAided by the fact that TDOA-PDOA-2 requires fewer clusters to reach the lower bound. The results in fig. 2 show the significant advantage of our proposed joint approach in position estimation.
FIG. 2 is a drawing ofAnd->RMSE at individual time and TDOA error standard deviation +.>Is a relationship of (2). When->Less than->When the joint lower bound LB-J approaches TDOA CRLB. On the contrary, when->When larger, LB-J is closer to LB-P, but whenWhen too large, the erroneous TDOA location is detrimental to the initialization of the algorithm. Further, for a sufficiently small +.>The proposed method produces results with RMSE close to the lower limit.
In FIG. 3, we change the PDOA error standard deviationSimultaneously fix->And->. When (when)When the initial position estimation is larger, the TDOA-PDOA-2 has performance close to CRLB-T under the condition of accurate initial position estimation. However, TDOA-PDOA-1 has poor performance because TDOA information is not utilized in the optimization process. TDOA-PDOA-2 is preferred over other methods, highlighting the advantage of the joint cost function (9).
The foregoing is illustrative of the best mode of carrying out the invention, and is not presented in any detail as is known to those of ordinary skill in the art. The protection scope of the invention is defined by the claims, and any equivalent transformation based on the technical teaching of the invention is also within the protection scope of the invention.
Claims (3)
1. The TDOA-PDOA combined positioning method based on particle swarm optimization is characterized by comprising the following steps of;
step 1, setting p as a target to be positioned, wherein N anchor nodes are arranged in a space where p is located, R1, R2 and R.the. RN are respectively arranged, and the coordinates of the anchor nodes Ri are R i I=1,..
Wherein (1)>、/>Is the lower and upper limit of the space covered by the anchor point,/->Is in combination with->Vectors of the same dimension; />,/>Is the standard deviation of TDOA error, +.>Is an all 1 vector, +.>Is a scaling factor;
Step 4, defining a composite functionSolving to obtain the estimated position of p by using PSO particle swarm optimization algorithm>:
2. The particle swarm optimization-based TDOA-PDOA joint positioning method according to claim 1, wherein the PDOA cost functionThe calculation formula of (2) is as follows:
given signal frequency,/>Is at the frequency +.>PDOA between the signals received at anchors Ri and Rj;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310131914.0A CN116106823A (en) | 2023-02-18 | 2023-02-18 | TDOA-PDOA combined positioning method based on particle swarm optimization |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310131914.0A CN116106823A (en) | 2023-02-18 | 2023-02-18 | TDOA-PDOA combined positioning method based on particle swarm optimization |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116106823A true CN116106823A (en) | 2023-05-12 |
Family
ID=86254081
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310131914.0A Withdrawn CN116106823A (en) | 2023-02-18 | 2023-02-18 | TDOA-PDOA combined positioning method based on particle swarm optimization |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116106823A (en) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101730227A (en) * | 2009-11-10 | 2010-06-09 | 大连理工大学 | Multi-base station secondary positioning method based on toughness estimation and arrival time difference |
CN106793087A (en) * | 2017-03-16 | 2017-05-31 | 天津大学 | A kind of array antenna indoor positioning algorithms based on AOA and PDOA |
CN107770859A (en) * | 2017-09-21 | 2018-03-06 | 天津大学 | A kind of TDOA AOA localization methods for considering base station location error |
CN115210596A (en) * | 2020-01-30 | 2022-10-18 | Idac控股公司 | Reference signal design and device procedures for downlink-based positioning/ranging using multi-frequency phase difference of arrival |
CN115379558A (en) * | 2022-08-22 | 2022-11-22 | 温州理工学院 | Mobile station position estimation method based on particle swarm optimization crow algorithm |
-
2023
- 2023-02-18 CN CN202310131914.0A patent/CN116106823A/en not_active Withdrawn
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101730227A (en) * | 2009-11-10 | 2010-06-09 | 大连理工大学 | Multi-base station secondary positioning method based on toughness estimation and arrival time difference |
CN106793087A (en) * | 2017-03-16 | 2017-05-31 | 天津大学 | A kind of array antenna indoor positioning algorithms based on AOA and PDOA |
CN107770859A (en) * | 2017-09-21 | 2018-03-06 | 天津大学 | A kind of TDOA AOA localization methods for considering base station location error |
CN115210596A (en) * | 2020-01-30 | 2022-10-18 | Idac控股公司 | Reference signal design and device procedures for downlink-based positioning/ranging using multi-frequency phase difference of arrival |
CN115379558A (en) * | 2022-08-22 | 2022-11-22 | 温州理工学院 | Mobile station position estimation method based on particle swarm optimization crow algorithm |
Non-Patent Citations (2)
Title |
---|
HUI CHEN等: "A Joint TDOA-PDOA Localization Approach Using Particle Swarm Optimization", IEEE WIRELESS COMMUNICATIONS LETTERS, pages 1240 - 1244 * |
胡骏;乐英高;蔡绍堂;曹莉;吴浩;: "基于改进变异粒子群算法的TDOA/AOA定位研究", 组合机床与自动化加工技术, no. 04 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Lui et al. | Semi-definite programming algorithms for sensor network node localization with uncertainties in anchor positions and/or propagation speed | |
Wei et al. | Multidimensional scaling analysis for passive moving target localization with TDOA and FDOA measurements | |
CN108445444B (en) | Direct positioning method for correction volume Kalman filtering | |
CN109581281B (en) | Moving target positioning method based on arrival time difference and arrival frequency difference | |
Zhang et al. | Underwater source localization using TDOA and FDOA measurements with unknown propagation speed and sensor parameter errors | |
Wang et al. | A spatial–temporal positioning algorithm using residual network and LSTM | |
CN112073895A (en) | High-precision personnel positioning and tracking method based on CSI | |
CN105738865B (en) | The direct localization method of multiple target under signal waveform known conditions | |
CN106093849B (en) | A kind of Underwater Navigation method based on ranging and neural network algorithm | |
CN105911521B (en) | Associated wireless electric signal complex envelope and the direct localization method of the over-the-horizon target of carrier phase information | |
CN107592671B (en) | Networked multi-agent active variable topology autonomous cooperative positioning method | |
CN107390171B (en) | Underwater sensor node positioning method based on TOA ranging and Doppler effect | |
CN109379780B (en) | Wireless sensor network positioning method based on self-adaptive differential evolution algorithm | |
CN109188362B (en) | Microphone array sound source positioning signal processing method | |
WO2016112758A1 (en) | Method and apparatus for locating terminal | |
CN105939299A (en) | Channel parameter estimation method based on improved SAGE algorithm | |
CN110632555B (en) | TDOA (time difference of arrival) direct positioning method based on matrix eigenvalue disturbance | |
CN103323815A (en) | Underwater acoustic locating method based on equivalent sound velocity | |
CN104699965A (en) | Estimation method of parameters of near-field source based on rotating interferometer | |
CN109195110A (en) | Indoor orientation method based on hierarchical clustering technology and online extreme learning machine | |
CN109696657A (en) | A kind of coherent sound sources localization method based on vector hydrophone | |
CN106371078B (en) | Multi-emitting source Passive Location based on transmitted waveform and position Combined estimator | |
CN106125059B (en) | Nonparametric Combined estimator signal and the Passive Location of position | |
Chen et al. | DeepMetricFi: Improving Wi-Fi fingerprinting localization by deep metric learning | |
Sun et al. | Successive and asymptotically efficient localization of sensor nodes in closed-form |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WW01 | Invention patent application withdrawn after publication | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20230512 |