Output group formation tracking control for heterogeneous systems with collision avoidance and connectivity maintenance