OPCODE/OPC_SphereAABBOverlap.h

   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 }