Open Access
This article is

- freely available
- re-usable

*Sensors*
**2019**,
*19*(23),
5321;
https://doi.org/10.3390/s19235321

Article

Location of Moving Targets in Substation Non-Line-of-Sight Environment

^{1}

State Grid Key Laboratory of Power Industrial Chip Design and Analysis Technology, Beijing Smart-Chip Microelectronics Technology Co., Ltd., Beijing 100192, China

^{2}

School of Electrical Engineering and Automation, Wuhan University, Wuhan 430072, China

^{3}

State Grid Ningxia Electric Power Co., Ltd., Yinchuan 750011, China

^{*}

Author to whom correspondence should be addressed.

Received: 9 October 2019 / Accepted: 23 November 2019 / Published: 3 December 2019

## Abstract

**:**

In substations, a localization system based on a wireless sensor network (WSN) is a challenge, because the propagation of the measured signal could be blocked by various devices. In other words, non-line-of-sight (NLOS) propagation, where the signal propagation path is occluded, will affect measurement accuracy. A novel localization method based on a two-step weighted least squares and a probability distribution function is proposed to reduce the influence of NLOS error on the localization result. In this method, the initial multi-group localization result is obtained by the two-step weight weighted least-squares method, and the probability distribution function of the target is constructed by using the initial localization results, which can effectively reduce the influence of the NLOS error on the localization result. The simulation and test results show that the proposed method can keep the coordinate error within 30 cm in the substation. Compared with the localization result of two-step weighted least-squares (TSWLS) method, the average localization error is reduced by more than 1 m. Compared with the other two similar algorithms, the localization accuracy is improved by more than 50%. The tested results show that the localization performance of the method is robustness in the NLOS environment of the substation. While ensuring stability, the proposed algorithm is less efficient than some existing ones. However, under the calculation conditions of ordinary computers, the average single-point calculation time is less than 0.1 s, which can meet the needs of applications in substations.

Keywords:

substation; wireless sensor network (WSN); moving target; non-line-of-sight (NLOS); probability distribution## 1. Introduction

In power substations, power equipment is densely populated. Due to the high level of voltage, there are many high-risk working areas. Inadvertent entry of moving targets such as inspectors and equipment may result in loss of life and property [1,2]. Currently, there are no reliable technical means and measures to protect human life in power substations. The safety of substation staff is mainly reliant on the consciousness of the safety supervisors, which is time-consuming, laborious, and subjective. During commissioning and maintenance work of substations and transmission lines, it is often necessary to use tall vehicles, such as large cranes. When a work vehicle works near live equipment or under live transmission lines, personnel supervision is usually required to prevent the working vehicle from touching the line. As there may be personnel fatigue, or care may not be timely, and the safety risks are high. If the location of the moving target in a substation can be obtained, and an alarm may be used to promptly warn the personnel involved, the safety of the staff can be guaranteed. In recent years, ultra-wide band (UWB) technology, which is a wireless carrier communication technology, has been used in the field of moving target localization. The UWB signal has a frequency range of 3.1 GHz to 10.6 GHz, and a bandwidth exceeding 500 MHz. It has a transmit power of less than −41 dBm/MHz. The UWB technology enjoys a good anti-multipath performance, good penetration capability, and a low power consumption. By constructing a wireless sensor network (WSN) based on UWB technology [3,4], the base station can obtain distance information between the target to be located and the base station by analyzing the UWB signal transmitted by the tag carried on the target. How to use the distance information to accurately estimate the position of the moving target is of great significance.

The location estimation of unknown targets is a typical nonlinear estimation problem, which is challenging. To achieve accurate localization of moving targets, scholars conducted a lot of research and proposed many classic localization algorithms, such as weighted least squares (WLS) [5,6], maximum likelihood (ML) estimation [7,8], and so on. These algorithms can achieve better localization accuracy under line-of-sight (LOS) conditions. However, in the non-line-of-sight (NLOS) [9] environment, where the signal propagation path is occluded, the performance of these algorithms usually drops. Therefore, to achieve accurate localization in the NLOS environment, it is often necessary to introduce some mechanisms to reduce the negative impact of NLOS error on the localization algorithm. In recent years, some localization algorithms have been developed to improve accuracy in the cases of NLOS propagation. In [10,11,12], algorithms can filter out unnecessary measurement information in situations of NLOS propagation, and retaining that essential measurement information only for localization. However, in an environment with many NLOS signals, there will be a situation in which the amount of data that are reliable is too small. As a result, the localization accuracy may be seriously affected. Reference [13] points out that in a propagation environment with mixed LOS/NLOS, making good use of NLOS measurement information can improve the accuracy of position estimation. In [14,15,16], the error distribution information of the measured signal in space was obtained in advance, and then the measurement result, which is identified as NLOS measurement, will be reconstructed to reduce the influence of the NLOS measurement error. Such methods need to obtain a priori information of the NLOS signal in the environment [17]. In addition to the methods in the literature [14,15,16], there is a class of method [18,19,20,21] that obtains the final localization result by weighting all measurement information. However, the weights in such methods are often calculated from a priori information measured in the field. As the error distribution of the NLOS measurement typically has much more complex properties and cannot be captured by a simple model [22], this type of localization methods is difficult to stably and accurately locate in a complex environment such as a substation.

A class of probabilistic location methods based on information fusion has been reported. The Kalman filter (KF) [23,24,25]-based method and the particle filter (PF) [26]-based methods are the most widely used. The main problem of the Kalman filter-based localization algorithm is that both the system noise and the perceptual assumed noise are subject to Gaussian distribution. In [27], the method of reconstructing the error matrix is used to reduce the error distribution requirements of the localization algorithm. The particle filter-based localization algorithm is suitable for nonlinear non-Gaussian localization systems. The main problem is particle depletion and computational complexity. References [28,29] proposed different schemes to reduce the number of particles required by the PF, which improved computational efficiency while ensuring location robustness. In general, KF-based localization algorithms and PF-based localization algorithms can achieve accurate and stable localization. However, such localization algorithms usually require different types of measurement data to establish a state model of the localization target, thereby realizing the establishment of the posterior probability distribution of the object. Although the localization algorithm based on KF and PF can correct the localization trajectory in the localization system with only the ranging sensor. In the localization system with only the ranging sensor, the robustness of the KF and PF-based localization algorithms may be degraded. When the motion state of the object changes, the localization accuracy of the algorithm will be affected. Therefore, KF-based localization algorithms and PF-based localization algorithms are usually applied to localization systems with multiple sensors for measurement, such as the localization of robots that integrate targets of various sensors. For mobile targets such as mobile workers or mobile vehicles in a substation, to facilitate carrying and controlling costs, only the distance-sensing tags are often carried. Therefore, it is necessary to study a localization algorithm that can achieve better robustness and accuracy under the condition that only distance measurement information can be achieved.

