100 lines
2.7 KiB
C
100 lines
2.7 KiB
C
|
#include <BH/Math.h>
|
||
|
|
#include <BH/Unit.h>
|
||
|
|
|
||
|
|
|
||
|
|
#define ACCEPTABLE_DELTA 0.0001f
|
||
|
|
|
||
|
|
|
||
|
|
BH_UNIT_TEST(RayIntersectTriangle)
|
||
|
|
{
|
||
|
|
float a[3], b[3], c[3], p[3], d[3], out[3], t;
|
||
|
|
|
||
|
|
a[0] =-3.0000f; a[1] = 1.0000f; a[2] = 2.0000f;
|
||
|
|
b[0] =-5.0000f; b[1] =-2.0000f; b[2] = 0.0000f;
|
||
|
|
c[0] =-6.0000f; c[1] = 2.5000f; c[2] =-1.0000f;
|
||
|
|
|
||
|
|
p[0] =-1.5000f; p[1] = 1.0000f; p[2] = 1.0000f;
|
||
|
|
d[0] =-1.0000f; d[1] = 0.0000f; d[2] = 0.0000f;
|
||
|
|
|
||
|
|
BH_VERIFY(BH_Ray3fIntersectTriangle(p, d, a, b, c, &t, out) == BH_OK);
|
||
|
|
|
||
|
|
BH_VERIFY_DELTA(t, 2.5000f, ACCEPTABLE_DELTA);
|
||
|
|
BH_VERIFY_DELTA(out[0],-4.0000f, ACCEPTABLE_DELTA);
|
||
|
|
BH_VERIFY_DELTA(out[1], 1.0000f, ACCEPTABLE_DELTA);
|
||
|
|
BH_VERIFY_DELTA(out[2], 1.0000f, ACCEPTABLE_DELTA);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
BH_UNIT_TEST(SegmentIntersectTriangle)
|
||
|
|
{
|
||
|
|
float a[3], b[3], c[3], d[3], f[3], out[3], t;
|
||
|
|
|
||
|
|
a[0] =-3.0000f; a[1] = 1.0000f; a[2] = 2.0000f;
|
||
|
|
b[0] =-5.0000f; b[1] =-2.0000f; b[2] = 0.0000f;
|
||
|
|
c[0] =-6.0000f; c[1] = 2.5000f; c[2] =-1.0000f;
|
||
|
|
|
||
|
|
d[0] =-1.5000f; d[1] = 1.0000f; d[2] = 1.0000f;
|
||
|
|
f[0] =-6.0000f; f[1] = 1.0000f; f[2] = 1.0000f;
|
||
|
|
|
||
|
|
BH_VERIFY(BH_Segment3fIntersectTriangle(d, f, a, b, c, &t, out) == BH_OK);
|
||
|
|
BH_VERIFY_DELTA(out[0],-4.0000f, ACCEPTABLE_DELTA);
|
||
|
|
BH_VERIFY_DELTA(out[1], 1.0000f, ACCEPTABLE_DELTA);
|
||
|
|
BH_VERIFY_DELTA(out[2], 1.0000f, ACCEPTABLE_DELTA);
|
||
|
|
|
||
|
|
BH_Vec3fLerp(d, f, t, out);
|
||
|
|
BH_VERIFY_DELTA(out[0],-4.0000f, ACCEPTABLE_DELTA);
|
||
|
|
BH_VERIFY_DELTA(out[1], 1.0000f, ACCEPTABLE_DELTA);
|
||
|
|
BH_VERIFY_DELTA(out[2], 1.0000f, ACCEPTABLE_DELTA);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
BH_UNIT_TEST(Barycentric)
|
||
|
|
{
|
||
|
|
float a[3], b[3], c[3], p[3], d[3], out[3], t;
|
||
|
|
|
||
|
|
a[0] =-3.0000f; a[1] = 1.0000f; a[2] = 2.0000f;
|
||
|
|
b[0] =-5.0000f; b[1] =-2.0000f; b[2] = 0.0000f;
|
||
|
|
c[0] =-6.0000f; c[1] = 2.5000f; c[2] =-1.0000f;
|
||
|
|
|
||
|
|
p[0] =-1.5000f; p[1] = 1.0000f; p[2] = 1.0000f;
|
||
|
|
d[0] =-1.0000f; d[1] = 0.0000f; d[2] = 0.0000f;
|
||
|
|
|
||
|
|
BH_VERIFY(BH_Ray3fIntersectTriangle(p, d, a, b, c, &t, out) == BH_OK);
|
||
|
|
(void)t;
|
||
|
|
|
||
|
|
BH_Triangle3fBarycentric(a, b, c, out, out);
|
||
|
|
BH_VERIFY(out[0] >= 0.0f);
|
||
|
|
BH_VERIFY(out[1] >= 0.0f);
|
||
|
|
BH_VERIFY(out[2] >= 0.0f);
|
||
|
|
|
||
|
|
BH_VERIFY(out[0] <= 1.0f);
|
||
|
|
BH_VERIFY(out[1] <= 1.0f);
|
||
|
|
BH_VERIFY(out[2] <= 1.0f);
|
||
|
|
|
||
|
|
BH_VERIFY_DELTA(out[0] + out[1] + out[2], 1.0000f, ACCEPTABLE_DELTA);
|
||
|
|
|
||
|
|
BH_Vec3fBarycentric(a, b, c, out[1], out[2], out);
|
||
|
|
BH_VERIFY_DELTA(out[0],-4.0000f, ACCEPTABLE_DELTA);
|
||
|
|
BH_VERIFY_DELTA(out[1], 1.0000f, ACCEPTABLE_DELTA);
|
||
|
|
BH_VERIFY_DELTA(out[2], 1.0000f, ACCEPTABLE_DELTA);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
int main(int argc, char **argv)
|
||
|
|
{
|
||
|
|
(void)argc;
|
||
|
|
(void)argv;
|
||
|
|
|
||
|
|
BH_UNIT_ADD(RayIntersectTriangle);
|
||
|
|
BH_UNIT_ADD(SegmentIntersectTriangle);
|
||
|
|
BH_UNIT_ADD(Barycentric);
|
||
|
|
|
||
|
|
return BH_UnitRun();
|
||
|
|
}
|