3D SLAM with LiDAR