I Introduction
Multiagent networks have recently gained many attentions with their potential intelligent applications [1, 2]. In the absence of a global navigation satellite system, networked agents can provide positioning services by acting as moving anchors, such as temporary aerial and vehicular anchors in terrestrial emergency rescue. To be specific, the agents can periodically broadcast wireless signals and their timespace information [2, 3, 4]. The broadcast information has notable uncertainties since the networked agents can only selfdetermine their parameters in unknown environments. The moving targets in communication range passively receive the signals and utilize the oneway time of arrival (TOA) measurements to localize themselves against the agents, and hence can theoretically scale to an arbitrary number [2].
The TOAbased localization problem in the presence of anchor uncertainties is mainly studied for static scenarios in the area of wireless sensor network (WSN). An intuitive maximum likelihood estimator (MLE) involving the parameters of both the static anchors and targets is proposed in [5]. However, it cannot guarantee convergence without good initial guesses. Closedform solutions, which do not require an initial guess, are reported in the literature [6, 7]. In [6], a twostep generalized total least squares (TSGTLS) method is proposed to estimate the position of a static target using all twoway TOA measurements between the target and anchors. In [7], the twostep weighted least squares (TSWLS) localization method is derived to estimate the position of the target. The method first linearizes the observation equations and then solves the problem in the sense of WLS by incorporating the agent uncertainties into the weighting matrix. However, the above methods are still all discussed from the static WSN point of view, which do not apply to moving targets. For moving targets, the state parameters of practical interest consist not only the position, but also the velocity of the target.
In practical implementation, channel access technology is used to permit collisionfree signal broadcasting from different anchors. For easy deployment using the offtheshelf products, such as the recent ultrawideband (UWB) chips, a time division multiple access (TDMA) scheme is commonly used [2, 8]. Different from the twoway or concurrent TOA measurements in [6, 7], TDMA produces sequential oneway TOA measurements, which is energy efficient for moving targets and capable of multiple targets localization. However, the minor time difference between sequential measurements will degrade localization performance if not considered. Fortunately, the minor time difference renders the target speed observable. Therefore, further consideration of sequential TOA measurements is needed for moving target localization.
In this letter, we extend the TSWLS algorithm [7] to the more general case with moving targets as well as sequential TOA measurements. In our localization system, the moving targets only passively receive signals from the multiagent network that broadcasts information based on TDMA scheduling. The proposed method only utilizes oneway TOA measurements to jointly estimate the position and velocity of the target, and thus is energy efficient and distributed. To improve performance, we additionally utilize an optimization process to refine the estimates. Furthermore, we introduce the new concept of large target clock offset (LTCO) scenarios concerning the unsynchronized targets that first enter or reenter the multiagent networks. The scenarios are similar to the large equal radius (LER) conditions in TOAbased localization [9, 10]
, since they both lead to large approximately equal pseudoranges and hence induce illconditioned matrix. We specially consider the LTCO scenarios by introducing a QR factorization to retain numerical stability.
Ii System Model and Problem Formulation
The agents generally have onboard navigation systems, such as visual navigation systems and inertial navigation systems, and can exchange their measurements using wireless communication to collaboratively estimate their timespace information. By periodically broadcasting their determined timespace information and corresponding uncertainties, the agents can serve as mobile anchors to assist lowcost moving target localization. The passive targets can then obtain the TOA measurements of the broadcast signals and the agents’ information to localize themselves. Consider a multiagent network and a target to be localized in a twodimensional plane. To be specific, an agent will broadcast its realtime determined timespace information at its allocated broadcast time , where is its position and is the clock offset with respect to the time reference agent
. The TOA measurements can then be obtained by subtracting the arrival time recorded at the target from the broadcast time recorded at the agents. We aim to localize the target using the agent broadcast information and the sequential TOA measurements in one TDMA frame. The target parameter vector at the start time of a TDMA frame is to be estimated and given as
(1) 
where is the target position, is the velocity, and
are the clock offset and clock skew with respect to agent
, respectively. The clock offset is the phase difference and the clock skew is the frequency difference of the internal clocks.Under the firstorder model assumption of the target motion and clock dynamic, and the fact that the worst clock skew magnitude is up to parts per million (ppm) [11], the TOA measurement from agent can be modeled as [2]
(2) 
(3) 
where denotes the independent measurement noise [12], denotes the norm, and denotes the known slot time difference and is determined by TDMA designers, where is the start time of a TDMA frame. Timerelated variables are represented in its rangeequivalent form by multiplying the known signal propagation speed.
For general discussion, the TOA measurements are collected into , which forms
(4) 
where is modeled as zeromean Gaussian random vector with diagonal covariance matrix . The agent nominal parameters are grouped into , where . They are unknown and corrupted with errors. We denote the error vector as
(5) 
where with
(6) 
We assume that is modeled as zeromean Gaussian random vector with covariance matrix . We note that is also broadcast to the target. We also assume that is independent of the measurement noises . Let
, the joint probability density function (PDF) of the observed TOAs, agent positions and clock offsets parameterized on unknown
is then given as(7) 
We note that MLE involves the maximization with respect to parameters of both the unknown target and agents. The maximization can be a very highdimensional problem if the number of agents is large. Furthermore, MLE is computationally expensive and needs proper initial guesses. Instead, we extend the TSWLS method and propose a low complexity method that requires no initial guesses.
Iii Proposed Method
The first step of the proposed method reparametrizes the localization problem in a higherdimensional space to linearize the equations and solves the linear equations by a WLS estimator. The second step introduces a nonlinear optimization process to refine the target parameters by exploiting their relationship to the higherdimensional solution. The details are described as follows:
1) Step I: The nominal parameters in (2) are replaced using (6). Defining , rearranging (2) and squaring both sides as in [7], the linear equation can be derived as:
(8) 
where
(9) 
where , and represents the secondorder error terms that will be ignored. Note that is associated with the agent nominal parameters and their uncertainties. We address the uncertainties issue by treating agent uncertainties as finetunings in .
Define the reparametrized vector , where , and . The matrix form of (8) is given as
(10) 
where , and with
The covariance matrix of the error vector is derived as
(11) 
Applying the whitening transformation to by multiplying to both sides of (10), we have
(12) 
The WLS solution to (10) is then given as
(13) 
The covariance matrix of the estimate is derived as [13]
(14) 
However, we notice that the moving targets typically have lowcost clocks due to their size and cost constraints. Therefore, the clock offset of the target can be relatively large, such as exceeding one millisecond, if not well synchronized. This makes pairwise approximately equal and the coefficient matrix have a very large condition number and, consequently, yields a poor estimate. We define these situations as LTCO scenarios. To the best of the authors’ knowledge, the LTCO scenarios have not been reported in previous closedform solutions for TOAbased localization problems. LTCO scenarios may appear for a longrunning target if its clock is not promptly adjusted and synchronized. Moreover, the LTCO scenario occurs if an unsynchronized target first enters the multiagent network. In this case, the target will have a large clock offset with respect to the agents.
We address LTCO scenarios by applying a reduced QR factorization to in (12), with column pivoting, to get
(15) 
where is an orthogonal matrix, is an upper triangular matrix and is an permutation matrix [14]. To derive the WLS solution , we solve the following equation by back substitution:
(16) 
The covariance matrix of the estimate is derived as:
(17) 
This dramatically enhances numerical stability properties. Our analysis is presented in terms of (12), but our practical algorithm implementation is based on (15).
2) Step II: This step retracts the target parameters from the WLS solution by exploiting their nonlinear relationship. The relationship is directly given as follows:
(18)  
(19) 
where is the error vector with covariance matrix . The target parameters can be estimated by solving the following optimization problem:
(20) 
where is the weighted norm. This can be solved using the iterative weighted least squares (IWLS) based on the GaussNewton numerical algorithm. To be specific, the initial guess of is obtained from the truncated . The increment in each iteration is estimated as
(21) 
where
(22) 
where denotes an identity matrix in this letter. The results can then be updated as
(23) 
Remark 1: depends on target nominal parameters, which are not available. In practical implementation, we first set to be to obtain an initial estimate . We then use from truncated to evaluate and derive the WLS solution.
Remark 2: The stopping criteria in IWLS is set as , where is the trace of the agent position covariance matrix that can be extracted from . The maximum number of iterations is set to be .
Remark 3: If we ignore the speed and clock skew parameters, do not consider the LTCO scenarios, and set IWLS iterations to be one, our method degrades into the original TSWLS algorithm in [7].
Iv Performance Analysis
In this section, we analyze the CRLB of the localization problem and the mean square error (MSE) of our proposed estimator to theoretically prove the effectiveness of our method.
The natural logarithm of the joint PDF is given as
(24) 
where is a constant independent of . The CRLB of is derived as [13]
(25) 
where
(26) 
where the operator yields the row vector partial derivative of function as:
(27) 
The partial derivatives above are derived using (3)
(28)  
(29) 
where
(30) 
with . The CRLB for is then derived as in [6]
(31) 
We then derive the analytical MSE of our proposed method. From the second step, the estimate bias is
(32) 
where is the estimate bias in the first step, . Substituting (14) and into (32), we can obtain
(33) 
Under the assumption that is small enough,
(34) 
The covariance of the estimate of is then derived as
(35) 
From (11) and using matrix inversion lemma [13], we have
(36) 
where and . Comparing (36) with (26) and (31), using some manipulations, it can be found that
(37) 
when the measurement noises and agent errors are small and hence the elements in and are with small perturbations. To conclude, our method is approximately unbiased and reaches CRLB under small noises.
V Numerical Results
This section numerically evaluates the performance of our proposed method. The simulation scenario is given in Fig. 1, where a target and a multiagent network composed of agents are moving in a twodimensional space. Without loss of generality, agent is chosen as the time reference agent. We set 10 time slots for TDMA scheduling with equal slot interval s, and the first slot starts at time
s. The agent clock offsets are generated by continuous uniform distribution,
ns. The clock skews of the target and agents are from to ppm. The target and agents move with a common velocity of m/s. For simplicity, the measurement noiseand the errors in agent position and clock offset are assumed as independent zeromean Gaussian random variables. Considering for example the UWB technology with fine temporal resolution, the covariance of
is set as dB [15]. The covariance matrix of agent uncertainties is where , and follows a uniform distribution dB. The MSEs of the results are evaluated by averaging over independent runs. For comparison, the TSGTLS in [6] and the TSWLS in [7] are also simulated. Also included is the MLE using GaussNewton implementation that ignores the agent uncertainties [2]. The initial guess for MLE is obtained by adding a small zeromean Gaussian noise to the nominal parameters. However, we note that the above three methods are all originally designed for a stationary target and are not applicable to our simulation scenarios. For a fair comparison, we extensively implement these methods by considering the target speed and clock skew parameters using the sequential TOA measurements. The implementations are based on our system model. Three simulation schemes are devised as follows:1) NonLTCO scenarios: The target clock offset is randomly generated from to ns, to simulate the nonLTCO scenarios. Fig. 2 shows the estimation performance comparison versus agent uncertainties . We can see that our proposed method significantly outperforms the existing methods. Moreover, the performance of our method can attain the CRLB and consistent with theoretical MSE under small noises, which validates the performance analysis results. TSGTLS and TSWLS perform worse mainly because they do not deeply exploit the nonlinear relationship between target parameters and nuisance parameters. Our method is also robust to large agent uncertainties, while MLE will diverge due to large errors in its coefficient matrix .
2) LTCO scenarios: We increase the target clock offset to simulate a weak to strong LTCO scenario and fix dB. We note that when a target cannot access the multiagent network, it may synchronize its clock via the Internet, in a typical precision of a few milliseconds [16]. When it enters the network, the strong LTCO scenario arises. Fig. 3 demonstrates that our method is robust to strong LTCO scenarios due to the advantage of utilizing the QR factorization, while the existing closedform solutions fail.
3) Random topology: For further evaluation, we randomly generate the agents and target topology in each independent run, and fix dB, in nonLTCO scenarios. The agent and coordinates are randomly drawn from to m, the target coordinates are from to m, and their velocities in all directions are from to m/s. The number of independent runs is . Fig. 4
shows the cumulative distribution function (CDF) of the position MSE. We observe that the CDF curve of our method is steeper for most of the time and can achieve 1 under small position MSE, which confirms that our method performs better than existing methods and is more robust to random localization topology.
The estimation results of clock offset, clock skew and/or target speed lead to the same conclusion, and are not shown here due to space limitations.
Vi Conclusion
In this letter, an extended TSWLS method is proposed to localize moving targets with the assistance of a multiagent network. The position and velocity of the target are jointly estimated using the sequential TOA measurements. Moreover, numerical stability is enhanced to produce valid estimates in LTCO scenarios. Performance analysis and numerical results validate that our proposed method is approximately unbiased and reaches CRLB under small noises. Numerical simulations also show that our method outperforms the existing closedform solutions in terms of accuracy and robustness, both in nonLTCO and LTCO scenarios.
References

