SimSTL: Add Dijkstra Implementation