# TDOA-Based Source Collaborative Localization via Semidefinite Relaxation in Sensor Networks

Authors: Yongsheng Yan; Haiyan Wang; Xiaohong Shen; Ke He; Xionghu Zhong
Journal: International Journal of Distributed Sensor Networks
 (2015)

---

## Abstract

The time delay of arrival- (TDOA-) based source localization using a wireless sensor network has been considered in this paper. The maximum likelihood estimate (MLE) is formulated by taking the correlated TDOA noise into account, which is caused by the difference with the TOA of the reference sensor. The global optimal solution is difficult to obtain due to the nonconvex nature of the ML function. We propose an alternative semidefinite programming method, which transforms the original ML problem into a convex one by relaxing nonconvex equalities into convex matrix inequalities. In addition, the source localization algorithm in the presence of sensor location errors and non-line-of-sight (NLOS) observations is developed. Our simulation results demonstrate the potential advantages of the proposed method. Furthermore, the proposed source localization algorithm by taking the NLOS TOA measurements as the constraints of the convex problem can provide a good estimate.


---

## Body

## 1. Introduction

Source localization using a number of distributed sensors has been extensively studied in the past few years for a wide range of applications such as radar, sonar, and microphone array [1–3]. Recently, tremendous growth in advances of wireless sensor networks (WSNs) has promoted both algorithmic research and application of the source localization in sensor networks [4–6]. Usually, the positions of the sensor nodes are assumed to be known and the spatial location of the source is the parameter to be estimated. Measurements are extracted from the received signals at local sensors and then transmitted to a fusion center where the source position estimation is carried out by fusing the received measurements.To localize the source, different measurement models are defined based on the information such as time of arrival (TOA) [7–10], time difference of arrival (TDOA) [11–19], angle of arrival (AOA) [20], received signal strength (RSS) [21–23], distance measurement (DM) [16, 24, 25], and a combination of them [26, 27]. Distance measurement is widely employed in the scenario of cooperative localization for sensor networks, for example, sensor node self-localization [4, 28]. However, such a measurement is not applicable in the noncooperative source localization scenario as the distance measurement is difficult to be estimated directly. RSS measurements can be sampled at a much lower rate as the power emitted by a source varies slowly, and the information is easy to obtain by averaging the signal power received at a sensor. However, the RSS measurement is dependent on the signal decay model assumption and is sensitive to the channel environment such as scatter, multipath effect. For AOA measurements, each sensor requires to be equipped with an angle estimation device, for example, multisensor array, acoustic vector sensor in underwater sensor networks. However, the deployment of networked arrays is very expensive and calibration of each array is a problem of its own. Such difficulties make the deployment of large-scaled network very challenging and impractical. In practice, the TOA and TDOA measurements are mostly widely used due to their accuracy and ease to access. In this paper, we will focus on the localization schemes based on TOA/TDOA measurement models.For TOA-based measurement, it is often assumed that the source and sensors are synchronized perfectly such that the signal propagation time can be exactly known at sensor nodes. However, the TDOA measurements are not available for noncooperative sources, for example, enemy target in a battlefield. One way to tackle this problem is to jointly estimate the initial signal transmission time and the source location by using available TOA measurements and known sensors coordinates [8, 9]. Another alternative method is to utilize the difference of pairwise TOA measurements, that is, TDOA, where the initial transmission time is not required. Although the TDOA measurements are more sensitive to the noise and it is observed that there is a 3 dB performance loss compared with TOA model [8], TDOA measurement has been widely employed in source localization due to its simplicity and robustness.TDOA-based source localization can be carried out by intersecting the hyperbolic curves corresponding to the different TDOA measurements. Usually, to obtain the source location is difficult due to the highly nonlinear relationship between the unknown parameter and derived measurements. One method to handle this nonlinearity is to use the iterative searching, for example, Gauss-Newton method, to obtain a maximum likelihood (ML) estimate. However, the iteration suffers from the convergence problem: the search can be ended up with a local optimum or a saddle point. In [14], a closed-form solution based on the weighted least-square (LS) was proposed to approximate the MLE by the parameter transformation. However, the estimation bias is large, when the noise-free TOA assumption is violated by heavy measurement noise. Another alternative method based on LS formulation was proposed in [15] to derive a closed-form solution to the ML equation, which changed nonlinear ML equations into linear equations. Also, a special geometry with three sensors on a line was considered. The explicit constrained LS solution for source localization was derived based on both the range and range-difference measurements in [16]. Such LS-based source localization can achieve good estimate when the noise of the range measurement is independent and identically distributed. However, the performance suffers from degradation when the covariance matrix of the range measurement noise is not proportional to the identity matrix (i.e., the range measurement noise is correlated). Note that this source localization algorithm is based on the minimization of LS error. It estimates the source location without requiring the knowledge about the probability distribution of TDOA or range-difference noises. Similarly, this minimization of LS error criterion has been developed in [17, 18]. In [17], two methods called BianSub and BiasRes were proposed to reduce the estimate bias caused by the noise correlation. In [18], the LS optimization problem was transformed into a convex one that can be solved by Lagrange multiplier method.The original attempt of this paper is to derive the solution (source location estimate) to the ML formulation, which can asymptotically achieve the optimum performance and is usually set as a benchmark for estimation performance [29]. An efficient way to derive the MLE is to utilize convex optimization or semidefinite programming (SDP). The convex optimization algorithm has been widely used in source localizations for RSS model [26], DM model [30], and TOA or TDOA model [8, 11, 19]. The authors of [19] transformed the ML problem into a convex one that is easy to be solved by interior point methods. It is worth mentioning that in [19] all pairwise TDOA measurements are taken into account. Such procedure will lead to higher computational complexity since the number of pairwise TDOA measurements is O(N2) (N is the number of sensors). For a resource-limited sensor network, higher computational complexity is costly. In order to overcome this shortcoming, the authors in [11] proposed a reduced complexity SDP-based source localization algorithm. The computational complexity is reduced from two respects: (1) a sensor is chosen as the reference one such that only selective differences of TOA are included; (2) the minimax approximation is employed to further reduce the computational complexity. Specifically, SDP inner product and SDP outer product are formulated based on the l∞ norm approximation of the original l2 norm, which is less sensitive to the distribution of the TOA measurement noise. Such an approximation will lead to performance degradation.Note that these TOA- and TDOA-based source localization algorithms considered only line-of-sight (LOS) connections between the source and sensors. However, in indoor environments or urban areas, there are non-line-of-sight (NLOS) observations resulting from the obstacles (e.g., buildings) in the direct paths of the signal transmission. NLOS connections severely degrade the source localization accuracy, since the obtained TOA measurement is positively biased due to the longer NLOS traveling distance than the true LOS distance [31, 32].Different approaches have been developed to mitigate the degradation due to NLOS signals. The first approach is the propagation model-based approach, which is based on the distribution of TOA generated from multipath scattering models [33–35]. This approach estimates the LOS TOA from several multipath arrivals (including NLOS arrivals) by matching the statistics of the TOAs with those produced by the scattering models and derives the location estimate according to the LOS TOA measurements. However, the accurate model is difficult to be obtained and the ideal scattering models always mismatch the probability density function (PDF) of the observed measurements due to the time-varying characteristic of the scattering models. The second approach to mitigate the degradation due to NLOS measurements is the “identify and discard” based approach [36, 37]. The source localization procedure is composed of two steps. In the first step, LOS and NLOS measurements are identified by the statistical decision theory [36, 38, 39]. Then these biased NLOS measurements are discarded. The remaining LOS measurements are employed to locate the source position via an MLE or a maximum a posteriori probability estimator [36]. The discarding of the NLOS information leads to performance degradation which can be avoided by the third method, that is, “identify and employ” based approach. Such an approach formulates the source localization problem as an optimization problem by taking the NLOS measurements as a constraint, for example, linear programming [31, 40] and SDP [41, 42], or by jointly considering LOS and NLOS measurements, for example, assigning different weights to LOS and NLOS measurements [43]. The fourth method is the source localization without distinguishing LOS and NLOS in mixed LOS/NLOS environments, where the key point is to design a robust source position estimator via jointly estimating mixture distribution and source position, for example, expectation-maximization (EM) and joint maximum a posteriori-maximum likelihood (JMAP-ML) in [44], adaptive kernel density estimation in [45], and machine learning in [46]. There also exists literature dedicated to the source localization under only NLOS measurements [47–49]. An overview of NLOS identification and error mitigation can be found in [50, 51] and references therein.In this paper, we develop a new algorithm via semidefinite programming based on the TDOA model. The TDOA measurement errors are assumed to be correlated with each other due to the TOA substraction with that of the reference sensor. The ML formulation based on TDOA model is considered. We develop an efficient convex relaxation for the nonconvex ML formulation. The corresponding source localization algorithm in the presence of sensor location errors is also proposed to examine the sensitivity of the inaccurate sensor location estimation, which deteriorates the accuracy of source localization algorithms [52, 53]. In terms of the LOS/NLOS environments, the “identify and employ” based source localization is considered to handle NLOS biases in this paper. We assume that the NLOS measurement has been identified for ultrawide band (UWB) signals via hypothesis test [54–56]. The main contributions of this work are summarized as follows:(i)
An alternative SDP source localization algorithm based on TDOA model with correlated TDOA noises is proposed. The proposed SDP source localization algorithm provides a tradeoff between the localization accuracy and computational complexity compared with the algorithm proposed in [11] and the algorithm in [19].(ii)
The robust source location estimation in the presence of sensor location errors is developed for the proposed SDP algorithm, where the location estimate is robust against the sensor location errors.(iii)
The proposed source localization algorithm is extended to the case that there are NLOS connections between the source and sensors for TOA measurements by taking the NLOS TOA measurements as the constraints of the optimization problem. The simulation results show that such source localization scheme can improve the performance compared with the source localization algorithm with only the LOS TOA measurements.(iv)
The performance of the proposed SDP with sensor location errors and without errors is examined by Monte Carlo simulations to show the effectiveness of the proposed algorithm in comparison to the existing methods.In addition, the performance of source localization is compared with existing source localization algorithms including ML and SDP algorithm [19] and SDP algorithm with minimax approximation [11]. Also, the Cramér-Rao lower bound (CRLB) is included in the simulations.We organize the remainder of this paper as follows. Section2 describes TDOA model with correlated noise and formulates ML problem. Section 3 presents the proposed SDP source localization algorithm by semidefinite relaxation. In Section 4, source localization in the presence of sensor location errors is formulated. The NLOS case is considered in Section 5. The simulations results are given in Section 6. Section 7 concludes the paper.Throughout this paper, we shall use the following mathematical notations:(·)T denotes the transpose of a matrix or a vector; Tr⁡(·) denote the trace of a square matrix; · denotes the Euclidean norm of a vector; Diag(·) denotes the diagonal matrix with the given vector on the main diagonal; 0m×n denotes the zero matrix with m rows and n columns; 1m denotes the m×1 column vector with all entries being 1s; Im denotes the m×m identity matrix; A⪰B means A-B is positive semidefinite.


