ajout optimisation avoidance si pas d'obstacle sur chemin. compile mais pas testé