hkpSphereUtil.inl
上传用户:yisoukefu
上传日期:2020-08-09
资源大小:39506k
文件大小:4k
源码类别:

其他游戏

开发平台:

Visual C++

  1. /* 
  2.  * 
  3.  * Confidential Information of Telekinesys Research Limited (t/a Havok). Not for disclosure or distribution without Havok's
  4.  * prior written consent. This software contains code, techniques and know-how which is confidential and proprietary to Havok.
  5.  * Level 2 and Level 3 source code contains trade secrets of Havok. Havok Software (C) Copyright 1999-2009 Telekinesys Research Limited t/a Havok. All Rights Reserved. Use of this software is subject to the terms of an end user license agreement.
  6.  * 
  7.  */
  8. #include <Physics/Collide/hkpCollide.h>
  9. #include <Common/Base/hkBase.h>
  10. #include <Physics/Collide/Util/hkpSphereUtil.h>
  11. #include <Physics/Collide/Shape/Query/hkpShapeRayCastInput.h>
  12. #include <Physics/Collide/Shape/Query/hkpShapeRayCastOutput.h>
  13. inline hkBool HK_CALL hkpSphereUtil::castRayUtil(hkReal radius, const hkpShapeRayCastInput& input, hkpShapeRayCastOutput& results)
  14. {
  15. //
  16. // This functions is a modified version of
  17. //  http://www.siggraph.org/education/materials/HyperGraph/raytrace/rtinter1.htm
  18. //  Modifications include changing the order of if statements to prevent
  19. //  any division which can produce a number greater than 1
  20. //
  21. {
  22.     hkReal radius2 = radius * radius;
  23.     
  24.     // 
  25.     // solve quadratic function: ax*x + bx + c = 0
  26.     //
  27.     hkVector4 dir; dir.setSub4( input.m_to, input.m_from);
  28.     
  29.     hkReal B = hkReal(dir.dot3( input.m_from ));
  30.     if ( B >= 0 )
  31.     {
  32.     // ray points away from sphere center
  33.     goto returnFalse;
  34.     }
  35. const hkReal A = dir.lengthSquared3();
  36. //
  37. // Check for long rays (check for startpoints being 10 times outside the radius
  38. //
  39. hkReal offset;
  40. hkVector4 midPoint;
  41. if ( B * B > A * radius2 * 100.0f)
  42. {
  43. // no hit if length is smaller than the distance of the startpoint to the center
  44. if ( A < radius2 )
  45. {
  46. goto returnFalse;
  47. }
  48. offset = -B;
  49. midPoint.setInterpolate4(input.m_from, input.m_to, offset/A);
  50. B = 0.0f;
  51. }
  52. else
  53. {
  54. offset = 0.0f;
  55. midPoint = input.m_from;
  56. }
  57. const hkReal C = hkReal(midPoint.lengthSquared3()) - radius2;
  58. const hkReal det = B*B - A*C;
  59. if ( det <= 0 )
  60. {
  61. //
  62. // Infinite ray does not hit
  63. //
  64. goto returnFalse;
  65. }
  66. const hkReal sqDet = hkMath::sqrt( det );
  67. const hkReal t2 = -B - sqDet;
  68. hkReal t = t2 + offset;
  69. if ( t >= (A * results.m_hitFraction))
  70. {
  71. //
  72. // hits behind endpoint or is greater than previous hit fraction
  73. //
  74. goto returnFalse;
  75. }
  76. if ( t < 0 )
  77. {
  78. //
  79. // start point inside
  80. //
  81. goto returnFalse;
  82. }
  83. //  Note: we know that t > 0
  84. //  Also that A > t 
  85. //  So this division is safe and results in a point between 0 and 1
  86. t = t/A;
  87. results.m_hitFraction = t;
  88. results.m_normal.setInterpolate4( input.m_from, input.m_to, t );
  89. results.m_normal.mul4( 1.0f / radius );
  90. results.setKey(HK_INVALID_SHAPE_KEY);
  91. return true;
  92. }
  93. returnFalse:
  94. return false;
  95. }
  96. /*
  97. * Havok SDK - NO SOURCE PC DOWNLOAD, BUILD(#20090216)
  98. * Confidential Information of Havok.  (C) Copyright 1999-2009
  99. * Telekinesys Research Limited t/a Havok. All Rights Reserved. The Havok
  100. * Logo, and the Havok buzzsaw logo are trademarks of Havok.  Title, ownership
  101. * rights, and intellectual property rights in the Havok software remain in
  102. * Havok and/or its suppliers.
  103. * Use of this software for evaluation purposes is subject to and indicates
  104. * acceptance of the End User licence Agreement for this product. A copy of
  105. * the license is included with this software and is also available at www.havok.com/tryhavok.
  106. */