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