Robustness and safety are crucial properties for the real-world application of autonomous vehicles. One of the most critical components of any autonomous system is localisation. During the last 20 years there has been significant progress in this area with the introduction of very efficient algorithms for mapping, localisation and SLAM. Many of these algorithms present impressive demonstrations for a particular domain, but fail to operate reliably with changes to the operating environment. The aspect of robustness has not received enough attention and localisation systems for self-driving vehicle applications are seldom evaluated for their robustness. In this paper we propose novel metrics to effectively quantify localisation robustness with or without an accurate ground truth. The experimental results present a comprehensive analysis of the application of these metrics against a number of well known localisation strategies.
The majority of Intelligent Transportation System (ITS) applications require an estimate of position, often generated through the fusion of satellite based positioning (such as GPS) with on-board inertial systems. To make the position estimates consistent it is necessary to understand the noise distribution of the information used in the estimation algorithm. For GNSS position information the noise distribution is commonly approximated as zero mean with Gaussian distribution, with the standard deviation used as an algorithm tuning parameter. A major issue with satellite based positioning is the well known problem of multipath which can introduce a non-linear and non-Gaussian error distribution for the position estimate. This paper introduces a novel algorithm that compares the noise distribution of the GNSS information with the more consistent noise distribution of the local egocentric sensors to effectively reject GNSS data that is inconsistent. The results presented in this paper show how the gating of the GNSS information in a strong multipath environment can maintain consistency in the position filter and dramatically improve the position estimate. This is particularly important when sharing information from different vehicles as in the case of cooperative perception due to the requirement to align information from various sources.