LiDAR Feature Outlier Mitigation Aided by Graduated Non-Convexity Relaxation for Safety-critical Localization in Urban Canyons

Jiachen Zhang, Weisong Wen, Li-Ta Hsu, Zheng Gong, Zhongzhe Su

Abstract:	Abstract—Safety-critical localization is essential for unmanned autonomous systems. LiDAR localization gains great popularity in urban canyons due to its high ranging accuracy. Inheriting from the integrity monitoring theory for GNSS, safety-certifiable LiDAR localization first consists in fault detection and exclusion (FDE). In face of numerous LiDAR measurements, conventional chi-square test for FDE is computationally intractable. What’s more, inliers could be mistakenly excluded without reconsideration. This paper proposes a computationally tractable and flexible FDE method. It’s realized via outlier mitigation aided by graduated nonconvexity (GNC) relaxation. The two novel loss functions truncated least square (TLS) and the Geman McClure (GM) are combined respectively. The outlier-mitigated planar-feature-based LiDAR localization is formulated with GNC and TLS or GM. More importantly, a triple-layer optimization method is proposed to solve the localization formulation. Besides the typical GNC relaxation, the control parameter is taken into consideration for tuning the outliers resistance degree. The outlier mitigated pose estimation and the weightings ranging from 0 to 1 for the exploited LiDAR measurements are finally produced. Extensive experiments of the proposed method is conducted on urban dataset. What’s more, considering that TSL and GM provides distinct outlier mitigation patterns, the performances from them are investigated and compared. Keywords—3D LiDAR, safety-critical localization, urban canyons, fault detection and exclusion, graduated non-convexity relaxation
Published in:	2023 IEEE/ION Position, Location and Navigation Symposium (PLANS) April 24 - 27, 2023 Hyatt Regency Hotel Monterey, CA
Pages:	660 - 664
Cite this article:	Zhang, Jiachen, Wen, Weisong, Hsu, Li-Ta, Gong, Zheng, Su, Zhongzhe, "LiDAR Feature Outlier Mitigation Aided by Graduated Non-Convexity Relaxation for Safety-critical Localization in Urban Canyons," 2023 IEEE/ION Position, Location and Navigation Symposium (PLANS), Monterey, CA, April 2023, pp. 660-664. https://doi.org/10.1109/PLANS53410.2023.10139983
Full Paper:	ION Members/Non-Members: 1 Download Credit Sign In