This paper presents a novel method that extends targetless LiDAR-IMU calibration for ground vehicles to non- flat environments. Calibration typically necessitates full exci- tation of the sensor rig, a requirement that is not fulfilled by ground vehicles in normal operation. To address the degenerate planar motion, state-of-the-art methods propose residuals that assume the colinearity of the gravity and physical surface normal vectors, restricting usage to cases where the ground is assumed flat. This paper proposes ground-plane residuals that do not require this assumption, and are applicable for planar motion on a tilted surface. Results are demonstrated on a dataset collected from a Husky ground vehicle, on the M2DGR dataset, as well as on an offroad vehicle dataset. Repeatability is shown to be improved both in tilted and flat-ground scenarios, with strong improvement demonstrated for the tilted case. The implementation and experiments are open-sourced at https://github.com/vkorotkine/licalib_tilted_ground.
Figures & tables
Method
Continuous-Time
Ground Constraint
Open Source
LI-Init [ 20 ]
No
No
Yes
OA-Calib [ 11 ]
Yes
No
Yes
GRIL-Calib [ 5 ]
No
Flat only
Yes
Slope-Based [ 15 ]
No
No
No
GCT-LICalib [ 4 ]
Yes
Flat only
No
Proposed
Yes
Tilted surfaces
Yes
Table I: Comparison of targetless LiDAR–IMU calibration methods.
Residual
Type
Tilted Ground
Uses IMU Inclination
\mbfeflat
Orientation
No
No
\mbfedist
Distance
Yes
No
\mbfeincl
Orientation
Yes
Yes
Table II: Summary of Residuals
Fig. 1: Problem setup: LiDAR-IMU calibration on a tilted planar surface.
Method
\mbfrblb (cm)
\mbfCbl (Euler, deg)
Husky UGV, Flat Ground
Measured
[24.77, -6.99, -46.36]
[180.00, 0.00, -90.00]
GRIL-Calib
[25.17, -3.38, -43.55]
[179.98, -0.21, -90.11]
Proposed
[26.00, -7.20, -43.53]
[179.98, -0.17, -87.48]
Husky UGV, Incline (Note: GRIL-Calib Diverges.)
Measured
[24.77, -6.99, -46.36]
[180.00, 0.00, -90.00]
Table III: Estimated Extrinsics Across All Datasets
Fig. 2: Husky UGV used for algorithm validation.
Fig. 3: Per-sequence position extrinsic results for the flat-ground Husky UGV dataset.
Fig. 4: Extrinsic spread for the flat-ground Husky UGV dataset.
Proposed
\mbfrblb (cm)
\mbfCbl (Euler, deg)
Outdoors1
[25.600, -7.700, -46.600]
[179.965, -0.179, -88.440]
Outdoors2
[25.400, -8.200, -41.000]
[179.969, -0.029, -87.740]
Outdoors3
[29.300, -5.400, -46.700]
[179.638, -0.306, -87.790]
Outdoors4
[23.700, -14.100, -42.400]
[-179.983, -0.103, -82.450]
Outdoors5
[26.600, -8.100, -43.600]
[180.000, -0.150, -86.010]
Table IV: Results for each sequence of inclined Husky UGV dataset
Fig. 5: Per-sequence position extrinsic results for the M2DGR dataset.
Fig. 6: Extrinsic spread for the M2DGR dataset.
Fig. 7: Per-sequence position extrinsic results for the Offroad dataset.
Fig. 8: Extrinsic spread for the Offroad dataset.
Fig. 9: Offroad dataset trajectory visualization.
Fig. 10: Extrinsic spread for the Offroad (ablation) dataset.
Fig. 11: Per-sequence position extrinsic results for the Offroad (ablation) dataset.
Fig. 12: Extrinsic spread for ablation study on offroad dataset with misinitalized extrinsics.
Fig. 13: Per-sequence position error for ablation study on offroad dataset with misinitalized extrinsics.
LiDAR-inertial odometry (LIO) is widely used for state estimation in ground-based autonomous mobile robots. However, the geometric constraints provided by the local ground surface remain largely underexploited in existing LIO systems. This paper proposes a filter-based local ground-aware LIO framework that explicitly incorporates local ground plane geometry into the state estimation process to improve both localization accuracy and computational efficiency. Specifically, a local ground plane is parameterized by the robot orientation and the body-to-ground (B-G) height and continuously propagated within the state estimation process. Based on the proposed B-G geometry model, a propagated local ground plane enables efficient and reliable ground segmentation. The segmented ground points are then incorporated into the filter update through point-to-plane geometric constraints, improving both state estimation accuracy and efficiency. Furthermore, a planar motion update is introduced to exploit the propagated local ground plane as an additional geometric constraint, effectively suppressing vertical drift and improving estimation robustness. To address the initially unknown B-G height, an efficient initialization strategy is developed, followed by an online calibration procedure for continuous refinement. The proposed system is evaluated on several public benchmark datasets and self-collected real-world datasets covering diverse operating scenarios. Experimental results demonstrate that the proposed method consistently outperforms representative LIO methods in terms of both localization accuracy and computational efficiency.
Zhixin Zhang, Yang Song, Liang Zhao +3
Department of Electrical and Electronic Engineering, University of Manchester, Manchester M13 9PL, U.K. · School of Informatics, University of Edinburgh, Edinburgh EH8 9AB, U.K. · Department of Mechanical, Aerospace and Civil Engineering, University of Manchester, Manchester M13 9PL, U.K.
We present LV-Calib, a calibration framework for LiDAR-camera extrinsic estimation and LiDAR boundary-response calibration using a printable planar target. The target serves as a shared observation carrier: visual fiducials provide indexed image measurements, while circular reflectivity boundaries provide LiDAR-observable structural feature points. Instead of directly fitting boundary points as ideal geometric contours, LV-Calib automatically crops background points, estimates the target plane, and iteratively refines accurate LiDAR-side 3-D feature points from intensity and geometric constraints. The refinement explicitly handles the broadened and distorted transition band induced by finite beam footprint and mixed-intensity returns around black-white reflectivity discontinuities. Given these refined LiDAR features, we formulate a weighted reprojection-consistent extrinsic optimization with LiDAR feature alignment, where image observations are kept in the reprojection domain and LiDAR feature residuals are weighted by refinement confidence. Finally, using the estimated extrinsic and the extracted transition band, LV-Calib calibrates the LiDAR boundary response by estimating pitch-yaw-range residual statistics of boundary-overlap samples. Experiments on printed-board calibration data demonstrate sub-pixel reprojection accuracy, millimeter-level LiDAR feature consistency, and improved odometry performance. Code and calibration data will be released for reproducible evaluation.
Sheng Hong
Pen-Tung Sah Institute of Micro-Nano Science and Technology, Xiamen University, Xiamen 361102, China
Autonomous navigation in space requires reliable terrain assessment for safe operations, especially in underground environments with limited communication, computing resources, and power budget. This paper presents a lightweight method for real-time vibration-aware traversability mapping using a Light Detecting And Ranging (LiDAR) point cloud and Inertial Measurement Unit (IMU) measurements. An initial vibration proxy is estimated from terrain geometry by applying Random sample consensus (RANSAC) to local point-cloud patches produced by a Simultaneous Localisation And Mapping (SLAM) algorithm. In parallel, the IMU provides local observations of the vibration experienced by the rover during traversal. The point-cloud-based prediction is then corrected online using Recursive Least Squares, allowing the system to adapt the geometric estimate to the measured rover response. The approach is evaluated in a lunar analogue environment, an outdoor field, and an underground mine.
Gabriel Manuel Garcia, Stephanie Aravecchia, Miguel Angel Olivares-Mendez
University of Luxembourg, Luxembourg · IRL Georgia Tech-CNRS, Metz, France