Performance Analysis of Parameter Estimator Based on Closed-Form Newton Method for Ultrawideband Positioning

NASG Key Laboratory for Land Environment and Disaster Monitoring, China University of Mining and Technology (CUMT), Xuzhou 221116, China School of Environment Science and Spatial Informatics, China University of Mining and Technology (CUMT), Xuzhou 221116, China School of Surveying and Geo-Informatics, Shandong Jianzhu University, Jinan 250101, China School of Geomatics and Urban Information, Beijing University of Civil Engineering and Architecture (BUCEA), Beijing 100044, China Piesat Information Technology Co., Ltd., Beijing 100195, China CUMT Geotechnical Engineering & New Technology Development Co., Ltd., Xuzhou 221116, China


Introduction
During recent decades, with the development of global navigation satellite system (GNSS), people pay more and more attention to the location based on service [1]. Urban dwellers spend more than 80% of their time indoors; however, the GNSS signal is not sufficiently strong to penetrate through different materials used in construction, and the phenomena of reflection and multipath fading limit the utility of GNSS in dense urban or in the indoor environments, which makes the indoor positioning demand growing [2]. In general, indoor localization technologies include Bluetooth, Wi-Fi, radio-frequency identification (RFID), and ultrawideband (UWB). When compared with other localization technologies, the UWB is capable of providing robust signaling, through-wall propagation and provides a large bandwidth that allows high-resolution ranging even in harsh environments [3]. erefore, UWB technology is well suited for indoor positioning applications. In order to employ this technology, different positioning methods have been developed, such as the time-of-arrival (TOA), time difference of arrival (TDOA), angle of arrival (AOA), and received signal strength (RSS) [4]. e positioning model based on UWB observations is nonlinear. e nonlinearity in the nonlinear inversion of geodetic and geophysical data is diagnosed, the amount of nonlinearity in nonlinear models is assessed to prove whether a linearized model is a sufficient approximation, and the significance of nonlinearity is tested in the problem of nonlinear least-squares inversion [5]. e estimator is not optimum with solving the linear equations directly via least squares [6]. e polynomial approaches solve directly the nonlinear distance equations for the coordinates of the unknown station and eliminates variables appearing in the nonlinear distance equations leaving univariate polynomials [7].
e Gauss-Jacobi combinatorial procedure uses the algebraic procedures of multipolynomial resultant or Groebner basis to solve the equations contained in the minimum combinatorial sets to give closed-form solutions [8]. Although the algebraic techniques solve distance nonlinear system of equations without linearization, iteration, and forward and backward substitution, they do not solve all general types of nonlinear equations, but those nonlinear systems of equations can be converted into algebraic form because most nonlinear least-squares problem cannot be solved by algebraic methods [9,10].
In general, the nonlinear algorithms can be divided into two families, noniterative and iterative. e noniterative algorithm often employs clever algebra method in order to produce a simple direct solution [11,12]. e most straightforward way to estimate the position may be directly solving a set of simultaneous equations [13]. However, it cannot make full use of extra measurements available to improve the accuracy. e closed-form solutions for localization using ranging difference measurements, including the spherical interpolation method, the spherical intersection method, and the plane intersection method, have been developed. To give an improved position estimate, the quadratic-correction leastsquares approach has been proposed using a two-stage weighted least-squares to solve for the source position, and the linear-correction least-squares approach has been devised with incorporating the relation explicitly by minimizing a constrained LS function [14,15]. e traditional positioning algorithms solve the nonlinear distance equations by linearizing them, and then, the solution can be found iteratively [16]. Iterative algorithms are the procedures that are from a rough initial guess to generate a sequence of improving approximate solutions for nonlinear equations [15]. e iterative approaches require and rely heavily on the initial starting values to ensure global minimum and faster convergence to the correct solution [17]. e numerical characteristics of a number of iterative descent algorithms for solving nonlinear least-squares problem have been discussed, particularly in the Gauss-Newton method [18]. e estimators are usually inherently biased by linearizing the nonlinear expression, and the bias comes from nonzero higher order terms [19].
A standard method for solving the nonlinear equations is Gauss-Newton iteration which is efficient and has a linear rate of convergence for points close to the solution [18]. However, the Gauss-Newton method is based on linearization and may thus perform poorly when the base stations are ill conditioned and the measurement equations are strongly nonlinear. Tikhonov regularization is the most commonly used method for nonlinear ill-posed problems; the chosen Tikhonov matrix gives preference to solutions with smaller norms which is known as L2 regularization [20]. e regularization and Gauss-Newton method are combined into the iteratively regularized Gauss-Newton method to deal with the matrix rank deficient problems [21].
e Gauss-Newton method strengthened with a regularization term is found to be as accurate as any of the closedform methods through simulation comparison, while being simpler to implement and avoiding most of the pitfalls [22]. As one kind of the steepest decent method, the barycenter method is discussed. It can stabilize the iteration without the matrix inversion and simplify the procedure without calculating the Hessian matrix [23]. e trust region and damped methods are introduced and modified for nonlinear least squares [24,25]. e closed-form of the Newton method by which the Newton method and Gauss-Newton method are connected has been obtained for solving the distance equations [26,27]. To minimize the objective function for the optimal position estimation, the performance of Gauss-Newton type and the quasi-Newton methods is analyzed and discussed [28]. To get a better approximation of the Hessian matrix of the objective function, the Broyden-Fletcher-Goldfarb-Shanno (BFGS) algorithm and Davidon-Fletcher-Powell (DFP) algorithm in the quasi-Newton methods have been compared [29]. e remainder of this paper is organized as follows. In Section 2, the nonlinear distance equations for UWB positioning are introduced. In Section 3, the closed-form Newton iterative method is presented. In Section 4, the performance of the closed-form Newton method in UWB positioning is analyzed and illustrated by the numerical examples. In Section 5, the conclusions are summarized.

