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

Add rotate(quat,vector,quat)

Browse source
This commit is contained in:
Nikita Lisitsa 2021-12-27 15:14:23 +03:00
parent 36854905fc
commit 64b3e876ad
1 changed files with 7 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

7
libs/geom/include/psemek/geom/quaternion.hpp
View file

@ -184,6 +184,13 @@ namespace psemek::geom
return {res[0], res[1], res[2]}; return {res[0], res[1], res[2]};
} }
template <typename T>
vector<T, 3> rotate(quaternion<T> const & q1, vector<T, 3> const & v, quaternion<T> const & q2)
{
auto res = q1 * quaternion<T>::vector(v) * conjugate(q2);
return {res[0], res[1], res[2]};
}
template <typename T> template <typename T>
T angle(quaternion<T> const & q0, quaternion<T> const & q1) T angle(quaternion<T> const & q0, quaternion<T> const & q1)
{ {