| 1 | #define LOCAL_EPSILON 0.000001f | 
|---|
| 2 |  | 
|---|
| 3 | /////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// | 
|---|
| 4 | /** | 
|---|
| 5 |  *      Computes a ray-triangle intersection test. | 
|---|
| 6 |  *      Original code from Tomas Möller's "Fast Minimum Storage Ray-Triangle Intersection". | 
|---|
| 7 |  *      It's been optimized a bit with integer code, and modified to return a non-intersection if distance from | 
|---|
| 8 |  *      ray origin to triangle is negative. | 
|---|
| 9 |  * | 
|---|
| 10 |  *      \param          vert0   [in] triangle vertex | 
|---|
| 11 |  *      \param          vert1   [in] triangle vertex | 
|---|
| 12 |  *      \param          vert2   [in] triangle vertex | 
|---|
| 13 |  *      \return         true on overlap. mStabbedFace is filled with relevant info. | 
|---|
| 14 |  */ | 
|---|
| 15 | /////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// | 
|---|
| 16 | inline_ BOOL RayCollider::RayTriOverlap(const Point& vert0, const Point& vert1, const Point& vert2) | 
|---|
| 17 | { | 
|---|
| 18 |         // Stats | 
|---|
| 19 |         mNbRayPrimTests++; | 
|---|
| 20 |  | 
|---|
| 21 |         // Find vectors for two edges sharing vert0 | 
|---|
| 22 |         Point edge1 = vert1 - vert0; | 
|---|
| 23 |         Point edge2 = vert2 - vert0; | 
|---|
| 24 |  | 
|---|
| 25 |         // Begin calculating determinant - also used to calculate U parameter | 
|---|
| 26 |         Point pvec = mDir^edge2; | 
|---|
| 27 |  | 
|---|
| 28 |         // If determinant is near zero, ray lies in plane of triangle | 
|---|
| 29 |         float det = edge1|pvec; | 
|---|
| 30 |  | 
|---|
| 31 |         if(mCulling) | 
|---|
| 32 |         { | 
|---|
| 33 |                 if(det<LOCAL_EPSILON)                                                                                                           return FALSE; | 
|---|
| 34 |                 // From here, det is > 0. So we can use integer cmp. | 
|---|
| 35 |  | 
|---|
| 36 |                 // Calculate distance from vert0 to ray origin | 
|---|
| 37 |                 Point tvec = mOrigin - vert0; | 
|---|
| 38 |  | 
|---|
| 39 |                 // Calculate U parameter and test bounds | 
|---|
| 40 |                 mStabbedFace.mU = tvec|pvec; | 
|---|
| 41 | //              if(IR(u)&0x80000000 || u>det)                                   return FALSE; | 
|---|
| 42 |                 if(IS_NEGATIVE_FLOAT(mStabbedFace.mU) || IR(mStabbedFace.mU)>IR(det))           return FALSE; | 
|---|
| 43 |  | 
|---|
| 44 |                 // Prepare to test V parameter | 
|---|
| 45 |                 Point qvec = tvec^edge1; | 
|---|
| 46 |  | 
|---|
| 47 |                 // Calculate V parameter and test bounds | 
|---|
| 48 |                 mStabbedFace.mV = mDir|qvec; | 
|---|
| 49 |                 if(IS_NEGATIVE_FLOAT(mStabbedFace.mV) || mStabbedFace.mU+mStabbedFace.mV>det)   return FALSE; | 
|---|
| 50 |  | 
|---|
| 51 |                 // Calculate t, scale parameters, ray intersects triangle | 
|---|
| 52 |                 mStabbedFace.mDistance = edge2|qvec; | 
|---|
| 53 |                 // Det > 0 so we can early exit here | 
|---|
| 54 |                 // Intersection point is valid if distance is positive (else it can just be a face behind the orig point) | 
|---|
| 55 |                 if(IS_NEGATIVE_FLOAT(mStabbedFace.mDistance))                                                           return FALSE; | 
|---|
| 56 |                 // Else go on | 
|---|
| 57 |                 float OneOverDet = 1.0f / det; | 
|---|
| 58 |                 mStabbedFace.mDistance *= OneOverDet; | 
|---|
| 59 |                 mStabbedFace.mU *= OneOverDet; | 
|---|
| 60 |                 mStabbedFace.mV *= OneOverDet; | 
|---|
| 61 |         } | 
|---|
| 62 |         else | 
|---|
| 63 |         { | 
|---|
| 64 |                 // the non-culling branch | 
|---|
| 65 |                 if(det>-LOCAL_EPSILON && det<LOCAL_EPSILON)                                                                     return FALSE; | 
|---|
| 66 |                 float OneOverDet = 1.0f / det; | 
|---|
| 67 |  | 
|---|
| 68 |                 // Calculate distance from vert0 to ray origin | 
|---|
| 69 |                 Point tvec = mOrigin - vert0; | 
|---|
| 70 |  | 
|---|
| 71 |                 // Calculate U parameter and test bounds | 
|---|
| 72 |                 mStabbedFace.mU = (tvec|pvec) * OneOverDet; | 
|---|
| 73 | //              if(IR(u)&0x80000000 || u>1.0f)                                  return FALSE; | 
|---|
| 74 |                 if(IS_NEGATIVE_FLOAT(mStabbedFace.mU) || IR(mStabbedFace.mU)>IEEE_1_0)          return FALSE; | 
|---|
| 75 |  | 
|---|
| 76 |                 // prepare to test V parameter | 
|---|
| 77 |                 Point qvec = tvec^edge1; | 
|---|
| 78 |  | 
|---|
| 79 |                 // Calculate V parameter and test bounds | 
|---|
| 80 |                 mStabbedFace.mV = (mDir|qvec) * OneOverDet; | 
|---|
| 81 |                 if(IS_NEGATIVE_FLOAT(mStabbedFace.mV) || mStabbedFace.mU+mStabbedFace.mV>1.0f)  return FALSE; | 
|---|
| 82 |  | 
|---|
| 83 |                 // Calculate t, ray intersects triangle | 
|---|
| 84 |                 mStabbedFace.mDistance = (edge2|qvec) * OneOverDet; | 
|---|
| 85 |                 // Intersection point is valid if distance is positive (else it can just be a face behind the orig point) | 
|---|
| 86 |                 if(IS_NEGATIVE_FLOAT(mStabbedFace.mDistance))                                                           return FALSE; | 
|---|
| 87 |         } | 
|---|
| 88 |         return TRUE; | 
|---|
| 89 | } | 
|---|