Added Occupancy Grid Removal function