checkpoint
Fixed bug in shortest path