diff options
Diffstat (limited to 'include/cglm/mat2x3.h')
| -rw-r--r-- | include/cglm/mat2x3.h | 154 |
1 files changed, 154 insertions, 0 deletions
diff --git a/include/cglm/mat2x3.h b/include/cglm/mat2x3.h new file mode 100644 index 0000000..0bb8d70 --- /dev/null +++ b/include/cglm/mat2x3.h @@ -0,0 +1,154 @@ +/* + * Copyright (c), Recep Aslantas. + * + * MIT License (MIT), http://opensource.org/licenses/MIT + * Full license can be found in the LICENSE file + */ + +/* + Macros: + GLM_MAT2X3_ZERO_INIT + GLM_MAT2X3_ZERO + + Functions: + CGLM_INLINE void glm_mat2x3_copy(mat2x3 src, mat2x3 dest); + CGLM_INLINE void glm_mat2x3_zero(mat2x3 m); + CGLM_INLINE void glm_mat2x3_make(const float * __restrict src, mat2x3 dest); + CGLM_INLINE void glm_mat2x3_mul(mat2x3 m1, mat3x2 m2, mat3 dest); + CGLM_INLINE void glm_mat2x3_mulv(mat2x3 m, vec2 v, vec3 dest); + CGLM_INLINE void glm_mat2x3_transpose(mat2x3 src, mat3x2 dest); + CGLM_INLINE void glm_mat2x3_scale(mat2x3 m, float s); + */ + +#ifndef cglm_mat2x3_h +#define cglm_mat2x3_h + +#include "common.h" + +#define GLM_MAT2X3_ZERO_INIT {{0.0f, 0.0f, 0.0f}, {0.0f, 0.0f, 0.0f}} + +/* for C only */ +#define GLM_MAT2X3_ZERO GLM_MAT2X3_ZERO_INIT + +/*! + * @brief Copy mat2x3 (src) to mat2x3 (dest). + * + * @param[in] src mat2x3 (left) + * @param[out] dest destination (result, mat2x3) + */ +CGLM_INLINE +void +glm_mat2x3_copy(mat2x3 src, mat2x3 dest) { + glm_vec3_copy(src[0], dest[0]); + glm_vec3_copy(src[1], dest[1]); +} + +/*! + * @brief Zero out the mat2x3 (m). + * + * @param[in, out] mat2x3 (src, dest) + */ +CGLM_INLINE +void +glm_mat2x3_zero(mat2x3 m) { + CGLM_ALIGN_MAT mat2x3 t = GLM_MAT2X3_ZERO_INIT; + glm_mat2x3_copy(t, m); +} + +/*! + * @brief Create mat2x3 (dest) from pointer (src). + * + * @param[in] src pointer to an array of floats (left) + * @param[out] dest destination (result, mat2x3) + */ +CGLM_INLINE +void +glm_mat2x3_make(const float * __restrict src, mat2x3 dest) { + dest[0][0] = src[0]; + dest[0][1] = src[1]; + dest[0][2] = src[2]; + + dest[1][0] = src[3]; + dest[1][1] = src[4]; + dest[1][2] = src[5]; +} + +/*! + * @brief Multiply mat2x3 (m1) by mat3x2 (m2) and store in mat3 (dest). + * + * @code + * glm_mat2x3_mul(mat2x3, mat3x2, mat3); + * @endcode + * + * @param[in] m1 mat2x3 (left) + * @param[in] m2 mat3x2 (right) + * @param[out] dest destination (result, mat3) + */ +CGLM_INLINE +void +glm_mat2x3_mul(mat2x3 m1, mat3x2 m2, mat3 dest) { + float a00 = m1[0][0], a01 = m1[0][1], a02 = m1[0][2], + a10 = m1[1][0], a11 = m1[1][1], a12 = m1[1][2], + + b00 = m2[0][0], b01 = m2[0][1], + b10 = m2[1][0], b11 = m2[1][1], + b20 = m2[2][0], b21 = m2[2][1]; + + dest[0][0] = a00 * b00 + a10 * b01; + dest[0][1] = a01 * b00 + a11 * b01; + dest[0][2] = a02 * b00 + a12 * b01; + + dest[1][0] = a00 * b10 + a10 * b11; + dest[1][1] = a01 * b10 + a11 * b11; + dest[1][2] = a02 * b10 + a12 * b11; + + dest[2][0] = a00 * b20 + a10 * b21; + dest[2][1] = a01 * b20 + a11 * b21; + dest[2][2] = a02 * b20 + a12 * b21; +} + +/*! + * @brief Multiply mat2x3 (m) by vec2 (v) and store in vec3 (dest). + * + * @param[in] m mat2x3 (left) + * @param[in] v vec2 (right, column vector) + * @param[out] dest destination (result, column vector) + */ +CGLM_INLINE +void +glm_mat2x3_mulv(mat2x3 m, vec2 v, vec3 dest) { + float v0 = v[0], v1 = v[1]; + + dest[0] = m[0][0] * v0 + m[1][0] * v1; + dest[1] = m[0][1] * v0 + m[1][1] * v1; + dest[2] = m[0][2] * v0 + m[1][2] * v1; +} + +/*! + * @brief Transpose mat2x3 (src) and store in mat3x2 (dest). + * + * @param[in] src mat2x3 (left) + * @param[out] dest destination (result, mat3x2) + */ +CGLM_INLINE +void +glm_mat2x3_transpose(mat2x3 src, mat3x2 dest) { + dest[0][0] = src[0][0]; dest[0][1] = src[1][0]; + dest[1][0] = src[0][1]; dest[1][1] = src[1][1]; + dest[2][0] = src[0][2]; dest[2][1] = src[1][2]; +} + +/*! + * @brief Multiply mat2x3 (m) by scalar constant (s). + * + * @param[in, out] m (src, dest) + * @param[in] float (scalar) + */ +CGLM_INLINE +void +glm_mat2x3_scale(mat2x3 m, float s) { + m[0][0] *= s; m[0][1] *= s; m[0][2] *= s; + m[1][0] *= s; m[1][1] *= s; m[1][2] *= s; +} + +#endif |
