Decompose in motion planning for swarm of robots and motion planning for object to be transported