Finding and optimizing solvable priority schemes for decoupled path planning techniques for teams of mobile robots