diff --git a/matrix/Quaternion.hpp b/matrix/Quaternion.hpp index b93b038936..db4eced28f 100644 --- a/matrix/Quaternion.hpp +++ b/matrix/Quaternion.hpp @@ -252,14 +252,14 @@ public: * @param q quaternion to multiply with * @return product */ - Quaternion operator*(const Quaternion &q) const + Quaternion operator*(const Quaternion &p) const { - const Quaternion &p = *this; + const Quaternion &q = *this; return { - p(0) * q(0) - p(1) * q(1) - p(2) * q(2) - p(3) * q(3), - p(0) * q(1) + p(1) * q(0) + p(2) * q(3) - p(3) * q(2), - p(0) * q(2) - p(1) * q(3) + p(2) * q(0) + p(3) * q(1), - p(0) * q(3) + p(1) * q(2) - p(2) * q(1) + p(3) * q(0)}; + q(0) * p(0) - q(1) * p(1) - q(2) * p(2) - q(3) * p(3), + q(1) * p(0) + q(0) * p(1) - q(3) * p(2) + q(2) * p(3), + q(2) * p(0) + q(3) * p(1) + q(0) * p(2) - q(1) * p(3), + q(3) * p(0) - q(2) * p(1) + q(1) * p(2) + q(0) * p(3) }; } /**