Open Access
This article is
 freely available
 reusable
Sensors 2019, 19(20), 4438; https://doi.org/10.3390/s19204438
Article
A Localization and Tracking Approach in NLOS Environment Based on Distance and Angle Probability Model
^{1}
Department of Control Science and Engineering, University of Shanghai for Science and Technology, Shanghai 200093, China
^{2}
College of Science, University of Shanghai for Science and Technology, Shanghai 200093, China
^{*}
Author to whom correspondence should be addressed.
Received: 11 September 2019 / Accepted: 9 October 2019 / Published: 14 October 2019
Abstract
:In this paper, an optimization algorithm is presented based on a distance and angle probability model for indoor nonlineofsight (NLOS) environments. By utilizing the sampling information, a distance and angle probability model is proposed so as to identify the NLOS propagation. Based on the established model, the maximum likelihood estimation (MLE) method is employed to reduce the error of distance in the NLOS propagation. In order to reduce the computational complexity, a modified Monte Carlo method is applied to search the optimal position of the target. Moreover, the extended Kalman filtering (EKF) algorithm is introduced to achieve localization. The simulation and experimental results show the effectiveness of the proposed algorithm in the improvement of localization accuracy.
Keywords:
NLOS; EKF; localization; probability model; MLE1. Introduction
With the rapid development of wireless communication technology in recent years, wireless localization systems have received considerable research interest due to the increasing demand of locationbased services (e.g., [1,2,3,4,5]). At present, many localization technologies have been widely used, such as GPS [6], CPS [7], and WLAN [8,9]. It is acknowledged that these localization systems perform well under ideal conditions [10,11,12,13]. However, in realworld situations, due to the complexity of the environment such as the nonlineofsight (NLOS) condition, the obstruction of the line of sight of the wireless communication between the anchor and the target may decrease the accuracy of the distance measurement, which accordingly leads to a poor localization accuracy [14].
So far, there are various methods to deal with ranging bias in the NLOS propagation. Based on the range measurements, the target localization issue in harsh indoor environments was investigated in [15]. By using the semidefinite programming relaxation technique, a robust estimator was introduced in [16] for the purpose of coping with the NLOS bias. The localization accuracy of rangeonly sensors with both additive and multiplicative noises was investigated in [17,18]. After that, in [19], the Manhattan distance was introduced to the WKNN algorithm to distinguish the influence of different reference nodes. In [20], the scene analysis approach was employed including two stages, namely, the offline stage and the online stage. In the offline stage, the wireless signals from all the anchors are recorded at each specific location in order to build a fingerprint database. In the online stage, according to the built fingerprint database, the Knearest neighbor and weighted Knearest neighbor algorithms were adopted to classify the data obtained from the environment into specific classifications. On the other hand, most of the existing results with respect to various NLOS identification methods (i.e., distinguish that the environment is in LOS (lineofsight) or NLOS propagation) are based on range estimates [21,22,23,24,25,26,27]. Note that all these methods require a sufficient number of measurements to reduce the impact of NLOS range estimates, which imposes a great burden on the computational complexity.
Generally, LOS propagation is more likely to occur when the distance between a target and an anchor is short enough. However, in real environments, with the increasing distance between the target and the anchor, the probability of NLOS propagation increases accordingly. In [28], LOS/NLOS probability was assumed to be fixed and known a priori, which ignores the fact that the occurrence probability of LOS and NLOS propagations is dependent on the distance between the target and the anchor. In [14], the distancerelated LOS/NLOS probability model was proposed. However, in addition to the distance, the NLOS propagation probability is also affected by the angle between the target and the anchor, which has not been taken into consideration in most of the reported results.
In this paper, the localization problem is considered in a real environment. The main contributions of this paper are summarized as follows:
(1) An optimization algorithm based on a distance and angle probability model for an indoor NLOS environment is proposed. Based on the NLOS propagation occurrence probability model, the maximum likelihood estimation (MLE) method is used to estimate the target position in order to suppress the NLOS error. In order to increase the speed of the operation, a simplified Monte Carlo algorithm is used to estimate the state. In addition, the extended Kalman filtering (EKF) algorithm is applied to the localization system to reduce measurement errors.
(2) The parameter acquisition method of the NLOS propagation occurrence probability model is given, which is obtained by sampling in the environment to acquire the probability of occurrence of NLOS status at different distances and angles.
(3) According to the characteristics of the signal, a simulation environment is established, which is similar to the real environment. A practical measurement scheme is used to verify the effectiveness of the proposed algorithm and compared with the existing algorithms.
The remainder of this paper is organized as follows. In Section 2, the system model is introduced. A probability model of the occurrence of NLOS propagation is formulated in Section 3. Based on the established model in Section 3, an MLE method is presented in Section 4. In Section 5, a localization method based on the extended Kalman filter algorithm is put forward. Simulation and experimental results are given in Section 6. Conclusions are drawn in Section 7.
2. System Model
In this paper, the system model under consideration is in a twodimensional environment. It is assumed that there are N anchors in the environment, and the position of the ith anchor is denoted as $({x}_{i},{y}_{i})$, where ${x}_{i}$ is the value of the anchor on the xaxis and ${y}_{i}$ is the value on the yaxis. Similarly, the location of the target is represented as $(x,y)$. The measurement distance between the ith anchor and the target is expressed as:
where ${z}_{i}\left(t\right)$ is the measured distance and ${d}_{ri}\left(t\right)$ is the real distance between the ith anchor and the target at time t. $Gau\left(t\right)$ is the Gaussian white noise with zeromean and variance ${\sigma}_{los}^{2}$ in the LOS propagation. $NLOS\left(t\right)$ stands for the error in NLOS propagation, which can also be described by the Gaussian white noise with mean ${\mu}_{nlos}$ and variance ${\sigma}_{nlos}^{2}$. Here, the $Gau\left(t\right)$ and $NLOS\left(t\right)$ are assumed to be mutually independent in the propagation environment.
$${z}_{i}\left(t\right)={d}_{ri}\left(t\right)+Gau\left(t\right)+{\beta}_{i}\xb7NLOS\left(t\right),$$
Remark 1.
Because of the complicated propagation environment, not all the propagations are LOS propagations. In (1), ${\beta}_{i}$ is a random variable taking values with 0 and 1. If the distance is measured in the NLOS propagation, the noise includes $Gau\left(t\right)$ and $NLOS\left(t\right)$ (i.e., ${\beta}_{i}=1$). Otherwise, if the distance is measured in the LOS propagation, the noise only includes $Gau\left(t\right)$ (i.e., ${\beta}_{i}=0$).
It should be pointed out that in practical engineering, the distributions of $Gau\left(t\right)$ and $NLOS\left(t\right)$ can be determined a priori via the measurements and precalibration. Consequently, the probability density function of the ${d}_{i}\left(t\right)$ in the LOS and NLOS propagation are, respectively, expressed as
$$\begin{array}{cc}\hfill {p}_{los}\left({z}_{i}\right)& =\frac{1}{\sqrt{2\pi {\sigma}_{los}^{2}}}\xb7{e}^{\frac{{({z}_{i}{d}_{ri})}^{2}}{2{\sigma}_{los}^{2}}}\hfill \end{array}$$
$$\begin{array}{cc}\hfill {p}_{nlos}\left({z}_{i}\right)& =\frac{1}{\sqrt{2\pi ({\sigma}_{los}^{2}+{\sigma}_{nlos}^{2})}}\xb7{e}^{\frac{{({z}_{i}{d}_{ri}{\mu}_{nlos})}^{2}}{2({\sigma}_{los}^{2}+{\sigma}_{nlos}^{2})}}.\hfill \end{array}$$
Moreover, it is assumed that NLOS propagation occurs with probability ${p}_{i,nlos}$. As such, the probability density function of ${z}_{i}\left(t\right)$ can be expressed as:
where ${\theta}_{i}\in \left(180,180\right]$ represents the angle between the positive direction of the xaxis and the vector constituted by the ith anchor and point x, and ${p}_{i,los}({z}_{i},{\theta}_{i};x)=1{p}_{i,nlos}({z}_{i},{\theta}_{i};x)$.
$$\begin{array}{cc}\hfill p({z}_{i};x)& ={p}_{nlos}({z}_{i};x)\xb7{p}_{i,nlos}({z}_{i},{\theta}_{i};x)\hfill \\ \hfill \phantom{\rule{1.em}{0ex}}& \phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}+{p}_{los}({z}_{i};x)\xb7{p}_{i,los}({z}_{i},{\theta}_{i};x),\hfill \end{array}$$
3. NLOS Propagation Occurrence Probability Model
Due to the complexity and uncertainty of the propagation, it is improper to describe the probability of the NLOS propagation as a constant. In order to better reflect reality, it is necessary to extract samples to get the characteristics of the environment. The distancebased probability model was proposed in [14], which described that the probability of the NLOS propagation increased with the distance. However, in the actual environment, the probability of NLOS propagation is related to not only the distance but also the angle. In addition, the probability of NLOS propagation is diverse in different environments. Therefore, a probability model of NLOS propagation needs to be established which gives the probability of NLOS propagation based on the distance and angle information between the measured target and the anchor node. For convenience, it is assumed that the distance and the angle are mutually independent in the NLOS propagation.
Denote by N the number of sampling points. In order to reduce the influence of the noise of the LOS propagation in the measurement, multiple distances are measured and the average value is calculated at each sampling point. The actual distance and the measured distance between the ith anchor and the jth sampling point are expressed as ${d}_{r,i,j}$ and ${z}_{i,j}$, respectively. ${\theta}_{r,i,j}\in \left(180,180\right]$ is the angle between the positive direction of the xaxis and the vector which is the anchor to the sampling point. By calculating the difference between the actual distance and the measured distance, we can determine whether NLOS propagation exists or not. As such, an indicative variable is introduced as follows:
where ${g}_{i,j}=1$ means that the measured distance is in the NLOS propagation between the ith anchor and the jth sampling point, and ${d}_{threshold}$ is a given constant, which can be set slightly larger than measurement error. The bound of the measurement error $\eta $ can be given, and we have
$$\begin{array}{cc}\hfill {g}_{i,j}& =\left\{\begin{array}{c}1,\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}{z}_{i,j}{d}_{r,i,j}>{d}_{threshold}\hfill \\ 0,\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}else\hfill \end{array}\right.,\hfill \end{array}$$
$$\begin{array}{c}\hfill \eta \le Gau\left(t\right)\le \eta .\end{array}$$
The probability satisfying (6) can be expressed as
$$\begin{array}{c}\hfill \zeta ={\int}_{\eta}^{\eta}\frac{1}{\sqrt{2\pi}{\sigma}_{los}}exp(\frac{{z}^{2}}{2{\sigma}_{los}^{2}})dz.\end{array}$$
In order to reduce the possibility that the measurement noise is determined as the NLOS error, the parameter $\zeta $ can be set to 0.99, that is, the probability that the measurement error is determined as the NLOS error is 1%. According to (7) and the properties of the Gaussian noise, we can obtain $\eta \approx 2.58{\sigma}_{los}$. Therefore, ${d}_{threshold}$ can be set to $2.58{\sigma}_{los}$.
The maximum of the actual distance between the ith anchor and each sampling point is expressed as ${d}_{rmax,i}$. Divide the interval $(0,{d}_{rmax,i}]$ into ${n}_{di}$ equal subintervals and the ${i}_{ds}$th subinterval is $\left(({i}_{ds}1)\xb7\frac{{d}_{rmax,i}}{{n}_{di}},{i}_{ds}\xb7\frac{{d}_{rmax,i}}{{n}_{di}}\right]$, where ${i}_{ds}=1,2,\cdots ,{n}_{di}$. The central point of the ${i}_{ds}$th distance subinterval can be expressed as
$$\begin{array}{cc}\hfill {d}_{c,{i}_{ds}}& =\frac{(2{i}_{ds}1)\xb7{d}_{rmax,i}}{2{n}_{di}}.\hfill \end{array}$$
Subsequently, assign N sampling points to ${n}_{di}$ distance subintervals and the number of the sampling points in the ${i}_{ds}$th subintervals is ${n}_{di,{i}_{ds},total}$. For the ${i}_{ds}$th subinterval, it is assumed that there are ${n}_{di,{i}_{ds},nlos}$ sampling points in the NLOS propagation. As such, the probability of NLOS propagation in the ${i}_{ds}$th interval can be expressed as
$${p}_{di,{i}_{ds},nlos}=\frac{{n}_{di,{i}_{ds},nlos}}{{n}_{di,{i}_{ds},total}}.$$
The probability acquisition method related to distance is summarized in Algorithm 1.
Algorithm 1 The probability acquisition method related to distance. 

