#include "./quaternion_copy.h"

#include <math.h>

#include "./../../helpers.h"

// ==================== FP32 ==================== //

static const int _TEST_FP32_QUATERNION_AMOUNT = 4;
static const BgcQuaternionFP32 _TEST_FP32_QUATERNION_LIST[] = {
    { 1.0f, 2.0f, 3.0f, 4.0f },
    { -4.0f, -3.0f, -2.0f, -1.0f },
    { -0.001f, 100.0f, -100.0f, 0.001f },
    { 0.001f, -100.0f, 100.0f, -0.001f }
};

int test_quaternion_copy_fp32()
{
    BgcQuaternionFP32 vector;

    print_testing_name("bgc_quaternion_copy_fp32");

    for (int i = 0; i < _TEST_FP32_QUATERNION_AMOUNT; i++) {
        
        bgc_quaternion_copy_fp32(&_TEST_FP32_QUATERNION_LIST[i], &vector);

        if (vector.s0 != _TEST_FP32_QUATERNION_LIST[i].s0 ||
            vector.x1 != _TEST_FP32_QUATERNION_LIST[i].x1 ||
            vector.x2 != _TEST_FP32_QUATERNION_LIST[i].x2 ||
            vector.x3 != _TEST_FP32_QUATERNION_LIST[i].x3) {
            print_testing_failed();
            return TEST_FAILED;
        }
    }

    print_testing_success();

    return TEST_SUCCESS;
}

// ==================== FP64 ==================== //

static const int _TEST_FP64_QUATERNION_AMOUNT = 4;
static const BgcQuaternionFP64 _TEST_FP64_QUATERNION_LIST[] = {
    { 1.0, 2.0, 3.0, 4.0 },
    { -4.0, -3.0, -2.0, -1.0 },
    { -0.001, 100.0, -100.0, 0.001 },
    { 0.001, -100.0, 100.0, -0.001 }
};

int test_quaternion_copy_fp64()
{
    BgcQuaternionFP64 vector;

    print_testing_name("bgc_quaternion_copy_fp64");

    for (int i = 0; i < _TEST_FP64_QUATERNION_AMOUNT; i++) {

        bgc_quaternion_copy_fp64(&_TEST_FP64_QUATERNION_LIST[i], &vector);

        if (vector.s0 != _TEST_FP64_QUATERNION_LIST[i].s0 ||
            vector.x1 != _TEST_FP64_QUATERNION_LIST[i].x1 ||
            vector.x2 != _TEST_FP64_QUATERNION_LIST[i].x2 ||
            vector.x3 != _TEST_FP64_QUATERNION_LIST[i].x3) {
            print_testing_failed();
            return TEST_FAILED;
        }
    }

    print_testing_success();

    return TEST_SUCCESS;
}

int test_quaternion_copy()
{
    if (test_quaternion_copy_fp32() != TEST_SUCCESS) {
        return TEST_FAILED;
    }

    if (test_quaternion_copy_fp64() != TEST_SUCCESS) {
        return TEST_FAILED;
    }

    return TEST_SUCCESS;
}