diff --git a/include/hpp/fcl/traversal/traversal_node_bvh_shape.h b/include/hpp/fcl/traversal/traversal_node_bvh_shape.h index 0d9730fe7341ad4409c01470c6f660b77dfc5ced..738d63c58dd1d3e0c31c140443d10c2c5a9670d2 100644 --- a/include/hpp/fcl/traversal/traversal_node_bvh_shape.h +++ b/include/hpp/fcl/traversal/traversal_node_bvh_shape.h @@ -312,6 +312,14 @@ public: return !overlap(this->tf1.getRotation(), this->tf1.getTranslation(), this->model2_bv, this->model1->getBV(b1).bv); } + bool BVTesting(int b1, int /*b2*/, FCL_REAL& sqrDistLowerBound) const + { + if(this->enable_statistics) this->num_bv_tests++; + return !overlap(this->tf1.getRotation(), this->tf1.getTranslation(), + this->model2_bv, this->model1->getBV(b1).bv, + this->request, sqrDistLowerBound); + } + void leafTesting(int b1, int b2, FCL_REAL& sqrDistLowerBound) const { details::meshShapeCollisionOrientedNodeLeafTesting