Reorganised visibility graph usage.

Moved functionality from the Room class to the VisibilityGraph class and
reflected changed in the PathPlanning class.