LIDAR Based Sequential Registration and Mapping for Autonomous Vehicles