#include <BH/Math/Box3f.h>
#include <BH/Unit.h>


#define ACCEPTABLE_DELTA 0.0001f


BH_UNIT_TEST(Union)
{
    float aMin[3], aMax[3], bMin[3], bMax[3], rMin[3], rMax[3];

    aMin[0] = 1.0f; aMin[1] = 2.0f; aMin[2] = 3.0f;
    aMax[0] = 5.0f; aMax[1] = 5.0f; aMax[2] = 5.0f;
    bMin[0] = 0.0f; bMin[1] = 0.0f; bMin[2] = 0.0f;
    bMax[0] = 4.0f; bMax[1] = 4.0f; bMax[2] = 4.0f;

    BH_Box3fUnion(aMin, aMax, bMin, bMax, rMin, rMax);
    BH_VERIFY_DELTA(rMin[0], 0.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMin[1], 0.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMin[2], 0.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMax[0], 5.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMax[1], 5.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMax[2], 5.0000f,  ACCEPTABLE_DELTA);

    return 0;
}


BH_UNIT_TEST(Intersect)
{
    float aMin[3], aMax[3], bMin[3], bMax[3], rMin[3], rMax[3];

    aMin[0] = 1.0f; aMin[1] = 2.0f; aMin[2] = 3.0f;
    aMax[0] = 5.0f; aMax[1] = 5.0f; aMax[2] = 5.0f;
    bMin[0] = 0.0f; bMin[1] = 0.0f; bMin[2] = 0.0f;
    bMax[0] = 4.0f; bMax[1] = 4.0f; bMax[2] = 4.0f;

    BH_VERIFY(BH_Box3fIntersect(aMin, aMax, bMin, bMax, rMin, rMax) == BH_OK);
    BH_VERIFY_DELTA(rMin[0], 1.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMin[1], 2.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMin[2], 3.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMax[0], 4.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMax[1], 4.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMax[2], 4.0000f,  ACCEPTABLE_DELTA);

    return 0;
}


BH_UNIT_TEST(Contains)
{
    float aMin[3], aMax[3], point[3];

    aMin[0] = 1.0f; aMin[1] = 2.0f; aMin[2] = 3.0f;
    aMax[0] = 5.0f; aMax[1] = 5.0f; aMax[2] = 5.0f;

    point[0] = 0.0f; point[1] = 0.0f; point[2] = 0.0f;
    BH_VERIFY(BH_Box3fContains(aMin, aMax, point) != BH_OK);

    point[0] = 1.0f; point[1] = 2.0f; point[2] = 3.0f;
    BH_VERIFY(BH_Box3fContains(aMin, aMax, point) == BH_OK);

    point[0] = 4.0f; point[1] = 4.0f; point[2] = 4.0f;
    BH_VERIFY(BH_Box3fContains(aMin, aMax, point) == BH_OK);

    point[0] = 6.0f; point[1] = 6.0f; point[2] = 5.0f;
    BH_VERIFY(BH_Box3fContains(aMin, aMax, point) != BH_OK);

    return 0;
}


BH_UNIT_TEST(Enclose)
{
    float points[6], rMin[3], rMax[3];

    points[0] = 5.0f; points[1] = 5.0f; points[2] = 5.0f;
    points[3] = 1.0f; points[4] = 2.0f; points[5] = 3.0f;

    BH_VERIFY(BH_Box3fEnclose(NULL, 0, NULL, NULL) != BH_OK);
    BH_VERIFY(BH_Box3fEnclose(points, 2, rMin, rMax) == BH_OK);
    BH_VERIFY_DELTA(rMin[0], 1.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMin[1], 2.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMin[2], 3.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMax[0], 5.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMax[1], 5.0000f,  ACCEPTABLE_DELTA);
    BH_VERIFY_DELTA(rMax[2], 5.0000f,  ACCEPTABLE_DELTA);

    return 0;
}


int main(int argc, char **argv)
{
    (void)argc;
    (void)argv;

    BH_UNIT_ADD(Union);
    BH_UNIT_ADD(Intersect);
    BH_UNIT_ADD(Contains);
    BH_UNIT_ADD(Enclose);

    return BH_UnitRun();
}