## 2. Problem Statement

Consider a sensor network withN sensor nodes arbitrarily deployed at m-dimensional surveillance region (with m=2 or 3). The sensor positions xi∈Rm, for i=1,…,N, are assumed to be known and fixed. The TOA measurements are extracted by a matched filter at each sensor node and transmitted to a data fusion center (DFC) where the source location y∈Rm is estimated. Figure 1 depicts such a source cooperative localization system. Here, we assume that all sensor nodes’ clocks are ideally synchronized but are unsynchronized with the source’s clock. The TOA measurement ti from the common source at the ith sensor is(1)ti=1cxi-y+t0+ωi,i=1,2,…,N,where t0 is the unknown time instant at which the signal is transmitted and c is the speed of signal transmission. ωi is the independent and identically distributed Gaussian noise with zero-mean and variance η2=σ2/c2. σ2 is the variance of the distance measurement. The joint conditional probability density function of the TOA measurement t=[t1,t2,…,tN]T is(2)ft∣y,t0,η2=2πη2-N/2exp-12η2∑i=1Nti-1cxi-y-t02.Consequently, the MLE of y for TOA measurement can be obtained as(3)y^=argminy,t0∑i=1Nti-1cxi-y-t02.Generally, the variance η2 is assumed to be known. ML formulation (3) is nonconvex and the estimate is easily converged to a local minimum with iterative algorithms.Figure 1
A block diagram of the source localization in sensor networks.In order to eliminate the unknown parametert0 that is not related to the source position, reference sensor r is selected. The TDOA between the ith sensor and the reference sensor can be addressed as(4)Δti=1cxi-y-xr-y+ωi-ωr︸ni,where i=1,2,…,r-1,r+1,…,N. Note that the noises ni=ωi-ωr are correlated with each other due to the common term ωr. The covariance matrix of the noise vector n=n1,n2,…,nr-1,nr+1,…,nNT is(5)Q=η221⋯112⋯1⋮⋱⋮11⋯2.By introducing auxiliary variables(6)τi=1cxi-y,1≤i≤N,h=τ1,τ2,…,τr,…,τNT,Δt=Δt1,Δt2,…,Δtr-1,Δtr+1,…,ΔtNT,(4) can be written in a matrix form by(7)Δt=Uh+n,where(8)U=Ir-1-1r-10r-1×N-r0N-r×r-1-1N-rIN-r.Note that (7) is a linear function of the auxiliary variable h. The joint conditional probability density function of the TDOA measurements is(9)fΔt∣y,η2=12πN-1/2Q1/2exp-12Δt-UhTQ-1Δt-Uh.Then, the MLE of y can be written as(10)y^=argminy,hΔt-UhTQ-1Δt-Uh,where Q and U are given as (5) and (8), respectively.


