Proper working Dijkstra
 Added testcase image annotation