Research on multi-moving target location algorithm based on improved TDOA/FDOA

Wireless positioning and tracking technology are key technologies in applying wireless sensor networks and have vital research significance and application value. In this paper, in terms of positioning multiple non-coincident dynamic targets, aiming at the problem of low precision and large computational complexity when locating multiple dynamic targets by the two-step least squares algorithm and the constrained total least squares algorithm, an improved constrained total least squares algorithm is proposed. This algorithm fully considers the constraints, introduces the Lagrangian multiplier technology and the quasi-Newton BFGS iterative formula, avoids the calculation of the Hessian matrix, reduces the amount of calculation, and improves the positioning accuracy. Simulation experiments show that when the measurement error and sensor position error are moderate, the ICTLS positioning algorithm has a smaller RMSE than the TSWLS and CTLS positioning algorithms, showing higher positioning accuracy and stronger robustness. Secondly, aiming at the problem that the target is close to the reference node or any coordinate axis causes the positioning error of the traditional positioning algorithm to increase sharply, an optimized two-step least squares algorithm is proposed. This algorithm corrects the defects of the TSWLS algorithm by selecting the reference station and rotating the coordinate system again, and improves the positioning performance of the algorithm while reducing the amount of calculation.


Introduction
In real life, Wireless Sensor Network (WSN) is widely used and it plays an increasingly important role, and location-based devices are the key core part of all applications, while the positioning target generally occurs in a noisy environment. The measurement error is large, and the error is also large when a single TDOA (Time Difference Of Arrival) ranging technology is used to achieve target positioning. 1 To improve the algorithm's positioning accuracy, hybrid positioning technology is usually used to estimate the position information of the target. 2 When carrying out position information estimation for multiple moving targets simultaneously, it is usually necessary to use a positioning model combined with TDOA and FDOA (Frequency Difference Of Arrival) to estimate the target speed and position, which effectively improves the positioning accuracy of moving targets. 3 However, when positioning a dynamic target, the position error of the sensor and the measurement error will bring a large positioning deviation. 4 Sun et al. used the TSWLS (Two Step Weighted Least Squares) algorithm to locate multiple moving targets based on the TDOA/FDOA measurement technology combined with the sensor's position error. The experimental results show that the RMSE (Root Mean Squares Error) of the position estimation can reach CRLB (Cramer-RaoLower Bound) 5 only under the condition of the high signal-to-noise ratio. Since the TSWLS algorithm has poor adaptability to noise errors, the positioning deviation is large, and the positioning accuracy is limited. Chen Shaochang et al. proposed in the literature 6 that the constrained total least squares algorithm considers all coefficient matrices' noise in the positioning equation and obtains the target's position coordinates through the Newton iteration method. The experimental results show that this algorithm has better performance than the TSWLS algorithm. However, this algorithm estimates the location information of fixed targets based on TDOA ranging technology and is not suitable for locating moving targets. By analyzing the factors affecting the positioning performance of the TSWLS algorithm, Liu Yang et al. proposed a moving target positioning algorithm based on TDOA/FDOA to correct the positioning error. Without increasing the computational complexity, the positioning error was reduced and the ability to adapt to measurement noise is improved. Yanbin Zou et al. proposed a semi-definite programming (SDP) method, which transforms the common MLE (maximum likelihood estimator) problem into a convex optimization problem, which iterates with the position and velocity obtained by the SDP method as the initial values and updates the velocity using weighted least squares to update the position using SDP, the main advantage of this scheme is that the localization performance is more obvious under medium to high noise conditions, 7 but the position error of the sensor and the sharp decrease in localization performance when the target is close to any axis of the set reference sensor are not considered. In contrast, this paper is mainly based on TSWLS and CTLS, taking into account the sensor position error and measurement error, as well as the localization problem in special scenarios.
Based on the above analysis, this paper mainly studies the positioning of multiple moving targets from two aspects. The first aspect of the research is: Aiming at the positioning of multiple non-coincident dynamic targets, ICTLS (Improved CTLS, ICTLS) positioning is proposed on the basis of the TSWLS and CTLS positioning algorithms. The ICTLS positioning algorithm corrects two defects in the TSWLS algorithm: ffi First, the deviation of WLS estimation results increases with the increase of noise error; ffl Second, the nonlinear operation introduced in WLS causes large calculation errors, thereby reducing the accuracy of the positioning algorithm. The ICTLS algorithm proposed in the article corrects the connection between the additional variables introduced in the CTLS algorithm and the target position coordinates, and establishes global constraints based on the connection between the target and the additional variables; At the same time, the Lagrangian multiplier technology is introduced to solve the positioning equation. The BFGS iterative formula of the quasi-Newton method avoids the calculation of the Hessian matrix, reduces the amount of calculation and speeds up the convergence speed. Simulation experiments show that when the measurement error and sensor position error are moderate, the ICTLS positioning algorithm has a smaller RMSE than the TSWLS and CTLS positioning algorithms, showing higher positioning accuracy and stronger robustness.
The second aspect of the research is: in view of the fatal flaw in a variety of existing positioning algorithms, that is, when the target approaches a reference sensor or a certain coordinate axis, it will cause a sudden increase in the estimation error of the target position based on the TSWLS algorithm. For this problem, a revised TSWLS positioning algorithm was proposed. The correction algorithm first uses the first step of the TSWLS algorithm to initially estimate the target position, and then re-selects the reference sensor (in principle, the new reference sensor farthest from the target) and the rotation axis according to the estimated target position. Even if the target is approaching the reference sensor or a certain coordinate axis, the correction algorithm also shows superior positioning performance, which makes up for the loopholes in the classic TSWLS series of algorithms.

