Subteaming and Adaptive Formation Control for Coordinated Multi-Robot Navigation