Stabilization of infinitesimally rigid formations of multi-robot networks