implementation d'un prototype de code de gestion de la formation, corrige la trajectoire de chaque robot en fonciton de leur position et de leurs objectifs, à completer