Similarly, the ${i}_{\theta s}$th subinterval is $\left(\pi +({i}_{\theta s}1)\xb7\frac{2\pi}{{n}_{\theta i}},\pi +{i}_{\theta s}\xb7\frac{2\pi}{{n}_{\theta i}}\right]$ and the central point of the ${i}_{\theta s}$th angle subinterval is described as
$$\begin{array}{c}\hfill {\theta}_{c,{i}_{\theta s}}=\pi +\frac{\pi \xb7(2{i}_{\theta s}1)}{{n}_{\theta i}}.\end{array}$$
Then, assign N sampling points to ${n}_{\theta i}$ angle subintervals and the number of the sampling points in the ${i}_{\theta s}$th subinterval is ${n}_{\theta i,{i}_{\theta s},total}$. Also, for the ${i}_{\theta s}$th subinterval, it is assumed that there are ${n}_{\theta i,{i}_{\theta s},nlos}$ sampling points in the NLOS propagation. Consequently, the probability of NLOS propagation in the ${i}_{\theta s}$th interval is calculated as
$${p}_{\theta i,{i}_{\theta s},nlos}=\frac{{n}_{\theta i,{i}_{\theta s},nlos}}{{n}_{\theta i,{i}_{\theta s},total}}.$$
The probability acquisition method related to angle is summarized in Algorithm 2.
Algorithm 2 The probability acquisition method related to angle. 

