Merge pull request #495 from Rombur/box_sphere

Compute distance sphere-box

src/details/ArborX_DetailsAlgorithms.hpp

@@ -143,6 +143,16 @@ float distance(Box const &box_a, Box const &box_b)
   return std::sqrt(distance_squared);
 }
 
+// distance box-sphere
+KOKKOS_INLINE_FUNCTION
+float distance(Sphere const &sphere, Box const &box)
+{
+  using KokkosExt::max;
+
+  float distance_center_box = distance(sphere.centroid(), box);
+  return max(distance_center_box - sphere.radius(), 0.f);
+}
+
 // expand an axis-aligned bounding box to include a point
 KOKKOS_INLINE_FUNCTION
 void expand(Box &box, Point const &point) { box += point; }

test/tstDetailsAlgorithms.cpp

@@ -82,6 +82,26 @@ BOOST_AUTO_TEST_CASE(distance_box_box)
   BOOST_TEST(distance(Box{}, Box{}) == infinity);
 }
 
+BOOST_AUTO_TEST_CASE(distance_sphere_box)
+{
+  using ArborX::Details::distance;
+  auto infinity = KokkosExt::ArithmeticTraits::infinity<float>::value;
+
+  // unit sphere
+  constexpr Sphere sphere{{{0., 0., 0.}}, 1.};
+  // distance between a sphere and a box no intersection
+  BOOST_TEST(distance(sphere, Box{{2.0, 3.0, 4.0}, {2.5, 3.5, 4.5}}) ==
+             std::sqrt(29.f) - 1.f);
+  // distance between a sphere and a box with intersection
+  BOOST_TEST(distance(sphere, Box{{0.5, 0.5, 0.5}, {2.5, 3.5, 4.5}}) == 0.f);
+  // distance between a sphere included in a box and that box
+  BOOST_TEST(distance(sphere, Box{{-2., -2., -2.}, {2., 2., 2.}}) == 0.f);
+  // distance between a sphere and a box included in that sphere
+  BOOST_TEST(distance(sphere, Box{{0., 0., 0.}, {0.1, 0.2, 0.3}}) == 0.f);
+  // distance to empty box
+  BOOST_TEST(distance(sphere, Box{}) == infinity);
+}
+
 BOOST_AUTO_TEST_CASE(intersects)
 {
   using ArborX::Details::intersects;