Implemented occupancy grid mapping.