1cabdff1aSopenharmony_ci/* 2cabdff1aSopenharmony_ci * VC-1 and WMV3 - DSP functions MMX-optimized 3cabdff1aSopenharmony_ci * Copyright (c) 2007 Christophe GISQUET <christophe.gisquet@free.fr> 4cabdff1aSopenharmony_ci * 5cabdff1aSopenharmony_ci * Permission is hereby granted, free of charge, to any person 6cabdff1aSopenharmony_ci * obtaining a copy of this software and associated documentation 7cabdff1aSopenharmony_ci * files (the "Software"), to deal in the Software without 8cabdff1aSopenharmony_ci * restriction, including without limitation the rights to use, 9cabdff1aSopenharmony_ci * copy, modify, merge, publish, distribute, sublicense, and/or sell 10cabdff1aSopenharmony_ci * copies of the Software, and to permit persons to whom the 11cabdff1aSopenharmony_ci * Software is furnished to do so, subject to the following 12cabdff1aSopenharmony_ci * conditions: 13cabdff1aSopenharmony_ci * 14cabdff1aSopenharmony_ci * The above copyright notice and this permission notice shall be 15cabdff1aSopenharmony_ci * included in all copies or substantial portions of the Software. 16cabdff1aSopenharmony_ci * 17cabdff1aSopenharmony_ci * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 18cabdff1aSopenharmony_ci * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES 19cabdff1aSopenharmony_ci * OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 20cabdff1aSopenharmony_ci * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT 21cabdff1aSopenharmony_ci * HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, 22cabdff1aSopenharmony_ci * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING 23cabdff1aSopenharmony_ci * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR 24cabdff1aSopenharmony_ci * OTHER DEALINGS IN THE SOFTWARE. 25cabdff1aSopenharmony_ci */ 26cabdff1aSopenharmony_ci 27cabdff1aSopenharmony_ci#include "libavutil/attributes.h" 28cabdff1aSopenharmony_ci#include "libavutil/mem_internal.h" 29cabdff1aSopenharmony_ci#include "libavutil/x86/asm.h" 30cabdff1aSopenharmony_ci#include "libavutil/x86/cpu.h" 31cabdff1aSopenharmony_ci#include "libavcodec/vc1dsp.h" 32cabdff1aSopenharmony_ci#include "constants.h" 33cabdff1aSopenharmony_ci#include "fpel.h" 34cabdff1aSopenharmony_ci#include "vc1dsp.h" 35cabdff1aSopenharmony_ci 36cabdff1aSopenharmony_ci#if HAVE_6REGS && HAVE_INLINE_ASM && HAVE_MMX_EXTERNAL 37cabdff1aSopenharmony_ci 38cabdff1aSopenharmony_civoid ff_vc1_put_ver_16b_shift2_mmx(int16_t *dst, 39cabdff1aSopenharmony_ci const uint8_t *src, x86_reg stride, 40cabdff1aSopenharmony_ci int rnd, int64_t shift); 41cabdff1aSopenharmony_civoid ff_vc1_put_hor_16b_shift2_mmx(uint8_t *dst, x86_reg stride, 42cabdff1aSopenharmony_ci const int16_t *src, int rnd); 43cabdff1aSopenharmony_civoid ff_vc1_avg_hor_16b_shift2_mmxext(uint8_t *dst, x86_reg stride, 44cabdff1aSopenharmony_ci const int16_t *src, int rnd); 45cabdff1aSopenharmony_ci 46cabdff1aSopenharmony_ci#define OP_PUT(S,D) 47cabdff1aSopenharmony_ci#define OP_AVG(S,D) "pavgb " #S ", " #D " \n\t" 48cabdff1aSopenharmony_ci 49cabdff1aSopenharmony_ci/** Add rounder from mm7 to mm3 and pack result at destination */ 50cabdff1aSopenharmony_ci#define NORMALIZE_MMX(SHIFT) \ 51cabdff1aSopenharmony_ci "paddw %%mm7, %%mm3 \n\t" /* +bias-r */ \ 52cabdff1aSopenharmony_ci "paddw %%mm7, %%mm4 \n\t" /* +bias-r */ \ 53cabdff1aSopenharmony_ci "psraw "SHIFT", %%mm3 \n\t" \ 54cabdff1aSopenharmony_ci "psraw "SHIFT", %%mm4 \n\t" 55cabdff1aSopenharmony_ci 56cabdff1aSopenharmony_ci#define TRANSFER_DO_PACK(OP) \ 57cabdff1aSopenharmony_ci "packuswb %%mm4, %%mm3 \n\t" \ 58cabdff1aSopenharmony_ci OP((%2), %%mm3) \ 59cabdff1aSopenharmony_ci "movq %%mm3, (%2) \n\t" 60cabdff1aSopenharmony_ci 61cabdff1aSopenharmony_ci#define TRANSFER_DONT_PACK(OP) \ 62cabdff1aSopenharmony_ci OP(0(%2), %%mm3) \ 63cabdff1aSopenharmony_ci OP(8(%2), %%mm4) \ 64cabdff1aSopenharmony_ci "movq %%mm3, 0(%2) \n\t" \ 65cabdff1aSopenharmony_ci "movq %%mm4, 8(%2) \n\t" 66cabdff1aSopenharmony_ci 67cabdff1aSopenharmony_ci/** @see MSPEL_FILTER13_CORE for use as UNPACK macro */ 68cabdff1aSopenharmony_ci#define DO_UNPACK(reg) "punpcklbw %%mm0, " reg "\n\t" 69cabdff1aSopenharmony_ci#define DONT_UNPACK(reg) 70cabdff1aSopenharmony_ci 71cabdff1aSopenharmony_ci/** Compute the rounder 32-r or 8-r and unpacks it to mm7 */ 72cabdff1aSopenharmony_ci#define LOAD_ROUNDER_MMX(ROUND) \ 73cabdff1aSopenharmony_ci "movd "ROUND", %%mm7 \n\t" \ 74cabdff1aSopenharmony_ci "punpcklwd %%mm7, %%mm7 \n\t" \ 75cabdff1aSopenharmony_ci "punpckldq %%mm7, %%mm7 \n\t" 76cabdff1aSopenharmony_ci 77cabdff1aSopenharmony_ci/** 78cabdff1aSopenharmony_ci * Purely vertical or horizontal 1/2 shift interpolation. 79cabdff1aSopenharmony_ci * Sacrifice mm6 for *9 factor. 80cabdff1aSopenharmony_ci */ 81cabdff1aSopenharmony_ci#define VC1_SHIFT2(OP, OPNAME)\ 82cabdff1aSopenharmony_cistatic void OPNAME ## vc1_shift2_mmx(uint8_t *dst, const uint8_t *src,\ 83cabdff1aSopenharmony_ci x86_reg stride, int rnd, x86_reg offset)\ 84cabdff1aSopenharmony_ci{\ 85cabdff1aSopenharmony_ci rnd = 8-rnd;\ 86cabdff1aSopenharmony_ci __asm__ volatile(\ 87cabdff1aSopenharmony_ci "mov $8, %%"FF_REG_c" \n\t"\ 88cabdff1aSopenharmony_ci LOAD_ROUNDER_MMX("%5")\ 89cabdff1aSopenharmony_ci "movq "MANGLE(ff_pw_9)", %%mm6\n\t"\ 90cabdff1aSopenharmony_ci "1: \n\t"\ 91cabdff1aSopenharmony_ci "movd 0(%0 ), %%mm3 \n\t"\ 92cabdff1aSopenharmony_ci "movd 4(%0 ), %%mm4 \n\t"\ 93cabdff1aSopenharmony_ci "movd 0(%0,%2), %%mm1 \n\t"\ 94cabdff1aSopenharmony_ci "movd 4(%0,%2), %%mm2 \n\t"\ 95cabdff1aSopenharmony_ci "add %2, %0 \n\t"\ 96cabdff1aSopenharmony_ci "punpcklbw %%mm0, %%mm3 \n\t"\ 97cabdff1aSopenharmony_ci "punpcklbw %%mm0, %%mm4 \n\t"\ 98cabdff1aSopenharmony_ci "punpcklbw %%mm0, %%mm1 \n\t"\ 99cabdff1aSopenharmony_ci "punpcklbw %%mm0, %%mm2 \n\t"\ 100cabdff1aSopenharmony_ci "paddw %%mm1, %%mm3 \n\t"\ 101cabdff1aSopenharmony_ci "paddw %%mm2, %%mm4 \n\t"\ 102cabdff1aSopenharmony_ci "movd 0(%0,%3), %%mm1 \n\t"\ 103cabdff1aSopenharmony_ci "movd 4(%0,%3), %%mm2 \n\t"\ 104cabdff1aSopenharmony_ci "pmullw %%mm6, %%mm3 \n\t" /* 0,9,9,0*/\ 105cabdff1aSopenharmony_ci "pmullw %%mm6, %%mm4 \n\t" /* 0,9,9,0*/\ 106cabdff1aSopenharmony_ci "punpcklbw %%mm0, %%mm1 \n\t"\ 107cabdff1aSopenharmony_ci "punpcklbw %%mm0, %%mm2 \n\t"\ 108cabdff1aSopenharmony_ci "psubw %%mm1, %%mm3 \n\t" /*-1,9,9,0*/\ 109cabdff1aSopenharmony_ci "psubw %%mm2, %%mm4 \n\t" /*-1,9,9,0*/\ 110cabdff1aSopenharmony_ci "movd 0(%0,%2), %%mm1 \n\t"\ 111cabdff1aSopenharmony_ci "movd 4(%0,%2), %%mm2 \n\t"\ 112cabdff1aSopenharmony_ci "punpcklbw %%mm0, %%mm1 \n\t"\ 113cabdff1aSopenharmony_ci "punpcklbw %%mm0, %%mm2 \n\t"\ 114cabdff1aSopenharmony_ci "psubw %%mm1, %%mm3 \n\t" /*-1,9,9,-1*/\ 115cabdff1aSopenharmony_ci "psubw %%mm2, %%mm4 \n\t" /*-1,9,9,-1*/\ 116cabdff1aSopenharmony_ci NORMALIZE_MMX("$4")\ 117cabdff1aSopenharmony_ci "packuswb %%mm4, %%mm3 \n\t"\ 118cabdff1aSopenharmony_ci OP((%1), %%mm3)\ 119cabdff1aSopenharmony_ci "movq %%mm3, (%1) \n\t"\ 120cabdff1aSopenharmony_ci "add %6, %0 \n\t"\ 121cabdff1aSopenharmony_ci "add %4, %1 \n\t"\ 122cabdff1aSopenharmony_ci "dec %%"FF_REG_c" \n\t"\ 123cabdff1aSopenharmony_ci "jnz 1b \n\t"\ 124cabdff1aSopenharmony_ci : "+r"(src), "+r"(dst)\ 125cabdff1aSopenharmony_ci : "r"(offset), "r"(-2*offset), "g"(stride), "m"(rnd),\ 126cabdff1aSopenharmony_ci "g"(stride-offset)\ 127cabdff1aSopenharmony_ci NAMED_CONSTRAINTS_ADD(ff_pw_9)\ 128cabdff1aSopenharmony_ci : "%"FF_REG_c, "memory"\ 129cabdff1aSopenharmony_ci );\ 130cabdff1aSopenharmony_ci} 131cabdff1aSopenharmony_ci 132cabdff1aSopenharmony_ciVC1_SHIFT2(OP_PUT, put_) 133cabdff1aSopenharmony_ciVC1_SHIFT2(OP_AVG, avg_) 134cabdff1aSopenharmony_ci 135cabdff1aSopenharmony_ci/** 136cabdff1aSopenharmony_ci * Core of the 1/4 and 3/4 shift bicubic interpolation. 137cabdff1aSopenharmony_ci * 138cabdff1aSopenharmony_ci * @param UNPACK Macro unpacking arguments from 8 to 16 bits (can be empty). 139cabdff1aSopenharmony_ci * @param MOVQ "movd 1" or "movq 2", if data read is already unpacked. 140cabdff1aSopenharmony_ci * @param A1 Address of 1st tap (beware of unpacked/packed). 141cabdff1aSopenharmony_ci * @param A2 Address of 2nd tap 142cabdff1aSopenharmony_ci * @param A3 Address of 3rd tap 143cabdff1aSopenharmony_ci * @param A4 Address of 4th tap 144cabdff1aSopenharmony_ci */ 145cabdff1aSopenharmony_ci#define MSPEL_FILTER13_CORE(UNPACK, MOVQ, A1, A2, A3, A4) \ 146cabdff1aSopenharmony_ci MOVQ "*0+"A1", %%mm1 \n\t" \ 147cabdff1aSopenharmony_ci MOVQ "*4+"A1", %%mm2 \n\t" \ 148cabdff1aSopenharmony_ci UNPACK("%%mm1") \ 149cabdff1aSopenharmony_ci UNPACK("%%mm2") \ 150cabdff1aSopenharmony_ci "pmullw "MANGLE(ff_pw_3)", %%mm1\n\t" \ 151cabdff1aSopenharmony_ci "pmullw "MANGLE(ff_pw_3)", %%mm2\n\t" \ 152cabdff1aSopenharmony_ci MOVQ "*0+"A2", %%mm3 \n\t" \ 153cabdff1aSopenharmony_ci MOVQ "*4+"A2", %%mm4 \n\t" \ 154cabdff1aSopenharmony_ci UNPACK("%%mm3") \ 155cabdff1aSopenharmony_ci UNPACK("%%mm4") \ 156cabdff1aSopenharmony_ci "pmullw %%mm6, %%mm3 \n\t" /* *18 */ \ 157cabdff1aSopenharmony_ci "pmullw %%mm6, %%mm4 \n\t" /* *18 */ \ 158cabdff1aSopenharmony_ci "psubw %%mm1, %%mm3 \n\t" /* 18,-3 */ \ 159cabdff1aSopenharmony_ci "psubw %%mm2, %%mm4 \n\t" /* 18,-3 */ \ 160cabdff1aSopenharmony_ci MOVQ "*0+"A4", %%mm1 \n\t" \ 161cabdff1aSopenharmony_ci MOVQ "*4+"A4", %%mm2 \n\t" \ 162cabdff1aSopenharmony_ci UNPACK("%%mm1") \ 163cabdff1aSopenharmony_ci UNPACK("%%mm2") \ 164cabdff1aSopenharmony_ci "psllw $2, %%mm1 \n\t" /* 4* */ \ 165cabdff1aSopenharmony_ci "psllw $2, %%mm2 \n\t" /* 4* */ \ 166cabdff1aSopenharmony_ci "psubw %%mm1, %%mm3 \n\t" /* -4,18,-3 */ \ 167cabdff1aSopenharmony_ci "psubw %%mm2, %%mm4 \n\t" /* -4,18,-3 */ \ 168cabdff1aSopenharmony_ci MOVQ "*0+"A3", %%mm1 \n\t" \ 169cabdff1aSopenharmony_ci MOVQ "*4+"A3", %%mm2 \n\t" \ 170cabdff1aSopenharmony_ci UNPACK("%%mm1") \ 171cabdff1aSopenharmony_ci UNPACK("%%mm2") \ 172cabdff1aSopenharmony_ci "pmullw %%mm5, %%mm1 \n\t" /* *53 */ \ 173cabdff1aSopenharmony_ci "pmullw %%mm5, %%mm2 \n\t" /* *53 */ \ 174cabdff1aSopenharmony_ci "paddw %%mm1, %%mm3 \n\t" /* 4,53,18,-3 */ \ 175cabdff1aSopenharmony_ci "paddw %%mm2, %%mm4 \n\t" /* 4,53,18,-3 */ 176cabdff1aSopenharmony_ci 177cabdff1aSopenharmony_ci/** 178cabdff1aSopenharmony_ci * Macro to build the vertical 16 bits version of vc1_put_shift[13]. 179cabdff1aSopenharmony_ci * Here, offset=src_stride. Parameters passed A1 to A4 must use 180cabdff1aSopenharmony_ci * %3 (src_stride) and %4 (3*src_stride). 181cabdff1aSopenharmony_ci * 182cabdff1aSopenharmony_ci * @param NAME Either 1 or 3 183cabdff1aSopenharmony_ci * @see MSPEL_FILTER13_CORE for information on A1->A4 184cabdff1aSopenharmony_ci */ 185cabdff1aSopenharmony_ci#define MSPEL_FILTER13_VER_16B(NAME, A1, A2, A3, A4) \ 186cabdff1aSopenharmony_cistatic void \ 187cabdff1aSopenharmony_civc1_put_ver_16b_ ## NAME ## _mmx(int16_t *dst, const uint8_t *src, \ 188cabdff1aSopenharmony_ci x86_reg src_stride, \ 189cabdff1aSopenharmony_ci int rnd, int64_t shift) \ 190cabdff1aSopenharmony_ci{ \ 191cabdff1aSopenharmony_ci int h = 8; \ 192cabdff1aSopenharmony_ci src -= src_stride; \ 193cabdff1aSopenharmony_ci __asm__ volatile( \ 194cabdff1aSopenharmony_ci LOAD_ROUNDER_MMX("%5") \ 195cabdff1aSopenharmony_ci "movq "MANGLE(ff_pw_53)", %%mm5\n\t" \ 196cabdff1aSopenharmony_ci "movq "MANGLE(ff_pw_18)", %%mm6\n\t" \ 197cabdff1aSopenharmony_ci ".p2align 3 \n\t" \ 198cabdff1aSopenharmony_ci "1: \n\t" \ 199cabdff1aSopenharmony_ci MSPEL_FILTER13_CORE(DO_UNPACK, "movd 1", A1, A2, A3, A4) \ 200cabdff1aSopenharmony_ci NORMALIZE_MMX("%6") \ 201cabdff1aSopenharmony_ci TRANSFER_DONT_PACK(OP_PUT) \ 202cabdff1aSopenharmony_ci /* Last 3 (in fact 4) bytes on the line */ \ 203cabdff1aSopenharmony_ci "movd 8+"A1", %%mm1 \n\t" \ 204cabdff1aSopenharmony_ci DO_UNPACK("%%mm1") \ 205cabdff1aSopenharmony_ci "movq %%mm1, %%mm3 \n\t" \ 206cabdff1aSopenharmony_ci "paddw %%mm1, %%mm1 \n\t" \ 207cabdff1aSopenharmony_ci "paddw %%mm3, %%mm1 \n\t" /* 3* */ \ 208cabdff1aSopenharmony_ci "movd 8+"A2", %%mm3 \n\t" \ 209cabdff1aSopenharmony_ci DO_UNPACK("%%mm3") \ 210cabdff1aSopenharmony_ci "pmullw %%mm6, %%mm3 \n\t" /* *18 */ \ 211cabdff1aSopenharmony_ci "psubw %%mm1, %%mm3 \n\t" /*18,-3 */ \ 212cabdff1aSopenharmony_ci "movd 8+"A3", %%mm1 \n\t" \ 213cabdff1aSopenharmony_ci DO_UNPACK("%%mm1") \ 214cabdff1aSopenharmony_ci "pmullw %%mm5, %%mm1 \n\t" /* *53 */ \ 215cabdff1aSopenharmony_ci "paddw %%mm1, %%mm3 \n\t" /*53,18,-3 */ \ 216cabdff1aSopenharmony_ci "movd 8+"A4", %%mm1 \n\t" \ 217cabdff1aSopenharmony_ci DO_UNPACK("%%mm1") \ 218cabdff1aSopenharmony_ci "psllw $2, %%mm1 \n\t" /* 4* */ \ 219cabdff1aSopenharmony_ci "psubw %%mm1, %%mm3 \n\t" \ 220cabdff1aSopenharmony_ci "paddw %%mm7, %%mm3 \n\t" \ 221cabdff1aSopenharmony_ci "psraw %6, %%mm3 \n\t" \ 222cabdff1aSopenharmony_ci "movq %%mm3, 16(%2) \n\t" \ 223cabdff1aSopenharmony_ci "add %3, %1 \n\t" \ 224cabdff1aSopenharmony_ci "add $24, %2 \n\t" \ 225cabdff1aSopenharmony_ci "decl %0 \n\t" \ 226cabdff1aSopenharmony_ci "jnz 1b \n\t" \ 227cabdff1aSopenharmony_ci : "+r"(h), "+r" (src), "+r" (dst) \ 228cabdff1aSopenharmony_ci : "r"(src_stride), "r"(3*src_stride), \ 229cabdff1aSopenharmony_ci "m"(rnd), "m"(shift) \ 230cabdff1aSopenharmony_ci NAMED_CONSTRAINTS_ADD(ff_pw_3,ff_pw_53,ff_pw_18) \ 231cabdff1aSopenharmony_ci : "memory" \ 232cabdff1aSopenharmony_ci ); \ 233cabdff1aSopenharmony_ci} 234cabdff1aSopenharmony_ci 235cabdff1aSopenharmony_ci/** 236cabdff1aSopenharmony_ci * Macro to build the horizontal 16 bits version of vc1_put_shift[13]. 237cabdff1aSopenharmony_ci * Here, offset=16 bits, so parameters passed A1 to A4 should be simple. 238cabdff1aSopenharmony_ci * 239cabdff1aSopenharmony_ci * @param NAME Either 1 or 3 240cabdff1aSopenharmony_ci * @see MSPEL_FILTER13_CORE for information on A1->A4 241cabdff1aSopenharmony_ci */ 242cabdff1aSopenharmony_ci#define MSPEL_FILTER13_HOR_16B(NAME, A1, A2, A3, A4, OP, OPNAME) \ 243cabdff1aSopenharmony_cistatic void \ 244cabdff1aSopenharmony_ciOPNAME ## vc1_hor_16b_ ## NAME ## _mmx(uint8_t *dst, x86_reg stride, \ 245cabdff1aSopenharmony_ci const int16_t *src, int rnd) \ 246cabdff1aSopenharmony_ci{ \ 247cabdff1aSopenharmony_ci int h = 8; \ 248cabdff1aSopenharmony_ci src -= 1; \ 249cabdff1aSopenharmony_ci rnd -= (-4+58+13-3)*256; /* Add -256 bias */ \ 250cabdff1aSopenharmony_ci __asm__ volatile( \ 251cabdff1aSopenharmony_ci LOAD_ROUNDER_MMX("%4") \ 252cabdff1aSopenharmony_ci "movq "MANGLE(ff_pw_18)", %%mm6 \n\t" \ 253cabdff1aSopenharmony_ci "movq "MANGLE(ff_pw_53)", %%mm5 \n\t" \ 254cabdff1aSopenharmony_ci ".p2align 3 \n\t" \ 255cabdff1aSopenharmony_ci "1: \n\t" \ 256cabdff1aSopenharmony_ci MSPEL_FILTER13_CORE(DONT_UNPACK, "movq 2", A1, A2, A3, A4) \ 257cabdff1aSopenharmony_ci NORMALIZE_MMX("$7") \ 258cabdff1aSopenharmony_ci /* Remove bias */ \ 259cabdff1aSopenharmony_ci "paddw "MANGLE(ff_pw_128)", %%mm3 \n\t" \ 260cabdff1aSopenharmony_ci "paddw "MANGLE(ff_pw_128)", %%mm4 \n\t" \ 261cabdff1aSopenharmony_ci TRANSFER_DO_PACK(OP) \ 262cabdff1aSopenharmony_ci "add $24, %1 \n\t" \ 263cabdff1aSopenharmony_ci "add %3, %2 \n\t" \ 264cabdff1aSopenharmony_ci "decl %0 \n\t" \ 265cabdff1aSopenharmony_ci "jnz 1b \n\t" \ 266cabdff1aSopenharmony_ci : "+r"(h), "+r" (src), "+r" (dst) \ 267cabdff1aSopenharmony_ci : "r"(stride), "m"(rnd) \ 268cabdff1aSopenharmony_ci NAMED_CONSTRAINTS_ADD(ff_pw_3,ff_pw_18,ff_pw_53,ff_pw_128) \ 269cabdff1aSopenharmony_ci : "memory" \ 270cabdff1aSopenharmony_ci ); \ 271cabdff1aSopenharmony_ci} 272cabdff1aSopenharmony_ci 273cabdff1aSopenharmony_ci/** 274cabdff1aSopenharmony_ci * Macro to build the 8 bits, any direction, version of vc1_put_shift[13]. 275cabdff1aSopenharmony_ci * Here, offset=src_stride. Parameters passed A1 to A4 must use 276cabdff1aSopenharmony_ci * %3 (offset) and %4 (3*offset). 277cabdff1aSopenharmony_ci * 278cabdff1aSopenharmony_ci * @param NAME Either 1 or 3 279cabdff1aSopenharmony_ci * @see MSPEL_FILTER13_CORE for information on A1->A4 280cabdff1aSopenharmony_ci */ 281cabdff1aSopenharmony_ci#define MSPEL_FILTER13_8B(NAME, A1, A2, A3, A4, OP, OPNAME) \ 282cabdff1aSopenharmony_cistatic void \ 283cabdff1aSopenharmony_ciOPNAME ## vc1_## NAME ## _mmx(uint8_t *dst, const uint8_t *src, \ 284cabdff1aSopenharmony_ci x86_reg stride, int rnd, x86_reg offset) \ 285cabdff1aSopenharmony_ci{ \ 286cabdff1aSopenharmony_ci int h = 8; \ 287cabdff1aSopenharmony_ci src -= offset; \ 288cabdff1aSopenharmony_ci rnd = 32-rnd; \ 289cabdff1aSopenharmony_ci __asm__ volatile ( \ 290cabdff1aSopenharmony_ci LOAD_ROUNDER_MMX("%6") \ 291cabdff1aSopenharmony_ci "movq "MANGLE(ff_pw_53)", %%mm5 \n\t" \ 292cabdff1aSopenharmony_ci "movq "MANGLE(ff_pw_18)", %%mm6 \n\t" \ 293cabdff1aSopenharmony_ci ".p2align 3 \n\t" \ 294cabdff1aSopenharmony_ci "1: \n\t" \ 295cabdff1aSopenharmony_ci MSPEL_FILTER13_CORE(DO_UNPACK, "movd 1", A1, A2, A3, A4) \ 296cabdff1aSopenharmony_ci NORMALIZE_MMX("$6") \ 297cabdff1aSopenharmony_ci TRANSFER_DO_PACK(OP) \ 298cabdff1aSopenharmony_ci "add %5, %1 \n\t" \ 299cabdff1aSopenharmony_ci "add %5, %2 \n\t" \ 300cabdff1aSopenharmony_ci "decl %0 \n\t" \ 301cabdff1aSopenharmony_ci "jnz 1b \n\t" \ 302cabdff1aSopenharmony_ci : "+r"(h), "+r" (src), "+r" (dst) \ 303cabdff1aSopenharmony_ci : "r"(offset), "r"(3*offset), "g"(stride), "m"(rnd) \ 304cabdff1aSopenharmony_ci NAMED_CONSTRAINTS_ADD(ff_pw_53,ff_pw_18,ff_pw_3) \ 305cabdff1aSopenharmony_ci : "memory" \ 306cabdff1aSopenharmony_ci ); \ 307cabdff1aSopenharmony_ci} 308cabdff1aSopenharmony_ci 309cabdff1aSopenharmony_ci/** 1/4 shift bicubic interpolation */ 310cabdff1aSopenharmony_ciMSPEL_FILTER13_8B (shift1, "0(%1,%4 )", "0(%1,%3,2)", "0(%1,%3 )", "0(%1 )", OP_PUT, put_) 311cabdff1aSopenharmony_ciMSPEL_FILTER13_8B (shift1, "0(%1,%4 )", "0(%1,%3,2)", "0(%1,%3 )", "0(%1 )", OP_AVG, avg_) 312cabdff1aSopenharmony_ciMSPEL_FILTER13_VER_16B(shift1, "0(%1,%4 )", "0(%1,%3,2)", "0(%1,%3 )", "0(%1 )") 313cabdff1aSopenharmony_ciMSPEL_FILTER13_HOR_16B(shift1, "2*3(%1)", "2*2(%1)", "2*1(%1)", "2*0(%1)", OP_PUT, put_) 314cabdff1aSopenharmony_ciMSPEL_FILTER13_HOR_16B(shift1, "2*3(%1)", "2*2(%1)", "2*1(%1)", "2*0(%1)", OP_AVG, avg_) 315cabdff1aSopenharmony_ci 316cabdff1aSopenharmony_ci/** 3/4 shift bicubic interpolation */ 317cabdff1aSopenharmony_ciMSPEL_FILTER13_8B (shift3, "0(%1 )", "0(%1,%3 )", "0(%1,%3,2)", "0(%1,%4 )", OP_PUT, put_) 318cabdff1aSopenharmony_ciMSPEL_FILTER13_8B (shift3, "0(%1 )", "0(%1,%3 )", "0(%1,%3,2)", "0(%1,%4 )", OP_AVG, avg_) 319cabdff1aSopenharmony_ciMSPEL_FILTER13_VER_16B(shift3, "0(%1 )", "0(%1,%3 )", "0(%1,%3,2)", "0(%1,%4 )") 320cabdff1aSopenharmony_ciMSPEL_FILTER13_HOR_16B(shift3, "2*0(%1)", "2*1(%1)", "2*2(%1)", "2*3(%1)", OP_PUT, put_) 321cabdff1aSopenharmony_ciMSPEL_FILTER13_HOR_16B(shift3, "2*0(%1)", "2*1(%1)", "2*2(%1)", "2*3(%1)", OP_AVG, avg_) 322cabdff1aSopenharmony_ci 323cabdff1aSopenharmony_citypedef void (*vc1_mspel_mc_filter_ver_16bits)(int16_t *dst, const uint8_t *src, x86_reg src_stride, int rnd, int64_t shift); 324cabdff1aSopenharmony_citypedef void (*vc1_mspel_mc_filter_hor_16bits)(uint8_t *dst, x86_reg dst_stride, const int16_t *src, int rnd); 325cabdff1aSopenharmony_citypedef void (*vc1_mspel_mc_filter_8bits)(uint8_t *dst, const uint8_t *src, x86_reg stride, int rnd, x86_reg offset); 326cabdff1aSopenharmony_ci 327cabdff1aSopenharmony_ci/** 328cabdff1aSopenharmony_ci * Interpolate fractional pel values by applying proper vertical then 329cabdff1aSopenharmony_ci * horizontal filter. 330cabdff1aSopenharmony_ci * 331cabdff1aSopenharmony_ci * @param dst Destination buffer for interpolated pels. 332cabdff1aSopenharmony_ci * @param src Source buffer. 333cabdff1aSopenharmony_ci * @param stride Stride for both src and dst buffers. 334cabdff1aSopenharmony_ci * @param hmode Horizontal filter (expressed in quarter pixels shift). 335cabdff1aSopenharmony_ci * @param hmode Vertical filter. 336cabdff1aSopenharmony_ci * @param rnd Rounding bias. 337cabdff1aSopenharmony_ci */ 338cabdff1aSopenharmony_ci#define VC1_MSPEL_MC(OP, INSTR)\ 339cabdff1aSopenharmony_cistatic void OP ## vc1_mspel_mc(uint8_t *dst, const uint8_t *src, int stride,\ 340cabdff1aSopenharmony_ci int hmode, int vmode, int rnd)\ 341cabdff1aSopenharmony_ci{\ 342cabdff1aSopenharmony_ci static const vc1_mspel_mc_filter_ver_16bits vc1_put_shift_ver_16bits[] =\ 343cabdff1aSopenharmony_ci { NULL, vc1_put_ver_16b_shift1_mmx, ff_vc1_put_ver_16b_shift2_mmx, vc1_put_ver_16b_shift3_mmx };\ 344cabdff1aSopenharmony_ci static const vc1_mspel_mc_filter_hor_16bits vc1_put_shift_hor_16bits[] =\ 345cabdff1aSopenharmony_ci { NULL, OP ## vc1_hor_16b_shift1_mmx, ff_vc1_ ## OP ## hor_16b_shift2_ ## INSTR, OP ## vc1_hor_16b_shift3_mmx };\ 346cabdff1aSopenharmony_ci static const vc1_mspel_mc_filter_8bits vc1_put_shift_8bits[] =\ 347cabdff1aSopenharmony_ci { NULL, OP ## vc1_shift1_mmx, OP ## vc1_shift2_mmx, OP ## vc1_shift3_mmx };\ 348cabdff1aSopenharmony_ci\ 349cabdff1aSopenharmony_ci __asm__ volatile(\ 350cabdff1aSopenharmony_ci "pxor %%mm0, %%mm0 \n\t"\ 351cabdff1aSopenharmony_ci ::: "memory"\ 352cabdff1aSopenharmony_ci );\ 353cabdff1aSopenharmony_ci\ 354cabdff1aSopenharmony_ci if (vmode) { /* Vertical filter to apply */\ 355cabdff1aSopenharmony_ci if (hmode) { /* Horizontal filter to apply, output to tmp */\ 356cabdff1aSopenharmony_ci static const int shift_value[] = { 0, 5, 1, 5 };\ 357cabdff1aSopenharmony_ci int shift = (shift_value[hmode]+shift_value[vmode])>>1;\ 358cabdff1aSopenharmony_ci int r;\ 359cabdff1aSopenharmony_ci LOCAL_ALIGNED(16, int16_t, tmp, [12*8]);\ 360cabdff1aSopenharmony_ci\ 361cabdff1aSopenharmony_ci r = (1<<(shift-1)) + rnd-1;\ 362cabdff1aSopenharmony_ci vc1_put_shift_ver_16bits[vmode](tmp, src-1, stride, r, shift);\ 363cabdff1aSopenharmony_ci\ 364cabdff1aSopenharmony_ci vc1_put_shift_hor_16bits[hmode](dst, stride, tmp+1, 64-rnd);\ 365cabdff1aSopenharmony_ci return;\ 366cabdff1aSopenharmony_ci }\ 367cabdff1aSopenharmony_ci else { /* No horizontal filter, output 8 lines to dst */\ 368cabdff1aSopenharmony_ci vc1_put_shift_8bits[vmode](dst, src, stride, 1-rnd, stride);\ 369cabdff1aSopenharmony_ci return;\ 370cabdff1aSopenharmony_ci }\ 371cabdff1aSopenharmony_ci }\ 372cabdff1aSopenharmony_ci\ 373cabdff1aSopenharmony_ci /* Horizontal mode with no vertical mode */\ 374cabdff1aSopenharmony_ci vc1_put_shift_8bits[hmode](dst, src, stride, rnd, 1);\ 375cabdff1aSopenharmony_ci} \ 376cabdff1aSopenharmony_cistatic void OP ## vc1_mspel_mc_16(uint8_t *dst, const uint8_t *src, \ 377cabdff1aSopenharmony_ci int stride, int hmode, int vmode, int rnd)\ 378cabdff1aSopenharmony_ci{ \ 379cabdff1aSopenharmony_ci OP ## vc1_mspel_mc(dst + 0, src + 0, stride, hmode, vmode, rnd); \ 380cabdff1aSopenharmony_ci OP ## vc1_mspel_mc(dst + 8, src + 8, stride, hmode, vmode, rnd); \ 381cabdff1aSopenharmony_ci dst += 8*stride; src += 8*stride; \ 382cabdff1aSopenharmony_ci OP ## vc1_mspel_mc(dst + 0, src + 0, stride, hmode, vmode, rnd); \ 383cabdff1aSopenharmony_ci OP ## vc1_mspel_mc(dst + 8, src + 8, stride, hmode, vmode, rnd); \ 384cabdff1aSopenharmony_ci} 385cabdff1aSopenharmony_ci 386cabdff1aSopenharmony_ciVC1_MSPEL_MC(put_, mmx) 387cabdff1aSopenharmony_ciVC1_MSPEL_MC(avg_, mmxext) 388cabdff1aSopenharmony_ci 389cabdff1aSopenharmony_ci/** Macro to ease bicubic filter interpolation functions declarations */ 390cabdff1aSopenharmony_ci#define DECLARE_FUNCTION(a, b) \ 391cabdff1aSopenharmony_cistatic void put_vc1_mspel_mc ## a ## b ## _mmx(uint8_t *dst, \ 392cabdff1aSopenharmony_ci const uint8_t *src, \ 393cabdff1aSopenharmony_ci ptrdiff_t stride, \ 394cabdff1aSopenharmony_ci int rnd) \ 395cabdff1aSopenharmony_ci{ \ 396cabdff1aSopenharmony_ci put_vc1_mspel_mc(dst, src, stride, a, b, rnd); \ 397cabdff1aSopenharmony_ci}\ 398cabdff1aSopenharmony_cistatic void avg_vc1_mspel_mc ## a ## b ## _mmxext(uint8_t *dst, \ 399cabdff1aSopenharmony_ci const uint8_t *src, \ 400cabdff1aSopenharmony_ci ptrdiff_t stride, \ 401cabdff1aSopenharmony_ci int rnd) \ 402cabdff1aSopenharmony_ci{ \ 403cabdff1aSopenharmony_ci avg_vc1_mspel_mc(dst, src, stride, a, b, rnd); \ 404cabdff1aSopenharmony_ci}\ 405cabdff1aSopenharmony_cistatic void put_vc1_mspel_mc ## a ## b ## _16_mmx(uint8_t *dst, \ 406cabdff1aSopenharmony_ci const uint8_t *src, \ 407cabdff1aSopenharmony_ci ptrdiff_t stride, \ 408cabdff1aSopenharmony_ci int rnd) \ 409cabdff1aSopenharmony_ci{ \ 410cabdff1aSopenharmony_ci put_vc1_mspel_mc_16(dst, src, stride, a, b, rnd); \ 411cabdff1aSopenharmony_ci}\ 412cabdff1aSopenharmony_cistatic void avg_vc1_mspel_mc ## a ## b ## _16_mmxext(uint8_t *dst, \ 413cabdff1aSopenharmony_ci const uint8_t *src,\ 414cabdff1aSopenharmony_ci ptrdiff_t stride, \ 415cabdff1aSopenharmony_ci int rnd) \ 416cabdff1aSopenharmony_ci{ \ 417cabdff1aSopenharmony_ci avg_vc1_mspel_mc_16(dst, src, stride, a, b, rnd); \ 418cabdff1aSopenharmony_ci} 419cabdff1aSopenharmony_ci 420cabdff1aSopenharmony_ciDECLARE_FUNCTION(0, 1) 421cabdff1aSopenharmony_ciDECLARE_FUNCTION(0, 2) 422cabdff1aSopenharmony_ciDECLARE_FUNCTION(0, 3) 423cabdff1aSopenharmony_ci 424cabdff1aSopenharmony_ciDECLARE_FUNCTION(1, 0) 425cabdff1aSopenharmony_ciDECLARE_FUNCTION(1, 1) 426cabdff1aSopenharmony_ciDECLARE_FUNCTION(1, 2) 427cabdff1aSopenharmony_ciDECLARE_FUNCTION(1, 3) 428cabdff1aSopenharmony_ci 429cabdff1aSopenharmony_ciDECLARE_FUNCTION(2, 0) 430cabdff1aSopenharmony_ciDECLARE_FUNCTION(2, 1) 431cabdff1aSopenharmony_ciDECLARE_FUNCTION(2, 2) 432cabdff1aSopenharmony_ciDECLARE_FUNCTION(2, 3) 433cabdff1aSopenharmony_ci 434cabdff1aSopenharmony_ciDECLARE_FUNCTION(3, 0) 435cabdff1aSopenharmony_ciDECLARE_FUNCTION(3, 1) 436cabdff1aSopenharmony_ciDECLARE_FUNCTION(3, 2) 437cabdff1aSopenharmony_ciDECLARE_FUNCTION(3, 3) 438cabdff1aSopenharmony_ci 439cabdff1aSopenharmony_ci#define FN_ASSIGN(OP, X, Y, INSN) \ 440cabdff1aSopenharmony_ci dsp->OP##vc1_mspel_pixels_tab[1][X+4*Y] = OP##vc1_mspel_mc##X##Y##INSN; \ 441cabdff1aSopenharmony_ci dsp->OP##vc1_mspel_pixels_tab[0][X+4*Y] = OP##vc1_mspel_mc##X##Y##_16##INSN 442cabdff1aSopenharmony_ci 443cabdff1aSopenharmony_ciav_cold void ff_vc1dsp_init_mmx(VC1DSPContext *dsp) 444cabdff1aSopenharmony_ci{ 445cabdff1aSopenharmony_ci FN_ASSIGN(put_, 0, 1, _mmx); 446cabdff1aSopenharmony_ci FN_ASSIGN(put_, 0, 2, _mmx); 447cabdff1aSopenharmony_ci FN_ASSIGN(put_, 0, 3, _mmx); 448cabdff1aSopenharmony_ci 449cabdff1aSopenharmony_ci FN_ASSIGN(put_, 1, 0, _mmx); 450cabdff1aSopenharmony_ci FN_ASSIGN(put_, 1, 1, _mmx); 451cabdff1aSopenharmony_ci FN_ASSIGN(put_, 1, 2, _mmx); 452cabdff1aSopenharmony_ci FN_ASSIGN(put_, 1, 3, _mmx); 453cabdff1aSopenharmony_ci 454cabdff1aSopenharmony_ci FN_ASSIGN(put_, 2, 0, _mmx); 455cabdff1aSopenharmony_ci FN_ASSIGN(put_, 2, 1, _mmx); 456cabdff1aSopenharmony_ci FN_ASSIGN(put_, 2, 2, _mmx); 457cabdff1aSopenharmony_ci FN_ASSIGN(put_, 2, 3, _mmx); 458cabdff1aSopenharmony_ci 459cabdff1aSopenharmony_ci FN_ASSIGN(put_, 3, 0, _mmx); 460cabdff1aSopenharmony_ci FN_ASSIGN(put_, 3, 1, _mmx); 461cabdff1aSopenharmony_ci FN_ASSIGN(put_, 3, 2, _mmx); 462cabdff1aSopenharmony_ci FN_ASSIGN(put_, 3, 3, _mmx); 463cabdff1aSopenharmony_ci} 464cabdff1aSopenharmony_ci 465cabdff1aSopenharmony_ciav_cold void ff_vc1dsp_init_mmxext(VC1DSPContext *dsp) 466cabdff1aSopenharmony_ci{ 467cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 0, 1, _mmxext); 468cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 0, 2, _mmxext); 469cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 0, 3, _mmxext); 470cabdff1aSopenharmony_ci 471cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 1, 0, _mmxext); 472cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 1, 1, _mmxext); 473cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 1, 2, _mmxext); 474cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 1, 3, _mmxext); 475cabdff1aSopenharmony_ci 476cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 2, 0, _mmxext); 477cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 2, 1, _mmxext); 478cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 2, 2, _mmxext); 479cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 2, 3, _mmxext); 480cabdff1aSopenharmony_ci 481cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 3, 0, _mmxext); 482cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 3, 1, _mmxext); 483cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 3, 2, _mmxext); 484cabdff1aSopenharmony_ci FN_ASSIGN(avg_, 3, 3, _mmxext); 485cabdff1aSopenharmony_ci} 486cabdff1aSopenharmony_ci#endif /* HAVE_6REGS && HAVE_INLINE_ASM && HAVE_MMX_EXTERNAL */ 487