Algorithm model and positioning principle
Positioning scene K non-coincident moving targets are randomly distributed in the three-dimensional space, and the true position and speed of the ith target are recorded as u i and _ u i , i = 1, 2, Á Á Á , K, respectively. M sensors are deployed in the same three-dimensional space, Ã T is the real speed of the sensor, where s 0 j and _ s 0 j are the real position and speed of the jth sensor, ½Á 0 is the real value of ½Á, and ½Á T is the real value of ½Á transpose operation. In the article, it is assumed that the true position information of the sensor is unknown, but the measured values s j and _ s j with position error information are known, and s are the known sensor position and velocity vector, and Ds and D _ s are the sensor's position and velocity, respectively, the error vector. The vector of real information about sensor position and velocity is Similarly, the measurement vector con- Ã T is the position error vector. Also assume that the position error vector is a zero-mean Gaussian random process and the covariance matrix is Q b . For the convenience of calculation, the sensor with j = 1 is generally regarded as the reference sensor. Therefore, the true distance between target i and sensor j is: In the formula, k k 2 represents the two norms. The real and measured values of the distance difference between target i and sensors 1 and j are Where Dr j1, i is the measurement error. Therefore, the measurement vector in the TDOA form of the position information of the target i is recorded as: Where Dr i = Dr 21, i , Dr 31, i , Á Á Á , Dr M1, i ½ T is the measurement error vector.
When the target and the sensor move relative to each other, the FDOA measurement value of the target speed information can be obtained from equation (2): Among them, _ r 0 j1, i is the true distance change rate between target i and sensor j, and _ r 0 is the unit vector pointing from b to a). According to formula (3), In the same way, the FDOA measurement vector about the target speed information is obtained: r For the convenience of the following description, the TDOA and FDOA measurement vectors of the target information are often expressed as a vector equation. 8,9 Since the measurement vector of target i can be denoted Therefore, the measurement equation is denoted as a = a 1 , a 2 , Á Á Á , a K ½ T = a 0 + Da and the dimension is 2K(M À 1)31. Also assume that Da is a Gaussian random process with zero mean and the covariance matrix is the measurement error vector of Q a . The position error vector Db and the measurement error vector Da are independent of each other.

