A test implementation of the A* pathfinding algorithm