## 3. Semidefinite Relaxation Based on TDOA

For ML formulation (10), the objective function is a nonconvex function of the unknown y. In [19], a semidefinite relaxation method was used to convert the ML estimation problem into a convex problem, where all pairwise TDOA measurements are considered. Such a procedure leads to higher computational complexity, since the number of TDOA measurements is N(N-1)/2. Besides, a solution was provided by assuming independent noise among the TDOA measurements [19]. The authors in [11] derived the source location estimate based on correlated noise by using l∞ approximation. Such an approximation leads to reduced computational complexity. However, its performance is worse than the original TDOA ML estimate. Here, we propose an alternative SDP source localization scheme according to the TDOA measurements with correlated noises, which provides a tradeoff between the localization accuracy and computational complexity.


### 3.1. SDP Source Localization Algorithm

In our work, theith TDOA measurement is obtained by taking the difference of the TOA between the ith sensor and the reference one. Taking into account correlated noises of the TDOA measurement, the MLE problem is transformed into a convex one by relaxing the nonconvex equalities.The objective function of the ML formulation in (10) can be rewritten as(11)Δt-UhTQ-1Δt-Uh=TrQ-1Δt-UhΔt-UhT.In order to write this objective function as a linear function of the unknown parameters, the auxiliary variable H=hhT is introduced. Equation (11) can be further written as(12)Tr⁡Q-1ΔtΔtT-2UhΔtT+UHUT.Clearly, this objective function is a linear function of both H and h. By using (12), ML formulation (10) can be written as the following optimization problem:(13)minH,h,Y,yTrQ-1ΔtΔtT-2UhΔtT+UHUTs.t.τi=1cxi-y,i=1,2,…,N,h=τ1,τ2,…,τNT,H=hhT.Notice that the optimization problem described in (13) is still nonconvex as the constraints τi=(1/c)xi-y and H=hhT are nonconvex. Hence, it is still difficult to obtain the solution. Next, our work is to relax the nonconvex constraints into convex constraints. By using the matrix notation H, the constraint τi=(1/c)xi-y can be written as(14)Hii=τi2=1c2yTy-2xiTy+xixiT=1c2TrY-2xiTy+xixiT,Y=yyT,H=hhT.Note that these constraints (Y=yyT and H=hhT) are still nonconvex; the solution remains difficult. The semidefinite relaxation is employed such that these two equalities can be relaxed into convex inequalities, Y⪰yyT and H⪰hhT. Further, these inequalities can be written as linear matrix inequalities:(15)YyyT1⪰0,HhhT1⪰0.Combining all the constraints, we now have transformed the ML problem into a convex optimization problem:(16)minH,h,yTrQ-1ΔtΔtT-2UhΔtT+UHUTs.t.Hii=1c2TrY-2xiTy+xi2,i=1,2,…,N,YyyT1⪰0,HhhT1⪰0.The global optimal solution to the unknown source position y can be derived by interior point methods such as SeDumi [57].Note that convex optimization formulation (16) is still prone to ambiguous solution, as the value Δri-cτi+cτr for i=1,…,r-1,r+1,…,N, which is the main component of objective function (16) in the form of matrix expansion, will not change when the source is located at hyperbolic curve with sensor i and reference sensor r as its focus points (see Figure 2). Thus, to avoid such an ambiguity, a penalty term is added into the objective function. Such a technique has been employed in previous work [8]. For the proposed TDOA-based SDP algorithm, extra penalty β∑i=1N‍∑j=1N‍Hij is added, and optimization problem (16) is transformed into(17)minH,h,yTrQ-1ΔtΔtT-2UhΔtT+UHUT+β∑i=1N∑j=1NHijs.t.Hii=1c2TrY-2xiTy+xi2,i,j=1,2,…,N,YyyT1⪰0,HhhT1⪰0,where β≥0 is a constant for penalization. As will be shown in Section 6, for larger 1/σ2, this transformation can lead to better performance than the case with β=0. Problem (17) can also be solved by interior point methods, and the source position estimate y^ is derived.Figure 2
The description of the ambiguity of convex formulation (16).


### 3.2.  The Expansion of the SDP Source Localization Algorithm

