105 lines
3 KiB
C
105 lines
3 KiB
C
#include "./versor_swap.h"
|
|
|
|
#include <math.h>
|
|
|
|
#include "./../../helpers.h"
|
|
|
|
// ==================== FP32 ==================== //
|
|
|
|
static const int _TEST_FP32_VERSOR_AMOUNT = 3;
|
|
|
|
static const BgcQuaternionFP32 _TEST_FP32_VERSOR_LIST1[] = {
|
|
{ 1.0f, 2.0f, 3.0f, 4.0f },
|
|
{ -4.0f, -3.0f, -2.0f, -1.0f },
|
|
{ 0.5f, -0.5f, -0.5f, -0.5f }
|
|
};
|
|
|
|
static const BgcQuaternionFP32 _TEST_FP32_VERSOR_LIST2[] = {
|
|
{ -0.5f, 0.5f, 0.5f, 0.5f },
|
|
{ -1.0f, -2.0f, -3.0f, -4.0f },
|
|
{ 4.0f, 3.0f, 2.0f, 1.0f }
|
|
};
|
|
|
|
void test_versor_swap_fp32()
|
|
{
|
|
BgcVersorFP32 versor1a, versor2a, versor1b, versor2b;
|
|
|
|
print_testing_name("bgc_versor_swap_fp32");
|
|
|
|
for (int i = 0; i < _TEST_FP32_VERSOR_AMOUNT; i++) {
|
|
bgc_versor_set_values_fp32(
|
|
_TEST_FP32_VERSOR_LIST1[i].s0,
|
|
_TEST_FP32_VERSOR_LIST1[i].x1,
|
|
_TEST_FP32_VERSOR_LIST1[i].x2,
|
|
_TEST_FP32_VERSOR_LIST1[i].x3,
|
|
&versor1a
|
|
);
|
|
|
|
bgc_versor_set_values_fp32(
|
|
_TEST_FP32_VERSOR_LIST2[i].s0,
|
|
_TEST_FP32_VERSOR_LIST2[i].x1,
|
|
_TEST_FP32_VERSOR_LIST2[i].x2,
|
|
_TEST_FP32_VERSOR_LIST2[i].x3,
|
|
&versor2a
|
|
);
|
|
|
|
bgc_versor_copy_fp32(&versor1a, &versor1b);
|
|
bgc_versor_copy_fp32(&versor2a, &versor2b);
|
|
|
|
bgc_versor_swap_fp32(&versor1b, &versor2b);
|
|
|
|
if (versor1a._s0 != versor2b._s0 || versor1a._x1 != versor2b._x1 || versor1a._x2 != versor2b._x2 || versor1a._x3 != versor2b._x3 ||
|
|
versor2a._s0 != versor1b._s0 || versor2a._x1 != versor1b._x1 || versor2a._x2 != versor1b._x2 || versor2a._x3 != versor1b._x3) {
|
|
print_testing_failed();
|
|
return;
|
|
}
|
|
}
|
|
|
|
print_testing_success();
|
|
}
|
|
|
|
// ==================== FP64 ==================== //
|
|
|
|
void test_versor_swap_fp64()
|
|
{
|
|
BgcVersorFP64 versor1a, versor2a, versor1b, versor2b;
|
|
|
|
print_testing_name("bgc_versor_swap_fp64");
|
|
|
|
for (int i = 0; i < _TEST_FP32_VERSOR_AMOUNT; i++) {
|
|
bgc_versor_set_values_fp64(
|
|
_TEST_FP32_VERSOR_LIST1[i].s0,
|
|
_TEST_FP32_VERSOR_LIST1[i].x1,
|
|
_TEST_FP32_VERSOR_LIST1[i].x2,
|
|
_TEST_FP32_VERSOR_LIST1[i].x3,
|
|
&versor1a
|
|
);
|
|
|
|
bgc_versor_set_values_fp64(
|
|
_TEST_FP32_VERSOR_LIST2[i].s0,
|
|
_TEST_FP32_VERSOR_LIST2[i].x1,
|
|
_TEST_FP32_VERSOR_LIST2[i].x2,
|
|
_TEST_FP32_VERSOR_LIST2[i].x3,
|
|
&versor2a
|
|
);
|
|
|
|
bgc_versor_copy_fp64(&versor1a, &versor1b);
|
|
bgc_versor_copy_fp64(&versor2a, &versor2b);
|
|
|
|
bgc_versor_swap_fp64(&versor1b, &versor2b);
|
|
|
|
if (versor1a._s0 != versor2b._s0 || versor1a._x1 != versor2b._x1 || versor1a._x2 != versor2b._x2 || versor1a._x3 != versor2b._x3 ||
|
|
versor2a._s0 != versor1b._s0 || versor2a._x1 != versor1b._x1 || versor2a._x2 != versor1b._x2 || versor2a._x3 != versor1b._x3) {
|
|
print_testing_failed();
|
|
return;
|
|
}
|
|
}
|
|
|
|
print_testing_success();
|
|
}
|
|
|
|
void test_versor_swap()
|
|
{
|
|
test_versor_swap_fp32();
|
|
test_versor_swap_fp64();
|
|
}
|