Added visibility graph creation.

Currently wired up to just plot what is visible from the startPoint.