lisyarus/psemek
1
0
Fork 1
Code Issues Pull requests 1 Projects Releases Packages Wiki Activity Actions

Fix geom::angle(vector,vector) for dimension > 2

Browse source
This commit is contained in:
Nikita Lisitsa 2022-07-05 18:32:12 +03:00
parent eb1e367085
commit d405d3d502
1 changed files with 7 additions and 1 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

8
libs/geom/include/psemek/geom/vector.hpp
View file

@ -328,10 +328,16 @@ namespace psemek::geom
return std::atan2(v[1], v[0]); return std::atan2(v[1], v[0]);
} }
template <typename T>
T angle(vector<T, 2> const & v0, vector<T, 2> const & v1)
{
return std::atan2(det(v0, v1), dot(v0, v1));
}
template <typename T, std::size_t N> template <typename T, std::size_t N>
T angle(vector<T, N> const & v0, vector<T, N> const & v1) T angle(vector<T, N> const & v0, vector<T, N> const & v1)
{ {
return std::atan2(det(v0, v1), dot(v0, v1)); return std::acos(std::min(T{1}, std::max(T{-1}, dot(v0, v1))));
} }
template <typename T> template <typename T>