In the above work, we derive the TDOA measurements by subtracting the TOA of the reference sensor. As such,N-1 TDOA measurements are utilized for source localization. Here, we extend our proposed SDP source localization to the scenario, where all pairwise TDOA measurements are included. However, there is a difference between the proposed SDP algorithm and the one proposed in [19], where the TDOA noises are assumed to be independent of each other.The TDOA between theith sensor and the jth sensor can be written as(18)Δtij=1cxi-y-xj-y+ωi-ωj︸δij,where δij=ωi-ωj denotes the correlated noise and i,j=1,…,N, i<j. It can be written as a matrix form:(19)Δt′=U′h+δ,where (20)τi=1cxi-y,1≤i≤N,h=τ1,τ2,…,τr,…,τNT,Δt′=Δt12,…,Δt1N,Δt23,…,Δt2N,…,ΔtN-1,NT,δ=δ12,…,δ1N,δ23,…,δ2N,…,δN-1,NT,U′=1-10⋯0010-1⋯00⋮⋮⋮⋱⋮⋮100⋯0-101-1⋯00010⋱0-1⋮⋮⋮⋱⋮⋮000⋯1-1. The covariance matrix Q′ of the noise vector δ can be given as (21)Q′uv=2η2ifu1=v1,u2=v2,η2ifu1=v1,u2≠v2,-η2ifu1=v2,u2≠v1,-η2ifu2=v1,u1≠v2,η2ifu2=v2,u1≠v1,0otherwise, where u1(v1) is the index of i for i=1,…,N and u2(v2) is the index of j for j=1,…,N(i<j).We can see that the formulation (in (7)), where all the pairwise TDOA measurements are included, is similar to the formulation (in (19)). The similar convex optimization problem to (17) can be derived. Thus, the solution to the expansion algorithm by taking all the pairwise TDOA measurements is derived by solving the convex optimization problem via interior methods.


## 3.1. SDP Source Localization Algorithm

In our work, theith TDOA measurement is obtained by taking the difference of the TOA between the ith sensor and the reference one. Taking into account correlated noises of the TDOA measurement, the MLE problem is transformed into a convex one by relaxing the nonconvex equalities.The objective function of the ML formulation in (10) can be rewritten as(11)Δt-UhTQ-1Δt-Uh=TrQ-1Δt-UhΔt-UhT.In order to write this objective function as a linear function of the unknown parameters, the auxiliary variable H=hhT is introduced. Equation (11) can be further written as(12)Tr⁡Q-1ΔtΔtT-2UhΔtT+UHUT.Clearly, this objective function is a linear function of both H and h. By using (12), ML formulation (10) can be written as the following optimization problem:(13)minH,h,Y,yTrQ-1ΔtΔtT-2UhΔtT+UHUTs.t.τi=1cxi-y,i=1,2,…,N,h=τ1,τ2,…,τNT,H=hhT.Notice that the optimization problem described in (13) is still nonconvex as the constraints τi=(1/c)xi-y and H=hhT are nonconvex. Hence, it is still difficult to obtain the solution. Next, our work is to relax the nonconvex constraints into convex constraints. By using the matrix notation H, the constraint τi=(1/c)xi-y can be written as(14)Hii=τi2=1c2yTy-2xiTy+xixiT=1c2TrY-2xiTy+xixiT,Y=yyT,H=hhT.Note that these constraints (Y=yyT and H=hhT) are still nonconvex; the solution remains difficult. The semidefinite relaxation is employed such that these two equalities can be relaxed into convex inequalities, Y⪰yyT and H⪰hhT. Further, these inequalities can be written as linear matrix inequalities:(15)YyyT1⪰0,HhhT1⪰0.Combining all the constraints, we now have transformed the ML problem into a convex optimization problem:(16)minH,h,yTrQ-1ΔtΔtT-2UhΔtT+UHUTs.t.Hii=1c2TrY-2xiTy+xi2,i=1,2,…,N,YyyT1⪰0,HhhT1⪰0.The global optimal solution to the unknown source position y can be derived by interior point methods such as SeDumi [57].Note that convex optimization formulation (16) is still prone to ambiguous solution, as the value Δri-cτi+cτr for i=1,…,r-1,r+1,…,N, which is the main component of objective function (16) in the form of matrix expansion, will not change when the source is located at hyperbolic curve with sensor i and reference sensor r as its focus points (see Figure 2). Thus, to avoid such an ambiguity, a penalty term is added into the objective function. Such a technique has been employed in previous work [8]. For the proposed TDOA-based SDP algorithm, extra penalty β∑i=1N‍∑j=1N‍Hij is added, and optimization problem (16) is transformed into(17)minH,h,yTrQ-1ΔtΔtT-2UhΔtT+UHUT+β∑i=1N∑j=1NHijs.t.Hii=1c2TrY-2xiTy+xi2,i,j=1,2,…,N,YyyT1⪰0,HhhT1⪰0,where β≥0 is a constant for penalization. As will be shown in Section 6, for larger 1/σ2, this transformation can lead to better performance than the case with β=0. Problem (17) can also be solved by interior point methods, and the source position estimate y^ is derived.Figure 2
The description of the ambiguity of convex formulation (16).


## 3.2.  The Expansion of the SDP Source Localization Algorithm

In the above work, we derive the TDOA measurements by subtracting the TOA of the reference sensor. As such,N-1 TDOA measurements are utilized for source localization. Here, we extend our proposed SDP source localization to the scenario, where all pairwise TDOA measurements are included. However, there is a difference between the proposed SDP algorithm and the one proposed in [19], where the TDOA noises are assumed to be independent of each other.The TDOA between theith sensor and the jth sensor can be written as(18)Δtij=1cxi-y-xj-y+ωi-ωj︸δij,where δij=ωi-ωj denotes the correlated noise and i,j=1,…,N, i<j. It can be written as a matrix form:(19)Δt′=U′h+δ,where (20)τi=1cxi-y,1≤i≤N,h=τ1,τ2,…,τr,…,τNT,Δt′=Δt12,…,Δt1N,Δt23,…,Δt2N,…,ΔtN-1,NT,δ=δ12,…,δ1N,δ23,…,δ2N,…,δN-1,NT,U′=1-10⋯0010-1⋯00⋮⋮⋮⋱⋮⋮100⋯0-101-1⋯00010⋱0-1⋮⋮⋮⋱⋮⋮000⋯1-1. The covariance matrix Q′ of the noise vector δ can be given as (21)Q′uv=2η2ifu1=v1,u2=v2,η2ifu1=v1,u2≠v2,-η2ifu1=v2,u2≠v1,-η2ifu2=v1,u1≠v2,η2ifu2=v2,u1≠v1,0otherwise, where u1(v1) is the index of i for i=1,…,N and u2(v2) is the index of j for j=1,…,N(i<j).We can see that the formulation (in (7)), where all the pairwise TDOA measurements are included, is similar to the formulation (in (19)). The similar convex optimization problem to (17) can be derived. Thus, the solution to the expansion algorithm by taking all the pairwise TDOA measurements is derived by solving the convex optimization problem via interior methods.


