nuclear@27: /* nuclear@27: libvmath - a vector math library nuclear@27: Copyright (C) 2004-2011 John Tsiombikas nuclear@27: nuclear@27: This program is free software: you can redistribute it and/or modify nuclear@27: it under the terms of the GNU Lesser General Public License as published nuclear@27: by the Free Software Foundation, either version 3 of the License, or nuclear@27: (at your option) any later version. nuclear@27: nuclear@27: This program is distributed in the hope that it will be useful, nuclear@27: but WITHOUT ANY WARRANTY; without even the implied warranty of nuclear@27: MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the nuclear@27: GNU Lesser General Public License for more details. nuclear@27: nuclear@27: You should have received a copy of the GNU Lesser General Public License nuclear@27: along with this program. If not, see . nuclear@27: */ nuclear@27: nuclear@27: #ifndef VMATH_QUATERNION_H_ nuclear@27: #define VMATH_QUATERNION_H_ nuclear@27: nuclear@27: #include nuclear@27: #include "vmath_types.h" nuclear@27: #include "vector.h" nuclear@27: nuclear@27: #ifdef __cplusplus nuclear@27: extern "C" { nuclear@27: #endif /* __cplusplus */ nuclear@27: nuclear@27: #define quat_cons(s, x, y, z) v4_cons(x, y, z, s) nuclear@27: #define quat_vec(q) v3_cons((q).x, (q).y, (q).z) nuclear@27: #define quat_s(q) ((q).w) nuclear@27: #define quat_identity() quat_cons(1.0, 0.0, 0.0, 0.0) nuclear@27: void quat_print(FILE *fp, quat_t q); nuclear@27: nuclear@27: #define quat_add v4_add nuclear@27: #define quat_sub v4_sub nuclear@27: #define quat_neg v4_neg nuclear@27: nuclear@28: static VMATH_INLINE quat_t quat_mul(quat_t q1, quat_t q2); nuclear@27: nuclear@28: static VMATH_INLINE quat_t quat_conjugate(quat_t q); nuclear@27: nuclear@27: #define quat_length v4_length nuclear@27: #define quat_length_sq v4_length_sq nuclear@27: nuclear@27: #define quat_normalize v4_normalize nuclear@28: static VMATH_INLINE quat_t quat_inverse(quat_t q); nuclear@27: nuclear@27: quat_t quat_rotate(quat_t q, scalar_t angle, scalar_t x, scalar_t y, scalar_t z); nuclear@27: quat_t quat_rotate_quat(quat_t q, quat_t rotq); nuclear@27: nuclear@28: static VMATH_INLINE void quat_to_mat3(mat3_t res, quat_t q); nuclear@28: static VMATH_INLINE void quat_to_mat4(mat4_t res, quat_t q); nuclear@27: nuclear@27: #define quat_lerp quat_slerp nuclear@27: quat_t quat_slerp(quat_t q1, quat_t q2, scalar_t t); nuclear@27: nuclear@27: nuclear@27: #ifdef __cplusplus nuclear@27: } /* extern "C" */ nuclear@27: nuclear@27: #include nuclear@27: nuclear@27: /* Quaternion */ nuclear@27: class Quaternion { nuclear@27: public: nuclear@27: scalar_t s; nuclear@27: Vector3 v; nuclear@27: nuclear@27: Quaternion(); nuclear@27: Quaternion(scalar_t s, const Vector3 &v); nuclear@27: Quaternion(scalar_t s, scalar_t x, scalar_t y, scalar_t z); nuclear@27: Quaternion(const Vector3 &axis, scalar_t angle); nuclear@27: Quaternion(const quat_t &quat); nuclear@27: nuclear@27: Quaternion operator +(const Quaternion &quat) const; nuclear@27: Quaternion operator -(const Quaternion &quat) const; nuclear@27: Quaternion operator -() const; nuclear@27: Quaternion operator *(const Quaternion &quat) const; nuclear@27: nuclear@27: void operator +=(const Quaternion &quat); nuclear@27: void operator -=(const Quaternion &quat); nuclear@27: void operator *=(const Quaternion &quat); nuclear@27: nuclear@27: void reset_identity(); nuclear@27: nuclear@27: Quaternion conjugate() const; nuclear@27: nuclear@27: scalar_t length() const; nuclear@27: scalar_t length_sq() const; nuclear@27: nuclear@27: void normalize(); nuclear@27: Quaternion normalized() const; nuclear@27: nuclear@27: Quaternion inverse() const; nuclear@27: nuclear@27: void set_rotation(const Vector3 &axis, scalar_t angle); nuclear@27: void rotate(const Vector3 &axis, scalar_t angle); nuclear@27: /* note: this is a totally different operation from the above nuclear@27: * this treats the quaternion as signifying direction and rotates nuclear@27: * it by a rotation quaternion by rot * q * rot' nuclear@27: */ nuclear@27: void rotate(const Quaternion &q); nuclear@27: nuclear@27: Matrix3x3 get_rotation_matrix() const; nuclear@27: }; nuclear@27: nuclear@27: Quaternion slerp(const Quaternion &q1, const Quaternion &q2, scalar_t t); nuclear@28: VMATH_INLINE Quaternion lerp(const Quaternion &q1, const Quaternion &q2, scalar_t t); nuclear@27: nuclear@27: std::ostream &operator <<(std::ostream &out, const Quaternion &q); nuclear@27: nuclear@27: #endif /* __cplusplus */ nuclear@27: nuclear@27: #include "quat.inl" nuclear@27: nuclear@27: #endif /* VMATH_QUATERNION_H_ */