I-TEAMS: Cooperative GNC for small UAV formations