TDOA-TWR based positioning algorithm for UWB localization system

Marcin Kolakowski,Vitomir Djaja-Josko

DOI: https://doi.org/10.1109/MIKON.2016.7491981

2024-02-15

Abstract:Ultra-wideband positioning systems intended for indoor applications often work in non-line of sight conditions, which result in insufficient precision and accuracy of derived localizations. One of the possible solutions is the implementation of cooperative positioning techniques. The following paper describes a cooperative ultra-wideband positioning system which calculates tag position from TDOA and distance between tags measurements. In the paper positioning system architecture is described and an exemplary transmission scheme for cooperative systems is presented. Considered localization system utilizes an Extended Kalman Filter based algorithm. The algorithm was investigated with simulations and experiments. Conducted experiment consisted in fusing results gathered from typical TDOA positioning system infrastructure and ranging results obtained with ultra-wideband radio modules. The research has shown that the use presented cooperative algorithm increases positioning precision.

Signal Processing

What problem does this paper attempt to address?

This paper aims to solve the problems encountered in the indoor applications of Ultra - Wideband (UWB) positioning systems, especially the problems of insufficient positioning accuracy and decreased accuracy caused by non - line - of - sight (NLOS) conditions. The author proposes a cooperative positioning algorithm based on Time Difference of Arrival (TDOA) and Two - Way Ranging (TWR) to improve the performance of UWB positioning systems.

### Main problems solved in the paper:

1. **Positioning accuracy problems under non - line - of - sight conditions**:
- The multipath propagation and non - line - of - sight conditions common in indoor environments have a negative impact on the accuracy and reliability of UWB positioning systems.
- The author improves the positioning accuracy by introducing cooperative positioning technology and using the relative position information between multiple tags.

2. **Data fusion in multi - tag positioning systems**:
- In multi - tag positioning systems, additional data can be obtained through information exchange and relative position evaluation between tags, thereby improving the positioning accuracy.
- The author proposes an Extended Kalman Filter (EKF) algorithm that combines TDOA and TWR measurement results for processing nonlinear measurement models.

3. **System architecture and transmission scheme**:
- The paper describes the architecture of the cooperative UWB positioning system, including the interaction methods between the infrastructure and tags.
- A transmission scheme is proposed to improve the flexibility and scalability of the system by minimizing the number of exchanged data packets.

### Main contributions:

- **Algorithm innovation**: An Extended Kalman Filter algorithm based on TDOA and TWR is proposed, which can effectively process nonlinear measurement models and improve positioning accuracy.
- **System design**: A flexible and scalable system architecture is designed to support cooperative positioning between multiple tags.
- **Experimental verification**: The effectiveness of the proposed algorithm is verified through simulation and actual experiments, and the results show that the use of the cooperative algorithm can significantly improve the positioning accuracy.

### Formula summary:

- **State vector**:
\[
\mathbf{x}_k=\begin{bmatrix}x\\y\\v_x\\v_y\end{bmatrix}
\]

- **Extended Kalman Filter equations**:
- Prediction step:
\[
\mathbf{\hat{x}}_{k|k - 1}=A\mathbf{\hat{x}}_{k - 1|k - 1}
\]
\[
\mathbf{P}_{k|k - 1}=A\mathbf{P}_{k - 1|k - 1}A^T+Q_{k - 1}
\]
- Update step:
\[
\mathbf{K}_k=\mathbf{P}_{k|k - 1}\mathbf{H}_k^T(\mathbf{H}_k\mathbf{P}_{k|k - 1}\mathbf{H}_k^T+\mathbf{R}_k)^{-1}
\]
\[
\mathbf{\hat{x}}_{k|k}=\mathbf{\hat{x}}_{k|k - 1}+\mathbf{K}_k(\mathbf{z}_k-\mathbf{H}_k\mathbf{\hat{x}}_{k|k - 1})
\]
\[
\mathbf{P}_{k|k}=(\mathbf{I}-\mathbf{K}_k\mathbf{H}_k)\mathbf{P}_{k|k - 1}
\]

- **Measurement function**:
\[
\mathbf{h}_k(\mathbf{\hat{x}}_{k|k - 1})=\begin{bmatrix}\text{TDOA}_1(\mathbf{\hat{x}}_{k|k - 1})\\\text{TDOA}_2(\mathbf{\hat{x}}_{k|k - 1})\\\vdots\\\text{TDOA}_n(\