Work on a* pathfinding and test display