A* Pathfinding and Displaying

Add to route?