From f322f5c9fddd724e86f9b6773a6144ec05beb8a8 Mon Sep 17 00:00:00 2001
From: hongkai-dai <daihongkai@gmail.com>
Date: Mon, 2 Jul 2018 09:41:30 -0700
Subject: [PATCH] Address Sherm's comments.

---
 .../detail/convexity_based_algorithm/gjk_libccd-inl.h      | 7 +------
 1 file changed, 1 insertion(+), 6 deletions(-)

diff --git a/include/fcl/narrowphase/detail/convexity_based_algorithm/gjk_libccd-inl.h b/include/fcl/narrowphase/detail/convexity_based_algorithm/gjk_libccd-inl.h
index f940b6a16..572455826 100644
--- a/include/fcl/narrowphase/detail/convexity_based_algorithm/gjk_libccd-inl.h
+++ b/include/fcl/narrowphase/detail/convexity_based_algorithm/gjk_libccd-inl.h
@@ -1181,7 +1181,6 @@ static ccd_vec3_t supportEPADirection(const ccd_pt_t* polytope,
         const ccd_pt_edge_t* edge =
             reinterpret_cast<const ccd_pt_edge_t*>(nearest_feature);
         dir = faceNormalPointingOutward(polytope, edge->faces[0]);
-        ccdVec3Normalize(&dir);
         break;
       }
       case CCD_PT_FACE: {
@@ -1190,17 +1189,13 @@ static ccd_vec3_t supportEPADirection(const ccd_pt_t* polytope,
         const ccd_pt_face_t* face =
             reinterpret_cast<const ccd_pt_face_t*>(nearest_feature);
         dir = faceNormalPointingOutward(polytope, face);
-
-        ccdVec3Normalize(&dir);
         break;
       }
     }
   } else {
     ccdVec3Copy(&dir, &(nearest_feature->witness));
-    // The "dist" field in ccd_pt_el_t is actually the square of the distance.
-    const ccd_real_t dist = std::sqrt(nearest_feature->dist);
-    ccdVec3Scale(&dir, ccd_real_t(1.0) / dist);
   }
+  ccdVec3Normalize(&dir);
   return dir;
 }