Optimization pipeline for swarm robot collaboration