Position Estimation Algorithms
From Measurements to Position Estimates
Section 30.1 established that each measurement type --- TOA, TDOA, AOA, RSSI --- defines a geometric locus (circle, hyperbola, bearing line) in the plane. In the absence of noise, the UE position is simply the intersection of these loci. In practice, noise corrupts every measurement, the loci do not intersect at a single point, and we must formulate and solve an estimation problem.
This section develops the complete estimation pipeline: (1) linearised least-squares for a fast closed-form initialisation; (2) Gauss-Newton iteration for refined nonlinear least-squares; (3) maximum likelihood for statistically optimal estimation; (4) the Cramer-Rao bound and position error bound (PEB) to quantify the fundamental accuracy limits. The section concludes with NLOS detection and mitigation, which is the dominant practical challenge in real-world positioning.
Definition: Linearised Least-Squares Positioning (TOA)
Linearised Least-Squares Positioning (TOA)
Given TOA range measurements from BSs at known positions , the range equations are:
Expanding and subtracting the equation for a reference BS (say BS 1) eliminates the quadratic terms :
This yields the linear system :
The ordinary least-squares estimate is:
For TDOA, a similar linearisation applies with replacing directly.
The linearised LS solution is not statistically efficient (it does not achieve the CRB) because squaring the range measurements distorts the noise distribution and the reference-BS subtraction introduces correlated errors. However, it is an excellent initialiser for iterative methods.
Gauss-Newton Algorithm for Position Estimation
Maximum Likelihood Position Estimation
Under the assumption of independent Gaussian measurement errors, the ML estimator for the UE position minimises the negative log-likelihood:
This is precisely the weighted nonlinear least-squares (WNLS) problem solved by the Gauss-Newton algorithm above with .
For TDOA, the ML problem becomes:
For hybrid measurements (e.g., TOA from some BSs, AOA from others), the log-likelihood simply sums the individual terms, leading to a data fusion framework.
Under the Gaussian noise model, the ML estimator is asymptotically efficient: it achieves the Cramer-Rao bound as the number of measurements or the SNR grows.
Definition: Fisher Information Matrix for Position Estimation
Fisher Information Matrix for Position Estimation
The Fisher information matrix (FIM) for estimating the 2D position from independent range measurements with Gaussian errors is:
where is the unit direction vector from BS to the UE.
Each term is a rank-1 matrix that contributes information only along the radial direction from BS . The FIM is the weighted sum of these directional contributions: it encodes how the geometric arrangement of base stations and their individual measurement accuracies combine to determine the overall positioning precision.
For AOA measurements with errors , the FIM contribution from BS is:
where is the unit vector perpendicular to the radial direction. Notably, AOA information is orthogonal to TOA information from the same BS, and scales inversely with the square of the distance.
The FIM has a beautiful geometric interpretation. Defining the information ellipse as , its shape reveals the directional distribution of positioning information. A circular information ellipse indicates uniform accuracy in all directions; an elongated ellipse indicates good accuracy along the major axis but poor accuracy along the minor axis --- which occurs when all BSs are clustered in one direction.
Theorem: Position Error Bound (PEB)
For any unbiased estimator of the 2D position , the mean squared position error is lower-bounded by:
The position error bound is defined as:
where are the eigenvalues of . The PEB represents the minimum achievable root-mean-square (RMS) position error, analogous to the GDOP (geometric dilution of precision) in GNSS.
For the special case of BSs with equal ranging accuracy , the PEB simplifies to:
where the ratio captures the geometry: equal eigenvalues (isotropic geometry) give the smallest PEB for a given total information.
The PEB is the positioning analogue of the standard error in 1D estimation. It tells you: "given these BSs at these locations with these measurement accuracies, the best possible RMS position error is PEB metres." Poor geometry (e.g., all BSs in a line) makes one eigenvalue of small, inflating the PEB. Adding a BS in a different direction (increasing angular diversity) is far more beneficial than adding one near an existing BS.
Apply the matrix CRB: .
Take the trace of both sides and use .
CRB for vector parameters
From the Cramer-Rao inequality for a vector parameter :
in the positive semidefinite (Loewner) ordering. This means .
Trace inequality
Since implies , we have:
The left side is:
Therefore .
Gauss-Newton Iteration Convergence
Watch the Gauss-Newton algorithm converge from a coarse initial estimate (linearised LS) to the refined position. Each frame shows one iteration: the current estimate, the linearised range residuals, and the update step. Observe the quadratic convergence rate near the solution and how increased noise slows convergence.
Parameters
Position Error Bound (PEB) Contour Map
Visualise the PEB as a function of the UE position across a 2D area containing base stations. The contour map reveals how BS geometry affects positioning accuracy: the PEB is lowest inside the convex hull of the BS locations and increases rapidly outside. Increase the number of BSs to observe the improvement in coverage. Reduce (which decreases with bandwidth) to see the PEB shrink uniformly. The bandwidth parameter converts to via the CRB on delay estimation at a reference SNR of 10 dB.
Parameters
The NLOS Problem: The Dominant Error Source in Practice
In real-world environments, the direct (line-of-sight) path between UE and BS is frequently blocked by buildings, walls, or other obstacles. The signal arrives via a reflected or diffracted non-line-of-sight (NLOS) path that is longer than the geometric distance, introducing a positive range bias:
where is the NLOS excess delay (often tens to hundreds of metres equivalent). This bias is not captured by the Gaussian noise model and can cause positioning errors of tens of metres even with high-bandwidth signals.
NLOS mitigation strategies fall into three categories:
-
Detection and exclusion: Identify NLOS measurements and remove them before positioning. Methods include residual analysis (measurements with large residuals after an initial LS fit are flagged as NLOS), hypothesis testing on the ranging error distribution, and machine learning classifiers trained on channel impulse response features.
-
Robust estimation: Use estimators that are resilient to outliers, such as M-estimators (replacing the squared loss with a Huber or Tukey loss function), RANSAC-based approaches, or constrained optimisation that enforces .
-
NLOS modelling: Treat the NLOS bias as a random variable with a known prior distribution (e.g., exponential) and incorporate it into a Bayesian estimation framework.
NLOS Detection and Mitigation
Monte Carlo simulation comparing positioning accuracy with and without NLOS mitigation. A fraction of the BS links are affected by NLOS bias. The plot shows the CDF of the position error for: (1) naive LS ignoring NLOS, (2) residual-based NLOS detection and exclusion, and (3) robust M-estimation. Observe how increasing or the NLOS bias dramatically degrades naive LS but is partially mitigated by the robust approaches.
Parameters
Common Mistake: NLOS Errors Are Not Gaussian
Mistake:
Modelling NLOS range errors as zero-mean Gaussian and applying standard least-squares positioning.
Correction:
NLOS introduces a positive bias () because the reflected path is always longer than the direct path. Standard LS/ML estimators assume zero-mean noise and will systematically pull the position estimate toward the NLOS BSs, potentially causing errors of tens of metres.
Proper handling requires either: (1) detecting and excluding NLOS measurements (residual analysis, hypothesis testing), (2) robust estimation (M-estimators with asymmetric loss), or (3) explicit bias modelling (e.g., exponential prior on ).
Common Mistake: More BSs Do Not Help If Geometry Is Poor
Mistake:
Adding more base stations in the same direction from the UE, expecting significant PEB improvement.
Correction:
The PEB depends on the eigenvalues of the FIM, which in turn depend on the angular diversity of BS directions. If all BSs are clustered in one direction, has one large and one small eigenvalue; adding more BSs in the same direction improves the large eigenvalue but not the small one.
The PEB is dominated by the weakest direction (). A single BS placed orthogonally to the cluster is worth more than doubling the cluster size. This is why positioning-aware network planning considers angular diversity, not just signal coverage.
Key Takeaway
The PEB captures the fundamental accuracy limit for any positioning method, given the available measurements. It is determined by two independent factors: measurement quality (, ) and geometry (GDOP). Improving either factor helps, but neither alone is sufficient โ a system with excellent ranging but poor geometry (all BSs in a line) cannot position accurately in the perpendicular direction, no matter how precise the individual measurements.
Clock Synchronisation Requirements for Positioning
Different positioning methods impose different synchronisation requirements, which have significant infrastructure implications:
- TOA (one-way): Requires UE-to-BS synchronisation with accuracy . For m, this means ns โ achievable only with GPS- disciplined oscillators, not standard crystal oscillators.
- TDOA: Requires BS-to-BS synchronisation at the same level. 5G gNBs typically achieve ns via PTP (IEEE 1588) or GPS timing, translating to m synchronisation error.
- RTT (round-trip): Eliminates clock sync entirely by measuring two-way delay. The price is that the UE must transmit (uplink overhead) and processing delays , must be calibrated.
- AOA: No timing requirements โ purely spatial. But requires calibrated antenna arrays.
In practice, Multi-RTT is preferred for wide-area deployments because it avoids the stringent synchronisation requirements of TDOA, at the cost of additional UL signalling.
- โข
PTP synchronisation accuracy is 50--100 ns in typical 5G deployments
- โข
GPS-disciplined oscillators add $500 per BS for timing
- โข
UE crystal oscillator drift is 1 ppm, too coarse for one-way TOA
Example: AOA-Based Positioning (Triangulation)
Two base stations with large antenna arrays are located at and (metres). The estimated angles of arrival from the UE are and (measured from the positive -axis).
(a) Write the bearing-line equations. (b) Find the intersection point (UE position). (c) If , estimate the position uncertainty.
Bearing lines
The bearing line from BS passing through at angle is:
BS 1:
BS 2:
Intersection
Setting equal:
m
m
m.
Position uncertainty
The distance from each BS to the UE is m and m (symmetric).
The cross-range error at distance with angular error is . With rad: m.
The PEB depends on the intersection angle ( here, nearly orthogonal), which gives near-isotropic accuracy: m per axis.
Quick Check
Four base stations are placed at the corners of a square of side length , and all have the same ranging accuracy . A fifth BS is to be added to minimise the PEB at the centre of the square. Where should it be placed?
At the centre of the square, co-located with the UE
At any corner โ adding a fifth corner-BS is always best
At any location on the boundary of the square โ the FIM is insensitive to the fifth BS placement
At any location that is not collinear with existing BSs; the exact position does not matter much since the four-corner geometry is already isotropic
The four-corner geometry already produces an isotropic FIM at the centre () because the direction vectors to the four corners are uniformly distributed. Adding a fifth BS anywhere (except at the centre, where is undefined) increases both eigenvalues, but since the geometry is already balanced, the marginal improvement is similar regardless of the fifth BS direction. The key insight is that geometric diversity (angular spread of BSs) matters more than distance: placing the fifth BS in a direction not already well covered (which is hard to improve upon with four symmetric corners) gives only a modest further reduction in PEB.