Optimization

Dijkstra actually works now!