To improve the robustness and accuracy of the localization algorithm when using only ranging information, this paper proposes a new method based on probability distribution function. The method proposed in this paper does not need to identify the NLOS measurement, nor does it require a priori knowledge of the distribution or statistics of the NLOS errors. All it needs is the LOS measurement error distribution. The difference between this method and the probabilistic methods based on PF or KF is that the proposed method is to construct the error distribution function by using the excess distance sensor data in the localization system and the KF and PF algorithms are localization algorithms that establish the probability of object distribution based on the position and motion state information of the object. The proposed algorithm has almost no dependence on the motion state information, and can ensure accuracy and robustness in the localization system with only the distance sensor. On the other hand, in contrast to the existing localization methods that use the NLOS prior error distribution to correct the results, the localization algorithm proposed in this paper uses the measured data acquired in real time to construct the probability distribution function of the localization target in space, and then achieve the position estimation of the target. By grouping and initializing a large number of real-time ranging data, multiple possible coordinate points are obtained, and the error probability distribution function is constructed according to these points, which can effectively improve the robustness and accuracy of the algorithm, which is an important contribution of this paper.

The detailed procedure of the proposed algorithm can be summarized as follows. First, to make a brief screening of the base station to ensure the computational efficiency of the algorithm, a simple base station selection principle is proposed, which can improve the calculation speed of the algorithm while ensuring the localization accuracy. This is one of the important contributions of this article. Secondly, all the data that participate in the localization are grouped, and each group of data is used for initial localization. Finally, the probability distribution function of the target is constructed by using multiple sets of initial localization results, and the target coordinates are obtained. This method can effectively improve the robustness of the algorithm and reduce the influence of measurement error on the localization result. This is another important contribution of this paper. The localization performance of the proposed algorithm is examined by simulation and experiment.

## 2. Localization Method Based on Two-Step Weighted Least Squares and Probability Distribution

#### 2.1. Time Difference of Arrival (TDOA) Localization Model

The time difference of arrival (TDOA) [30,31] is a method for target localization based on analysis of the time difference of signals associated with the target. To achieve spatial localization, at least the time difference between the target and 4 different localization base stations should be known. However, when there are only 4 base stations for localization, there is a great possibility of large errors. Therefore, in actual localization applications, it is often ensured that the number of base stations is more than four.

It is assumed that a base station of M (M > 4) with known positions is set in the three-dimensional space, and the coordinates of the i-th base station are expressed as

**S**= (x_{i}_{i},y_{i},z_{i})^{T}, i = 1, 2, …, M. The coordinates of the target are expressed as**U**= (x,y,z)^{T}, and the distance from the target to the i-th base station can then be expressed as:
$${r}_{i}=\sqrt{{({x}_{i}-x)}^{2}+{({y}_{i}-y)}^{2}+({z}_{i}-z{)}^{2}}$$

The first base station
in (2), τ

**S**is selected as the reference base station for TDOA localization, and the TDOA measurement value can be expressed as:_{1}
$${\tau}_{i1}={t}_{i1}+\Delta {t}_{i1}=({r}_{i}-{r}_{1})/c+\Delta {t}_{i1},\text{}i=2,3,\dots ,M$$

_{i1}represents the time difference measurement value between the measurement target and the base station**S**and_{i}**S**, t_{1}_{i}and t_{1}are the time values at which the signal arrives at the base station**S**and_{i}**S**. Δt_{1}_{i1}is the measurement error of time difference between**S**and_{i}**S**, and c is the speed at which electromagnetic waves propagate in a vacuum._{1}By multiplying the two sides of (2) by the speed of light, the equation below can be obtained:
in (3), r
where i = 2, 3, …, M. Without considering the NLOS error, it can be assumed that the measurement error n

$${d}_{i1}=c{\tau}_{i1}={r}_{i1}+{n}_{i1}={r}_{i}-{r}_{1}+{n}_{i1},\text{}i=2,3,\dots ,M$$

_{i1}= r_{i}− r_{1}is the distance between the measurement signals reaching the two base stations, and n_{i1}= cΔt_{i1}represents the measurement error of the difference in their distance to the base station. By combining (3) and (1), the localization equation can be obtained:
$${d}_{i1}=\sqrt{{({x}_{i}-x)}^{2}+{({y}_{i}-y)}^{2}+({z}_{i}-z{)}^{2}}-\sqrt{{({x}_{1}-x)}^{2}+{({y}_{1}-y)}^{2}+({z}_{1}-z{)}^{2}}+{n}_{i1}$$

_{i1}in (4) obeys a normal distribution with a mean of 0 and a variance of σ. By solving the optimal estimate of (4), the coordinates of the location of the target can be located.#### 2.2. Initial Localization Method Based on Two-Step Weighted Least Squares

To obtain a more effective localization algorithm, Equation (4) is transformed into a linear equation, and then the optimal estimation is obtained by the two-step weighted least-squares (TSWLS) [6] method as the initial localization result.

Simultaneously squaring the two sides of Formula (3), we can obtain:

$$[({d}_{i1}-{n}_{i1})+{r}_{1}{]}^{2}={({r}_{i1}+{r}_{1})}^{2}={r}_{i}{}^{2}$$

Then substitute Equation (1) into Equation (5).

$${[({d}_{i1}-{n}_{i1})+{r}_{1}]}^{2}={{x}_{i}}^{2}+{{y}_{i}}^{2}+{{z}_{i}}^{2}-2{x}_{i}x-2{y}_{i}y-2{z}_{i}z+{x}^{2}+{y}^{2}+{z}^{2}$$

And we can express Equation (6) in the form of a vector:

$${[({d}_{i1}-{n}_{i1})+{r}_{1}]}^{2}={\mathit{S}}_{i}{}^{T}{\mathit{S}}_{i}-2{\mathit{S}}_{i}{}^{T}\mathit{U}+{x}^{2}+{y}^{2}+{z}^{2}$$

Subtracting both sides of Equation (7) by r

_{1}^{2}, we can get:
$${{d}_{i1}}^{2}-2{d}_{i1}{n}_{i1}+{{n}_{i1}}^{2}+2{r}_{1}({d}_{i1}-{n}_{i1})={\mathit{S}}_{i}{}^{T}{\mathit{S}}_{i}-{\mathit{S}}_{1}{}^{T}{\mathit{S}}_{1}-2({\mathit{S}}_{i}-{\mathit{S}}_{1}){}^{T}\mathit{U}$$

Sort out the two sides of Equation (8), we can get:

