More A* Progress

Dijkstra implemented and patched up

Can visit checkpoints along the path before reaching the finish node