wbt_erase_polygon_from_lidar function

Erase polygon from lidar