Multi-robot workspace design and motion planning for package sorting