Trajectory planning and optimal control for formations of autonomous robotsMartin SaskaEsaurito4,3Avvisami