Add A* pathfinding
ptimizations