#include "mons_math/vec3.h"
#include "mons_math/vec4.h"
#include "mons_math/util.h"
#include "test.h"

int main(void) {
    mons_vec4 a = {2.0, 3.0, 4.0, 5.0};
    mons_vec4 b = {6.0, 5.0, 4.0, 3.0};

    // Add
    mons_vec4 sum = mons_vec4_add(a, b);
    ASSERT(mons_vec4_equal(sum, (mons_vec4){8.0, 8.0, 8.0, 8.0}));
    
    // Add in Place
    mons_vec4_add_inplace(&a, b);
    ASSERT(mons_vec4_equal(a, sum));

    // Subtract
    mons_vec4 diff = mons_vec4_sub(sum, b);
    ASSERT(mons_vec4_equal(diff, (mons_vec4){2.0, 3.0, 4.0, 5.0}));

    // Subtract in Place
    mons_vec4_sub_inplace(&a, b);
    ASSERT(mons_vec4_equal(diff, a));

    // Multiply (float)
    mons_vec4 product_f = mons_vec4_mul_f(a, -3.0);
    ASSERT(mons_vec4_equal(product_f, (mons_vec4){-6.0, -9.0, -12.0, -15.0}))
    
    // Multiply in Place (float)
    mons_vec4_mul_f_inplace(&a, 3.0);
    ASSERT(mons_vec4_equal(mons_vec4_negate(product_f), a))

    // Divide (float)
    mons_vec4 quotient_f = mons_vec4_div_f(product_f, 3.0);
    mons_vec4_negate_inplace(&quotient_f);
    ASSERT(mons_vec4_equal(quotient_f, (mons_vec4){2.0, 3.0, 4.0, 5.0}));

    // Divide in Place (float)
    mons_vec4_div_f_inplace(&a, 3.0);
    ASSERT(mons_vec4_equal(quotient_f, a));

    // Multiply (int)
    mons_vec4 product_i = mons_vec4_mul_i(a, -3);
    ASSERT(mons_vec4_equal(product_i, (mons_vec4){-6.0, -9.0, -12.0, -15.0}))
    
    // Multiply in Place (int)
    mons_vec4_mul_i_inplace(&a, 3);
    ASSERT(mons_vec4_equal(mons_vec4_negate(product_i), a))

    // Divide (int)
    mons_vec4 quotient_i = mons_vec4_div_i(product_i, 3);
    mons_vec4_negate_inplace(&quotient_i);
    ASSERT(mons_vec4_equal(quotient_i, (mons_vec4){2.0, 3.0, 4.0, 5.0}));

    // Divide in Place (int)
    mons_vec4_div_i_inplace(&a, 3);
    ASSERT(mons_vec4_equal(quotient_i, a));

    // Get Length
    float a_len = mons_vec4_len(a);
    ASSERT(mons_float_approx_equal(a_len, 7.34846));

    // Dot Product
    float dot = mons_vec4_dot(a, b);
    ASSERT(mons_float_approx_equal(dot, 58.0));

    // Truncate
    mons_vec3 truncated = mons_vec4_truncate(a);
    ASSERT(mons_vec3_equal(truncated, (mons_vec3){a.x, a.y, a.z}));

    // Normalize
    mons_vec4 normalized = mons_vec4_normalize(a);
    ASSERT(mons_float_approx_equal(mons_vec4_len(normalized), 1.0));

    // Normalize in Place
    mons_vec4_normalize_inplace(&a);
    ASSERT(mons_float_approx_equal(mons_vec4_len(a), 1.0));

    return EXIT_SUCCESS;
}