Fixed bug in collision checking for BaseAdaptiveMP