Use FCLCollisionDetector