DECENTRALIZED MULTI-SUBGROUP FORMATION CONTROL WITH CONNECTIVITY PRESERVATION AND COLLISION AVOIDANCE