Fixed a bug: ALL robots were being passed into the discrete solver. Now only robots in conflict are passed in