Added Dijkstra implementation in Matlab