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

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

多媒体编程

开发平台：

Visual C++

idctfpu.cpp：源码内容
  1. #include "stdafx.h"
  3. /* idct.c, inverse fast discrete cosine transform                           */
  6. /*************************************************************/
  7. /* inverse two dimensional DCT, Chen-Wang algorithm          */
  8. /* (cf. IEEE ASSP-32, pp. 803-816, Aug. 1984)                */
  9. /*                                                           */
  10. /* floating point conversion by Miha Peternel                */
  11. /* x87 hand-optimized assembly by Miha Peternel              */
  12. /*                                    27.11. - 11.12.2000    */
  13. /*                                                           */
  14. /* You are free to use this code in your project if:         */
  15. /* - no changes are made to this message                     */
  16. /* - any changes to this code are publicly available         */
  17. /* - your project documentation contains the following text: */
  18. /*   "This software contains fast high-quality IDCT decoder  */
  19. /*    by Miha Peternel."                                     */
  20. /*                                                           */
  21. /*************************************************************/
  24. /////////////////////////////////////////////////////
  25. //
  26. // TODO:
  27. // - loops can be easily vectorized for SIMD
  28. //
  29. /////////////////////////////////////////////////////
  31. #include <math.h>
  32. #  define PI 3.1415926535897932384626433832795
  34. #define FLOAT double
  36. const static double RC = 1.0*1024*1024*1024*1024*256*16 + 1024; // magic + clip center
  38. static FLOAT W1; // /* sqrt(2)*cos(1*pi/16) */
  39. static FLOAT W2; // /* sqrt(2)*cos(2*pi/16) */
  40. static FLOAT W5; // /* sqrt(2)*cos(5*pi/16) */
  42. static FLOAT W1_8;
  43. static FLOAT W2_8;
  44. static FLOAT W5_8;
  46. static FLOAT W7; // /* sqrt(2)*cos(7*pi/16) */
  47. static FLOAT W1mW7; // W1-W7
  48. static FLOAT W1pW7; // W1+W7
  50. static FLOAT W3; // /* sqrt(2)*cos(3*pi/16) */
  51. static FLOAT W3mW5; // W3-W5
  52. static FLOAT W3pW5; // W3+W5
  54. static FLOAT W6; // /* sqrt(2)*cos(6*pi/16) */
  55. static FLOAT W2mW6; // W2-W6
  56. static FLOAT W2pW6; // W2+W6
  58. static FLOAT S2; // 1/sqrt(2)
  59. static FLOAT D8 = 1.0/8;
  61. static FLOAT W7_8;
  62. static FLOAT W1mW7_8;
  63. static FLOAT W1pW7_8;
  65. static FLOAT W3_8;
  66. static FLOAT W3mW5_8;
  67. static FLOAT W3pW5_8;
  69. static FLOAT W6_8;
  70. static FLOAT W2mW6_8;
  71. static FLOAT W2pW6_8;
  73. /* global declarations */
  75. /* private data */
  76. static short iclip[1024+1024]; /* clipping table */
  77. static short *iclp;
  79. void Initialize_FPU_IDCT()
  80. {
  81.   int i;
  83.   S2 = sqrt(0.5); // 1.0/sqrt(2);
  85.   W1 = sqrt(2.0)*cos(PI*(1.0/16)); 
  86. W1_8 = W1/8;
  87.   W2 = sqrt(2.0)*cos(PI*(2.0/16)); 
  88. W2_8 = W2/8;
  89.   W3 = sqrt(2.0)*cos(PI*(3.0/16)); 
  90. W3_8 = W3/8;
  91.   W5 = sqrt(2.0)*cos(PI*(5.0/16)); 
  92. W5_8 = W5/8;
  93.   W6 = sqrt(2.0)*cos(PI*(6.0/16)); 
  94. W6_8 = W6/8;
  95.   W7 = sqrt(2.0)*cos(PI*(7.0/16));
  96. W7_8 = W7/8;
  98.   W1mW7 = W1-W7;  W1mW7_8 = W1mW7/8;
  99.   W1pW7 = W1+W7;  W1pW7_8 = W1pW7/8;
  100.   W3mW5 = W3-W5;  W3mW5_8 = W3mW5/8;
  101.   W3pW5 = W3+W5;  W3pW5_8 = W3pW5/8;
  102.   W2mW6 = W2-W6;  W2mW6_8 = W2mW6/8;
  103.   W2pW6 = W2+W6;  W2pW6_8 = W2pW6/8;
  105.   iclp = iclip+1024;
  106.   for (i= -1024; i<1024; i++)
  107.     iclp[i] = (i<-256) ? -256 : ((i>255) ? 255 : i);
  108. }
  110. void FPU_IDCT(short *block)
  111. {
  112. int *b = (int *) block;
  113.   if( b[0]==0 && (b[31]==0x10000 || b[31]==0) )
  114. {
  115.   if( b[ 1]|b[ 2]|b[ 3]|b[ 4]|b[ 5] )
  116.   goto normal;
  117.   if( b[ 6]|b[ 7]|b[ 8]|b[ 9]|b[10] )
  118.   goto normal;
  119.   if( b[11]|b[12]|b[13]|b[14]|b[15] )
  120.   goto normal;
  121.   if( b[16]|b[17]|b[18]|b[19]|b[20] )
  122.   goto normal;
  123.   if( b[21]|b[22]|b[23]|b[24]|b[25] )
  124.   goto normal;
  125.   if( b[26]|b[27]|b[28]|b[29]|b[30] )
  126.   goto normal;
  127. b[31]=0;
  128. ////empty++;
  129. return;
  130. }
  131. normal:
  133. #define tmp  ebx
  134. #define tmp1 ebx-1*8
  135. #define tmp2 ebx-2*8
  136. #define tmp3 ebx-3*8
  137. #define int0 ebx-3*8-1*4
  138. #define int1 ebx-3*8-2*4
  139. #define int2 ebx-3*8-3*4
  140. #define int3 ebx-3*8-4*4
  141. #define int4 ebx-3*8-5*4
  142. #define int5 ebx-3*8-6*4
  143. #define int6 ebx-3*8-7*4
  144. #define int7 ebx-3*8-8*4
  145. #define SIZE 8*8*8+3*8+8*4+16 // locals + 16-byte alignment area
  146. __asm
  147. {
  148.   lea ebx,[esp-8*8*8]
  149. sub esp,SIZE
  150. and ebx,-16 // force 16-byte alignment of locals
  152. // rows
  153. mov esi,[block]
  154. lea edi,[tmp]
  155. mov ecx,8
  157. align 16
  158. Lrows:
  159.     movsx eax,word ptr [esi+2]
  160. or    eax,         [esi+4]
  161. or    eax,         [esi+8]
  162. or    eax,         [esi+12]
  163. jnz L1
  165. fild word ptr [esi+0*2]
  166. fst  qword ptr [edi+7*8]
  167. fst  qword ptr [edi+6*8]
  168. fst  qword ptr [edi+5*8]
  169. fst  qword ptr [edi+4*8]
  170. fst  qword ptr [edi+3*8]
  171. fst  qword ptr [edi+2*8]
  172. fst  qword ptr [edi+1*8]
  173. fstp qword ptr [edi+0*8]
  174. jmp L2
  176. align 16
  177. L1:
  179. fild word ptr [esi+7*2]
  180. fld st(0)
  181. fild word ptr [esi+1*2]
  182. fadd st(1),st(0)
  183. fld qword ptr [W7]
  184. fxch st(1)
  185. fmul qword ptr [W1mW7]
  186. fxch st(1)
  187. fmulp st(2),st(0)
  188. fadd st(0),st(1)
  189. fstp qword ptr [tmp1]
  190. fild word ptr [esi+3*2]
  191. fld st(0)
  192. fxch st(3)
  193. fmul qword ptr [W1pW7]
  194. fild word ptr [esi+5*2]
  195. fadd st(4),st(0)
  196. fmul qword ptr [W3mW5]
  197. fxch st(1)
  198. fsubp st(3),st(0)//fsubrp
  199. fld qword ptr [W3]
  200. fmulp st(4),st(0)
  201. fsubr st(0),st(3)
  202. fstp qword ptr [tmp2]
  203. fmul qword ptr [W3pW5]
  204. fsubp st(2),st(0)//fsubrp
  205. fxch st(1)
  206. fstp qword ptr [tmp3]
  207. fild word ptr [esi+0*2]
  208. fild word ptr [esi+4*2]
  209. fild word ptr [esi+2*2]
  210. fld st(0)
  211. fmul qword ptr [W2mW6]
  212. fld st(3)
  213. fild word ptr [esi+6*2]
  214. fxch st(5)
  215. fsub st(0),st(4)
  216. fxch st(3)
  217. fadd st(0),st(5)
  218. fxch st(1)
  219. faddp st(4),st(0)
  220. fld qword ptr [W6]
  221. fmulp st(1),st(0)
  222. fxch st(4)
  223. fmul qword ptr [W2pW6]
  224. fld qword ptr [tmp1]
  225. fsub qword ptr [tmp2]
  226. fld st(5)
  227. fxch st(3)
  228. faddp st(6),st(0)
  229. fld qword ptr [tmp1]
  230. fxch st(1)
  231. fstp qword ptr [tmp1]
  232. fld st(6)
  233. fadd qword ptr [tmp3]
  234. fxch st(1)
  235. fadd qword ptr [tmp2]
  236. fxch st(7)
  237. fsub qword ptr [tmp3]
  238. fxch st(1)
  239. fstp qword ptr [tmp2]
  240. fld st(4)
  241. fxch st(3)
  242. fsubrp st(2),st(0)//fsubp
  243. fxch st(4)
  244. fsub st(0),st(5)
  245. fxch st(2)
  246. faddp st(5),st(0)
  247. fld st(2)
  248. fsub st(0),st(1)
  249. fxch st(5)
  250. fstp qword ptr [tmp3]
  251. fld qword ptr [tmp1]
  252. fld qword ptr [S2]
  253. fxch st(4)
  254. faddp st(2),st(0)
  255. fld st(3)
  256. fxch st(1)
  257. fadd st(0),st(5)
  258. fmulp st(1),st(0)
  260. fld qword ptr [tmp3]
  261. fadd st(0),st(7)
  262. fxch st(5)
  263. fsubr qword ptr [tmp1]
  264. fxch st(5)
  265. fstp qword ptr [edi+0*8]
  266. fxch st(6)
  267. fsubr qword ptr [tmp3]
  268. fld st(2)
  269. fxch st(1)
  270. fstp qword ptr [edi+7*8]
  271. fadd qword ptr [tmp2]
  272. fxch st(3)
  273. fmulp st(4),st(0)
  274. fxch st(2)
  275. fstp qword ptr [edi+3*8]
  276. fld st(1)
  277. fadd st(0),st(5)
  278. fxch st(1)
  279. fsub qword ptr [tmp2]
  280. fxch st(2)
  281. fsubrp st(5),st(0)//fsubp
  282. fstp qword ptr [edi+1*8]
  283. fld st(2)
  284. fxch st(1)
  285. fstp qword ptr [edi+4*8]
  286. fxch st(2)
  287. fsub st(0),st(1)
  288. fxch st(2)
  289. faddp st(1),st(0)
  290. fxch st(2)
  291. fstp qword ptr [edi+6*8]
  292. fstp qword ptr [edi+5*8]
  293. fstp qword ptr [edi+2*8]
  294. L2:
  295.   add esi,8*2
  296. add edi,8*8
  297. dec ecx
  298. jnz Lrows
  300. // columns
  301.     lea esi,[tmp]
  302. mov edi,[block]
  303. lea edx,[iclip+1024*2]
  304. mov ecx,8
  306.     align 16
  307. Lcols:
  308. fld qword ptr [esi+7*8*8]
  309. fld st(0)
  310. fld qword ptr [esi+1*8*8]
  311. fadd st(1),st(0)
  312. fld qword ptr [W7_8]
  313. fxch st(1)
  314. fmul qword ptr [W1mW7_8]
  315. fxch st(1)
  316. fmulp st(2),st(0)
  317. fadd st(0),st(1)
  318. fstp qword ptr [tmp2]
  319. fld qword ptr [esi+3*8*8]
  320. fld st(0)
  321. fxch st(3)
  322. fmul qword ptr [W1pW7_8]
  323. fld qword ptr [esi+5*8*8]
  324. fadd st(4),st(0)
  325. fmul qword ptr [W3mW5_8]
  326. fxch st(1)
  327. fsubp st(3),st(0)//fsubrp
  328. fld qword ptr [W3_8]
  329. fmulp st(4),st(0)
  330. fsubr st(0),st(3)
  331. fstp qword ptr [tmp3]
  332. fld qword ptr [D8]
  333. fld qword ptr [esi+0*8*8]
  334. fmul st(0),st(1)
  335. fxch st(2)
  336. fmul qword ptr [W3pW5_8]
  337. fld qword ptr [esi+4*8*8]
  338. fmulp st(2),st(0)
  339. fld qword ptr [esi+6*8*8]
  340. fld st(3)
  341. fxch st(6)
  342. fsubrp st(2),st(0)//fsubp
  343. fld qword ptr [esi+2*8*8]
  344. fld st(0)
  345. fxch st(5)
  346. fsub st(0),st(4)
  347. fxch st(7)
  348. faddp st(4),st(0)
  349. fxch st(4)
  350. fadd st(0),st(1)
  351. fld qword ptr [W6_8]
  352. fxch st(2)
  353. fmul qword ptr [W2pW6_8]
  354. fxch st(2)
  355. fmulp st(1),st(0)
  356. fxch st(4)
  357. fmul qword ptr [W2mW6_8]
  358. fld qword ptr [tmp2]
  359. fsub qword ptr [tmp3]
  360. fxch st(2)
  361. fsubr st(0),st(5)
  362. fxch st(1)
  363. faddp st(5),st(0)
  364. fld qword ptr [tmp2]
  365. fxch st(2)
  366. fstp qword ptr [tmp2]
  367. fld st(5)
  368. fxch st(2)
  369. fadd qword ptr [tmp3]
  370. fxch st(6)
  371. fsub st(0),st(3)
  372. fxch st(2)
  373. faddp st(3),st(0)
  374. fld st(3)
  375. fsub st(0),st(5)
  376. fxch st(3)
  377. fstp qword ptr [tmp3]
  378. fxch st(3)
  379. faddp st(4),st(0)
  380. fld st(5)
  381. fld qword ptr [tmp2]
  382. fxch st(7)
  383. fsub st(0),st(4)
  384. fxch st(7)
  385. fadd st(0),st(2)
  386. fxch st(1)
  387. faddp st(4),st(0)
  388. fld qword ptr [S2]
  389. fmul st(1),st(0)
  390. fxch st(1)
  391. fstp qword ptr [tmp1]
  392. fld st(4)
  393. fadd st(0),st(6)
  394. fxch st(2)
  395. fsubr qword ptr [tmp2]
  396. fxch st(5)
  397. fsubrp st(6),st(0)//fsubp
  398. fxch st(1)
  399. fistp dword ptr [int0]
  400. fxch st(4)
  401. mov eax,[int0]
  402. movsx eax,word ptr [edx+2*eax]
  403. mov [edi+0*8*2],ax
  404. fistp dword ptr [int7]
  405. mov eax,[int7]
  406. fld st(0)
  407. movsx eax,word ptr [edx+2*eax]
  408. mov [edi+7*8*2],ax
  409. fadd qword ptr [tmp3]
  410. fistp dword ptr [int3]
  411. mov eax,[int3]
  412. movsx eax,word ptr [edx+2*eax]
  413. mov [edi+3*8*2],ax
  414. fsub qword ptr [tmp3]
  415. fld st(1)
  416. fxch st(1)
  417. fistp dword ptr [int4]
  418. mov eax,[int4]
  419. movsx eax,word ptr [edx+2*eax]
  420. mov [edi+4*8*2],ax
  421. fadd qword ptr [tmp1]
  422. fxch st(3)
  423. fmulp st(2),st(0)
  424. fxch st(2)
  425. fistp dword ptr [int1]
  426. fxch st(1)
  427. mov eax,[int1]
  428. movsx eax,word ptr [edx+2*eax]
  429. mov [edi+1*8*2],ax
  430. fsub qword ptr [tmp1]
  431. fld st(2)
  432. fsub st(0),st(2)
  433. fxch st(1)
  434. fistp dword ptr [int6]
  435. fxch st(2)
  436. mov eax,[int6]
  437. faddp st(1),st(0)
  438. movsx eax,word ptr [edx+2*eax]
  439. mov [edi+6*8*2],ax
  440. fistp dword ptr [int2]
  441. mov eax,[int2]
  442. movsx eax,word ptr [edx+2*eax]
  443. mov [edi+2*8*2],ax
  444. fistp dword ptr [int5]
  445. mov eax,[int5]
  446. movsx eax,word ptr [edx+2*eax]
  447. mov [edi+5*8*2],ax
  449.   add esi,8
  450. add edi,2
  451. dec ecx
  452. jnz Lcols
  454. add esp,SIZE
  455.   }
  456. }