1/* 2 * This file is part of FFmpeg. 3 * 4 * FFmpeg is free software; you can redistribute it and/or 5 * modify it under the terms of the GNU Lesser General Public 6 * License as published by the Free Software Foundation; either 7 * version 2.1 of the License, or (at your option) any later version. 8 * 9 * FFmpeg is distributed in the hope that it will be useful, 10 * but WITHOUT ANY WARRANTY; without even the implied warranty of 11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 12 * Lesser General Public License for more details. 13 * 14 * You should have received a copy of the GNU Lesser General Public 15 * License along with FFmpeg; if not, write to the Free Software 16 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA 17 */ 18 19#include "config.h" 20#include "libavutil/attributes.h" 21#include "libavutil/common.h" 22#include "mpegvideodsp.h" 23 24static void gmc1_c(uint8_t *dst, uint8_t *src, int stride, int h, 25 int x16, int y16, int rounder) 26{ 27 const int A = (16 - x16) * (16 - y16); 28 const int B = (x16) * (16 - y16); 29 const int C = (16 - x16) * (y16); 30 const int D = (x16) * (y16); 31 int i; 32 33 for (i = 0; i < h; i++) { 34 dst[0] = (A * src[0] + B * src[1] + C * src[stride + 0] + D * src[stride + 1] + rounder) >> 8; 35 dst[1] = (A * src[1] + B * src[2] + C * src[stride + 1] + D * src[stride + 2] + rounder) >> 8; 36 dst[2] = (A * src[2] + B * src[3] + C * src[stride + 2] + D * src[stride + 3] + rounder) >> 8; 37 dst[3] = (A * src[3] + B * src[4] + C * src[stride + 3] + D * src[stride + 4] + rounder) >> 8; 38 dst[4] = (A * src[4] + B * src[5] + C * src[stride + 4] + D * src[stride + 5] + rounder) >> 8; 39 dst[5] = (A * src[5] + B * src[6] + C * src[stride + 5] + D * src[stride + 6] + rounder) >> 8; 40 dst[6] = (A * src[6] + B * src[7] + C * src[stride + 6] + D * src[stride + 7] + rounder) >> 8; 41 dst[7] = (A * src[7] + B * src[8] + C * src[stride + 7] + D * src[stride + 8] + rounder) >> 8; 42 dst += stride; 43 src += stride; 44 } 45} 46 47void ff_gmc_c(uint8_t *dst, uint8_t *src, int stride, int h, int ox, int oy, 48 int dxx, int dxy, int dyx, int dyy, int shift, int r, 49 int width, int height) 50{ 51 int y, vx, vy; 52 const int s = 1 << shift; 53 54 width--; 55 height--; 56 57 for (y = 0; y < h; y++) { 58 int x; 59 60 vx = ox; 61 vy = oy; 62 for (x = 0; x < 8; x++) { // FIXME: optimize 63 int index; 64 int src_x = vx >> 16; 65 int src_y = vy >> 16; 66 int frac_x = src_x & (s - 1); 67 int frac_y = src_y & (s - 1); 68 69 src_x >>= shift; 70 src_y >>= shift; 71 72 if ((unsigned) src_x < width) { 73 if ((unsigned) src_y < height) { 74 index = src_x + src_y * stride; 75 dst[y * stride + x] = 76 ((src[index] * (s - frac_x) + 77 src[index + 1] * frac_x) * (s - frac_y) + 78 (src[index + stride] * (s - frac_x) + 79 src[index + stride + 1] * frac_x) * frac_y + 80 r) >> (shift * 2); 81 } else { 82 index = src_x + av_clip(src_y, 0, height) * stride; 83 dst[y * stride + x] = 84 ((src[index] * (s - frac_x) + 85 src[index + 1] * frac_x) * s + 86 r) >> (shift * 2); 87 } 88 } else { 89 if ((unsigned) src_y < height) { 90 index = av_clip(src_x, 0, width) + src_y * stride; 91 dst[y * stride + x] = 92 ((src[index] * (s - frac_y) + 93 src[index + stride] * frac_y) * s + 94 r) >> (shift * 2); 95 } else { 96 index = av_clip(src_x, 0, width) + 97 av_clip(src_y, 0, height) * stride; 98 dst[y * stride + x] = src[index]; 99 } 100 } 101 102 vx += dxx; 103 vy += dyx; 104 } 105 ox += dxy; 106 oy += dyy; 107 } 108} 109 110av_cold void ff_mpegvideodsp_init(MpegVideoDSPContext *c) 111{ 112 c->gmc1 = gmc1_c; 113 c->gmc = ff_gmc_c; 114 115 if (ARCH_PPC) 116 ff_mpegvideodsp_init_ppc(c); 117 if (ARCH_X86) 118 ff_mpegvideodsp_init_x86(c); 119} 120