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