## 4. Robust Source Localization with Sensor Location Errors

In previous sections, we assume that sensor locations are known precisely; that is,xi is accurately known. However, since sensors are arbitrarily deployed in a surveillance region, it is difficult to obtain the accurate locations of all sensors in practice, particularly in the scenario where sensor self-localization is needed but the GPS signal is not available, for example, underwater acoustic sensor networks. In this section, we give a source localization method that is robust against the sensor location errors.For sensor location uncertainty, we definex~i=xi+ξi as the estimated sensor location. xi is the true sensor location whereas ξi∈Rm is the location error with the constraint ξi≤ϵ. By using the first-order Taylor expansion of xi-y, TOA measurement ti in the presence of sensor location errors can be represented as(22)ti=1cx~i-y-ξiTx~i-ycx~i-y+t0+ωi+oξi.Define (23)δi=ξiTx~i-ycx~i-y,δ=δ1,δ2,…,δNT. We have the following constraint: (24)δi2=ξiTx~i-yξiTx~i-yc2x~i-y2≤ξiTξix~i-yTx~i-yc2x~i-y2=ξiTξic2,which can be expressed as δi≤ξi/c. For the set δ, the constraint is δ≤ϵN/c. Next, we consider the source localization with sensor location errors by minimizing the worst case of the objective function.Under the sensor location uncertainty, the noisy TDOA measurement is(25)Δti=ti-tr≈1cx~i-y-x~r-y-δi-δr+ωi-ωr︸ni.It can be written as a matrix form:(26)Δt=Uh~+δ+n,where (27)h~=τ~1,τ~2,…,τ~NT,τ~i=1cx~i-y,U is given as (8), and n~N0N-1×1,Q. Q is the covariance matrix of correlated noise n, which is given as (5). Thus, the source localization problem with sensor location errors can be modified as(28)miny,h~⁡maxδ≤ϵN/c⁡Δt-Uh~+UδTQ-1Δt-Uh~+Uδ.Similar to the original SDP source localization, optimization problem (28) can be equivalently written as an epigraph form [58]:(29)miny,h~,μμs.t.Δt-Uh~+UδTQ-1Δt-Uh~+Uδ≤μforδ≤ϵNc,τ~i=1cx~i-y,i=1,2,…,N.Note that the objective function is a linear function of μ. However, the constraints are nonconvex. In order to transform the constraints into convex function of unknown parameters, we write the first constraint as (30)Tr⁡Q-1ΔtΔtT-2Uh~ΔtT+Uh~h~TUT+2UδTQ-1Δt-Uh~+UδTQ-1Uδ≤μfor ∥δ∥≤ϵN/c. This inequality constraint is equivalent to the following implicit expression:(31)δ≤ϵNc⟹Tr⁡Q-1ΔtΔtT-2Uh~ΔtT+Uh~h~TUT+2UδTQ-1Δt-Uh~+UδTQ-1Uδ≤μ,where A⇒B means that B holds under condition A. Further, we can write the above implication in matrix forms as(32)δ1TIN0N×101×N-Nϵ2c2δ1≤0⟹δ1TGFFTφ-μδ1≤0,where (33)G=UTQ-1U,F=UTQ-1Δt-Uh~,φ=Tr⁡Q-1ΔtΔtT-2Uh~ΔtT+UH~UT,H~=h~h~T. According to theS-procedure [58], formulation (32) holds if and only if there exists λ≥0 such that(34)GFFTφ-μ⪯λIN0N×101×N-Nϵ2c2.Note that φ is a linear function of both h~ and H~. Constraint (34) is convex. By using the equality constraint H~=h~h~T, the second constraint in (29) τ~i=(1/c)xi-y can be written as (35)H~ii=1c2TrY-2x~iTy+x~i2,where Y=yyT. Combining all the constraints, the TDOA-based source localization with sensor location errors can be written as the following optimization problem:(36)miny,Y,h~,H~,λμs.t.GFFTφ-μ⪯λIN0N×101×N-Nϵ2c2,G=UTQ-1U,φ=TrQ-1ΔtΔtT-2Uh~ΔtT+UH~UT,F=UTQ-1Δt-Uh~,H~=h~h~T,Y=yyT,H~ii=1c2TrY-2x~iTy+x~i2,λ≥0,i=1,2,…,N.Similar to (17), the equality constraints H~=h~h~T and Y=yyT can be relaxed into (37)YyyT1⪰0,H~h~h~T1⪰0.Thus, we have the following TDOA-based source localization algorithm with the penalty term:(38)miny,Y,h~,H~,λμ+β∑i=1N∑j=1NH~ijs.t.GFFTφ-μ⪯λIN0N×101×N-Nϵ2c2,φ=Tr⁡Q-1ΔtΔtT-2Uh~ΔtT+UH~UT,F=UTQ-1Δt-Uh~,H~ii=1c2TrY-2x~iTy+x~i2,YyyT1⪰0,H~h~h~T1⪰0,λ≥0,i,j=1,2,…,N,where β≥0 is a constant for penalization. Using the SDP solver SeDumi [57], we can obtain the source position estimate y^ in the presence of sensor location errors.


## 5. Source Localization under LOS/NLOS Environments

