Implement Dijkstra
Implement GeometricGraph
Create simple simulator