Optimal formation Switching with collision avoidance and allowing variable agent velocities - Dalila B. M. M. Fontes (2012)