Pathfinding for roadmaking