Pathfinding first draft