diff --git a/libs/geom/include/psemek/geom/quaternion.hpp b/libs/geom/include/psemek/geom/quaternion.hpp index 606b72b3..f91d50e8 100644 --- a/libs/geom/include/psemek/geom/quaternion.hpp +++ b/libs/geom/include/psemek/geom/quaternion.hpp @@ -184,6 +184,13 @@ namespace psemek::geom return {res[0], res[1], res[2]}; } + template + vector rotate(quaternion const & q1, vector const & v, quaternion const & q2) + { + auto res = q1 * quaternion::vector(v) * conjugate(q2); + return {res[0], res[1], res[2]}; + } + template T angle(quaternion const & q0, quaternion const & q1) {