Added shortest path algorithm for visibility graphs