85 lines
1.6 KiB
C
85 lines
1.6 KiB
C
#include <BH/Math/Line.h>
|
|
#include <BH/Unit.h>
|
|
|
|
|
|
#define ACCEPTABLE_DELTA 0.0001f
|
|
|
|
|
|
BH_UNIT_TEST(FromPoints)
|
|
{
|
|
float a[2], b[2], r[3];
|
|
|
|
a[0] = -8.0f; a[1] = 1.0f;
|
|
b[0] = -2.0f; b[1] = 3.0f;
|
|
|
|
BH_VERIFY(BH_LineFromPoints(a, b, r) == BH_OK);
|
|
BH_VERIFY_DELTA(r[0],-0.3162f, ACCEPTABLE_DELTA);
|
|
BH_VERIFY_DELTA(r[1], 0.9487f, ACCEPTABLE_DELTA);
|
|
BH_VERIFY_DELTA(r[2], 3.4785f, ACCEPTABLE_DELTA);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
BH_UNIT_TEST(Degenerate)
|
|
{
|
|
float a[2], b[2], r[3];
|
|
|
|
a[0] = -8.0f; a[1] = 1.0f;
|
|
b[0] = -8.0f; b[1] = 1.0f;
|
|
|
|
BH_VERIFY(BH_LineFromPoints(a, b, r) != BH_OK);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
BH_UNIT_TEST(Distance)
|
|
{
|
|
float a[2], b[2], r[3];
|
|
|
|
a[0] = -8.0f; a[1] = 1.0f;
|
|
b[0] = -2.0f; b[1] = 3.0f;
|
|
|
|
BH_VERIFY(BH_LineFromPoints(a, b, r) == BH_OK);
|
|
BH_VERIFY_DELTA(BH_LineDistance(r, a), 0.0000f, ACCEPTABLE_DELTA);
|
|
BH_VERIFY_DELTA(BH_LineDistance(r, b), 0.0000f, ACCEPTABLE_DELTA);
|
|
|
|
a[0] = -7.0f; a[1] = 4.0f;
|
|
BH_VERIFY_DELTA(BH_LineDistance(r, a), 2.5298f, ACCEPTABLE_DELTA);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
BH_UNIT_TEST(ClosestPoint)
|
|
{
|
|
float a[2], b[2], r[3];
|
|
|
|
a[0] = -8.0f; a[1] = 1.0f;
|
|
b[0] = -2.0f; b[1] = 3.0f;
|
|
|
|
BH_VERIFY(BH_LineFromPoints(a, b, r) == BH_OK);
|
|
|
|
a[0] = -7.0f; a[1] = 4.0f;
|
|
BH_LineClosestPoint(r, a, b);
|
|
BH_VERIFY_DELTA(b[0],-6.2000f, ACCEPTABLE_DELTA);
|
|
BH_VERIFY_DELTA(b[1], 1.6000f, ACCEPTABLE_DELTA);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
int main(int argc, char **argv)
|
|
{
|
|
(void)argc;
|
|
(void)argv;
|
|
|
|
BH_UNIT_ADD(FromPoints);
|
|
BH_UNIT_ADD(Degenerate);
|
|
BH_UNIT_ADD(Distance);
|
|
BH_UNIT_ADD(ClosestPoint);
|
|
|
|
return BH_UnitRun();
|
|
}
|