In previous sections, we have developed an alternative SDP-based source localization scheme by employing TOA measurements. Also, the robust source localization against sensor location errors is given. Note that the TOA measurements derived by the match-filter at sensors are based on the LOS connections between the source and the sensors. However, in dense multipath propagation environments (e.g., indoor or urban areas), the LOS paths between the source and the sensors are obstructed. Thus, the NLOS range measurement is much larger than the LOS range one. It was observed that the NLOS bias errors of the range measurements are much larger than the range measurement errors of the LOS scenarios [32]. In this paper, we present a source localization scheme that effectively takes both LOS and NLOS TOA measurements into account. A convex optimization problem is formulated, where the LOS measurements are used to formulate the objective function whereas the NLOS measurements are used to formulated the constraint. To begin, here, we state our assumptions:(1)
TheM NLOS TOA measurements in all the M+N TOA measurements have been identified by the statistical decision theory, for example, energy detection [38], joint received signal strength and TOA-based statistical NLOS identification [39].(2)
The NLOS bias errors of the range measurements are much larger than the range measurement errors of the LOS scenarios; that is,bk (for k=1,…,M) is typically much larger than the TOA measurement noise ωNk.We make no further assumption on the distribution ofbk.The TOA measurement with NLOS connection between the source and sensork is(39)tNk=1cxNk-y+t0+ωNk+bk,k=1,2,…,M,where y∈Rm is the source location that needs to be estimated; xNk∈Rm (for k=1,…,M) is the location of the kth sensor with NLOS connection between the source and itself; M is the number of NLOS TOA measurements, which can be derived by the NLOS identification method for TOA measurements; bk (for k=1,…,M) is the NLOS bias error, which is always positive (i.e., bk>0). Similarly to the TOA measurement with the LOS connection, here, the sensor r with the LOS connection is also chosen as the reference sensor. The TDOA between the kth sensor with the NLOS connection and the reference sensor r with the LOS connection can be given as(40)ΔtNk=tNk-tr=1cxNk-y-xr-y+ωNk-ωr+bk.Note that if the NLOS bias error is much larger than the TOA measurement noise, for example,(41)bk≥2·maxi=1,…,N,k=1,…,M⁡ωi,ωNk,the term ωNk-ωr+bk is positively biased. Thus, we have the following inequality constraint:(42)1cxNk-y-xr-y≤ΔtNk.Similar to the source localization algorithm in [31], here, we make no assumption of the statistic characteristics for the NLOS bias error. And inequality constraint (42) holds under inequation (41). Such a condition is always satisfied, since the NLOS distance is much larger than the true LOS distance.Based on assumption (1), the LOS TOA measurements are used to formulate the objective function, whereas the NLOS TOA measurements are used to formulate additional constraints of the original source localization optimization problem in (17). Thus, we have(43)minH,h,yTr⁡Q-1ΔtΔtT-2UhΔtT+UHUT+β∑i=1N∑j=1NHijs.t.Hii=1c2TrY-2xiTy+xi2,YyyT1⪰0,HhhT1⪰0,1cxNk-y-xr-y≤ΔtNk,i,j=1,2,…,N,k=1,…,M.The inequality constraint is nonconvex. By using the equation τr=(1/c)(xr-y), the nonconvex inequality can be written as(44)1cxNk-y≤1cxr-y+ΔtNk=τr+ΔtNk.Taking square of (44) and expanding it, we have(45)-2xNkT+xrTy-2c2ΔtNkτr≤c2ΔtNk2-xNk2+xr2,where τr is the rth element of the vector h; that is, hr=τr. Note that this inequality is convex. Combining all of the convex constraints, we have the following optimization problem with M NLOS connections between the source and the sensors:(46)minH,h,yTrQ-1ΔtΔtT-2UhΔtT+UHUT+β∑i=1N∑j=1NHijs.t.Hii=1c2TrY-2xiTy+xi2,YyyT1⪰0,HhhT1⪰0,-2xNkT+xrTy-2c2ΔtNkhr≤c2ΔtNk2-xNk2+xr2,i,j=1,2,…,N,k=1,…,M,where β≥0 is a constant for penalization. Similarly, the source position estimate under the LOS/NLOS environment can be derived by solving the convex optimization problem (46) via SDP solver SeDumi [57].


## 6. Simulation Results

