Optimal collision avoidance and formation switching on Riemannian manifolds | IEEE Conference Publication | IEEE Xplore