Implementation pathfinding (non optimisee pour le moment)