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

This commit is contained in:
Nikita Lisitsa 2022-07-05 18:32:12 +03:00
parent eb1e367085
commit d405d3d502

View file

@ -328,10 +328,16 @@ namespace psemek::geom
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>
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>