Based on the center points ${d}_{c,{i}_{ds}}$, ${\theta}_{c,{i}_{\theta s}}$ and the probabilities ${p}_{di,{i}_{s},nlos}$, ${p}_{\theta i,{i}_{s},nlos}$ in the NLOS propagation in each distance interval and angle interval, the polynomial curve fitting technique is used. DistanceNLOS probability polynomials and angleNLOS probability polynomials are calculated as
where ${p}_{di,nlos}$ and ${p}_{\theta i,nlos}$ are the probabilities of the NLOS propagation at the distance ${d}_{ai}$ and the angle ${\theta}_{bi}$, respectively. ${a}_{{\overline{m}}_{i}}$ and ${\overline{a}}_{{\overline{n}}_{i}}$ are the fitted coefficients, which can be achieved by least square polynomial fitting method. It can be expressed as
where ${p}_{di,nlos}\left({d}_{c,{i}_{ds}}\right)={\displaystyle \sum _{{\overline{m}}_{i}=0}^{{N}_{{\overline{m}}_{i}}}}{a}_{{\overline{m}}_{i}}\xb7{d}_{c,{i}_{ds}}^{{\overline{m}}_{i}}$. By taking partial derivatives of (14) with respect to ${a}_{{\overline{m}}_{i}}$ and setting them equal to 0, we have
$${p}_{di,nlos}=\sum _{{\overline{m}}_{i}=0}^{{N}_{{\overline{m}}_{i}}}{a}_{{\overline{m}}_{i}}\xb7{d}_{ai}^{{\overline{m}}_{i}},$$
$${p}_{\theta i,nlos}=\sum _{{\overline{n}}_{i}=0}^{{N}_{{\overline{n}}_{i}}}{\overline{a}}_{{\overline{n}}_{i}}\xb7{\theta}_{bi}^{{\overline{n}}_{i}},$$
$$\begin{array}{c}\hfill min\sum _{{i}_{ds}=1}^{{n}_{di}}{\left[{p}_{di,nlos}\left({d}_{c,{i}_{ds}}\right){p}_{di,{i}_{ds},nlos}\right]}^{2},\end{array}$$
$$\begin{array}{c}\hfill \left\{\begin{array}{ccc}\hfill \phantom{\rule{1.em}{0ex}}& 2\sum _{{i}_{ds}=1}^{{n}_{di}}\left[{p}_{di,nlos}\left({d}_{c,{i}_{ds}}\right){p}_{di,{i}_{ds},nlos}\right]\hfill & \hfill =0\\ \hfill \phantom{\rule{1.em}{0ex}}& 2\sum _{{i}_{ds}=1}^{{n}_{di}}\left[{p}_{di,nlos}\left({d}_{c,{i}_{ds}}\right){p}_{di,{i}_{ds},nlos}\right]{d}_{c,{i}_{ds}}\hfill & \hfill =0\\ \hfill \phantom{\rule{1.em}{0ex}}& \phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\phantom{\rule{3.33333pt}{0ex}}\vdots \hfill \\ \hfill \phantom{\rule{1.em}{0ex}}& 2\sum _{{i}_{ds}=1}^{{n}_{di}}\left[{p}_{di,nlos}\left({d}_{c,{i}_{ds}}\right){p}_{di,{i}_{ds},nlos}\right]{d}_{c,{i}_{ds}}^{{N}_{{\overline{m}}_{i}}}\hfill & \hfill =0\end{array}\right.\phantom{\rule{0.277778em}{0ex}}\phantom{\rule{0.277778em}{0ex}}\phantom{\rule{0.277778em}{0ex}}.\end{array}$$
Equation (15) can be organized into a matrix form as follows:
$$\begin{array}{c}\hfill \left[\begin{array}{cccc}{n}_{di}& \sum _{{i}_{ds}=1}^{{n}_{di}}{d}_{c,{i}_{ds}}& \cdots & \sum _{{i}_{ds}=1}^{{n}_{di}}{d}_{c,{i}_{ds}}^{{N}_{{\overline{m}}_{i}}}\\ \sum _{{i}_{ds}=1}^{{n}_{di}}{d}_{c,{i}_{ds}}& \sum _{{i}_{ds}=1}^{{n}_{di}}{d}_{c,{i}_{ds}}^{2}& \cdots & \sum _{{i}_{ds}=1}^{{n}_{di}}{d}_{c,{i}_{ds}}^{{N}_{{\overline{m}}_{i}}+1}\\ \vdots & \vdots & \ddots & \vdots \\ \sum _{{i}_{ds}=1}^{{n}_{di}}{d}_{c,{i}_{ds}}^{{N}_{{\overline{m}}_{i}}}& \sum _{{i}_{ds}=1}^{{n}_{di}}{d}_{c,{i}_{ds}}^{{N}_{{\overline{m}}_{i}}+1}& \cdots & \sum _{{i}_{ds}=1}^{{n}_{di}}{d}_{c,{i}_{ds}}^{2{N}_{{\overline{m}}_{i}}}\end{array}\right]\left[\begin{array}{c}{a}_{0}\\ {a}_{1}\\ \vdots \\ {a}_{{N}_{{\overline{m}}_{i}}}\end{array}\right]=\left[\begin{array}{c}\sum _{{i}_{ds}=1}^{{n}_{di}}{p}_{di,{i}_{ds},nlos}\\ \sum _{{i}_{ds}=1}^{{n}_{di}}{d}_{c,{i}_{ds}}{p}_{di,{i}_{ds},nlos}\\ \vdots \\ \sum _{{i}_{ds}=1}^{{n}_{di}}{d}_{c,{i}_{ds}}^{{N}_{{\overline{m}}_{i}}}{p}_{di,{i}_{ds},nlos}\end{array}\right].\end{array}$$
It can be expressed as
where $\mathit{F}=\left[\begin{array}{cccc}1& {d}_{c,1}& \cdots & {d}_{c,1}^{{N}_{{\overline{m}}_{i}}}\\ 1& {d}_{c,2}& \cdots & {d}_{c,2}^{{N}_{{\overline{m}}_{i}}}\\ \vdots & \vdots & \cdots & \vdots \\ 1& {d}_{c,{n}_{di}}& \cdots & {d}_{c,{n}_{di}}^{{N}_{{\overline{m}}_{i}}}\end{array}\right]$, $\mathit{y}=\left[\begin{array}{c}{p}_{di,1,nlos}\\ {p}_{di,2,nlos}\\ \vdots \\ {p}_{di,{n}_{di},nlos}\end{array}\right]$ and $\mathit{a}=\left[\begin{array}{c}{a}_{0}\\ {a}_{1}\\ \vdots \\ {a}_{{N}_{{\overline{m}}_{i}}}\end{array}\right]$.
$$\begin{array}{c}\hfill {\mathit{F}}^{T}\mathit{F}\mathit{a}={\mathit{F}}^{T}\mathit{y},\end{array}$$
Therefore, Equation (17) can be solved as
$$\begin{array}{c}\hfill \mathit{a}={\left({\mathit{F}}^{T}\mathit{F}\right)}^{1}{\mathit{F}}^{T}\mathit{y}.\end{array}$$
Similarly, the coefficients ${\overline{a}}_{{\overline{n}}_{i}}$ can be achieved as
where $\mathit{G}=\left[\begin{array}{cccc}1& {\theta}_{c,1}& \cdots & {\theta}_{c,1}^{{N}_{{\overline{n}}_{i}}}\\ 1& {\theta}_{c,2}& \cdots & {\theta}_{c,2}^{{N}_{{\overline{n}}_{i}}}\\ \vdots & \vdots & \cdots & \vdots \\ 1& {\theta}_{c,{n}_{\theta i}}& \cdots & {\theta}_{c,{n}_{\theta i}}^{{N}_{{\overline{n}}_{i}}}\end{array}\right]$, $\overline{\mathit{y}}=\left[\begin{array}{c}{p}_{\theta i,1,nlos}\\ {p}_{\theta i,2,nlos}\\ \vdots \\ {p}_{\theta i,{n}_{\theta i},nlos}\end{array}\right]$, and $\overline{\mathit{a}}=\left[\begin{array}{c}{\overline{a}}_{0}\\ {\overline{a}}_{1}\\ \vdots \\ {\overline{a}}_{{N}_{{\overline{n}}_{i}}}\end{array}\right]$.
$$\begin{array}{c}\hfill \overline{\mathit{a}}={\left({\mathit{G}}^{T}\mathit{G}\right)}^{1}{\mathit{G}}^{T}\overline{\mathit{y}},\end{array}$$
The probability of the NLOS propagation between the point $(x,y)$ and the ith anchor is proposed as:
where
and ${k}_{0}$ is a positive constant.
$$\begin{array}{cc}\hfill {p}_{i,nlos}& ={\alpha}_{i}\xb7{p}_{di,nlos}+(1{\alpha}_{i})\xb7{p}_{\theta i,nlos},\hfill \end{array}$$
$$\begin{array}{cc}\hfill {\alpha}_{i}& =\frac{1}{2}\left({e}^{{k}_{0}\xb7{d}_{i}}+1\right),\hfill \end{array}$$
$$\begin{array}{cc}\hfill {d}_{i}& =\sqrt{{({x}_{i}x)}^{2}+{({y}_{i}y)}^{2}},\hfill \end{array}$$
$$\begin{array}{cc}\hfill {\theta}_{i}& =atan2({y}_{i}y,{x}_{i}x)\hfill \end{array}$$
Remark 2.
In this paper, a new probability model (21) is put forward which is more reasonable to reflect the practical engineering. It is not difficult to see that when the difference of the distance between the estimated position and the real position is fixed, angle error increases as the distance between the real position and the position of the anchor decreases. Therefore, the smaller the distance is, the smaller the confidence level of the anglebased estimation is. In addition, the exponential form of parameter ${\alpha}_{i}$ is selected by experiments.
4. Simplified Calculation of Maximum Likelihood Estimation
According to (4), the probability density function of the distance between each anchor and the target can be obtained. Assuming that the probability density function of the distance between each anchor and the target is independent, one has the following joint likelihood function:
$$p(z;x)=\prod _{i=1}^{n}p({z}_{i};x).$$
The estimate of x by MLE can be obtained as:
where ${\widehat{X}}_{MLE}={\left[{\widehat{x}}_{MLE},{\widehat{y}}_{MLE}\right]}^{T}$.
$$\begin{array}{cc}\hfill {\widehat{X}}_{MLE}& =arg\underset{x}{max}lnp(z;x)\hfill \\ \hfill \phantom{\rule{1.em}{0ex}}& =arg\underset{x}{max}\sum _{i=1}^{n}lnp({z}_{i};x),\hfill \end{array}$$
Normally, finding the analytical solution of (25) is quite timeconsuming, which deteriorates the realtime performance of the system to a great extent. For the purpose of overcoming such a difficulty, an improved Monte Carlo method is proposed to solve (25), which could reduce the computational complexity and accordingly improve the realtime performance of the system.
Assume that at the time $k1$, the position and velocity of the target are $({x}_{k1},{y}_{k1})$ and $({v}_{x,k1},{v}_{y,k1})$, respectively. The angle between the velocity direction and the positive direction of the xaxis is calculated as
where $atan2({v}_{y,k1},{v}_{x,k1})$ is the angle between the vector from origin to $({v}_{x,k1},{v}_{y,k1})$ and xaxis positive direction vector. For the convenience of discussion, the position of the point is expressed in polar coordinates, and $({x}_{k1},{y}_{k1})$ is used as the coordinate origin of polar coordinates. Therefore, the points can be obtained from the parameters of ${d}_{m,i}$ and ${\theta}_{m,i}$ in terms of the following two methods, respectively.
$${\theta}_{v,k1}=atan2({v}_{y,k1},{v}_{x,k1}),$$
(a) The distance satisfies ${d}_{m,i}\sim N(0,{\sigma}_{{}_{ma}}^{2})$ and the angle satisfies ${\theta}_{m,i}\sim U(\pi ,\pi )$;
(b) The angle satisfies ${\theta}_{m,i}\sim N({\theta}_{v,k1},{\sigma}_{{}_{mb}}^{2})$ and the distance satisfies ${d}_{m,i}\sim U(0,{d}_{m,max})$, where ${\sigma}_{{}_{ma}}^{2}$ and ${\sigma}_{{}_{mb}}^{2}$ are the variance of distance and angle, respectively, ${d}_{m,max}$ represents the upper bound of distance.
The point of maximum value solved in (24) is taken as the optimal estimation point.
5. Localization Based on Extended Kalman Filter Algorithm
The motion model is represented as a discretetime system and decomposed into state vectors in both directions x and y, which can be expressed as
where $x\left(k\right)$, ${v}_{x}\left(k\right)$ are the position and velocity of target in the xaxis and $y\left(k\right)$, ${v}_{y}\left(k\right)$ are the position and velocity of target in the yaxis of the system at time k.
$$\left[\begin{array}{c}x\left(k\right)\\ y\left(k\right)\\ {v}_{x}\left(k\right)\\ {v}_{y}\left(k\right)\end{array}\right]=\left[\begin{array}{cccc}1& 0& \Delta t& 0\\ 0& 1& 0& \Delta t\\ 0& 0& 1& 0\\ 0& 0& 0& 1\end{array}\right]\left[\begin{array}{c}x(k1)\\ y(k1)\\ {v}_{x}(k1)\\ {v}_{y}(k1)\end{array}\right],$$
Therefore, the prediction phase of the Kalman filter can be expressed as
where $A=\left[\begin{array}{cccc}1& 0& \Delta t& 0\\ 0& 1& 0& \Delta t\\ 0& 0& 1& 0\\ 0& 0& 0& 1\end{array}\right]$.
$$\begin{array}{cc}\hfill {X}_{kk1}& =A{X}_{k1k1},\hfill \end{array}$$
$$\begin{array}{cc}\hfill {P}_{kk1}& =A{P}_{k1k1}{A}^{T}+Q,\hfill \end{array}$$
${X}_{k1k1}={[x(k1),y(k1),{v}_{x}(k1),{v}_{y}(k1)]}^{T}$, ${X}_{k1k1}$ is optimal estimate of state vector X at time $k1$, ${P}_{k1k1}$ is the posteriori error covariance matrix at time $k1$. Q is the covariance matrix of the process noise which is set to a diagonal matrix.
The prediction distance vector between anchors and the target is derived as
where $({x}_{kk1},{y}_{kk1})$ is the position estimation of the target in the prediction phase. Moreover, the Jacobian matrix of (30) is obtained as
$$h\left({X}_{kk1}\right)=\left[\begin{array}{c}\sqrt{{({x}_{kk1}{x}_{1})}^{2}+{({y}_{kk1}{y}_{1})}^{2}}\\ \vdots \\ \sqrt{{({x}_{kk1}{x}_{i})}^{2}+{({y}_{kk1}{y}_{i})}^{2}}\\ \vdots \\ \sqrt{{({x}_{kk1}{x}_{n})}^{2}+{({y}_{kk1}{y}_{n})}^{2}}\end{array}\right],$$
$${H}_{k}=\left[\begin{array}{cccc}\frac{{x}_{kk1}{x}_{1}}{{h}_{1}\left(X\right)}& \frac{{y}_{kk1}{y}_{1}}{{h}_{1}\left(X\right)}& 0& 0\\ \vdots & \vdots & \vdots & \vdots \\ \frac{{x}_{kk1}{x}_{i}}{{h}_{i}\left(X\right)}& \frac{{y}_{kk1}{y}_{i}}{{h}_{i}\left(X\right)}& 0& 0\\ \vdots & \vdots & \vdots & \vdots \\ \frac{{x}_{kk1}{x}_{n}}{{h}_{n}\left(X\right)}& \frac{{x}_{kk1}{x}_{n}}{{h}_{n}\left(X\right)}& 0& 0\end{array}\right].$$
The filter gain matrix ${K}_{k}$ is determined by
where R represents the covariance matrix of the observation noise which is set to a diagonal matrix.
$${K}_{k}={P}_{kk1}{{H}_{k}}^{T}({H}_{k}{P}_{kk1}{{H}_{k}}^{T}+R),$$
The update phase of the Kalman filter is given as follows:
where ${P}_{kk}$ is the posteriori error covariance matrix at time k, ${X}_{kk}$ represents the posteriori state estimate at time k, and ${{d}_{k}}^{\prime}$ represents corrected measuring distance vector from the MLE method at time k with the following form:
$${X}_{kk}={X}_{kk1}+{K}_{k}({{d}_{k}}^{\prime}{h}_{k}),$$
$${P}_{kk}={P}_{kk1}{K}_{k}{H}_{k}{P}_{kk1},$$
$${{d}_{k}}^{\prime}=\left[\begin{array}{c}\sqrt{{({\widehat{x}}_{MLE}{x}_{1})}^{2}+{({\widehat{y}}_{MLE}{y}_{1})}^{2}}\\ \vdots \\ \sqrt{{({\widehat{x}}_{MLE}{x}_{i})}^{2}+{({\widehat{y}}_{MLE}{y}_{i})}^{2}}\\ \vdots \\ \sqrt{{({\widehat{x}}_{MLE}{x}_{n})}^{2}+{({\widehat{y}}_{MLE}{y}_{n})}^{2}}\end{array}\right].$$
6. Simulation and Experimental Results
6.1. Simulation Results
UWB technology is widely used in indoor localization because it is insensitive to channel fading and has high positioning accuracy. Therefore, we simulated UWB communication to verify the effectiveness of the algorithm. In this section, an indoor environment with obstacles is considered, where the test area was a rectangular space of 14 m × 5 m. There were eight anchors assigned around the space, whose locations were respectively known as [0 cm, 0 cm], [500 cm, $100$ cm], [1000 cm, 0 cm], [1100 cm, 150 cm], [1000 cm, 300 cm], [500 cm, 400 cm], [0 cm, 300 cm], [$100$ cm, 150 cm]. The obstacle was considered in the space and the location of the obstacle was unknown and fixed. It was assumed that NLOS error occurred when the connecting line of the target to the anchor traverses the obstacle, otherwise there was no NLOS error. The LOS error obeyed ${\epsilon}_{L}\sim N(0\phantom{\rule{0.166667em}{0ex}}\mathrm{cm},2.6\phantom{\rule{0.166667em}{0ex}}\mathrm{cm})$ and NLOS error obeyed ${\epsilon}_{NL}\sim N(22\phantom{\rule{0.166667em}{0ex}}\mathrm{cm},3.6\phantom{\rule{0.166667em}{0ex}}\mathrm{cm})$. In the simulation, the proposed algorithm was compared with the existing ones; see Table 1.
Figure 1 shows the simulation environment setting and real trajectory. The obstacle was placed in the middle of the environment and anchors were placed around. In the test, the target moved along a black dotted line, which was Sshaped. The velocity of the target was set to $0.3$ m/s ∼$0.5$ m/s. In order to test the performance of algorithms in Table 1, the root mean square error (RMSE) was used as the main performance metric. It was defined as $RMSE=\sqrt{({\sum}_{i=1}^{{T}_{n}}\left\right{\mathit{x}}_{r,i}{\widehat{\mathit{x}}}_{i}{\left\right}^{2})/{T}_{n}}$, where ${\mathit{x}}_{r,i}$ denotes the true position of the target at time i, ${\widehat{\mathit{x}}}_{i}$ indicates the estimated position.
Before using the proposed algorithm, it was necessary to estimate the probability of occurrence of the NLOS status at different distances and angles by sampling. Figure 2 and Figure 3 show the relationship between the probability of NLOS status and distance or angle in eight anchors. As can be seen from Figure 2, in general, the larger the distance, the higher the probability of NLOS status. From Figure 3, the relationship between the angle and the probability of NLOS status could be obtained. It was obviously different in different environments. According to Figure 2 and Figure 3, polynomial fitting could be used to obtain the relationship between NLOS status occurrence probability and distance or angle. Alternatively, the relationship could be obtained by constructing a piecewise function.
In order to reduce the operation time, 500 points were randomly selected according to the introduced Monte Carlo method and one point was selected which could maximize Formula (24). Figure 4 illustrates the RMSE of different algorithms with different numbers of anchors. The distribution of noise was the same in each algorithm experiment. As can be seen from Figure 4, as the number of anchors increased, the RMSE of algorithms gradually decreased, except for the LS algorithm. When the number of anchors was 6 or 8, the RMSE of the LS algorithm was increased. The reason may be that NLOS measurement error of the added anchor was large, which led to a large error. Since the weights of LS algorithm were equal, the algorithm could not allocate less weight to the measurement with larger NLOS error. On the contrary, the RWLS algorithm compensated for this deficiency. The algorithm assigned weights to the measurements of each anchor by analyzing the positioning residuals of each anchor. However, the algorithm could not exert its advantages when the number of anchors was small. Therefore, when the number of anchors was four or five, the RMSE was higher than that of the LS method. The RMSE of the EKF algorithm was the highest when the number of anchors was four. As this number increased, the RMSE gradually stabilized, but the value was always higher than some other methods, because it does not suppress NLOS error very well. The SDP method worked well when the number of NLOS status was large or small in all measurements. From the figure, it worked better than the EKF method. The DPMLE method uses statistical methods to estimate the relationship between the probability of NLOS propagation and the measured distance. However, the proposed method not only considers the relationship between its probability of occurrence and the measured distance, but also considers the relationship with measurement angle. Therefore, the RMSE of the proposed algorithm was smaller than that of the DPMLE method.
Figure 5 shows the RMSEs of different algorithms using different standard deviations of measurement noise. It can be seen from the figure that the RMSE of the proposed method was the lowest and that of the LS method was the highest in different standard deviations. Since the RWLS algorithm assigns less weight to anchors with large residuals, the RMSE of the method was lower than that of the LS method. The advantage of the EKF method is mainly its ability to suppress the measurement noise; consequently, the RMSE of the method was lower than that of RWLS. The SDP algorithm estimates the average value of NLOS error and constructs the model based on statistical features. As a result, the method was superior to the EKF method. The RMSE of the proposed method and DPMLE method both increased with increasing standard deviation. This is why the constructed models are probability models based on NLOS status. When the standard deviation of measurement noise increased, the accuracy of NLOS status judgment will be reduced. For example, when the measurement noise is larger than NLOS error, it may be considered as NLOS noise. However, the RMSE of the proposed algorithm was still lower than those of DPMLE and SDP methods, based on Figure 5.
Figure 6 shows the RMSEs of different algorithms using different means of NLOS error. With the increase of the mean of NLOS error, the RMSEs of LS, EKF, and RWLS algorithms increased obviously and gradually. The main reason is that these methods could not effectively suppress the NLOS error. The SDP method can suppress the NLOS error without identifying NLOS status. Both DPMLE and the proposed method could estimate the probability of NLOS status. However, the accuracy of the proposed method was higher than that of DPMLE method. Therefore, the RMSE of this method was lower than that of DPMLE method.
6.2. Experimental Results
In order to better verify the effectiveness of the algorithm, we used the measurement database in [31]. The experimental equipment consisted of 20 anchor nodes and one mobile node, which were UWB devices. Some anchor nodes were placed in the corridor and the other parts were placed in the room. The twoway arrival time estimation method was used in ranging. The mobile node was placed on the mobile robot, which was placed on the orbit. Due to the influence of energy attenuation in propagation, the mobile node could not accept all signals of anchor nodes. Therefore, we selected nine anchor nodes that could successfully communicate with the mobile node for the experiment; see Table 2.
In the experiment, the height of the target was fixed and known, and the height of the mobile node was set to 0.162 m. Since the algorithm was calculated in a twodimensional environment, the measured data needed to be converted. According to (36), the measured distance was converted into the horizontal distance between the target and the anchor.
where ${d}_{m}$ is the measured distance and $\Delta h$ is the height difference between the mobile node and the anchor node.
$$d=\sqrt{{d}_{m}^{2}\Delta {h}^{2}},$$
The parameters of NLOS propagation occurrence probability model need to be obtained by sampling before testing; that is, ${p}_{los}\left({z}_{i}\right)$ and ${p}_{nlos}\left({z}_{i}\right)$. In the data set, about 90% of the data was used for training and about 10% for testing. The distances between each anchor and the remaining 19 anchors were measured. However, the communication between some anchors could not be established. Therefore, the measurements of two anchors that could not establish communication were set as NLOS propagation. Since the positions of all anchors were known, the distance between any two anchors could be calculated. In order to reduce the measurement errors caused by faults or other factors, multiple measurements were used and the average value was calculated as the final measurement value. If the difference between the measured value and the true distance exceeded the threshold, the measurement was considered as the NLOS propagation. The relationship between distance, the angle of each sampling point, and the NLOS status probability is given in Figure 7 and Figure 8.
In the test, we used the data of 20 s of target movement to complete the experiment. The robot trajectory and the position of anchors is given in Figure 9. The mobile robot moved at a constant speed and turned left at about time 8 s. The RMSEs of different numbers of anchors are given in Figure 10.
As can be seen from Figure 10, the RWLS method had the worst effect when the number of anchors was five. Because the RWLS method could not accurately identify NLOS error when the number of anchors was small, it led to the wrong weight. The performance of the proposed method and the EKF method did not change much as the number of anchors increased, but the performance of the proposed method was better than that of other methods. The reason is that the proposed method could effectively suppress the NLOS errors when the number of anchors was small. When the number of anchors was 6 or 7, the weight of the RWLS method was accurate. Therefore, its effect was better than that of the LS method. However, the performance of these two methods was inferior to the EKF method and the proposed method because the two methods do not consider suppressing measurement errors. When the number of anchors was nine, the DPMLE, SDP, and proposed method could effectively suppress NLOS error, but the DPMLE and SDP methods found it difficult to identify NLOS errors when the number of anchors was small. In addition, the SDP algorithm is solved by interior point method, and its operation time was much longer than that of the proposed algorithm. As a result, the realtime performance of the SDP algorithm Was far inferior to that of the proposed algorithm.
7. Conclusions
In the paper, an optimization algorithm is presented based on a distance and angle probability model for indoor nonlineofsight (NLOS) environments. According to the relationship between distance, angle, and the occurrence probability of NLOS propagation, the joint likelihood function was established. The simulation and experimental results showed that the NLOS error was compensated effectively in NLOS propagation, and the proposed algorithm was superior to other algorithms when the number of anchors was small. Furthermore, the realtime performance of the proposed algorithm was much higher than that of SDP algorithm and the accuracy of the algorithm was ensured.
Author Contributions
X.T. finished writing the original draft and conducted the simulation and experiment. G.W. and J.W. supervised the work and revised the paper. D.Z. wrote the software program for the experiment.
Funding
This work was supported in part by the National Natural Science Foundation of China under Grant 61873169, the Program for Capability Construction of Shanghai Provincial Universities under Grant 15550502500, the Program for Professor of Special Appointment (Eastern Scholar) at Shanghai Institutions of Higher Learning.
Conflicts of Interest
The authors declare no conflicts of interest.
References
 Zhang, H.; Cheng, P.; Shi, L.; Chen, J. Optimal DoS Attack Scheduling in Wireless Networked Control System. IEEE Trans. Control. Syst. Technol. 2016, 24, 843–852. [Google Scholar] [CrossRef]
 Wang, Y.; Li, X. The IMU/UWB Fusion Positioning Algorithm Based on a Particle Filter. ISPRS Int. J. GeoInf. 2017, 6, 235. [Google Scholar] [CrossRef]
 Yu, C.; Lan, H.; Gu, F.; Fei, Y.; Naser, E. A Map/INS/WiFi Integrated System for Indoor LocationBased Service Applications. Sensors 2017, 17, 1272. [Google Scholar] [CrossRef] [PubMed]
 Tseng, H.P.; Chan, C.Y.; Lin, J.Y.; Lin, B.D.; Wu, N.; Wang, M.T. RayTracingAssisted Fingerprinting Based on Channel Impulse Response Measurement for Indoor Positioning. IEEE Trans. Instrum. Meas. 2017, 66, 1032–1045. [Google Scholar] [CrossRef]
 Cheng, L.; Li, Y.; Wang, Y.; Bi, Y.; Feng, L.; Xue, M. A TripleFilter NLOS Localization Algorithm Based on Fuzzy Cmeans for Wireless Sensor Networks. Sensors 2019, 19, 1215. [Google Scholar] [CrossRef] [PubMed]
 Saska, M.; Baca, T.; Thomas, J.; Chudoba, J.; Preucil, L.; Krajnik, T.; Faigl, J.; Loianno, G.; Kumar, V. System for deployment of groups of unmanned micro aerial vehicles in GPSdenied environments using onboard visual relative localization. Auton. Robot. 2017, 41, 919–944. [Google Scholar] [CrossRef]
 Qiu, J.; Wang, X.; Dai, G. Improving the indoor localization accuracy for CPS by reorganizing the fingerprint signatures. Int. J. Distrib. Sens. Netw. 2014, 10, 415710. [Google Scholar] [CrossRef]
 Pirzada, N.; Nayan, Y.M.; Subhan, F.; Abro, A.; Hassan, F.M.; Sakidin, H. Location Fingerprinting Technique for WLAN DeviceFree Indoor Localization System. Wirel. Pers. Commun. 2017, 95, 445–455. [Google Scholar] [CrossRef]
 Li, J.; He, X.; Cai, Z.Y.; Xu, Q. Method of WiFi indoor location based on Kmeans and Random Forest. Control. Eng. China 2017, 24, 787–792. [Google Scholar]
 Lee, H.S.; Lim, K.I.; Lee, K.J. Method for improving indoor positioning accuracy using extended Kalman filter. Mob. Inf. Syst. 2016, 2016, 2369103. [Google Scholar] [CrossRef]
 Cai, S.; Liao, W.; Luo, C.; Li, M.; Huang, X.; Li, P. CRIL: An efficient online adaptive indoor localization system. IEEE Trans. Veh. Technol. 2017, 66, 4148–4160. [Google Scholar] [CrossRef]
 Liu, C.; Tian, Z.; Zhou, M.; Yang, X. GeneSequencingBased Indoor Localization in Distributed Antenna System. IEEE Sens. J. 2017, 17, 6019–6028. [Google Scholar] [CrossRef]
 Jiang, W.; Yin, Z. Indoor localization with a signal tree. Multimed. Tools Appl. 2017, 76, 20317–20339. [Google Scholar] [CrossRef]
 Shi, X.; Mao, G.; Yang, Z.; Chen, J. MLEbased localization and performance analysis in probabilistic LOS/NLOS environment. Neurocomputing 2017, 270, 101–109. [Google Scholar] [CrossRef]
 Tomic, S.; Beko, M.; Dinis, R.; Montezuma, P. A Robust Bisectionbased Estimator for TOAbased Target Localization in NLOS Environments. IEEE Commun. Lett. 2017, 21, 2488–2491. [Google Scholar] [CrossRef]
 Wang, G.; Chen, H.; Li, Y.; Ansari, N. NLOS error mitigation for TOAbased localization via convex relaxation. IEEE Trans. Wirel. Commun. 2014, 13, 4119–4131. [Google Scholar] [CrossRef]
 Shi, X.; Yang, Z.; Chen, J. Localization accuracy of rangeonly sensors with additive and multiplicative noise. In Proceedings of the 2013 IEEE Global Communications Conference (GLOBECOM), Atlanta, GA, USA, 9–13 December 2013; pp. 195–200. [Google Scholar]
 Yang, Z.; Shi, X.; Chen, J. Optimal Coordination of Mobile Sensors for Target Tracking Under Additive and Multiplicative Noises. IEEE Trans. Ind. Electron. 2014, 61, 3459–3468. [Google Scholar] [CrossRef]
 Li, C.; Qiu, Z.; Liu, C. An Improved Weighted KNearest Neighbor Algorithm for Indoor Positioning. Wirel. Pers. Commun. 2017, 96, 2239–2251. [Google Scholar] [CrossRef]
 Oussalah, M.; Alakhras, M.; Hussein, I.M. Multivariable fuzzy inference system for fingerprinting indoor localization. Fuzzy Sets Syst. 2015, 269, 65–89. [Google Scholar] [CrossRef]
 Li, J.; Wu, S. Nonparametric nonlineofsight identification and estimation for wireless location. In Proceedings of the Computer Science and Service System (CSSS), Nanjing, China, 11–13 August 2012; pp. 81–84. [Google Scholar]
 Schroeder, J.; Galler, S.; Kyamakya, K.; Jobmann, K. NLOS detection algorithms for UltraWideband localization. In Proceedings of the 4th Workshop on Positioning, Navigation and Communication, Hannover, Germany, 22 March 2007; pp. 159–166. [Google Scholar]
 Borras, J.; Hatrack, P.; Mandayam, B.N. Decision theoretic framework for NLOS identification. In Proceedings of the 48th IEEE Vehicular Technology Conference, Ottawa, ON, Canada, 21 May 1998; pp. 1583–1587. [Google Scholar]
 Casas, R.; Marco, A.; Guerrero, J.J.; Falco, J. Robust estimator for nonlineofsight error mitigation in indoor localization. EURASIP J. Appl. Signal Process. 2006, 2006, 156. [Google Scholar] [CrossRef]
 Venkatesh, S.; Buehrer, M.R. NLOS mitigation using linear programming in ultrawideband locationaware networks. IEEE Trans. Veh. Technol. 2007, 56, 3182–3198. [Google Scholar] [CrossRef]
 Marano, S.; Gifford, M.W.; Wymeersch, H.; Win, Z.M. NLOS identification and mitigation for localization based on UWB experimental data. IEEE J. Sel. Areas Commun. 2010, 28, 1026–1035. [Google Scholar] [CrossRef]
 Morelli, C.; Nicoli, M.; Rampa, V.; Spagnolini, U. Hidden Markov Models for Radio Localization in Mixed LOS/NLOS Conditions. IEEE Trans. Signal Process. 2007, 55, 1525–1542. [Google Scholar] [CrossRef]
 Lui, K.W.K.; So, C.H.; Ma, K.W. Maximum a posteriori approach to timeofarrivalbased localization in nonlineofsight environment. IEEE Trans. Veh. Technol. 2009, 59, 1517–1523. [Google Scholar] [CrossRef]
 Gu, H.; Shi, Y.; Chen, Y. Cicada: A HighlyPrecise EasyEmbedded and OmniDirectional Indoor Location Sensing System. In Proceedings of the International Conference on Advances in Grid and Pervasive Computing, Taichung, Taiwan, 3 May 2006; pp. 385–394. [Google Scholar]
 Yang, S.; Wang, B. Residual based weighted least square algorithm for Bluetooth/UWB indoor localization system. In Proceedings of the 36th Chinese Control Conference (CCC), Dalian, China, 26–28 July 2017; pp. 5959–5963. [Google Scholar]
 Dardari, D.; Sottile, F. WPR. B Database: Annex of N++ Deliverable WPR. B DB. 3. Progress Report II on Advanced Localization and Positioning Techniques: Data Fusion and Applications, Deliverable Number: DB, 3. 2010. Available online: https://www.academia.edu/2830567/216715_NEWCOM_Deliverable_Number_DB._3_Progress_Report_II_on_Advanced_Localization_and_Positioning_Techniques_Data_Fusion_and_Applications (accessed on 14 October 2019).
Figure 2.
The relationship between the probability of nonlineofsight (NLOS) status and distance in eight anchors.
Figure 7.
The relationship between distance and NLOS status probability. The horizontal axis of each graph represents distance (m) and the vertical axes represent NLOS status probability.
Figure 8.
The relationship between angle and NLOS status probability. The horizontal axis of each graph represents angle (degree) and the vertical axes represent NLOS status probability.
Algorithm  Description 

LS  Least square method 
EKF  Extended kalman filtering algorithm [29] 
RWLS  Residual based weighted least square algorithm [30] 
SDP  Semidefinite programming method [16] 
DPMLE  Distancerelated LOS/NLOS probabilities maximum likelihood estimation [14] 
DAPMLE  The proposed method 
Anchor ID  Coordinate X (m)  Coordinate Y (m)  Coordinate Z (m) 

8  13.80  7.20  1.13 
9  15.00  9.91  1.13 
11  17.40  18.31  1.13 
12  19.21  23.11  1.13 
13  15.00  20.56  1.13 
14  12.60  18.31  1.13 
15  10.80  16.65  1.13 
16  8.61  20.08  1.13 
17  3.24  19.78  1.13 
© 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/).