OCE: an optimization convergence metric for LiDAR SLAM degeneracy detection

Abstract

LiDAR-based Simultaneous Localization and Mapping (SLAM) systems suffer from environment-induced degeneracy in geometrically self-similar scenes such as tunnels and cylindrical structures, where the point cloud registration problem becomes ill-conditioned. Existing degeneracy detection methods predominantly rely on eigenvalue analysis of the Hessian matrix, which assesses geometric conditioning at a fixed linearization point. However, in semi-degenerate environments containing partial but sufficient geometric constraints, these methods tend to produce false positive detections because measurement noise inflates eigenvalues and obscures the contribution of minor structural features. In this paper, we propose the Optimization Convergence Efficiency (OCE) metric, which evaluates the relative contraction of the directional optimizer gradient across Levenberg-Marquardt evaluations and directly characterizes the convergence response of LiDAR registration along the monitored state direction. The proposed method is evaluated through controlled simulation with ground-truth-based quantitative assessment and real-world UAV experiments in a wind-turbine tower and a long tunnel. In the nominal simulation, OCE achieves 98.21% recall with a 2.33% false-positive rate, compared with 100% recall and a 49.42% false-positive rate for the conventional eigenvalue-ratio detector. Controlled measurement-noise experiments further demonstrate that OCE maintains substantially lower false-alarm rates as spectral discrimination becomes less reliable. These results show that OCE can retain usable LiDAR pose estimates in semi-degenerate environments while reliably identifying actual registration failure.

Keywords

Degeneracy detection / LIDAR SLAM / LiDAR point cloud registration / SLAM

References

[1] Xu W., Cai Y., He D., Lin J., Zhang F.. FAST-LIO2: fast direct LiDAR-inertial odometry. IEEE Trans. Robot., 2022, 38420532073.

[2] Shan T., Englot B., Meyers D., Wang W., Ratti C., Rus D.. LIO-SAM: tightly-coupled LiDAR inertial odometry via smoothing and mapping. 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2020IEEE51355142.

[3] Chen K., Nemiroff R., Lopez B.T.. Direct LiDAR-inertial odometry: lightweight LIO with continuous-time motion correction. 2023 IEEE International Conference on Robotics and Automation (ICRA), 2023IEEE39833989.

[4] K.-L. Low, Linear least-squares optimization for point-to-plane ICP surface registration. Chapel Hill, University of North Carolina 4(10), 1–3 (2014)

[5] Segal A., Haehnel D., Thrun S.. Generalized-ICP. Robotics: Science and Systems, 2009435Seattle2

[6] Pomerleau F., Colas F., Siegwart R., Magnenat S.. Comparing ICP variants on real-world data sets: open-source library and experimental protocol. Auton. Robots, 2013, 343133148.

[7] Zhan Q., Zhou Y., Zhang J., Sun C., Shen R., He B.. A novel method for measuring center-axis velocity of unmanned aerial vehicles through synthetic motion blur images. Auton. Intell. Syst., 2024, 4116.

[8] Das S., Klinteberg L., Fallon M., Chatterjee S.. Observability-aware online multi-LiDAR extrinsic calibration. IEEE Robot. Autom. Lett., 2023, 8528602867.

[9] Zhang J., Kaess M., Singh S.. On degeneracy of optimization-based state estimation problems. 2016 IEEE International Conference on Robotics and Automation (ICRA), 2016IEEE809816.

[10] Hinduja A., Ho B.-J., Kaess M.. Degeneracy-aware factors with applications to underwater SLAM. 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2019IEEE12931299.

[11] Tuna T., Nubert J., Nava Y., Khattak S., Hutter M.. X-ICP: localizability-aware LiDAR registration for robust localization in extreme environments. IEEE Trans. Robot., 2023, 40: 452-471.

[12] Tagliabue A., Tordesillas J., Cai X., Santamaria-Navarro A., How J.P., Carlone L., Agha-mohammadi A.-a.. LION: LiDAR-inertial observability-aware navigator for vision-denied environments. International Symposium on Experimental Robotics, 2020, Berlin: Springer, 380-390

[13] H. Zhu, G. Zhang, Y. Huang, A degeneracy-aware LiDAR-inertial-visual SLAM for degenerate environments. IEEE Sens. J. (2025)

[14] Ebadi K., Palieri M., Wood S., Padgett C., Agha-mohammadi A.-a.. Dare-SLAM: degeneracy-aware and resilient loop closing in perceptually-degraded environments. J. Intell. Robot. Syst., 2021, 10212.

[15] Lee J., Komatsu R., Shinozaki M., Kitajima T., Asama H., An Q., Yamashita A.. Switch-SLAM: switching-based LiDAR-inertial-visual SLAM for degenerate environments. IEEE Robot. Autom. Lett., 2024, 9872707277.

[16] Z. Liao, X. Zhang, T. Zhang, Z. Li, Z. Zheng, Z. Wen, Y. Li, A real-time degeneracy sensing and compensation method for enhanced LiDAR SLAM. IEEE Trans. Intell. Transp. Syst. (2025)

[17] Zhang J., Huang Z., Zhu X., Guo F., Sun C., Zhan Q., Shen R.. LOFF: LiDAR and optical flow fusion odometry. Drones, 2024, 88411.

[18] Zhen W., Scherer S.. Estimating the localizability in tunnel-like environments using LiDAR and UWB. 2019 International Conference on Robotics and Automation (ICRA), 2019IEEE49034908.

[19] Nubert J., Walther E., Khattak S., Hutter M.. Learning-based localizability estimation for robust LiDAR localization. 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2022IEEE1724.

[20] Gelfand N., Ikemoto L., Rusinkiewicz S., Levoy M.. Geometrically stable sampling for the ICP algorithm. Fourth International Conference on 3-D Digital Imaging and Modeling, 2003. 3DIM 2003, 2003IEEE260267

[21] Bonnabel S., Barczyk M., Goulette F.. On the covariance of ICP-based scan-matching techniques. 2016 American Control Conference (ACC), 2016IEEE54985503.

[22] Ma Y., Zhao C., Xu J., Li Y., Zhang X., Yuan S., Xie L.. NVMS-SLAM: normal vector-based multi-session LiDAR SLAM in indoor environments. IEEE Trans. Autom. Sci. Eng., 2026, 23: 8034-8045.

[23] Kung Y.-C., Zhou X., Shen H., Ahn J., Wang J.. Convolutional neural networks for interpreting unclustered radar data in automotive applications. 2023 IEEE International Automated Vehicle Validation Conference (IAVVC), 2023IEEE16

[24] Zhao L., Dai H.-Y., Lang L., Zhang M.. An adaptive filtering method for cooperative localization in leader–follower auvs. Sensors, 2022, 22135016.

[25] Wang Z., Li B., Dan Z., Wang H., Fang K.. 3D LiDAR aided GNSS/INS integration fault detection, localization and integrity assessment in urban canyons. Remote Sens., 2022, 14184641.

[26] Venus A., Leitinger E., Tertinek S., Witrisal K.. A graph-based algorithm for robust sequential localization exploiting multipath for obstructed-los-bias mitigation. IEEE Trans. Wirel. Commun., 2023, 23210681084.

[27] Koide K., Yokozuka M., Oishi S., Banno A.. Voxelized GICP for fast and accurate 3D point cloud registration. 2021 IEEE International Conference on Robotics and Automation (ICRA), 2021IEEE1105411059.

Rights & permissions

The Author(s)