rev |
line source |
nuclear@28
|
1 #ifndef VMATH_QUATERNION_H_
|
nuclear@28
|
2 #define VMATH_QUATERNION_H_
|
nuclear@28
|
3
|
nuclear@28
|
4 #include <stdio.h>
|
nuclear@28
|
5 #include "vmath_types.h"
|
nuclear@28
|
6 #include "vector.h"
|
nuclear@28
|
7
|
nuclear@28
|
8 #ifdef __cplusplus
|
nuclear@28
|
9 extern "C" {
|
nuclear@28
|
10 #endif /* __cplusplus */
|
nuclear@28
|
11
|
nuclear@28
|
12 #define quat_cons(s, x, y, z) v4_cons(x, y, z, s)
|
nuclear@28
|
13 #define quat_vec(q) v3_cons((q).x, (q).y, (q).z)
|
nuclear@28
|
14 #define quat_s(q) ((q).w)
|
nuclear@28
|
15 #define quat_identity() quat_cons(1.0, 0.0, 0.0, 0.0)
|
nuclear@28
|
16 void quat_print(FILE *fp, quat_t q);
|
nuclear@28
|
17
|
nuclear@28
|
18 #define quat_add v4_add
|
nuclear@28
|
19 #define quat_sub v4_sub
|
nuclear@28
|
20 #define quat_neg v4_neg
|
nuclear@28
|
21
|
nuclear@28
|
22 static inline quat_t quat_mul(quat_t q1, quat_t q2);
|
nuclear@28
|
23
|
nuclear@28
|
24 static inline quat_t quat_conjugate(quat_t q);
|
nuclear@28
|
25
|
nuclear@28
|
26 #define quat_length v4_length
|
nuclear@28
|
27 #define quat_length_sq v4_length_sq
|
nuclear@28
|
28
|
nuclear@28
|
29 #define quat_normalize v4_normalize
|
nuclear@28
|
30 static inline quat_t quat_inverse(quat_t q);
|
nuclear@28
|
31
|
nuclear@28
|
32 quat_t quat_rotate(quat_t q, scalar_t angle, scalar_t x, scalar_t y, scalar_t z);
|
nuclear@28
|
33 quat_t quat_rotate_quat(quat_t q, quat_t rotq);
|
nuclear@28
|
34
|
nuclear@28
|
35 static inline void quat_to_mat3(mat3_t res, quat_t q);
|
nuclear@28
|
36 static inline void quat_to_mat4(mat4_t res, quat_t q);
|
nuclear@28
|
37
|
nuclear@28
|
38 #define quat_lerp quat_slerp
|
nuclear@28
|
39 quat_t quat_slerp(quat_t q1, quat_t q2, scalar_t t);
|
nuclear@28
|
40
|
nuclear@28
|
41
|
nuclear@28
|
42 #ifdef __cplusplus
|
nuclear@28
|
43 } /* extern "C" */
|
nuclear@28
|
44
|
nuclear@28
|
45 #include <iostream>
|
nuclear@28
|
46
|
nuclear@28
|
47 /* Quaternion */
|
nuclear@28
|
48 class Quaternion {
|
nuclear@28
|
49 public:
|
nuclear@28
|
50 scalar_t s;
|
nuclear@28
|
51 Vector3 v;
|
nuclear@28
|
52
|
nuclear@28
|
53 Quaternion();
|
nuclear@28
|
54 Quaternion(scalar_t s, const Vector3 &v);
|
nuclear@28
|
55 Quaternion(scalar_t s, scalar_t x, scalar_t y, scalar_t z);
|
nuclear@28
|
56 Quaternion(const Vector3 &axis, scalar_t angle);
|
nuclear@28
|
57 Quaternion(const quat_t &quat);
|
nuclear@28
|
58
|
nuclear@28
|
59 Quaternion operator +(const Quaternion &quat) const;
|
nuclear@28
|
60 Quaternion operator -(const Quaternion &quat) const;
|
nuclear@28
|
61 Quaternion operator -() const;
|
nuclear@28
|
62 Quaternion operator *(const Quaternion &quat) const;
|
nuclear@28
|
63
|
nuclear@28
|
64 void operator +=(const Quaternion &quat);
|
nuclear@28
|
65 void operator -=(const Quaternion &quat);
|
nuclear@28
|
66 void operator *=(const Quaternion &quat);
|
nuclear@28
|
67
|
nuclear@28
|
68 void reset_identity();
|
nuclear@28
|
69
|
nuclear@28
|
70 Quaternion conjugate() const;
|
nuclear@28
|
71
|
nuclear@28
|
72 scalar_t length() const;
|
nuclear@28
|
73 scalar_t length_sq() const;
|
nuclear@28
|
74
|
nuclear@28
|
75 void normalize();
|
nuclear@28
|
76 Quaternion normalized() const;
|
nuclear@28
|
77
|
nuclear@28
|
78 Quaternion inverse() const;
|
nuclear@28
|
79
|
nuclear@28
|
80 void set_rotation(const Vector3 &axis, scalar_t angle);
|
nuclear@28
|
81 void rotate(const Vector3 &axis, scalar_t angle);
|
nuclear@28
|
82 /* note: this is a totally different operation from the above
|
nuclear@28
|
83 * this treats the quaternion as signifying direction and rotates
|
nuclear@28
|
84 * it by a rotation quaternion by rot * q * rot'
|
nuclear@28
|
85 */
|
nuclear@28
|
86 void rotate(const Quaternion &q);
|
nuclear@28
|
87
|
nuclear@28
|
88 Matrix3x3 get_rotation_matrix() const;
|
nuclear@28
|
89
|
nuclear@28
|
90 friend Quaternion slerp(const Quaternion &q1, const Quaternion &q2, scalar_t t);
|
nuclear@28
|
91
|
nuclear@28
|
92 friend std::ostream &operator <<(std::ostream &out, const Quaternion &q);
|
nuclear@28
|
93 };
|
nuclear@28
|
94
|
nuclear@28
|
95 Quaternion slerp(const Quaternion &q1, const Quaternion &q2, scalar_t t);
|
nuclear@28
|
96 inline Quaternion lerp(const Quaternion &q1, const Quaternion &q2, scalar_t t);
|
nuclear@28
|
97 #endif /* __cplusplus */
|
nuclear@28
|
98
|
nuclear@28
|
99 #include "quat.inl"
|
nuclear@28
|
100
|
nuclear@28
|
101 #endif /* VMATH_QUATERNION_H_ */
|