ccore/test/modules/VectorTests.c

#include <math.h>

#include "../Tests.h"
#include "core/Vector.h"

static const float eps = 0.0001f;

#define V2 Vector2
#define CV2(a, b, c, d) (&(V2){{a, b}})
#define FV2(a, b) CV2(a, b, 0, 0)
#define CV20 CV2(0, 0, 0, 0)

#define V3 Vector3
#define CV3(a, b, c, d) (&(V3){{a, b, c}})
#define FV3(a, b, c) CV3(a, b, c, 0)
#define CV30 CV3(0, 0, 0, 0)

#define V4 Vector4
#define CV4(a, b, c, d) (&(V4){{a, b, c, d}})
#define CV40 CV4(0, 0, 0, 0)

#define IV2 IntVector2
#define CIV2(a, b, c, d) (&(IV2){{a, b}})
#define FIV2(a, b) CIV2(a, b, 0, 0)
#define CIV20 CIV2(0, 0, 0, 0)

#define IV3 IntVector3
#define CIV3(a, b, c, d) (&(IV3){{a, b, c}})
#define FIV3(a, b, c) CIV3(a, b, c, 0)
#define CIV30 CIV3(0, 0, 0, 0)

#define IV4 IntVector4
#define CIV4(a, b, c, d) (&(IV4){{a, b, c, d}})
#define CIV40 CIV4(0, 0, 0, 0)

#define TESTS X(V2) X(V3) X(V4) X(IV2) X(IV3) X(IV4)

static void testSetAngles() {
    float root = sqrtf(2) * 0.5f;
    TEST_V3(FV3(1, 0, 0), angles(CV30, 0, 0));
    TEST_V3(FV3(root, 0, -root), angles(CV30, 45, 0));
    TEST_V3(FV3(0, 0, -1), angles(CV30, 90, 0));
    TEST_V3(FV3(-root, 0, -root), angles(CV30, 135, 0));
    TEST_V3(FV3(-1, 0, 0), angles(CV30, 180, 0));
    TEST_V3(FV3(-root, 0, root), angles(CV30, 225, 0));
    TEST_V3(FV3(0, 0, 1), angles(CV30, 270, 0));
    TEST_V3(FV3(root, 0, root), angles(CV30, 315, 0));

    TEST_V3(FV3(0, 1, 0), angles(CV30, 0, 90));
    TEST_V3(FV3(0, 1, 0), angles(CV30, 90, 90));
    TEST_V3(FV3(0, 1, 0), angles(CV30, 180, 90));
    TEST_V3(FV3(0, 1, 0), angles(CV30, 270, 90));

    TEST_V3(FV3(0, -1, 0), angles(CV30, 0, -90));
    TEST_V3(FV3(0, -1, 0), angles(CV30, 90, -90));
    TEST_V3(FV3(0, -1, 0), angles(CV30, 180, -90));
    TEST_V3(FV3(0, -1, 0), angles(CV30, 270, -90));

    TEST_V3(FV3(root, root, 0), angles(CV30, 0, 45));
    TEST_V3(FV3(0, root, -root), angles(CV30, 90, 45));
    TEST_V3(FV3(-root, root, 0), angles(CV30, 180, 45));
    TEST_V3(FV3(0, root, root), angles(CV30, 270, 45));

    TEST_V3(FV3(root, -root, 0), angles(CV30, 0, -45));
    TEST_V3(FV3(0, -root, -root), angles(CV30, 90, -45));
    TEST_V3(FV3(-root, -root, 0), angles(CV30, 180, -45));
    TEST_V3(FV3(0, -root, root), angles(CV30, 270, -45));

    TEST_V3(FV3(0.5f, root, -0.5f), angles(CV30, 45, 45));
}

static void testCross() {
    TEST_V3(FV3(0, 0, 1), cross(CV30, FV3(1, 0, 0), FV3(0, 1, 0)));
    TEST_V3(FV3(0, -1, 0), cross(CV30, FV3(1, 0, 0), FV3(0, 0, 1)));
    TEST_V3(FV3(0, 0, -1), cross(CV30, FV3(0, 1, 0), FV3(1, 0, 0)));
    TEST_V3(FV3(1, 0, 0), cross(CV30, FV3(0, 1, 0), FV3(0, 0, 1)));
    TEST_V3(FV3(0, 1, 0), cross(CV30, FV3(0, 0, 1), FV3(1, 0, 0)));
    TEST_V3(FV3(-1, 0, 0), cross(CV30, FV3(0, 0, 1), FV3(0, 1, 0)));
}

static void testSetAdd() {
#define X(T)                                                                   \
    {                                                                          \
        T v = *C##T(0, 0, 0, 0);                                               \
        addSet##T(&v, C##T(1, 2, 3, 4));                                       \
        TEST_##T(C##T(1, 2, 3, 4), &v);                                        \
        addSet##T(&v, C##T(2, 3, 4, 5));                                       \
        TEST_##T(C##T(3, 5, 7, 9), &v);                                        \
    }
    TESTS
#undef X
}

