Added shortest path finder and a test for it