Modified LIDAR definition for CostMap