Implement Dijkstra
Implement GeometricGraph
Create a simple simulator