[1]
Q. Wang, W. Zhang, Y. Liu, and Y. Liu, “MultiUAV dynamic wireless networking with deep reinforcement learning,”
IEEE Commun. Lett., vol. 23, no. 12, pp. 2243–2246, 2019.  [2] Q. Shi, X. Cui, S. Zhao, S. Xu, and M. Lu, “BLAS: Broadcast relative localization and clock synchronization for dynamic dense multiagent systems,” IEEE Trans. Aerosp. Electron. Syst., pp. 1–1, 2020.

[3]
J. Cano, S. Chidami, and J. Le Ny, “A kalman filterbased algorithm for simultaneous time synchronization and localization in UWB networks,” in
Proc. IEEE Int. Conf. Robot. Automat. IEEE, 2019, pp. 1431–1437.  [4] Q. Shi, X. Cui, S. Zhao, J. Wen, and M. Lu, “Rangeonly collaborative localization for ground vehicles,” in Proc. 32nd Int. Tech. Meeting Satell. Div. Inst. Navig. ION, 2019.
 [5] M. Angjelichinoski, D. Denkovski, V. Atanasovski, and L. Gavrilovska, “SPEAR: Source position estimation for anchor position uncertainty reduction,” IEEE Commun. Lett., vol. 18, no. 4, pp. 560–563, 2014.
 [6] J. Zheng and Y.C. Wu, “Joint time synchronization and localization of an unknown node in wireless sensor networks,” IEEE Trans. Signal Process., vol. 58, no. 3, pp. 1309–1320, 2009.
 [7] Y. Wang, J. Huang, L. Yang, and Y. Xue, “TOAbased joint synchronization and source localization with random errors in sensor positions and sensor clock biases,” Ad Hoc Netw., vol. 27, pp. 99–111, 2015.
 [8] J. Tiemann, Y. Elmasry, L. Koring, and C. Wietfeld, “Atlas fast: Fast and simple scheduled tdoa for reliable ultrawideband localization,” in Proc. IEEE Int. Conf. Robot. Automat. IEEE, 2019, pp. 2554–2560.
 [9] L. A. Romero, J. Mason, and D. M. Day, “The large equal radius conditions and time of arrival geolocation algorithms,” SIAM J. SCI. Comput., vol. 31, no. 1, pp. 254–272, 2008.
 [10] L. A. Romero and J. Mason, “Evaluation of direct and iterative methods for overdetermined systems of toa geolocation equations,” IEEE Trans. Aerosp. Electron. Syst., vol. 47, no. 2, pp. 1213–1229, 2011.
 [11] D. Neirynck, E. Luk, and M. McLaughlin, “An alternative doublesided twoway ranging method,” in Proc. IEEE 13th Workshop Positioning Navig. and Commun. IEEE, 2016, pp. 1–4.
 [12] J. Elson, L. Girod, and D. Estrin, “Finegrained network time synchronization using reference broadcasts,” ACM SIGOPS Oper. Syst. Rev., vol. 36, no. SI, pp. 147–163, 2002.
 [13] S. M. Kay, Fundamentals of statistical signal processing. Prentice Hall PTR, 1993.
 [14] P. D. Hough and S. A. Vavasis, “Complete orthogonal decomposition for weighted least squares,” SIAM J. Matrix Anal. Appl., vol. 18, no. 2, pp. 369–392, 1997.
 [15] C. Xu and C. L. Law, “Delaydependent threshold selection for UWB TOA estimation,” IEEE Commun. Lett., vol. 12, no. 5, pp. 380–382, 2008.
 [16] D. L. Mills, “Internet time synchronization: the network time protocol,” IEEE Trans. Wireless Commun., vol. 39, no. 10, pp. 1482–1493, 1991.
Comments
There are no comments yet.