Positioning model
In order to estimate the position and velocity of the target, it is necessary to construct a TDOA/FDOA positioning equation set about the position information of the target and the sensor. To this end, an additional variable r 0 1, i = u i À s 0 1 2 is introduced, r 0 1, i and r 0 j, i are substituted into equation (2) and both sides are squared, 10 and the TDOA equations are obtained after sorting: Since the introduced additional variable r 0 1, i = u i À s 0 1 2 contains the real position coordinate information of sensor 1, we expand r 0 1, i at the sensor noise position s 1 as a first-order Taylor series, and ignore the higher-order terms above the second order, and get: Wherer 1, i = u i À s 1 k k 2 is the estimated value of r 0 1, i and assume d 1, i = r T u i , s 1 . Substituting formula (6) and s 1 = s 0 1 + Ds 1 into formula (5), we get: Differentiate equation (7) with time to obtain the FDOA equations: Where, (7) and (8) to obtain the positioning equations in matrix form: In the formula, u = w T ,r 1, i , _ w T ,_ r 1, i h i T , w = u i À s 1 , w = _ u i À _ s 1 , and the expression of A, DA, b, Db is consistent with the corresponding matrix vector expression in the literature. 11

Optimization
For the above method of solving the target positioning equation, the TSWLS positioning algorithm only considers the error of part of the coefficient matrix in the equation, 12 which causes the target estimated position error to increase; secondly, the TSWLS algorithm considers that the introduced variablesr 1, i and_ r 1, i are mutually related to w and _ w. Independence, without considering the constraint relationship between them, causing distortion of the positioning model, resulting in increased position estimation deviation. For this reason, the error of all coefficient matrices in the equation is considered in this paper, combined with the constraints between additional variablesr 1, i and_ r 1, i and w and _ w, 13 the CTLS positioning algorithm is used to estimate the position information of the target. Therefore, the value function of the vector u to be sought can be constructed as: In the formula, W u is the weighting matrix. Therefore, the least squares solution of vector u is: In the formula, b u is the estimated value of u, and e u is the optimized value of u. Since the introduced variableŝ r 1, i and_ r 1, i have a certain constraint relationship with w and _ w, it is necessary to solve equation (11) in combination with this constraint. The constraint conditions of the comprehensive formulas (1) and (4) can be expressed as:r Substituting the deformed formula (12) into the formula (10), the constraint conditions in matrix form are obtained after finishing: In the formula, Therefore, the total least squares solution of vector u becomes the CTLS solution: For solving the problem of constrained optimization minimum of formula (14), the Lagrangian multiplier technique is introduced, and the value function of A (10) becomes: Where l 1 and l 2 are the introduced Lagrange multipliers. Therefore, equation (15) is a quadratic constrained non-convex optimization problem. To solve this problem, first obtain a partial differential of equation (15) with respect to u, 14,15 and then set ∂L u, l 1 , l 2 ½ ∂u to obtain: In the formula, is the initial weighting matrix and n = Db T , Da T Â Ã T is random noise, and F 1 , . . . , F L is the coefficient matrix of the disturbance matrix DA, Db. Therefore, the final estimate of vector u is: Substituting formula (17) into the constraint formula (13) again, we get: Equation (18) composes a high-order polynomial equation set about l 1 and l 2 . l 1 and l 2 are obtained by solving the equation set and substituted into equation (17) to obtain the final estimated position information of the target. The system of high-order polynomial equations is solved by the quasi-Newton iteration method, 16 and the formula (18) can be changed to Where, Solve l using the quasi-Newton iterative formula: In the formula, l (k) is the kth iteration of l, a (k) is the step size, g (k) = rf l (k) À Á . H (k) is the symmetric matrix of the corresponding dimension, updated by the BFGS formula to: The specific steps of using the quasi-Newton BFGS formula to iterate are as follows [17][18][19][20] : Set the precision e = 10 À3 , take the initial point 4e, stop the iteration and output l k as the approximate solution; (c) Calculate the search direction p (k) = À H (k) g (k) ; (d) Let m k be the smallest non-negative integer that (e) Use the BFGS formula of the quasi-Newton method to update H (k + 1) , set k = k + 1, and go to step (b).
Finally, the obtained optimal value of l k is substituted into equation (18) to obtain the optimal estimated value of the vector u to be sought, that is, the position information of the target.

