Constraint fix.

LLNL · Aug 4, 2021 · 1d39a9b · 1d39a9b
1 parent 75b12f7
commit 1d39a9b
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/src/Utilities/pointDistances.hh b/src/Utilities/pointDistances.hh
@@ -27,7 +27,7 @@ closestPointOnSegment(const Vector& p,
   const auto ahat = a01*safeInv(a01mag);
   const auto a0p = p - a0;
   const auto ptest = a0p.dot(ahat);
-  return a0 + ptest*ahat;
+  return a0 + std::max(0.0, std::min(a01mag,ptest))*ahat;
 }
 
 // This version returns true if the closest point forms a right angle between
@@ -44,7 +44,7 @@ closestPointOnSegment(const Vector& p,
   const auto ahat = a01*safeInv(a01mag);
   const auto a0p = p - a0;
   const auto ptest = a0p.dot(ahat);
-  result = a0 + ptest*ahat;
+  result = a0 + std::max(0.0, std::min(a01mag,ptest))*ahat;
   return (ptest >= 0.0 and ptest <= a01mag);
 }