High-Level Collaborative Task Planning for Heterogeneous Multi-Robot Systems