Experimental verification and result analysis
In order to verify the feasibility of the proposed ICTLS algorithm to locate multiple dynamic targets, this section designs three simulation experiments for target location scenarios. In order to compare and analyze the positioning performance of the ICTLS algorithm in detail, the simulation experiment in this article compares the simulation results of the three positioning algorithms TSWLS, CTLS, and ICTLS. The experiment is based on the simulation scheme in Ho et al. 4 It is assumed that there are six observation sensors in the three-dimensional space. The specific positions and speeds of the sensors are shown in Table 1. In this paper, two targets are taken as examples to carry out the simulation experiment of multi-target positioning, of course, it can also be extended to more targets. The real positions of the two targets to be positioned are u 0 1 = ½600, 650, 550 T and u 0 2 = ½310, 480, 245 T respectively, and the speeds of the two targets are _ u 0 1 = ½À20, 15, 40 T and _ u 0 2 = ½40, 15, À 20 T respectively. Suppose the position error of the sensor is a Gaussian random process with zero mean, and the cov- t and s 2 f are the measurement time difference and frequency difference variance respectively, set s 2 t = 10 À4 (m 2 ), and J is a (M 2 1) 3 (M + 1) square matrix, whose main diagonal element is 1 and other elements are 0.5. Run 9999 Monte Carlo experiments on a PC to compare the RMSE estimated by the ICTLS algorithm and the TSWLS and CTLS methods for target position and velocity. The RMSE of the estimated target position and velocity is defined as follows: Among them: P-RMSE and V-RMSE respectively represent the RMSE of the estimated position and velocity of the target, and e u i (l) is the estimated result of the first Monte Carlo experiment. Three positioning scenarios are designed in the article: ffi To locate a single dynamic target, the real position and speed of the target are u 0 1 = ½600, 650, 550 T and _ u 0 1 = ½À20, 15, 40 T respectively. ffl Locate two different dynamic targets. In addition to target u 0 1 , the real position and velocity of the other target are u 0 2 = ½310, 480, 245 T and _ u 0 2 = ½40, 15, À 20 T respectively. Locate two different static targets, assume that the speed of the two targets u 0 1 and u 0 2 are zero, and select the sensor s 0 3 close to u 0 2 as the reference sensor. The location distribution of targets and sensors in space is shown in Figure 1.   s)   1  299  99  151  30  220  20  2  399  151  101 230  10  20  3  299  501  199  10  220  10  4  348  201  101  10  20  30  5  2101 299 299 220  10  10  6 199 2299 2199 20 210 10 and the target position coordinate u 0 i , and does not consider the correlation between the measurement noise and the sensor position error. Therefore, the CTLS positioning algorithm cannot reach the optimal solution; the ICTLS positioning algorithm in the article is based on the CTLS algorithm, not only considering the correlation between the measurement noise and the sensor position error, but also approximating processing of the introduced additional variables reduces the estimation error in the first step, and also consider the correlation between the introduced variables and the target position into the positioning algorithm, and the optimal solution can be reached under constraints.
Therefore, this paper's ICTLS positioning algorithm has the best performance in positioning dynamic targets among the three positioning algorithms.
In terms of target speed estimation, when 10 lg s 2 s À Á 42:5dBm 2 , the RMSE of the speed estimation of the three positioning algorithms of TSWLS, CTLS, and ICTLS can all reach CRLB, and the three positioning algorithms' thresholds are, respectively, 2.5, 5, and 7.5 dBm 2 . It can be seen that the three positioning algorithms correspond to The position estimation thresholds are respectively greater than their speed estimation thresholds. Therefore, when the three positioning algorithms locate dynamic targets, the ability of speed estimation to adapt to noise is worse than that of position estimation, and the randomness of estimation errors is also increased.  Figure 3 shows the RMSE curve of position and velocity estimation deviation. The upper curve is the RMSE curve of positioning target u 0 1 , and the lower curve is the RMSE curve of positioning target u 0 2 . As can be seen from the curve in the figure, when positioning two dynamic targets u 0 1 and u 0 2 , the ICTLS positioning algorithm always has higher accuracy and stronger robustness than the other two algorithms in terms of position and velocity estimation, even if the measurement error and sensor position error CRLB can be achieved even larger. In addition, when the TSWLS and CTLS positioning algorithms are obtained from the curve in the figure, when locating a short-range target u 0 2 , the thresholds in the estimation of target position and speed are smaller than those of the long-range target u 0 1 . This shows that TSWLS and CTLS The poor performance of positioning algorithms in locating close-range targets is mainly due to the large influence of noise between close-range targets without considering the correlation of noise errors. . 5dBm 2 , the RMSE of the three positioning algorithms will increase with the increase of the error noise power, but at the same noise Under the condition of power increase, the increase in RMSE of static target position estimation error is less than the increase in RMSE of dynamic target position estimation error. The reason is the lack of some parameters such as speed and frequency when positioning the static target, which  weakens the interaction between the participating variables. Influence, improve the calculation efficiency and positioning accuracy. However, when locating the target u 0 2 close to the reference sensor, the TSWLS and CTLS positioning algorithms' threshold is obviously smaller than that of the target u 0 1 , and the positioning algorithm has poor positioning performance when locating the target close to the reference sensor.
Simulation experiments show that when the measurement error and sensor position error are moderate, the ICTLS positioning algorithm has a smaller RMSE than the TSWLS and CTLS positioning algorithms, showing higher positioning accuracy and stronger robustness. However, when the measurement error and sensor position error are large, the performance of the algorithm in this paper is not as good as expected, which is the limitation of this algorithm.

