Removed occupancy grid utils