Formation Tracking Control for Heterogeneous Swarm Systems