A *  fonctionne   avec  collision et obstacle mais pas parfait