Mapping and Navigation on Rough Surface with LIDAR and IMU | IEEE Conference Publication | IEEE Xplore