Math positioning algorithm in specific scenarios
In the previous chapter, based on the estimation of multiple targets' position by the TSWLS algorithm and the CTLS algorithm, the ICTLS positioning algorithm was proposed. This algorithm fully considered the noise of all coefficient matrices in the positioning equation, introduced the Lagrangian multiplier technology, and used the quasi-Newton The BFGS formula of the method effectively avoids the calculation of the Hessian matrix, reduces the amount of calculation, and comprehensively improves the performance of the positioning algorithm. However, whether it is the classic TSWLS, CTLS positioning algorithm, or the ICTLS positioning algorithm proposed in the article, there is a fatal flaw in locating the target, which leads to a large positioning deviation and a sharp decline in positioning performance. When the target is located at or close to any coordinate axis of the set reference sensor, the above positioning algorithm will have a large positioning deviation, and the positioning performance will drop sharply. In order to avoid the algorithm defects caused by special positioning scenarios, we carefully analyzed the principle of the above algorithm to solve the positioning equation, combined with the measurement error and the position error of the sensor, and introduced a simple and effective strategy based on the TSWLS algorithm, namely, reselecting the reference sensor and the rotating coordinate system avoids the fatal shortcomings of the above positioning algorithm and reduces the target position estimation error in a specific scene. The principle and flow of the improved algorithm to locate the target will be introduced in detail below.

Positioning scene and model establishment
To be better suitable for practical applications, the article considers positioning the target in three-dimensional space. Combining the targets and sensors set in the previous chapter, this section also assumes that M randomly distributed sensors are used to locate a static target u 0 = x 0 , y 0 , z 0 Â Ã T , the real position coordinate of the ith sensor is s 0 The measured position vector of the sensor is To be more representative, let be the reference sensor and be the origin of the coordinate system. Refer to the positioning scenario and model establishment in Chapter 2, the measurement equation based on TDOA is: Where r = r 2,k ,r 3, k , ÁÁÁ,r M,k ½ T , Dr = Dr 2,k ,Dr 3, k , ÁÁÁ, ½ Dr M, k T is the Gaussian random measurement error vector with zero mean and the covariance matrix is Q t . The additional variable r 0 k is also introduced, and r 0 k is determined by the target position coordinate u 0 and the reference sensor s 0 k . Therefore, the additional variable r 0 k is expanded by a first-order Taylor series at s 0 k , and only the linear term of Ds k is retained. After sorting, we get: In the formula,r 0 k = u 0 À s k is the estimated value of and r 0 k is the unit vector (from s k to u 0 ). Substituting equation (23) into equation (24) and finishing the pseudo-linear positioning equation for TDOA:

