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

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

其他游戏

开发平台：

Visual C++

hkFpuVector4.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.  */
  9. /* quad, here for inlining */
  11. inline hkQuadReal& hkVector4::getQuad()
  12. {
  13. return reinterpret_cast<hkQuadReal&>(x);
  14. }
  16. inline const hkQuadReal& hkVector4::getQuad() const
  17. {
  18. return reinterpret_cast<const hkQuadReal&>(x);
  19. }
  21. /* operator (),[] here for inlining */
  23. inline hkReal& hkVector4::operator() (int i)
  24. {
  25. HK_ASSERT(0x3d62369d, i>=0 && i<4);
  26. return (&x)[i];
  27. }
  29. inline const hkReal& hkVector4::operator() (int i) const
  30. {
  31. HK_ASSERT(0x269e424a, i>=0 && i<4);
  32. return (&x)[i];
  33. }
  35. HK_FORCE_INLINE void hkVector4::setW(const hkVector4& v)
  36. {
  37. w = v.w;
  38. }
  40. HK_FORCE_INLINE void hkVector4::setXYZ(const hkVector4& v)
  41. {
  42. x = v.x;
  43. y = v.y;
  44. z = v.z;
  45. }
  47. HK_FORCE_INLINE void hkVector4::setXYZ0(const hkVector4& xyz)
  48. {
  49. x = xyz.x;
  50. y = xyz.y;
  51. z = xyz.z;
  52. w = 0;
  53. }
  55. HK_FORCE_INLINE void hkVector4::setXYZW(const hkVector4& xyz, const hkVector4& vw)
  56. {
  57. x = xyz.x;
  58. y = xyz.y;
  59. z = xyz.z;
  60. w = vw.w;
  61. }
  63. HK_FORCE_INLINE void hkVector4::setReciprocal4(const hkVector4& v)
  64. {
  65. x = 1.0f / v.x;
  66. y = 1.0f / v.y;
  67. z = 1.0f / v.z;
  68. w = 1.0f / v.w;
  69. }
  71. #define HK_VECTOR4_setReciprocal3
  72. inline void hkVector4::setReciprocal3(const hkVector4& v)
  73. {
  74. x = 1.0f / v.x;
  75. y = 1.0f / v.y;
  76. z = 1.0f / v.z;
  77. w = 1.0f;
  78. }
  80. HK_FORCE_INLINE void hkVector4::setSqrtInverse4(const hkVector4& v)
  81. {
  82. x = hkMath::sqrtInverse(v.x);
  83. y = hkMath::sqrtInverse(v.y);
  84. z = hkMath::sqrtInverse(v.z);
  85. w = hkMath::sqrtInverse(v.w);
  86. }
  88. inline hkSimdReal hkVector4::getSimdAt(int i) const
  89. {
  90. HK_ASSERT(0x5e605c8e, i>=0 && i<4);
  91. return (&x)[i];
  92. }
  94. inline void hkVector4::operator= (const hkVector4& v)
  95. {
  96. x = v.x;
  97. y = v.y;
  98. z = v.z;
  99. w = v.w;
  100. }
  102. #ifndef HK_DISABLE_VECTOR4_CONSTRUCTORS
  104. /* construct, assign, zero */
  105. inline hkVector4::hkVector4(hkReal a, hkReal b, hkReal c, hkReal d)
  106. : x(a), y(b), z(c), w(d)
  107. {
  108. }
  110. inline hkVector4::hkVector4(const hkQuadReal& q)
  111. : x(q.x), y(q.y), z(q.z), w(q.w)
  112. {
  113. }
  115. inline hkVector4::hkVector4( const hkVector4& v)
  116. {
  117. *this = v;
  118. }
  119. #endif
  121. inline void hkVector4::set(hkReal a, hkReal b, hkReal c, hkReal d)
  122. {
  123. x = a;
  124. y = b;
  125. z = c;
  126. w = d;
  127. }
  129. inline void hkVector4::setAll(hkReal a)
  130. {
  131. x = a;
  132. y = a;
  133. z = a;
  134. w = a;
  135. }
  137. inline void hkVector4::setAll3(hkReal a)
  138. {
  139. x = a;
  140. y = a;
  141. z = a;
  142. w = a;
  143. }
  145. inline void hkVector4::setZero4()
  146. {
  147. x = y = z = w = 0;
  148. }
  150. inline void hkVector4::zeroElement( int i )
  151. {
  152. (*this)(i) = 0.0f;
  153. }
  155. inline void hkVector4::setInt24W( int value )
  156. {
  157. (reinterpret_cast<int*>(this))[3] = (value | 0x3f000000);
  158. }
  160. // Gets the .w component as an integer with 24 bit resolution (for real experts only)
  161. inline int hkVector4::getInt24W( ) const 
  162. {
  163. return (reinterpret_cast<const int*>(this))[3] & ~0x3f000000;
  164. }
  166. inline void hkVector4::storeUncached( void* dest) const
  167. {
  168. *static_cast<hkVector4*>(dest) = *this;
  169. }
  171. /* vector methods */
  173. inline void hkVector4::add4(const hkVector4& v)
  174. {
  175. x += v.x;
  176. y += v.y;
  177. z += v.z;
  178. w += v.w;
  179. }
  181. inline void hkVector4::add3clobberW(const hkVector4& v)
  182. {
  183. x += v.x;
  184. y += v.y;
  185. z += v.z;
  186. }
  188. inline void hkVector4::setAdd4(const hkVector4& v0, const hkVector4& v1)
  189. {
  190. x = v0.x + v1.x;
  191. y = v0.y + v1.y;
  192. z = v0.z + v1.z;
  193. w = v0.w + v1.w;
  194. }
  196. inline void hkVector4::sub4(const hkVector4& v)
  197. {
  198. x -= v.x;
  199. y -= v.y;
  200. z -= v.z;
  201. w -= v.w;
  202. }
  204. inline void hkVector4::sub3clobberW(const hkVector4& v)
  205. {
  206. x -= v.x;
  207. y -= v.y;
  208. z -= v.z;
  209. }
  211. inline void hkVector4::setSub4(const hkVector4& v0, const hkVector4& v1)
  212. {
  213. x = v0.x - v1.x;
  214. y = v0.y - v1.y;
  215. z = v0.z - v1.z;
  216. w = v0.w - v1.w;
  217. }
  219. inline void hkVector4::mul4(const hkVector4& a)
  220. {
  221. x *= a.x;
  222. y *= a.y;
  223. z *= a.z;
  224. w *= a.w;
  225. }
  226. inline void hkVector4::setMul4(const hkVector4& a, const hkVector4& b)
  227. {
  228. x = a.x * b.x;
  229. y = a.y * b.y;
  230. z = a.z * b.z;
  231. w = a.w * b.w;
  232. }
  234. inline void hkVector4::mul4(hkSimdRealParameter rs)
  235. {  
  236. hkReal s = hkReal(rs);
  237. x *= s;
  238. y *= s;
  239. z *= s;
  240. w *= s;
  241. }
  242. inline void hkVector4::setMul4(hkSimdRealParameter rs, const hkVector4& a)
  243. {
  244. hkReal r = hkReal(rs);
  245. x = r * a.x;
  246. y = r * a.y;
  247. z = r * a.z;
  248. w = r * a.w;
  249. }
  250. inline void hkVector4::addMul4(hkSimdRealParameter rs, const hkVector4& a)
  251. {
  252. hkReal r = hkReal(rs);
  253. x += r * a.x;
  254. y += r * a.y;
  255. z += r * a.z;
  256. w += r * a.w;
  257. }
  258. inline void hkVector4::addMul4(const hkVector4& a, const hkVector4& b)
  259. {
  260. x += a.x * b.x;
  261. y += a.y * b.y;
  262. z += a.z * b.z;
  263. w += a.w * b.w;
  264. }
  266. inline void hkVector4::subMul4(hkSimdRealParameter rs, const hkVector4& a)
  267. {
  268. hkReal r = hkReal(rs);
  269. x -= r * a.x;
  270. y -= r * a.y;
  271. z -= r * a.z;
  272. w -= r * a.w;
  273. }
  275. inline void hkVector4::subMul4(const hkVector4& a, const hkVector4& b)
  276. {
  277. x -= a.x * b.x;
  278. y -= a.y * b.y;
  279. z -= a.z * b.z;
  280. w -= a.w * b.w;
  281. }
  283. inline void hkVector4::setAddMul4(const hkVector4& a, const hkVector4& b, hkSimdRealParameter r)
  284. {
  285. x = a.x + r * b.x;
  286. y = a.y + r * b.y;
  287. z = a.z + r * b.z;
  288. w = a.w + r * b.w;
  289. }
  291. inline void hkVector4::setAddMul4(const hkVector4& a, const hkVector4& m0, const hkVector4& m1)
  292. {
  293. x = a.x + m0.x * m1.x;
  294. y = a.y + m0.y * m1.y;
  295. z = a.z + m0.z * m1.z;
  296. w = a.w + m0.w * m1.w;
  297. }
  300. #if !defined( HK_VECTOR4_setCross)
  301. inline void hkVector4::setCross(const hkVector4& v1, const hkVector4& v2)
  302. {
  303. const hkReal nx = v1(1)*v2(2) - v1(2)*v2(1);
  304. const hkReal ny = v1(2)*v2(0) - v1(0)*v2(2);
  305. const hkReal nz = v1(0)*v2(1) - v1(1)*v2(0);
  306. this->set( nx, ny, nz , 0.0f );
  307. }
  308. #endif // HK_VECTOR4_SET_CROSS
  311. inline void hkVector4::setInterpolate4(const hkVector4& v0, const hkVector4& v1, hkSimdRealParameter rt)
  312. {
  313. hkReal t = hkReal(rt);
  314. hkReal s = 1.0f - t;
  315. hkVector4& d = *this;
  316. d(0) = s * v0(0) + t * v1(0);
  317. d(1) = s * v0(1) + t * v1(1);
  318. d(2) = s * v0(2) + t * v1(2);
  319. d(3) = s * v0(3) + t * v1(3);
  320. }
  322. inline hkVector4Comparison hkVector4::compareLessThan4(const hkVector4& a) const
  323. {
  324. hkVector4Comparison ret;
  325. ret.m_mask =
  326. ((x<a.x) ? hkVector4Comparison::MASK_X : 0) |
  327. ((y<a.y) ? hkVector4Comparison::MASK_Y : 0) |
  328. ((z<a.z) ? hkVector4Comparison::MASK_Z : 0) |
  329. ((w<a.w) ? hkVector4Comparison::MASK_W : 0);
  330. return ret;
  331. }
  333. inline hkVector4Comparison hkVector4::compareEqual4(const hkVector4& a) const
  334. {
  335. hkVector4Comparison ret;
  336. ret.m_mask =
  337. ((x==a.x) ? hkVector4Comparison::MASK_X : 0) |
  338. ((y==a.y) ? hkVector4Comparison::MASK_Y : 0) |
  339. ((z==a.z) ? hkVector4Comparison::MASK_Z : 0) |
  340. ((w==a.w) ? hkVector4Comparison::MASK_W : 0);
  341. return ret;
  342. }
  344. inline hkVector4Comparison hkVector4::compareLessThanEqual4(const hkVector4& a) const
  345. {
  346. hkVector4Comparison ret;
  347. ret.m_mask =
  348. ((x<=a.x) ? hkVector4Comparison::MASK_X : 0) |
  349. ((y<=a.y) ? hkVector4Comparison::MASK_Y : 0) |
  350. ((z<=a.z) ? hkVector4Comparison::MASK_Z : 0) |
  351. ((w<=a.w) ? hkVector4Comparison::MASK_W : 0);
  352. return ret;
  353. }
  355. inline hkVector4Comparison hkVector4::compareLessThanZero4() const
  356. {
  357. hkVector4Comparison ret;
  358. ret.m_mask =
  359. ((x<0) ? hkVector4Comparison::MASK_X : 0) |
  360. ((y<0) ? hkVector4Comparison::MASK_Y : 0) |
  361. ((z<0) ? hkVector4Comparison::MASK_Z : 0) |
  362. ((w<0) ? hkVector4Comparison::MASK_W : 0);
  363. return ret;
  364. }
  366. inline hkBool32 hkVector4::allLessThan3(hkVector4Parameter a) const
  367. {
  368. return x<a.x && y<a.y && z<a.z;
  369. }
  371. inline hkBool32 hkVector4::allLessThan4(hkVector4Parameter a) const
  372. {
  373. return x<a.x && y<a.y && z<a.z && w<a.w;
  374. }
  376. inline void hkVector4::select32( hkVector4Parameter a, hkVector4Parameter b, const hkVector4Comparison& comp)
  377. {
  378. int m = comp.getMask();
  379. x = (m & hkVector4Comparison::MASK_X) ? b.x : a.x;
  380. y = (m & hkVector4Comparison::MASK_Y) ? b.y : a.y;
  381. z = (m & hkVector4Comparison::MASK_Z) ? b.z : a.z;
  382. w = (m & hkVector4Comparison::MASK_W) ? b.w : a.w;
  383. }
  385. inline void hkVector4::setNeg4(const hkVector4& v)
  386. {
  387. x = -v.x;
  388. y = -v.y;
  389. z = -v.z;
  390. w = -v.w;
  391. }
  393. inline void hkVector4::setNeg3(const hkVector4& v)
  394. {
  395. x = -v.x;
  396. y = -v.y;
  397. z = -v.z;
  398. w =  v.w;
  399. }
  401. inline void hkVector4::setAbs4(const hkVector4& v)
  402. {
  403. x = hkMath::fabs(v.x);
  404. y = hkMath::fabs(v.y);
  405. z = hkMath::fabs(v.z);
  406. w = hkMath::fabs(v.w);
  407. }
  409. #if !defined(HK_VECTOR4_setMin4)
  410. inline void hkVector4::setMin4(const hkVector4& a, const hkVector4& b)
  411. {
  412. x = a.x < b.x ? a.x : b.x;
  413. y = a.y < b.y ? a.y : b.y;
  414. z = a.z < b.z ? a.z : b.z;
  415. w = a.w < b.w ? a.w : b.w;
  416. }
  417. #endif
  419. #if !defined( HK_VECTOR4_setMax4)
  420. inline void hkVector4::setMax4(const hkVector4& a, const hkVector4& b)
  421. {
  422. x = a.x > b.x ? a.x : b.x;
  423. y = a.y > b.y ? a.y : b.y;
  424. z = a.z > b.z ? a.z : b.z;
  425. w = a.w > b.w ? a.w : b.w;
  426. }
  427. #endif
  429. #if !defined( HK_VECTOR4__setMul3)
  430. inline void hkVector4::_setMul3( const hkMatrix3& r, const hkVector4& v )
  431. {
  432. //HK_ASSERT(0x28487ddd, hkMath::isAliased(r,this) == false );
  433. hkReal v0 = v(0);
  434. hkReal v1 = v(1);
  435. hkReal v2 = v(2);
  436. hkVector4& t = *this;
  437. t(0) = r(0,0)*v0 + r(0,1)*v1 + r(0,2)*v2;
  438. t(1) = r(1,0)*v0 + r(1,1)*v1 + r(1,2)*v2;
  439. t(2) = r(2,0)*v0 + r(2,1)*v1 + r(2,2)*v2;
  440. t(3) = 0;
  441. }
  442. #endif
  444. #if !defined( HK_VECTOR4__setMul4)
  445. inline void hkVector4::_setMul4( const hkMatrix3& t, const hkVector4& v )
  446. {
  447. //HK_ASSERT(0x28487ddd, hkMath::isAliased(t,this) == false );
  448. hkReal v0 = v(0);
  449. hkReal v1 = v(1);
  450. hkReal v2 = v(2);
  451. hkVector4& d = *this;
  452. d(0) = t(0,0)*v0 + t(0,1)*v1 + t(0,2)*v2;
  453. d(1) = t(1,0)*v0 + t(1,1)*v1 + t(1,2)*v2;
  454. d(2) = t(2,0)*v0 + t(2,1)*v1 + t(2,2)*v2;
  455. d(3) = t(3,0)*v0 + t(3,1)*v1 + t(3,2)*v2;
  456. }
  457. #endif
  459. #if !defined( HK_VECTOR4__setMul4xyz1)
  460. inline void hkVector4::_setMul4xyz1( const hkTransform& t, const hkVector4& v )
  461. {
  462. //HK_ASSERT(0x28487ddd, hkMath::isAliased(t,this) == false );
  463. hkReal v0 = v(0);
  464. hkReal v1 = v(1);
  465. hkReal v2 = v(2);
  466. hkVector4& d = *this;
  467. d(0) = t(0,0)*v0 + t(0,1)*v1 + t(0,2)*v2 + t(0,3);
  468. d(1) = t(1,0)*v0 + t(1,1)*v1 + t(1,2)*v2 + t(1,3);
  469. d(2) = t(2,0)*v0 + t(2,1)*v1 + t(2,2)*v2 + t(2,3);
  470. d(3) = t(3,0)*v0 + t(3,1)*v1 + t(3,2)*v2 + t(3,3);
  471. }
  472. #endif
  474. #if !defined( HK_VECTOR4__setRotatedDir)
  475. inline void hkVector4::_setRotatedDir(const hkRotation& r, const hkVector4& v)
  476. {
  477. _setMul3(r,v);
  478. }
  479. #endif
  481. #if !defined( HK_VECTOR4__setRotatedInverseDir)
  482. inline void hkVector4::_setRotatedInverseDir(const hkRotation& r, const hkVector4& v)
  483. {
  484. //HK_ASSERT(0x28487ddd, hkMath::isAliased(r,this) == false );
  485. hkReal v0 = v(0);
  486. hkReal v1 = v(1);
  487. hkReal v2 = v(2);
  488. hkVector4& t = *this;
  489. t(0) = r(0,0)*v0 + r(1,0)*v1 + r(2,0)*v2;
  490. t(1) = r(0,1)*v0 + r(1,1)*v1 + r(2,1)*v2;
  491. t(2) = r(0,2)*v0 + r(1,2)*v1 + r(2,2)*v2;
  492. t(3) = 0;
  493. }
  494. #endif
  496. #if !defined( HK_VECTOR4__setTransformedPos)
  497. inline void hkVector4::_setTransformedPos(const hkTransform& t, const hkVector4& v)
  498. {
  499. //HK_ASSERT(0x28487ddd, hkMath::isAliased(t,this) == false );
  500. hkReal v0 = v(0);
  501. hkReal v1 = v(1);
  502. hkReal v2 = v(2);
  503. hkVector4& d = *this;
  504. d(0) = t(0,0)*v0 + t(0,1)*v1 + t(0,2)*v2 + t(0,3);
  505. d(1) = t(1,0)*v0 + t(1,1)*v1 + t(1,2)*v2 + t(1,3);
  506. d(2) = t(2,0)*v0 + t(2,1)*v1 + t(2,2)*v2 + t(2,3);
  507. d(3) = 0;
  508. }
  509. #endif
  511. #if !defined( HK_VECTOR4__setTransformedInversePos)
  512. inline void hkVector4::_setTransformedInversePos(const hkTransform& t, const hkVector4& v)
  513. {
  514. //HK_ASSERT(0x28487ddd, hkMath::isAliased(t,this) == false );
  515. hkReal v0 = v(0) - t(0,3);
  516. hkReal v1 = v(1) - t(1,3);
  517. hkReal v2 = v(2) - t(2,3);
  519. hkVector4& d = *this;
  520. d(0) = t(0,0)*v0 + t(1,0)*v1 + t(2,0)*v2;
  521. d(1) = t(0,1)*v0 + t(1,1)*v1 + t(2,1)*v2;
  522. d(2) = t(0,2)*v0 + t(1,2)*v1 + t(2,2)*v2;
  523. d(3) = 0.0f;
  524. }
  525. #endif
  527. /* length and distance */
  529. inline hkSimdReal hkVector4::dot3(const hkVector4& a) const
  530. {
  531. return (x * a.x) + ( y * a.y ) + ( z * a.z );
  532. }
  534. inline void hkVector4::setDot3(hkVector4Parameter a, hkVector4Parameter b)
  535. {
  536. x = ( a.x * b.x ) + ( a.y * b.y ) + ( a.z * b.z );
  537. }
  539. inline hkReal hkVector4::dot3fpu(const hkVector4& a) const
  540. {
  541. return (x * a.x) + ( y * a.y ) + ( z * a.z );
  542. }
  544. inline hkSimdReal hkVector4::dot4(const hkVector4& a) const
  545. {
  546. return (x * a.x) + ( y * a.y ) + ( z * a.z ) + ( w * a.w );
  547. }
  549. inline void hkVector4::setDot4(hkVector4Parameter a, hkVector4Parameter b)
  550. {
  551. x = y = z = w = ( a.x * b.x ) + ( a.y * b.y ) + ( a.z * b.z) + ( a.w * b.w );
  552. }
  554. inline hkSimdReal hkVector4::dot4xyz1(const hkVector4& a) const
  555. {
  556. return (x * a.x) + ( y * a.y ) + ( z * a.z ) + ( w  );
  557. }
  559. inline hkSimdReal hkVector4::horizontalAdd3() const
  560. {
  561. return x+y+z;
  562. }
  564. inline hkSimdReal hkVector4::horizontalAdd4() const
  565. {
  566. return x+y+z+w;
  567. }
  569. #if !defined( HK_VECTOR4_length3)
  570. inline hkSimdReal hkVector4::length3() const
  571. {
  572. return hkMath::sqrt((x * x) + ( y * y ) + ( z * z ));
  573. }
  574. #endif
  577. inline hkSimdReal hkVector4::lengthSquared3() const
  578. {
  579. return this->dot3(*this);
  580. }
  582. #if !defined( HK_VECTOR4_lengthInverse3)
  583. inline hkSimdReal hkVector4::lengthInverse3() const
  584. {
  585. hkReal l2 = (x*x) + (y*y) + (z*z);
  586. return l2 ? hkMath::sqrtInverse(l2) : 0;
  587. }
  588. #endif
  590. #if !defined( HK_VECTOR4_length4)
  591. inline hkSimdReal hkVector4::length4() const
  592. {
  593. return hkMath::sqrt( (x * x) + (y * y) + (z * z) + (w * w) );
  594. }
  595. #endif
  597. inline hkSimdReal hkVector4::lengthSquared4() const
  598. {
  599. return this->dot4(*this);
  600. }
  602. #if !defined( HK_VECTOR4_lengthInverse4)
  603. inline hkSimdReal hkVector4::lengthInverse4() const
  604. {
  605. hkReal l2 = (x*x) + (y*y) + (z*z) + (w*w);
  606. return l2 ? hkMath::sqrtInverse(l2) : 0;
  607. }
  608. #endif
  610. #if !defined( HK_VECTOR4_normalize3 )
  611. inline void hkVector4::normalize3()
  612. {
  613. this->mul4( this->lengthInverse3() );
  614. HK_ASSERT2(0x475d86b1, isNormalized3(), "hkVector4 too small for normalize3");
  615. }
  616. #endif
  618. #if !defined( HK_VECTOR4_normalizeWithLength3)
  619. inline hkSimdReal hkVector4::normalizeWithLength3()
  620. {
  621. hkReal len = this->length3();
  622. this->mul4( (1.0f)/len );
  623. HK_ASSERT2(0x6fe84a9b, isNormalized3(), "hkVector4 too small for normalize3");
  624. return len;
  625. }
  626. #endif
  628. #if !defined( HK_VECTOR4_normalize4)
  629. inline void hkVector4::normalize4()
  630. {
  631. this->mul4( this->lengthInverse4() );
  632. HK_ASSERT2(0x21c8ab2a,  isNormalized4(), "hkVector4 too small for normalize4");
  633. }
  634. #endif
  636. #if !defined( HK_VECTOR4_normalizeWithLength4)
  637. inline hkSimdReal hkVector4::normalizeWithLength4()
  638. {
  640. hkReal len = this->length4();
  641. this->mul4( (1.0f)/len );
  642. HK_ASSERT2(0x309314d9,  isNormalized4(), "hkVector4 too small for normalize4");
  643. return len;
  644. }
  645. #endif
  647. inline void hkVector4::fastNormalize3()
  648. {
  649. normalize3();
  650. }
  652. inline void hkVector4::fastNormalize3NonZero()
  653. {
  654. hkReal l2 = (x*x) + (y*y) + (z*z);
  655. l2 = hkMath::sqrtInverse(l2);
  656. this->mul4( l2 );
  657. }
  659. inline hkSimdReal hkVector4::fastNormalizeWithLength3()
  660. {
  661. return normalizeWithLength3();
  662. }
  665. inline void hkVector4::broadcast(int i)
  666. {
  667. HK_ASSERT2(0x4a4d61ec, i>=0 && i<4, "index error in broadcast");
  668. hkReal r = (&x)[i];
  669. x = r;
  670. y = r;
  671. z = r;
  672. w = r;
  673. }
  675. inline void hkVector4::setBroadcast(const hkVector4& v, int i)
  676. {
  677. HK_ASSERT2(0x294fb42b, i>=0 && i<4, "index error in broadcast");
  678. hkReal r = (&v.x)[i];
  679. x = r;
  680. y = r;
  681. z = r;
  682. w = r;
  683. }
  685. inline void hkVector4::setBroadcast3clobberW(const hkVector4& v, int i)
  686. {
  687. HK_ASSERT2(0x294fb42b, i>=0 && i<4, "index error in broadcast");
  688. hkReal r = (&v.x)[i];
  689. x = r;
  690. y = r;
  691. z = r;
  692. w = r;
  693. }
  695. inline void hkVector4::_setTransformedPos(const hkQsTransform& a, const hkVector4& b)
  696. {
  697. hkVector4 scaled; scaled.setMul4(b, a.m_scale);
  698. hkVector4 rotated; rotated.setRotatedDir( a.m_rotation, scaled );
  699. setAdd4( rotated, a.m_translation );
  700. }
  702. inline void hkVector4::_setTransformedInversePos(const hkQsTransform& a, const hkVector4& b)
  703. {
  704. //HK_ASSERT(0x28487ddd, hkMath::isAliased(a,this) == false );
  705. hkVector4 temp(b);
  706. temp.sub4(a.m_translation);
  707. setRotatedInverseDir(a.m_rotation, temp);
  709. hkVector4 invScale; invScale.set(1.0f/a.m_scale(0), 1.0f/a.m_scale(1), 1.0f/a.m_scale(2));
  710. mul4(invScale);
  711. }
  713. /*
  714. * Havok SDK - NO SOURCE PC DOWNLOAD, BUILD(#20090216)
  715. * 
  716. * Confidential Information of Havok.  (C) Copyright 1999-2009
  717. * Telekinesys Research Limited t/a Havok. All Rights Reserved. The Havok
  718. * Logo, and the Havok buzzsaw logo are trademarks of Havok.  Title, ownership
  719. * rights, and intellectual property rights in the Havok software remain in
  720. * Havok and/or its suppliers.
  721. * 
  722. * Use of this software for evaluation purposes is subject to and indicates
  723. * acceptance of the End User licence Agreement for this product. A copy of
  724. * the license is included with this software and is also available at www.havok.com/tryhavok.
  725. * 
  726. */