Implemented a Find SHortest Path algorithm (dijkstra)