Merge pull request #4311 from maxGimeno/Distance_3-Plane_plane-maxGimeno

Distance_3: Add Pl_3-Pl_3

Author: lrineau

Distance_3/include/CGAL/squared_distance_3_2.h

@@ -399,6 +399,20 @@ squared_distance(const Triangle_3<K> & t,
 }
 
 
+template <class K>
+inline
+typename K::FT
+squared_distance(const Plane_3<K> & p1,
+                 const Plane_3<K> & p2) {
+  K k;
+  typename K::Construct_orthogonal_vector_3 ortho_vec =
+      k.construct_orthogonal_vector_3_object();
+  if (!internal::is_null(internal::wcross(ortho_vec(p1), ortho_vec(p2), k), k))
+    return typename K::FT(0);
+  else
+    return internal::squared_distance(p1.point(), p2, k);
+}
+
 } //namespace CGAL
 
 

Distance_3/test/Distance_3/test_distance_3.cpp

@@ -221,6 +221,17 @@ struct Test {
     check_squared_distance (L(p(2, -4,  3), p( 3,-8, 4)), Pl(0, 1, 0, 0), 0);
   }
 
+  void Pl_Pl()
+  {
+    std::cout << "Plane - Plane\n";
+    Pl p1(0, 1, 0, 0);
+    typename K::Vector_3 v = -p1.orthogonal_vector();
+    v /= CGAL::sqrt(v.squared_length());
+    Pl p2 = Pl(0,-1,0,6);
+    check_squared_distance (p1,p2, 36);
+    check_squared_distance (Pl(-2, 1, 1, 0), Pl(2, 1, 3, 0), 0);
+  }
+
   void run()
   {
     std::cout << "3D Distance tests\n";
@@ -239,6 +250,7 @@ struct Test {
     S_Pl();
     R_Pl();
     L_Pl();
+    Pl_Pl();
   }
 
 };