Safety-quantifiable planar-feature-based LiDAR localization with a prior map for intelligent vehicles in urban scenarios

Abstract

Safety-quantifiable and accurate localization is of great importance for safety-critical applications with navigation requirements, such as intelligent vehicles (IV). LiDAR-based localization with the prior map is highly expected due to its high accuracy. However, how to reliably quantify the safety (quantify the maximum potential localization error) of LiDAR localization is still an open challenge. Integrity monitoring (IM) is one of the most stringent existing solutions to quantify the safety of satellite navigation, where usually tens of measurements are involved and interpreted by an almost locally linear model. Differently, the number of measurements involved in the LiDAR localization problem is significantly larger (e.g., 2000). Moreover, the LiDAR measurement model is highly non-linear. The convexity of the LiDAR localization is still to be quantified. To fill these gaps, this paper proposes a safety-quantifiable planar feature-based LiDAR localization method with a prior map. Specifically, the LiDAR localization framework utilizing representative planar features with maximum spectral attributes is proposed. The cardinality restriction facilitates feasible safety quantification regardless of thousands of measurements. To quantify the convexity of the LiDAR localization problem, the Hessian matrix of the planar feature measurement model is analytically derived. The local convex property during non-linear optimization of the localization model is quantified from dual perspectives. Additionally, different from existing methods, the protection level of the derived LiDAR localization is estimated for both translation and rotation to quantify the safety. The feasibility of the proposed method is validated using the datasets collected in typical urban canyons of Hong Kong.