$$0.5\times ({{d}_{i1}}^{2}-{\mathit{S}}_{i}{}^{T}{\mathit{S}}_{i}+{\mathit{S}}_{1}{}^{T}{\mathit{S}}_{1})+({\mathit{S}}_{i}-{\mathit{S}}_{1}){}^{T}\mathit{U}+{d}_{i1}{r}_{1}=({r}_{1}+{d}_{i1}){n}_{i1}=({r}_{1}+{r}_{i1}){n}_{i1}+{{n}_{i1}}^{2}$$

Ignoring the quadratic term of the error term in Equation (9) and organize it into a matrix form:
where

$$0.5\times \mathit{h}-\mathit{G}\mathit{\phi}=\mathit{\eta}$$

$$\mathit{h}=\left[\begin{array}{c}{d}_{21}^{2}-{\mathit{S}}_{2}^{T}{\mathit{S}}_{2}+{\mathit{S}}_{1}^{T}{\mathit{S}}_{1}\\ \vdots \\ {d}_{M1}^{2}-{\mathit{S}}_{M}^{T}{\mathit{S}}_{M}+{\mathit{S}}_{1}^{T}{\mathit{S}}_{1}\end{array}\right],\mathit{G}=\left[\begin{array}{cc}{({\mathit{S}}_{1}-{\mathit{S}}_{2})}^{T}& -{d}_{21}\\ \vdots & \vdots \\ {({\mathit{S}}_{1}-{\mathit{S}}_{M})}^{T}& -{d}_{M1}\end{array}\right],\mathit{\phi}=\left[\begin{array}{c}\mathit{U}\\ {r}_{1}\end{array}\right],$$

$$\mathit{\eta}=\mathit{B}\mathit{n},\mathit{B}=\mathrm{diag}\{{r}_{2},\cdots ,{r}_{M}\},\mathit{n}=[{n}_{21},\cdots ,{n}_{M1}]$$

Equation (10) is linearized from a nonlinear equation to a linear equation. We can get the coordinates

**U**of the target from**φ**. The least-squares (LS) method can be used to obtain the best estimate of**φ**:
$$\mathit{\phi}=\mathrm{arg}\text{}\mathrm{min}\{{(0.5\ast \mathit{h}-\mathit{G}\mathit{\phi})}^{T}{\mathit{\Psi}}^{-1}(0.5\ast \mathit{h}-\mathit{G}\mathit{\phi})\}={({\mathit{G}}^{T}{\mathit{\Psi}}^{-1}\mathit{G})}^{-1}{\mathit{G}}^{T}{\mathit{\Psi}}^{-1}\mathit{h}$$

Here

**Ψ**is the weighting matrix of Equation (11),**Ψ**= E (**ηη**^{T}) = c^{2}**BQB**, where**Q**is a diagonal matrix with a diagonal element of 0.5σ^{2}. It represents an error covariance matrix.**Ψ**is not known in practice as**B**contains the true distances between source and receivers. Further approximation is necessary to solve the problem. According to the fact that the difference between the two sides of the triangle is smaller than the third side, we know that r_{i}−r_{2}is less than the distance between the two sensors. The distance between the sensors is fixed. When the distance of the localization target distance sensor is greater than 20 times the distance between the sensors, the difference between any two r_{i}will be less than 5% of the corresponding r_{i}, and it can be seen that each r_{i}is equal, so we can assume that**B**≈ r_{2}**I**,**I**is an identity matrix. Equation (11) can be approximated as:
$$\mathit{\phi}\approx {({\mathit{G}}^{T}{\mathit{Q}}^{-1}\mathit{G})}^{-1}{\mathit{G}}^{T}{\mathit{Q}}^{-1}\mathit{h}$$

And then an estimated value of r

_{1}can be obtained by using Equation (12). After that we can use r_{1}to calculate the estimated value of r_{i}. From which matrix**B**can be obtained. Then matrix**B**can be substituted into Equation (11) to obtain the position estimation result.When using (11) to estimate the position of the target, in a LOS condition, the root mean squared error (RMSE) of the localization result can be close to the Cramer–Rao bound [32], and the calculation is very simple. With the increase of the measured value, the two-step LS method can use the measurement data of the redundant base station to improve the localization accuracy. However, in the case of a large LOS measurement error or NLOS propagation, the localization accuracy of the two-step linear LS method cannot be guaranteed. Consequently, one must perform the initial solution of Equation (10). To achieve precise localization in the complex environment of substation, the results need to be further optimized based on the initial estimation. Here, a probability distribution function is introduced to further improve the position estimation.

#### 2.3. Location Estimation Algorithm Based on Probability Distribution Function

In the substation environment, the propagation path of a measurement signal includes both the LOS path and the NLOS path. The measurement error under the LOS path is small, and is generally regarded as due to white noise obeying a normal distribution. The propagation error under the NLOS path is associated with the propagation environment. Without the propagation error, the aforementioned equations can be solved with a unique optimal solution. However, the LOS error and NLOS error existing in the measured value make it difficult for the numerical method to converge to the optimal solution when solving the equation. From a statistical point of view, the localization result obtained by the combination of the data with higher LOS measurement value is closer to the actual coordinate of the target, and the localization result is consistent and obeys the spatial normal distribution. Localization results that are more affected by the NLOS measurement data will deviate from the region and will not exhibit a regular distribution. Therefore, the concept of spatial probability distribution is introduced. Through the distribution of most of the localization results that are less affected by the NLOS measurement data, the target will have the smallest probability of error in space. Localization results with large errors will deviate from the region, do not have uniform regularity, and will not affect the probability distribution of the region.

Assuming that the number of base stations is N > 4, the number of measurement values that can be obtained is N − 1. In this paper, data combination refers to a data set containing some measurement data. Group all the measurement values, N − 1 measurement values can be expressed as ${\mathrm{C}}_{N-1}^{4}$ which is a data combination containing 4 measured values. For each data combination, one set of localization results can be obtained. Due to the LOS error and the NLOS error, the localization results of each data combination are not the same, and there is an error among the calculated coordinates and the actual coordinates.

Reference [33] proposes that when the TDOA time difference measurement error is large, in the polar coordinate system, the directional angle information calculated by the localization algorithm is more accurate than the modular length information calculated by the localization algorithm. Therefore, after considering the localization result as a spatial straight line, the more accurate direction information can be used to obtain the final result.

