1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
|
#include <BH/Math.h>
#include <BH/Unit.h>
#define ACCEPTABLE_DELTA 0.0001f
BH_UNIT_TEST(FromPoints)
{
float a[3], b[3], c[3], r[4];
a[0] = 1; a[1] = -2; a[2] = 1;
b[0] = 4; b[1] = -2; b[2] = -2;
c[0] = 4; c[1] = 1; c[2] = 4;
BH_VERIFY(BH_PlaneFromPoints(a, b, c, r) == BH_OK);
BH_VERIFY_DELTA(r[0],-0.4082f, ACCEPTABLE_DELTA);
BH_VERIFY_DELTA(r[1], 0.8165f, ACCEPTABLE_DELTA);
BH_VERIFY_DELTA(r[2],-0.4082f, ACCEPTABLE_DELTA);
BH_VERIFY_DELTA(r[3],-2.4495f, ACCEPTABLE_DELTA);
return 0;
}
BH_UNIT_TEST(Degenerate)
{
float a[3], b[3], c[3], r[4];
a[0] = 1; a[1] = -2; a[2] = 1;
b[0] = 1; b[1] = -2; b[2] = 1;
c[0] = 4; c[1] = 1; c[2] = 4;
BH_VERIFY(BH_PlaneFromPoints(a, b, c, r) != BH_OK);
return 0;
}
BH_UNIT_TEST(Distance)
{
float a[3], b[3], c[3], r[4];
a[0] = 1; a[1] = -2; a[2] = 1;
b[0] = 4; b[1] = -2; b[2] = -2;
c[0] = 4; c[1] = 1; c[2] = 4;
BH_VERIFY(BH_PlaneFromPoints(a, b, c, r) == BH_OK);
BH_VERIFY_DELTA(BH_PlaneDistance(r, a), 0.0000f, ACCEPTABLE_DELTA);
BH_VERIFY_DELTA(BH_PlaneDistance(r, b), 0.0000f, ACCEPTABLE_DELTA);
BH_VERIFY_DELTA(BH_PlaneDistance(r, c), 0.0000f, ACCEPTABLE_DELTA);
a[0] = 3; a[1] = 4; a[2] = 5;
b[0] = 2; b[1] = -1; b[2] = 6;
BH_VERIFY_DELTA(BH_PlaneDistance(r, a), 2.4495f, ACCEPTABLE_DELTA);
BH_VERIFY_DELTA(BH_PlaneDistance(r, b), -1.6330f, ACCEPTABLE_DELTA);
return 0;
}
BH_UNIT_TEST(ClosestPoint)
{
float a[3], b[3], c[3], r[4];
a[0] = 1; a[1] = -2; a[2] = 1;
b[0] = 4; b[1] = -2; b[2] = -2;
c[0] = 4; c[1] = 1; c[2] = 4;
BH_VERIFY(BH_PlaneFromPoints(a, b, c, r) == BH_OK);
b[0] = 3; b[1] = 4; b[2] = 5;
BH_PlaneClosestPoint(r, b, c);
BH_VERIFY_DELTA(c[0], 4.0000f, ACCEPTABLE_DELTA);
BH_VERIFY_DELTA(c[1], 2.0000f, ACCEPTABLE_DELTA);
BH_VERIFY_DELTA(c[2], 6.0000f, 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();
}
|
