Dijkstra Shortest Path Routing

This function and example show shortest path routing based on Dijkstra algorithm.

This function performs Dijkstra algorithm based on the cost matrix, and shortest path can be found.