Merge branch 'develop'
Merge branch 'develop'
add some print to dijkstra
output generic dot format
Merge branch 'master' into develop
output Graphviz Dot graph in demo