Geometry.h

Go to the documentation of this file.

// SPDX-License-Identifier: LGPL-2.1-or-later OR GPL-2.0-or-later OR GPL-3.0-or-later OR LicenseRef-ACF-Commercial
#pragma once
 
 
// ACF includes
#include <i3d/CVector3d.h>
#include <i3d/CPlane3d.h>
#include <i3d/CLine3d.h>
 
 
namespace i3d
{
 
 
namespace Geometry
{
 
 
inline double GetAngleBetweenVectors(const CVector3d& v1, const CVector3d& v2)
{
       double dot = v1.GetNormalized().GetDotProduct(v2.GetNormalized());
       // Clamp to avoid numerical issues with acos
       dot = qMax(-1.0, qMin(1.0, dot));
       return qAcos(dot);
}
 
 
inline double GetSignedAngleBetweenVectors(const CVector3d& v1, const CVector3d& v2, const CVector3d& axis)
{
       CVector3d n1 = v1.GetNormalized();
       CVector3d n2 = v2.GetNormalized();
       
       double angle = GetAngleBetweenVectors(n1, n2);
       
       // Determine sign using cross product
       CVector3d cross = n1.GetCrossProduct(n2);
       if (cross.GetDotProduct(axis) < 0.0){
              angle = -angle;
       }
       
       return angle;
}
 
 
inline double GetDistance(const CVector3d& p1, const CVector3d& p2)
{
       return (p2 - p1).GetLength();
}
 
 
inline double GetDistanceSq(const CVector3d& p1, const CVector3d& p2)
{
       return (p2 - p1).GetLength2();
}
 
 
inline double GetDistance(const CVector3d& point, const CPlane3d& plane)
{
       return plane.GetDistance(point);
}
 
 
inline double GetDistance(const CVector3d& point, const CLine3d& line)
{
       return line.GetDistance(point);
}
 
 
bool AreIntersecting(const CLine3d& line1, const CLine3d& line2, double tolerance = I_BIG_EPSILON);
 
 
bool GetIntersection(const CLine3d& line, const CPlane3d& plane, CVector3d& result, double tolerance = I_BIG_EPSILON);
 
 
double GetClosestPoints(const CLine3d& line1, const CLine3d& line2, CVector3d& point1, CVector3d& point2);
 
 
inline bool IsOnPositiveSide(const CVector3d& point, const CPlane3d& plane)
{
       return plane.GetSignedDistance(point) >= 0.0;
}
 
 
inline CVector3d ProjectVectorOntoVector(const CVector3d& vector, const CVector3d& onto)
{
       double ontoLengthSq = onto.GetLength2();
       if (ontoLengthSq < I_BIG_EPSILON){
              return CVector3d(0.0, 0.0, 0.0);
       }
       
       double projection = vector.GetDotProduct(onto) / ontoLengthSq;
       return onto * projection;
}
 
 
bool GetBarycentricCoordinates(
       const CVector3d& point,
       const CVector3d& p1,
       const CVector3d& p2,
       const CVector3d& p3,
       double& u,
       double& v,
       double& w);
 
 
bool IsPointInTriangle(
       const CVector3d& point,
       const CVector3d& p1,
       const CVector3d& p2,
       const CVector3d& p3);
 
 
inline CVector3d GetTriangleNormal(const CVector3d& p1, const CVector3d& p2, const CVector3d& p3)
{
       CVector3d edge1 = p2 - p1;
       CVector3d edge2 = p3 - p1;
       return edge1.GetCrossProduct(edge2).GetNormalized();
}
 
 
inline double GetTriangleArea(const CVector3d& p1, const CVector3d& p2, const CVector3d& p3)
{
       CVector3d edge1 = p2 - p1;
       CVector3d edge2 = p3 - p1;
       return edge1.GetCrossProduct(edge2).GetLength() * 0.5;
}
 
 
} // namespace Geometry
 
 
} // namespace i3d