Suppose there are U data combinations (O

_{1}, O_{2}, …, O_{j}, …, O_{U}), where j = 1, …, U. We solve each data combination separately, and record the result coordinates (x_{pj}, y_{pj}, z_{pj}). At the same time, the geometric center of all the base stations in each data combination is recorded, its coordinates are expressed as (x_{Oj}, y_{Oj}, z_{Oj}). The two points of the known coordinates in the space form a straight line. Using the data combination initial localization result (x_{pj}, y_{pj}, z_{pj}) and the data combination geometric center (x_{Oj}, y_{Oj}, z_{Oj}), a space line can be established using (13).
$$\{\begin{array}{l}\frac{x-{x}_{\mathrm{O}j}}{\mathrm{cos}{\theta}_{\mathrm{O}j}}=\frac{y-{y}_{\mathrm{O}j}}{\mathrm{sin}{\theta}_{\mathrm{O}j}}=\frac{z-{z}_{\mathrm{O}j}}{\mathrm{tan}{\varphi}_{\mathrm{O}j}}\\ {\theta}_{\mathrm{O}j}=\mathrm{arctan}\frac{{y}_{pj}-{y}_{\mathrm{O}j}}{{x}_{pj}-{x}_{\mathrm{O}j}}\\ {\varphi}_{\mathrm{O}j}=\mathrm{arctan}\frac{{z}_{pj}-{z}_{\mathrm{O}j}}{\sqrt{{({x}_{pj}-{x}_{\mathrm{O}j})}^{2}+{({y}_{pj}-{y}_{\mathrm{O}j})}^{2}}}\end{array}$$

The probability p

_{j}(θ,ϕ) of any point in the space is the unknown target satisfying (14), where σ_{θ}and σ_{ϕ}are the root mean square errors of the LOS measurement error after conversion to azimuth.
$${p}_{j}(\theta ,\varphi )=1-\frac{1}{\sqrt{2\pi}{\sigma}_{\theta}{\sigma}_{\varphi}}\mathrm{exp}\left\{-\frac{1}{2}[\frac{{(\theta -{\theta}_{\mathrm{O}j})}^{2}}{2{\sigma}_{\theta}^{2}}+\frac{{(\varphi -{\varphi}_{\mathrm{O}j})}^{2}}{2{\sigma}_{\varphi}^{2}}]\right\}$$

Equation (15) is the joint probability density of each direction vector, and the point with the smallest joint probability density in space is the target coordinate to be located.

$$p(\theta ,\varphi )={\displaystyle \prod _{j=1}^{U}{p}_{j}(\theta ,\varphi )}$$

In (15), θ and Φ respectively represent the direction angle of the standard point (x

_{Oj}, y_{Oj}, z_{Oj}) of any point in the space and the corresponding data, as shown in (16):
$$\{\begin{array}{l}\theta =\mathrm{arctan}\frac{y-{y}_{\mathrm{O}j}}{x-{x}_{\mathrm{O}j}}\\ \varphi =\mathrm{arctan}\frac{z-{z}_{\mathrm{O}j}}{\sqrt{{(x-{x}_{\mathrm{O}j})}^{2}+{(y-{y}_{\mathrm{O}j})}^{2}}}\end{array}$$

After calculating (15), the joint probability density of each point in space can be normalized according to Formula (17), and the probability distribution of the target in a certain region can be obtained. The larger the value of Formula (17), the greater the probability that the localization result exists in the space enclosed by the three-dimensional surface.

$$p(x,y,z)=p(\theta ,\varphi )=1-\frac{p(\theta ,\varphi )-\mathrm{min}(p(\theta ,\varphi ))}{\mathrm{max}(p(\theta ,\varphi ))-\mathrm{min}(p(\theta ,\varphi ))}$$

By using the error distribution range of the localization result, it is possible to locate more effectively, and to avoid unnecessary accidents caused by the deviation of the localization coordinates.

When passing the equation to the spatial probability density function of (14), it is necessary to know the root mean square error of the azimuth angle θ

_{j}and the pitch angle ϕ_{j}due to the device measurement error under the LOS condition. It was obtained by experimental statistics in this paper. The experimental method is: (i) placing the localization tag at a known coordinate position of the substation; (ii) using the previous method to detect the tag at different positions of the substation; and (iii) using the two-step linear LS method to calculate the azimuth angle θ_{j}, ϕ_{j}. Finally, in (iv), using (18) to calculate the root mean square error, where n is the number of experiments and θ_{ave}is the average of n experimental measurements θ_{j}. A total of 50 experiments were performed.
$${\sigma}_{\theta}=\sqrt{\frac{1}{n}{\displaystyle \sum _{j=1}^{n}{({\theta}_{j}-{\theta}_{\mathrm{ave}})}^{2}}}$$

#### 2.4. Base Station Selection

The probability distribution-based localization method requires data from all the base stations to locate the target. When constructing the probability distribution function, the ${\mathrm{C}}_{N-1}^{4}$ group data should be solved. Because of the increase of N, the calculation amount of the algorithm is multiplied. When N < 10, the number of data combinations does not exceed 100. Therefore, the upper limit of the number of base stations that participate in localization is set to 9.

There are two main principles for selecting a base station. The first is to select the base station which presents LOS propagation conditions. The second is to choose those base stations that are that are closer to the target after the consideration of the first principle.

Since the difference between the two sides of the triangle is smaller than the third side in length, the distance difference between the target of the two base stations is smaller than the distance between the two base stations. However, if there exists NLOS propagation when a localization signal reaches a certain base station, the time for the localization signal to reach the base station is greatly increased. Generally, the base station whose signal arrives at the earliest time is selected as the reference base station. The measured value d

_{i1}of the distance difference between the i-th base station and the reference base station is obtained using Equations (2) and (3). The distance D_{i1}between the base stations can be calculated from the known base station coordinates. If d_{i1}≥ D_{i1}, it can be determined that there is NLOS propagation between the target and the i-th base station. Therefore, the primary screening of all the base stations can remove the localization base stations that are greatly affected by the NLOS propagation.After screening through the above steps, the remaining base stations can be used for localization. If the number of remaining base stations is still greater than 9, the 9 base stations with the earliest arrival time of the signal are selected to participate in the localization. When the number of remaining base stations is less than 4, the 3 base stations with the earliest signal arrival time are selected among the excluded base stations to participate in the localization.

#### 2.5. Steps of the Localization Method

A novel localization method based on TSWLS and probability distribution function is adopted here. The specific flow chart of the proposed method is shown in Figure 1, which can be further elaborated as follows:

Step 1: A coordinate system is established in the substation, and the localization base station is arranged at the designated position. Obtaining the time difference between the signal emanated from the target to be located and each base station

Step 2: Screening the base station. When the number of base stations participating in the location of the target is greater than 9, the appropriate localization base station is selected by using the procedure described in Section 2.4. When the number of base stations is less than or equal to 9, all base stations are selected as the localization base station;

Step 3: Grouping of measured values. From the N (N > 4) localization base stations obtain N − 1 measurement values as described earlier. Formulate ${\mathrm{C}}_{N-1}^{4}$ data combinations (O

_{1}, O_{2}, …, O_{j}, …, O_{U}) containing four measured values. Then calculate the reference point (x_{Oj}, y_{Oj}, z_{Oj}) of each data combination;Step 4: Initial Localization. According to Equation (11) and Equation (12), the position estimates of the different data combinations are obtained. The solution of the equations can be expressed as (x

_{pj}, y_{pj}, z_{pj}), and the space vector group is established by Equation (13).Step 5: Using the probability distribution function to process the initial localization result. The spatial probability distribution model is established by Equations (14)–(17), and the point where the error probability in space is the smallest is set as the coordinate of the target to be located.

## 3. Simulation

To verify the localization performance of the proposed algorithm, this section carries out a simulation study on the 3 existing algorithms, namely the algorithm proposed in the paper, the TSWLS [6] algorithm, residual weighted (RWGH) [34] algorithm, and the residual test (RT) [17] algorithm. The two-step WLS algorithm uses the LS method to estimate the position of the target, and is generally used for localization under LOS conditions. The RWGH algorithm weights different results by the residual of the initial localization result to reduce the influence of the NLOS error. The RT algorithm compares the calculated residual with a set threshold to identify the NLOS base station in the environment. Then, by removing the measurement data obtained by the NLOS base station, the purpose of improving the accuracy of the algorithm is achieved.

The simulation results are compared and analyzed to verify the superiority of the proposed algorithm.

#### 3.1. Simulation Parameters

The simulation conditions are set as follows: The targets to be positioned were randomly distributed in a space area of 30 m × 30 m × 3 m. There were 8 base stations in the to-be-positioned area, and the coordinates were respectively as

**S**= (15,15,0)_{1}^{T},**S**= (−15,15,0)_{2}^{T},**S**= (15, −15, 0)_{3}^{T},**S**= (−15, −15, 0)_{4}^{T},**S**= (15, 15, 3)_{5}^{T},**S**= (15, 15, 3)_{6}^{T},**S**= (10, 10, 3)_{7}^{T},**S**= (10, 10, 3)_{8}^{T}. The simulation environment is shown in Figure 2.In the simulation, the LOS measurement error obeys a normal distribution with the mean value of 0, the standard deviation of σ. The NLOS error obeys the uniform distribution b

_{i}~U (0, B), where B is the maximum possible value of NLOS error. The simulations in this section were based on the Monte Carlo simulation method, and the number of Monte Carlo experiments is 2000, i.e., the average value of the localization error was obtained by randomly taking 2000 points in the space to be located for localization.To verify the localization performance of the algorithm under different conditions, this section sets four different simulation conditions. The simulation conditions are set as shown in Table 1.

Simulation 1 compared the performance of the algorithm with the LOS measurement error standard deviation in the absence of NLOS measurement error, which reflect the relationship between the performance of the algorithm and the performance of the localization sensor. Simulation 2 and Simulation 3 compared the performance of the four algorithms with the NLOS measurement error, and reflected the relationship between the performance of the algorithm and the propagation environment, respectively. Simulation 2 simulated the situation when the maximum possible error of NLOS changes, and simulation 3 simulated the situation when the number of NLOS base station changes. The evaluation index of the performance of the algorithm from Simulation 1 to Simulation 3 was the RMSE of the position estimate and the true value. Simulation 4 further tested the performance of several algorithms. The cumulative distribution function (CDF) was chosen to compare these four algorithms.

#### 3.2. Simulation Result and Discussion

Figure 3 shows the relationship between the performance of the algorithm and the standard deviation σ of the LOS measurement error without NLOS measurement error. It can be seen from the figure that the localization performance of each algorithm is similar when the measurement error is small. However, when the standard deviation σ is high and the localization sensor performance is poor, the root mean square error of the localization algorithm proposed in this paper is significantly smaller than other algorithms, and it has better localization stability.

Figure 4 shows the error curve of the algorithms with their performances as a function of NLOS measurement error when several other conditions are the same. It can be seen from the figure that the TSWLS algorithm failed to maintain a good localization performance in the LOS/NLOS mixed propagation environment, while the RWGH algorithm, the RT algorithm and the proposed algorithm can reduce the influence of NLOS signal on the localization result in this mixed propagation environment. When the NLOS error is large, the proposed algorithm has better localization performance.

Figure 5 shows the relationship between algorithm performance and the number of NLOS base stations. It can be seen from the figure that as the number of NLOS base stations increased, the localization performance of all algorithms decreased. The localization algorithm based on residual identification sharply declined in localization performance when half of the base stations were changed to NLOS ones. The proposed algorithm maintained high localization accuracy when there were large proportion of NLOS base stations.

Figure 6 compares the CDF curves of four algorithms when σ is 0.2 m, where there were 2 NLOS base stations, and the maximum possible error of NLOS was 3 m. According to the results in the figure, it can be seen that the algorithm error proposed in this paper is significantly smaller than other algorithms. In addition, the proposed algorithm is smooth when the error value is less than 0.6 m. This shows that under this simulation condition, the maximum localization error of the proposed algorithm is less than 0.6 m, and it is unlikely to cause misjudgment in the application.

## 4. Field Test in Substation

#### 4.1. Test Arrangement

To verify the simulation results, a localization test was carried out in a 220 kV substation. The photo of the substation site layout is shown in Figure 7. Figure 8 is a plain view of the substation test arrangement. In Figure 8, 1 is a lightning arrester; 2 is a voltage transformer; 3 is a circuit breaker; 4 is a current transformer; 5 is an isolating switch; 6 is a coupling capacitor, and U, V, and W represent three phases of a high voltage device. In the space rectangular coordinate system established in the substation, the unit of coordinates is meters. The eight localization base stations had the coordinates

**S**(−9.5, −5.5, 1.8),_{1}**S**(−9.5, −5.5, 0),_{2}**S**(9.5, −5.5, 1.8),_{3}**S**(9.5, −5.5, 0),_{4}**S**(9.5, 5.5, 1.8),_{5}**S**(9.5, 5.5, 0),_{6}**S**(−9.5, 5.5, 1.8),_{7}**S**(−9.5, 5.5, 0). The UWB measurement module was arranged at the corresponding location to obtain relevant measurement information. At the same time, the tag for the signal source was fixed on a rigid long rod to serve as a localization target, and the height of the tag was 1.5 m. In this paper, two paths were designed in the experiment. One was a straight path and the other was a rectangular path. For the straight path, the localization target carrying the tag was moved manually from measuring point P_{8}_{1}(2.5, 3, 1.5) to measuring point P_{2}(−1.1, 0.76, 1.5) and finally to measuring point P_{3}(−4.8, −1.6, 1.5). For the rectangle path, the four vertices of the path were (−4, 3, 1.5), (4, 3, 1.5), (4, −1, 1.5), (−4, −1, 1.5), respectively. The target moves along a rectangular path determined by these four vertices.#### 4.2. Test Result and Discussion

The time difference measured between the base station in the field is calculated by using the probability distribution-based localization algorithm, the RWGH localization algorithm, the RT algorithm, and the TSWLS algorithm, respectively. To better verify the superiority of the proposed algorithm, this section also adds the localization trajectory of the TSWLS localization algorithm improved by the PF [26] method, and compares it with each algorithm.

The localization track of the straight path is shown in Figure 9 and Figure 10, from which it can be seen that the localization error of the proposed method is significantly smaller than other localization methods. In the XY plane, in addition to the TSWLS algorithm, the localization trajectories of the other four localization algorithms are basically distributed next to the actual trajectory. The algorithm proposed in this paper is more precise than the RWGH algorithm, the RT algorithm, and the PF method. In the XZ plane, the localization algorithm proposed in the paper has far smaller error in height localization than the RWGH algorithm and the PF algorithm. The RT algorithm has a large error. When the target moved along a straight path, the RMSE value of the localization value and the real value of the proposed algorithm was 0.25 m, the RMSE obtained by the PF algorithm was 0.34 m, the RMSE of the RWGH algorithm and the real value was 0.52 m, and the RMSE obtained by the RT algorithm was 1.09 m. The RMSE obtained by the TSWLS algorithm was 1.41 m. From the results, we can see that under the linear trajectory, the proposed algorithm has the best localization performance.

The localization track of the rectangle path is shown in Figure 11 and Figure 12 The localization accuracy of the proposed method is obviously better than other methods in both XY plane and XZ plane. When the target moved along a rectangle path, the RMSE value of the localization value and the real value of the proposed algorithm was 0.28 m, the RMSE obtained by the PF algorithm was 0.55 m, the RMSE of the RWGH algorithm and the real value was 0.59 m, and the RMSE obtained by the RT algorithm was 0.94 m. The RMSE obtained by the TSWLS algorithm was 1.38 m. The localization error of the PF localization algorithm under the rectangular trajectory is slightly increased. This is because the motion state changes at the turning point of the moving target, and the correction effect of the PF localization algorithm on the localization trajectory will decrease. Under the rectangular trajectory, the localization error of the proposed localization algorithm is still the lowest among these five algorithms.

The RMSE of the localization results and the true values of each of the algorithms under the scenarios of two different paths is shown in Table 2. From Table 2, we can see that in the case of NLOS, TSWLS cannot guarantee the accuracy of localization result. From Figure 9 to Figure 12, we can see that the localization result of TSWLS in this environment is not stable. From the results, we can also see that the PF can effectively improve the initial localization result of the TSWLS algorithm. The correction effect of the PF algorithm on the linear trajectory is better than the correction effect on the rectangular trajectory. This is because the moving state of the moving target changes significantly at the corner, and in the localization system with only the distance sensor, the motion state of the object itself cannot be corrected very well. Finally, it can be seen from Table 2 that the localization accuracy of the proposed algorithm in both paths does not change significantly, and the RMSE values are less than 30 cm, which is the minimum of among all the algorithms. When the object moves along a linear path, the localization error of the proposed algorithm is only 0.09 m lower than the PF localization method. However, on the rectangular trajectory, the localization error of the proposed algorithm is reduced by 0.27 m compared with the PF localization algorithm. This is because the algorithm proposed in the paper does not rely on other state information of the target to correct the localization result. The algorithm proposed in this paper reduces the influence of measurement error on the localization result based on the probability distribution function of the initial localization result of the group, so it is less affected by the moving trajectory of the target.

The average time consumption of an algorithm for a single point in the localization process is shown in Table 3, from which we can see that the algorithm mentioned in the paper takes the second longest time of these five localization algorithms, but it did not exceed 0.1 s. The localization target moving speed in the substation is not too fast; although the algorithm proposed in the paper is not as efficient as the existing algorithm, it can still meet the requirement in practical application. How to further improve the computational efficiency of the proposed algorithm is an area for improvement in follow-up studies.

To further analyze the influence of measurement error on the localization accuracy of the proposed algorithm and the RWGH algorithm, the below analyzes the localization results of P

_{1}, P_{2}, and P_{3}.Table 4 lists the time difference among the time when the tag signal is at P

_{1}, P_{2}, and P_{3}, and the difference between the time difference measurement and the real-time difference. T_{i1}in the table indicates the time difference between the arrival of the signal at the i-th base station and the first base station.As can be seen from Table 4, the time measurement error, when the base station is in the LOS situation, generally does not exceed 0.5 ns. The closer the measurement distance, the smaller the measurement error. When the localization base station is occluded, the measurement error changes depending the severity of the occlusion. Localization base stations 5 and 6 may be taken as an example for further analysis. These two base stations were in front of a lightning arrester, and localization base station 5 was placed on the ground, so that the occlusion is severe. However, since localization base station 6 was placed high above ground, the occlusion is not obvious when the measurement point was far away, and the measurement error did not change significantly.

The data in Table 4 was made available to apply the RWGH algorithm and to apply the proposed algorithm for localization. The results are shown in Table 5. The accuracy of the algorithm is represented by the RMSE value of the localization result and the actual result. The unit of the coordinates and the RMSE value in Table 5 are in meters. It can be seen from Table 5 that the localization algorithm proposed in this paper is more stable than the RWGH algorithm, especially when the NLOS measurement error is serious. Taking P

_{1}as an example, the localization performance of the proposed method is significantly better than the existing algorithm. At the same time, among the three localization points, the final localization errors of the localization points P_{2}and P_{3}are small. This is because the positions of P_{2}and P_{3}are relatively empty, the error of the time difference measurement from the point to each base station is small.Combined with the data of the field test, the accuracy of the time difference measurement has a great influence on the localization result. The localization algorithm proposed in this paper can effectively reduce the influence of measurement error on localization error, and each single coordinate error fell within 30 cm. In the actual application in the substation, in addition to considering the placement of the localization base station and improving its measurement performance, the localization method proposed in this paper can effectively reduce the influence of measurement error and make the localization result more reliable.

## 5. Conclusions

This paper proposes a new localization method based on TSWLS and probability distribution function. The proposed method obtains multiple sets of initial localization results using the two-step weighted least-squares method, and constructs the probability distribution function of the target by using the initial localization results. The final localization result is obtained by solving the objective function. This localization method reduces the influence of measurement error on the localization result, and can effectively improve the stability and effectiveness of the localization algorithm. For the traditional LS localization, the localization result obtained by the data with more LOS measurements will be closer to the actual coordinates of the target, and will be regularly distributed around the actual coordinates. The initial localization results obtained by the data with more NLOS measurements will have large deviations, which show no regularity. By constructing the probability distribution function, the initial localization results that are greatly affected by the NLOS error can be effectively eliminated. This can help solve the shortcoming that the traditional least-squares-based localization method is greatly affected by the NLOS error. At the same time, through the simple base station screening algorithm, the algorithm proposed in the paper has better computational efficiency.

The results of the simulation analysis and the field test show that the average localization error is reduced by more than one meter compared with the TSWLS method when the measurement error is large. Compared with the RWGH algorithms and the RT method, the proposed algorithm has improved the localization accuracy by more than 50%. Compared with the PF method, the proposed method also has better performance. When the object moves along a linear path, the localization error of the proposed algorithm is 0.09 m lower than the PF localization method. However, on the rectangular trajectory, the localization error of the proposed algorithm is reduced by 0.27 m compared with the PF localization algorithm. This method can keep the coordinate error within 30 cm in the substation environment. This proves that the localization method proposed in this paper can achieve precise localization of targets in substation environments with only the ranging sensors, although the computational efficiency of the proposed algorithm is not as efficient as some existing algorithms. The average time required for a single-point calculation using the proposed algorithm is less than 0.1 s on an ordinary PC. It can meet the basic requirements of the mobile target location in the substation.

## Author Contributions

Conceptualization, Y.W. and W.Y.; Formal analysis, Y.W., W.Y., Z.W. and W.Z.; Funding acquisition, Y.W. and Z.W.; Investigation, H.Z.; Methodology, W.Y.; Project administration, Z.W., W.Z. and L.L.; Resources, H.Z.; Supervision, W.Z.; Writing—original draft, Y.W. and W.Y.; Writing—review and editing, Y.W., Z.W., W.Z., L.L. and H.Z.

## Funding

This research was funded by State Grid Corporation Headquarters Science and Technology Project, grant No. 546816180001.

## Conflicts of Interest

The authors declare no conflict of interest.

## References

- Durocher, D.B. Considerations in unit substation design to optimize reliability and electrical workplace safety. In Proceedings of the 2010 IEEE IAS Electrical Safety Workshop, Memphis, TN, USA, 1–5 Feburay 2010; pp. 3–16. [Google Scholar] [CrossRef]
- Sheng, H.; Shi, J.; Qiu, Q.; Jiang, W.; Niu, J. The warning strategy research on safety measures of smart substation according to correlation model. In Proceedings of the 2015 5th International Conference on Electric Utility Deregulation and Restructuring and Power Technologies (DRPT), Changsha, China, 26–29 November 2015; pp. 1095–1098. [Google Scholar]
- Martinez-Sandoval, R.; Garcia-Sanchez, A.J.; Garcia-Sanchez, F.; Garcia-Haro, J.; Flynn, D. A Comprehensive WSN-Based Approach to Efficiently Manage a Smart Grid. Sensors
**2014**, 14, 18748–18783. [Google Scholar] [CrossRef] [PubMed] - Mavridis, T.; Sarrazin, J.; Petrillo, L.; De Doncker, P.; Benlarbi-Delai, A. Information Spatial Focusing Scheme for UWB Wireless Communications in Smart Environments. IEEE Antennas Wirel. Propag. Lett.
**2015**, 14, 20–23. [Google Scholar] [CrossRef] - Chan, Y.T.; Ho, K.C. A Simple and Efficient Estimator for Hyperbolic Location. IEEE Trans. Signal. Process.
**1994**, 42, 1905–1915. [Google Scholar] [CrossRef] - Lin, L.X.; So, H.C.; Chan, F.K.W.; Chan, Y.T.; Ho, K.C. A new constrained weighted least squares algorithm for TDOA-based localization. Signal. Process.
**2013**, 93, 2872–2878. [Google Scholar] [CrossRef] - Chan, Y.T.; Hang, H.Y.C.; Ching, P.C. Exact and approximate maximum likelihood localization algorithms. IEEE Trans. Veh. Technol.
**2006**, 55, 10–16. [Google Scholar] [CrossRef] - Buehrer, R.M.; Jia, T. Collaborative Position Location; Wiley-IEEE Press: New York, NY, USA, 2011; pp. 755–811. [Google Scholar]
- Cong, L.; Zhuang, W.H. Hybrid TDOA/AOA mobile user location for wideband CDMA-cellular systems. IEEE Trans. Wirel. Commun.
**2002**, 1, 439–447. [Google Scholar] [CrossRef] - Chan, Y.T.; Tsui, W.Y.; So, H.C.; Ching, P.C. Time-of-arrival based localization under NLOS conditions. IEEE Trans. Veh. Technol.
**2006**, 55, 17–24. [Google Scholar] [CrossRef] - Hua, J.Y.; Yin, Y.J.; Lu, W.D.; Zhang, Y.; Li, F. NLOS Identification and Positioning Algorithm Based on Localization Residual in Wireless Sensor Networks. Sensors
**2018**, 18, 2991. [Google Scholar] [CrossRef] - Gazzah, L.; Najjar, L.; Besbes, H. Selective hybrid RSS/AOA weighting algorithm for NLOS intra cell localization. In Proceedings of the 2014 IEEE Wireless Communications and Networking Conference (WCNC), Istanbul, Turkey, 6–9 April 2014. [Google Scholar] [CrossRef]
- Venkatesh, S.; Buehrer, R.M. A linear programming approach to NLOS error mitigation in sensor networks. In Proceedings of the International Conference on Information Processing in Sensor Networks, Nashville, TN, USA, 19–21 April 2006; pp. 301–308. [Google Scholar]
- Li, X.; Cai, X.; Hei, Y.; Yuan, R. NLOS identification and mitigation based on channel state information for indoor WiFi localisation. IET Commun.
**2017**, 11, 531–537. [Google Scholar] [CrossRef] - Park, J.; Cho, Y.K. Development and Evaluation of a Probabilistic Local Search Algorithm for Complex Dynamic Indoor Construction Sites. J. Comput. Civil Eng.
**2017**, 31, 4. [Google Scholar] [CrossRef] - Faragher, R.; Harle, R. An Analysis of the Accuracy of Bluetooth Low Energy for Indoor Positioning Applications. In Proceedings of the 27th International Technical Meeting of the Satellite Division of the Institute of Navigation, Tampa, FL, USA, 8–12 September 2014; pp. 201–210. [Google Scholar]
- Wang, W.; Wang, G.; Zhang, J.; Li, Y.M. Robust Weighted Least Squares Method for TOA-Based Localization Under Mixed LOS/NLOS Conditions. IEEE Commun. Lett.
**2017**, 21, 2226–2229. [Google Scholar] [CrossRef] - Khalajmehrabadi, A.; Gatsis, N.; Akopian, D. Indoor WLAN localization using group sparsity optimization technique. In Proceedings of the 2016 IEEE Position, Location and Navigation Symposium (PLANS), Savannah, GA, USA, 11–14 April 2016; pp. 584–588. [Google Scholar]
- Chen, C.; Feng, K. An efficient geometry-constrained location estimation algorithm for NLOS environments. In Proceedings of the International Conference on Wireless Networks, Maui, HI, USA, 13–16 June 2005; pp. 244–249. [Google Scholar]
- Wu, S.X.; Li, J.P.; Liu, S.Y. Improved Localization Algorithms Based on Reference Selection of Linear Least Squares in LOS and NLOS Environments. Wirel. Pers. Commun.
**2013**, 68, 187–200. [Google Scholar] [CrossRef] - Zhang, S.J.; Gao, S.C.; Wang, G.; Li, Y.M. Robust NLOS Error Mitigation Method for TOA-Based Localization via Second-Order Cone Relaxation. IEEE Commun. Lett.
**2015**, 19, 2210–2213. [Google Scholar] [CrossRef] - Wang, G.; So, A.M.C.; Li, Y.M. Robust Convex Approximation Methods for TDOA-Based Localization Under NLOS Conditions. IEEE Trans. Signal. Process.
**2016**, 64, 3281–3296. [Google Scholar] [CrossRef] - Perala, T.; Piché, R. Robust extended Kalman filtering in hybrid positioning applications. In Proceedings of the 2007 4th Workshop on Positioning, Navigation and Communication, Hannover, Germany, 22 March 2007; pp. 55–63. [Google Scholar]
- Kalman, R.E. A new approach to linear filtering and prediction problem. Trans. ASME J. Basic Eng.
**1960**, 82, 35–45. [Google Scholar] [CrossRef] - Julier, S.J.; Uhlmann, J.K.; Durran-whyte, H.F. A New Approach for Filtering Nonlinear Systems. In Proceedings of the 1995 American Control Conference—ACC95, Seattle, WA, USA, 21–23 June 1995; pp. 1628–1632. [Google Scholar]
- Salman, N.; Alsindi, N.; Mihaylova, L.; Kemp, A.H. Super resolution WiFi indoor localization and tracking. In Proceedings of the 2014 Sensor Data Fusion: Trends, Solutions, Applications (SDF), Bonn, Germany, 8–10 October 2014; pp. 1–5. [Google Scholar]
- Chang, L.; Hu, B.; Chang, G.; Li, A. Huber-based novel robust unscented Kalman filter. IET Sci. Meas. Technol.
**2012**, 6, 502–509. [Google Scholar] [CrossRef] - Wang, J.K.; Wang, P.; Chen, Z.H. A novel qualitative motion model based probabilistic indoor global localization method. Inf. Sci.
**2018**, 429, 284–295. [Google Scholar] [CrossRef] - Zhang, Q.B.; Wang, P.; Chen, Z.H. An improved particle filter for mobile robot localization based on particle swarm optimization. Expert Syst. Appl.
**2019**, 135, 181–193. [Google Scholar] [CrossRef] - Gante, A.D.; Siller, M. A Survey of Hybrid Schemes for Location Estimation in Wireless Sensor Networks. Procedia Technol.
**2013**, 7, 377–383. [Google Scholar] [CrossRef] - Wang, W.; Wang, G.; Zhang, F.; Li, Y. Second-Order Cone Relaxation for TDOA-Based Localization under Mixed LOS/NLOS Conditions. IEEE Signal. Process. Lett.
**2016**, 23, 1872–1876. [Google Scholar] [CrossRef] - Sun, M.; Ho, K.C. Refining inaccurate sensor positions using target at unknown location. Signal. Process.
**2012**, 92, 2097–2104. [Google Scholar] [CrossRef] - Zhou, W.; Li, P.; Yang, S.; Liu, Y.; Tian, Y.; Wang, Y. Partial Discharge Localization Method by Multi-direction Measurement Using Directional Antenna in Substation. High. Volt. Eng.
**2017**, 43, 1476–1484. [Google Scholar] - Jiao, L.; Li, F.Y.; Xu, Z.Y. LCRT: A ToA Based Mobile Terminal Localization Algorithm in NLOS Environment. In Proceedings of the VTC Spring 2009—IEEE 69th Vehicular Technology Conference, Barcelona, Spain, 26–29 April 2009; pp. 1–5. [Google Scholar]

**Figure 5.**The error curve of various algorithm performance when the number of NLOS base stations changes (the maximum error of NLOS is 3 m).

σ/m | B/m | Number of NLOS Base Stations | |
---|---|---|---|

Simulation 1 | variable | 0 | 0 |

Simulation 2 | 0.2 | variable | 2 |

Simulation 3 | 0.2 | 3 | variable |

Simulation 4 | 0.2 | 3 | 2 |

The Proposed Method | The RWGH Method | The RT Method | The TSWLS Method | The PF Method | |
---|---|---|---|---|---|

straight path | 0.25 m | 0.52 m | 1.09 m | 1.41 m | 0.34 m |

rectangle path | 0.28 m | 0.59 m | 0.94 m | 1.38 m | 0.55 m |

The Proposed Method | The RWGH Method | The RT Method | The TSWLS Method | The PF Method | |
---|---|---|---|---|---|

time taken | 0.094 s | 0.058 s | 0.026 s | 4.69 × 10^{−4} s | 0.126 s |

Time Difference | P_{1} | P_{2} | P_{3} | |||
---|---|---|---|---|---|---|

Measurements | Error | Measurements | Error | Measurements | Error | |

T_{21} | −0.24 ns | 0.15 ns | −0.17 ns | 0.17 ns | −0.66 ns | −0.08 ns |

T_{31} | −7.90 ns | 4.33 ns | 6.87 ns | 0.81 ns | 29.28 ns | 0.58 ns |

T_{41} | −9.84 ns | 2.71 ns | 6.42 ns | 0.65 ns | 28.10 ns | −0.35 ns |

T_{51} | −17.61 ns | 6.39 ns | 7.26 ns | 3.51 ns | 28.18 ns | 4.31 ns |

T_{61} | −21.65 ns | 2.83 ns | 3.86 ns | 0.47 ns | 31.38 ns | 0.89 ns |

T_{71} | −8.22 ns | −0.11 ns | −2.42 ns | 0.32 ns | 8.10 ns | 0.24 ns |

T_{81} | −8.72 ns | −0.32 ns | −3.29 ns | −0.19 ns | 7.63 ns | 0.19 ns |

Actual | The Proposed Method | The RWGH Method | ||
---|---|---|---|---|

Coordinates/m | Result/m | RMSE/m | Result/m | RMSE/m |

P_{1} (2.5,3,1.5) | (2.63,3.18,1.28) | 0.313 | (2.44,2.56,0.65) | 0.960 |

P_{2} (−1.1,0.76,1.5) | (−0.99,0.87,1.34) | 0.223 | (−0.89,0.63,1.28) | 0.339 |

P_{3} (−4.8,−1.6,1.5) | (−4.68,−1.68,1.66) | 0.219 | (−4.96,−1.74,1.32) | 0.278 |

© 2019 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (http://creativecommons.org/licenses/by/4.0/).