Nonlinear Deterministic Observer for Inertial Navigation using Ultra-wideband and IMU Sensor Fusion

Hashim A. Hashim,Abdelrahman E. E. Eltoukhy,Kyriakos G. Vamvoudakis,Mohammed I. Abouheaf

2023-08-16

Abstract:Navigation in Global Positioning Systems (GPS)-denied environments requires robust estimators reliant on fusion of inertial sensors able to estimate rigid-body's orientation, position, and linear velocity. Ultra-wideband (UWB) and Inertial Measurement Unit (IMU) represent low-cost measurement technology that can be utilized for successful Inertial Navigation. This paper presents a nonlinear deterministic navigation observer in a continuous form that directly employs UWB and IMU measurements. The estimator is developed on the extended Special Euclidean Group $\mathbb{SE}_{2}\left(3\right)$ and ensures exponential convergence of the closed loop error signals starting from almost any initial condition. The discrete version of the proposed observer is tested using a publicly available real-world dataset of a drone flight. Keywords: Ultra-wideband, Inertial measurement unit, Sensor Fusion, Positioning system, GPS-denied navigation.

Systems and Control,Robotics

What problem does this paper attempt to address?

The problem that this paper attempts to solve is to achieve accurate navigation in an environment where GPS signals are unavailable. Specifically, the paper proposes a non - linear deterministic navigation observer based on the fusion of ultra - wideband (UWB) and inertial measurement unit (IMU) sensors, aiming to estimate the attitude (i.e., orientation), position and linear velocity of a rigid body. The main challenges mentioned in the paper include:

1. **High - precision navigation requirements**: In environments where GPS signals are unavailable or interfered with, such as indoors and urban canyons, a reliable alternative is required to achieve high - precision navigation.
2. **Sensor uncertainties**: UWB and IMU sensors have relatively high measurement uncertainties, which will affect the performance of the navigation system. In particular, the bias error in the IMU sensor will accumulate over time, leading to an increase in the estimation error.
3. **Limitations of existing methods**: Existing methods based on Kalman Filters and Particle Filters have certain limitations in dealing with non - linear problems, such as linearization errors and high computational complexity.

To solve these problems, the paper makes the following contributions:

- **Lie - group - based navigation observer**: The paper models the navigation dynamics on the extended special Euclidean group SE2(3) and designs a non - linear deterministic navigation observer that can directly utilize the measurement data of UWB and IMU.
- **Unknown bias compensation**: The proposed observer can effectively handle the unknown bias problem in IMU measurements, improving the robustness and accuracy of the navigation system.
- **Exponential convergence**: Through theoretical analysis, it is proved that the proposed observer can make the closed - loop error signal converge exponentially starting from almost any initial condition.

The paper verifies the effectiveness of the proposed navigation observer by using publicly available real - world drone flight data sets, demonstrating its strong tracking performance and robustness in practical applications.