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

源码开发语言/平台
当前位置：首页 > 源码/资料 > Windows编程 > 多媒体编程 > 查看源码
GSSoftVertex.h
资源名称：fullMPCcode.rar　[点击查看]
上传用户：xjjlds
上传日期：2015-12-05
资源大小：22823k
文件大小：13k
源码类别：

多媒体编程

开发平台：

Visual C++

GSSoftVertex.h：源码内容
  1. /* 
  2.  * Copyright (C) 2003-2005 Gabest
  3.  * http://www.gabest.org
  4.  *
  5.  *  This Program is free software; you can redistribute it and/or modify
  6.  *  it under the terms of the GNU General Public License as published by
  7.  *  the Free Software Foundation; either version 2, or (at your option)
  8.  *  any later version.
  9.  *   
  10.  *  This Program is distributed in the hope that it will be useful,
  11.  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  12.  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13.  *  GNU General Public License for more details.
  14.  *   
  15.  *  You should have received a copy of the GNU General Public License
  16.  *  along with GNU Make; see the file COPYING.  If not, write to
  17.  *  the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA. 
  18.  *  http://www.gnu.org/copyleft/gpl.html
  19.  *
  20.  */
  22. #pragma once
  24. //
  25. // GSSoftVertexFP
  26. //
  28. extern const __m128i _80000000, _4b000000, _3f800000;
  30. __declspec(align(16)) union GSSoftVertexFP
  31. {
  32. class __declspec(novtable) Scalar
  33. {
  34. float val;
  36. public:
  37. Scalar() {}
  38. explicit Scalar(float f) {val = f;}
  39. explicit Scalar(int i) {val = (float)i;}
  41. float Value() const {return val;}
  43. #if _M_IX86_FP >= 2 || defined(_M_AMD64)
  44. void sat() {_mm_store_ss(&val, _mm_min_ss(_mm_max_ss(_mm_set_ss(val), _mm_setzero_ps()), _mm_set_ss(255)));}
  45. void rcp() {_mm_store_ss(&val, _mm_rcp_ss(_mm_set_ss(val)));}
  46. #else
  47. void sat() {val = val < 0 ? 0 : val > 255 ? 255 : val;}
  48. void rcp() {val = 1.0f / val;}
  49. #endif
  50. void abs() {val = fabs(val);}
  52. Scalar floor_s() const {return Scalar(floor(val));}
  53. int floor_i() const {return (int)floor(val);}
  55. Scalar ceil_s() const {return Scalar(-floor(-val));}
  56. int ceil_i() const {return -(int)floor(-val);}
  58. void operator = (float f) {val = f;}
  59. void operator = (int i) {val = (float)i;}
  61. operator float() const {return val;}
  62. operator int() const {return (int)val;}
  64. void operator += (const Scalar& s) {val += s.val;}
  65. void operator -= (const Scalar& s) {val -= s.val;}
  66. void operator *= (const Scalar& s) {val *= s.val;}
  67. void operator /= (const Scalar& s) {val /= s.val;}
  69. friend Scalar operator + (const Scalar& s1, const Scalar& s2) {return Scalar(s1.val + s2.val);}
  70. friend Scalar operator - (const Scalar& s1, const Scalar& s2) {return Scalar(s1.val - s2.val);}
  71. friend Scalar operator * (const Scalar& s1, const Scalar& s2) {return Scalar(s1.val * s2.val);}
  72. friend Scalar operator / (const Scalar& s1, const Scalar& s2) {return Scalar(s1.val / s2.val);}
  74. friend Scalar operator + (const Scalar& s, int i) {return Scalar(s.val + i);}
  75. friend Scalar operator - (const Scalar& s, int i) {return Scalar(s.val - i);}
  76. friend Scalar operator * (const Scalar& s, int i) {return Scalar(s.val * i);}
  77. friend Scalar operator / (const Scalar& s, int i) {return Scalar(s.val / i);}
  79. friend Scalar operator << (const Scalar& s, int i) {return Scalar(s.val * (1<<i));}
  80. friend Scalar operator >> (const Scalar& s, int i) {return Scalar(s.val / (1<<i));}
  82. friend bool operator == (const Scalar& s1, const Scalar& s2) {return s1.val == s2.val;}
  83. friend bool operator <= (const Scalar& s1, const Scalar& s2) {return s1.val <= s2.val;}
  84. friend bool operator < (const Scalar& s1, const Scalar& s2) {return s1.val < s2.val;}
  85. };
  87. __declspec(align(16)) class __declspec(novtable) Vector
  88. {
  89. public:
  90. union
  91. {
  92. union {struct {Scalar x, y, z, q;}; struct {Scalar r, g, b, a;};};
  93. union {struct {Scalar v[4];}; struct {Scalar c[4];};};
  94. #if _M_IX86_FP >= 2 || defined(_M_AMD64)
  95. union {__m128 xyzq; __m128 rgba;};
  96. #endif
  97. };
  99. Vector() {}
  100. Vector(const Vector& v) {*this = v;}
  101. Vector(Scalar s) {*this = s;}
  102. Vector(Scalar s0, Scalar s1, Scalar s2, Scalar s3) {x = s0; y = s1; z = s2; q = s3;}
  103. explicit Vector(DWORD dw) {*this = dw;}
  104. #if _M_IX86_FP >= 2 || defined(_M_AMD64)
  105. Vector(__m128 f0123) {*this = f0123;}
  106. #endif
  108. #if _M_IX86_FP >= 2 || defined(_M_AMD64)
  110. void operator = (const Vector& v) {xyzq = v.xyzq;}
  111. void operator = (Scalar s) {xyzq = _mm_set1_ps(s);}
  113. void operator = (__m128 f0123) {xyzq = f0123;}
  114. operator __m128() const {return xyzq;}
  116. void operator = (DWORD dw) {__m128i zero = _mm_setzero_si128(); xyzq = _mm_cvtepi32_ps(_mm_unpacklo_epi16(_mm_unpacklo_epi8(_mm_cvtsi32_si128(dw), zero), zero));}
  117. operator DWORD() const {__m128i r0 = _mm_cvttps_epi32(xyzq); r0 = _mm_packs_epi32(r0, r0); r0 = _mm_packus_epi16(r0, r0); return (DWORD)_mm_cvtsi128_si32(r0);}
  118. operator UINT64() const {__m128i r0 = _mm_cvttps_epi32(xyzq); r0 = _mm_packs_epi32(r0, r0); return *(UINT64*)&r0;}
  120. void sat() {xyzq = _mm_min_ps(_mm_max_ps(xyzq, _mm_setzero_ps()), _mm_set1_ps(255));}
  121. void rcp() {xyzq = _mm_rcp_ps(xyzq);}
  123. Vector floor()
  124. {
  125. __m128 sign = _mm_and_ps(xyzq, *(__m128*)&_80000000);
  126. __m128 r0 = _mm_or_ps(sign, *(__m128*)&_4b000000);
  127. __m128 r1 = _mm_sub_ps(_mm_add_ps(xyzq, r0), r0);
  128. __m128 r2 = _mm_sub_ps(r1, xyzq);
  129. __m128 r3 = _mm_and_ps(_mm_cmpnle_ps(r2, sign), *(__m128*)&_3f800000);
  130. __m128 r4 = _mm_sub_ps(r1, r3);
  131. return r4;
  132. }
  134. void operator += (const Vector& v) {xyzq = _mm_add_ps(xyzq, v);}
  135. void operator -= (const Vector& v) {xyzq = _mm_sub_ps(xyzq, v);}
  136. void operator *= (const Vector& v) {xyzq = _mm_mul_ps(xyzq, v);}
  137. void operator /= (const Vector& v) {xyzq = _mm_div_ps(xyzq, v);}
  139. #else
  141. void operator = (const Vector& v) {x = v.x; y = v.y; z = v.z; q = v.q;}
  142. void operator = (Scalar s) {x = y = z = q = s;}
  144. void operator = (DWORD dw)
  145. {
  146. x = Scalar((int)((dw>>0)&0xff));
  147. y = Scalar((int)((dw>>8)&0xff));
  148. z = Scalar((int)((dw>>16)&0xff));
  149. q = Scalar((int)((dw>>24)&0xff));
  150. }
  152. operator DWORD() const
  153. {
  154. return (DWORD)(
  155. (((DWORD)(int)x&0xff)<<0) |
  156. (((DWORD)(int)y&0xff)<<8) |
  157. (((DWORD)(int)z&0xff)<<16) |
  158. (((DWORD)(int)q&0xff)<<24));
  159. }
  161. operator UINT64() const
  162. {
  163. return (DWORD)(
  164. (((UINT64)(int)x&0xffff)<<0) |
  165. (((UINT64)(int)y&0xffff)<<16) |
  166. (((UINT64)(int)z&0xffff)<<32) |
  167. (((UINT64)(int)q&0xffff)<<48));
  168. }
  170. void sat() {x.sat(); y.sat(); z.sat(); q.sat();}
  171. void rcp() {x.rcp(); y.rcp(); z.rcp(); q.rcp();}
  173. Vector floor() {return Vector(x.floor_s(), y.floor_s(), z.floor_s(), q.floor_s());}
  175. void operator += (const Vector& v) {*this = *this + v;}
  176. void operator -= (const Vector& v) {*this = *this - v;}
  177. void operator *= (const Vector& v) {*this = *this * v;}
  178. void operator /= (const Vector& v) {*this = *this / v;}
  180. #endif
  182. friend Vector operator + (const Vector& v1, const Vector& v2);
  183. friend Vector operator - (const Vector& v1, const Vector& v2);
  184. friend Vector operator * (const Vector& v1, const Vector& v2);
  185. friend Vector operator / (const Vector& v1, const Vector& v2);
  187. friend Vector operator + (const Vector& v, Scalar s);
  188. friend Vector operator - (const Vector& v, Scalar s);
  189. friend Vector operator * (const Vector& v, Scalar s);
  190. friend Vector operator / (const Vector& v, Scalar s);
  191. };
  193. struct {__declspec(align(16)) Vector c, p, t;};
  194. struct {__declspec(align(16)) Vector sv[3];};
  195. struct {__declspec(align(16)) Scalar s[12];};
  197. GSSoftVertexFP() {}
  198. GSSoftVertexFP(const GSSoftVertexFP& v) {*this = v;}
  200. void operator = (const GSSoftVertexFP& v) {c = v.c; p = v.p; t = v.t;}
  201. void operator += (const GSSoftVertexFP& v) {c += v.c; p += v.p; t += v.t;}
  203. operator CPoint() const {return CPoint((int)p.x, (int)p.y);}
  205. __forceinline DWORD GetZ() const 
  206. {
  207. ASSERT((float)p.z >= 0 && (float)p.q >= 0);
  208. #if _M_IX86_FP >= 2 || defined(_M_AMD64)
  209. __m128 z = _mm_shuffle_ps(p, p, _MM_SHUFFLE(2,2,2,2));
  210. __m128 q = _mm_shuffle_ps(p, p, _MM_SHUFFLE(3,3,3,3));
  211. // TODO: check if our floor is faster than doing ss->si->ss
  212. int zh = _mm_cvttss_si32(z);
  213. __m128 zhi = _mm_cvtsi32_ss(zhi, zh);
  214. __m128 zhf = _mm_mul_ss(_mm_sub_ss(z, zhi), _mm_set_ss(65536));
  215. int zl = _mm_cvtss_si32(_mm_add_ss(zhf, q));
  216. return ((DWORD)zh << 16) + (DWORD)zl;
  217. #else
  218. // return ((DWORD)(int)p.z << 16) + (DWORD)(int)((p.z - p.z.floor_s())*65536 + p.q);
  220. int z = (int)p.z;
  221. return ((DWORD)z << 16) + (DWORD)(((float)p.z - z)*65536 + (float)p.q);
  222. #endif
  223. }
  225. };
  227. #if _M_IX86_FP >= 2 || defined(_M_AMD64)
  229. __forceinline GSSoftVertexFP::Vector operator + (const GSSoftVertexFP::Vector& v1, const GSSoftVertexFP::Vector& v2) {return GSSoftVertexFP::Vector(_mm_add_ps(v1, v2));}
  230. __forceinline GSSoftVertexFP::Vector operator - (const GSSoftVertexFP::Vector& v1, const GSSoftVertexFP::Vector& v2) {return GSSoftVertexFP::Vector(_mm_sub_ps(v1, v2));}
  231. __forceinline GSSoftVertexFP::Vector operator * (const GSSoftVertexFP::Vector& v1, const GSSoftVertexFP::Vector& v2) {return GSSoftVertexFP::Vector(_mm_mul_ps(v1, v2));}
  232. __forceinline GSSoftVertexFP::Vector operator / (const GSSoftVertexFP::Vector& v1, const GSSoftVertexFP::Vector& v2) {return GSSoftVertexFP::Vector(_mm_div_ps(v1, v2));}
  234. __forceinline GSSoftVertexFP::Vector operator + (const GSSoftVertexFP::Vector& v, GSSoftVertexFP::Scalar s) {return GSSoftVertexFP::Vector(_mm_add_ps(v, _mm_set1_ps(s)));}
  235. __forceinline GSSoftVertexFP::Vector operator - (const GSSoftVertexFP::Vector& v, GSSoftVertexFP::Scalar s) {return GSSoftVertexFP::Vector(_mm_sub_ps(v, _mm_set1_ps(s)));}
  236. __forceinline GSSoftVertexFP::Vector operator * (const GSSoftVertexFP::Vector& v, GSSoftVertexFP::Scalar s) {return GSSoftVertexFP::Vector(_mm_mul_ps(v, _mm_set1_ps(s)));}
  237. __forceinline GSSoftVertexFP::Vector operator / (const GSSoftVertexFP::Vector& v, GSSoftVertexFP::Scalar s) {return GSSoftVertexFP::Vector(_mm_div_ps(v, _mm_set1_ps(s)));}
  239. __forceinline GSSoftVertexFP::Vector operator << (const GSSoftVertexFP::Vector& v, int i) {return GSSoftVertexFP::Vector(_mm_mul_ps(v, _mm_set1_ps((float)(1 << i))));}
  240. __forceinline GSSoftVertexFP::Vector operator >> (const GSSoftVertexFP::Vector& v, int i) {return GSSoftVertexFP::Vector(_mm_mul_ps(v, _mm_set1_ps(1.0f / (1 << i))));}
  242. #else
  244. __forceinline GSSoftVertexFP::Vector operator + (const GSSoftVertexFP::Vector& v1, const GSSoftVertexFP::Vector& v2) {return GSSoftVertexFP::Vector(v1.x + v2.x, v1.y + v2.y, v1.z + v2.z, v1.q + v2.q);}
  245. __forceinline GSSoftVertexFP::Vector operator - (const GSSoftVertexFP::Vector& v1, const GSSoftVertexFP::Vector& v2) {return GSSoftVertexFP::Vector(v1.x - v2.x, v1.y - v2.y, v1.z - v2.z, v1.q - v2.q);}
  246. __forceinline GSSoftVertexFP::Vector operator * (const GSSoftVertexFP::Vector& v1, const GSSoftVertexFP::Vector& v2) {return GSSoftVertexFP::Vector(v1.x * v2.x, v1.y * v2.y, v1.z * v2.z, v1.q * v2.q);}
  247. __forceinline GSSoftVertexFP::Vector operator / (const GSSoftVertexFP::Vector& v1, const GSSoftVertexFP::Vector& v2) {return GSSoftVertexFP::Vector(v1.x / v2.x, v1.y / v2.y, v1.z / v2.z, v1.q / v2.q);}
  249. __forceinline GSSoftVertexFP::Vector operator + (const GSSoftVertexFP::Vector& v, GSSoftVertexFP::Scalar s) {return GSSoftVertexFP::Vector(v.x + s, v.y + s, v.z + s, v.q + s);}
  250. __forceinline GSSoftVertexFP::Vector operator - (const GSSoftVertexFP::Vector& v, GSSoftVertexFP::Scalar s) {return GSSoftVertexFP::Vector(v.x - s, v.y - s, v.z - s, v.q - s);}
  251. __forceinline GSSoftVertexFP::Vector operator * (const GSSoftVertexFP::Vector& v, GSSoftVertexFP::Scalar s) {return GSSoftVertexFP::Vector(v.x * s, v.y * s, v.z * s, v.q * s);}
  252. __forceinline GSSoftVertexFP::Vector operator / (const GSSoftVertexFP::Vector& v, GSSoftVertexFP::Scalar s) {return GSSoftVertexFP::Vector(v.x / s, v.y / s, v.z / s, v.q / s);}
  254. __forceinline GSSoftVertexFP::Vector operator << (const GSSoftVertexFP::Vector& v, int i) {return GSSoftVertexFP::Vector(v.x << i, v.y << i, v.z << i, v.q << i);}
  255. __forceinline GSSoftVertexFP::Vector operator >> (const GSSoftVertexFP::Vector& v, int i) {return GSSoftVertexFP::Vector(v.x >> i, v.y >> i, v.z >> i, v.q >> i);}
  257. #endif
  259. //
  261. template <class Vertex>
  262. __forceinline Vertex operator + (const Vertex& v1, const Vertex& v2)
  263. {
  264. Vertex v0;
  265. v0.c = v1.c + v2.c;
  266. v0.p = v1.p + v2.p;
  267. v0.t = v1.t + v2.t;
  268. return v0;
  269. }
  271. template <class Vertex>
  272. __forceinline Vertex operator - (const Vertex& v1, const Vertex& v2)
  273. {
  274. Vertex v0;
  275. v0.c = v1.c - v2.c;
  276. v0.p = v1.p - v2.p;
  277. v0.t = v1.t - v2.t;
  278. return v0;
  279. }
  281. template <class Vertex>
  282. __forceinline Vertex operator * (const Vertex& v, typename Vertex::Scalar s)
  283. {
  284. Vertex v0;
  285. Vertex::Vector vs(s);
  286. v0.c = v.c * vs;
  287. v0.p = v.p * vs;
  288. v0.t = v.t * vs;
  289. return v0;
  290. }
  292. template <class Vertex>
  293. __forceinline Vertex operator / (const Vertex& v, typename Vertex::Scalar s)
  294. {
  295. Vertex v0;
  296. Vertex::Vector vs(s);
  297. v0.c = v.c / vs;
  298. v0.p = v.p / vs;
  299. v0.t = v.t / vs;
  300. return v0;
  301. }
  303. template <class Vertex>
  304. __forceinline void Exchange(Vertex* RESTRICT v1, Vertex* RESTRICT v2)
  305. {
  306. typename Vertex::Vector c = v1->c, p = v1->p, t = v1->t;
  307. v1->c = v2->c; v1->p = v2->p; v1->t = v2->t;
  308. v2->c = c; v2->p = p; v2->t = t;
  309. }