From 1362bef50ff87ff520b55d1fe5503298b2f9c3ed Mon Sep 17 00:00:00 2001
From: Recep Aslantas <info@recp.me>
Date: Wed, 23 May 2018 23:13:41 +0300
Subject: [PATCH] fix glm_translate_to

---
 include/cglm/affine.h | 59 +++++++++++++------------------------------
 1 file changed, 17 insertions(+), 42 deletions(-)

diff --git a/include/cglm/affine.h b/include/cglm/affine.h
index e160bdb..e8f98bb 100644
--- a/include/cglm/affine.h
+++ b/include/cglm/affine.h
@@ -44,48 +44,6 @@ CGLM_INLINE
 void
 glm_mat4_mul(mat4 m1, mat4 m2, mat4 dest);
 
-/*!
- * @brief translate existing transform matrix by v vector
- *        and store result in dest
- *
- * @param[in]  m    affine transfrom
- * @param[in]  v    translate vector [x, y, z]
- * @param[out] dest translated matrix
- */
-CGLM_INLINE
-void
-glm_translate_to(mat4 m, vec3 v, mat4 dest) {
-  CGLM_ALIGN(16) mat4 t = GLM_MAT4_IDENTITY_INIT;
-
-#if defined( __SSE__ ) || defined( __SSE2__ )
-  glmm_store(dest[3],
-             _mm_add_ps(_mm_add_ps(_mm_mul_ps(glmm_load(t[0]),
-                                              _mm_set1_ps(v[0])),
-                                   _mm_mul_ps(glmm_load(t[1]),
-                                              _mm_set1_ps(v[1]))),
-                        _mm_add_ps(_mm_mul_ps(glmm_load(t[2]),
-                                              _mm_set1_ps(v[2])),
-                                   glmm_load(t[3]))))
-  ;
-
-  glmm_store(dest[0], glmm_load(m[0]));
-  glmm_store(dest[1], glmm_load(m[1]));
-  glmm_store(dest[2], glmm_load(m[2]));
-#else
-  vec4 v1, v2, v3;
-
-  glm_vec4_scale(t[0], v[0], v1);
-  glm_vec4_scale(t[1], v[1], v2);
-  glm_vec4_scale(t[2], v[2], v3);
-
-  glm_vec4_add(v1, t[3], t[3]);
-  glm_vec4_add(v2, t[3], t[3]);
-  glm_vec4_add(v3, t[3], t[3]);
-
-  glm_mat4_copy(t, dest);
-#endif
-}
-
 /*!
  * @brief translate existing transform matrix by v vector
  *        and stores result in same matrix
@@ -119,6 +77,23 @@ glm_translate(mat4 m, vec3 v) {
 #endif
 }
 
+/*!
+ * @brief translate existing transform matrix by v vector
+ *        and store result in dest
+ *
+ * source matrix will remain same
+ *
+ * @param[in]  m    affine transfrom
+ * @param[in]  v    translate vector [x, y, z]
+ * @param[out] dest translated matrix
+ */
+CGLM_INLINE
+void
+glm_translate_to(mat4 m, vec3 v, mat4 dest) {
+  glm_mat4_copy(m, dest);
+  glm_translate(dest, v);
+}
+
 /*!
  * @brief translate existing transform matrix by x factor
  *