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 #include "libavutil/avassert.h"
28 #include "libavutil/common.h"
29 #include "libavutil/intreadwrite.h"
30 #include "h264chroma.h"
31 #include "qpeldsp.h"
32 #include "rnd_avg.h"
33 #include "vc1dsp.h"
34 #include "startcode.h"
35
36 /* Apply overlap transform to horizontal edge */
vc1_v_overlap_c(uint8_t * src,int stride)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 */
vc1_h_overlap_c(uint8_t * src,int stride)61 static void vc1_h_overlap_c(uint8_t *src, int stride)
62 {
63 int i;
64 int a, b, c, d;
65 int d1, d2;
66 int rnd = 1;
67 for (i = 0; i < 8; i++) {
68 a = src[-2];
69 b = src[-1];
70 c = src[0];
71 d = src[1];
72 d1 = (a - d + 3 + rnd) >> 3;
73 d2 = (a - d + b - c + 4 - rnd) >> 3;
74
75 src[-2] = a - d1;
76 src[-1] = av_clip_uint8(b - d2);
77 src[0] = av_clip_uint8(c + d2);
78 src[1] = d + d1;
79 src += stride;
80 rnd = !rnd;
81 }
82 }
83
vc1_v_s_overlap_c(int16_t * top,int16_t * bottom)84 static void vc1_v_s_overlap_c(int16_t *top, int16_t *bottom)
85 {
86 int i;
87 int a, b, c, d;
88 int d1, d2;
89 int rnd1 = 4, rnd2 = 3;
90 for (i = 0; i < 8; i++) {
91 a = top[48];
92 b = top[56];
93 c = bottom[0];
94 d = bottom[8];
95 d1 = a - d;
96 d2 = a - d + b - c;
97
98 top[48] = ((a * 8) - d1 + rnd1) >> 3;
99 top[56] = ((b * 8) - d2 + rnd2) >> 3;
100 bottom[0] = ((c * 8) + d2 + rnd1) >> 3;
101 bottom[8] = ((d * 8) + d1 + rnd2) >> 3;
102
103 bottom++;
104 top++;
105 rnd2 = 7 - rnd2;
106 rnd1 = 7 - rnd1;
107 }
108 }
109
vc1_h_s_overlap_c(int16_t * left,int16_t * right,int left_stride,int right_stride,int flags)110 static void vc1_h_s_overlap_c(int16_t *left, int16_t *right, int left_stride, int right_stride, int flags)
111 {
112 int i;
113 int a, b, c, d;
114 int d1, d2;
115 int rnd1 = flags & 2 ? 3 : 4;
116 int rnd2 = 7 - rnd1;
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 * 8) - d1 + rnd1) >> 3;
126 left[7] = ((b * 8) - d2 + rnd2) >> 3;
127 right[0] = ((c * 8) + d2 + rnd1) >> 3;
128 right[1] = ((d * 8) + d1 + rnd2) >> 3;
129
130 right += right_stride;
131 left += left_stride;
132 if (flags & 1) {
133 rnd2 = 7 - rnd2;
134 rnd1 = 7 - rnd1;
135 }
136 }
137 }
138
139 /**
140 * VC-1 in-loop deblocking filter for one line
141 * @param src source block type
142 * @param stride block stride
143 * @param pq block quantizer
144 * @return whether other 3 pairs should be filtered or not
145 * @see 8.6
146 */
vc1_filter_line(uint8_t * src,int stride,int pq)147 static av_always_inline int vc1_filter_line(uint8_t *src, int stride, int pq)
148 {
149 int a0 = (2 * (src[-2 * stride] - src[1 * stride]) -
150 5 * (src[-1 * stride] - src[0 * stride]) + 4) >> 3;
151 int a0_sign = a0 >> 31; /* Store sign */
152
153 a0 = (a0 ^ a0_sign) - a0_sign; /* a0 = FFABS(a0); */
154 if (a0 < pq) {
155 int a1 = FFABS((2 * (src[-4 * stride] - src[-1 * stride]) -
156 5 * (src[-3 * stride] - src[-2 * stride]) + 4) >> 3);
157 int a2 = FFABS((2 * (src[ 0 * stride] - src[ 3 * stride]) -
158 5 * (src[ 1 * stride] - src[ 2 * stride]) + 4) >> 3);
159 if (a1 < a0 || a2 < a0) {
160 int clip = src[-1 * stride] - src[0 * stride];
161 int clip_sign = clip >> 31;
162
163 clip = ((clip ^ clip_sign) - clip_sign) >> 1;
164 if (clip) {
165 int a3 = FFMIN(a1, a2);
166 int d = 5 * (a3 - a0);
167 int d_sign = (d >> 31);
168
169 d = ((d ^ d_sign) - d_sign) >> 3;
170 d_sign ^= a0_sign;
171
172 if (d_sign ^ clip_sign)
173 d = 0;
174 else {
175 d = FFMIN(d, clip);
176 d = (d ^ d_sign) - d_sign; /* Restore sign */
177 src[-1 * stride] = av_clip_uint8(src[-1 * stride] - d);
178 src[ 0 * stride] = av_clip_uint8(src[ 0 * stride] + d);
179 }
180 return 1;
181 }
182 }
183 }
184 return 0;
185 }
186
187 /**
188 * VC-1 in-loop deblocking filter
189 * @param src source block type
190 * @param step distance between horizontally adjacent elements
191 * @param stride distance between vertically adjacent elements
192 * @param len edge length to filter (4 or 8 pixels)
193 * @param pq block quantizer
194 * @see 8.6
195 */
vc1_loop_filter(uint8_t * src,int step,int stride,int len,int pq)196 static inline void vc1_loop_filter(uint8_t *src, int step, int stride,
197 int len, int pq)
198 {
199 int i;
200 int filt3;
201
202 for (i = 0; i < len; i += 4) {
203 filt3 = vc1_filter_line(src + 2 * step, stride, pq);
204 if (filt3) {
205 vc1_filter_line(src + 0 * step, stride, pq);
206 vc1_filter_line(src + 1 * step, stride, pq);
207 vc1_filter_line(src + 3 * step, stride, pq);
208 }
209 src += step * 4;
210 }
211 }
212
vc1_v_loop_filter4_c(uint8_t * src,int stride,int pq)213 static void vc1_v_loop_filter4_c(uint8_t *src, int stride, int pq)
214 {
215 vc1_loop_filter(src, 1, stride, 4, pq);
216 }
217
vc1_h_loop_filter4_c(uint8_t * src,int stride,int pq)218 static void vc1_h_loop_filter4_c(uint8_t *src, int stride, int pq)
219 {
220 vc1_loop_filter(src, stride, 1, 4, pq);
221 }
222
vc1_v_loop_filter8_c(uint8_t * src,int stride,int pq)223 static void vc1_v_loop_filter8_c(uint8_t *src, int stride, int pq)
224 {
225 vc1_loop_filter(src, 1, stride, 8, pq);
226 }
227
vc1_h_loop_filter8_c(uint8_t * src,int stride,int pq)228 static void vc1_h_loop_filter8_c(uint8_t *src, int stride, int pq)
229 {
230 vc1_loop_filter(src, stride, 1, 8, pq);
231 }
232
vc1_v_loop_filter16_c(uint8_t * src,int stride,int pq)233 static void vc1_v_loop_filter16_c(uint8_t *src, int stride, int pq)
234 {
235 vc1_loop_filter(src, 1, stride, 16, pq);
236 }
237
vc1_h_loop_filter16_c(uint8_t * src,int stride,int pq)238 static void vc1_h_loop_filter16_c(uint8_t *src, int stride, int pq)
239 {
240 vc1_loop_filter(src, stride, 1, 16, pq);
241 }
242
243 /* Do inverse transform on 8x8 block */
vc1_inv_trans_8x8_dc_c(uint8_t * dest,ptrdiff_t stride,int16_t * block)244 static void vc1_inv_trans_8x8_dc_c(uint8_t *dest, ptrdiff_t stride, int16_t *block)
245 {
246 int i;
247 int dc = block[0];
248
249 dc = (3 * dc + 1) >> 1;
250 dc = (3 * dc + 16) >> 5;
251
252 for (i = 0; i < 8; i++) {
253 dest[0] = av_clip_uint8(dest[0] + dc);
254 dest[1] = av_clip_uint8(dest[1] + dc);
255 dest[2] = av_clip_uint8(dest[2] + dc);
256 dest[3] = av_clip_uint8(dest[3] + dc);
257 dest[4] = av_clip_uint8(dest[4] + dc);
258 dest[5] = av_clip_uint8(dest[5] + dc);
259 dest[6] = av_clip_uint8(dest[6] + dc);
260 dest[7] = av_clip_uint8(dest[7] + dc);
261 dest += stride;
262 }
263 }
264
vc1_inv_trans_8x8_c(int16_t block[64])265 static void vc1_inv_trans_8x8_c(int16_t block[64])
266 {
267 int i;
268 register int t1, t2, t3, t4, t5, t6, t7, t8;
269 int16_t *src, *dst, temp[64];
270
271 src = block;
272 dst = temp;
273 for (i = 0; i < 8; i++) {
274 t1 = 12 * (src[ 0] + src[32]) + 4;
275 t2 = 12 * (src[ 0] - src[32]) + 4;
276 t3 = 16 * src[16] + 6 * src[48];
277 t4 = 6 * src[16] - 16 * src[48];
278
279 t5 = t1 + t3;
280 t6 = t2 + t4;
281 t7 = t2 - t4;
282 t8 = t1 - t3;
283
284 t1 = 16 * src[ 8] + 15 * src[24] + 9 * src[40] + 4 * src[56];
285 t2 = 15 * src[ 8] - 4 * src[24] - 16 * src[40] - 9 * src[56];
286 t3 = 9 * src[ 8] - 16 * src[24] + 4 * src[40] + 15 * src[56];
287 t4 = 4 * src[ 8] - 9 * src[24] + 15 * src[40] - 16 * src[56];
288
289 dst[0] = (t5 + t1) >> 3;
290 dst[1] = (t6 + t2) >> 3;
291 dst[2] = (t7 + t3) >> 3;
292 dst[3] = (t8 + t4) >> 3;
293 dst[4] = (t8 - t4) >> 3;
294 dst[5] = (t7 - t3) >> 3;
295 dst[6] = (t6 - t2) >> 3;
296 dst[7] = (t5 - t1) >> 3;
297
298 src += 1;
299 dst += 8;
300 }
301
302 src = temp;
303 dst = block;
304 for (i = 0; i < 8; i++) {
305 t1 = 12 * (src[ 0] + src[32]) + 64;
306 t2 = 12 * (src[ 0] - src[32]) + 64;
307 t3 = 16 * src[16] + 6 * src[48];
308 t4 = 6 * src[16] - 16 * src[48];
309
310 t5 = t1 + t3;
311 t6 = t2 + t4;
312 t7 = t2 - t4;
313 t8 = t1 - t3;
314
315 t1 = 16 * src[ 8] + 15 * src[24] + 9 * src[40] + 4 * src[56];
316 t2 = 15 * src[ 8] - 4 * src[24] - 16 * src[40] - 9 * src[56];
317 t3 = 9 * src[ 8] - 16 * src[24] + 4 * src[40] + 15 * src[56];
318 t4 = 4 * src[ 8] - 9 * src[24] + 15 * src[40] - 16 * src[56];
319
320 dst[ 0] = (t5 + t1) >> 7;
321 dst[ 8] = (t6 + t2) >> 7;
322 dst[16] = (t7 + t3) >> 7;
323 dst[24] = (t8 + t4) >> 7;
324 dst[32] = (t8 - t4 + 1) >> 7;
325 dst[40] = (t7 - t3 + 1) >> 7;
326 dst[48] = (t6 - t2 + 1) >> 7;
327 dst[56] = (t5 - t1 + 1) >> 7;
328
329 src++;
330 dst++;
331 }
332 }
333
334 /* Do inverse transform on 8x4 part of block */
vc1_inv_trans_8x4_dc_c(uint8_t * dest,ptrdiff_t stride,int16_t * block)335 static void vc1_inv_trans_8x4_dc_c(uint8_t *dest, ptrdiff_t stride, int16_t *block)
336 {
337 int i;
338 int dc = block[0];
339
340 dc = (3 * dc + 1) >> 1;
341 dc = (17 * dc + 64) >> 7;
342
343 for (i = 0; i < 4; i++) {
344 dest[0] = av_clip_uint8(dest[0] + dc);
345 dest[1] = av_clip_uint8(dest[1] + dc);
346 dest[2] = av_clip_uint8(dest[2] + dc);
347 dest[3] = av_clip_uint8(dest[3] + dc);
348 dest[4] = av_clip_uint8(dest[4] + dc);
349 dest[5] = av_clip_uint8(dest[5] + dc);
350 dest[6] = av_clip_uint8(dest[6] + dc);
351 dest[7] = av_clip_uint8(dest[7] + dc);
352 dest += stride;
353 }
354 }
355
vc1_inv_trans_8x4_c(uint8_t * dest,ptrdiff_t stride,int16_t * block)356 static void vc1_inv_trans_8x4_c(uint8_t *dest, ptrdiff_t stride, int16_t *block)
357 {
358 int i;
359 register int t1, t2, t3, t4, t5, t6, t7, t8;
360 int16_t *src, *dst;
361
362 src = block;
363 dst = block;
364
365 for (i = 0; i < 4; i++) {
366 t1 = 12 * (src[0] + src[4]) + 4;
367 t2 = 12 * (src[0] - src[4]) + 4;
368 t3 = 16 * src[2] + 6 * src[6];
369 t4 = 6 * src[2] - 16 * src[6];
370
371 t5 = t1 + t3;
372 t6 = t2 + t4;
373 t7 = t2 - t4;
374 t8 = t1 - t3;
375
376 t1 = 16 * src[1] + 15 * src[3] + 9 * src[5] + 4 * src[7];
377 t2 = 15 * src[1] - 4 * src[3] - 16 * src[5] - 9 * src[7];
378 t3 = 9 * src[1] - 16 * src[3] + 4 * src[5] + 15 * src[7];
379 t4 = 4 * src[1] - 9 * src[3] + 15 * src[5] - 16 * src[7];
380
381 dst[0] = (t5 + t1) >> 3;
382 dst[1] = (t6 + t2) >> 3;
383 dst[2] = (t7 + t3) >> 3;
384 dst[3] = (t8 + t4) >> 3;
385 dst[4] = (t8 - t4) >> 3;
386 dst[5] = (t7 - t3) >> 3;
387 dst[6] = (t6 - t2) >> 3;
388 dst[7] = (t5 - t1) >> 3;
389
390 src += 8;
391 dst += 8;
392 }
393
394 src = block;
395 for (i = 0; i < 8; i++) {
396 t1 = 17 * (src[ 0] + src[16]) + 64;
397 t2 = 17 * (src[ 0] - src[16]) + 64;
398 t3 = 22 * src[ 8] + 10 * src[24];
399 t4 = 22 * src[24] - 10 * src[ 8];
400
401 dest[0 * stride] = av_clip_uint8(dest[0 * stride] + ((t1 + t3) >> 7));
402 dest[1 * stride] = av_clip_uint8(dest[1 * stride] + ((t2 - t4) >> 7));
403 dest[2 * stride] = av_clip_uint8(dest[2 * stride] + ((t2 + t4) >> 7));
404 dest[3 * stride] = av_clip_uint8(dest[3 * stride] + ((t1 - t3) >> 7));
405
406 src++;
407 dest++;
408 }
409 }
410
411 /* Do inverse transform on 4x8 parts of block */
vc1_inv_trans_4x8_dc_c(uint8_t * dest,ptrdiff_t stride,int16_t * block)412 static void vc1_inv_trans_4x8_dc_c(uint8_t *dest, ptrdiff_t stride, int16_t *block)
413 {
414 int i;
415 int dc = block[0];
416
417 dc = (17 * dc + 4) >> 3;
418 dc = (12 * dc + 64) >> 7;
419
420 for (i = 0; i < 8; i++) {
421 dest[0] = av_clip_uint8(dest[0] + dc);
422 dest[1] = av_clip_uint8(dest[1] + dc);
423 dest[2] = av_clip_uint8(dest[2] + dc);
424 dest[3] = av_clip_uint8(dest[3] + dc);
425 dest += stride;
426 }
427 }
428
vc1_inv_trans_4x8_c(uint8_t * dest,ptrdiff_t stride,int16_t * block)429 static void vc1_inv_trans_4x8_c(uint8_t *dest, ptrdiff_t stride, int16_t *block)
430 {
431 int i;
432 register int t1, t2, t3, t4, t5, t6, t7, t8;
433 int16_t *src, *dst;
434
435 src = block;
436 dst = block;
437
438 for (i = 0; i < 8; i++) {
439 t1 = 17 * (src[0] + src[2]) + 4;
440 t2 = 17 * (src[0] - src[2]) + 4;
441 t3 = 22 * src[1] + 10 * src[3];
442 t4 = 22 * src[3] - 10 * src[1];
443
444 dst[0] = (t1 + t3) >> 3;
445 dst[1] = (t2 - t4) >> 3;
446 dst[2] = (t2 + t4) >> 3;
447 dst[3] = (t1 - t3) >> 3;
448
449 src += 8;
450 dst += 8;
451 }
452
453 src = block;
454 for (i = 0; i < 4; i++) {
455 t1 = 12 * (src[ 0] + src[32]) + 64;
456 t2 = 12 * (src[ 0] - src[32]) + 64;
457 t3 = 16 * src[16] + 6 * src[48];
458 t4 = 6 * src[16] - 16 * src[48];
459
460 t5 = t1 + t3;
461 t6 = t2 + t4;
462 t7 = t2 - t4;
463 t8 = t1 - t3;
464
465 t1 = 16 * src[ 8] + 15 * src[24] + 9 * src[40] + 4 * src[56];
466 t2 = 15 * src[ 8] - 4 * src[24] - 16 * src[40] - 9 * src[56];
467 t3 = 9 * src[ 8] - 16 * src[24] + 4 * src[40] + 15 * src[56];
468 t4 = 4 * src[ 8] - 9 * src[24] + 15 * src[40] - 16 * src[56];
469
470 dest[0 * stride] = av_clip_uint8(dest[0 * stride] + ((t5 + t1) >> 7));
471 dest[1 * stride] = av_clip_uint8(dest[1 * stride] + ((t6 + t2) >> 7));
472 dest[2 * stride] = av_clip_uint8(dest[2 * stride] + ((t7 + t3) >> 7));
473 dest[3 * stride] = av_clip_uint8(dest[3 * stride] + ((t8 + t4) >> 7));
474 dest[4 * stride] = av_clip_uint8(dest[4 * stride] + ((t8 - t4 + 1) >> 7));
475 dest[5 * stride] = av_clip_uint8(dest[5 * stride] + ((t7 - t3 + 1) >> 7));
476 dest[6 * stride] = av_clip_uint8(dest[6 * stride] + ((t6 - t2 + 1) >> 7));
477 dest[7 * stride] = av_clip_uint8(dest[7 * stride] + ((t5 - t1 + 1) >> 7));
478
479 src++;
480 dest++;
481 }
482 }
483
484 /* Do inverse transform on 4x4 part of block */
vc1_inv_trans_4x4_dc_c(uint8_t * dest,ptrdiff_t stride,int16_t * block)485 static void vc1_inv_trans_4x4_dc_c(uint8_t *dest, ptrdiff_t stride, int16_t *block)
486 {
487 int i;
488 int dc = block[0];
489
490 dc = (17 * dc + 4) >> 3;
491 dc = (17 * dc + 64) >> 7;
492
493 for (i = 0; i < 4; i++) {
494 dest[0] = av_clip_uint8(dest[0] + dc);
495 dest[1] = av_clip_uint8(dest[1] + dc);
496 dest[2] = av_clip_uint8(dest[2] + dc);
497 dest[3] = av_clip_uint8(dest[3] + dc);
498 dest += stride;
499 }
500 }
501
vc1_inv_trans_4x4_c(uint8_t * dest,ptrdiff_t stride,int16_t * block)502 static void vc1_inv_trans_4x4_c(uint8_t *dest, ptrdiff_t stride, int16_t *block)
503 {
504 int i;
505 register int t1, t2, t3, t4;
506 int16_t *src, *dst;
507
508 src = block;
509 dst = block;
510 for (i = 0; i < 4; i++) {
511 t1 = 17 * (src[0] + src[2]) + 4;
512 t2 = 17 * (src[0] - src[2]) + 4;
513 t3 = 22 * src[1] + 10 * src[3];
514 t4 = 22 * src[3] - 10 * src[1];
515
516 dst[0] = (t1 + t3) >> 3;
517 dst[1] = (t2 - t4) >> 3;
518 dst[2] = (t2 + t4) >> 3;
519 dst[3] = (t1 - t3) >> 3;
520
521 src += 8;
522 dst += 8;
523 }
524
525 src = block;
526 for (i = 0; i < 4; i++) {
527 t1 = 17 * (src[0] + src[16]) + 64;
528 t2 = 17 * (src[0] - src[16]) + 64;
529 t3 = 22 * src[8] + 10 * src[24];
530 t4 = 22 * src[24] - 10 * src[8];
531
532 dest[0 * stride] = av_clip_uint8(dest[0 * stride] + ((t1 + t3) >> 7));
533 dest[1 * stride] = av_clip_uint8(dest[1 * stride] + ((t2 - t4) >> 7));
534 dest[2 * stride] = av_clip_uint8(dest[2 * stride] + ((t2 + t4) >> 7));
535 dest[3 * stride] = av_clip_uint8(dest[3 * stride] + ((t1 - t3) >> 7));
536
537 src++;
538 dest++;
539 }
540 }
541
542 /* motion compensation functions */
543
544 /* Filter in case of 2 filters */
545 #define VC1_MSPEL_FILTER_16B(DIR, TYPE) \
546 static av_always_inline int vc1_mspel_ ## DIR ## _filter_16bits(const TYPE *src, \
547 int stride, \
548 int mode) \
549 { \
550 switch(mode) { \
551 case 0: /* no shift - should not occur */ \
552 return 0; \
553 case 1: /* 1/4 shift */ \
554 return -4 * src[-stride] + 53 * src[0] + \
555 18 * src[stride] - 3 * src[stride * 2]; \
556 case 2: /* 1/2 shift */ \
557 return -1 * src[-stride] + 9 * src[0] + \
558 9 * src[stride] - 1 * src[stride * 2]; \
559 case 3: /* 3/4 shift */ \
560 return -3 * src[-stride] + 18 * src[0] + \
561 53 * src[stride] - 4 * src[stride * 2]; \
562 } \
563 return 0; /* should not occur */ \
564 }
565
VC1_MSPEL_FILTER_16B(ver,uint8_t)566 VC1_MSPEL_FILTER_16B(ver, uint8_t)
567 VC1_MSPEL_FILTER_16B(hor, int16_t)
568
569 /* Filter used to interpolate fractional pel values */
570 static av_always_inline int vc1_mspel_filter(const uint8_t *src, int stride,
571 int mode, int r)
572 {
573 switch (mode) {
574 case 0: // no shift
575 return src[0];
576 case 1: // 1/4 shift
577 return (-4 * src[-stride] + 53 * src[0] +
578 18 * src[stride] - 3 * src[stride * 2] + 32 - r) >> 6;
579 case 2: // 1/2 shift
580 return (-1 * src[-stride] + 9 * src[0] +
581 9 * src[stride] - 1 * src[stride * 2] + 8 - r) >> 4;
582 case 3: // 3/4 shift
583 return (-3 * src[-stride] + 18 * src[0] +
584 53 * src[stride] - 4 * src[stride * 2] + 32 - r) >> 6;
585 }
586 return 0; // should not occur
587 }
588
589 /* Function used to do motion compensation with bicubic interpolation */
590 #define VC1_MSPEL_MC(OP, OP4, OPNAME) \
591 static av_always_inline void OPNAME ## vc1_mspel_mc(uint8_t *dst, \
592 const uint8_t *src, \
593 ptrdiff_t stride, \
594 int hmode, \
595 int vmode, \
596 int rnd) \
597 { \
598 int i, j; \
599 \
600 if (vmode) { /* Horizontal filter to apply */ \
601 int r; \
602 \
603 if (hmode) { /* Vertical filter to apply, output to tmp */ \
604 static const int shift_value[] = { 0, 5, 1, 5 }; \
605 int shift = (shift_value[hmode] + shift_value[vmode]) >> 1; \
606 int16_t tmp[11 * 8], *tptr = tmp; \
607 \
608 r = (1 << (shift - 1)) + rnd - 1; \
609 \
610 src -= 1; \
611 for (j = 0; j < 8; j++) { \
612 for (i = 0; i < 11; i++) \
613 tptr[i] = (vc1_mspel_ver_filter_16bits(src + i, stride, vmode) + r) >> shift; \
614 src += stride; \
615 tptr += 11; \
616 } \
617 \
618 r = 64 - rnd; \
619 tptr = tmp + 1; \
620 for (j = 0; j < 8; j++) { \
621 for (i = 0; i < 8; i++) \
622 OP(dst[i], (vc1_mspel_hor_filter_16bits(tptr + i, 1, hmode) + r) >> 7); \
623 dst += stride; \
624 tptr += 11; \
625 } \
626 \
627 return; \
628 } else { /* No horizontal filter, output 8 lines to dst */ \
629 r = 1 - rnd; \
630 \
631 for (j = 0; j < 8; j++) { \
632 for (i = 0; i < 8; i++) \
633 OP(dst[i], vc1_mspel_filter(src + i, stride, vmode, r)); \
634 src += stride; \
635 dst += stride; \
636 } \
637 return; \
638 } \
639 } \
640 \
641 /* Horizontal mode with no vertical mode */ \
642 for (j = 0; j < 8; j++) { \
643 for (i = 0; i < 8; i++) \
644 OP(dst[i], vc1_mspel_filter(src + i, 1, hmode, rnd)); \
645 dst += stride; \
646 src += stride; \
647 } \
648 }\
649 static av_always_inline void OPNAME ## vc1_mspel_mc_16(uint8_t *dst, \
650 const uint8_t *src, \
651 ptrdiff_t stride, \
652 int hmode, \
653 int vmode, \
654 int rnd) \
655 { \
656 int i, j; \
657 \
658 if (vmode) { /* Horizontal filter to apply */ \
659 int r; \
660 \
661 if (hmode) { /* Vertical filter to apply, output to tmp */ \
662 static const int shift_value[] = { 0, 5, 1, 5 }; \
663 int shift = (shift_value[hmode] + shift_value[vmode]) >> 1; \
664 int16_t tmp[19 * 16], *tptr = tmp; \
665 \
666 r = (1 << (shift - 1)) + rnd - 1; \
667 \
668 src -= 1; \
669 for (j = 0; j < 16; j++) { \
670 for (i = 0; i < 19; i++) \
671 tptr[i] = (vc1_mspel_ver_filter_16bits(src + i, stride, vmode) + r) >> shift; \
672 src += stride; \
673 tptr += 19; \
674 } \
675 \
676 r = 64 - rnd; \
677 tptr = tmp + 1; \
678 for (j = 0; j < 16; j++) { \
679 for (i = 0; i < 16; i++) \
680 OP(dst[i], (vc1_mspel_hor_filter_16bits(tptr + i, 1, hmode) + r) >> 7); \
681 dst += stride; \
682 tptr += 19; \
683 } \
684 \
685 return; \
686 } else { /* No horizontal filter, output 8 lines to dst */ \
687 r = 1 - rnd; \
688 \
689 for (j = 0; j < 16; j++) { \
690 for (i = 0; i < 16; i++) \
691 OP(dst[i], vc1_mspel_filter(src + i, stride, vmode, r)); \
692 src += stride; \
693 dst += stride; \
694 } \
695 return; \
696 } \
697 } \
698 \
699 /* Horizontal mode with no vertical mode */ \
700 for (j = 0; j < 16; j++) { \
701 for (i = 0; i < 16; i++) \
702 OP(dst[i], vc1_mspel_filter(src + i, 1, hmode, rnd)); \
703 dst += stride; \
704 src += stride; \
705 } \
706 }\
707 static void OPNAME ## pixels8x8_c(uint8_t *block, const uint8_t *pixels, ptrdiff_t line_size, int rnd){\
708 int i;\
709 for(i=0; i<8; i++){\
710 OP4(*(uint32_t*)(block ), AV_RN32(pixels ));\
711 OP4(*(uint32_t*)(block+4), AV_RN32(pixels+4));\
712 pixels+=line_size;\
713 block +=line_size;\
714 }\
715 }\
716 static void OPNAME ## pixels16x16_c(uint8_t *block, const uint8_t *pixels, ptrdiff_t line_size, int rnd){\
717 int i;\
718 for(i=0; i<16; i++){\
719 OP4(*(uint32_t*)(block ), AV_RN32(pixels ));\
720 OP4(*(uint32_t*)(block+ 4), AV_RN32(pixels+ 4));\
721 OP4(*(uint32_t*)(block+ 8), AV_RN32(pixels+ 8));\
722 OP4(*(uint32_t*)(block+12), AV_RN32(pixels+12));\
723 pixels+=line_size;\
724 block +=line_size;\
725 }\
726 }
727
728 #define op_put(a, b) (a) = av_clip_uint8(b)
729 #define op_avg(a, b) (a) = ((a) + av_clip_uint8(b) + 1) >> 1
730 #define op4_avg(a, b) (a) = rnd_avg32(a, b)
731 #define op4_put(a, b) (a) = (b)
732
VC1_MSPEL_MC(op_put,op4_put,put_)733 VC1_MSPEL_MC(op_put, op4_put, put_)
734 VC1_MSPEL_MC(op_avg, op4_avg, avg_)
735
736 /* pixel functions - really are entry points to vc1_mspel_mc */
737
738 #define PUT_VC1_MSPEL(a, b) \
739 static void put_vc1_mspel_mc ## a ## b ## _c(uint8_t *dst, \
740 const uint8_t *src, \
741 ptrdiff_t stride, int rnd) \
742 { \
743 put_vc1_mspel_mc(dst, src, stride, a, b, rnd); \
744 } \
745 static void avg_vc1_mspel_mc ## a ## b ## _c(uint8_t *dst, \
746 const uint8_t *src, \
747 ptrdiff_t stride, int rnd) \
748 { \
749 avg_vc1_mspel_mc(dst, src, stride, a, b, rnd); \
750 } \
751 static void put_vc1_mspel_mc ## a ## b ## _16_c(uint8_t *dst, \
752 const uint8_t *src, \
753 ptrdiff_t stride, int rnd) \
754 { \
755 put_vc1_mspel_mc_16(dst, src, stride, a, b, rnd); \
756 } \
757 static void avg_vc1_mspel_mc ## a ## b ## _16_c(uint8_t *dst, \
758 const uint8_t *src, \
759 ptrdiff_t stride, int rnd) \
760 { \
761 avg_vc1_mspel_mc_16(dst, src, stride, a, b, rnd); \
762 }
763
764 PUT_VC1_MSPEL(1, 0)
765 PUT_VC1_MSPEL(2, 0)
766 PUT_VC1_MSPEL(3, 0)
767
768 PUT_VC1_MSPEL(0, 1)
769 PUT_VC1_MSPEL(1, 1)
770 PUT_VC1_MSPEL(2, 1)
771 PUT_VC1_MSPEL(3, 1)
772
773 PUT_VC1_MSPEL(0, 2)
774 PUT_VC1_MSPEL(1, 2)
775 PUT_VC1_MSPEL(2, 2)
776 PUT_VC1_MSPEL(3, 2)
777
778 PUT_VC1_MSPEL(0, 3)
779 PUT_VC1_MSPEL(1, 3)
780 PUT_VC1_MSPEL(2, 3)
781 PUT_VC1_MSPEL(3, 3)
782
783 #define chroma_mc(a) \
784 ((A * src[a] + B * src[a + 1] + \
785 C * src[stride + a] + D * src[stride + a + 1] + 32 - 4) >> 6)
786 static void put_no_rnd_vc1_chroma_mc8_c(uint8_t *dst /* align 8 */,
787 uint8_t *src /* align 1 */,
788 ptrdiff_t stride, int h, int x, int y)
789 {
790 const int A = (8 - x) * (8 - y);
791 const int B = (x) * (8 - y);
792 const int C = (8 - x) * (y);
793 const int D = (x) * (y);
794 int i;
795
796 av_assert2(x < 8 && y < 8 && x >= 0 && y >= 0);
797
798 for (i = 0; i < h; i++) {
799 dst[0] = chroma_mc(0);
800 dst[1] = chroma_mc(1);
801 dst[2] = chroma_mc(2);
802 dst[3] = chroma_mc(3);
803 dst[4] = chroma_mc(4);
804 dst[5] = chroma_mc(5);
805 dst[6] = chroma_mc(6);
806 dst[7] = chroma_mc(7);
807 dst += stride;
808 src += stride;
809 }
810 }
811
put_no_rnd_vc1_chroma_mc4_c(uint8_t * dst,uint8_t * src,ptrdiff_t stride,int h,int x,int y)812 static void put_no_rnd_vc1_chroma_mc4_c(uint8_t *dst, uint8_t *src,
813 ptrdiff_t stride, int h, int x, int y)
814 {
815 const int A = (8 - x) * (8 - y);
816 const int B = (x) * (8 - y);
817 const int C = (8 - x) * (y);
818 const int D = (x) * (y);
819 int i;
820
821 av_assert2(x < 8 && y < 8 && x >= 0 && y >= 0);
822
823 for (i = 0; i < h; i++) {
824 dst[0] = chroma_mc(0);
825 dst[1] = chroma_mc(1);
826 dst[2] = chroma_mc(2);
827 dst[3] = chroma_mc(3);
828 dst += stride;
829 src += stride;
830 }
831 }
832
833 #define avg2(a, b) (((a) + (b) + 1) >> 1)
avg_no_rnd_vc1_chroma_mc8_c(uint8_t * dst,uint8_t * src,ptrdiff_t stride,int h,int x,int y)834 static void avg_no_rnd_vc1_chroma_mc8_c(uint8_t *dst /* align 8 */,
835 uint8_t *src /* align 1 */,
836 ptrdiff_t stride, int h, int x, int y)
837 {
838 const int A = (8 - x) * (8 - y);
839 const int B = (x) * (8 - y);
840 const int C = (8 - x) * (y);
841 const int D = (x) * (y);
842 int i;
843
844 av_assert2(x < 8 && y < 8 && x >= 0 && y >= 0);
845
846 for (i = 0; i < h; i++) {
847 dst[0] = avg2(dst[0], chroma_mc(0));
848 dst[1] = avg2(dst[1], chroma_mc(1));
849 dst[2] = avg2(dst[2], chroma_mc(2));
850 dst[3] = avg2(dst[3], chroma_mc(3));
851 dst[4] = avg2(dst[4], chroma_mc(4));
852 dst[5] = avg2(dst[5], chroma_mc(5));
853 dst[6] = avg2(dst[6], chroma_mc(6));
854 dst[7] = avg2(dst[7], chroma_mc(7));
855 dst += stride;
856 src += stride;
857 }
858 }
859
avg_no_rnd_vc1_chroma_mc4_c(uint8_t * dst,uint8_t * src,ptrdiff_t stride,int h,int x,int y)860 static void avg_no_rnd_vc1_chroma_mc4_c(uint8_t *dst /* align 8 */,
861 uint8_t *src /* align 1 */,
862 ptrdiff_t stride, int h, int x, int y)
863 {
864 const int A = (8 - x) * (8 - y);
865 const int B = ( x) * (8 - y);
866 const int C = (8 - x) * ( y);
867 const int D = ( x) * ( y);
868 int i;
869
870 av_assert2(x < 8 && y < 8 && x >= 0 && y >= 0);
871
872 for (i = 0; i < h; i++) {
873 dst[0] = avg2(dst[0], chroma_mc(0));
874 dst[1] = avg2(dst[1], chroma_mc(1));
875 dst[2] = avg2(dst[2], chroma_mc(2));
876 dst[3] = avg2(dst[3], chroma_mc(3));
877 dst += stride;
878 src += stride;
879 }
880 }
881
882 #if CONFIG_WMV3IMAGE_DECODER || CONFIG_VC1IMAGE_DECODER
883
sprite_h_c(uint8_t * dst,const uint8_t * src,int offset,int advance,int count)884 static void sprite_h_c(uint8_t *dst, const uint8_t *src, int offset,
885 int advance, int count)
886 {
887 while (count--) {
888 int a = src[(offset >> 16)];
889 int b = src[(offset >> 16) + 1];
890 *dst++ = a + ((b - a) * (offset & 0xFFFF) >> 16);
891 offset += advance;
892 }
893 }
894
sprite_v_template(uint8_t * dst,const uint8_t * src1a,const uint8_t * src1b,int offset1,int two_sprites,const uint8_t * src2a,const uint8_t * src2b,int offset2,int alpha,int scaled,int width)895 static av_always_inline void sprite_v_template(uint8_t *dst,
896 const uint8_t *src1a,
897 const uint8_t *src1b,
898 int offset1,
899 int two_sprites,
900 const uint8_t *src2a,
901 const uint8_t *src2b,
902 int offset2,
903 int alpha, int scaled,
904 int width)
905 {
906 int a1, b1, a2, b2;
907 while (width--) {
908 a1 = *src1a++;
909 if (scaled) {
910 b1 = *src1b++;
911 a1 = a1 + ((b1 - a1) * offset1 >> 16);
912 }
913 if (two_sprites) {
914 a2 = *src2a++;
915 if (scaled > 1) {
916 b2 = *src2b++;
917 a2 = a2 + ((b2 - a2) * offset2 >> 16);
918 }
919 a1 = a1 + ((a2 - a1) * alpha >> 16);
920 }
921 *dst++ = a1;
922 }
923 }
924
sprite_v_single_c(uint8_t * dst,const uint8_t * src1a,const uint8_t * src1b,int offset,int width)925 static void sprite_v_single_c(uint8_t *dst, const uint8_t *src1a,
926 const uint8_t *src1b,
927 int offset, int width)
928 {
929 sprite_v_template(dst, src1a, src1b, offset, 0, NULL, NULL, 0, 0, 1, width);
930 }
931
sprite_v_double_noscale_c(uint8_t * dst,const uint8_t * src1a,const uint8_t * src2a,int alpha,int width)932 static void sprite_v_double_noscale_c(uint8_t *dst, const uint8_t *src1a,
933 const uint8_t *src2a,
934 int alpha, int width)
935 {
936 sprite_v_template(dst, src1a, NULL, 0, 1, src2a, NULL, 0, alpha, 0, width);
937 }
938
sprite_v_double_onescale_c(uint8_t * dst,const uint8_t * src1a,const uint8_t * src1b,int offset1,const uint8_t * src2a,int alpha,int width)939 static void sprite_v_double_onescale_c(uint8_t *dst,
940 const uint8_t *src1a,
941 const uint8_t *src1b,
942 int offset1,
943 const uint8_t *src2a,
944 int alpha, int width)
945 {
946 sprite_v_template(dst, src1a, src1b, offset1, 1, src2a, NULL, 0, alpha, 1,
947 width);
948 }
949
sprite_v_double_twoscale_c(uint8_t * dst,const uint8_t * src1a,const uint8_t * src1b,int offset1,const uint8_t * src2a,const uint8_t * src2b,int offset2,int alpha,int width)950 static void sprite_v_double_twoscale_c(uint8_t *dst,
951 const uint8_t *src1a,
952 const uint8_t *src1b,
953 int offset1,
954 const uint8_t *src2a,
955 const uint8_t *src2b,
956 int offset2,
957 int alpha,
958 int width)
959 {
960 sprite_v_template(dst, src1a, src1b, offset1, 1, src2a, src2b, offset2,
961 alpha, 2, width);
962 }
963
964 #endif /* CONFIG_WMV3IMAGE_DECODER || CONFIG_VC1IMAGE_DECODER */
965 #define FN_ASSIGN(X, Y) \
966 dsp->put_vc1_mspel_pixels_tab[1][X+4*Y] = put_vc1_mspel_mc##X##Y##_c; \
967 dsp->put_vc1_mspel_pixels_tab[0][X+4*Y] = put_vc1_mspel_mc##X##Y##_16_c; \
968 dsp->avg_vc1_mspel_pixels_tab[1][X+4*Y] = avg_vc1_mspel_mc##X##Y##_c; \
969 dsp->avg_vc1_mspel_pixels_tab[0][X+4*Y] = avg_vc1_mspel_mc##X##Y##_16_c
970
ff_vc1dsp_init(VC1DSPContext * dsp)971 av_cold void ff_vc1dsp_init(VC1DSPContext *dsp)
972 {
973 dsp->vc1_inv_trans_8x8 = vc1_inv_trans_8x8_c;
974 dsp->vc1_inv_trans_4x8 = vc1_inv_trans_4x8_c;
975 dsp->vc1_inv_trans_8x4 = vc1_inv_trans_8x4_c;
976 dsp->vc1_inv_trans_4x4 = vc1_inv_trans_4x4_c;
977 dsp->vc1_inv_trans_8x8_dc = vc1_inv_trans_8x8_dc_c;
978 dsp->vc1_inv_trans_4x8_dc = vc1_inv_trans_4x8_dc_c;
979 dsp->vc1_inv_trans_8x4_dc = vc1_inv_trans_8x4_dc_c;
980 dsp->vc1_inv_trans_4x4_dc = vc1_inv_trans_4x4_dc_c;
981
982 dsp->vc1_h_overlap = vc1_h_overlap_c;
983 dsp->vc1_v_overlap = vc1_v_overlap_c;
984 dsp->vc1_h_s_overlap = vc1_h_s_overlap_c;
985 dsp->vc1_v_s_overlap = vc1_v_s_overlap_c;
986
987 dsp->vc1_v_loop_filter4 = vc1_v_loop_filter4_c;
988 dsp->vc1_h_loop_filter4 = vc1_h_loop_filter4_c;
989 dsp->vc1_v_loop_filter8 = vc1_v_loop_filter8_c;
990 dsp->vc1_h_loop_filter8 = vc1_h_loop_filter8_c;
991 dsp->vc1_v_loop_filter16 = vc1_v_loop_filter16_c;
992 dsp->vc1_h_loop_filter16 = vc1_h_loop_filter16_c;
993
994 dsp->put_vc1_mspel_pixels_tab[0][0] = put_pixels16x16_c;
995 dsp->avg_vc1_mspel_pixels_tab[0][0] = avg_pixels16x16_c;
996 dsp->put_vc1_mspel_pixels_tab[1][0] = put_pixels8x8_c;
997 dsp->avg_vc1_mspel_pixels_tab[1][0] = avg_pixels8x8_c;
998 FN_ASSIGN(0, 1);
999 FN_ASSIGN(0, 2);
1000 FN_ASSIGN(0, 3);
1001
1002 FN_ASSIGN(1, 0);
1003 FN_ASSIGN(1, 1);
1004 FN_ASSIGN(1, 2);
1005 FN_ASSIGN(1, 3);
1006
1007 FN_ASSIGN(2, 0);
1008 FN_ASSIGN(2, 1);
1009 FN_ASSIGN(2, 2);
1010 FN_ASSIGN(2, 3);
1011
1012 FN_ASSIGN(3, 0);
1013 FN_ASSIGN(3, 1);
1014 FN_ASSIGN(3, 2);
1015 FN_ASSIGN(3, 3);
1016
1017 dsp->put_no_rnd_vc1_chroma_pixels_tab[0] = put_no_rnd_vc1_chroma_mc8_c;
1018 dsp->avg_no_rnd_vc1_chroma_pixels_tab[0] = avg_no_rnd_vc1_chroma_mc8_c;
1019 dsp->put_no_rnd_vc1_chroma_pixels_tab[1] = put_no_rnd_vc1_chroma_mc4_c;
1020 dsp->avg_no_rnd_vc1_chroma_pixels_tab[1] = avg_no_rnd_vc1_chroma_mc4_c;
1021
1022 #if CONFIG_WMV3IMAGE_DECODER || CONFIG_VC1IMAGE_DECODER
1023 dsp->sprite_h = sprite_h_c;
1024 dsp->sprite_v_single = sprite_v_single_c;
1025 dsp->sprite_v_double_noscale = sprite_v_double_noscale_c;
1026 dsp->sprite_v_double_onescale = sprite_v_double_onescale_c;
1027 dsp->sprite_v_double_twoscale = sprite_v_double_twoscale_c;
1028 #endif /* CONFIG_WMV3IMAGE_DECODER || CONFIG_VC1IMAGE_DECODER */
1029
1030 dsp->startcode_find_candidate = ff_startcode_find_candidate_c;
1031
1032 if (ARCH_AARCH64)
1033 ff_vc1dsp_init_aarch64(dsp);
1034 if (ARCH_ARM)
1035 ff_vc1dsp_init_arm(dsp);
1036 if (ARCH_PPC)
1037 ff_vc1dsp_init_ppc(dsp);
1038 if (ARCH_X86)
1039 ff_vc1dsp_init_x86(dsp);
1040 if (ARCH_MIPS)
1041 ff_vc1dsp_init_mips(dsp);
1042 }
1043