Add wall around hole

New function which computes a filled polygon around a given hole and displays it in rviz.

most probably too specific for the scene_publisher, but not sure where to put it otherwise.