The Nonlinear Distance Equations for UWB Positioning
As shown in Figure 1, we evaluate the UWB sensor network positioning system based on the DW1000 module. It allows high data rate communications, up to 6.8 Mb/s, and it is a perfect fit in wireless sensor network applications [30]. By determining the time of flight (TOF) of signals travelling between the anchor and tag, the ranging measurements in these transceivers is performed based on the two way ranging (TWR). After collecting ranging data by the positioning system, we use the TOA method to process the data for positioning calculation. e three-dimensional (3D) position of the tag is determined as the intersection of all the spheres, whose centers are the coordinates of the anchors and radius is the range between the anchors and the tag. However, the accuracy of ranging distance is affected by noise and the multipath components; thus, the spheres do not always intersect at one single point. e goal of the positioning estimation is to find out coordinates closest to the actual position [31]. e nonlinear observation model of distance equation is given as [32] where L i denotes the observation distance between the tag and ith anchor; L � L 1 L 2 . . . L n T denotes the obser- 2 is the Euclidean distance; ε i represents the corresponding random error; (x i , y i , z i ) is the known coordinate of ith anchor; and (x, y, z) is the coordinate of tag. e tag coordinates can be estimated by the nonlinear equations. If the nonlinear equations are overdetermined, then the nonlinear least-squares solution is to find X � argmin X g(X), where g(X) � V T (X)V(X)/2, in which V(X) � d(X) − L represents the residual vector and P(X) � diag(p 1 , p 2 , . . . , p n ) is the weight matrix. We denote g(X) as the least-squares objective function, since the function is twice continuously differentiable; then, its first-order partial derivatives are obtained: where J(X) represents the Jacobian matrix: is the ith direction cosine vector from the unknown point to the ith known point. e solution of the objective function can be then obtained by solving the orthogonal condition as [8] e nonlinear equation (4) is a base to discuss the properties of the nonlinear least-squares solution and develop iterative methods and even algebraic approaches for solving the overdetermined distance equations [26]. e nonlinearity measures may be obtained by the Hessian matrix of the form where V i ″ (X) contains the second derivatives of the distance equation [18].

