kindred/create
1
1
Fork 0
Code Issues 53 Pull Requests Actions Packages Projects 9 Releases 2 Wiki Activity

Base: fix IsNormal() and IsParallel()

Browse Source 
Fix the IsNormal() and IsParallel() methods to pass the unit tests
This commit is contained in:
wmayer
2024-02-09 17:25:42 +01:00
committed by Chris Hennes
parent 5368465ec1
commit b03ed3b42e
2 changed files with 20 additions and 13 deletions
Download Patch File Download Diff File Expand all files Collapse all files

27
src/Base/Vector3D.cpp
View File

@@ -25,6 +25,7 @@
#include <cmath>
#include <limits>
#include <boost/math/special_functions/fpclassify.hpp>
#include "Vector3D.h"
#include "Tools.h"
@@ -228,22 +229,26 @@ bool Vector3<float_type>::IsEqual(const Vector3<float_type>& rclPnt, float_type
}
template<class float_type>
bool Vector3<float_type>::IsParallel(const Vector3<float_type>& rclPnt, float_type tol) const
bool Vector3<float_type>::IsParallel(const Vector3<float_type>& rclDir, float_type tol) const
{
Vector3<float_type> v1 = *this;
Vector3<float_type> v2 = rclPnt;
double dot = abs(v1 * v2);
double mag = v1.Length() * v2.Length();
return (abs(dot - mag) < tol);
float_type angle = GetAngle(rclDir);
if (boost::math::isnan(angle)) {
return false;
}
return angle <= tol || traits_type::pi() - angle <= tol;
}
template<class float_type>
bool Vector3<float_type>::IsNormal(const Vector3<float_type>& rclPnt, float_type tol) const
bool Vector3<float_type>::IsNormal(const Vector3<float_type>& rclDir, float_type tol) const
{
Vector3<float_type> v1 = *this;
Vector3<float_type> v2 = rclPnt;
double dot = abs(v1 * v2);
return (dot < tol);
float_type angle = GetAngle(rclDir);
if (boost::math::isnan(angle)) {
return false;
}
float_type diff = std::abs(traits_type::pi() / 2.0 - angle); // NOLINT
return diff <= tol;
}
template<class float_type>