fixes to ompl collision checker