static void testAdd() {
    TEST_V3(FV3(1, 2, 3), addV3(CV30, CV30, FV3(1, 2, 3)));
    TEST_V3(FV3(3, 5, 7), addV3(CV30, FV3(1, 2, 3), FV3(2, 3, 4)));
}

static void testSetSub() {
#define X(T)                                                                   \
    {                                                                          \
        T v = *C##T(0, 0, 0, 0);                                               \
        subSet##T(&v, C##T(1, 2, 3, 4));                                       \
        TEST_##T(C##T(-1, -2, -3, -4), &v);                                    \
        subSet##T(&v, C##T(2, 3, 4, 5));                                       \
        TEST_##T(C##T(-3, -5, -7, -9), &v);                                    \
    }
    TESTS
#undef X
}

static void testSub() {
    TEST_V3(FV3(1, 2, 3), subV3(CV30, CV30, FV3(-1, -2, -3)));
    TEST_V3(FV3(-1, -1, -1), subV3(CV30, FV3(1, 2, 3), FV3(2, 3, 4)));
}

static void testSetMul() {
#define X(T)                                                                   \
    {                                                                          \
        T v = *C##T(1, 2, 3, 4);                                               \
        mulSet##T##F(&v, 3);                                                   \
        TEST_##T(C##T(3, 6, 9, 12), &v);                                       \
        mulSet##T##F(&v, -2);                                                  \
        TEST_##T(C##T(-6, -12, -18, -24), &v);                                 \
    }
    TESTS
#undef X
}

static void testMul() {
    TEST_V3(FV3(3, 6, 9), mulV3F(CV30, FV3(1, 2, 3), 3));
}

static void testSetMulVector() {
#define X(T)                                                                   \
    {                                                                          \
        T v = *C##T(1, 2, 3, 4);                                               \
        mulSet##T(&v, C##T(2, 1, 3, 4));                                       \
        TEST_##T(C##T(2, 2, 9, 16), &v);                                       \
        mulSet##T(&v, C##T(-3, 4, -2, -2));                                    \
        TEST_##T(C##T(-6, 8, -18, -32), &v);                                   \
    }
    TESTS
#undef X
}

static void testMulVector() {
    TEST_V3(FV3(-2, -2, -9), mulV3(CV30, FV3(2, 1, 3), FV3(-1, -2, -3)));
    TEST_V3(FV3(2, 2, 9), mulV3(CV30, FV3(1, 2, 3), FV3(2, 1, 3)));
}

static void testSetDiv() {
#define X(T)                                                                   \
    {                                                                          \
        T v = *C##T(18, 36, 9, 27);                                            \
        divSet##T##F(&v, 3);                                                   \
        TEST_##T(C##T(6, 12, 3, 9), &v);                                       \
        divSet##T##F(&v, -3);                                                  \
        TEST_##T(C##T(-2, -4, -1, -3), &v);                                    \
    }
    TESTS
#undef X
}

static void testDiv() {
    TEST_V3(FV3(-1, -2, -3), divV3F(CV30, FV3(-3, -6, -9), 3));
}

static void testSetDivVector() {
#define X(T)                                                                   \
    {                                                                          \
        T v = *C##T(12, 4, 6, 8);                                              \
        divSet##T(&v, C##T(2, 1, 3, 4));                                       \
        TEST_##T(C##T(6, 4, 2, 2), &v);                                        \
        divSet##T(&v, C##T(-3, 4, -2, -1));                                    \
        TEST_##T(C##T(-2, 1, -1, -2), &v);                                     \
    }
    TESTS
#undef X
}

static void testDivVector() {
    TEST_V3(FV3(-2, -0.5f, -1), divV3(CV30, FV3(2, 1, 3), FV3(-1, -2, -3)));
    TEST_V3(FV3(0.5f, 2, 1), divV3(CV30, FV3(1, 2, 3), FV3(2, 1, 3)));
}

static void testSetInvert() {
    TEST_V2(FV2(-1, 2), invertSetV2(FV2(1, -2)));
    TEST_V3(FV3(-1, 2, 3), invertSetV3(FV3(1, -2, -3)));
    TEST_V4(CV4(-1, 2, 3, 4), invertSetV4(CV4(1, -2, -3, -4)));
    TEST_IV2(FIV2(-1, 2), invertSetIV2(FIV2(1, -2)));
    TEST_IV3(FIV3(-1, 2, 3), invertSetIV3(FIV3(1, -2, -3)));
    TEST_IV4(CIV4(-1, 2, 3, 4), invertSetIV4(CIV4(1, -2, -3, -4)));
}

static void testInvert() {
    TEST_V3(FV3(-1, 2, 3), invertV3(CV30, FV3(1, -2, -3)));
}