In this section, we provide several examples to demonstrate the performance of the proposed TDOA-based SDP algorithm in comparison with the other TDOA-based algorithms. Also, the performance of the proposed source localization algorithm in the presence of sensor location errors and under LOS/NLOS environment is examined. Recall that the “TDOA-based min-max algorithm (labeled as MMA)” in [11] estimates the source location based on the minimax approximation of the original ML problem. Specifically, two source localization algorithms (SDP-I and SDP-O) have been given, and the simulation results have shown that the SDP-I algorithm outperforms the SDP-O. Thus, in this paper we label indiscriminately SDO-I as MMA and only compare the SDP-I algorithm with our proposed algorithm. The solution of TDOA-based ML formulation (9) is also included in the simulation, which is solved by the MATLAB routinefmincon. The TDOA-based SDP algorithm using all pairwise measurements in [19] is denoted by “AM” here.In the simulation, eight sensors in a 2-dimensional area are deployed at(47)x1=40,-40T,x2=40,-40,x3=-40,40T,x4=-40,-40T,x5=40,0T,x6=0,40T,x7=-40,0T,x8=0,40T.The performance is evaluated in terms of the root-mean-square error (RMSE) of the source position, which is defined as(48)RMSE=∑m=1My^m-yt2M,where y^m is the estimate of the source position in the mth Monte Carlo (MC) simulation and M is the number of the MC. In this paper, we set M=1000. The initial transmission time instant t0 is randomly chosen with a uniform distribution over [0,50].Example 1.
In order to illustrate the importance of the penalty term in (17), this example examines the performance for different penalty factor β including β=0. The results are given in Figures 3 and 4, where the source is located at y=[20,30]T and y=[120,150]T, respectively. The locations of the eight sensors are given as (47). The case with β≈0, that is, optimization problem (16), is also considered. The TOA measurements only with LOS connections between the source and sensors are considered. We can see that the optimal penalty factor is dependent on the source location as well as 1/σ2. When the source is inside the convex hull of sensors, β can be chosen between 10-4 and 10-3 for 1/σ2=30,40,50 dB. When the source is outside the convex hull of sensors, β can be chosen between 10-5 and 10-4. We will use this selection criterion of the penalty factor in the next examples.Figure 3
Comparison of different penalty constant for the proposed SDP algorithms when the source is inside the convex hull of the sensor nodes(y=[20,30]T).Figure 4
Comparison of different penalty constant for the proposed SDP algorithms when the source is outside the convex hull of the sensor nodes(y=[120,150]T).Example 2.
In this example, we compare the performance of the proposed TDOA-based SDP algorithm and MMA to examine the sensitivity of the selection of reference sensor. For the MMA, the authors in [11] have proved that better performance can be achieved by choosing the reference sensor with themedian TOA measurement criterion. The locations of the eight sensors are also given as (47). The source is located at y=[20,30]T, which is inside the convex hull formed by sensors. The penalty factor β is set to 1×10-4. We assume that the sensor locations are error-free. Similar to Example 1, only the LOS TOA measurements are considered in this example. The performance comparison of MMA and the proposed SDP algorithm under different reference sensors is given in Figure 5. It can be observed that the proposed SDP algorithm is more robust against different selections of the reference node compared with the MMA. Moreover, when r=5 is chosen as the reference node, the localization error is larger than that of r=3 especially at low 1/σ2 (1/σ2≤5 dB). The proposed SDP algorithm significantly outperforms the MMA in terms of RMSE, regardless of the selection of the reference node. Specifically, there is a 5 dB enhancement in terms of 1/σ2 for the proposed SDP algorithm compared with the MMA.Figure 5
Comparison of MMA and the proposed SDP algorithm with different reference nodesr. The source is located at y=[20,30]T, which is inside the convex hull of the sensor nodes.Example 3.
To examine the sensitivity of selection of the reference node when the source is located outside the convex hull formed by sensors, the performance of MMA and the proposed SDP algorithm is compared. The source is located aty=[120,150]T. The locations of the eight sensors are given as (47). The penalty factor β is set to 1×10-5. Also, the sensor locations are assumed to be error-free and only LOS measurements are considered. The performance comparison of the two TDOA-based source localization methods is given in Figure 6. Similar to the results of Example 2, the proposed SDP algorithm is less sensitive to the selection of the reference node compared with the MMA. Thus, we randomly select the reference node for the proposed SDP algorithm in the next examples.Figure 6
Comparison of MMA and the proposed SDP algorithm with different reference nodesr. The source is located at y=[120,150]T, which is outside the convex hull of the sensor nodes.By comparing the results in Figures5 and 6, we can find that the MMA source localization algorithm for the case where the source is located outside the convex hull formed by sensors is more sensitive to the selection of the reference node compared with the one for the case where the source is located inside the convex hull. Moreover, we also observe that the selection of the reference node based on the median TOA measurement (i.e., r=3 for both of the two cases) is suitable for both the inside and outside cases.Example 4.
Here, several source localization algorithms including the proposed SDP, MMA, ML, and AM are compared. The estimation results are given in Figure7. The source is located at y=[30,10]T, which is inside the convex hull of the sensors. The Cramér-Rao low bound (CRLB) [11] is also presented in the simulation. For the ML formulation, the initial value of the searching algorithm is set to be the ground truth of the source position. The AM algorithm proposed in [19], which includes N(N-1)/2 pairwise TDOA measurements and neglects the correlated noise induced by the preprocessing through subtraction, is also compared. Furthermore, we also extend our proposed SDP algorithm to the scenario that includes N(N-1)/2 pairwise TDOA measurements. The noises are assumed to be correlated. Here, we label such an algorithm as “SDP-proposed, AM”.
From the results, we can see that ML in this scenario provides the best performance. The proposed SDP algorithm performs better than MMA. The reason for this is that MMA is a minimax approximation of the ML formulation. Such an approximation can lead to performance loss. The performances of the AM and the proposed SDP algorithms are very close to each other, and both of them give a good estimation, especially at high1/σ2 (over 30 dB). However, the good estimation of the AM algorithm is derived at the expense of high computational complexity as all the pairwise TDOA measurements are employed. We can also observe that the proposed SDP algorithm with N-1 TDOA measurements provides a better estimate compared with the AM algorithm proposed in [19] and the MMA proposed in [11]. The performances of the extended SDP algorithm with N(N-1)/2 TDOA measurements labeled as SDP-proposed, AM and the proposed SDP algorithm with N-1 TDOA measurements labeled as SDP-proposed are very close to each other. Both of these two proposed algorithms outperform the AM algorithm. Furthermore, the increase of the number of TDOA measurements (from N-1 to N(N-1)/2) does not significantly provide the performance improvement for the proposed SDP algorithm. That is, the proposed SDP algorithm provides comparable performance with the extended SDP algorithm.
To illustrate the computational cost of the AM algorithm, we give a comparison of the average CPU time in Table1. All the results are obtained by using an Intel core i5-4200U PC with 1.60 GHz CPU and 8 G RAM. For ML, the true source location is considered as the initial point and two different MATLAB iterative methods are employed. The small one is the time of the MATLAB routinefmincon, whereas the large one is the time of the MATLAB routineGlobalSearch. From the results, we can see that our proposed SDP algorithm requires moderate CPU time compared with MMA and AM algorithm. Thus, the proposed SDP source localization algorithm provides a tradeoff between the localization accuracy and computational complexity compared with AM algorithm and MMA.Table 1
Average CPU computational time per estimation for different source localization algorithms.
Algorithm
Average CPU estimation time (ms)
ML
27.51/523.01
AM
438.53
MMA
265.20
Proposed SDP
327.60Figure 7
Comparison of MMA, ML algorithm, and the proposed SDP algorithm with reference nodesr=6 and the AM algorithm when the source is inside the convex hull of the sensor nodes (y=[30,10]T).Example 5.
In this example, the sensors are also placed at the locations given by (47), and we position the source at y=[100,80]T, which is outside the convex hull of sensors. The performance comparison of the above source localization algorithms is given in Figure 8. It can be seen that the performances of AM and the proposed SDP algorithms are very close to each other. Also, the performance of these two algorithms is very close to the CRLB under most of the range of 1/σ2 (from 0 dB to 30 dB). Both the AM and the proposed SDP algorithms outperform the ML algorithm since the cost function of ML formulation is nonconvex and it is easy to trap into the local minima. Similar to the result of Example 3, both the proposed SDP and AM generate better performance than the MMA. Both the proposed SDP algorithm and the extended SDP algorithm provide better estimate than the MMA. Also, the performance of the two algorithm is very close to the CRLB when the source is located outside the convex hull formed by sensors.Figure 8
Comparison of MMA, ML algorithm, and the proposed SDP algorithm with reference nodesr=6 and the AM algorithm when the source is outside the convex hull of the sensor nodes (y=[100,80]T).Example 6.
Here, we test the source estimation performance under given sensors location errors. The results are given in Figures9 and 10. The source is located in y=[25,10]T and y=[100,80]T, respectively. In this example, σs is defined as the location error variance of the sensor node. For each dimension of sensor position z, we generate sensor node location error according to the truncated Gaussian distribution in the interval |z|≤σs/α; its PDF is given by(49)fz=α/2πσsexp-αz2/2σs22Φα-1z≤σsα,0z>σsα,where Φ(x)=∫-∞x‍(1/2π)exp1/2υ2dυ is the cumulative distribution function of the standard norm distribution and α is the factor to make the position error variable ξi2 lie at the interval ξi2≤σs2. For 2-dimension sensor nodes, α=2. We consider σs=0, σs=0.5, σs=1, and σs=2 in Figures 7 and 8. σs=0 means that the sensors self-localization is error-free. Due to the random characteristic of sensor location errors, the RMSE of estimation in the presence of sensor location errors is defined as(50)RMSEe=∑k=1K∑m=1My^mk-yr2MK,where K is the number of the MC runs in terms of different sensor self-localization results and M is the number of the MC runs in terms of different noises. In this example, we set K=500 and M=500.Figure 9
Source location estimation in the presence of sensors self-localization errors. The source is inside the convex hull of the sensor nodes(y=[25,10]T). The penalty factor is β=5.0×10-4.Figure 10
Source location estimation in the presence of sensors self-localization errors. The source is outside the convex hull of the sensor nodes(y=[100,80]T). The penalty factor is β=1.0×10-5.It can be seen from the results that the proposed SDP algorithm without sensor location error provides the best performance. As the error variance of sensors self-localization increases, the performance of the proposed SDP algorithm degrades. There is a performance upper bound of the source localization for the case where the fixed source location is both inside and outside the convex hull of sensor nodes.Example 7.
In previous examples, the proposed SDP algorithm is compared with the mentioned algorithms under LOS connections between the source and the sensors. However, this is a very unrealistic situation. In this example, the performance analysis under both LOS and NLOS connections by solving convex problem (46) is carried out. We label the algorithm as “SDP, LOS/NLOS”. We also give the performance of the proposed SDP algorithm only with LOS connections (i.e., the scenario where NLOS TDOA components are discarded is included). We label the algorithm with such a scenario as “SDP, only LOS”. Furthermore, the performance of the SDP algorithm by taking all of the TDOA measurements (including both LOS and NLOS measurements) as LOS measurements is considered. We label the algorithm with such a scenario as “SDP”.In this example, the sensors are randomly distributed at 2-dimensional region40×40 m2. The source is also randomly located at such an area. The penalty factor β is set to 1×10-4. The sensor locations are assumed to be error-free. There are 8 sensors to be used to estimate the source location. M=2 sensors are assumed to generate NLOS TOA measurements, which have been identified by the hypothesis test. N=6 sensors are assumed to generate LOS TOA measurements. Note that, in Section 6, we make no assumptions about the statistical distribution of the NLOS TOA bias errors. For the purpose of simulation, we assume that the bias errors are uniformly distributed; bk~B(0,B) [31]. Here, we set B=2 s and the number of MC M=5000. Figure 11 gives the simulation results.Figure 11
Source location estimation under LOS/NLOS environments. The sensors are randomly distributed at 2-dimensional region40×40 m2. The penalty factor is β=1.0×10-4.It can be observed that the proposed SDP source localization algorithm under LOS/NLOS environments, that is, the solution of problem (46), can provide accurate source location estimate under both LOS and NLOS connections between the source and the sensors. The performance of the proposed SDP algorithm under LOS/NLOS environments is better than the SDP algorithm with only LOS TOA measurements. This is because the proposed algorithm employs all of the information from the sensors, which includes the NLOS measurements, whereas the SDP algorithm discards the NLOS information. Furthermore, we can see that the original SDP algorithm by taking both LOS and NLOS measurements as LOS ones suffers performance degradations in most of the range of 1/σ2 (1/σ2≥10 dB). However, there is an exception. When 1/σ2≤5 dB, the original SDP algorithm by taking all of TOA measurements as LOS ones outperforms both the SDP algorithm under LOS/NLOS environments and the SDP algorithm with only LOS measurements. One reason for this is that the same treatment of both LOS and NLOS measurements is reasonable when the LOS TOA measurement errors are larger than or equal to the NLOS bias errors under low 1/σ2.From the above simulations, we can derive the following conclusion:(1)
Our proposed SDP algorithm provides a robust estimate in terms of the selection of the reference sensor compared with the MMA.(2)
The proposed SDP algorithm outperforms the MMA and provides comparable performance with the extended SDP algorithm, which gives a good estimate at the expense of high computational complexity.(3)
There is a performance upper bound for the robust source localization against sensor location errors when1/σ2 increases.(4)
The proposed SDP algorithm under both LOS and NLOS environments provides a better estimate compared with the SDP algorithm by taking all of measurements as LOS ones and the SDP algorithm with discarding NLOS information.


## 7. Conclusion

In this paper, we investigate the problem of TDOA-based source localization in sensor networks. Based on the correlated TDOA noise measurements, we propose an alternative convex optimization formulation for the ML problem. The robust source localization algorithm in the presence of sensor location errors is also given. Furthermore, the LOS/NLOS environments are considered by taking the NLOS measurements as several constraints of the convex optimization problem. Simulation results show that the proposed TDOA-based SDP algorithm provides superior estimation, especially for the case where the source is located outside the convex hull of sensors. Also, the SDP algorithm works well with low sensitivity of selection of the reference node of the TDOA measurements. The proposed SDP algorithm under both LOS and NLOS environments provides a better estimation compared with the one by discarding the NLOS measurements. However, the proposed SDP source localization algorithm considers the estimate without the communication errors between the sensors and the fusion center, which can deteriorate the performance. The source localization algorithm taking the communication errors into account will be studied in our future work.



---

*Source: 248970-2015-09-07.xml*