[216] | 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 | } |
---|