istereo

annotate libs/vmath/quat.inl @ 43:73813c1176de

find changesets by author, revision, files, or words in the commit message
better hgignore
author John Tsiombikas <nuclear@member.fsf.org>
date Fri, 14 Aug 2015 04:33:42 +0300
parents fb4c9641059f
children
rev   line source
nuclear@39 1 /*
nuclear@39 2 libvmath - a vector math library
nuclear@39 3 Copyright (C) 2004-2011 John Tsiombikas <nuclear@member.fsf.org>
nuclear@39 4
nuclear@39 5 This program is free software: you can redistribute it and/or modify
nuclear@39 6 it under the terms of the GNU Lesser General Public License as published
nuclear@39 7 by the Free Software Foundation, either version 3 of the License, or
nuclear@39 8 (at your option) any later version.
nuclear@39 9
nuclear@39 10 This program is distributed in the hope that it will be useful,
nuclear@39 11 but WITHOUT ANY WARRANTY; without even the implied warranty of
nuclear@39 12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
nuclear@39 13 GNU Lesser General Public License for more details.
nuclear@39 14
nuclear@39 15 You should have received a copy of the GNU Lesser General Public License
nuclear@39 16 along with this program. If not, see <http://www.gnu.org/licenses/>.
nuclear@39 17 */
nuclear@39 18
nuclear@29 19 #include "vector.h"
nuclear@29 20 #include "matrix.h"
nuclear@29 21
nuclear@29 22 #ifdef __cplusplus
nuclear@29 23 extern "C" {
nuclear@29 24 #endif /* __cplusplus */
nuclear@29 25
nuclear@29 26 static inline quat_t quat_mul(quat_t q1, quat_t q2)
nuclear@29 27 {
nuclear@29 28 quat_t res;
nuclear@29 29 vec3_t v1 = quat_vec(q1);
nuclear@29 30 vec3_t v2 = quat_vec(q2);
nuclear@29 31
nuclear@29 32 res.w = q1.w * q2.w - v3_dot(v1, v2);
nuclear@29 33 /* resvec = v2 * q1 + v1 * q2 + cross(v1, v2) */
nuclear@29 34 res.x = v2.x * q1.w + v1.x * q2.w + (v1.y * v2.z - v1.z * v2.y);
nuclear@29 35 res.y = v2.y * q1.w + v1.y * q2.w + (v1.z * v2.x - v1.x * v2.z);
nuclear@29 36 res.z = v2.z * q1.w + v1.z * q2.w + (v1.x * v2.y - v1.y * v2.x);
nuclear@29 37 return res;
nuclear@29 38 }
nuclear@29 39
nuclear@29 40 static inline quat_t quat_conjugate(quat_t q)
nuclear@29 41 {
nuclear@29 42 q.x = -q.x;
nuclear@29 43 q.y = -q.y;
nuclear@29 44 q.z = -q.z;
nuclear@29 45 return q;
nuclear@29 46 }
nuclear@29 47
nuclear@29 48 static inline quat_t quat_inverse(quat_t q)
nuclear@29 49 {
nuclear@29 50 scalar_t lensq = quat_length_sq(q);
nuclear@29 51 q = quat_conjugate(q);
nuclear@29 52 q.x /= lensq;
nuclear@29 53 q.y /= lensq;
nuclear@29 54 q.z /= lensq;
nuclear@29 55 q.w /= lensq;
nuclear@29 56 return q;
nuclear@29 57 }
nuclear@29 58
nuclear@29 59 static inline void quat_to_mat3(mat3_t res, quat_t q)
nuclear@29 60 {
nuclear@29 61 m3_cons(res, 1.0 - 2.0 * q.y*q.y - 2.0 * q.z*q.z, 2.0 * q.x * q.y + 2.0 * q.w * q.z, 2.0 * q.z * q.x - 2.0 * q.w * q.y,
nuclear@29 62 2.0 * q.x * q.y - 2.0 * q.w * q.z, 1.0 - 2.0 * q.x*q.x - 2.0 * q.z*q.z, 2.0 * q.y * q.z + 2.0 * q.w * q.x,
nuclear@29 63 2.0 * q.z * q.x + 2.0 * q.w * q.y, 2.0 * q.y * q.z - 2.0 * q.w * q.x, 1.0 - 2.0 * q.x*q.x - 2.0 * q.y*q.y);
nuclear@29 64 }
nuclear@29 65
nuclear@29 66 static inline void quat_to_mat4(mat4_t res, quat_t q)
nuclear@29 67 {
nuclear@29 68 m4_cons(res, 1.0 - 2.0 * q.y*q.y - 2.0 * q.z*q.z, 2.0 * q.x * q.y + 2.0 * q.w * q.z, 2.0 * q.z * q.x - 2.0 * q.w * q.y, 0,
nuclear@29 69 2.0 * q.x * q.y - 2.0 * q.w * q.z, 1.0 - 2.0 * q.x*q.x - 2.0 * q.z*q.z, 2.0 * q.y * q.z + 2.0 * q.w * q.x, 0,
nuclear@29 70 2.0 * q.z * q.x + 2.0 * q.w * q.y, 2.0 * q.y * q.z - 2.0 * q.w * q.x, 1.0 - 2.0 * q.x*q.x - 2.0 * q.y*q.y, 0,
nuclear@29 71 0, 0, 0, 1);
nuclear@29 72 }
nuclear@29 73
nuclear@29 74 #ifdef __cplusplus
nuclear@29 75 } /* extern "C" */
nuclear@29 76
nuclear@29 77 inline Quaternion lerp(const Quaternion &a, const Quaternion &b, scalar_t t)
nuclear@29 78 {
nuclear@29 79 return slerp(a, b, t);
nuclear@29 80 }
nuclear@29 81 #endif /* __cplusplus */