diff --git a/libs/geom/include/psemek/geom/vector.hpp b/libs/geom/include/psemek/geom/vector.hpp index ce12dac5..aaf0b282 100644 --- a/libs/geom/include/psemek/geom/vector.hpp +++ b/libs/geom/include/psemek/geom/vector.hpp @@ -314,6 +314,12 @@ namespace psemek::geom return std::atan2(v[1], v[0]); } + template + T angle(vector const & v0, vector const & v1) + { + return std::acos(std::max(T{-1}, std::min(T{1}, dot(v0, v1)))); + } + template vector pointwise_mult(vector const & v0, vector const & v1) {