diff options
author | dan miller | 2007-10-19 05:22:23 +0000 |
---|---|---|
committer | dan miller | 2007-10-19 05:22:23 +0000 |
commit | 1ec410ecd725f5a3ccb2d2fc16f48730d9d9fe43 (patch) | |
tree | 51bcae7a1b8381a6bf6fd8025a7de1e30fe0045d /libraries/ode-0.9/OPCODE/OPC_SphereAABBOverlap.h | |
parent | one more for the gipper (diff) | |
download | opensim-SC_OLD-1ec410ecd725f5a3ccb2d2fc16f48730d9d9fe43.zip opensim-SC_OLD-1ec410ecd725f5a3ccb2d2fc16f48730d9d9fe43.tar.gz opensim-SC_OLD-1ec410ecd725f5a3ccb2d2fc16f48730d9d9fe43.tar.bz2 opensim-SC_OLD-1ec410ecd725f5a3ccb2d2fc16f48730d9d9fe43.tar.xz |
trying to fix my screwup, please hold on
Diffstat (limited to 'libraries/ode-0.9/OPCODE/OPC_SphereAABBOverlap.h')
-rw-r--r-- | libraries/ode-0.9/OPCODE/OPC_SphereAABBOverlap.h | 128 |
1 files changed, 0 insertions, 128 deletions
diff --git a/libraries/ode-0.9/OPCODE/OPC_SphereAABBOverlap.h b/libraries/ode-0.9/OPCODE/OPC_SphereAABBOverlap.h deleted file mode 100644 index 2278bc0..0000000 --- a/libraries/ode-0.9/OPCODE/OPC_SphereAABBOverlap.h +++ /dev/null | |||
@@ -1,128 +0,0 @@ | |||
1 | /////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// | ||
2 | /** | ||
3 | * Sphere-AABB overlap test, based on Jim Arvo's code. | ||
4 | * \param center [in] box center | ||
5 | * \param extents [in] box extents | ||
6 | * \return TRUE on overlap | ||
7 | */ | ||
8 | /////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// | ||
9 | inline_ BOOL SphereCollider::SphereAABBOverlap(const Point& center, const Point& extents) | ||
10 | { | ||
11 | // Stats | ||
12 | mNbVolumeBVTests++; | ||
13 | |||
14 | float d = 0.0f; | ||
15 | |||
16 | //find the square of the distance | ||
17 | //from the sphere to the box | ||
18 | #ifdef OLDIES | ||
19 | for(udword i=0;i<3;i++) | ||
20 | { | ||
21 | float tmp = mCenter[i] - center[i]; | ||
22 | float s = tmp + extents[i]; | ||
23 | |||
24 | if(s<0.0f) d += s*s; | ||
25 | else | ||
26 | { | ||
27 | s = tmp - extents[i]; | ||
28 | if(s>0.0f) d += s*s; | ||
29 | } | ||
30 | } | ||
31 | #endif | ||
32 | |||
33 | //#ifdef NEW_TEST | ||
34 | |||
35 | // float tmp = mCenter.x - center.x; | ||
36 | // float s = tmp + extents.x; | ||
37 | |||
38 | float tmp,s; | ||
39 | |||
40 | tmp = mCenter.x - center.x; | ||
41 | s = tmp + extents.x; | ||
42 | |||
43 | if(s<0.0f) | ||
44 | { | ||
45 | d += s*s; | ||
46 | if(d>mRadius2) return FALSE; | ||
47 | } | ||
48 | else | ||
49 | { | ||
50 | s = tmp - extents.x; | ||
51 | if(s>0.0f) | ||
52 | { | ||
53 | d += s*s; | ||
54 | if(d>mRadius2) return FALSE; | ||
55 | } | ||
56 | } | ||
57 | |||
58 | tmp = mCenter.y - center.y; | ||
59 | s = tmp + extents.y; | ||
60 | |||
61 | if(s<0.0f) | ||
62 | { | ||
63 | d += s*s; | ||
64 | if(d>mRadius2) return FALSE; | ||
65 | } | ||
66 | else | ||
67 | { | ||
68 | s = tmp - extents.y; | ||
69 | if(s>0.0f) | ||
70 | { | ||
71 | d += s*s; | ||
72 | if(d>mRadius2) return FALSE; | ||
73 | } | ||
74 | } | ||
75 | |||
76 | tmp = mCenter.z - center.z; | ||
77 | s = tmp + extents.z; | ||
78 | |||
79 | if(s<0.0f) | ||
80 | { | ||
81 | d += s*s; | ||
82 | if(d>mRadius2) return FALSE; | ||
83 | } | ||
84 | else | ||
85 | { | ||
86 | s = tmp - extents.z; | ||
87 | if(s>0.0f) | ||
88 | { | ||
89 | d += s*s; | ||
90 | if(d>mRadius2) return FALSE; | ||
91 | } | ||
92 | } | ||
93 | //#endif | ||
94 | |||
95 | #ifdef OLDIES | ||
96 | // Point Min = center - extents; | ||
97 | // Point Max = center + extents; | ||
98 | |||
99 | float d = 0.0f; | ||
100 | |||
101 | //find the square of the distance | ||
102 | //from the sphere to the box | ||
103 | for(udword i=0;i<3;i++) | ||
104 | { | ||
105 | float Min = center[i] - extents[i]; | ||
106 | |||
107 | // if(mCenter[i]<Min[i]) | ||
108 | if(mCenter[i]<Min) | ||
109 | { | ||
110 | // float s = mCenter[i] - Min[i]; | ||
111 | float s = mCenter[i] - Min; | ||
112 | d += s*s; | ||
113 | } | ||
114 | else | ||
115 | { | ||
116 | float Max = center[i] + extents[i]; | ||
117 | |||
118 | // if(mCenter[i]>Max[i]) | ||
119 | if(mCenter[i]>Max) | ||
120 | { | ||
121 | float s = mCenter[i] - Max; | ||
122 | d += s*s; | ||
123 | } | ||
124 | } | ||
125 | } | ||
126 | #endif | ||
127 | return d <= mRadius2; | ||
128 | } | ||