dijkstras algorithm code snippets in matlab