Algorithm optimization
Let u 0 1 = u 0 T ,r 0 k Â Ã T , synthesize all the pseudo-linear equations of formula (25) to obtain the positioning equation in matrix form of the vector to be sought: Where, h= 1 2 r 2 2,k +s T k s k Às T 2 s 2 r 2 3,k +s T k s k Às T 3 s 3 . . .  Therefore, equation (26) becomes a linear equation about u 0 1 , and the WLS estimation result of u 0 1 is: Whereû andr k are the estimated values of u and r k respectively. The weighting matrix W 1 is Define Du 1 = u 1 À u 0 1 as the estimation error of the first WLS, then the estimation error Du 1 can be expressed as So the covariance matrix of the estimated vector u 1 is When the estimated deviation of vector u 1 is relatively small, u 1 can be regarded as a random vector fluctuating around u 0 1 . Therefore, the estimated vector u 1 can be expressed as u 1 (1) = x 0 + e 1 u 1 (2) = y 0 + e 2 u 1 (3) = z 0 + e 3 u 1 (4) = r 0 In the formula, u 1 (i), i = 1, 2, 3, 4 is the ith element of the estimated vector u 1 , and e i is the estimated deviation of the ith element in u 1 . The first three elements in u 1 are respectively subtracted from the position coordinate (x k , y k , and z k ) of the reference sensor, and the two sides are squared to obtain another set of linear positioning equations: Where, h 2 = ! , e 2 is the error vector of the first WLS estimation B. Substituting formula (31) into formula (32), after sorting, we get: Where e 2 (i), i = 1, 2, 3, 4 is the ith element of e 2 . When the target u 0 is located at or close to the reference sensor s k , x 0 À x k À Á ! 0, y 0 À y k À Á ! 0 or z 0 À z k À Á ! 0 appears, then the approximate error equation (33) will become meaningless. Both the classic TSWLS and CTLS positioning algorithms, or the ICTLS mentioned in the article, have this hidden danger. Therefore, in order to avoid the impact of this malpractice on target positioning, we need to re-select the reference sensor, usually based on the first estimation result u 1 , select the sensor s k 0 farthest from the target as the new reference sensor. 21,22 In order to further analyze the reason why the reselectors refer to the sensor, define  (33) can be rewritten as: In order to facilitate the calculation of the coordinates, the position distribution of the target and the reference sensor is shown in Figure 5. From the geometric relationship in the figure, x 0 À x k = r k sin u cos f, y 0 À y k = r k sin u sin f, and z = r k cos u can be obtained. Substituting the above relationship into equation (34), we get: The mathematical expectation of the approximate error formula (35) is: Where P = 1 sin u E e 1 j j ð Þ j cos fj + E e 2 j j ð Þ j sin fj + E e 3 j j ð Þ j cos uj + E e 4 j j, r k represents the measured distance between the kth sensor and the target. In order to minimize the mathematical expectation formula (36) of the estimated deviation, two steps are required: ffi let r k take the maximum value, ffl let P take the minimum value. 23 In order to get the maximum value of r k , a new sensor s k 0 needs to be selected as the reference sensor, and s k 0 is the sensor farthest from the target among all sensors, so as to ensure that s k 0 gets the maximum value. In order to get the minimum value of P, we carefully analyzed the expression of P. In view of the relatively small estimation error, E e 1 j j ð Þ= E e 2 j j ð Þ= E e 3 j j ð Þ can be obtained, and P can get the minimum value when u'55 8 , f = 45 8 . So we can make u'45 8 , f = 55 8 by rotating the coordinate axis twice. 24 Rotate the coordinate axis for the first time so that f = 45 8 , take the z axis as the rotation axis, rotate the coordinate axis clockwise, and the rotation angle is a = p=4. Therefore, after rotating the coordinate axis for the first time, the ith sensor in the new coordinate system can be expressed as: Rotate the coordinate axis for the second time so that u'55 8 , take the line passing through the origin of the coordinate and perpendicular to the plane s k ug as the rotation axis, rotate the coordinate axis clockwise, the rotation angle is b = 55p=180, and the cosine direction of the rotation axis is n x = n y = ffiffi ffi 2 p =2;n z = 0. 25 Therefore, after the second rotation of the coordinate axis, the coordinate system of the second rotation of the ith sensor can be expressed as In the same way, the target u 0 becomes (u 0 ) 00 after two rotations of the coordinate axis.
The WLS estimation result of the program (32) under the new coordinate system is Where W 2 is the weighting matrix: The covariance matrix of the estimated vector u 00 is approximate: Therefore, the estimated position of the target under the new coordinate system is: In the formula, P = diag sgn u 00 (1 : 3) À s  positioning performance, especially when the target is at or close to the reference sensor.

