Merge commit '528daa399018af74d52192eb1861d2b59d256111'
[ffmpeg.git] / libavcodec / vc1dsp.c
1 /*
2  * VC-1 and WMV3 decoder - DSP functions
3  * Copyright (c) 2006 Konstantin Shishkov
4  *
5  * This file is part of FFmpeg.
6  *
7  * FFmpeg is free software; you can redistribute it and/or
8  * modify it under the terms of the GNU Lesser General Public
9  * License as published by the Free Software Foundation; either
10  * version 2.1 of the License, or (at your option) any later version.
11  *
12  * FFmpeg 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 GNU
15  * Lesser General Public License for more details.
16  *
17  * You should have received a copy of the GNU Lesser General Public
18  * License along with FFmpeg; if not, write to the Free Software
19  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20  */
21
22 /**
23 * @file
24  * VC-1 and WMV3 decoder
25  *
26  */
27
28 #include "libavutil/avassert.h"
29 #include "libavutil/common.h"
30 #include "h264chroma.h"
31 #include "rnd_avg.h"
32 #include "vc1dsp.h"
33
34
35 /** Apply overlap transform to horizontal edge
36 */
37 static void vc1_v_overlap_c(uint8_t* src, int stride)
38 {
39     int i;
40     int a, b, c, d;
41     int d1, d2;
42     int rnd = 1;
43     for(i = 0; i < 8; i++) {
44         a = src[-2*stride];
45         b = src[-stride];
46         c = src[0];
47         d = src[stride];
48         d1 = (a - d + 3 + rnd) >> 3;
49         d2 = (a - d + b - c + 4 - rnd) >> 3;
50
51         src[-2*stride] = a - d1;
52         src[-stride] = av_clip_uint8(b - d2);
53         src[0] = av_clip_uint8(c + d2);
54         src[stride] = d + d1;
55         src++;
56         rnd = !rnd;
57     }
58 }
59
60 /** Apply overlap transform to vertical edge
61 */
62 static void vc1_h_overlap_c(uint8_t* src, int stride)
63 {
64     int i;
65     int a, b, c, d;
66     int d1, d2;
67     int rnd = 1;
68     for(i = 0; i < 8; i++) {
69         a = src[-2];
70         b = src[-1];
71         c = src[0];
72         d = src[1];
73         d1 = (a - d + 3 + rnd) >> 3;
74         d2 = (a - d + b - c + 4 - rnd) >> 3;
75
76         src[-2] = a - d1;
77         src[-1] = av_clip_uint8(b - d2);
78         src[0] = av_clip_uint8(c + d2);
79         src[1] = d + d1;
80         src += stride;
81         rnd = !rnd;
82     }
83 }
84
85 static void vc1_v_s_overlap_c(int16_t *top,  int16_t *bottom)
86 {
87     int i;
88     int a, b, c, d;
89     int d1, d2;
90     int rnd1 = 4, rnd2 = 3;
91     for(i = 0; i < 8; i++) {
92         a = top[48];
93         b = top[56];
94         c = bottom[0];
95         d = bottom[8];
96         d1 = a - d;
97         d2 = a - d + b - c;
98
99         top[48]   = ((a << 3) - d1 + rnd1) >> 3;
100         top[56]   = ((b << 3) - d2 + rnd2) >> 3;
101         bottom[0] = ((c << 3) + d2 + rnd1) >> 3;
102         bottom[8] = ((d << 3) + d1 + rnd2) >> 3;
103
104         bottom++;
105         top++;
106         rnd2 = 7 - rnd2;
107         rnd1 = 7 - rnd1;
108     }
109 }
110
111 static void vc1_h_s_overlap_c(int16_t *left, int16_t *right)
112 {
113     int i;
114     int a, b, c, d;
115     int d1, d2;
116     int rnd1 = 4, rnd2 = 3;
117     for(i = 0; i < 8; i++) {
118         a = left[6];
119         b = left[7];
120         c = right[0];
121         d = right[1];
122         d1 = a - d;
123         d2 = a - d + b - c;
124
125         left[6]  = ((a << 3) - d1 + rnd1) >> 3;
126         left[7]  = ((b << 3) - d2 + rnd2) >> 3;
127         right[0] = ((c << 3) + d2 + rnd1) >> 3;
128         right[1] = ((d << 3) + d1 + rnd2) >> 3;
129
130         right += 8;
131         left += 8;
132         rnd2 = 7 - rnd2;
133         rnd1 = 7 - rnd1;
134     }
135 }
136
137 /**
138  * VC-1 in-loop deblocking filter for one line
139  * @param src source block type
140  * @param stride block stride
141  * @param pq block quantizer
142  * @return whether other 3 pairs should be filtered or not
143  * @see 8.6
144  */
145 static av_always_inline int vc1_filter_line(uint8_t* src, int stride, int pq){
146     int a0 = (2*(src[-2*stride] - src[ 1*stride]) - 5*(src[-1*stride] - src[ 0*stride]) + 4) >> 3;
147     int a0_sign = a0 >> 31;        /* Store sign */
148     a0 = (a0 ^ a0_sign) - a0_sign; /* a0 = FFABS(a0); */
149     if(a0 < pq){
150         int a1 = FFABS((2*(src[-4*stride] - src[-1*stride]) - 5*(src[-3*stride] - src[-2*stride]) + 4) >> 3);
151         int a2 = FFABS((2*(src[ 0*stride] - src[ 3*stride]) - 5*(src[ 1*stride] - src[ 2*stride]) + 4) >> 3);
152         if(a1 < a0 || a2 < a0){
153             int clip = src[-1*stride] - src[ 0*stride];
154             int clip_sign = clip >> 31;
155             clip = ((clip ^ clip_sign) - clip_sign)>>1;
156             if(clip){
157                 int a3 = FFMIN(a1, a2);
158                 int d = 5 * (a3 - a0);
159                 int d_sign = (d >> 31);
160                 d = ((d ^ d_sign) - d_sign) >> 3;
161                 d_sign ^= a0_sign;
162
163                 if( d_sign ^ clip_sign )
164                     d = 0;
165                 else{
166                     d = FFMIN(d, clip);
167                     d = (d ^ d_sign) - d_sign;          /* Restore sign */
168                     src[-1*stride] = av_clip_uint8(src[-1*stride] - d);
169                     src[ 0*stride] = av_clip_uint8(src[ 0*stride] + d);
170                 }
171                 return 1;
172             }
173         }
174     }
175     return 0;
176 }
177
178 /**
179  * VC-1 in-loop deblocking filter
180  * @param src source block type
181  * @param step distance between horizontally adjacent elements
182  * @param stride distance between vertically adjacent elements
183  * @param len edge length to filter (4 or 8 pixels)
184  * @param pq block quantizer
185  * @see 8.6
186  */
187 static inline void vc1_loop_filter(uint8_t* src, int step, int stride, int len, int pq)
188 {
189     int i;
190     int filt3;
191
192     for(i = 0; i < len; i += 4){
193         filt3 = vc1_filter_line(src + 2*step, stride, pq);
194         if(filt3){
195             vc1_filter_line(src + 0*step, stride, pq);
196             vc1_filter_line(src + 1*step, stride, pq);
197             vc1_filter_line(src + 3*step, stride, pq);
198         }
199         src += step * 4;
200     }
201 }
202
203 static void vc1_v_loop_filter4_c(uint8_t *src, int stride, int pq)
204 {
205     vc1_loop_filter(src, 1, stride, 4, pq);
206 }
207
208 static void vc1_h_loop_filter4_c(uint8_t *src, int stride, int pq)
209 {
210     vc1_loop_filter(src, stride, 1, 4, pq);
211 }
212
213 static void vc1_v_loop_filter8_c(uint8_t *src, int stride, int pq)
214 {
215     vc1_loop_filter(src, 1, stride, 8, pq);
216 }
217
218 static void vc1_h_loop_filter8_c(uint8_t *src, int stride, int pq)
219 {
220     vc1_loop_filter(src, stride, 1, 8, pq);
221 }
222
223 static void vc1_v_loop_filter16_c(uint8_t *src, int stride, int pq)
224 {
225     vc1_loop_filter(src, 1, stride, 16, pq);
226 }
227
228 static void vc1_h_loop_filter16_c(uint8_t *src, int stride, int pq)
229 {
230     vc1_loop_filter(src, stride, 1, 16, pq);
231 }
232
233 /** Do inverse transform on 8x8 block
234 */
235 static void vc1_inv_trans_8x8_dc_c(uint8_t *dest, int linesize, int16_t *block)
236 {
237     int i;
238     int dc = block[0];
239     dc = (3 * dc +  1) >> 1;
240     dc = (3 * dc + 16) >> 5;
241     for(i = 0; i < 8; i++){
242         dest[0] = av_clip_uint8(dest[0] + dc);
243         dest[1] = av_clip_uint8(dest[1] + dc);
244         dest[2] = av_clip_uint8(dest[2] + dc);
245         dest[3] = av_clip_uint8(dest[3] + dc);
246         dest[4] = av_clip_uint8(dest[4] + dc);
247         dest[5] = av_clip_uint8(dest[5] + dc);
248         dest[6] = av_clip_uint8(dest[6] + dc);
249         dest[7] = av_clip_uint8(dest[7] + dc);
250         dest += linesize;
251     }
252 }
253
254 static void vc1_inv_trans_8x8_c(int16_t block[64])
255 {
256     int i;
257     register int t1,t2,t3,t4,t5,t6,t7,t8;
258     int16_t *src, *dst, temp[64];
259
260     src = block;
261     dst = temp;
262     for(i = 0; i < 8; i++){
263         t1 = 12 * (src[ 0] + src[32]) + 4;
264         t2 = 12 * (src[ 0] - src[32]) + 4;
265         t3 = 16 * src[16] +  6 * src[48];
266         t4 =  6 * src[16] - 16 * src[48];
267
268         t5 = t1 + t3;
269         t6 = t2 + t4;
270         t7 = t2 - t4;
271         t8 = t1 - t3;
272
273         t1 = 16 * src[ 8] + 15 * src[24] +  9 * src[40] +  4 * src[56];
274         t2 = 15 * src[ 8] -  4 * src[24] - 16 * src[40] -  9 * src[56];
275         t3 =  9 * src[ 8] - 16 * src[24] +  4 * src[40] + 15 * src[56];
276         t4 =  4 * src[ 8] -  9 * src[24] + 15 * src[40] - 16 * src[56];
277
278         dst[0] = (t5 + t1) >> 3;
279         dst[1] = (t6 + t2) >> 3;
280         dst[2] = (t7 + t3) >> 3;
281         dst[3] = (t8 + t4) >> 3;
282         dst[4] = (t8 - t4) >> 3;
283         dst[5] = (t7 - t3) >> 3;
284         dst[6] = (t6 - t2) >> 3;
285         dst[7] = (t5 - t1) >> 3;
286
287         src += 1;
288         dst += 8;
289     }
290
291     src = temp;
292     dst = block;
293     for(i = 0; i < 8; i++){
294         t1 = 12 * (src[ 0] + src[32]) + 64;
295         t2 = 12 * (src[ 0] - src[32]) + 64;
296         t3 = 16 * src[16] +  6 * src[48];
297         t4 =  6 * src[16] - 16 * src[48];
298
299         t5 = t1 + t3;
300         t6 = t2 + t4;
301         t7 = t2 - t4;
302         t8 = t1 - t3;
303
304         t1 = 16 * src[ 8] + 15 * src[24] +  9 * src[40] +  4 * src[56];
305         t2 = 15 * src[ 8] -  4 * src[24] - 16 * src[40] -  9 * src[56];
306         t3 =  9 * src[ 8] - 16 * src[24] +  4 * src[40] + 15 * src[56];
307         t4 =  4 * src[ 8] -  9 * src[24] + 15 * src[40] - 16 * src[56];
308
309         dst[ 0] = (t5 + t1) >> 7;
310         dst[ 8] = (t6 + t2) >> 7;
311         dst[16] = (t7 + t3) >> 7;
312         dst[24] = (t8 + t4) >> 7;
313         dst[32] = (t8 - t4 + 1) >> 7;
314         dst[40] = (t7 - t3 + 1) >> 7;
315         dst[48] = (t6 - t2 + 1) >> 7;
316         dst[56] = (t5 - t1 + 1) >> 7;
317
318         src++;
319         dst++;
320     }
321 }
322
323 /** Do inverse transform on 8x4 part of block
324 */
325 static void vc1_inv_trans_8x4_dc_c(uint8_t *dest, int linesize, int16_t *block)
326 {
327     int i;
328     int dc = block[0];
329     dc = ( 3 * dc +  1) >> 1;
330     dc = (17 * dc + 64) >> 7;
331     for(i = 0; i < 4; i++){
332         dest[0] = av_clip_uint8(dest[0] + dc);
333         dest[1] = av_clip_uint8(dest[1] + dc);
334         dest[2] = av_clip_uint8(dest[2] + dc);
335         dest[3] = av_clip_uint8(dest[3] + dc);
336         dest[4] = av_clip_uint8(dest[4] + dc);
337         dest[5] = av_clip_uint8(dest[5] + dc);
338         dest[6] = av_clip_uint8(dest[6] + dc);
339         dest[7] = av_clip_uint8(dest[7] + dc);
340         dest += linesize;
341     }
342 }
343
344 static void vc1_inv_trans_8x4_c(uint8_t *dest, int linesize, int16_t *block)
345 {
346     int i;
347     register int t1,t2,t3,t4,t5,t6,t7,t8;
348     int16_t *src, *dst;
349
350     src = block;
351     dst = block;
352     for(i = 0; i < 4; i++){
353         t1 = 12 * (src[0] + src[4]) + 4;
354         t2 = 12 * (src[0] - src[4]) + 4;
355         t3 = 16 * src[2] +  6 * src[6];
356         t4 =  6 * src[2] - 16 * src[6];
357
358         t5 = t1 + t3;
359         t6 = t2 + t4;
360         t7 = t2 - t4;
361         t8 = t1 - t3;
362
363         t1 = 16 * src[1] + 15 * src[3] +  9 * src[5] +  4 * src[7];
364         t2 = 15 * src[1] -  4 * src[3] - 16 * src[5] -  9 * src[7];
365         t3 =  9 * src[1] - 16 * src[3] +  4 * src[5] + 15 * src[7];
366         t4 =  4 * src[1] -  9 * src[3] + 15 * src[5] - 16 * src[7];
367
368         dst[0] = (t5 + t1) >> 3;
369         dst[1] = (t6 + t2) >> 3;
370         dst[2] = (t7 + t3) >> 3;
371         dst[3] = (t8 + t4) >> 3;
372         dst[4] = (t8 - t4) >> 3;
373         dst[5] = (t7 - t3) >> 3;
374         dst[6] = (t6 - t2) >> 3;
375         dst[7] = (t5 - t1) >> 3;
376
377         src += 8;
378         dst += 8;
379     }
380
381     src = block;
382     for(i = 0; i < 8; i++){
383         t1 = 17 * (src[ 0] + src[16]) + 64;
384         t2 = 17 * (src[ 0] - src[16]) + 64;
385         t3 = 22 * src[ 8] + 10 * src[24];
386         t4 = 22 * src[24] - 10 * src[ 8];
387
388         dest[0*linesize] = av_clip_uint8(dest[0*linesize] + ((t1 + t3) >> 7));
389         dest[1*linesize] = av_clip_uint8(dest[1*linesize] + ((t2 - t4) >> 7));
390         dest[2*linesize] = av_clip_uint8(dest[2*linesize] + ((t2 + t4) >> 7));
391         dest[3*linesize] = av_clip_uint8(dest[3*linesize] + ((t1 - t3) >> 7));
392
393         src ++;
394         dest++;
395     }
396 }
397
398 /** Do inverse transform on 4x8 parts of block
399 */
400 static void vc1_inv_trans_4x8_dc_c(uint8_t *dest, int linesize, int16_t *block)
401 {
402     int i;
403     int dc = block[0];
404     dc = (17 * dc +  4) >> 3;
405     dc = (12 * dc + 64) >> 7;
406     for(i = 0; i < 8; i++){
407         dest[0] = av_clip_uint8(dest[0] + dc);
408         dest[1] = av_clip_uint8(dest[1] + dc);
409         dest[2] = av_clip_uint8(dest[2] + dc);
410         dest[3] = av_clip_uint8(dest[3] + dc);
411         dest += linesize;
412     }
413 }
414
415 static void vc1_inv_trans_4x8_c(uint8_t *dest, int linesize, int16_t *block)
416 {
417     int i;
418     register int t1,t2,t3,t4,t5,t6,t7,t8;
419     int16_t *src, *dst;
420
421     src = block;
422     dst = block;
423     for(i = 0; i < 8; i++){
424         t1 = 17 * (src[0] + src[2]) + 4;
425         t2 = 17 * (src[0] - src[2]) + 4;
426         t3 = 22 * src[1] + 10 * src[3];
427         t4 = 22 * src[3] - 10 * src[1];
428
429         dst[0] = (t1 + t3) >> 3;
430         dst[1] = (t2 - t4) >> 3;
431         dst[2] = (t2 + t4) >> 3;
432         dst[3] = (t1 - t3) >> 3;
433
434         src += 8;
435         dst += 8;
436     }
437
438     src = block;
439     for(i = 0; i < 4; i++){
440         t1 = 12 * (src[ 0] + src[32]) + 64;
441         t2 = 12 * (src[ 0] - src[32]) + 64;
442         t3 = 16 * src[16] +  6 * src[48];
443         t4 =  6 * src[16] - 16 * src[48];
444
445         t5 = t1 + t3;
446         t6 = t2 + t4;
447         t7 = t2 - t4;
448         t8 = t1 - t3;
449
450         t1 = 16 * src[ 8] + 15 * src[24] +  9 * src[40] +  4 * src[56];
451         t2 = 15 * src[ 8] -  4 * src[24] - 16 * src[40] -  9 * src[56];
452         t3 =  9 * src[ 8] - 16 * src[24] +  4 * src[40] + 15 * src[56];
453         t4 =  4 * src[ 8] -  9 * src[24] + 15 * src[40] - 16 * src[56];
454
455         dest[0*linesize] = av_clip_uint8(dest[0*linesize] + ((t5 + t1) >> 7));
456         dest[1*linesize] = av_clip_uint8(dest[1*linesize] + ((t6 + t2) >> 7));
457         dest[2*linesize] = av_clip_uint8(dest[2*linesize] + ((t7 + t3) >> 7));
458         dest[3*linesize] = av_clip_uint8(dest[3*linesize] + ((t8 + t4) >> 7));
459         dest[4*linesize] = av_clip_uint8(dest[4*linesize] + ((t8 - t4 + 1) >> 7));
460         dest[5*linesize] = av_clip_uint8(dest[5*linesize] + ((t7 - t3 + 1) >> 7));
461         dest[6*linesize] = av_clip_uint8(dest[6*linesize] + ((t6 - t2 + 1) >> 7));
462         dest[7*linesize] = av_clip_uint8(dest[7*linesize] + ((t5 - t1 + 1) >> 7));
463
464         src ++;
465         dest++;
466     }
467 }
468
469 /** Do inverse transform on 4x4 part of block
470 */
471 static void vc1_inv_trans_4x4_dc_c(uint8_t *dest, int linesize, int16_t *block)
472 {
473     int i;
474     int dc = block[0];
475     dc = (17 * dc +  4) >> 3;
476     dc = (17 * dc + 64) >> 7;
477     for(i = 0; i < 4; i++){
478         dest[0] = av_clip_uint8(dest[0] + dc);
479         dest[1] = av_clip_uint8(dest[1] + dc);
480         dest[2] = av_clip_uint8(dest[2] + dc);
481         dest[3] = av_clip_uint8(dest[3] + dc);
482         dest += linesize;
483     }
484 }
485
486 static void vc1_inv_trans_4x4_c(uint8_t *dest, int linesize, int16_t *block)
487 {
488     int i;
489     register int t1,t2,t3,t4;
490     int16_t *src, *dst;
491
492     src = block;
493     dst = block;
494     for(i = 0; i < 4; i++){
495         t1 = 17 * (src[0] + src[2]) + 4;
496         t2 = 17 * (src[0] - src[2]) + 4;
497         t3 = 22 * src[1] + 10 * src[3];
498         t4 = 22 * src[3] - 10 * src[1];
499
500         dst[0] = (t1 + t3) >> 3;
501         dst[1] = (t2 - t4) >> 3;
502         dst[2] = (t2 + t4) >> 3;
503         dst[3] = (t1 - t3) >> 3;
504
505         src += 8;
506         dst += 8;
507     }
508
509     src = block;
510     for(i = 0; i < 4; i++){
511         t1 = 17 * (src[ 0] + src[16]) + 64;
512         t2 = 17 * (src[ 0] - src[16]) + 64;
513         t3 = 22 * src[ 8] + 10 * src[24];
514         t4 = 22 * src[24] - 10 * src[ 8];
515
516         dest[0*linesize] = av_clip_uint8(dest[0*linesize] + ((t1 + t3) >> 7));
517         dest[1*linesize] = av_clip_uint8(dest[1*linesize] + ((t2 - t4) >> 7));
518         dest[2*linesize] = av_clip_uint8(dest[2*linesize] + ((t2 + t4) >> 7));
519         dest[3*linesize] = av_clip_uint8(dest[3*linesize] + ((t1 - t3) >> 7));
520
521         src ++;
522         dest++;
523     }
524 }
525
526 /* motion compensation functions */
527 /** Filter in case of 2 filters */
528 #define VC1_MSPEL_FILTER_16B(DIR, TYPE)                                 \
529 static av_always_inline int vc1_mspel_ ## DIR ## _filter_16bits(const TYPE *src, int stride, int mode) \
530 {                                                                       \
531     switch(mode){                                                       \
532     case 0: /* no shift - should not occur */                           \
533         return 0;                                                       \
534     case 1: /* 1/4 shift */                                             \
535         return -4*src[-stride] + 53*src[0] + 18*src[stride] - 3*src[stride*2]; \
536     case 2: /* 1/2 shift */                                             \
537         return -src[-stride] + 9*src[0] + 9*src[stride] - src[stride*2]; \
538     case 3: /* 3/4 shift */                                             \
539         return -3*src[-stride] + 18*src[0] + 53*src[stride] - 4*src[stride*2]; \
540     }                                                                   \
541     return 0; /* should not occur */                                    \
542 }
543
544 VC1_MSPEL_FILTER_16B(ver, uint8_t)
545 VC1_MSPEL_FILTER_16B(hor, int16_t)
546
547
548 /** Filter used to interpolate fractional pel values
549  */
550 static av_always_inline int vc1_mspel_filter(const uint8_t *src, int stride, int mode, int r)
551 {
552     switch(mode){
553     case 0: //no shift
554         return src[0];
555     case 1: // 1/4 shift
556         return (-4*src[-stride] + 53*src[0] + 18*src[stride] - 3*src[stride*2] + 32 - r) >> 6;
557     case 2: // 1/2 shift
558         return (-src[-stride] + 9*src[0] + 9*src[stride] - src[stride*2] + 8 - r) >> 4;
559     case 3: // 3/4 shift
560         return (-3*src[-stride] + 18*src[0] + 53*src[stride] - 4*src[stride*2] + 32 - r) >> 6;
561     }
562     return 0; //should not occur
563 }
564
565 /** Function used to do motion compensation with bicubic interpolation
566  */
567 #define VC1_MSPEL_MC(OP, OP4, OPNAME)\
568 static av_always_inline void OPNAME ## vc1_mspel_mc(uint8_t *dst, const uint8_t *src, ptrdiff_t stride, int hmode, int vmode, int rnd)\
569 {\
570     int     i, j;\
571 \
572     if (vmode) { /* Horizontal filter to apply */\
573         int r;\
574 \
575         if (hmode) { /* Vertical filter to apply, output to tmp */\
576             static const int shift_value[] = { 0, 5, 1, 5 };\
577             int              shift = (shift_value[hmode]+shift_value[vmode])>>1;\
578             int16_t          tmp[11*8], *tptr = tmp;\
579 \
580             r = (1<<(shift-1)) + rnd-1;\
581 \
582             src -= 1;\
583             for(j = 0; j < 8; j++) {\
584                 for(i = 0; i < 11; i++)\
585                     tptr[i] = (vc1_mspel_ver_filter_16bits(src + i, stride, vmode)+r)>>shift;\
586                 src += stride;\
587                 tptr += 11;\
588             }\
589 \
590             r = 64-rnd;\
591             tptr = tmp+1;\
592             for(j = 0; j < 8; j++) {\
593                 for(i = 0; i < 8; i++)\
594                     OP(dst[i], (vc1_mspel_hor_filter_16bits(tptr + i, 1, hmode)+r)>>7);\
595                 dst += stride;\
596                 tptr += 11;\
597             }\
598 \
599             return;\
600         }\
601         else { /* No horizontal filter, output 8 lines to dst */\
602             r = 1-rnd;\
603 \
604             for(j = 0; j < 8; j++) {\
605                 for(i = 0; i < 8; i++)\
606                     OP(dst[i], vc1_mspel_filter(src + i, stride, vmode, r));\
607                 src += stride;\
608                 dst += stride;\
609             }\
610             return;\
611         }\
612     }\
613 \
614     /* Horizontal mode with no vertical mode */\
615     for(j = 0; j < 8; j++) {\
616         for(i = 0; i < 8; i++)\
617             OP(dst[i], vc1_mspel_filter(src + i, 1, hmode, rnd));\
618         dst += stride;\
619         src += stride;\
620     }\
621 }\
622 static void OPNAME ## pixels8x8_c(uint8_t *block, const uint8_t *pixels, ptrdiff_t line_size, int rnd){\
623     int i;\
624     for(i=0; i<8; i++){\
625         OP4(*(uint32_t*)(block  ), AV_RN32(pixels  ));\
626         OP4(*(uint32_t*)(block+4), AV_RN32(pixels+4));\
627         pixels+=line_size;\
628         block +=line_size;\
629     }\
630 }
631
632 #define op_put(a, b) a = av_clip_uint8(b)
633 #define op_avg(a, b) a = (a + av_clip_uint8(b) + 1) >> 1
634 #define op4_avg(a, b) a = rnd_avg32(a, b)
635 #define op4_put(a, b) a = b
636
637 VC1_MSPEL_MC(op_put, op4_put, put_)
638 VC1_MSPEL_MC(op_avg, op4_avg, avg_)
639
640 /* pixel functions - really are entry points to vc1_mspel_mc */
641
642 #define PUT_VC1_MSPEL(a, b)\
643 static void put_vc1_mspel_mc ## a ## b ##_c(uint8_t *dst,               \
644                                             const uint8_t *src,         \
645                                             ptrdiff_t stride, int rnd)  \
646 {                                                                       \
647     put_vc1_mspel_mc(dst, src, stride, a, b, rnd);                      \
648 }                                                                       \
649 static void avg_vc1_mspel_mc ## a ## b ##_c(uint8_t *dst,               \
650                                             const uint8_t *src,         \
651                                             ptrdiff_t stride, int rnd)  \
652 {                                                                       \
653     avg_vc1_mspel_mc(dst, src, stride, a, b, rnd);                      \
654 }
655
656 PUT_VC1_MSPEL(1, 0)
657 PUT_VC1_MSPEL(2, 0)
658 PUT_VC1_MSPEL(3, 0)
659
660 PUT_VC1_MSPEL(0, 1)
661 PUT_VC1_MSPEL(1, 1)
662 PUT_VC1_MSPEL(2, 1)
663 PUT_VC1_MSPEL(3, 1)
664
665 PUT_VC1_MSPEL(0, 2)
666 PUT_VC1_MSPEL(1, 2)
667 PUT_VC1_MSPEL(2, 2)
668 PUT_VC1_MSPEL(3, 2)
669
670 PUT_VC1_MSPEL(0, 3)
671 PUT_VC1_MSPEL(1, 3)
672 PUT_VC1_MSPEL(2, 3)
673 PUT_VC1_MSPEL(3, 3)
674
675 static void put_no_rnd_vc1_chroma_mc8_c(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y){
676     const int A=(8-x)*(8-y);
677     const int B=(  x)*(8-y);
678     const int C=(8-x)*(  y);
679     const int D=(  x)*(  y);
680     int i;
681
682     av_assert2(x<8 && y<8 && x>=0 && y>=0);
683
684     for(i=0; i<h; i++)
685     {
686         dst[0] = (A*src[0] + B*src[1] + C*src[stride+0] + D*src[stride+1] + 32 - 4) >> 6;
687         dst[1] = (A*src[1] + B*src[2] + C*src[stride+1] + D*src[stride+2] + 32 - 4) >> 6;
688         dst[2] = (A*src[2] + B*src[3] + C*src[stride+2] + D*src[stride+3] + 32 - 4) >> 6;
689         dst[3] = (A*src[3] + B*src[4] + C*src[stride+3] + D*src[stride+4] + 32 - 4) >> 6;
690         dst[4] = (A*src[4] + B*src[5] + C*src[stride+4] + D*src[stride+5] + 32 - 4) >> 6;
691         dst[5] = (A*src[5] + B*src[6] + C*src[stride+5] + D*src[stride+6] + 32 - 4) >> 6;
692         dst[6] = (A*src[6] + B*src[7] + C*src[stride+6] + D*src[stride+7] + 32 - 4) >> 6;
693         dst[7] = (A*src[7] + B*src[8] + C*src[stride+7] + D*src[stride+8] + 32 - 4) >> 6;
694         dst+= stride;
695         src+= stride;
696     }
697 }
698
699 static void put_no_rnd_vc1_chroma_mc4_c(uint8_t *dst, uint8_t *src, int stride, int h, int x, int y){
700     const int A=(8-x)*(8-y);
701     const int B=(  x)*(8-y);
702     const int C=(8-x)*(  y);
703     const int D=(  x)*(  y);
704     int i;
705
706     av_assert2(x<8 && y<8 && x>=0 && y>=0);
707
708     for(i=0; i<h; i++)
709     {
710         dst[0] = (A*src[0] + B*src[1] + C*src[stride+0] + D*src[stride+1] + 32 - 4) >> 6;
711         dst[1] = (A*src[1] + B*src[2] + C*src[stride+1] + D*src[stride+2] + 32 - 4) >> 6;
712         dst[2] = (A*src[2] + B*src[3] + C*src[stride+2] + D*src[stride+3] + 32 - 4) >> 6;
713         dst[3] = (A*src[3] + B*src[4] + C*src[stride+3] + D*src[stride+4] + 32 - 4) >> 6;
714         dst+= stride;
715         src+= stride;
716     }
717 }
718
719 #define avg2(a,b) ((a+b+1)>>1)
720 static void avg_no_rnd_vc1_chroma_mc8_c(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y){
721     const int A=(8-x)*(8-y);
722     const int B=(  x)*(8-y);
723     const int C=(8-x)*(  y);
724     const int D=(  x)*(  y);
725     int i;
726
727     av_assert2(x<8 && y<8 && x>=0 && y>=0);
728
729     for(i=0; i<h; i++)
730     {
731         dst[0] = avg2(dst[0], ((A*src[0] + B*src[1] + C*src[stride+0] + D*src[stride+1] + 32 - 4) >> 6));
732         dst[1] = avg2(dst[1], ((A*src[1] + B*src[2] + C*src[stride+1] + D*src[stride+2] + 32 - 4) >> 6));
733         dst[2] = avg2(dst[2], ((A*src[2] + B*src[3] + C*src[stride+2] + D*src[stride+3] + 32 - 4) >> 6));
734         dst[3] = avg2(dst[3], ((A*src[3] + B*src[4] + C*src[stride+3] + D*src[stride+4] + 32 - 4) >> 6));
735         dst[4] = avg2(dst[4], ((A*src[4] + B*src[5] + C*src[stride+4] + D*src[stride+5] + 32 - 4) >> 6));
736         dst[5] = avg2(dst[5], ((A*src[5] + B*src[6] + C*src[stride+5] + D*src[stride+6] + 32 - 4) >> 6));
737         dst[6] = avg2(dst[6], ((A*src[6] + B*src[7] + C*src[stride+6] + D*src[stride+7] + 32 - 4) >> 6));
738         dst[7] = avg2(dst[7], ((A*src[7] + B*src[8] + C*src[stride+7] + D*src[stride+8] + 32 - 4) >> 6));
739         dst+= stride;
740         src+= stride;
741     }
742 }
743
744 static void avg_no_rnd_vc1_chroma_mc4_c(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y){
745     const int A=(8-x)*(8-y);
746     const int B=(  x)*(8-y);
747     const int C=(8-x)*(  y);
748     const int D=(  x)*(  y);
749     int i;
750
751     av_assert2(x<8 && y<8 && x>=0 && y>=0);
752
753     for(i=0; i<h; i++)
754     {
755         dst[0] = avg2(dst[0], ((A*src[0] + B*src[1] + C*src[stride+0] + D*src[stride+1] + 32 - 4) >> 6));
756         dst[1] = avg2(dst[1], ((A*src[1] + B*src[2] + C*src[stride+1] + D*src[stride+2] + 32 - 4) >> 6));
757         dst[2] = avg2(dst[2], ((A*src[2] + B*src[3] + C*src[stride+2] + D*src[stride+3] + 32 - 4) >> 6));
758         dst[3] = avg2(dst[3], ((A*src[3] + B*src[4] + C*src[stride+3] + D*src[stride+4] + 32 - 4) >> 6));
759         dst+= stride;
760         src+= stride;
761     }
762 }
763
764 #if CONFIG_WMV3IMAGE_DECODER || CONFIG_VC1IMAGE_DECODER
765
766 static void sprite_h_c(uint8_t *dst, const uint8_t *src, int offset, int advance, int count)
767 {
768     while (count--) {
769         int a = src[(offset >> 16)    ];
770         int b = src[(offset >> 16) + 1];
771         *dst++ = a + ((b - a) * (offset&0xFFFF) >> 16);
772         offset += advance;
773     }
774 }
775
776 static av_always_inline void sprite_v_template(uint8_t *dst, const uint8_t *src1a, const uint8_t *src1b, int offset1,
777                                             int two_sprites, const uint8_t *src2a, const uint8_t *src2b, int offset2,
778                                             int alpha, int scaled, int width)
779 {
780     int a1, b1, a2, b2;
781     while (width--) {
782         a1 = *src1a++;
783         if (scaled) {
784             b1 = *src1b++;
785             a1 = a1 + ((b1 - a1) * offset1 >> 16);
786         }
787         if (two_sprites) {
788             a2 = *src2a++;
789             if (scaled > 1) {
790                 b2 = *src2b++;
791                 a2 = a2 + ((b2 - a2) * offset2 >> 16);
792             }
793             a1 = a1 + ((a2 - a1) * alpha >> 16);
794         }
795         *dst++ = a1;
796     }
797 }
798
799 static void sprite_v_single_c(uint8_t *dst, const uint8_t *src1a, const uint8_t *src1b, int offset, int width)
800 {
801     sprite_v_template(dst, src1a, src1b, offset, 0, NULL, NULL, 0, 0, 1, width);
802 }
803
804 static void sprite_v_double_noscale_c(uint8_t *dst, const uint8_t *src1a, const uint8_t *src2a, int alpha, int width)
805 {
806     sprite_v_template(dst, src1a, NULL, 0, 1, src2a, NULL, 0, alpha, 0, width);
807 }
808
809 static void sprite_v_double_onescale_c(uint8_t *dst, const uint8_t *src1a, const uint8_t *src1b, int offset1,
810                                                      const uint8_t *src2a, int alpha, int width)
811 {
812     sprite_v_template(dst, src1a, src1b, offset1, 1, src2a, NULL, 0, alpha, 1, width);
813 }
814
815 static void sprite_v_double_twoscale_c(uint8_t *dst, const uint8_t *src1a, const uint8_t *src1b, int offset1,
816                                                      const uint8_t *src2a, const uint8_t *src2b, int offset2,
817                                        int alpha, int width)
818 {
819     sprite_v_template(dst, src1a, src1b, offset1, 1, src2a, src2b, offset2, alpha, 2, width);
820 }
821
822 #endif
823
824 av_cold void ff_vc1dsp_init(VC1DSPContext* dsp) {
825     dsp->vc1_inv_trans_8x8 = vc1_inv_trans_8x8_c;
826     dsp->vc1_inv_trans_4x8 = vc1_inv_trans_4x8_c;
827     dsp->vc1_inv_trans_8x4 = vc1_inv_trans_8x4_c;
828     dsp->vc1_inv_trans_4x4 = vc1_inv_trans_4x4_c;
829     dsp->vc1_inv_trans_8x8_dc = vc1_inv_trans_8x8_dc_c;
830     dsp->vc1_inv_trans_4x8_dc = vc1_inv_trans_4x8_dc_c;
831     dsp->vc1_inv_trans_8x4_dc = vc1_inv_trans_8x4_dc_c;
832     dsp->vc1_inv_trans_4x4_dc = vc1_inv_trans_4x4_dc_c;
833     dsp->vc1_h_overlap = vc1_h_overlap_c;
834     dsp->vc1_v_overlap = vc1_v_overlap_c;
835     dsp->vc1_h_s_overlap = vc1_h_s_overlap_c;
836     dsp->vc1_v_s_overlap = vc1_v_s_overlap_c;
837     dsp->vc1_v_loop_filter4 = vc1_v_loop_filter4_c;
838     dsp->vc1_h_loop_filter4 = vc1_h_loop_filter4_c;
839     dsp->vc1_v_loop_filter8 = vc1_v_loop_filter8_c;
840     dsp->vc1_h_loop_filter8 = vc1_h_loop_filter8_c;
841     dsp->vc1_v_loop_filter16 = vc1_v_loop_filter16_c;
842     dsp->vc1_h_loop_filter16 = vc1_h_loop_filter16_c;
843
844     dsp->put_vc1_mspel_pixels_tab[ 0] = put_pixels8x8_c;
845     dsp->put_vc1_mspel_pixels_tab[ 1] = put_vc1_mspel_mc10_c;
846     dsp->put_vc1_mspel_pixels_tab[ 2] = put_vc1_mspel_mc20_c;
847     dsp->put_vc1_mspel_pixels_tab[ 3] = put_vc1_mspel_mc30_c;
848     dsp->put_vc1_mspel_pixels_tab[ 4] = put_vc1_mspel_mc01_c;
849     dsp->put_vc1_mspel_pixels_tab[ 5] = put_vc1_mspel_mc11_c;
850     dsp->put_vc1_mspel_pixels_tab[ 6] = put_vc1_mspel_mc21_c;
851     dsp->put_vc1_mspel_pixels_tab[ 7] = put_vc1_mspel_mc31_c;
852     dsp->put_vc1_mspel_pixels_tab[ 8] = put_vc1_mspel_mc02_c;
853     dsp->put_vc1_mspel_pixels_tab[ 9] = put_vc1_mspel_mc12_c;
854     dsp->put_vc1_mspel_pixels_tab[10] = put_vc1_mspel_mc22_c;
855     dsp->put_vc1_mspel_pixels_tab[11] = put_vc1_mspel_mc32_c;
856     dsp->put_vc1_mspel_pixels_tab[12] = put_vc1_mspel_mc03_c;
857     dsp->put_vc1_mspel_pixels_tab[13] = put_vc1_mspel_mc13_c;
858     dsp->put_vc1_mspel_pixels_tab[14] = put_vc1_mspel_mc23_c;
859     dsp->put_vc1_mspel_pixels_tab[15] = put_vc1_mspel_mc33_c;
860
861     dsp->avg_vc1_mspel_pixels_tab[ 0] = avg_pixels8x8_c;
862     dsp->avg_vc1_mspel_pixels_tab[ 1] = avg_vc1_mspel_mc10_c;
863     dsp->avg_vc1_mspel_pixels_tab[ 2] = avg_vc1_mspel_mc20_c;
864     dsp->avg_vc1_mspel_pixels_tab[ 3] = avg_vc1_mspel_mc30_c;
865     dsp->avg_vc1_mspel_pixels_tab[ 4] = avg_vc1_mspel_mc01_c;
866     dsp->avg_vc1_mspel_pixels_tab[ 5] = avg_vc1_mspel_mc11_c;
867     dsp->avg_vc1_mspel_pixels_tab[ 6] = avg_vc1_mspel_mc21_c;
868     dsp->avg_vc1_mspel_pixels_tab[ 7] = avg_vc1_mspel_mc31_c;
869     dsp->avg_vc1_mspel_pixels_tab[ 8] = avg_vc1_mspel_mc02_c;
870     dsp->avg_vc1_mspel_pixels_tab[ 9] = avg_vc1_mspel_mc12_c;
871     dsp->avg_vc1_mspel_pixels_tab[10] = avg_vc1_mspel_mc22_c;
872     dsp->avg_vc1_mspel_pixels_tab[11] = avg_vc1_mspel_mc32_c;
873     dsp->avg_vc1_mspel_pixels_tab[12] = avg_vc1_mspel_mc03_c;
874     dsp->avg_vc1_mspel_pixels_tab[13] = avg_vc1_mspel_mc13_c;
875     dsp->avg_vc1_mspel_pixels_tab[14] = avg_vc1_mspel_mc23_c;
876     dsp->avg_vc1_mspel_pixels_tab[15] = avg_vc1_mspel_mc33_c;
877
878     dsp->put_no_rnd_vc1_chroma_pixels_tab[0]= put_no_rnd_vc1_chroma_mc8_c;
879     dsp->avg_no_rnd_vc1_chroma_pixels_tab[0]= avg_no_rnd_vc1_chroma_mc8_c;
880     dsp->put_no_rnd_vc1_chroma_pixels_tab[1] = put_no_rnd_vc1_chroma_mc4_c;
881     dsp->avg_no_rnd_vc1_chroma_pixels_tab[1] = avg_no_rnd_vc1_chroma_mc4_c;
882
883 #if CONFIG_WMV3IMAGE_DECODER || CONFIG_VC1IMAGE_DECODER
884     dsp->sprite_h = sprite_h_c;
885     dsp->sprite_v_single = sprite_v_single_c;
886     dsp->sprite_v_double_noscale = sprite_v_double_noscale_c;
887     dsp->sprite_v_double_onescale = sprite_v_double_onescale_c;
888     dsp->sprite_v_double_twoscale = sprite_v_double_twoscale_c;
889 #endif
890
891     if (ARCH_X86)
892         ff_vc1dsp_init_x86(dsp);
893     if (ARCH_PPC)
894         ff_vc1dsp_init_ppc(dsp);
895 }