2 * MMX optimized forward DCT
3 * The gcc porting is Copyright (c) 2001 Fabrice Bellard.
4 * cleanup/optimizations are Copyright (c) 2002-2004 Michael Niedermayer <michaelni@gmx.at>
5 * SSE2 optimization is Copyright (c) 2004 Denes Balatoni.
7 * from fdctam32.c - AP922 MMX(3D-Now) forward-DCT
9 * Intel Application Note AP-922 - fast, precise implementation of DCT
10 * http://developer.intel.com/vtune/cbts/appnotes.htm
12 * Also of inspiration:
13 * a page about fdct at http://www.geocities.com/ssavekar/dct.htm
14 * Skal's fdct at http://skal.planet-d.net/coding/dct.html
16 #include "../common.h"
17 #include "../dsputil.h"
20 #define ATTR_ALIGN(align) __attribute__ ((__aligned__ (align)))
22 //////////////////////////////////////////////////////////////////////
24 // constants for the forward DCT
25 // -----------------------------
27 // Be sure to check that your compiler is aligning all constants to QWORD
28 // (8-byte) memory boundaries! Otherwise the unaligned memory access will
29 // severely stall MMX execution.
31 //////////////////////////////////////////////////////////////////////
33 #define BITS_FRW_ACC 3 //; 2 or 3 for accuracy
34 #define SHIFT_FRW_COL BITS_FRW_ACC
35 #define SHIFT_FRW_ROW (BITS_FRW_ACC + 17 - 3)
36 #define RND_FRW_ROW (1 << (SHIFT_FRW_ROW-1))
37 //#define RND_FRW_COL (1 << (SHIFT_FRW_COL-1))
39 //concatenated table, for forward DCT transformation
40 static const int16_t fdct_tg_all_16
[] ATTR_ALIGN(8) = {
41 13036, 13036, 13036, 13036, // tg * (2<<16) + 0.5
42 27146, 27146, 27146, 27146, // tg * (2<<16) + 0.5
43 -21746, -21746, -21746, -21746, // tg * (2<<16) + 0.5
46 static const int16_t ocos_4_16
[4] ATTR_ALIGN(8) = {
47 23170, 23170, 23170, 23170, //cos * (2<<15) + 0.5
50 static const int64_t fdct_one_corr
ATTR_ALIGN(8) = 0x0001000100010001LL
;
52 static const int32_t fdct_r_row
[2] ATTR_ALIGN(8) = {RND_FRW_ROW
, RND_FRW_ROW
};
56 const int32_t fdct_r_row_sse2
[4] ATTR_ALIGN(16);
57 } fdct_r_row_sse2
ATTR_ALIGN(16)=
59 RND_FRW_ROW
, RND_FRW_ROW
, RND_FRW_ROW
, RND_FRW_ROW
61 //static const long fdct_r_row_sse2[4] ATTR_ALIGN(16) = {RND_FRW_ROW, RND_FRW_ROW, RND_FRW_ROW, RND_FRW_ROW};
63 static const int16_t tab_frw_01234567
[] ATTR_ALIGN(8) = { // forward_dct coeff table
64 16384, 16384, 22725, 19266,
65 16384, 16384, 12873, 4520,
66 21407, 8867, 19266, -4520,
67 -8867, -21407, -22725, -12873,
68 16384, -16384, 12873, -22725,
69 -16384, 16384, 4520, 19266,
70 8867, -21407, 4520, -12873,
71 21407, -8867, 19266, -22725,
73 22725, 22725, 31521, 26722,
74 22725, 22725, 17855, 6270,
75 29692, 12299, 26722, -6270,
76 -12299, -29692, -31521, -17855,
77 22725, -22725, 17855, -31521,
78 -22725, 22725, 6270, 26722,
79 12299, -29692, 6270, -17855,
80 29692, -12299, 26722, -31521,
82 21407, 21407, 29692, 25172,
83 21407, 21407, 16819, 5906,
84 27969, 11585, 25172, -5906,
85 -11585, -27969, -29692, -16819,
86 21407, -21407, 16819, -29692,
87 -21407, 21407, 5906, 25172,
88 11585, -27969, 5906, -16819,
89 27969, -11585, 25172, -29692,
91 19266, 19266, 26722, 22654,
92 19266, 19266, 15137, 5315,
93 25172, 10426, 22654, -5315,
94 -10426, -25172, -26722, -15137,
95 19266, -19266, 15137, -26722,
96 -19266, 19266, 5315, 22654,
97 10426, -25172, 5315, -15137,
98 25172, -10426, 22654, -26722,
100 16384, 16384, 22725, 19266,
101 16384, 16384, 12873, 4520,
102 21407, 8867, 19266, -4520,
103 -8867, -21407, -22725, -12873,
104 16384, -16384, 12873, -22725,
105 -16384, 16384, 4520, 19266,
106 8867, -21407, 4520, -12873,
107 21407, -8867, 19266, -22725,
109 19266, 19266, 26722, 22654,
110 19266, 19266, 15137, 5315,
111 25172, 10426, 22654, -5315,
112 -10426, -25172, -26722, -15137,
113 19266, -19266, 15137, -26722,
114 -19266, 19266, 5315, 22654,
115 10426, -25172, 5315, -15137,
116 25172, -10426, 22654, -26722,
118 21407, 21407, 29692, 25172,
119 21407, 21407, 16819, 5906,
120 27969, 11585, 25172, -5906,
121 -11585, -27969, -29692, -16819,
122 21407, -21407, 16819, -29692,
123 -21407, 21407, 5906, 25172,
124 11585, -27969, 5906, -16819,
125 27969, -11585, 25172, -29692,
127 22725, 22725, 31521, 26722,
128 22725, 22725, 17855, 6270,
129 29692, 12299, 26722, -6270,
130 -12299, -29692, -31521, -17855,
131 22725, -22725, 17855, -31521,
132 -22725, 22725, 6270, 26722,
133 12299, -29692, 6270, -17855,
134 29692, -12299, 26722, -31521,
139 const int16_t tab_frw_01234567_sse2
[256] ATTR_ALIGN(16);
140 } tab_frw_01234567_sse2
ATTR_ALIGN(16) =
142 //static const int16_t tab_frw_01234567_sse2[] ATTR_ALIGN(16) = { // forward_dct coeff table
143 #define TABLE_SSE2 C4, C4, C1, C3, -C6, -C2, -C1, -C5, \
144 C4, C4, C5, C7, C2, C6, C3, -C7, \
145 -C4, C4, C7, C3, C6, -C2, C7, -C5, \
146 C4, -C4, C5, -C1, C2, -C6, C3, -C1,
147 // c1..c7 * cos(pi/4) * 2^15
271 static always_inline
void fdct_col(const int16_t *in
, int16_t *out
, int offset
)
273 movq_m2r(*(in
+ offset
+ 1 * 8), mm0
);
274 movq_m2r(*(in
+ offset
+ 6 * 8), mm1
);
276 movq_m2r(*(in
+ offset
+ 2 * 8), mm3
);
277 paddsw_r2r(mm1
, mm0
);
278 movq_m2r(*(in
+ offset
+ 5 * 8), mm4
);
279 psllw_i2r(SHIFT_FRW_COL
, mm0
);
280 movq_m2r(*(in
+ offset
+ 0 * 8), mm5
);
281 paddsw_r2r(mm3
, mm4
);
282 paddsw_m2r(*(in
+ offset
+ 7 * 8), mm5
);
283 psllw_i2r(SHIFT_FRW_COL
, mm4
);
285 psubsw_r2r(mm1
, mm2
);
286 movq_m2r(*(fdct_tg_all_16
+ 4), mm1
);
287 psubsw_r2r(mm4
, mm0
);
288 movq_m2r(*(in
+ offset
+ 3 * 8), mm7
);
289 pmulhw_r2r(mm0
, mm1
);
290 paddsw_m2r(*(in
+ offset
+ 4 * 8), mm7
);
291 psllw_i2r(SHIFT_FRW_COL
, mm5
);
292 paddsw_r2r(mm4
, mm6
);
293 psllw_i2r(SHIFT_FRW_COL
, mm7
);
295 psubsw_r2r(mm7
, mm5
);
296 paddsw_r2r(mm5
, mm1
);
297 paddsw_r2r(mm7
, mm4
);
298 por_m2r(fdct_one_corr
, mm1
);
299 psllw_i2r(SHIFT_FRW_COL
+ 1, mm2
);
300 pmulhw_m2r(*(fdct_tg_all_16
+ 4), mm5
);
302 psubsw_m2r(*(in
+ offset
+ 5 * 8), mm3
);
303 psubsw_r2r(mm6
, mm4
);
304 movq_r2m(mm1
, *(out
+ offset
+ 2 * 8));
305 paddsw_r2r(mm6
, mm7
);
306 movq_m2r(*(in
+ offset
+ 3 * 8), mm1
);
307 psllw_i2r(SHIFT_FRW_COL
+ 1, mm3
);
308 psubsw_m2r(*(in
+ offset
+ 4 * 8), mm1
);
310 movq_r2m(mm4
, *(out
+ offset
+ 4 * 8));
311 paddsw_r2r(mm3
, mm2
);
312 pmulhw_m2r(*ocos_4_16
, mm2
);
313 psubsw_r2r(mm3
, mm6
);
314 pmulhw_m2r(*ocos_4_16
, mm6
);
315 psubsw_r2r(mm0
, mm5
);
316 por_m2r(fdct_one_corr
, mm5
);
317 psllw_i2r(SHIFT_FRW_COL
, mm1
);
318 por_m2r(fdct_one_corr
, mm2
);
320 movq_m2r(*(in
+ offset
+ 0 * 8), mm3
);
321 paddsw_r2r(mm6
, mm1
);
322 psubsw_m2r(*(in
+ offset
+ 7 * 8), mm3
);
323 psubsw_r2r(mm6
, mm4
);
324 movq_m2r(*(fdct_tg_all_16
+ 0), mm0
);
325 psllw_i2r(SHIFT_FRW_COL
, mm3
);
326 movq_m2r(*(fdct_tg_all_16
+ 8), mm6
);
327 pmulhw_r2r(mm1
, mm0
);
328 movq_r2m(mm7
, *(out
+ offset
+ 0 * 8));
329 pmulhw_r2r(mm4
, mm6
);
330 movq_r2m(mm5
, *(out
+ offset
+ 6 * 8));
332 movq_m2r(*(fdct_tg_all_16
+ 8), mm5
);
333 psubsw_r2r(mm2
, mm7
);
334 paddsw_r2r(mm2
, mm3
);
335 pmulhw_r2r(mm7
, mm5
);
336 paddsw_r2r(mm3
, mm0
);
337 paddsw_r2r(mm4
, mm6
);
338 pmulhw_m2r(*(fdct_tg_all_16
+ 0), mm3
);
339 por_m2r(fdct_one_corr
, mm0
);
340 paddsw_r2r(mm7
, mm5
);
341 psubsw_r2r(mm6
, mm7
);
342 movq_r2m(mm0
, *(out
+ offset
+ 1 * 8));
343 paddsw_r2r(mm4
, mm5
);
344 movq_r2m(mm7
, *(out
+ offset
+ 3 * 8));
345 psubsw_r2r(mm1
, mm3
);
346 movq_r2m(mm5
, *(out
+ offset
+ 5 * 8));
347 movq_r2m(mm3
, *(out
+ offset
+ 7 * 8));
351 static always_inline
void fdct_row_sse2(const int16_t *in
, int16_t *out
)
354 ".macro FDCT_ROW_SSE2_H1 i t \n\t"
355 "movq \\i(%0), %%xmm2 \n\t"
356 "movq \\i+8(%0), %%xmm0 \n\t"
357 "movdqa \\t+32(%1), %%xmm3 \n\t"
358 "movdqa \\t+48(%1), %%xmm7 \n\t"
359 "movdqa \\t(%1), %%xmm4 \n\t"
360 "movdqa \\t+16(%1), %%xmm5 \n\t"
362 ".macro FDCT_ROW_SSE2_H2 i t \n\t"
363 "movq \\i(%0), %%xmm2 \n\t"
364 "movq \\i+8(%0), %%xmm0 \n\t"
365 "movdqa \\t+32(%1), %%xmm3 \n\t"
366 "movdqa \\t+48(%1), %%xmm7 \n\t"
368 ".macro FDCT_ROW_SSE2 i \n\t"
369 "movq %%xmm2, %%xmm1 \n\t"
370 "pshuflw $27, %%xmm0, %%xmm0 \n\t"
371 "paddsw %%xmm0, %%xmm1 \n\t"
372 "psubsw %%xmm0, %%xmm2 \n\t"
373 "punpckldq %%xmm2, %%xmm1 \n\t"
374 "pshufd $78, %%xmm1, %%xmm2 \n\t"
375 "pmaddwd %%xmm2, %%xmm3 \n\t"
376 "pmaddwd %%xmm1, %%xmm7 \n\t"
377 "pmaddwd %%xmm5, %%xmm2 \n\t"
378 "pmaddwd %%xmm4, %%xmm1 \n\t"
379 "paddd %%xmm7, %%xmm3 \n\t"
380 "paddd %%xmm2, %%xmm1 \n\t"
381 "paddd %%xmm6, %%xmm3 \n\t"
382 "paddd %%xmm6, %%xmm1 \n\t"
383 "psrad %3, %%xmm3 \n\t"
384 "psrad %3, %%xmm1 \n\t"
385 "packssdw %%xmm3, %%xmm1 \n\t"
386 "movdqa %%xmm1, \\i(%4) \n\t"
388 "movdqa (%2), %%xmm6 \n\t"
389 "FDCT_ROW_SSE2_H1 0 0 \n\t"
390 "FDCT_ROW_SSE2 0 \n\t"
391 "FDCT_ROW_SSE2_H2 64 0 \n\t"
392 "FDCT_ROW_SSE2 64 \n\t"
394 "FDCT_ROW_SSE2_H1 16 64 \n\t"
395 "FDCT_ROW_SSE2 16 \n\t"
396 "FDCT_ROW_SSE2_H2 112 64 \n\t"
397 "FDCT_ROW_SSE2 112 \n\t"
399 "FDCT_ROW_SSE2_H1 32 128 \n\t"
400 "FDCT_ROW_SSE2 32 \n\t"
401 "FDCT_ROW_SSE2_H2 96 128 \n\t"
402 "FDCT_ROW_SSE2 96 \n\t"
404 "FDCT_ROW_SSE2_H1 48 192 \n\t"
405 "FDCT_ROW_SSE2 48 \n\t"
406 "FDCT_ROW_SSE2_H2 80 192 \n\t"
407 "FDCT_ROW_SSE2 80 \n\t"
409 : "r" (in
), "r" (tab_frw_01234567_sse2
.tab_frw_01234567_sse2
), "r" (fdct_r_row_sse2
.fdct_r_row_sse2
), "i" (SHIFT_FRW_ROW
), "r" (out
)
413 static always_inline
void fdct_row_mmx2(const int16_t *in
, int16_t *out
, const int16_t *table
)
415 pshufw_m2r(*(in
+ 4), mm5
, 0x1B);
416 movq_m2r(*(in
+ 0), mm0
);
418 paddsw_r2r(mm5
, mm0
);
419 psubsw_r2r(mm5
, mm1
);
421 punpckldq_r2r(mm1
, mm0
);
422 punpckhdq_r2r(mm1
, mm2
);
423 movq_m2r(*(table
+ 0), mm1
);
424 movq_m2r(*(table
+ 4), mm3
);
425 movq_m2r(*(table
+ 8), mm4
);
426 movq_m2r(*(table
+ 12), mm5
);
427 movq_m2r(*(table
+ 16), mm6
);
428 movq_m2r(*(table
+ 20), mm7
);
429 pmaddwd_r2r(mm0
, mm1
);
430 pmaddwd_r2r(mm2
, mm3
);
431 pmaddwd_r2r(mm0
, mm4
);
432 pmaddwd_r2r(mm2
, mm5
);
433 pmaddwd_r2r(mm0
, mm6
);
434 pmaddwd_r2r(mm2
, mm7
);
435 pmaddwd_m2r(*(table
+ 24), mm0
);
436 pmaddwd_m2r(*(table
+ 28), mm2
);
441 movq_m2r(*fdct_r_row
, mm0
);
446 psrad_i2r(SHIFT_FRW_ROW
, mm3
);
447 psrad_i2r(SHIFT_FRW_ROW
, mm5
);
448 psrad_i2r(SHIFT_FRW_ROW
, mm7
);
449 psrad_i2r(SHIFT_FRW_ROW
, mm2
);
450 packssdw_r2r(mm5
, mm3
);
451 packssdw_r2r(mm2
, mm7
);
452 movq_r2m(mm3
, *(out
+ 0));
453 movq_r2m(mm7
, *(out
+ 4));
456 static always_inline
void fdct_row_mmx(const int16_t *in
, int16_t *out
, const int16_t *table
)
458 //FIXME reorder (i dont have a old mmx only cpu here to benchmark ...)
459 movd_m2r(*(in
+ 6), mm1
);
460 punpcklwd_m2r(*(in
+ 4), mm1
);
462 psrlq_i2r(0x20, mm1
);
463 movq_m2r(*(in
+ 0), mm0
);
464 punpcklwd_r2r(mm2
, mm1
);
466 paddsw_r2r(mm1
, mm0
);
467 psubsw_r2r(mm1
, mm5
);
469 punpckldq_r2r(mm5
, mm0
);
470 punpckhdq_r2r(mm5
, mm2
);
471 movq_m2r(*(table
+ 0), mm1
);
472 movq_m2r(*(table
+ 4), mm3
);
473 movq_m2r(*(table
+ 8), mm4
);
474 movq_m2r(*(table
+ 12), mm5
);
475 movq_m2r(*(table
+ 16), mm6
);
476 movq_m2r(*(table
+ 20), mm7
);
477 pmaddwd_r2r(mm0
, mm1
);
478 pmaddwd_r2r(mm2
, mm3
);
479 pmaddwd_r2r(mm0
, mm4
);
480 pmaddwd_r2r(mm2
, mm5
);
481 pmaddwd_r2r(mm0
, mm6
);
482 pmaddwd_r2r(mm2
, mm7
);
483 pmaddwd_m2r(*(table
+ 24), mm0
);
484 pmaddwd_m2r(*(table
+ 28), mm2
);
489 movq_m2r(*fdct_r_row
, mm0
);
494 psrad_i2r(SHIFT_FRW_ROW
, mm3
);
495 psrad_i2r(SHIFT_FRW_ROW
, mm5
);
496 psrad_i2r(SHIFT_FRW_ROW
, mm7
);
497 psrad_i2r(SHIFT_FRW_ROW
, mm2
);
498 packssdw_r2r(mm5
, mm3
);
499 packssdw_r2r(mm2
, mm7
);
500 movq_r2m(mm3
, *(out
+ 0));
501 movq_r2m(mm7
, *(out
+ 4));
504 void ff_fdct_mmx(int16_t *block
)
506 int64_t align_tmp
[16] ATTR_ALIGN(8);
507 int16_t * const block_tmp
= (int16_t*)align_tmp
;
508 int16_t *block1
, *out
;
509 const int16_t *table
;
513 fdct_col(block
, block1
, 0);
514 fdct_col(block
, block1
, 4);
517 table
= tab_frw_01234567
;
520 fdct_row_mmx(block1
, out
, table
);
527 void ff_fdct_mmx2(int16_t *block
)
529 int64_t align_tmp
[16] ATTR_ALIGN(8);
530 int16_t * const block_tmp
= (int16_t*)align_tmp
;
531 int16_t *block1
, *out
;
532 const int16_t *table
;
536 fdct_col(block
, block1
, 0);
537 fdct_col(block
, block1
, 4);
540 table
= tab_frw_01234567
;
543 fdct_row_mmx2(block1
, out
, table
);
550 void ff_fdct_sse2(int16_t *block
)
552 int64_t align_tmp
[16] ATTR_ALIGN(8);
553 int16_t * const block_tmp
= (int16_t*)align_tmp
;
557 fdct_col(block
, block1
, 0);
558 fdct_col(block
, block1
, 4);
560 fdct_row_sse2(block1
, block
);