Obstacle avoidance in optimal switching of a formation geometry - Fernando A.C.C. Fontes (2012)