开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 游戏 > 其他游戏 > 查看源码
hkKdTreeMath.inl
资源名称：wow-313-source.rar　[点击查看]
上传用户：yisoukefu
上传日期：2020-08-09
资源大小：39506k
文件大小：10k
源码类别：

其他游戏

开发平台：

Visual C++

hkKdTreeMath.inl：源码内容
  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.  */
  12. inline hkBool32 hkKdTreeMath::isComponentEqZero(hkVector4Parameter v, int component)
  13. {
  14. hkVector4 zero; zero.setZero4();
  15. hkVector4Comparison compMask = v.compareEqual4(zero);
  16. return compMask.allAreSet(hkVector4Comparison::s_components[component]);
  17. }
  19. inline hkBool32 hkKdTreeMath::isComponentGtZero(hkVector4Parameter v, int component)
  20. {
  21. hkVector4 zero; zero.setZero4();
  22. hkVector4Comparison compMask = v.compareGreaterThan4(zero);
  23. return compMask.allAreSet(hkVector4Comparison::s_components[component]);
  24. }
  27. // sets v to its minimum component
  28. inline void hkKdTreeMath::vectorBroadcastMin3(hkVector4& v)
  29. {
  30. hkVector4 temp0, temp1, temp2, temp;
  32. temp0.setBroadcast(v, 0);
  33. temp1.setBroadcast(v, 1);
  34. temp.setMin4(temp0, temp1);
  35. temp2.setBroadcast(v, 2);
  36. v.setMin4(temp, temp2);
  37. }
  39. inline void hkKdTreeMath::vectorBroadcastMin3(hkVector4& v, hkVector4ComparisonParameter ignoreMask)
  40. {
  41. hkQuadReal allMax = HK_QUADREAL_CONSTANT(HK_REAL_MAX, HK_REAL_MAX, HK_REAL_MAX, HK_REAL_MAX);
  43. HK_ASSERT(0x2dc51fe7, !ignoreMask.allAreSet(hkVector4Comparison::MASK_XYZ)); // trying to ignore all 3 components
  44. hkVector4 temp0, temp1, temp2, temp;
  46. hkVector4 allMaxV; allMaxV.getQuad() = allMax;
  47. v.select32(v, allMaxV, ignoreMask); 
  49. temp0.setBroadcast(v, 0);
  50. temp1.setBroadcast(v, 1);
  51. temp.setMin4(temp0, temp1);
  52. temp2.setBroadcast(v, 2);
  53. v.setMin4(temp, temp2);
  54. }
  56. // sets v to its maximum component
  57. inline void hkKdTreeMath::vectorBroadcastMax3(hkVector4& v)
  58. {
  59. hkVector4 temp0, temp1, temp2, temp;
  61. temp0.setBroadcast(v, 0);
  62. temp1.setBroadcast(v, 1);
  63. temp.setMax4(temp0, temp1);
  64. temp2.setBroadcast(v, 2);
  65. v.setMax4(temp, temp2);
  66. }
  68. inline void hkKdTreeMath::vectorBroadcastMax3(hkVector4& v, hkVector4ComparisonParameter ignoreMask)
  69. {
  70. hkQuadReal allMin = HK_QUADREAL_CONSTANT(-HK_REAL_MAX, -HK_REAL_MAX, -HK_REAL_MAX, -HK_REAL_MAX);
  72. HK_ASSERT(0x2dc51fe7, !ignoreMask.allAreSet(hkVector4Comparison::MASK_XYZ)); // trying to ignore all 3 components
  73. hkVector4 temp0, temp1, temp2, temp;
  75. hkVector4 allMinV; allMinV.getQuad() = allMin;
  76. v.select32(v, allMinV, ignoreMask); 
  78. temp0.setBroadcast(v, 0);
  79. temp1.setBroadcast(v, 1);
  80. temp.setMax4(temp0, temp1);
  81. temp2.setBroadcast(v, 2);
  82. v.setMax4(temp, temp2);
  83. }
  85. inline hkBool hkKdTreeMath::rayAabbCheckSlow(hkVector4Parameter orig, hkVector4Parameter invDir, hkReal tNear, hkReal tFar, const hkAabb& aabb)
  86. {
  87. for (int i=0; i<3; i++)
  88. {
  89. if (invDir(i) == 0.0f) // Ray is flat in this direction; can't exclude
  90. {
  91. // check that origin is within the bounds of the other planes
  92. if (orig(i) > aabb.m_max(i) || orig(i) < aabb.m_min(i))
  93. {
  94. return false;
  95. }
  96. continue;
  97. }
  99. hkReal splitMin = aabb.m_min(i);
  100. hkReal splitMax = aabb.m_max(i);
  101. hkReal dNear = ( splitMin - orig( i ) ) * invDir( i );
  102. hkReal dFar  = ( splitMax - orig( i ) ) * invDir( i );
  104. if (invDir(i) < 0.0f)
  105. {
  106. hkReal temp = dFar;
  107. dFar = dNear;
  108. dNear = temp;
  109. }
  111. tNear = hkMath::max2(dNear, tNear);
  112. tFar =  hkMath::min2(dFar, tFar);
  113. }
  115. return (tNear < tFar);
  116. }
  118. inline hkBool32 hkKdTreeMath::rayAabbCheck(hkVector4Parameter orig, hkVector4Parameter invDir, hkReal _tNear, hkReal _tFar, const hkAabb& aabb)
  119. {
  120. hkVector4 dNearTemp;
  121. dNearTemp = aabb.m_min;
  122. hkVector4 dFarTemp;
  123. dFarTemp = aabb.m_max;
  125. dNearTemp.sub4(orig);
  126. dFarTemp.sub4( orig);
  127. dNearTemp.mul4(invDir);
  128. dFarTemp.mul4( invDir);
  130. hkVector4 zero; zero.setZero4();
  131. hkVector4Comparison invDirLtZero = invDir.compareGreaterThanEqual4(zero);
  133. hkVector4 dNear, dFar;
  134. dNear.select32(dFarTemp, dNearTemp, invDirLtZero);
  135. dFar.select32( dNearTemp, dFarTemp, invDirLtZero);
  137. hkVector4 tNear, tFar;
  138. tNear.setAll(_tNear);
  139. tFar.setAll( _tFar );
  141. hkVector4Comparison invDirEqZero;
  142. invDirEqZero = invDir.compareEqual4(zero);
  144. hkVector4Comparison origInAabb = orig.compareGreaterThanEqual4(aabb.m_min);
  145. origInAabb.setAnd(origInAabb, orig.compareLessThanEqual4(aabb.m_max));
  147. vectorBroadcastMax3(dNear, invDirEqZero);
  148. vectorBroadcastMin3(dFar,  invDirEqZero);
  150. tNear.setMax4(tNear, dNear);
  151. tFar.setMin4(tFar, dFar);
  153. hkVector4Comparison nearLtFar = tNear.compareLessThan4(tFar);
  154. hkVector4Comparison isOk; isOk.setSelect(nearLtFar, origInAabb, invDirEqZero);
  155. //return nearLtFar.allAreSet();
  156. return isOk.allAreSet(hkVector4Comparison::MASK_XYZ);
  157. }
  159. inline hkVector4Comparison hkKdTreeMath::rayBundleAabbCheck(const struct hkKdTreeUtils::RayBundle& orig, const struct hkKdTreeUtils::RayBundle& invDir, hkVector4Parameter _tNear, hkVector4Parameter _tFar, const hkVector4* aabbData)
  160. {
  161. hkVector4 tNear = _tNear;
  162. hkVector4 tFar = _tFar;
  164. hkVector4Comparison flatOrigOK; flatOrigOK.set(hkVector4Comparison::MASK_XYZW);
  166. for (int i=0; i<3; i++)
  167. {
  168. hkVector4 aabbMin, aabbMax;
  169. aabbMin = *aabbData++;
  170. aabbMax = *aabbData++;
  172. hkVector4 dNear, dFar, dNearTemp, dFarTemp;
  173. dNearTemp.setSub4(aabbMin, orig.m_vec[i]);
  174. dFarTemp.setSub4( aabbMax, orig.m_vec[i]);
  175. dNearTemp.mul4(invDir.m_vec[i]);
  176. dFarTemp.mul4( invDir.m_vec[i]);
  178. hkVector4 zero; zero.setZero4();
  179. hkVector4Comparison dirLtZero = invDir.m_vec[ i ].compareGreaterThanEqual4(zero);
  180. hkVector4Comparison dirEqZero = invDir.m_vec[ i ].compareEqual4(zero);
  183. // Check that the origins in flat directions (dir=0) are within the AABB in that direction
  184. // OK = OK && ( (!flat) || (flat && inRange) )
  185. //    = OK && select(true, inRange, flat)
  186. //    = OK && select(OK, inRange, flat)
  188. hkVector4Comparison inRange;
  189. inRange = orig.m_vec[i].compareLessThanEqual4(aabbMax);
  190. inRange.setAnd(inRange, orig.m_vec[i].compareGreaterThanEqual4(aabbMin) );
  191. hkVector4Comparison thisComponentIsOk; thisComponentIsOk.setSelect(flatOrigOK, inRange, dirEqZero);
  192. flatOrigOK.setAnd(flatOrigOK, thisComponentIsOk);
  194. dNear.select32(dFarTemp, dNearTemp, dirLtZero);
  195. dFar.select32( dNearTemp, dFarTemp, dirLtZero);
  197. // If the ray is flat in this direction, effectively skip the direction
  198. dNear.select32(dNear, tNear, dirEqZero);
  199. dFar.select32( dFar, tFar, dirEqZero);
  201. tNear.setMax4(dNear, tNear);
  202. tFar.setMin4(dFar, tFar);
  203. }
  204. //return tNear.compareLessThan4(tFar);
  206. // The ray hits if tNear<tFar and the origins are within the proper ranges
  207. hkVector4Comparison tOk = tNear.compareLessThan4(tFar);
  208. tOk.setAnd(tOk, flatOrigOK);
  209. return tOk;
  210. }
  212. //static const hkQuadReal oneOver65K = HK_QUADREAL_CONSTANT(1.0f/65535.0f, 1.0f/65535.0f, 1.0f/65535.0f, 1.0f/65535.0f);
  213. #ifndef HK_PLATFORM_PS3_SPU
  214. static HK_FORCE_INLINE hkQuadReal hkGetOneOver65K()
  215. {
  216. static hkQuadReal x = HK_QUADREAL_CONSTANT(1.0f / 65535.0f, 1.0f / 65535.0f, 1.0f / 65535.0f, 1.0f / 65535.0f);
  217. return x;
  218. }
  219. #else
  220. static HK_FORCE_INLINE hkQuadReal hkGetOneOver65K()
  221. {
  222. // 0x37800080
  223. vector signed char upper = si_ilhu(0x3780);
  224. return (hkQuadReal) si_iohl(upper, 0x0080);
  225. }
  226. #endif
  228. void inline hkKdTreeMath::getAabbFromProjectedEntry(const hkKdTreeBuildInput::ProjectedEntry* aabbData, hkAabb& aabb, hkVector4Parameter offset, hkVector4Parameter _scale)
  229. {
  230. hkVector4 scale; scale.getQuad() = hkGetOneOver65K();
  231. scale.mul4(_scale); 
  233. hkVector4 min, max;
  234. convertProjectedEntryToHkVector4(aabbData, min, max);
  235. aabb.m_min.setAddMul4(offset, scale, min); // offset + (scale*min)
  236. aabb.m_max.setAddMul4(offset, scale, max);
  238. // isEmpty means that max < min, which happens when the primitive is invalidated
  239. HK_ASSERT(0x781378a0, aabb.isValid() || aabb.isEmpty() );
  240. }
  242. // Vectors are output in the order minX, maxX, minY, maxY, minZ, maxZ
  243. void inline hkKdTreeMath::getAabbVecsFromProjectedEntry(const hkKdTreeBuildInput::ProjectedEntry* aabbData, hkVector4* HK_RESTRICT vecsOut, hkVector4Parameter offset, hkVector4Parameter scaleIn)
  244. {
  245. hkVector4 scale; scale.getQuad() = hkGetOneOver65K();
  246. scale.mul4(scaleIn);
  248. hkVector4 min, max;
  249. convertProjectedEntryToHkVector4(aabbData, min, max);
  251. min.setAddMul4(offset, scale, min); // offset + (scale*min)
  252. max.setAddMul4(offset, scale, max);
  254. vecsOut[0].setBroadcast(min, 0);
  255. vecsOut[1].setBroadcast(max, 0);
  257. vecsOut[2].setBroadcast(min, 1);
  258. vecsOut[3].setBroadcast(max, 1);
  260. vecsOut[4].setBroadcast(min, 2);
  261. vecsOut[5].setBroadcast(max, 2);
  262. }
  264. inline void hkKdTreeMath::convertProjectedEntryToHkVector4(const hkKdTreeBuildInput::ProjectedEntry* splits, hkVector4& v1, hkVector4& v2)
  265. {
  266. #if (HK_CONFIG_SIMD == HK_CONFIG_SIMD_ENABLED) && (HK_POINTER_SIZE == 4)
  268. // The compressed AABBs are always 16-byte aligned
  269. HK_ASSERT( 0x0, ((hkUlong)splits & 0xf) == 0);
  271. hkIntVector b = *(hkIntVector*)splits; // b = xxyy zz00 XXYY ZZ00
  272. hkIntVector zero; zero.setZero();
  274. hkIntVector minUint, maxUint;
  275. if(HK_ENDIAN_BIG) 
  276. {
  277. minUint.setMergeHigh16(zero, b); // minUint = 00xx 00yy 00zz 0000
  278. maxUint.setMergeLow16(zero, b);  // maxUint = 00XX 00YY 00ZZ 0000
  279. }
  280. else
  281. {
  282. minUint.setMergeHigh16(b, zero); 
  283. maxUint.setMergeLow16(b, zero); 
  284. }
  286. minUint.convertToF32fromU32(v1);
  287. maxUint.convertToF32fromU32(v2);
  289. #else
  291. v1.set(hkReal(splits->m_min[0]), hkReal(splits->m_min[1]), hkReal(splits->m_min[2]), 0.0f);
  292. v2.set(hkReal(splits->m_max[0]), hkReal(splits->m_max[1]), hkReal(splits->m_max[2]), 0.0f);
  293. #endif
  294. }
  296. // Leave an extra line at the EOF
  298. /*
  299. * Havok SDK - NO SOURCE PC DOWNLOAD, BUILD(#20090216)
  300. * 
  301. * Confidential Information of Havok.  (C) Copyright 1999-2009
  302. * Telekinesys Research Limited t/a Havok. All Rights Reserved. The Havok
  303. * Logo, and the Havok buzzsaw logo are trademarks of Havok.  Title, ownership
  304. * rights, and intellectual property rights in the Havok software remain in
  305. * Havok and/or its suppliers.
  306. * 
  307. * Use of this software for evaluation purposes is subject to and indicates
  308. * acceptance of the End User licence Agreement for this product. A copy of
  309. * the license is included with this software and is also available at www.havok.com/tryhavok.
  310. * 
  311. */