1: \begin{abstract}

2: Visual and lidar \ac{SLAM} algorithms benefit from the \ac{IMU} modality.

3: The high-rate inertial data complement the other lower-rate modalities.

4: Moreover, in the absence of constant acceleration, the gravity vector makes two attitude angles out of three observable in the global coordinate frame.

5: In visual odometry, this is already being used to reduce the 6-\ac{DOF} pose estimation problem to 4-DOF.

6: In lidar \ac{SLAM}, the gravity measurements are often used as a penalty in the back-end global map optimization to prevent map deformations.

7: In this work, we propose an \ac{ICP}-based front-end which exploits the observable \ac{DOF} and provides pose estimates aligned with the gravity vector.

8: We believe that this front-end has the potential to support the loop closure identification, thus speeding up convergences of global map optimizations.

9: The presented approach has been extensively tested in large-scale outdoor environments as well as in the Subterranean Challenge organized by \ac{DARPA}.

10: We show that it can reduce the localization drift by 30\,\% when compared to the standard 6-\ac{DOF} \ac{ICP}.

11: Moreover, the code is readily available to the community as a part of the libpointmatcher library.

12: \end{abstract}