The Closed-Form Newton Method
For small residual and low nonlinearity problems in nonlinear adjustment models, a linearized model is a sufficient approximation, n i�1 V i (X)p i V i ″ (X) ⟶ 0, the Hessian matrix H(X) can be approximated to its linear term N(X), we have the Gauss-Newton method as However, the issues come in when the approximation is not adequate; if H(X) is ill conditioned, N(X) will not be a sufficient approximation to the Hessian matrix, and the least-squares solution will be unstable. Moreover, the linearization of the positioning functional model results in biased least-squares estimators. e Gauss-Newton method only includes the first-order Taylor expansion of distance equations. e bias comes from neglected higher order terms, which can be regarded as a systematic error.
To stabilize the ill-conditioned least-squares solution, the Gauss-Newton method can be corrected by using prior information; this kind of prior assumption can easily be incorporated in the Gauss-Newton method as a regularization term. For the indoor applications, the preliminary information about the user position is limited, the ill-posed problems will occur when the anchors are configured close to coplanar and the measurement errors are large.
To solve the ill-conditioned configurations problems, a new iterative descent method called the closed-form Newton method is introduced [27]. e Hessian matrix can be de- Figure 1: e anchor (a) and tag (b) hardware devices.
Similarly, we can acquire other entries, and all entries of the Hessian matrix can be presented as Equation (8) is expressed as the matrix form where tr(·) is the trace of matrix, α � tr(P) − tr(PR) is the trace of matrix, and R � diag( Closed-form Newton iterative formula can be given as If the residual is small enough, R ⟶ I, closed-form Newton will be reduced to the Gauss-Newton method.

Numerical Examples
In this section, the simulation and measurement experiments in different situations are implemented. e iterative convergence and position estimation based on the closedform Newton method are analyzed and compared.

Simulation Verification.
e positioning configurations and coordinates of the anchor and tag are shown in Figure 2. As shown in Table 1, four sets of tests are conducted in the simulation experiment. e simulated measurement errors are expressed by the standard deviation (STD). ey obey the normal distribution which is an independent Gaussian variable with zero mean and equal variance. e statistical results of iterations and convergence property are shown in Figure 4 and Table 2, respectively. In Test 1, we can see that both the Gauss-Newton method and closed-form Newton method can converge to the optimal solutions with very few iterations. It indicates that these two iterative methods can converge to the global optimal solution with better convergence and higher efficiency under well-conditioned positioning configuration. Compared with Test 1, Test 2 is based on ill-conditioned positioning configuration. Test 1 and Test 2 have the same measurement error, and meanwhile, the initial iteration values for Test 1 and Test 2 are true positions. In Test 2, Gauss Newton method diverges in some epochs. However, closed-form Newton method guarantees the convergence in all epochs although there are more iterations in some epochs. Compared with Test 2, the observation in Test 3 is more accurate, and the error is smaller. It makes known that both the both Gauss-Newton method and closed-form Newton method can achieve correct convergence if the observation accuracy is high enough despite the positioning configuration is ill conditioned. e initial iteration value for Test 4 is different from Test 2. It can be known that the initial value affects the iterations, but does not affect the convergence success rate. e frequency histograms of positioning error based on the Gauss-Newton method closed-form Newton method are represented in Figures 5 and 6, respectively. e average positioning error under convergence is given in Table 3. As we can see, the positioning error distribution of the Gauss-Newton 4 Mathematical Problems in Engineering    Gauss-Newton Closed-form Newton   method closed-form Newton method is basically the same in Test 1 and Test 3. It can be known that the performance of closed-form Newton method and Gauss-Newton method is consistent if the system geometry is well conditioned or the observation accuracy is high enough. In Test 2, the closed-form Newton method has smaller average positioning error than the Gauss-Newton method, especially in the coordinate component Z. It indicates that the closed-form Newton method has higher positioning accuracy. In Test 4, the closed-form Newton method achieves effective convergence and converge to optimal solution in the coordinate component X and Y, but does not converge to optimal solution in the coordinate component Z which is ill-conditioned direction. In practical applications, since the location information of the user is rather limited, it is not easy to get a good initial value. It can be known that the closed-form Newton method can guarantee the complete convergence by sacrificing the positioning accuracy in the illconditioned direction.

Measurement Verification.
In the measurement experiment, the hardware devices used are the DecaWave Mini2016 suite, including the anchor and tag nodes, already described in detail in Section 2. e experimental scene is an empty hall. During the testing process, no relevant personnel entered. e tag node is mounted on the top of the helmet, which is placed at test point at the height of 30 cm. e anchor nodes are placed on a tripod of the same antenna height. e main goal is to evaluate the performance of the closed-form Newton method in a static situation. e locations of test points and anchors and the experimental scene are shown in Figure 7.
e experimental setup is shown in Table 4. e positions of test points were calibrated ahead of time. In the test point, 280 epochs of data were sampled. In the following four sets of tests, there is only one redundant observation. is makes the number of parameters to be estimated relatively more for the particular observation model, and the nonlinear strength increases with the decreases of DOF.  Mathematical Problems in Engineering Figure 8 represents the cumulative distribution function (CDF) of the ranging error of all the measurements collected. It can be observed that the random error of these observations are small and differ slightly. However, all of their systematic errors are very large. e distance between T1 and A1 perfectly matches the distance between T1 and A3, but their range estimation accuracy is different due to the hardware. Although the hardware devices adopt the principle of TWR without a common time reference, the clock drift and offset still affect the ranging error. We can also see that the systematic error based on anchors A1 and A3 becomes larger than that based on anchors A0 and A2. e statistical results of iterations and convergence property are shown in Figure 9 and Table 5, respectively. In Test 1, the initial value for iteration is close to coplanar with the anchors. It can be observed that the convergence rate of the Gauss-Newton method is lowest. Meanwhile, all of the successful iterations are false convergence with the local optimal solution. Compared with Test 1, Test 2 is based on a relatively reasonable initial value.
e Gauss-Newton method converges correctly, and its convergence rate is improved obviously. Comparatively speaking, the closedform Newton method can converge quickly in all epochs. It can be known that the initial value has a great influence on the iteration of the Gauss-Newton method under the illconditioned positioning configuration. Moreover, the closed-form Newton method can converge to the global optimal solution with better convergence and higher efficiency regardless of whether the initial iteration value is reasonable or not.
In addition, the location estimation results based on Test 3 and Test 4 are expressed in Figures 10 and 11. e initial values for iteration for Test 3 and Test 4 are true positions. In Test 3, although the Gauss-Newton method converges to the global optimal solution, the positioning error in the coordinate component Z is very large. e closed-form Newton method imposes constraints on the positioning in the coordinate component Z, and uses the Z-axis coordinates of the base station plane as its positioning result, which limits the Z-axis positioning error under the ill-conditioned configuration.
is also results in more iterations of the closed-form Newton method in Test 3 than Tests 1 and 2. Furthermore, the accuracy of horizontal location estimation results of the closed-form Newton method is effectively improved compared to the Gauss-Newton method. e reason is that the Gauss-Newton method only includes the first-order Taylor expansion of distance equations due to the linearization of the positioning functional model. e bias comes from neglected higher order terms, which can be regarded as a systematic error. e closed-form Newton method which considers the high order partial derivatives is more stable and effective. It can converge to the global optimal solution with increasing the computational cost a little. In Test 4, the horizontal location estimation results of the closed-form Newton method and Gauss-Newton method are similar. e main cause for this case is that the positioning configuration of Test 4 is more symmetrical than that of Test 3 in the coordinate components X and Y. e better the system geometry is, the smaller the bias in the parameter estimator will be. For a positioning configuration, when the anchors are evenly distributed, the amount of nonlinearity is orthogonal to the ranging space of the design matrix, the linearization is valid, and the parameter estimator tends to be unbiased.        According to the above analysis and research, we can believe that the closed-form Newton method has better convergence and higher efficiency. It confirms that the closed-form Newton method performs better than the Gauss-Newton method in ultrawideband positioning, especially under ill-conditioned configuration.

Conclusions
In this paper, we introduce the closed-form Newton method for UWB positioning. It provides an overview of the reliability of the closed-form Newton method applied to UWB positioning. e linearization of the positioning functional model results in biased least-squares estimators. e Gauss-Newton method only includes the firstorder Taylor expansion of distance equations so that it has higher computational efficiency. e bias comes from neglected higher order terms, which can be regarded as a systematic error. Besides, in outdoor satellite positioning, a good initial value can be obtained and a good positioning geometry configuration can be chosen due to many dynamic available satellites. en, the convergence property is efficient. However, in the UWB indoor positioning, since the prior information of the user position is rather limited, it is not easy to get a good initial value. Moreover, the nonline-of-sight (NLOS) environment makes the error of measurements increased and biased. In addition, in view of the complexity and cost of the positioning system, the geometry configuration of anchor nodes is prone to be ill conditioned. When selecting an unreasonable initial value, the Gauss-Newton method converges with many iterations or diverges sometimes or converges to a false local optimal solution. e effect of nonlinearity on the positioning system can become rather straightforward. us, the performance and the reliability of the positioning functional model are inevitably influenced. In comparison, the closed-form Newton method can converge to the global optimal solution with better convergence and higher efficiency regardless of whether the initial iteration value is reasonable or not, especially with ill-conditioned positioning configuration. Furthermore, considering the high order partial derivatives, the closed-form Newton method can improve the accuracy of location estimation results compared to the Gauss-Newton method with increasing the computational cost a little. erefore, in the application of indoor positioning, when the positioning configuration is ill conditioned and a good initial value cannot be obtained, we can choose to use the closed-form Newton method. Meanwhile, we generally try to avoid the ill-posed problems on the deployment of positioning system.

Data Availability
e data used to support the findings of this study are available from the corresponding author upon request.

Conflicts of Interest
e authors declare no conflicts of interest.