GTRS-Based Algorithm for UAV Navigation in Indoor Environments Employing Range Measurements and Odometry

This work addresses the problem of unmanned aerial vehicle (UAV) navigation in indoor environments. Due to unavailability of satellite signals, the proposed algorithm takes advantage of terrestrial radio measurements between the UAV and a set of stationary reference points, from which it extracts range information, as well as odometry by means of inertial sensors, such as accelerometer. On the one hand, based on maximum a posteriori (MAP) criterion, the range information and accumulated knowledge throughout the UAV’s movement are employed to derive a generalized trust region sub-problem (GTRS), that is solved exactly via bisection procedure. On the other hand, by using the UAV’s transform in relation to the world, another position estimation is obtained by employing odometry. Finally, the two position estimates are combined through a Kalman filter (KF) to enhance the positioning accuracy and obtain the final UAV’s position estimation. The UAV is then navigated to a desired destination, by simply calculating the velocity components in the shortest path. Our results show that the proposed algorithm is robust to various model parameters for high precision (HP) UAV sensors, achieving reasonably good positioning accuracy. Besides, the results corroborate that the proposed algorithm is suitable for real-time applications, consuming (on average) only 21 ms to estimate the UAV position