/*
 * Copyright (c), Recep Aslantas.
 *
 * MIT License (MIT), http://opensource.org/licenses/MIT
 * Full license can be found in the LICENSE file
 */

#include "test_common.h"

void
test_vec3(void **state) {
  mat3 rot1m3;
  mat4 rot1;
  vec3 v, v1, v2;

  /* test zero */
  glm_vec_zero(v);
  test_assert_vec3_eq(GLM_VEC3_ZERO, v);

  /* test one */
  glm_vec_one(v);
  test_assert_vec3_eq(GLM_VEC3_ONE, v);

  /* adds, subs, div, divs, mul */
  glm_vec_add(v, GLM_VEC3_ONE, v);
  assert_true(glmc_vec_eq_eps(v, 2));

  glm_vec_adds(v, 10, v);
  assert_true(glmc_vec_eq_eps(v, 12));

  glm_vec_sub(v, GLM_VEC3_ONE, v);
  assert_true(glmc_vec_eq_eps(v, 11));

  glm_vec_subs(v, 1, v);
  assert_true(glmc_vec_eq_eps(v, 10));

  glm_vec_broadcast(2, v1);
  glm_vec_div(v, v1, v);
  assert_true(glmc_vec_eq_eps(v, 5));

  glm_vec_divs(v, 0.5, v);
  assert_true(glmc_vec_eq_eps(v, 10));

  glm_vec_mul(v, v1, v);
  assert_true(glmc_vec_eq_eps(v, 20));

  glm_vec_scale(v, 0.5, v);
  assert_true(glmc_vec_eq_eps(v, 10));

  glm_vec_normalize_to(v, v1);
  glm_vec_scale(v1, 0.8, v1);
  glm_vec_scale_as(v, 0.8, v);
  test_assert_vec3_eq(v1, v);

  /* addadd, subadd, muladd */
  glm_vec_one(v);

  glm_vec_addadd(GLM_VEC3_ONE, GLM_VEC3_ONE, v);
  assert_true(glmc_vec_eq_eps(v, 3));

  glm_vec_subadd(GLM_VEC3_ONE, GLM_VEC3_ZERO, v);
  assert_true(glmc_vec_eq_eps(v, 4));

  glm_vec_broadcast(2, v1);
  glm_vec_broadcast(3, v2);
  glm_vec_muladd(v1, v2, v);
  assert_true(glmc_vec_eq_eps(v, 10));

  /* rotate */
  glm_vec_copy(GLM_YUP, v);
  glm_rotate_make(rot1, glm_rad(90), GLM_XUP);
  glm_vec_rotate_m4(rot1, v, v1);
  glm_mat4_pick3(rot1, rot1m3);
  glm_vec_rotate_m3(rot1m3, v, v2);

  test_assert_vec3_eq(v1, v2);
  test_assert_vec3_eq(v1, GLM_ZUP);
}