Adding calculation of shortest path [NOT FINISHED]
.
.