Collision-Free Task Assignment And Trajectory Planning For Multi-Robot Systems