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

源码开发语言/平台
当前位置：首页 > 源码/资料 > 游戏 > 游戏引擎 > 查看源码
llv4matrix4.h
资源名称：snowglobe-src-viewer-2.0.0-r0.tar.gz　[点击查看]
上传用户：king477883
上传日期：2021-03-01
资源大小：9553k
文件大小：9k
源码类别：

游戏引擎

开发平台：

C++ Builder

llv4matrix4.h：源码内容
  1. /** 
  2.  * @file llviewerjointmesh.cpp
  3.  * @brief LLV4* class header file - vector processor enabled math
  4.  *
  5.  * $LicenseInfo:firstyear=2007&license=viewergpl$
  6.  * 
  7.  * Copyright (c) 2007-2010, Linden Research, Inc.
  8.  * 
  9.  * Second Life Viewer Source Code
  10.  * The source code in this file ("Source Code") is provided by Linden Lab
  11.  * to you under the terms of the GNU General Public License, version 2.0
  12.  * ("GPL"), unless you have obtained a separate licensing agreement
  13.  * ("Other License"), formally executed by you and Linden Lab.  Terms of
  14.  * the GPL can be found in doc/GPL-license.txt in this distribution, or
  15.  * online at http://secondlifegrid.net/programs/open_source/licensing/gplv2
  16.  * 
  17.  * There are special exceptions to the terms and conditions of the GPL as
  18.  * it is applied to this Source Code. View the full text of the exception
  19.  * in the file doc/FLOSS-exception.txt in this software distribution, or
  20.  * online at
  21.  * http://secondlifegrid.net/programs/open_source/licensing/flossexception
  22.  * 
  23.  * By copying, modifying or distributing this software, you acknowledge
  24.  * that you have read and understood your obligations described above,
  25.  * and agree to abide by those obligations.
  26.  * 
  27.  * ALL LINDEN LAB SOURCE CODE IS PROVIDED "AS IS." LINDEN LAB MAKES NO
  28.  * WARRANTIES, EXPRESS, IMPLIED OR OTHERWISE, REGARDING ITS ACCURACY,
  29.  * COMPLETENESS OR PERFORMANCE.
  30.  * $/LicenseInfo$
  31.  */
  33. #ifndef LL_LLV4MATRIX4_H
  34. #define LL_LLV4MATRIX4_H
  36. #include "llv4math.h"
  37. #include "llv4matrix3.h" // just for operator LLV4Matrix3()
  38. #include "llv4vector3.h"
  40. //-----------------------------------------------------------------------------
  41. //-----------------------------------------------------------------------------
  42. // LLV4Matrix4
  43. //-----------------------------------------------------------------------------
  44. //-----------------------------------------------------------------------------
  46. LL_LLV4MATH_ALIGN_PREFIX
  48. class LLV4Matrix4
  49. {
  50. public:
  51. union {
  52. F32 mMatrix[LLV4_NUM_AXIS][LLV4_NUM_AXIS];
  53. V4F32 mV[LLV4_NUM_AXIS];
  54. };
  56. void lerp(const LLV4Matrix4 &a, const LLV4Matrix4 &b, const F32 &w);
  57. void multiply(const LLVector3 &a, LLVector3& o) const;
  58. void multiply(const LLVector3 &a, LLV4Vector3& o) const;
  60. const LLV4Matrix4& transpose();
  61. const LLV4Matrix4&  translate(const LLVector3 &vec);
  62. const LLV4Matrix4&  translate(const LLV4Vector3 &vec);
  63. const LLV4Matrix4& operator=(const LLMatrix4& a);
  65. operator LLMatrix4() const { return *(reinterpret_cast<const LLMatrix4*>(const_cast<const F32*>(&mMatrix[0][0]))); }
  66. operator LLV4Matrix3() const { return *(reinterpret_cast<const LLV4Matrix3*>(const_cast<const F32*>(&mMatrix[0][0]))); }
  68. friend LLVector3 operator*(const LLVector3 &a, const LLV4Matrix4 &b);
  69. }
  71. LL_LLV4MATH_ALIGN_POSTFIX;
  73. //-----------------------------------------------------------------------------
  74. //-----------------------------------------------------------------------------
  75. // LLV4Matrix4 - SSE
  76. //-----------------------------------------------------------------------------
  77. //-----------------------------------------------------------------------------
  79. #if LL_VECTORIZE
  81. inline void LLV4Matrix4::lerp(const LLV4Matrix4 &a, const LLV4Matrix4 &b, const F32 &w)
  82. {
  83. __m128 vw = _mm_set1_ps(w);
  84. mV[VX] = _mm_add_ps(_mm_mul_ps(_mm_sub_ps(b.mV[VX], a.mV[VX]), vw), a.mV[VX]); // ( b - a ) * w + a
  85. mV[VY] = _mm_add_ps(_mm_mul_ps(_mm_sub_ps(b.mV[VY], a.mV[VY]), vw), a.mV[VY]);
  86. mV[VZ] = _mm_add_ps(_mm_mul_ps(_mm_sub_ps(b.mV[VZ], a.mV[VZ]), vw), a.mV[VZ]);
  87. mV[VW] = _mm_add_ps(_mm_mul_ps(_mm_sub_ps(b.mV[VW], a.mV[VW]), vw), a.mV[VW]);
  88. }
  90. inline void LLV4Matrix4::multiply(const LLVector3 &a, LLVector3& o) const
  91. {
  92. LLV4Vector3 j;
  93. j.v = _mm_add_ps(mV[VW], _mm_mul_ps(_mm_set1_ps(a.mV[VX]), mV[VX])); // ( ax * vx ) + vw
  94. j.v = _mm_add_ps(j.v   , _mm_mul_ps(_mm_set1_ps(a.mV[VY]), mV[VY]));
  95. j.v = _mm_add_ps(j.v   , _mm_mul_ps(_mm_set1_ps(a.mV[VZ]), mV[VZ]));
  96. o.setVec(j.mV);
  97. }
  99. inline void LLV4Matrix4::multiply(const LLVector3 &a, LLV4Vector3& o) const
  100. {
  101. o.v = _mm_add_ps(mV[VW], _mm_mul_ps(_mm_set1_ps(a.mV[VX]), mV[VX])); // ( ax * vx ) + vw
  102. o.v = _mm_add_ps(o.v   , _mm_mul_ps(_mm_set1_ps(a.mV[VY]), mV[VY]));
  103. o.v = _mm_add_ps(o.v   , _mm_mul_ps(_mm_set1_ps(a.mV[VZ]), mV[VZ]));
  104. }
  106. inline const LLV4Matrix4& LLV4Matrix4::translate(const LLV4Vector3 &vec)
  107. {
  108. mV[VW] = _mm_add_ps(mV[VW], vec.v);
  109. return (*this);
  110. }
  112. //-----------------------------------------------------------------------------
  113. //-----------------------------------------------------------------------------
  114. // LLV4Matrix4
  115. //-----------------------------------------------------------------------------
  116. //-----------------------------------------------------------------------------
  118. #else
  120. inline void LLV4Matrix4::lerp(const LLV4Matrix4 &a, const LLV4Matrix4 &b, const F32 &w)
  121. {
  122. mMatrix[VX][VX] = llv4lerp(a.mMatrix[VX][VX], b.mMatrix[VX][VX], w);
  123. mMatrix[VX][VY] = llv4lerp(a.mMatrix[VX][VY], b.mMatrix[VX][VY], w);
  124. mMatrix[VX][VZ] = llv4lerp(a.mMatrix[VX][VZ], b.mMatrix[VX][VZ], w);
  126. mMatrix[VY][VX] = llv4lerp(a.mMatrix[VY][VX], b.mMatrix[VY][VX], w);
  127. mMatrix[VY][VY] = llv4lerp(a.mMatrix[VY][VY], b.mMatrix[VY][VY], w);
  128. mMatrix[VY][VZ] = llv4lerp(a.mMatrix[VY][VZ], b.mMatrix[VY][VZ], w);
  130. mMatrix[VZ][VX] = llv4lerp(a.mMatrix[VZ][VX], b.mMatrix[VZ][VX], w);
  131. mMatrix[VZ][VY] = llv4lerp(a.mMatrix[VZ][VY], b.mMatrix[VZ][VY], w);
  132. mMatrix[VZ][VZ] = llv4lerp(a.mMatrix[VZ][VZ], b.mMatrix[VZ][VZ], w);
  134. mMatrix[VW][VX] = llv4lerp(a.mMatrix[VW][VX], b.mMatrix[VW][VX], w);
  135. mMatrix[VW][VY] = llv4lerp(a.mMatrix[VW][VY], b.mMatrix[VW][VY], w);
  136. mMatrix[VW][VZ] = llv4lerp(a.mMatrix[VW][VZ], b.mMatrix[VW][VZ], w);
  137. }
  139. inline void LLV4Matrix4::multiply(const LLVector3 &a, LLVector3& o) const
  140. {
  141. o.setVec( a.mV[VX] * mMatrix[VX][VX] + 
  142. a.mV[VY] * mMatrix[VY][VX] + 
  143. a.mV[VZ] * mMatrix[VZ][VX] +
  144. mMatrix[VW][VX],
  145.  
  146. a.mV[VX] * mMatrix[VX][VY] + 
  147. a.mV[VY] * mMatrix[VY][VY] + 
  148. a.mV[VZ] * mMatrix[VZ][VY] +
  149. mMatrix[VW][VY],
  150.  
  151. a.mV[VX] * mMatrix[VX][VZ] + 
  152. a.mV[VY] * mMatrix[VY][VZ] + 
  153. a.mV[VZ] * mMatrix[VZ][VZ] +
  154. mMatrix[VW][VZ]);
  155. }
  157. inline void LLV4Matrix4::multiply(const LLVector3 &a, LLV4Vector3& o) const
  158. {
  159. o.setVec( a.mV[VX] * mMatrix[VX][VX] + 
  160. a.mV[VY] * mMatrix[VY][VX] + 
  161. a.mV[VZ] * mMatrix[VZ][VX] +
  162. mMatrix[VW][VX],
  163.  
  164. a.mV[VX] * mMatrix[VX][VY] + 
  165. a.mV[VY] * mMatrix[VY][VY] + 
  166. a.mV[VZ] * mMatrix[VZ][VY] +
  167. mMatrix[VW][VY],
  168.  
  169. a.mV[VX] * mMatrix[VX][VZ] + 
  170. a.mV[VY] * mMatrix[VY][VZ] + 
  171. a.mV[VZ] * mMatrix[VZ][VZ] +
  172. mMatrix[VW][VZ]);
  173. }
  175. inline const LLV4Matrix4& LLV4Matrix4::translate(const LLV4Vector3 &vec)
  176. {
  177. mMatrix[3][0] += vec.mV[0];
  178. mMatrix[3][1] += vec.mV[1];
  179. mMatrix[3][2] += vec.mV[2];
  180. return (*this);
  181. }
  183. //-----------------------------------------------------------------------------
  184. //-----------------------------------------------------------------------------
  185. // LLV4Matrix4
  186. //-----------------------------------------------------------------------------
  187. //-----------------------------------------------------------------------------
  189. #endif
  191. inline const LLV4Matrix4& LLV4Matrix4::operator=(const LLMatrix4& a)
  192. {
  193. memcpy(mMatrix, a.mMatrix, sizeof(F32) * 16 );
  194. return *this;
  195. }
  197. inline const LLV4Matrix4& LLV4Matrix4::transpose()
  198. {
  199. #if LL_VECTORIZE && defined(_MM_TRANSPOSE4_PS)
  200. _MM_TRANSPOSE4_PS(mV[VX], mV[VY], mV[VZ], mV[VW]);
  201. #else
  202. LLV4Matrix4 mat;
  203. mat.mMatrix[0][0] = mMatrix[0][0];
  204. mat.mMatrix[1][0] = mMatrix[0][1];
  205. mat.mMatrix[2][0] = mMatrix[0][2];
  206. mat.mMatrix[3][0] = mMatrix[0][3];
  208. mat.mMatrix[0][1] = mMatrix[1][0];
  209. mat.mMatrix[1][1] = mMatrix[1][1];
  210. mat.mMatrix[2][1] = mMatrix[1][2];
  211. mat.mMatrix[3][1] = mMatrix[1][3];
  213. mat.mMatrix[0][2] = mMatrix[2][0];
  214. mat.mMatrix[1][2] = mMatrix[2][1];
  215. mat.mMatrix[2][2] = mMatrix[2][2];
  216. mat.mMatrix[3][2] = mMatrix[2][3];
  218. mat.mMatrix[0][3] = mMatrix[3][0];
  219. mat.mMatrix[1][3] = mMatrix[3][1];
  220. mat.mMatrix[2][3] = mMatrix[3][2];
  221. mat.mMatrix[3][3] = mMatrix[3][3];
  223. *this = mat;
  224. #endif
  225. return *this;
  226. }
  228. inline const LLV4Matrix4& LLV4Matrix4::translate(const LLVector3 &vec)
  229. {
  230. mMatrix[3][0] += vec.mV[0];
  231. mMatrix[3][1] += vec.mV[1];
  232. mMatrix[3][2] += vec.mV[2];
  233. return (*this);
  234. }
  236. inline LLVector3 operator*(const LLVector3 &a, const LLV4Matrix4 &b)
  237. {
  238. return LLVector3(a.mV[VX] * b.mMatrix[VX][VX] + 
  239.  a.mV[VY] * b.mMatrix[VY][VX] + 
  240.  a.mV[VZ] * b.mMatrix[VZ][VX] +
  241.  b.mMatrix[VW][VX],
  242.  
  243.  a.mV[VX] * b.mMatrix[VX][VY] + 
  244.  a.mV[VY] * b.mMatrix[VY][VY] + 
  245.  a.mV[VZ] * b.mMatrix[VZ][VY] +
  246.  b.mMatrix[VW][VY],
  247.  
  248.  a.mV[VX] * b.mMatrix[VX][VZ] + 
  249.  a.mV[VY] * b.mMatrix[VY][VZ] + 
  250.  a.mV[VZ] * b.mMatrix[VZ][VZ] +
  251.  b.mMatrix[VW][VZ]);
  252. }
  255. #endif