Added visibility graph + shortest path