Imported Debian version 2.5.0~trusty1.1
[deb_ffmpeg.git] / ffmpeg / libavfilter / libmpcodecs / vf_fspp.c
CommitLineData
2ba45a60
DM
1/*
2 * Copyright (C) 2003 Michael Niedermayer <michaelni@gmx.at>
3 * Copyright (C) 2005 Nikolaj Poroshin <porosh3@psu.ru>
4 *
5 * This file is part of MPlayer.
6 *
7 * MPlayer is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 *
12 * MPlayer is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License along
18 * with MPlayer; if not, write to the Free Software Foundation, Inc.,
19 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
20 */
21
22/*
23 * This implementation is based on an algorithm described in
24 * "Aria Nosratinia Embedded Post-Processing for
25 * Enhancement of Compressed Images (1999)"
26 * (http://citeseer.nj.nec.com/nosratinia99embedded.html)
27 * Further, with splitting (i)dct into hor/ver passes, one of them can be
28 * performed once per block, not pixel. This allows for much better speed.
29 */
30
31/*
32 Heavily optimized version of SPP filter by Nikolaj
33 */
34
35#include <stdio.h>
36#include <stdlib.h>
37#include <string.h>
38#include <inttypes.h>
39#include <math.h>
40
41#include "config.h"
42
43#include "mp_msg.h"
44#include "cpudetect.h"
45#include "img_format.h"
46#include "mp_image.h"
47#include "vf.h"
48#include "av_helpers.h"
49#include "libvo/fastmemcpy.h"
50
51#include "libavutil/internal.h"
52#include "libavutil/intreadwrite.h"
53#include "libavutil/mem.h"
54#include "libavutil/x86/asm.h"
55#include "libavcodec/avcodec.h"
56
57#undef free
58#undef malloc
59
60//===========================================================================//
61#define BLOCKSZ 12
62
63static const short custom_threshold[64]=
64// values (296) can't be too high
65// -it causes too big quant dependence
66// or maybe overflow(check), which results in some flashing
67{ 71, 296, 295, 237, 71, 40, 38, 19,
68 245, 193, 185, 121, 102, 73, 53, 27,
69 158, 129, 141, 107, 97, 73, 50, 26,
70 102, 116, 109, 98, 82, 66, 45, 23,
71 71, 94, 95, 81, 70, 56, 38, 20,
72 56, 77, 74, 66, 56, 44, 30, 15,
73 38, 53, 50, 45, 38, 30, 21, 11,
74 20, 27, 26, 23, 20, 15, 11, 5
75};
76
77DECLARE_ALIGNED(32, static const uint8_t, dither)[8][8] = {
78 { 0, 48, 12, 60, 3, 51, 15, 63, },
79 { 32, 16, 44, 28, 35, 19, 47, 31, },
80 { 8, 56, 4, 52, 11, 59, 7, 55, },
81 { 40, 24, 36, 20, 43, 27, 39, 23, },
82 { 2, 50, 14, 62, 1, 49, 13, 61, },
83 { 34, 18, 46, 30, 33, 17, 45, 29, },
84 { 10, 58, 6, 54, 9, 57, 5, 53, },
85 { 42, 26, 38, 22, 41, 25, 37, 21, },
86};
87
88struct vf_priv_s { //align 16 !
89 uint64_t threshold_mtx_noq[8*2];
90 uint64_t threshold_mtx[8*2];//used in both C & MMX (& later SSE2) versions
91
92 int log2_count;
93 int temp_stride;
94 int qp;
95 int mpeg2;
96 int prev_q;
97 uint8_t *src;
98 int16_t *temp;
99 int bframes;
100 char *non_b_qp;
101};
102
103
f6fa7814 104#if !HAVE_MMX_INLINE
2ba45a60
DM
105
106//This func reads from 1 slice, 1 and clears 0 & 1
107static void store_slice_c(uint8_t *dst, int16_t *src, int dst_stride, int src_stride, int width, int height, int log2_scale)
108{int y, x;
109#define STORE(pos) \
110 temp= (src[x + pos] + (d[pos]>>log2_scale))>>(6-log2_scale); \
111 src[x + pos]=src[x + pos - 8*src_stride]=0; \
112 if(temp & 0x100) temp= ~(temp>>31); \
113 dst[x + pos]= temp;
114
115 for(y=0; y<height; y++){
116 const uint8_t *d= dither[y];
117 for(x=0; x<width; x+=8){
118 int temp;
119 STORE(0);
120 STORE(1);
121 STORE(2);
122 STORE(3);
123 STORE(4);
124 STORE(5);
125 STORE(6);
126 STORE(7);
127 }
128 src+=src_stride;
129 dst+=dst_stride;
130 }
131}
132
133//This func reads from 2 slices, 0 & 2 and clears 2-nd
134static void store_slice2_c(uint8_t *dst, int16_t *src, int dst_stride, int src_stride, int width, int height, int log2_scale)
135{int y, x;
136#define STORE2(pos) \
137 temp= (src[x + pos] + src[x + pos + 16*src_stride] + (d[pos]>>log2_scale))>>(6-log2_scale); \
138 src[x + pos + 16*src_stride]=0; \
139 if(temp & 0x100) temp= ~(temp>>31); \
140 dst[x + pos]= temp;
141
142 for(y=0; y<height; y++){
143 const uint8_t *d= dither[y];
144 for(x=0; x<width; x+=8){
145 int temp;
146 STORE2(0);
147 STORE2(1);
148 STORE2(2);
149 STORE2(3);
150 STORE2(4);
151 STORE2(5);
152 STORE2(6);
153 STORE2(7);
154 }
155 src+=src_stride;
156 dst+=dst_stride;
157 }
158}
159
160static void mul_thrmat_c(struct vf_priv_s *p,int q)
161{
162 int a;
163 for(a=0;a<64;a++)
164 ((short*)p->threshold_mtx)[a]=q * ((short*)p->threshold_mtx_noq)[a];//ints faster in C
165}
166
167static void column_fidct_c(int16_t* thr_adr, int16_t *data, int16_t *output, int cnt);
168static void row_idct_c(int16_t* workspace,
169 int16_t* output_adr, int output_stride, int cnt);
170static void row_fdct_c(int16_t *data, const uint8_t *pixels, int line_size, int cnt);
171
172//this is rather ugly, but there is no need for function pointers
173#define store_slice_s store_slice_c
174#define store_slice2_s store_slice2_c
175#define mul_thrmat_s mul_thrmat_c
176#define column_fidct_s column_fidct_c
177#define row_idct_s row_idct_c
178#define row_fdct_s row_fdct_c
179
f6fa7814 180#else /* HAVE_MMX_INLINE */
2ba45a60
DM
181
182//This func reads from 1 slice, 1 and clears 0 & 1
183static void store_slice_mmx(uint8_t *dst, int16_t *src, long dst_stride, long src_stride, long width, long height, long log2_scale)
184{
185 const uint8_t *od=&dither[0][0];
186 const uint8_t *end=&dither[height][0];
187 width = (width+7)&~7;
188 dst_stride-=width;
189 //src_stride=(src_stride-width)*2;
190 __asm__ volatile(
191 "mov %5, %%"REG_d" \n\t"
192 "mov %6, %%"REG_S" \n\t"
193 "mov %7, %%"REG_D" \n\t"
194 "mov %1, %%"REG_a" \n\t"
195 "movd %%"REG_d", %%mm5 \n\t"
196 "xor $-1, %%"REG_d" \n\t"
197 "mov %%"REG_a", %%"REG_c" \n\t"
198 "add $7, %%"REG_d" \n\t"
199 "neg %%"REG_a" \n\t"
200 "sub %0, %%"REG_c" \n\t"
201 "add %%"REG_c", %%"REG_c" \n\t"
202 "movd %%"REG_d", %%mm2 \n\t"
203 "mov %%"REG_c", %1 \n\t"
204 "mov %2, %%"REG_d" \n\t"
205 "shl $4, %%"REG_a" \n\t"
206
207 "2: \n\t"
208 "movq (%%"REG_d"), %%mm3 \n\t"
209 "movq %%mm3, %%mm4 \n\t"
210 "pxor %%mm7, %%mm7 \n\t"
211 "punpcklbw %%mm7, %%mm3 \n\t"
212 "punpckhbw %%mm7, %%mm4 \n\t"
213 "mov %0, %%"REG_c" \n\t"
214 "psraw %%mm5, %%mm3 \n\t"
215 "psraw %%mm5, %%mm4 \n\t"
216 "1: \n\t"
217 "movq %%mm7, (%%"REG_S",%%"REG_a") \n\t"
218 "movq (%%"REG_S"), %%mm0 \n\t"
219 "movq 8(%%"REG_S"), %%mm1 \n\t"
220
221 "movq %%mm7, 8(%%"REG_S",%%"REG_a") \n\t"
222 "paddw %%mm3, %%mm0 \n\t"
223 "paddw %%mm4, %%mm1 \n\t"
224
225 "movq %%mm7, (%%"REG_S") \n\t"
226 "psraw %%mm2, %%mm0 \n\t"
227 "psraw %%mm2, %%mm1 \n\t"
228
229 "movq %%mm7, 8(%%"REG_S") \n\t"
230 "packuswb %%mm1, %%mm0 \n\t"
231 "add $16, %%"REG_S" \n\t"
232
233 "movq %%mm0, (%%"REG_D") \n\t"
234 "add $8, %%"REG_D" \n\t"
235 "sub $8, %%"REG_c" \n\t"
236 "jg 1b \n\t"
237 "add %1, %%"REG_S" \n\t"
238 "add $8, %%"REG_d" \n\t"
239 "add %3, %%"REG_D" \n\t"
240 "cmp %4, %%"REG_d" \n\t"
241 "jl 2b \n\t"
242
243 :
244 : "m" (width), "m" (src_stride), "erm" (od), "m" (dst_stride), "erm" (end),
245 "m" (log2_scale), "m" (src), "m" (dst) //input
246 : "%"REG_a, "%"REG_c, "%"REG_d, "%"REG_S, "%"REG_D
247 );
248}
249
250//This func reads from 2 slices, 0 & 2 and clears 2-nd
251static void store_slice2_mmx(uint8_t *dst, int16_t *src, long dst_stride, long src_stride, long width, long height, long log2_scale)
252{
253 const uint8_t *od=&dither[0][0];
254 const uint8_t *end=&dither[height][0];
255 width = (width+7)&~7;
256 dst_stride-=width;
257 //src_stride=(src_stride-width)*2;
258 __asm__ volatile(
259 "mov %5, %%"REG_d" \n\t"
260 "mov %6, %%"REG_S" \n\t"
261 "mov %7, %%"REG_D" \n\t"
262 "mov %1, %%"REG_a" \n\t"
263 "movd %%"REG_d", %%mm5 \n\t"
264 "xor $-1, %%"REG_d" \n\t"
265 "mov %%"REG_a", %%"REG_c" \n\t"
266 "add $7, %%"REG_d" \n\t"
267 "sub %0, %%"REG_c" \n\t"
268 "add %%"REG_c", %%"REG_c" \n\t"
269 "movd %%"REG_d", %%mm2 \n\t"
270 "mov %%"REG_c", %1 \n\t"
271 "mov %2, %%"REG_d" \n\t"
272 "shl $5, %%"REG_a" \n\t"
273
274 "2: \n\t"
275 "movq (%%"REG_d"), %%mm3 \n\t"
276 "movq %%mm3, %%mm4 \n\t"
277 "pxor %%mm7, %%mm7 \n\t"
278 "punpcklbw %%mm7, %%mm3 \n\t"
279 "punpckhbw %%mm7, %%mm4 \n\t"
280 "mov %0, %%"REG_c" \n\t"
281 "psraw %%mm5, %%mm3 \n\t"
282 "psraw %%mm5, %%mm4 \n\t"
283 "1: \n\t"
284 "movq (%%"REG_S"), %%mm0 \n\t"
285 "movq 8(%%"REG_S"), %%mm1 \n\t"
286 "paddw %%mm3, %%mm0 \n\t"
287
288 "paddw (%%"REG_S",%%"REG_a"), %%mm0 \n\t"
289 "paddw %%mm4, %%mm1 \n\t"
290 "movq 8(%%"REG_S",%%"REG_a"), %%mm6 \n\t"
291
292 "movq %%mm7, (%%"REG_S",%%"REG_a") \n\t"
293 "psraw %%mm2, %%mm0 \n\t"
294 "paddw %%mm6, %%mm1 \n\t"
295
296 "movq %%mm7, 8(%%"REG_S",%%"REG_a") \n\t"
297 "psraw %%mm2, %%mm1 \n\t"
298 "packuswb %%mm1, %%mm0 \n\t"
299
300 "movq %%mm0, (%%"REG_D") \n\t"
301 "add $16, %%"REG_S" \n\t"
302 "add $8, %%"REG_D" \n\t"
303 "sub $8, %%"REG_c" \n\t"
304 "jg 1b \n\t"
305 "add %1, %%"REG_S" \n\t"
306 "add $8, %%"REG_d" \n\t"
307 "add %3, %%"REG_D" \n\t"
308 "cmp %4, %%"REG_d" \n\t"
309 "jl 2b \n\t"
310
311 :
312 : "m" (width), "m" (src_stride), "erm" (od), "m" (dst_stride), "erm" (end),
313 "m" (log2_scale), "m" (src), "m" (dst) //input
314 : "%"REG_a, "%"REG_c, "%"REG_d, "%"REG_D, "%"REG_S
315 );
316}
317
318static void mul_thrmat_mmx(struct vf_priv_s *p, int q)
319{
320 uint64_t *adr=&p->threshold_mtx_noq[0];
321 __asm__ volatile(
322 "movd %0, %%mm7 \n\t"
323 "add $8*8*2, %%"REG_D" \n\t"
324 "movq 0*8(%%"REG_S"), %%mm0 \n\t"
325 "punpcklwd %%mm7, %%mm7 \n\t"
326 "movq 1*8(%%"REG_S"), %%mm1 \n\t"
327 "punpckldq %%mm7, %%mm7 \n\t"
328 "pmullw %%mm7, %%mm0 \n\t"
329
330 "movq 2*8(%%"REG_S"), %%mm2 \n\t"
331 "pmullw %%mm7, %%mm1 \n\t"
332
333 "movq 3*8(%%"REG_S"), %%mm3 \n\t"
334 "pmullw %%mm7, %%mm2 \n\t"
335
336 "movq %%mm0, 0*8(%%"REG_D") \n\t"
337 "movq 4*8(%%"REG_S"), %%mm4 \n\t"
338 "pmullw %%mm7, %%mm3 \n\t"
339
340 "movq %%mm1, 1*8(%%"REG_D") \n\t"
341 "movq 5*8(%%"REG_S"), %%mm5 \n\t"
342 "pmullw %%mm7, %%mm4 \n\t"
343
344 "movq %%mm2, 2*8(%%"REG_D") \n\t"
345 "movq 6*8(%%"REG_S"), %%mm6 \n\t"
346 "pmullw %%mm7, %%mm5 \n\t"
347
348 "movq %%mm3, 3*8(%%"REG_D") \n\t"
349 "movq 7*8+0*8(%%"REG_S"), %%mm0 \n\t"
350 "pmullw %%mm7, %%mm6 \n\t"
351
352 "movq %%mm4, 4*8(%%"REG_D") \n\t"
353 "movq 7*8+1*8(%%"REG_S"), %%mm1 \n\t"
354 "pmullw %%mm7, %%mm0 \n\t"
355
356 "movq %%mm5, 5*8(%%"REG_D") \n\t"
357 "movq 7*8+2*8(%%"REG_S"), %%mm2 \n\t"
358 "pmullw %%mm7, %%mm1 \n\t"
359
360 "movq %%mm6, 6*8(%%"REG_D") \n\t"
361 "movq 7*8+3*8(%%"REG_S"), %%mm3 \n\t"
362 "pmullw %%mm7, %%mm2 \n\t"
363
364 "movq %%mm0, 7*8+0*8(%%"REG_D") \n\t"
365 "movq 7*8+4*8(%%"REG_S"), %%mm4 \n\t"
366 "pmullw %%mm7, %%mm3 \n\t"
367
368 "movq %%mm1, 7*8+1*8(%%"REG_D") \n\t"
369 "movq 7*8+5*8(%%"REG_S"), %%mm5 \n\t"
370 "pmullw %%mm7, %%mm4 \n\t"
371
372 "movq %%mm2, 7*8+2*8(%%"REG_D") \n\t"
373 "movq 7*8+6*8(%%"REG_S"), %%mm6 \n\t"
374 "pmullw %%mm7, %%mm5 \n\t"
375
376 "movq %%mm3, 7*8+3*8(%%"REG_D") \n\t"
377 "movq 14*8+0*8(%%"REG_S"), %%mm0 \n\t"
378 "pmullw %%mm7, %%mm6 \n\t"
379
380 "movq %%mm4, 7*8+4*8(%%"REG_D") \n\t"
381 "movq 14*8+1*8(%%"REG_S"), %%mm1 \n\t"
382 "pmullw %%mm7, %%mm0 \n\t"
383
384 "movq %%mm5, 7*8+5*8(%%"REG_D") \n\t"
385 "pmullw %%mm7, %%mm1 \n\t"
386
387 "movq %%mm6, 7*8+6*8(%%"REG_D") \n\t"
388 "movq %%mm0, 14*8+0*8(%%"REG_D") \n\t"
389 "movq %%mm1, 14*8+1*8(%%"REG_D") \n\t"
390
391 : "+g" (q), "+S" (adr), "+D" (adr)
392 :
393 );
394}
395
396static void column_fidct_mmx(int16_t* thr_adr, int16_t *data, int16_t *output, int cnt);
397static void row_idct_mmx(int16_t* workspace,
398 int16_t* output_adr, int output_stride, int cnt);
399static void row_fdct_mmx(int16_t *data, const uint8_t *pixels, int line_size, int cnt);
400
401#define store_slice_s store_slice_mmx
402#define store_slice2_s store_slice2_mmx
403#define mul_thrmat_s mul_thrmat_mmx
404#define column_fidct_s column_fidct_mmx
405#define row_idct_s row_idct_mmx
406#define row_fdct_s row_fdct_mmx
f6fa7814 407#endif // HAVE_MMX_INLINE
2ba45a60
DM
408
409static void filter(struct vf_priv_s *p, uint8_t *dst, uint8_t *src,
410 int dst_stride, int src_stride,
411 int width, int height,
412 uint8_t *qp_store, int qp_stride, int is_luma)
413{
414 int x, x0, y, es, qy, t;
415 const int stride= is_luma ? p->temp_stride : (width+16);//((width+16+15)&(~15))
416 const int step=6-p->log2_count;
417 const int qps= 3 + is_luma;
418 DECLARE_ALIGNED(32, int32_t, block_align)[4*8*BLOCKSZ+ 4*8*BLOCKSZ];
419 int16_t *block= (int16_t *)block_align;
420 int16_t *block3=(int16_t *)(block_align+4*8*BLOCKSZ);
421
422 memset(block3, 0, 4*8*BLOCKSZ);
423
424 //p->src=src-src_stride*8-8;//!
425 if (!src || !dst) return; // HACK avoid crash for Y8 colourspace
426 for(y=0; y<height; y++){
427 int index= 8 + 8*stride + y*stride;
428 fast_memcpy(p->src + index, src + y*src_stride, width);//this line can be avoided by using DR & user fr.buffers
429 for(x=0; x<8; x++){
430 p->src[index - x - 1]= p->src[index + x ];
431 p->src[index + width + x ]= p->src[index + width - x - 1];
432 }
433 }
434 for(y=0; y<8; y++){
435 fast_memcpy(p->src + ( 7-y)*stride, p->src + ( y+8)*stride, stride);
436 fast_memcpy(p->src + (height+8+y)*stride, p->src + (height-y+7)*stride, stride);
437 }
438 //FIXME (try edge emu)
439
440 for(y=8; y<24; y++)
441 memset(p->temp+ 8 +y*stride, 0,width*sizeof(int16_t));
442
443 for(y=step; y<height+8; y+=step){ //step= 1,2
444 qy=y-4;
445 if (qy>height-1) qy=height-1;
446 if (qy<0) qy=0;
447 qy=(qy>>qps)*qp_stride;
448 row_fdct_s(block, p->src + y*stride +2-(y&1), stride, 2);
449 for(x0=0; x0<width+8-8*(BLOCKSZ-1); x0+=8*(BLOCKSZ-1)){
450 row_fdct_s(block+8*8, p->src + y*stride+8+x0 +2-(y&1), stride, 2*(BLOCKSZ-1));
451 if(p->qp)
452 column_fidct_s((int16_t*)(&p->threshold_mtx[0]), block+0*8, block3+0*8, 8*(BLOCKSZ-1)); //yes, this is a HOTSPOT
453 else
454 for (x=0; x<8*(BLOCKSZ-1); x+=8) {
455 t=x+x0-2; //correct t=x+x0-2-(y&1), but its the same
456 if (t<0) t=0;//t always < width-2
457 t=qp_store[qy+(t>>qps)];
458 t=norm_qscale(t, p->mpeg2);
459 if (t!=p->prev_q) p->prev_q=t, mul_thrmat_s(p, t);
460 column_fidct_s((int16_t*)(&p->threshold_mtx[0]), block+x*8, block3+x*8, 8); //yes, this is a HOTSPOT
461 }
462 row_idct_s(block3+0*8, p->temp + (y&15)*stride+x0+2-(y&1), stride, 2*(BLOCKSZ-1));
463 memmove(block, block+(BLOCKSZ-1)*64, 8*8*sizeof(int16_t)); //cycling
464 memmove(block3, block3+(BLOCKSZ-1)*64, 6*8*sizeof(int16_t));
465 }
466 //
467 es=width+8-x0; // 8, ...
468 if (es>8)
469 row_fdct_s(block+8*8, p->src + y*stride+8+x0 +2-(y&1), stride, (es-4)>>2);
470 column_fidct_s((int16_t*)(&p->threshold_mtx[0]), block, block3, es&(~1));
471 row_idct_s(block3+0*8, p->temp + (y&15)*stride+x0+2-(y&1), stride, es>>2);
472 {const int y1=y-8+step;//l5-7 l4-6
473 if (!(y1&7) && y1) {
474 if (y1&8) store_slice_s(dst + (y1-8)*dst_stride, p->temp+ 8 +8*stride,
475 dst_stride, stride, width, 8, 5-p->log2_count);
476 else store_slice2_s(dst + (y1-8)*dst_stride, p->temp+ 8 +0*stride,
477 dst_stride, stride, width, 8, 5-p->log2_count);
478 } }
479 }
480
481 if (y&7) { // == height & 7
482 if (y&8) store_slice_s(dst + ((y-8)&~7)*dst_stride, p->temp+ 8 +8*stride,
483 dst_stride, stride, width, y&7, 5-p->log2_count);
484 else store_slice2_s(dst + ((y-8)&~7)*dst_stride, p->temp+ 8 +0*stride,
485 dst_stride, stride, width, y&7, 5-p->log2_count);
486 }
487}
488
489static int config(struct vf_instance *vf,
490 int width, int height, int d_width, int d_height,
491 unsigned int flags, unsigned int outfmt)
492{
493 int h= (height+16+15)&(~15);
494
495 vf->priv->temp_stride= (width+16+15)&(~15);
496 vf->priv->temp= (int16_t*)av_mallocz(vf->priv->temp_stride*3*8*sizeof(int16_t));
497 //this can also be avoided, see above
498 vf->priv->src = (uint8_t*)av_malloc(vf->priv->temp_stride*h*sizeof(uint8_t));
499
500 return ff_vf_next_config(vf,width,height,d_width,d_height,flags,outfmt);
501}
502
503static void get_image(struct vf_instance *vf, mp_image_t *mpi)
504{
505 if(mpi->flags&MP_IMGFLAG_PRESERVE) return; // don't change
506 // ok, we can do pp in-place (or pp disabled):
507 vf->dmpi=ff_vf_get_image(vf->next,mpi->imgfmt,
508 mpi->type, mpi->flags, mpi->width, mpi->height);
509 mpi->planes[0]=vf->dmpi->planes[0];
510 mpi->stride[0]=vf->dmpi->stride[0];
511 mpi->width=vf->dmpi->width;
512 if(mpi->flags&MP_IMGFLAG_PLANAR){
513 mpi->planes[1]=vf->dmpi->planes[1];
514 mpi->planes[2]=vf->dmpi->planes[2];
515 mpi->stride[1]=vf->dmpi->stride[1];
516 mpi->stride[2]=vf->dmpi->stride[2];
517 }
518 mpi->flags|=MP_IMGFLAG_DIRECT;
519}
520
521static int put_image(struct vf_instance *vf, mp_image_t *mpi, double pts)
522{
523 mp_image_t *dmpi;
524 if(!(mpi->flags&MP_IMGFLAG_DIRECT)){
525 // no DR, so get a new image! hope we'll get DR buffer:
526 dmpi=ff_vf_get_image(vf->next,mpi->imgfmt,
527 MP_IMGTYPE_TEMP,
528 MP_IMGFLAG_ACCEPT_STRIDE|MP_IMGFLAG_PREFER_ALIGNED_STRIDE,
529 mpi->width,mpi->height);
530 ff_vf_clone_mpi_attributes(dmpi, mpi);
531 }else{
532 dmpi=vf->dmpi;
533 }
534
535 vf->priv->mpeg2= mpi->qscale_type;
536 if(mpi->pict_type != 3 && mpi->qscale && !vf->priv->qp){
537 int w = mpi->qstride;
538 int h = (mpi->h + 15) >> 4;
539 if (!w) {
540 w = (mpi->w + 15) >> 4;
541 h = 1;
542 }
543 if(!vf->priv->non_b_qp)
544 vf->priv->non_b_qp= malloc(w*h);
545 fast_memcpy(vf->priv->non_b_qp, mpi->qscale, w*h);
546 }
547 if(vf->priv->log2_count || !(mpi->flags&MP_IMGFLAG_DIRECT)){
548 char *qp_tab= vf->priv->non_b_qp;
549 if(vf->priv->bframes || !qp_tab)
550 qp_tab= mpi->qscale;
551
552 if(qp_tab || vf->priv->qp){
553 filter(vf->priv, dmpi->planes[0], mpi->planes[0], dmpi->stride[0], mpi->stride[0],
554 mpi->w, mpi->h, qp_tab, mpi->qstride, 1);
555 filter(vf->priv, dmpi->planes[1], mpi->planes[1], dmpi->stride[1], mpi->stride[1],
556 mpi->w>>mpi->chroma_x_shift, mpi->h>>mpi->chroma_y_shift, qp_tab, mpi->qstride, 0);
557 filter(vf->priv, dmpi->planes[2], mpi->planes[2], dmpi->stride[2], mpi->stride[2],
558 mpi->w>>mpi->chroma_x_shift, mpi->h>>mpi->chroma_y_shift, qp_tab, mpi->qstride, 0);
559 }else{
560 memcpy_pic(dmpi->planes[0], mpi->planes[0], mpi->w, mpi->h, dmpi->stride[0], mpi->stride[0]);
561 memcpy_pic(dmpi->planes[1], mpi->planes[1], mpi->w>>mpi->chroma_x_shift, mpi->h>>mpi->chroma_y_shift, dmpi->stride[1], mpi->stride[1]);
562 memcpy_pic(dmpi->planes[2], mpi->planes[2], mpi->w>>mpi->chroma_x_shift, mpi->h>>mpi->chroma_y_shift, dmpi->stride[2], mpi->stride[2]);
563 }
564 }
565
f6fa7814 566#if HAVE_MMX_INLINE
2ba45a60
DM
567 if(ff_gCpuCaps.hasMMX) __asm__ volatile ("emms\n\t");
568#endif
f6fa7814 569#if HAVE_MMXEXT_INLINE
2ba45a60
DM
570 if(ff_gCpuCaps.hasMMX2) __asm__ volatile ("sfence\n\t");
571#endif
572 return ff_vf_next_put_image(vf,dmpi, pts);
573}
574
575static void uninit(struct vf_instance *vf)
576{
577 if(!vf->priv) return;
578
579 av_free(vf->priv->temp);
580 vf->priv->temp= NULL;
581 av_free(vf->priv->src);
582 vf->priv->src= NULL;
583 //free(vf->priv->avctx);
584 //vf->priv->avctx= NULL;
585 free(vf->priv->non_b_qp);
586 vf->priv->non_b_qp= NULL;
587
588 av_free(vf->priv);
589 vf->priv=NULL;
590}
591
592//===========================================================================//
593
594static int query_format(struct vf_instance *vf, unsigned int fmt)
595{
596 switch(fmt){
597 case IMGFMT_YVU9:
598 case IMGFMT_IF09:
599 case IMGFMT_YV12:
600 case IMGFMT_I420:
601 case IMGFMT_IYUV:
602 case IMGFMT_CLPL:
603 case IMGFMT_Y800:
604 case IMGFMT_Y8:
605 case IMGFMT_444P:
606 case IMGFMT_422P:
607 case IMGFMT_411P:
608 return ff_vf_next_query_format(vf,fmt);
609 }
610 return 0;
611}
612
613static int control(struct vf_instance *vf, int request, void* data)
614{
615 switch(request){
616 case VFCTRL_QUERY_MAX_PP_LEVEL:
617 return 5;
618 case VFCTRL_SET_PP_LEVEL:
619 vf->priv->log2_count= *((unsigned int*)data);
620 if (vf->priv->log2_count < 4) vf->priv->log2_count=4;
621 return CONTROL_TRUE;
622 }
623 return ff_vf_next_control(vf,request,data);
624}
625
626static int vf_open(vf_instance_t *vf, char *args)
627{
628 int i=0, bias;
629 int custom_threshold_m[64];
630 int log2c=-1;
631
632 vf->config=config;
633 vf->put_image=put_image;
634 vf->get_image=get_image;
635 vf->query_format=query_format;
636 vf->uninit=uninit;
637 vf->control= control;
638 vf->priv=av_mallocz(sizeof(struct vf_priv_s));//assumes align 16 !
639
640 ff_init_avcodec();
641
642 //vf->priv->avctx= avcodec_alloc_context();
643 //dsputil_init(&vf->priv->dsp, vf->priv->avctx);
644
645 vf->priv->log2_count= 4;
646 vf->priv->bframes = 0;
647
648 if (args) sscanf(args, "%d:%d:%d:%d", &log2c, &vf->priv->qp, &i, &vf->priv->bframes);
649
650 if( log2c >=4 && log2c <=5 )
651 vf->priv->log2_count = log2c;
652 else if( log2c >= 6 )
653 vf->priv->log2_count = 5;
654
655 if(vf->priv->qp < 0)
656 vf->priv->qp = 0;
657
658 if (i < -15) i = -15;
659 if (i > 32) i = 32;
660
661 bias= (1<<4)+i; //regulable
662 vf->priv->prev_q=0;
663 //
664 for(i=0;i<64;i++) //FIXME: tune custom_threshold[] and remove this !
665 custom_threshold_m[i]=(int)(custom_threshold[i]*(bias/71.)+ 0.5);
666 for(i=0;i<8;i++){
667 vf->priv->threshold_mtx_noq[2*i]=(uint64_t)custom_threshold_m[i*8+2]
668 |(((uint64_t)custom_threshold_m[i*8+6])<<16)
669 |(((uint64_t)custom_threshold_m[i*8+0])<<32)
670 |(((uint64_t)custom_threshold_m[i*8+4])<<48);
671 vf->priv->threshold_mtx_noq[2*i+1]=(uint64_t)custom_threshold_m[i*8+5]
672 |(((uint64_t)custom_threshold_m[i*8+3])<<16)
673 |(((uint64_t)custom_threshold_m[i*8+1])<<32)
674 |(((uint64_t)custom_threshold_m[i*8+7])<<48);
675 }
676
677 if (vf->priv->qp) vf->priv->prev_q=vf->priv->qp, mul_thrmat_s(vf->priv, vf->priv->qp);
678
679 return 1;
680}
681
682const vf_info_t ff_vf_info_fspp = {
683 "fast simple postprocess",
684 "fspp",
685 "Michael Niedermayer, Nikolaj Poroshin",
686 "",
687 vf_open,
688 NULL
689};
690
691//====================================================================
692//Specific spp's dct, idct and threshold functions
693//I'd prefer to have them in the separate file.
694
695//#define MANGLE(a) #a
696
697//typedef int16_t int16_t; //! only int16_t
698
699#define DCTSIZE 8
700#define DCTSIZE_S "8"
701
702#define FIX(x,s) ((int) ((x) * (1<<s) + 0.5)&0xffff)
703#define C64(x) ((uint64_t)((x)|(x)<<16))<<32 | (uint64_t)(x) | (uint64_t)(x)<<16
704#define FIX64(x,s) C64(FIX(x,s))
705
706#define MULTIPLY16H(x,k) (((x)*(k))>>16)
707#define THRESHOLD(r,x,t) if(((unsigned)((x)+t))>t*2) r=(x);else r=0;
708#define DESCALE(x,n) (((x) + (1 << ((n)-1))) >> n)
709
f6fa7814 710#if HAVE_MMX_INLINE
2ba45a60
DM
711
712DECLARE_ASM_CONST(8, uint64_t, MM_FIX_0_382683433)=FIX64(0.382683433, 14);
713DECLARE_ALIGNED(8, uint64_t, ff_MM_FIX_0_541196100)=FIX64(0.541196100, 14);
714DECLARE_ALIGNED(8, uint64_t, ff_MM_FIX_0_707106781)=FIX64(0.707106781, 14);
715DECLARE_ASM_CONST(8, uint64_t, MM_FIX_1_306562965)=FIX64(1.306562965, 14);
716
717DECLARE_ASM_CONST(8, uint64_t, MM_FIX_1_414213562_A)=FIX64(1.414213562, 14);
718
719DECLARE_ASM_CONST(8, uint64_t, MM_FIX_1_847759065)=FIX64(1.847759065, 13);
720DECLARE_ASM_CONST(8, uint64_t, MM_FIX_2_613125930)=FIX64(-2.613125930, 13); //-
721DECLARE_ASM_CONST(8, uint64_t, MM_FIX_1_414213562)=FIX64(1.414213562, 13);
722DECLARE_ASM_CONST(8, uint64_t, MM_FIX_1_082392200)=FIX64(1.082392200, 13);
723//for t3,t5,t7 == 0 shortcut
724DECLARE_ASM_CONST(8, uint64_t, MM_FIX_0_847759065)=FIX64(0.847759065, 14);
725DECLARE_ASM_CONST(8, uint64_t, MM_FIX_0_566454497)=FIX64(0.566454497, 14);
726DECLARE_ASM_CONST(8, uint64_t, MM_FIX_0_198912367)=FIX64(0.198912367, 14);
727
728DECLARE_ASM_CONST(8, uint64_t, MM_DESCALE_RND)=C64(4);
729DECLARE_ASM_CONST(8, uint64_t, MM_2)=C64(2);
730
f6fa7814 731#else /* !HAVE_MMX_INLINE */
2ba45a60
DM
732
733typedef int32_t int_simd16_t;
734static const int16_t FIX_0_382683433=FIX(0.382683433, 14);
735static const int16_t FIX_0_541196100=FIX(0.541196100, 14);
736static const int16_t FIX_0_707106781=FIX(0.707106781, 14);
737static const int16_t FIX_1_306562965=FIX(1.306562965, 14);
738static const int16_t FIX_1_414213562_A=FIX(1.414213562, 14);
739static const int16_t FIX_1_847759065=FIX(1.847759065, 13);
740static const int16_t FIX_2_613125930=FIX(-2.613125930, 13); //-
741static const int16_t FIX_1_414213562=FIX(1.414213562, 13);
742static const int16_t FIX_1_082392200=FIX(1.082392200, 13);
743
744#endif
745
f6fa7814 746#if !HAVE_MMX_INLINE
2ba45a60
DM
747
748static void column_fidct_c(int16_t* thr_adr, int16_t *data, int16_t *output, int cnt)
749{
750 int_simd16_t tmp0, tmp1, tmp2, tmp3, tmp4, tmp5, tmp6, tmp7;
751 int_simd16_t tmp10, tmp11, tmp12, tmp13;
752 int_simd16_t z1,z2,z3,z4,z5, z10, z11, z12, z13;
753 int_simd16_t d0, d1, d2, d3, d4, d5, d6, d7;
754
755 int16_t* dataptr;
756 int16_t* wsptr;
757 int16_t *threshold;
758 int ctr;
759
760 dataptr = data;
761 wsptr = output;
762
763 for (; cnt > 0; cnt-=2) { //start positions
764 threshold=(int16_t*)thr_adr;//threshold_mtx
765 for (ctr = DCTSIZE; ctr > 0; ctr--) {
766 // Process columns from input, add to output.
767 tmp0 = dataptr[DCTSIZE*0] + dataptr[DCTSIZE*7];
768 tmp7 = dataptr[DCTSIZE*0] - dataptr[DCTSIZE*7];
769
770 tmp1 = dataptr[DCTSIZE*1] + dataptr[DCTSIZE*6];
771 tmp6 = dataptr[DCTSIZE*1] - dataptr[DCTSIZE*6];
772
773 tmp2 = dataptr[DCTSIZE*2] + dataptr[DCTSIZE*5];
774 tmp5 = dataptr[DCTSIZE*2] - dataptr[DCTSIZE*5];
775
776 tmp3 = dataptr[DCTSIZE*3] + dataptr[DCTSIZE*4];
777 tmp4 = dataptr[DCTSIZE*3] - dataptr[DCTSIZE*4];
778
779 // Even part of FDCT
780
781 tmp10 = tmp0 + tmp3;
782 tmp13 = tmp0 - tmp3;
783 tmp11 = tmp1 + tmp2;
784 tmp12 = tmp1 - tmp2;
785
786 d0 = tmp10 + tmp11;
787 d4 = tmp10 - tmp11;
788
789 z1 = MULTIPLY16H((tmp12 + tmp13) <<2, FIX_0_707106781);
790 d2 = tmp13 + z1;
791 d6 = tmp13 - z1;
792
793 // Even part of IDCT
794
795 THRESHOLD(tmp0, d0, threshold[0*8]);
796 THRESHOLD(tmp1, d2, threshold[2*8]);
797 THRESHOLD(tmp2, d4, threshold[4*8]);
798 THRESHOLD(tmp3, d6, threshold[6*8]);
799 tmp0+=2;
800 tmp10 = (tmp0 + tmp2)>>2;
801 tmp11 = (tmp0 - tmp2)>>2;
802
803 tmp13 = (tmp1 + tmp3)>>2; //+2 ! (psnr decides)
804 tmp12 = MULTIPLY16H((tmp1 - tmp3), FIX_1_414213562_A) - tmp13; //<<2
805
806 tmp0 = tmp10 + tmp13; //->temps
807 tmp3 = tmp10 - tmp13; //->temps
808 tmp1 = tmp11 + tmp12; //->temps
809 tmp2 = tmp11 - tmp12; //->temps
810
811 // Odd part of FDCT
812
813 tmp10 = tmp4 + tmp5;
814 tmp11 = tmp5 + tmp6;
815 tmp12 = tmp6 + tmp7;
816
817 z5 = MULTIPLY16H((tmp10 - tmp12)<<2, FIX_0_382683433);
818 z2 = MULTIPLY16H(tmp10 <<2, FIX_0_541196100) + z5;
819 z4 = MULTIPLY16H(tmp12 <<2, FIX_1_306562965) + z5;
820 z3 = MULTIPLY16H(tmp11 <<2, FIX_0_707106781);
821
822 z11 = tmp7 + z3;
823 z13 = tmp7 - z3;
824
825 d5 = z13 + z2;
826 d3 = z13 - z2;
827 d1 = z11 + z4;
828 d7 = z11 - z4;
829
830 // Odd part of IDCT
831
832 THRESHOLD(tmp4, d1, threshold[1*8]);
833 THRESHOLD(tmp5, d3, threshold[3*8]);
834 THRESHOLD(tmp6, d5, threshold[5*8]);
835 THRESHOLD(tmp7, d7, threshold[7*8]);
836
837 //Simd version uses here a shortcut for the tmp5,tmp6,tmp7 == 0
838 z13 = tmp6 + tmp5;
839 z10 = (tmp6 - tmp5)<<1;
840 z11 = tmp4 + tmp7;
841 z12 = (tmp4 - tmp7)<<1;
842
843 tmp7 = (z11 + z13)>>2; //+2 !
844 tmp11 = MULTIPLY16H((z11 - z13)<<1, FIX_1_414213562);
845 z5 = MULTIPLY16H(z10 + z12, FIX_1_847759065);
846 tmp10 = MULTIPLY16H(z12, FIX_1_082392200) - z5;
847 tmp12 = MULTIPLY16H(z10, FIX_2_613125930) + z5; // - !!
848
849 tmp6 = tmp12 - tmp7;
850 tmp5 = tmp11 - tmp6;
851 tmp4 = tmp10 + tmp5;
852
853 wsptr[DCTSIZE*0]+= (tmp0 + tmp7);
854 wsptr[DCTSIZE*1]+= (tmp1 + tmp6);
855 wsptr[DCTSIZE*2]+= (tmp2 + tmp5);
856 wsptr[DCTSIZE*3]+= (tmp3 - tmp4);
857 wsptr[DCTSIZE*4]+= (tmp3 + tmp4);
858 wsptr[DCTSIZE*5]+= (tmp2 - tmp5);
859 wsptr[DCTSIZE*6]= (tmp1 - tmp6);
860 wsptr[DCTSIZE*7]= (tmp0 - tmp7);
861 //
862 dataptr++; //next column
863 wsptr++;
864 threshold++;
865 }
866 dataptr+=8; //skip each second start pos
867 wsptr +=8;
868 }
869}
870
f6fa7814 871#else /* HAVE_MMX_INLINE */
2ba45a60
DM
872
873static void column_fidct_mmx(int16_t* thr_adr, int16_t *data, int16_t *output, int cnt)
874{
875 DECLARE_ALIGNED(8, uint64_t, temps)[4];
876 __asm__ volatile(
877 ASMALIGN(4)
878 "1: \n\t"
879 "movq "DCTSIZE_S"*0*2(%%"REG_S"), %%mm1 \n\t"
880 //
881 "movq "DCTSIZE_S"*3*2(%%"REG_S"), %%mm7 \n\t"
882 "movq %%mm1, %%mm0 \n\t"
883
884 "paddw "DCTSIZE_S"*7*2(%%"REG_S"), %%mm1 \n\t" //t0
885 "movq %%mm7, %%mm3 \n\t"
886
887 "paddw "DCTSIZE_S"*4*2(%%"REG_S"), %%mm7 \n\t" //t3
888 "movq %%mm1, %%mm5 \n\t"
889
890 "movq "DCTSIZE_S"*1*2(%%"REG_S"), %%mm6 \n\t"
891 "psubw %%mm7, %%mm1 \n\t" //t13
892
893 "movq "DCTSIZE_S"*2*2(%%"REG_S"), %%mm2 \n\t"
894 "movq %%mm6, %%mm4 \n\t"
895
896 "paddw "DCTSIZE_S"*6*2(%%"REG_S"), %%mm6 \n\t" //t1
897 "paddw %%mm7, %%mm5 \n\t" //t10
898
899 "paddw "DCTSIZE_S"*5*2(%%"REG_S"), %%mm2 \n\t" //t2
900 "movq %%mm6, %%mm7 \n\t"
901
902 "paddw %%mm2, %%mm6 \n\t" //t11
903 "psubw %%mm2, %%mm7 \n\t" //t12
904
905 "movq %%mm5, %%mm2 \n\t"
906 "paddw %%mm6, %%mm5 \n\t" //d0
907 // i0 t13 t12 i3 i1 d0 - d4
908 "psubw %%mm6, %%mm2 \n\t" //d4
909 "paddw %%mm1, %%mm7 \n\t"
910
911 "movq 4*16(%%"REG_d"), %%mm6 \n\t"
912 "psllw $2, %%mm7 \n\t"
913
914 "psubw 0*16(%%"REG_d"), %%mm5 \n\t"
915 "psubw %%mm6, %%mm2 \n\t"
916
917 "paddusw 0*16(%%"REG_d"), %%mm5 \n\t"
918 "paddusw %%mm6, %%mm2 \n\t"
919
920 "pmulhw "MANGLE(ff_MM_FIX_0_707106781)", %%mm7 \n\t"
921 //
922 "paddw 0*16(%%"REG_d"), %%mm5 \n\t"
923 "paddw %%mm6, %%mm2 \n\t"
924
925 "psubusw 0*16(%%"REG_d"), %%mm5 \n\t"
926 "psubusw %%mm6, %%mm2 \n\t"
927
928//This func is totally compute-bound, operates at huge speed. So, DC shortcut
929// at this place isn't worthwhile due to BTB miss penalty (checked on Pent. 3).
930//However, typical numbers: nondc - 29%%, dc - 46%%, zero - 25%%. All <> 0 case is very rare.
931 "paddw "MANGLE(MM_2)", %%mm5 \n\t"
932 "movq %%mm2, %%mm6 \n\t"
933
934 "paddw %%mm5, %%mm2 \n\t"
935 "psubw %%mm6, %%mm5 \n\t"
936
937 "movq %%mm1, %%mm6 \n\t"
938 "paddw %%mm7, %%mm1 \n\t" //d2
939
940 "psubw 2*16(%%"REG_d"), %%mm1 \n\t"
941 "psubw %%mm7, %%mm6 \n\t" //d6
942
943 "movq 6*16(%%"REG_d"), %%mm7 \n\t"
944 "psraw $2, %%mm5 \n\t"
945
946 "paddusw 2*16(%%"REG_d"), %%mm1 \n\t"
947 "psubw %%mm7, %%mm6 \n\t"
948 // t7 d2 /t11 t4 t6 - d6 /t10
949
950 "paddw 2*16(%%"REG_d"), %%mm1 \n\t"
951 "paddusw %%mm7, %%mm6 \n\t"
952
953 "psubusw 2*16(%%"REG_d"), %%mm1 \n\t"
954 "paddw %%mm7, %%mm6 \n\t"
955
956 "psubw "DCTSIZE_S"*4*2(%%"REG_S"), %%mm3 \n\t"
957 "psubusw %%mm7, %%mm6 \n\t"
958
959 //movq [edi+"DCTSIZE_S"*2*2], mm1
960 //movq [edi+"DCTSIZE_S"*6*2], mm6
961 "movq %%mm1, %%mm7 \n\t"
962 "psraw $2, %%mm2 \n\t"
963
964 "psubw "DCTSIZE_S"*6*2(%%"REG_S"), %%mm4 \n\t"
965 "psubw %%mm6, %%mm1 \n\t"
966
967 "psubw "DCTSIZE_S"*7*2(%%"REG_S"), %%mm0 \n\t"
968 "paddw %%mm7, %%mm6 \n\t" //'t13
969
970 "psraw $2, %%mm6 \n\t" //paddw mm6, MM_2 !! ---
971 "movq %%mm2, %%mm7 \n\t"
972
973 "pmulhw "MANGLE(MM_FIX_1_414213562_A)", %%mm1 \n\t"
974 "paddw %%mm6, %%mm2 \n\t" //'t0
975
976 "movq %%mm2, 0*8+%3 \n\t" //!
977 "psubw %%mm6, %%mm7 \n\t" //'t3
978
979 "movq "DCTSIZE_S"*2*2(%%"REG_S"), %%mm2 \n\t"
980 "psubw %%mm6, %%mm1 \n\t" //'t12
981
982 "psubw "DCTSIZE_S"*5*2(%%"REG_S"), %%mm2 \n\t" //t5
983 "movq %%mm5, %%mm6 \n\t"
984
985 "movq %%mm7, 3*8+%3 \n\t"
986 "paddw %%mm2, %%mm3 \n\t" //t10
987
988 "paddw %%mm4, %%mm2 \n\t" //t11
989 "paddw %%mm0, %%mm4 \n\t" //t12
990
991 "movq %%mm3, %%mm7 \n\t"
992 "psubw %%mm4, %%mm3 \n\t"
993
994 "psllw $2, %%mm3 \n\t"
995 "psllw $2, %%mm7 \n\t" //opt for P6
996
997 "pmulhw "MANGLE(MM_FIX_0_382683433)", %%mm3 \n\t"
998 "psllw $2, %%mm4 \n\t"
999
1000 "pmulhw "MANGLE(ff_MM_FIX_0_541196100)", %%mm7 \n\t"
1001 "psllw $2, %%mm2 \n\t"
1002
1003 "pmulhw "MANGLE(MM_FIX_1_306562965)", %%mm4 \n\t"
1004 "paddw %%mm1, %%mm5 \n\t" //'t1
1005
1006 "pmulhw "MANGLE(ff_MM_FIX_0_707106781)", %%mm2 \n\t"
1007 "psubw %%mm1, %%mm6 \n\t" //'t2
1008 // t7 't12 't11 t4 t6 - 't13 't10 ---
1009
1010 "paddw %%mm3, %%mm7 \n\t" //z2
1011
1012 "movq %%mm5, 1*8+%3 \n\t"
1013 "paddw %%mm3, %%mm4 \n\t" //z4
1014
1015 "movq 3*16(%%"REG_d"), %%mm3 \n\t"
1016 "movq %%mm0, %%mm1 \n\t"
1017
1018 "movq %%mm6, 2*8+%3 \n\t"
1019 "psubw %%mm2, %%mm1 \n\t" //z13
1020
1021//===
1022 "paddw %%mm2, %%mm0 \n\t" //z11
1023 "movq %%mm1, %%mm5 \n\t"
1024
1025 "movq 5*16(%%"REG_d"), %%mm2 \n\t"
1026 "psubw %%mm7, %%mm1 \n\t" //d3
1027
1028 "paddw %%mm7, %%mm5 \n\t" //d5
1029 "psubw %%mm3, %%mm1 \n\t"
1030
1031 "movq 1*16(%%"REG_d"), %%mm7 \n\t"
1032 "psubw %%mm2, %%mm5 \n\t"
1033
1034 "movq %%mm0, %%mm6 \n\t"
1035 "paddw %%mm4, %%mm0 \n\t" //d1
1036
1037 "paddusw %%mm3, %%mm1 \n\t"
1038 "psubw %%mm4, %%mm6 \n\t" //d7
1039
1040 // d1 d3 - - - d5 d7 -
1041 "movq 7*16(%%"REG_d"), %%mm4 \n\t"
1042 "psubw %%mm7, %%mm0 \n\t"
1043
1044 "psubw %%mm4, %%mm6 \n\t"
1045 "paddusw %%mm2, %%mm5 \n\t"
1046
1047 "paddusw %%mm4, %%mm6 \n\t"
1048 "paddw %%mm3, %%mm1 \n\t"
1049
1050 "paddw %%mm2, %%mm5 \n\t"
1051 "paddw %%mm4, %%mm6 \n\t"
1052
1053 "psubusw %%mm3, %%mm1 \n\t"
1054 "psubusw %%mm2, %%mm5 \n\t"
1055
1056 "psubusw %%mm4, %%mm6 \n\t"
1057 "movq %%mm1, %%mm4 \n\t"
1058
1059 "por %%mm5, %%mm4 \n\t"
1060 "paddusw %%mm7, %%mm0 \n\t"
1061
1062 "por %%mm6, %%mm4 \n\t"
1063 "paddw %%mm7, %%mm0 \n\t"
1064
1065 "packssdw %%mm4, %%mm4 \n\t"
1066 "psubusw %%mm7, %%mm0 \n\t"
1067
1068 "movd %%mm4, %%"REG_a" \n\t"
1069 "or %%"REG_a", %%"REG_a" \n\t"
1070 "jnz 2f \n\t"
1071 //movq [edi+"DCTSIZE_S"*3*2], mm1
1072 //movq [edi+"DCTSIZE_S"*5*2], mm5
1073 //movq [edi+"DCTSIZE_S"*1*2], mm0
1074 //movq [edi+"DCTSIZE_S"*7*2], mm6
1075 // t4 t5 - - - t6 t7 -
1076 //--- t4 (mm0) may be <>0; mm1, mm5, mm6 == 0
1077//Typical numbers: nondc - 19%%, dc - 26%%, zero - 55%%. zero case alone isn't worthwhile
1078 "movq 0*8+%3, %%mm4 \n\t"
1079 "movq %%mm0, %%mm1 \n\t"
1080
1081 "pmulhw "MANGLE(MM_FIX_0_847759065)", %%mm0 \n\t" //tmp6
1082 "movq %%mm1, %%mm2 \n\t"
1083
1084 "movq "DCTSIZE_S"*0*2(%%"REG_D"), %%mm5 \n\t"
1085 "movq %%mm2, %%mm3 \n\t"
1086
1087 "pmulhw "MANGLE(MM_FIX_0_566454497)", %%mm1 \n\t" //tmp5
1088 "paddw %%mm4, %%mm5 \n\t"
1089
1090 "movq 1*8+%3, %%mm6 \n\t"
1091 //paddw mm3, MM_2
1092 "psraw $2, %%mm3 \n\t" //tmp7
1093
1094 "pmulhw "MANGLE(MM_FIX_0_198912367)", %%mm2 \n\t" //-tmp4
1095 "psubw %%mm3, %%mm4 \n\t"
1096
1097 "movq "DCTSIZE_S"*1*2(%%"REG_D"), %%mm7 \n\t"
1098 "paddw %%mm3, %%mm5 \n\t"
1099
1100 "movq %%mm4, "DCTSIZE_S"*7*2(%%"REG_D") \n\t"
1101 "paddw %%mm6, %%mm7 \n\t"
1102
1103 "movq 2*8+%3, %%mm3 \n\t"
1104 "psubw %%mm0, %%mm6 \n\t"
1105
1106 "movq "DCTSIZE_S"*2*2(%%"REG_D"), %%mm4 \n\t"
1107 "paddw %%mm0, %%mm7 \n\t"
1108
1109 "movq %%mm5, "DCTSIZE_S"*0*2(%%"REG_D") \n\t"
1110 "paddw %%mm3, %%mm4 \n\t"
1111
1112 "movq %%mm6, "DCTSIZE_S"*6*2(%%"REG_D") \n\t"
1113 "psubw %%mm1, %%mm3 \n\t"
1114
1115 "movq "DCTSIZE_S"*5*2(%%"REG_D"), %%mm5 \n\t"
1116 "paddw %%mm1, %%mm4 \n\t"
1117
1118 "movq "DCTSIZE_S"*3*2(%%"REG_D"), %%mm6 \n\t"
1119 "paddw %%mm3, %%mm5 \n\t"
1120
1121 "movq 3*8+%3, %%mm0 \n\t"
1122 "add $8, %%"REG_S" \n\t"
1123
1124 "movq %%mm7, "DCTSIZE_S"*1*2(%%"REG_D") \n\t"
1125 "paddw %%mm0, %%mm6 \n\t"
1126
1127 "movq %%mm4, "DCTSIZE_S"*2*2(%%"REG_D") \n\t"
1128 "psubw %%mm2, %%mm0 \n\t"
1129
1130 "movq "DCTSIZE_S"*4*2(%%"REG_D"), %%mm7 \n\t"
1131 "paddw %%mm2, %%mm6 \n\t"
1132
1133 "movq %%mm5, "DCTSIZE_S"*5*2(%%"REG_D") \n\t"
1134 "paddw %%mm0, %%mm7 \n\t"
1135
1136 "movq %%mm6, "DCTSIZE_S"*3*2(%%"REG_D") \n\t"
1137
1138 "movq %%mm7, "DCTSIZE_S"*4*2(%%"REG_D") \n\t"
1139 "add $8, %%"REG_D" \n\t"
1140 "jmp 4f \n\t"
1141
1142 "2: \n\t"
1143 //--- non DC2
1144 //psraw mm1, 2 w/o it -> offset. thr1, thr1, thr1 (actually thr1, thr1, thr1-1)
1145 //psraw mm5, 2
1146 //psraw mm0, 2
1147 //psraw mm6, 2
1148 "movq %%mm5, %%mm3 \n\t"
1149 "psubw %%mm1, %%mm5 \n\t"
1150
1151 "psllw $1, %%mm5 \n\t" //'z10
1152 "paddw %%mm1, %%mm3 \n\t" //'z13
1153
1154 "movq %%mm0, %%mm2 \n\t"
1155 "psubw %%mm6, %%mm0 \n\t"
1156
1157 "movq %%mm5, %%mm1 \n\t"
1158 "psllw $1, %%mm0 \n\t" //'z12
1159
1160 "pmulhw "MANGLE(MM_FIX_2_613125930)", %%mm1 \n\t" //-
1161 "paddw %%mm0, %%mm5 \n\t"
1162
1163 "pmulhw "MANGLE(MM_FIX_1_847759065)", %%mm5 \n\t" //'z5
1164 "paddw %%mm6, %%mm2 \n\t" //'z11
1165
1166 "pmulhw "MANGLE(MM_FIX_1_082392200)", %%mm0 \n\t"
1167 "movq %%mm2, %%mm7 \n\t"
1168
1169 //---
1170 "movq 0*8+%3, %%mm4 \n\t"
1171 "psubw %%mm3, %%mm2 \n\t"
1172
1173 "psllw $1, %%mm2 \n\t"
1174 "paddw %%mm3, %%mm7 \n\t" //'t7
1175
1176 "pmulhw "MANGLE(MM_FIX_1_414213562)", %%mm2 \n\t" //'t11
1177 "movq %%mm4, %%mm6 \n\t"
1178 //paddw mm7, MM_2
1179 "psraw $2, %%mm7 \n\t"
1180
1181 "paddw "DCTSIZE_S"*0*2(%%"REG_D"), %%mm4 \n\t"
1182 "psubw %%mm7, %%mm6 \n\t"
1183
1184 "movq 1*8+%3, %%mm3 \n\t"
1185 "paddw %%mm7, %%mm4 \n\t"
1186
1187 "movq %%mm6, "DCTSIZE_S"*7*2(%%"REG_D") \n\t"
1188 "paddw %%mm5, %%mm1 \n\t" //'t12
1189
1190 "movq %%mm4, "DCTSIZE_S"*0*2(%%"REG_D") \n\t"
1191 "psubw %%mm7, %%mm1 \n\t" //'t6
1192
1193 "movq 2*8+%3, %%mm7 \n\t"
1194 "psubw %%mm5, %%mm0 \n\t" //'t10
1195
1196 "movq 3*8+%3, %%mm6 \n\t"
1197 "movq %%mm3, %%mm5 \n\t"
1198
1199 "paddw "DCTSIZE_S"*1*2(%%"REG_D"), %%mm3 \n\t"
1200 "psubw %%mm1, %%mm5 \n\t"
1201
1202 "psubw %%mm1, %%mm2 \n\t" //'t5
1203 "paddw %%mm1, %%mm3 \n\t"
1204
1205 "movq %%mm5, "DCTSIZE_S"*6*2(%%"REG_D") \n\t"
1206 "movq %%mm7, %%mm4 \n\t"
1207
1208 "paddw "DCTSIZE_S"*2*2(%%"REG_D"), %%mm7 \n\t"
1209 "psubw %%mm2, %%mm4 \n\t"
1210
1211 "paddw "DCTSIZE_S"*5*2(%%"REG_D"), %%mm4 \n\t"
1212 "paddw %%mm2, %%mm7 \n\t"
1213
1214 "movq %%mm3, "DCTSIZE_S"*1*2(%%"REG_D") \n\t"
1215 "paddw %%mm2, %%mm0 \n\t" //'t4
1216
1217 // 't4 't6 't5 - - - - 't7
1218 "movq %%mm7, "DCTSIZE_S"*2*2(%%"REG_D") \n\t"
1219 "movq %%mm6, %%mm1 \n\t"
1220
1221 "paddw "DCTSIZE_S"*4*2(%%"REG_D"), %%mm6 \n\t"
1222 "psubw %%mm0, %%mm1 \n\t"
1223
1224 "paddw "DCTSIZE_S"*3*2(%%"REG_D"), %%mm1 \n\t"
1225 "paddw %%mm0, %%mm6 \n\t"
1226
1227 "movq %%mm4, "DCTSIZE_S"*5*2(%%"REG_D") \n\t"
1228 "add $8, %%"REG_S" \n\t"
1229
1230 "movq %%mm6, "DCTSIZE_S"*4*2(%%"REG_D") \n\t"
1231
1232 "movq %%mm1, "DCTSIZE_S"*3*2(%%"REG_D") \n\t"
1233 "add $8, %%"REG_D" \n\t"
1234
1235 "4: \n\t"
1236//=part 2 (the same)===========================================================
1237 "movq "DCTSIZE_S"*0*2(%%"REG_S"), %%mm1 \n\t"
1238 //
1239 "movq "DCTSIZE_S"*3*2(%%"REG_S"), %%mm7 \n\t"
1240 "movq %%mm1, %%mm0 \n\t"
1241
1242 "paddw "DCTSIZE_S"*7*2(%%"REG_S"), %%mm1 \n\t" //t0
1243 "movq %%mm7, %%mm3 \n\t"
1244
1245 "paddw "DCTSIZE_S"*4*2(%%"REG_S"), %%mm7 \n\t" //t3
1246 "movq %%mm1, %%mm5 \n\t"
1247
1248 "movq "DCTSIZE_S"*1*2(%%"REG_S"), %%mm6 \n\t"
1249 "psubw %%mm7, %%mm1 \n\t" //t13
1250
1251 "movq "DCTSIZE_S"*2*2(%%"REG_S"), %%mm2 \n\t"
1252 "movq %%mm6, %%mm4 \n\t"
1253
1254 "paddw "DCTSIZE_S"*6*2(%%"REG_S"), %%mm6 \n\t" //t1
1255 "paddw %%mm7, %%mm5 \n\t" //t10
1256
1257 "paddw "DCTSIZE_S"*5*2(%%"REG_S"), %%mm2 \n\t" //t2
1258 "movq %%mm6, %%mm7 \n\t"
1259
1260 "paddw %%mm2, %%mm6 \n\t" //t11
1261 "psubw %%mm2, %%mm7 \n\t" //t12
1262
1263 "movq %%mm5, %%mm2 \n\t"
1264 "paddw %%mm6, %%mm5 \n\t" //d0
1265 // i0 t13 t12 i3 i1 d0 - d4
1266 "psubw %%mm6, %%mm2 \n\t" //d4
1267 "paddw %%mm1, %%mm7 \n\t"
1268
1269 "movq 1*8+4*16(%%"REG_d"), %%mm6 \n\t"
1270 "psllw $2, %%mm7 \n\t"
1271
1272 "psubw 1*8+0*16(%%"REG_d"), %%mm5 \n\t"
1273 "psubw %%mm6, %%mm2 \n\t"
1274
1275 "paddusw 1*8+0*16(%%"REG_d"), %%mm5 \n\t"
1276 "paddusw %%mm6, %%mm2 \n\t"
1277
1278 "pmulhw "MANGLE(ff_MM_FIX_0_707106781)", %%mm7 \n\t"
1279 //
1280 "paddw 1*8+0*16(%%"REG_d"), %%mm5 \n\t"
1281 "paddw %%mm6, %%mm2 \n\t"
1282
1283 "psubusw 1*8+0*16(%%"REG_d"), %%mm5 \n\t"
1284 "psubusw %%mm6, %%mm2 \n\t"
1285
1286//This func is totally compute-bound, operates at huge speed. So, DC shortcut
1287// at this place isn't worthwhile due to BTB miss penalty (checked on Pent. 3).
1288//However, typical numbers: nondc - 29%%, dc - 46%%, zero - 25%%. All <> 0 case is very rare.
1289 "paddw "MANGLE(MM_2)", %%mm5 \n\t"
1290 "movq %%mm2, %%mm6 \n\t"
1291
1292 "paddw %%mm5, %%mm2 \n\t"
1293 "psubw %%mm6, %%mm5 \n\t"
1294
1295 "movq %%mm1, %%mm6 \n\t"
1296 "paddw %%mm7, %%mm1 \n\t" //d2
1297
1298 "psubw 1*8+2*16(%%"REG_d"), %%mm1 \n\t"
1299 "psubw %%mm7, %%mm6 \n\t" //d6
1300
1301 "movq 1*8+6*16(%%"REG_d"), %%mm7 \n\t"
1302 "psraw $2, %%mm5 \n\t"
1303
1304 "paddusw 1*8+2*16(%%"REG_d"), %%mm1 \n\t"
1305 "psubw %%mm7, %%mm6 \n\t"
1306 // t7 d2 /t11 t4 t6 - d6 /t10
1307
1308 "paddw 1*8+2*16(%%"REG_d"), %%mm1 \n\t"
1309 "paddusw %%mm7, %%mm6 \n\t"
1310
1311 "psubusw 1*8+2*16(%%"REG_d"), %%mm1 \n\t"
1312 "paddw %%mm7, %%mm6 \n\t"
1313
1314 "psubw "DCTSIZE_S"*4*2(%%"REG_S"), %%mm3 \n\t"
1315 "psubusw %%mm7, %%mm6 \n\t"
1316
1317 //movq [edi+"DCTSIZE_S"*2*2], mm1
1318 //movq [edi+"DCTSIZE_S"*6*2], mm6
1319 "movq %%mm1, %%mm7 \n\t"
1320 "psraw $2, %%mm2 \n\t"
1321
1322 "psubw "DCTSIZE_S"*6*2(%%"REG_S"), %%mm4 \n\t"
1323 "psubw %%mm6, %%mm1 \n\t"
1324
1325 "psubw "DCTSIZE_S"*7*2(%%"REG_S"), %%mm0 \n\t"
1326 "paddw %%mm7, %%mm6 \n\t" //'t13
1327
1328 "psraw $2, %%mm6 \n\t" //paddw mm6, MM_2 !! ---
1329 "movq %%mm2, %%mm7 \n\t"
1330
1331 "pmulhw "MANGLE(MM_FIX_1_414213562_A)", %%mm1 \n\t"
1332 "paddw %%mm6, %%mm2 \n\t" //'t0
1333
1334 "movq %%mm2, 0*8+%3 \n\t" //!
1335 "psubw %%mm6, %%mm7 \n\t" //'t3
1336
1337 "movq "DCTSIZE_S"*2*2(%%"REG_S"), %%mm2 \n\t"
1338 "psubw %%mm6, %%mm1 \n\t" //'t12
1339
1340 "psubw "DCTSIZE_S"*5*2(%%"REG_S"), %%mm2 \n\t" //t5
1341 "movq %%mm5, %%mm6 \n\t"
1342
1343 "movq %%mm7, 3*8+%3 \n\t"
1344 "paddw %%mm2, %%mm3 \n\t" //t10
1345
1346 "paddw %%mm4, %%mm2 \n\t" //t11
1347 "paddw %%mm0, %%mm4 \n\t" //t12
1348
1349 "movq %%mm3, %%mm7 \n\t"
1350 "psubw %%mm4, %%mm3 \n\t"
1351
1352 "psllw $2, %%mm3 \n\t"
1353 "psllw $2, %%mm7 \n\t" //opt for P6
1354
1355 "pmulhw "MANGLE(MM_FIX_0_382683433)", %%mm3 \n\t"
1356 "psllw $2, %%mm4 \n\t"
1357
1358 "pmulhw "MANGLE(ff_MM_FIX_0_541196100)", %%mm7 \n\t"
1359 "psllw $2, %%mm2 \n\t"
1360
1361 "pmulhw "MANGLE(MM_FIX_1_306562965)", %%mm4 \n\t"
1362 "paddw %%mm1, %%mm5 \n\t" //'t1
1363
1364 "pmulhw "MANGLE(ff_MM_FIX_0_707106781)", %%mm2 \n\t"
1365 "psubw %%mm1, %%mm6 \n\t" //'t2
1366 // t7 't12 't11 t4 t6 - 't13 't10 ---
1367
1368 "paddw %%mm3, %%mm7 \n\t" //z2
1369
1370 "movq %%mm5, 1*8+%3 \n\t"
1371 "paddw %%mm3, %%mm4 \n\t" //z4
1372
1373 "movq 1*8+3*16(%%"REG_d"), %%mm3 \n\t"
1374 "movq %%mm0, %%mm1 \n\t"
1375
1376 "movq %%mm6, 2*8+%3 \n\t"
1377 "psubw %%mm2, %%mm1 \n\t" //z13
1378
1379//===
1380 "paddw %%mm2, %%mm0 \n\t" //z11
1381 "movq %%mm1, %%mm5 \n\t"
1382
1383 "movq 1*8+5*16(%%"REG_d"), %%mm2 \n\t"
1384 "psubw %%mm7, %%mm1 \n\t" //d3
1385
1386 "paddw %%mm7, %%mm5 \n\t" //d5
1387 "psubw %%mm3, %%mm1 \n\t"
1388
1389 "movq 1*8+1*16(%%"REG_d"), %%mm7 \n\t"
1390 "psubw %%mm2, %%mm5 \n\t"
1391
1392 "movq %%mm0, %%mm6 \n\t"
1393 "paddw %%mm4, %%mm0 \n\t" //d1
1394
1395 "paddusw %%mm3, %%mm1 \n\t"
1396 "psubw %%mm4, %%mm6 \n\t" //d7
1397
1398 // d1 d3 - - - d5 d7 -
1399 "movq 1*8+7*16(%%"REG_d"), %%mm4 \n\t"
1400 "psubw %%mm7, %%mm0 \n\t"
1401
1402 "psubw %%mm4, %%mm6 \n\t"
1403 "paddusw %%mm2, %%mm5 \n\t"
1404
1405 "paddusw %%mm4, %%mm6 \n\t"
1406 "paddw %%mm3, %%mm1 \n\t"
1407
1408 "paddw %%mm2, %%mm5 \n\t"
1409 "paddw %%mm4, %%mm6 \n\t"
1410
1411 "psubusw %%mm3, %%mm1 \n\t"
1412 "psubusw %%mm2, %%mm5 \n\t"
1413
1414 "psubusw %%mm4, %%mm6 \n\t"
1415 "movq %%mm1, %%mm4 \n\t"
1416
1417 "por %%mm5, %%mm4 \n\t"
1418 "paddusw %%mm7, %%mm0 \n\t"
1419
1420 "por %%mm6, %%mm4 \n\t"
1421 "paddw %%mm7, %%mm0 \n\t"
1422
1423 "packssdw %%mm4, %%mm4 \n\t"
1424 "psubusw %%mm7, %%mm0 \n\t"
1425
1426 "movd %%mm4, %%"REG_a" \n\t"
1427 "or %%"REG_a", %%"REG_a" \n\t"
1428 "jnz 3f \n\t"
1429 //movq [edi+"DCTSIZE_S"*3*2], mm1
1430 //movq [edi+"DCTSIZE_S"*5*2], mm5
1431 //movq [edi+"DCTSIZE_S"*1*2], mm0
1432 //movq [edi+"DCTSIZE_S"*7*2], mm6
1433 // t4 t5 - - - t6 t7 -
1434 //--- t4 (mm0) may be <>0; mm1, mm5, mm6 == 0
1435//Typical numbers: nondc - 19%%, dc - 26%%, zero - 55%%. zero case alone isn't worthwhile
1436 "movq 0*8+%3, %%mm4 \n\t"
1437 "movq %%mm0, %%mm1 \n\t"
1438
1439 "pmulhw "MANGLE(MM_FIX_0_847759065)", %%mm0 \n\t" //tmp6
1440 "movq %%mm1, %%mm2 \n\t"
1441
1442 "movq "DCTSIZE_S"*0*2(%%"REG_D"), %%mm5 \n\t"
1443 "movq %%mm2, %%mm3 \n\t"
1444
1445 "pmulhw "MANGLE(MM_FIX_0_566454497)", %%mm1 \n\t" //tmp5
1446 "paddw %%mm4, %%mm5 \n\t"
1447
1448 "movq 1*8+%3, %%mm6 \n\t"
1449 //paddw mm3, MM_2
1450 "psraw $2, %%mm3 \n\t" //tmp7
1451
1452 "pmulhw "MANGLE(MM_FIX_0_198912367)", %%mm2 \n\t" //-tmp4
1453 "psubw %%mm3, %%mm4 \n\t"
1454
1455 "movq "DCTSIZE_S"*1*2(%%"REG_D"), %%mm7 \n\t"
1456 "paddw %%mm3, %%mm5 \n\t"
1457
1458 "movq %%mm4, "DCTSIZE_S"*7*2(%%"REG_D") \n\t"
1459 "paddw %%mm6, %%mm7 \n\t"
1460
1461 "movq 2*8+%3, %%mm3 \n\t"
1462 "psubw %%mm0, %%mm6 \n\t"
1463
1464 "movq "DCTSIZE_S"*2*2(%%"REG_D"), %%mm4 \n\t"
1465 "paddw %%mm0, %%mm7 \n\t"
1466
1467 "movq %%mm5, "DCTSIZE_S"*0*2(%%"REG_D") \n\t"
1468 "paddw %%mm3, %%mm4 \n\t"
1469
1470 "movq %%mm6, "DCTSIZE_S"*6*2(%%"REG_D") \n\t"
1471 "psubw %%mm1, %%mm3 \n\t"
1472
1473 "movq "DCTSIZE_S"*5*2(%%"REG_D"), %%mm5 \n\t"
1474 "paddw %%mm1, %%mm4 \n\t"
1475
1476 "movq "DCTSIZE_S"*3*2(%%"REG_D"), %%mm6 \n\t"
1477 "paddw %%mm3, %%mm5 \n\t"
1478
1479 "movq 3*8+%3, %%mm0 \n\t"
1480 "add $24, %%"REG_S" \n\t"
1481
1482 "movq %%mm7, "DCTSIZE_S"*1*2(%%"REG_D") \n\t"
1483 "paddw %%mm0, %%mm6 \n\t"
1484
1485 "movq %%mm4, "DCTSIZE_S"*2*2(%%"REG_D") \n\t"
1486 "psubw %%mm2, %%mm0 \n\t"
1487
1488 "movq "DCTSIZE_S"*4*2(%%"REG_D"), %%mm7 \n\t"
1489 "paddw %%mm2, %%mm6 \n\t"
1490
1491 "movq %%mm5, "DCTSIZE_S"*5*2(%%"REG_D") \n\t"
1492 "paddw %%mm0, %%mm7 \n\t"
1493
1494 "movq %%mm6, "DCTSIZE_S"*3*2(%%"REG_D") \n\t"
1495
1496 "movq %%mm7, "DCTSIZE_S"*4*2(%%"REG_D") \n\t"
1497 "add $24, %%"REG_D" \n\t"
1498 "sub $2, %%"REG_c" \n\t"
1499 "jnz 1b \n\t"
1500 "jmp 5f \n\t"
1501
1502 "3: \n\t"
1503 //--- non DC2
1504 //psraw mm1, 2 w/o it -> offset. thr1, thr1, thr1 (actually thr1, thr1, thr1-1)
1505 //psraw mm5, 2
1506 //psraw mm0, 2
1507 //psraw mm6, 2
1508 "movq %%mm5, %%mm3 \n\t"
1509 "psubw %%mm1, %%mm5 \n\t"
1510
1511 "psllw $1, %%mm5 \n\t" //'z10
1512 "paddw %%mm1, %%mm3 \n\t" //'z13
1513
1514 "movq %%mm0, %%mm2 \n\t"
1515 "psubw %%mm6, %%mm0 \n\t"
1516
1517 "movq %%mm5, %%mm1 \n\t"
1518 "psllw $1, %%mm0 \n\t" //'z12
1519
1520 "pmulhw "MANGLE(MM_FIX_2_613125930)", %%mm1 \n\t" //-
1521 "paddw %%mm0, %%mm5 \n\t"
1522
1523 "pmulhw "MANGLE(MM_FIX_1_847759065)", %%mm5 \n\t" //'z5
1524 "paddw %%mm6, %%mm2 \n\t" //'z11
1525
1526 "pmulhw "MANGLE(MM_FIX_1_082392200)", %%mm0 \n\t"
1527 "movq %%mm2, %%mm7 \n\t"
1528
1529 //---
1530 "movq 0*8+%3, %%mm4 \n\t"
1531 "psubw %%mm3, %%mm2 \n\t"
1532
1533 "psllw $1, %%mm2 \n\t"
1534 "paddw %%mm3, %%mm7 \n\t" //'t7
1535
1536 "pmulhw "MANGLE(MM_FIX_1_414213562)", %%mm2 \n\t" //'t11
1537 "movq %%mm4, %%mm6 \n\t"
1538 //paddw mm7, MM_2
1539 "psraw $2, %%mm7 \n\t"
1540
1541 "paddw "DCTSIZE_S"*0*2(%%"REG_D"), %%mm4 \n\t"
1542 "psubw %%mm7, %%mm6 \n\t"
1543
1544 "movq 1*8+%3, %%mm3 \n\t"
1545 "paddw %%mm7, %%mm4 \n\t"
1546
1547 "movq %%mm6, "DCTSIZE_S"*7*2(%%"REG_D") \n\t"
1548 "paddw %%mm5, %%mm1 \n\t" //'t12
1549
1550 "movq %%mm4, "DCTSIZE_S"*0*2(%%"REG_D") \n\t"
1551 "psubw %%mm7, %%mm1 \n\t" //'t6
1552
1553 "movq 2*8+%3, %%mm7 \n\t"
1554 "psubw %%mm5, %%mm0 \n\t" //'t10
1555
1556 "movq 3*8+%3, %%mm6 \n\t"
1557 "movq %%mm3, %%mm5 \n\t"
1558
1559 "paddw "DCTSIZE_S"*1*2(%%"REG_D"), %%mm3 \n\t"
1560 "psubw %%mm1, %%mm5 \n\t"
1561
1562 "psubw %%mm1, %%mm2 \n\t" //'t5
1563 "paddw %%mm1, %%mm3 \n\t"
1564
1565 "movq %%mm5, "DCTSIZE_S"*6*2(%%"REG_D") \n\t"
1566 "movq %%mm7, %%mm4 \n\t"
1567
1568 "paddw "DCTSIZE_S"*2*2(%%"REG_D"), %%mm7 \n\t"
1569 "psubw %%mm2, %%mm4 \n\t"
1570
1571 "paddw "DCTSIZE_S"*5*2(%%"REG_D"), %%mm4 \n\t"
1572 "paddw %%mm2, %%mm7 \n\t"
1573
1574 "movq %%mm3, "DCTSIZE_S"*1*2(%%"REG_D") \n\t"
1575 "paddw %%mm2, %%mm0 \n\t" //'t4
1576
1577 // 't4 't6 't5 - - - - 't7
1578 "movq %%mm7, "DCTSIZE_S"*2*2(%%"REG_D") \n\t"
1579 "movq %%mm6, %%mm1 \n\t"
1580
1581 "paddw "DCTSIZE_S"*4*2(%%"REG_D"), %%mm6 \n\t"
1582 "psubw %%mm0, %%mm1 \n\t"
1583
1584 "paddw "DCTSIZE_S"*3*2(%%"REG_D"), %%mm1 \n\t"
1585 "paddw %%mm0, %%mm6 \n\t"
1586
1587 "movq %%mm4, "DCTSIZE_S"*5*2(%%"REG_D") \n\t"
1588 "add $24, %%"REG_S" \n\t"
1589
1590 "movq %%mm6, "DCTSIZE_S"*4*2(%%"REG_D") \n\t"
1591
1592 "movq %%mm1, "DCTSIZE_S"*3*2(%%"REG_D") \n\t"
1593 "add $24, %%"REG_D" \n\t"
1594 "sub $2, %%"REG_c" \n\t"
1595 "jnz 1b \n\t"
1596 "5: \n\t"
1597
1598 : "+S"(data), "+D"(output), "+c"(cnt), "=o"(temps)
1599 : "d"(thr_adr)
1600 NAMED_CONSTRAINTS_ADD(ff_MM_FIX_0_707106781,MM_2,MM_FIX_1_414213562_A,MM_FIX_1_414213562,MM_FIX_0_382683433,
1601 ff_MM_FIX_0_541196100,MM_FIX_1_306562965,MM_FIX_0_847759065)
1602 NAMED_CONSTRAINTS_ADD(MM_FIX_0_566454497,MM_FIX_0_198912367,MM_FIX_2_613125930,MM_FIX_1_847759065,
1603 MM_FIX_1_082392200)
1604 : "%"REG_a
1605 );
1606}
1607
f6fa7814 1608#endif // HAVE_MMX_INLINE
2ba45a60 1609
f6fa7814 1610#if !HAVE_MMX_INLINE
2ba45a60
DM
1611
1612static void row_idct_c(int16_t* workspace,
1613 int16_t* output_adr, int output_stride, int cnt)
1614{
1615 int_simd16_t tmp0, tmp1, tmp2, tmp3, tmp4, tmp5, tmp6, tmp7;
1616 int_simd16_t tmp10, tmp11, tmp12, tmp13;
1617 int_simd16_t z5, z10, z11, z12, z13;
1618 int16_t* outptr;
1619 int16_t* wsptr;
1620
1621 cnt*=4;
1622 wsptr = workspace;
1623 outptr = output_adr;
1624 for (; cnt > 0; cnt--) {
1625 // Even part
1626 //Simd version reads 4x4 block and transposes it
1627 tmp10 = ( wsptr[2] + wsptr[3]);
1628 tmp11 = ( wsptr[2] - wsptr[3]);
1629
1630 tmp13 = ( wsptr[0] + wsptr[1]);
1631 tmp12 = (MULTIPLY16H( wsptr[0] - wsptr[1], FIX_1_414213562_A)<<2) - tmp13;//this shift order to avoid overflow
1632
1633 tmp0 = tmp10 + tmp13; //->temps
1634 tmp3 = tmp10 - tmp13; //->temps
1635 tmp1 = tmp11 + tmp12;
1636 tmp2 = tmp11 - tmp12;
1637
1638 // Odd part
1639 //Also transpose, with previous:
1640 // ---- ---- ||||
1641 // ---- ---- idct ||||
1642 // ---- ---- ---> ||||
1643 // ---- ---- ||||
1644 z13 = wsptr[4] + wsptr[5];
1645 z10 = wsptr[4] - wsptr[5];
1646 z11 = wsptr[6] + wsptr[7];
1647 z12 = wsptr[6] - wsptr[7];
1648
1649 tmp7 = z11 + z13;
1650 tmp11 = MULTIPLY16H(z11 - z13, FIX_1_414213562);
1651
1652 z5 = MULTIPLY16H(z10 + z12, FIX_1_847759065);
1653 tmp10 = MULTIPLY16H(z12, FIX_1_082392200) - z5;
1654 tmp12 = MULTIPLY16H(z10, FIX_2_613125930) + z5; // - FIX_
1655
1656 tmp6 = (tmp12<<3) - tmp7;
1657 tmp5 = (tmp11<<3) - tmp6;
1658 tmp4 = (tmp10<<3) + tmp5;
1659
1660 // Final output stage: descale and write column
1661 outptr[0*output_stride]+= DESCALE(tmp0 + tmp7, 3);
1662 outptr[1*output_stride]+= DESCALE(tmp1 + tmp6, 3);
1663 outptr[2*output_stride]+= DESCALE(tmp2 + tmp5, 3);
1664 outptr[3*output_stride]+= DESCALE(tmp3 - tmp4, 3);
1665 outptr[4*output_stride]+= DESCALE(tmp3 + tmp4, 3);
1666 outptr[5*output_stride]+= DESCALE(tmp2 - tmp5, 3);
1667 outptr[6*output_stride]+= DESCALE(tmp1 - tmp6, 3); //no += ?
1668 outptr[7*output_stride]+= DESCALE(tmp0 - tmp7, 3); //no += ?
1669 outptr++;
1670
1671 wsptr += DCTSIZE; // advance pointer to next row
1672 }
1673}
1674
f6fa7814 1675#else /* HAVE_MMX_INLINE */
2ba45a60
DM
1676
1677static void row_idct_mmx (int16_t* workspace,
1678 int16_t* output_adr, int output_stride, int cnt)
1679{
1680 DECLARE_ALIGNED(8, uint64_t, temps)[4];
1681 __asm__ volatile(
1682 "lea (%%"REG_a",%%"REG_a",2), %%"REG_d" \n\t"
1683 "1: \n\t"
1684 "movq "DCTSIZE_S"*0*2(%%"REG_S"), %%mm0 \n\t"
1685 //
1686
1687 "movq "DCTSIZE_S"*1*2(%%"REG_S"), %%mm1 \n\t"
1688 "movq %%mm0, %%mm4 \n\t"
1689
1690 "movq "DCTSIZE_S"*2*2(%%"REG_S"), %%mm2 \n\t"
1691 "punpcklwd %%mm1, %%mm0 \n\t"
1692
1693 "movq "DCTSIZE_S"*3*2(%%"REG_S"), %%mm3 \n\t"
1694 "punpckhwd %%mm1, %%mm4 \n\t"
1695
1696 //transpose 4x4
1697 "movq %%mm2, %%mm7 \n\t"
1698 "punpcklwd %%mm3, %%mm2 \n\t"
1699
1700 "movq %%mm0, %%mm6 \n\t"
1701 "punpckldq %%mm2, %%mm0 \n\t" //0
1702
1703 "punpckhdq %%mm2, %%mm6 \n\t" //1
1704 "movq %%mm0, %%mm5 \n\t"
1705
1706 "punpckhwd %%mm3, %%mm7 \n\t"
1707 "psubw %%mm6, %%mm0 \n\t"
1708
1709 "pmulhw "MANGLE(MM_FIX_1_414213562_A)", %%mm0 \n\t"
1710 "movq %%mm4, %%mm2 \n\t"
1711
1712 "punpckldq %%mm7, %%mm4 \n\t" //2
1713 "paddw %%mm6, %%mm5 \n\t"
1714
1715 "punpckhdq %%mm7, %%mm2 \n\t" //3
1716 "movq %%mm4, %%mm1 \n\t"
1717
1718 "psllw $2, %%mm0 \n\t"
1719 "paddw %%mm2, %%mm4 \n\t" //t10
1720
1721 "movq "DCTSIZE_S"*0*2+"DCTSIZE_S"(%%"REG_S"), %%mm3 \n\t"
1722 "psubw %%mm2, %%mm1 \n\t" //t11
1723
1724 "movq "DCTSIZE_S"*1*2+"DCTSIZE_S"(%%"REG_S"), %%mm2 \n\t"
1725 "psubw %%mm5, %%mm0 \n\t"
1726
1727 "movq %%mm4, %%mm6 \n\t"
1728 "paddw %%mm5, %%mm4 \n\t" //t0
1729
1730 "psubw %%mm5, %%mm6 \n\t" //t3
1731 "movq %%mm1, %%mm7 \n\t"
1732
1733 "movq "DCTSIZE_S"*2*2+"DCTSIZE_S"(%%"REG_S"), %%mm5 \n\t"
1734 "paddw %%mm0, %%mm1 \n\t" //t1
1735
1736 "movq %%mm4, 0*8+%3 \n\t" //t0
1737 "movq %%mm3, %%mm4 \n\t"
1738
1739 "movq %%mm6, 1*8+%3 \n\t" //t3
1740 "punpcklwd %%mm2, %%mm3 \n\t"
1741
1742 //transpose 4x4
1743 "movq "DCTSIZE_S"*3*2+"DCTSIZE_S"(%%"REG_S"), %%mm6 \n\t"
1744 "punpckhwd %%mm2, %%mm4 \n\t"
1745
1746 "movq %%mm5, %%mm2 \n\t"
1747 "punpcklwd %%mm6, %%mm5 \n\t"
1748
1749 "psubw %%mm0, %%mm7 \n\t" //t2
1750 "punpckhwd %%mm6, %%mm2 \n\t"
1751
1752 "movq %%mm3, %%mm0 \n\t"
1753 "punpckldq %%mm5, %%mm3 \n\t" //4
1754
1755 "punpckhdq %%mm5, %%mm0 \n\t" //5
1756 "movq %%mm4, %%mm5 \n\t"
1757
1758 //
1759 "movq %%mm3, %%mm6 \n\t"
1760 "punpckldq %%mm2, %%mm4 \n\t" //6
1761
1762 "psubw %%mm0, %%mm3 \n\t" //z10
1763 "punpckhdq %%mm2, %%mm5 \n\t" //7
1764
1765 "paddw %%mm0, %%mm6 \n\t" //z13
1766 "movq %%mm4, %%mm2 \n\t"
1767
1768 "movq %%mm3, %%mm0 \n\t"
1769 "psubw %%mm5, %%mm4 \n\t" //z12
1770
1771 "pmulhw "MANGLE(MM_FIX_2_613125930)", %%mm0 \n\t" //-
1772 "paddw %%mm4, %%mm3 \n\t"
1773
1774 "pmulhw "MANGLE(MM_FIX_1_847759065)", %%mm3 \n\t" //z5
1775 "paddw %%mm5, %%mm2 \n\t" //z11 >
1776
1777 "pmulhw "MANGLE(MM_FIX_1_082392200)", %%mm4 \n\t"
1778 "movq %%mm2, %%mm5 \n\t"
1779
1780 "psubw %%mm6, %%mm2 \n\t"
1781 "paddw %%mm6, %%mm5 \n\t" //t7
1782
1783 "pmulhw "MANGLE(MM_FIX_1_414213562)", %%mm2 \n\t" //t11
1784 "paddw %%mm3, %%mm0 \n\t" //t12
1785
1786 "psllw $3, %%mm0 \n\t"
1787 "psubw %%mm3, %%mm4 \n\t" //t10
1788
1789 "movq 0*8+%3, %%mm6 \n\t"
1790 "movq %%mm1, %%mm3 \n\t"
1791
1792 "psllw $3, %%mm4 \n\t"
1793 "psubw %%mm5, %%mm0 \n\t" //t6
1794
1795 "psllw $3, %%mm2 \n\t"
1796 "paddw %%mm0, %%mm1 \n\t" //d1
1797
1798 "psubw %%mm0, %%mm2 \n\t" //t5
1799 "psubw %%mm0, %%mm3 \n\t" //d6
1800
1801 "paddw %%mm2, %%mm4 \n\t" //t4
1802 "movq %%mm7, %%mm0 \n\t"
1803
1804 "paddw %%mm2, %%mm7 \n\t" //d2
1805 "psubw %%mm2, %%mm0 \n\t" //d5
1806
1807 "movq "MANGLE(MM_DESCALE_RND)", %%mm2 \n\t" //4
1808 "psubw %%mm5, %%mm6 \n\t" //d7
1809
1810 "paddw 0*8+%3, %%mm5 \n\t" //d0
1811 "paddw %%mm2, %%mm1 \n\t"
1812
1813 "paddw %%mm2, %%mm5 \n\t"
1814 "psraw $3, %%mm1 \n\t"
1815
1816 "paddw %%mm2, %%mm7 \n\t"
1817 "psraw $3, %%mm5 \n\t"
1818
1819 "paddw (%%"REG_D"), %%mm5 \n\t"
1820 "psraw $3, %%mm7 \n\t"
1821
1822 "paddw (%%"REG_D",%%"REG_a"), %%mm1 \n\t"
1823 "paddw %%mm2, %%mm0 \n\t"
1824
1825 "paddw (%%"REG_D",%%"REG_a",2), %%mm7 \n\t"
1826 "paddw %%mm2, %%mm3 \n\t"
1827
1828 "movq %%mm5, (%%"REG_D") \n\t"
1829 "paddw %%mm2, %%mm6 \n\t"
1830
1831 "movq %%mm1, (%%"REG_D",%%"REG_a") \n\t"
1832 "psraw $3, %%mm0 \n\t"
1833
1834 "movq %%mm7, (%%"REG_D",%%"REG_a",2) \n\t"
1835 "add %%"REG_d", %%"REG_D" \n\t" //3*ls
1836
1837 "movq 1*8+%3, %%mm5 \n\t" //t3
1838 "psraw $3, %%mm3 \n\t"
1839
1840 "paddw (%%"REG_D",%%"REG_a",2), %%mm0 \n\t"
1841 "psubw %%mm4, %%mm5 \n\t" //d3
1842
1843 "paddw (%%"REG_D",%%"REG_d"), %%mm3 \n\t"
1844 "psraw $3, %%mm6 \n\t"
1845
1846 "paddw 1*8+%3, %%mm4 \n\t" //d4
1847 "paddw %%mm2, %%mm5 \n\t"
1848
1849 "paddw (%%"REG_D",%%"REG_a",4), %%mm6 \n\t"
1850 "paddw %%mm2, %%mm4 \n\t"
1851
1852 "movq %%mm0, (%%"REG_D",%%"REG_a",2) \n\t"
1853 "psraw $3, %%mm5 \n\t"
1854
1855 "paddw (%%"REG_D"), %%mm5 \n\t"
1856 "psraw $3, %%mm4 \n\t"
1857
1858 "paddw (%%"REG_D",%%"REG_a"), %%mm4 \n\t"
1859 "add $"DCTSIZE_S"*2*4, %%"REG_S" \n\t" //4 rows
1860
1861 "movq %%mm3, (%%"REG_D",%%"REG_d") \n\t"
1862 "movq %%mm6, (%%"REG_D",%%"REG_a",4) \n\t"
1863 "movq %%mm5, (%%"REG_D") \n\t"
1864 "movq %%mm4, (%%"REG_D",%%"REG_a") \n\t"
1865
1866 "sub %%"REG_d", %%"REG_D" \n\t"
1867 "add $8, %%"REG_D" \n\t"
1868 "dec %%"REG_c" \n\t"
1869 "jnz 1b \n\t"
1870
1871 : "+S"(workspace), "+D"(output_adr), "+c"(cnt), "=o"(temps)
1872 : "a"(output_stride*sizeof(short))
1873 NAMED_CONSTRAINTS_ADD(MM_FIX_1_414213562_A,MM_FIX_2_613125930,MM_FIX_1_847759065,MM_FIX_1_082392200,
1874 MM_FIX_1_414213562,MM_DESCALE_RND)
1875 : "%"REG_d
1876 );
1877}
1878
f6fa7814 1879#endif // HAVE_MMX_INLINE
2ba45a60 1880
f6fa7814 1881#if !HAVE_MMX_INLINE
2ba45a60
DM
1882
1883static void row_fdct_c(int16_t *data, const uint8_t *pixels, int line_size, int cnt)
1884{
1885 int_simd16_t tmp0, tmp1, tmp2, tmp3, tmp4, tmp5, tmp6, tmp7;
1886 int_simd16_t tmp10, tmp11, tmp12, tmp13;
1887 int_simd16_t z1, z2, z3, z4, z5, z11, z13;
1888 int16_t *dataptr;
1889
1890 cnt*=4;
1891 // Pass 1: process rows.
1892
1893 dataptr = data;
1894 for (; cnt > 0; cnt--) {
1895 tmp0 = pixels[line_size*0] + pixels[line_size*7];
1896 tmp7 = pixels[line_size*0] - pixels[line_size*7];
1897 tmp1 = pixels[line_size*1] + pixels[line_size*6];
1898 tmp6 = pixels[line_size*1] - pixels[line_size*6];
1899 tmp2 = pixels[line_size*2] + pixels[line_size*5];
1900 tmp5 = pixels[line_size*2] - pixels[line_size*5];
1901 tmp3 = pixels[line_size*3] + pixels[line_size*4];
1902 tmp4 = pixels[line_size*3] - pixels[line_size*4];
1903
1904 // Even part
1905
1906 tmp10 = tmp0 + tmp3;
1907 tmp13 = tmp0 - tmp3;
1908 tmp11 = tmp1 + tmp2;
1909 tmp12 = tmp1 - tmp2;
1910 //Even columns are written first, this leads to different order of columns
1911 //in column_fidct(), but they are processed independently, so all ok.
1912 //Later in the row_idct() columns readed at the same order.
1913 dataptr[2] = tmp10 + tmp11;
1914 dataptr[3] = tmp10 - tmp11;
1915
1916 z1 = MULTIPLY16H((tmp12 + tmp13)<<2, FIX_0_707106781);
1917 dataptr[0] = tmp13 + z1;
1918 dataptr[1] = tmp13 - z1;
1919
1920 // Odd part
1921
1922 tmp10 = (tmp4 + tmp5) <<2;
1923 tmp11 = (tmp5 + tmp6) <<2;
1924 tmp12 = (tmp6 + tmp7) <<2;
1925
1926 z5 = MULTIPLY16H(tmp10 - tmp12, FIX_0_382683433);
1927 z2 = MULTIPLY16H(tmp10, FIX_0_541196100) + z5;
1928 z4 = MULTIPLY16H(tmp12, FIX_1_306562965) + z5;
1929 z3 = MULTIPLY16H(tmp11, FIX_0_707106781);
1930
1931 z11 = tmp7 + z3;
1932 z13 = tmp7 - z3;
1933
1934 dataptr[4] = z13 + z2;
1935 dataptr[5] = z13 - z2;
1936 dataptr[6] = z11 + z4;
1937 dataptr[7] = z11 - z4;
1938
1939 pixels++; // advance pointer to next column
1940 dataptr += DCTSIZE;
1941 }
1942}
1943
f6fa7814 1944#else /* HAVE_MMX_INLINE */
2ba45a60
DM
1945
1946static void row_fdct_mmx(int16_t *data, const uint8_t *pixels, int line_size, int cnt)
1947{
1948 DECLARE_ALIGNED(8, uint64_t, temps)[4];
1949 __asm__ volatile(
1950 "lea (%%"REG_a",%%"REG_a",2), %%"REG_d" \n\t"
1951 "6: \n\t"
1952 "movd (%%"REG_S"), %%mm0 \n\t"
1953 "pxor %%mm7, %%mm7 \n\t"
1954
1955 "movd (%%"REG_S",%%"REG_a"), %%mm1 \n\t"
1956 "punpcklbw %%mm7, %%mm0 \n\t"
1957
1958 "movd (%%"REG_S",%%"REG_a",2), %%mm2 \n\t"
1959 "punpcklbw %%mm7, %%mm1 \n\t"
1960
1961 "punpcklbw %%mm7, %%mm2 \n\t"
1962 "add %%"REG_d", %%"REG_S" \n\t"
1963
1964 "movq %%mm0, %%mm5 \n\t"
1965 //
1966
1967 "movd (%%"REG_S",%%"REG_a",4), %%mm3 \n\t" //7 ;prefetch!
1968 "movq %%mm1, %%mm6 \n\t"
1969
1970 "movd (%%"REG_S",%%"REG_d"), %%mm4 \n\t" //6
1971 "punpcklbw %%mm7, %%mm3 \n\t"
1972
1973 "psubw %%mm3, %%mm5 \n\t"
1974 "punpcklbw %%mm7, %%mm4 \n\t"
1975
1976 "paddw %%mm3, %%mm0 \n\t"
1977 "psubw %%mm4, %%mm6 \n\t"
1978
1979 "movd (%%"REG_S",%%"REG_a",2), %%mm3 \n\t" //5
1980 "paddw %%mm4, %%mm1 \n\t"
1981
1982 "movq %%mm5, %3 \n\t" //t7
1983 "punpcklbw %%mm7, %%mm3 \n\t"
1984
1985 "movq %%mm6, %4 \n\t" //t6
1986 "movq %%mm2, %%mm4 \n\t"
1987
1988 "movd (%%"REG_S"), %%mm5 \n\t" //3
1989 "paddw %%mm3, %%mm2 \n\t"
1990
1991 "movd (%%"REG_S",%%"REG_a"), %%mm6 \n\t" //4
1992 "punpcklbw %%mm7, %%mm5 \n\t"
1993
1994 "psubw %%mm3, %%mm4 \n\t"
1995 "punpcklbw %%mm7, %%mm6 \n\t"
1996
1997 "movq %%mm5, %%mm3 \n\t"
1998 "paddw %%mm6, %%mm5 \n\t" //t3
1999
2000 "psubw %%mm6, %%mm3 \n\t" //t4 ; t0 t1 t2 t4 t5 t3 - -
2001 "movq %%mm0, %%mm6 \n\t"
2002
2003 "movq %%mm1, %%mm7 \n\t"
2004 "psubw %%mm5, %%mm0 \n\t" //t13
2005
2006 "psubw %%mm2, %%mm1 \n\t"
2007 "paddw %%mm2, %%mm7 \n\t" //t11
2008
2009 "paddw %%mm0, %%mm1 \n\t"
2010 "movq %%mm7, %%mm2 \n\t"
2011
2012 "psllw $2, %%mm1 \n\t"
2013 "paddw %%mm5, %%mm6 \n\t" //t10
2014
2015 "pmulhw "MANGLE(ff_MM_FIX_0_707106781)", %%mm1 \n\t"
2016 "paddw %%mm6, %%mm7 \n\t" //d2
2017
2018 "psubw %%mm2, %%mm6 \n\t" //d3
2019 "movq %%mm0, %%mm5 \n\t"
2020
2021 //transpose 4x4
2022 "movq %%mm7, %%mm2 \n\t"
2023 "punpcklwd %%mm6, %%mm7 \n\t"
2024
2025 "paddw %%mm1, %%mm0 \n\t" //d0
2026 "punpckhwd %%mm6, %%mm2 \n\t"
2027
2028 "psubw %%mm1, %%mm5 \n\t" //d1
2029 "movq %%mm0, %%mm6 \n\t"
2030
2031 "movq %4, %%mm1 \n\t"
2032 "punpcklwd %%mm5, %%mm0 \n\t"
2033
2034 "punpckhwd %%mm5, %%mm6 \n\t"
2035 "movq %%mm0, %%mm5 \n\t"
2036
2037 "punpckldq %%mm7, %%mm0 \n\t" //0
2038 "paddw %%mm4, %%mm3 \n\t"
2039
2040 "punpckhdq %%mm7, %%mm5 \n\t" //1
2041 "movq %%mm6, %%mm7 \n\t"
2042
2043 "movq %%mm0, "DCTSIZE_S"*0*2(%%"REG_D") \n\t"
2044 "punpckldq %%mm2, %%mm6 \n\t" //2
2045
2046 "movq %%mm5, "DCTSIZE_S"*1*2(%%"REG_D") \n\t"
2047 "punpckhdq %%mm2, %%mm7 \n\t" //3
2048
2049 "movq %%mm6, "DCTSIZE_S"*2*2(%%"REG_D") \n\t"
2050 "paddw %%mm1, %%mm4 \n\t"
2051
2052 "movq %%mm7, "DCTSIZE_S"*3*2(%%"REG_D") \n\t"
2053 "psllw $2, %%mm3 \n\t" //t10
2054
2055 "movq %3, %%mm2 \n\t"
2056 "psllw $2, %%mm4 \n\t" //t11
2057
2058 "pmulhw "MANGLE(ff_MM_FIX_0_707106781)", %%mm4 \n\t" //z3
2059 "paddw %%mm2, %%mm1 \n\t"
2060
2061 "psllw $2, %%mm1 \n\t" //t12
2062 "movq %%mm3, %%mm0 \n\t"
2063
2064 "pmulhw "MANGLE(ff_MM_FIX_0_541196100)", %%mm0 \n\t"
2065 "psubw %%mm1, %%mm3 \n\t"
2066
2067 "pmulhw "MANGLE(MM_FIX_0_382683433)", %%mm3 \n\t" //z5
2068 "movq %%mm2, %%mm5 \n\t"
2069
2070 "pmulhw "MANGLE(MM_FIX_1_306562965)", %%mm1 \n\t"
2071 "psubw %%mm4, %%mm2 \n\t" //z13
2072
2073 "paddw %%mm4, %%mm5 \n\t" //z11
2074 "movq %%mm2, %%mm6 \n\t"
2075
2076 "paddw %%mm3, %%mm0 \n\t" //z2
2077 "movq %%mm5, %%mm7 \n\t"
2078
2079 "paddw %%mm0, %%mm2 \n\t" //d4
2080 "psubw %%mm0, %%mm6 \n\t" //d5
2081
2082 "movq %%mm2, %%mm4 \n\t"
2083 "paddw %%mm3, %%mm1 \n\t" //z4
2084
2085 //transpose 4x4
2086 "punpcklwd %%mm6, %%mm2 \n\t"
2087 "paddw %%mm1, %%mm5 \n\t" //d6
2088
2089 "punpckhwd %%mm6, %%mm4 \n\t"
2090 "psubw %%mm1, %%mm7 \n\t" //d7
2091
2092 "movq %%mm5, %%mm6 \n\t"
2093 "punpcklwd %%mm7, %%mm5 \n\t"
2094
2095 "punpckhwd %%mm7, %%mm6 \n\t"
2096 "movq %%mm2, %%mm7 \n\t"
2097
2098 "punpckldq %%mm5, %%mm2 \n\t" //4
2099 "sub %%"REG_d", %%"REG_S" \n\t"
2100
2101 "punpckhdq %%mm5, %%mm7 \n\t" //5
2102 "movq %%mm4, %%mm5 \n\t"
2103
2104 "movq %%mm2, "DCTSIZE_S"*0*2+"DCTSIZE_S"(%%"REG_D") \n\t"
2105 "punpckldq %%mm6, %%mm4 \n\t" //6
2106
2107 "movq %%mm7, "DCTSIZE_S"*1*2+"DCTSIZE_S"(%%"REG_D") \n\t"
2108 "punpckhdq %%mm6, %%mm5 \n\t" //7
2109
2110 "movq %%mm4, "DCTSIZE_S"*2*2+"DCTSIZE_S"(%%"REG_D") \n\t"
2111 "add $4, %%"REG_S" \n\t"
2112
2113 "movq %%mm5, "DCTSIZE_S"*3*2+"DCTSIZE_S"(%%"REG_D") \n\t"
2114 "add $"DCTSIZE_S"*2*4, %%"REG_D" \n\t" //4 rows
2115 "dec %%"REG_c" \n\t"
2116 "jnz 6b \n\t"
2117
2118 : "+S"(pixels), "+D"(data), "+c"(cnt), "=o"(temps), "=o"(temps[1])
2119 : "a"(line_size)
2120 NAMED_CONSTRAINTS_ADD(ff_MM_FIX_0_707106781,ff_MM_FIX_0_541196100,MM_FIX_0_382683433,MM_FIX_1_306562965)
2121 : "%"REG_d);
2122}
2123
f6fa7814 2124#endif // HAVE_MMX_INLINE