static void testDot() {
    TEST_FLOAT(0, dotV2(FV2(-4, 2), FV2(-1, -2)), eps);
    TEST_FLOAT(9, dotV3(FV3(-4, 2, -3), FV3(-1, -2, -3)), eps);
    TEST_FLOAT(16, dotV4(CV4(-4, 2, -3, 1), CV4(-1, -2, -3, 7)), eps);
}

static void testSquareLength() {
    TEST_FLOAT(20, squareLengthV2(FV2(-4, 2)), eps);
    TEST_FLOAT(29, squareLengthV3(FV3(-4, 2, -3)), eps);
    TEST_FLOAT(54, squareLengthV4(CV4(-4, 2, -3, 5)), eps);
}

static void testLength() {
    TEST_FLOAT(5, lengthV2(FV2(-3, 4)), eps);
    TEST_FLOAT(13, lengthV2(FV2(5, 12)), eps);
    TEST_FLOAT(3, lengthV3(FV3(-2, 2, -1)), eps);
    TEST_FLOAT(7, lengthV3(FV3(6, 2, -3)), eps);
    TEST_FLOAT(3, lengthV4(CV4(-2, 2, 0, -1)), eps);
    TEST_FLOAT(9, lengthV4(CV4(6, 0, -6, 3)), eps);
}

static void testNormalize() {
    {
        V2 v1 = {{-15, 20}};
        V2 v2;
        mulV2F(&v2, &v1, 1.0f / 25.0f);
        normalizeV2(&v1);
        TEST_V2(&v2, &v1);

        V2 v3 = {{15, 36}};
        V2 v4;
        mulV2F(&v4, &v3, 1.0f / 39.0f);
        normalizeV2(&v3);
        TEST_V2(&v4, &v3);
    }
    {
        V3 v1 = {{-2, 2, -1}};
        V3 v2;
        mulV3F(&v2, &v1, 1.0f / 3.0f);
        normalizeV3(&v1);
        TEST_V3(&v2, &v1);

        V3 v3 = {{6, 2, -3}};
        V3 v4;
        mulV3F(&v4, &v3, 1.0f / 7.0f);
        normalizeV3(&v3);
        TEST_V3(&v4, &v3);
    }
    {
        V4 v1 = {{-2, 2, 0, -1}};
        V4 v2;
        mulV4F(&v2, &v1, 1.0f / 3.0f);
        normalizeV4(&v1);
        TEST_V4(&v2, &v1);

        V4 v3 = {{6, 0, -6, 3}};
        V4 v4;
        mulV4F(&v4, &v3, 1.0f / 9.0f);
        normalizeV4(&v3);
        TEST_V4(&v4, &v3);
    }
}

static void testCast() {
    TEST_V2(FV2(-2.0f, 2.0f), convertIV2(CV20, FIV2(-2, 2)));
    TEST_IV2(FIV2(-2, 2), convertV2(CIV20, FV2(-2.5f, 2.6f)));
    TEST_V3(FV3(-2.0f, 2.0f, 9.0f), convertIV3(CV30, FIV3(-2, 2, 9)));
    TEST_IV3(FIV3(-2, 2, 9), convertV3(CIV30, FV3(-2.5f, 2.6f, 9.0f)));
    TEST_V4(CV4(-2.0f, 2.0f, 9.0f, 6.0f), convertIV4(CV40, CIV4(-2, 2, 9, 6)));
    TEST_IV4(CIV4(-2, 2, 9, 3), convertV4(CIV40, CV4(-2.5f, 2.6f, 9.0f, 3.2f)));
}

static void testToString() {
    char buffer[64];
    toStringV2(FV2(4, 5), buffer, sizeof(buffer));
    TEST_STRING("[4.000, 5.000]", buffer);
    toStringV3(FV3(4, 5, 6), buffer, sizeof(buffer));
    TEST_STRING("[4.000, 5.000, 6.000]", buffer);
    toStringV4(CV4(4, 5, 6, 7), buffer, sizeof(buffer));
    TEST_STRING("[4.000, 5.000, 6.000, 7.000]", buffer);
    toStringIV2(FIV2(4, 5), buffer, sizeof(buffer));
    TEST_STRING("[4, 5]", buffer);
    toStringIV3(FIV3(4, 5, 6), buffer, sizeof(buffer));
    TEST_STRING("[4, 5, 6]", buffer);
    toStringIV4(CIV4(4, 5, 6, 7), buffer, sizeof(buffer));
    TEST_STRING("[4, 5, 6, 7]", buffer);
}

void testVector() {
    testSetAngles();
    testCross();
    testSetAdd();
    testAdd();
    testSetSub();
    testSub();
    testSetMul();
    testMul();
    testSetMulVector();
    testMulVector();
    testSetDiv();
    testDiv();
    testSetDivVector();
    testDivVector();
    testSetInvert();
    testInvert();
    testDot();
    testSquareLength();
    testLength();
    testNormalize();
    testCast();
    testToString();
}