A Framework for Optimal Navigation in Situations of Localization Uncertainty

Sensors (Basel). 2023 Aug 17;23(16):7237. doi: 10.3390/s23167237.

Abstract

The basic functions of an autonomous vehicle typically involve navigating from one point to another in the world by following a reference path and analyzing the traversability along this path to avoid potential obstacles. What happens when the vehicle is subject to uncertainties in its localization? All its capabilities, whether path following or obstacle avoidance, are affected by this uncertainty, and stopping the vehicle becomes the safest solution. In this work, we propose a framework that optimally combines path following and obstacle avoidance while keeping these two objectives independent, ensuring that the limitations of one do not affect the other. Absolute localization uncertainty only has an impact on path following, and in no way affects obstacle avoidance, which is performed in the robot's local reference frame. Therefore, it is possible to navigate with or without prior information, without being affected by position uncertainty during obstacle avoidance maneuvers. We conducted tests on an EZ10 shuttle in the PAVIN experimental platform to validate our approach. These experimental results show that our approach achieves satisfactory performance, making it a promising solution for collision-free navigation applications for mobile robots even when localization is not accurate.

Keywords: localization uncertainty; obstacle avoidance; path following.

Grants and funding

This research was funded by the Wide Open to the World (WOW) excellence Incoming Master Fellowship from the Clermont Auvergne Project (https://cap2025.fr/ (accessed on 15 August 2023)). This work was supported by the International Research Center “Innovation Transportation and Production Systems” of the I-SITE CAP 20–25 French project.