Algorithm maj pour pathfind