Partial implmentation of shortest path
More implementation, added some simple tests
Handles cycles
Got simple example for complex graph