Added quat_rotate

1 files changed, 8 insertions, 0 deletions

diff --git a/linmath.h b/linmath.h
index d5c4084..78937fa 100644
--- a/linmath.h
+++ b/linmath.h
@@ -491,6 +491,14 @@ static inline void quat_conj(quat r, quat q)
 		r[i] = -q[i];
 	r[3] = q[3];
 }
+static inline void quat_rotate(quat r, float angle, vec3 axis) {
+	vec3 v;
+	vec3_scale(v, axis, sinf(angle / 2));
+	int i;
+	for(i=0; i<3; ++i)
+		r[i] = v[i];
+	r[3] = cosf(angle / 2);
+}
 #define quat_norm vec4_norm
 static inline void quat_mul_vec3(vec3 r, quat q, vec3 v)
 {