Experimental verification and result analysis
This section compares the proposed optimization algorithm's performance and the TSWLS algorithm for positioning targets through simulation experiments in two positioning scenarios. The two positioning scenes are ffi special positioning scene, that is, the target is located at or close to the reference sensor; ffl random positioning scene, that is, the target and sensors are randomly distributed in three-dimensional space. The experiments in the two positioning scenarios were run 5000 Monte Carlo experiments on a PC, and the positioning performance of the algorithm was analyzed by comparing the MSE and deviation of the position estimation of the two algorithms. The MSE and bias of the position estimate are defined as 26 : Where b u l is the estimated value of u l 's lth Monte Carlo experiment and L = 5000. The position error variance of the sensor is s 2 s , and the covariance matrix is Q s = s 2 s Á diag½10, 10, 10, 2, 2, 2, 10, 10, 10,40,40,40,20,20,20,3,3,3; the variance of the average measurement error is s 2 t = 10 À4 m 2 , its covariance matrix is Q t = s 2 t R, and R is a main diagonal element of 1 and other elements of 0.5 (M 2 1) 3 (M 2 1) matrix; assume that the measurement error and the position error of the sensor are independent of each other. 21 Target positioning in a specific scene. There are two targets to be located in the monitoring area, one is the shortrange target u 0 1 = ½600, 80, 300m, and the other is the long-range target u 0 2 = ½2000, 3000, 1500m. The two targets to be located are used to estimate the target position information from the data measured by the six sensors in the area. The real position coordinates of the sensors are shown in Table 4.
The distribution of targets and sensors in space is shown in Figure 6, assuming that A is the reference sensor. We compare the position estimation deviation and MSE to evaluate the positioning performance of the TSWLS algorithm in Sun and Ho 5 and the optimized algorithm in the paper. Figure 7 depicts the relationship between the MSE and the deviation of the short-distance target position estimated by the two algorithms and the sensor position error variance. As can be seen from the figure, 10 lg s 2 s À Á 4 À 40dBm 2 ; and the threshold of the Table 3. The computational complexity of the optimized algorithm in this paper. Step The formula in this paper RMs First step 4M 2 + 28M + 32 Repeat twice Formulas (7) and (8) Sun and Ho. 5 Step Equations in the literature RMs optimized algorithm in the text is 210 dBm 2 , which is 30 dBm 2 higher than the threshold of the TSWLS algorithm, which has strong robustness. In addition, the optimization algorithm in the article at 10 lg s 2 s À Á = À 20dBm 2 time reduces the estimation deviation by about 8 dB compared with the TSWLS algorithm. Therefore, the optimization algorithm shows high positioning accuracy and strong robustness when locating short-range targets. Figure 8 shows the relationship between the MSE and the deviation of the long-distance target position estimated by the two algorithms and the sensor position error variance. It can be seen from the curve in the figure that when 10 lg s 2 s À Á 4 À 10dBm 2 , the MSE estimated by the two positioning algorithms can reach CRLB. The noise thresholds of the TSWLS algorithm and the optimized algorithm are 210 and 25 dBm 2 , respectively. Obviously, the optimized algorithm is more robust than the TSWLS algorithm. In addition, the optimization algorithm also has a smaller position estimation deviation than the TSWLS algorithm. In short, when locating long-distance targets, the optimization algorithm also showed better positioning performance.
Figure axis labels target positioning in random acenes. Hundred target sources are randomly distributed in the setting space, and the target sources are randomly distributed in a cube with a side length of 600 m. Similarly, 100 sensors are randomly distributed in a cube with a side length of 200 m, and the centers of the two cubes coincide. Randomly select six sensors and one target as a positioning scene, and run 5000 Monte Carlo experiments on the PC to locate each scene's target. The settings of other parameters are the same as those of target positioning in a specific scene. The spatial distribution of targets and sensors is shown in Figure 9. Figure 10 depicts the relationship between the MSE and deviation of the target position estimated by the two algorithms and the variance of the sensor position error when the target and sensors are randomly distributed. It can be seen from the graph curve that when 10 lg s 2 s À Á = À 30dBm 2 or 10 lg s 2 s À Á = 0dBm 2 , the MSE estimated by the TSWLS algorithm for the target position suddenly deviates from the CRLB and the deviation increases sharply, this shows that the  1  299  99  151  2  399  151  101  3  299  501  199  4  348  201  101  5  2101  299  299  6 199 2299 2199   target to be located at this time may be just at or close to the reference sensor, resulting in an increase in estimation error. On the contrary, the optimization algorithm in the article can reach CRLB at the error threshold. Compared with the TSWLS algorithm, the optimization algorithm reduces the position estimation MSE by 4 and 7 dBm, respectively under the above two sensor position error variance points, and the position estimation deviation is reduced by 7 and 6 dBm, respectively. This is mainly because the optimization algorithm corrects the defects in the TSWLS algorithm by reselecting the reference sensor and rotating the coordinate system. However, in the same positioning scenario, the optimization algorithm takes a slightly longer time to locate the target than the TSWLS algorithm. This is because the optimization algorithm introduces the reference sensor's reselection and the rotating coordinate system, which causes the amount of calculation to increase. Considering comprehensively, when randomly distributed sensors are used to locate randomly distributed targets, the optimization algorithm is better than the TSWLS algorithm in the positioning targets' overall performance. Figure 11 shows the relationship between the average MSE and the deviation of the target position estimated by the two positioning algorithms with the number of sensors. In the experiment, the number of sensors is gradually increased from 3 to 8. Simultaneously, set the average position error variance of the sensor to 10 lg s 2 s À Á = À 30dBm 2 , and the settings of other parameters are the same as the above experiment. The experimental results show that the MSE and deviation of the two algorithms' target position estimation decrease with the number of sensors. Especially when the number of sensors increases from 3 to 5, the MSE and deviation of the position estimation decrease sharply, but the number of sensors decreases from 6. This change will become slower when it is increased to eight, which is why six sensors are set to locate the target in the above experiment.
In the presence of both sensor position error and measurement error, this section carefully analyzes the solution process of the TSWLS algorithm and corrects the fatal defects in TSWLS by re-selecting the reference sensor and rotating the coordinate system, thus optimizing the TSWLS algorithm and improving the positioning performance of the TSWLS algorithm in general. However, the introduction of new operation steps in the optimization algorithm leads to a slight increase in the amount of operations and a slight increase in the time used to locate the target, which is a reflection of the limitations of the algorithm in this paper, and it is evident that any high-precision localization algorithm comes at the expense of the amount of operations.

Conclusion
Aiming at the positioning problem of multiple noncoincident targets, the ICTLS positioning algorithm is proposed. By analyzing the shortcomings of the TSWLS algorithm when positioning multiple targets, the proposed ICTLS algorithm establishes global   constraints based on the relationship between the target and additional variables, and introduces Lagrangian multiplier technology to solve the positioning equation using the quasi-Newtonian BFGS iterative formula. Avoiding the operation of the Hessian matrix and reducing the calculation amount of the algorithm. The proposed ICTLS algorithm shows better positioning performance and strong robustness.
The optimized positioning algorithm of TSWLS solves the hidden dangers in many positioning algorithms; when the target is located at or close to the reference sensor, the estimation error increases suddenly. Based on retaining the closed-form solution, the optimization, the algorithm effectively reduces the position estimation error by reselecting the reference sensor and the rotating coordinate system, corrects the TSWLS algorithm's defects, and comprehensively improves the positioning performance of the TSWLS algorithm.

Declaration of conflicting interests
The author(s) declared no potential conflicts of interest with respect to the research, authorship, and/or publication of this article.