Debian Codegraph @

modules/lsp-dsp-lib/include/private/dsp/arch/x86/avx512/pmath/op_kx.h

raw
1 /*
2 * Copyright (C) 2023 Linux Studio Plugins Project <https://lsp-plug.in/>
3 * (C) 2023 Vladimir Sadovnikov <[email protected]>
4 *
5 * This file is part of lsp-dsp-lib
6 * Created on: 28 окт. 2023 г.
7 *
8 * lsp-dsp-lib is free software: you can redistribute it and/or modify
9 * it under the terms of the GNU Lesser General Public License as published by
10 * the Free Software Foundation, either version 3 of the License, or
11 * any later version.
12 *
13 * lsp-dsp-lib is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU Lesser General Public License for more details.
17 *
18 * You should have received a copy of the GNU Lesser General Public License
19 * along with lsp-dsp-lib. If not, see <https://www.gnu.org/licenses/>.
20 */
21
22 #ifndef PRIVATE_DSP_ARCH_X86_AVX512_PMATH_OP_KX_H_
23 #define PRIVATE_DSP_ARCH_X86_AVX512_PMATH_OP_KX_H_
24
25 #ifndef PRIVATE_DSP_ARCH_X86_AVX512_IMPL
26 #error "This header should not be included directly"
27 #endif /* PRIVATE_DSP_ARCH_X86_AVX512_IMPL */
28
29 namespace lsp
30 {
31 namespace avx512
32 {
33 #define OP_DSEL(a, b) a
34 #define OP_RSEL(a, b) b
35
36 #define OP_K4_CORE(DST, SRC, OP, SEL) \
37 __ASM_EMIT("vbroadcastss %[k], %%zmm0") \
38 __ASM_EMIT("xor %[off], %[off]") \
39 __ASM_EMIT("vmovaps %%zmm0, %%zmm1") \
40 /* 64x blocks */ \
41 __ASM_EMIT("sub $64, %[count]") \
42 __ASM_EMIT("jb 2f") \
43 __ASM_EMIT("1:") \
44 __ASM_EMIT(SEL("", "vmovups 0x000(%[" SRC "], %[off]), %%zmm4")) \
45 __ASM_EMIT(SEL("", "vmovups 0x040(%[" SRC "], %[off]), %%zmm5")) \
46 __ASM_EMIT(SEL("", "vmovups 0x080(%[" SRC "], %[off]), %%zmm6")) \
47 __ASM_EMIT(SEL("", "vmovups 0x0c0(%[" SRC "], %[off]), %%zmm7")) \
48 __ASM_EMIT(OP "ps " SEL("0x000(%[" SRC "], %[off])", "%%zmm0") ", " SEL("%%zmm0", "%%zmm4") ", %%zmm4") \
49 __ASM_EMIT(OP "ps " SEL("0x040(%[" SRC "], %[off])", "%%zmm1") ", " SEL("%%zmm1", "%%zmm5") ", %%zmm5") \
50 __ASM_EMIT(OP "ps " SEL("0x080(%[" SRC "], %[off])", "%%zmm0") ", " SEL("%%zmm0", "%%zmm6") ", %%zmm6") \
51 __ASM_EMIT(OP "ps " SEL("0x0c0(%[" SRC "], %[off])", "%%zmm1") ", " SEL("%%zmm1", "%%zmm7") ", %%zmm7") \
52 __ASM_EMIT("vmovups %%zmm4, 0x000(%[" DST "], %[off])") \
53 __ASM_EMIT("vmovups %%zmm5, 0x040(%[" DST "], %[off])") \
54 __ASM_EMIT("vmovups %%zmm6, 0x080(%[" DST "], %[off])") \
55 __ASM_EMIT("vmovups %%zmm7, 0x0c0(%[" DST "], %[off])") \
56 __ASM_EMIT("add $0x100, %[off]") \
57 __ASM_EMIT("sub $64, %[count]") \
58 __ASM_EMIT("jae 1b") \
59 __ASM_EMIT("2:") \
60 /* 32x blocks */ \
61 __ASM_EMIT("add $32, %[count]") \
62 __ASM_EMIT("jl 4f") \
63 __ASM_EMIT(SEL("", "vmovups 0x000(%[" SRC "], %[off]), %%ymm4")) \
64 __ASM_EMIT(SEL("", "vmovups 0x020(%[" SRC "], %[off]), %%ymm5")) \
65 __ASM_EMIT(SEL("", "vmovups 0x040(%[" SRC "], %[off]), %%ymm6")) \
66 __ASM_EMIT(SEL("", "vmovups 0x060(%[" SRC "], %[off]), %%ymm7")) \
67 __ASM_EMIT(OP "ps " SEL("0x000(%[" SRC "], %[off])", "%%ymm0") ", " SEL("%%ymm0", "%%ymm4") ", %%ymm4") \
68 __ASM_EMIT(OP "ps " SEL("0x020(%[" SRC "], %[off])", "%%ymm1") ", " SEL("%%ymm1", "%%ymm5") ", %%ymm5") \
69 __ASM_EMIT(OP "ps " SEL("0x040(%[" SRC "], %[off])", "%%ymm0") ", " SEL("%%ymm0", "%%ymm6") ", %%ymm6") \
70 __ASM_EMIT(OP "ps " SEL("0x060(%[" SRC "], %[off])", "%%ymm1") ", " SEL("%%ymm1", "%%ymm7") ", %%ymm7") \
71 __ASM_EMIT("vmovups %%ymm4, 0x000(%[" DST "], %[off])") \
72 __ASM_EMIT("vmovups %%ymm5, 0x020(%[" DST "], %[off])") \
73 __ASM_EMIT("vmovups %%ymm6, 0x040(%[" DST "], %[off])") \
74 __ASM_EMIT("vmovups %%ymm7, 0x060(%[" DST "], %[off])") \
75 __ASM_EMIT("sub $32, %[count]") \
76 __ASM_EMIT("add $0x80, %[off]") \
77 __ASM_EMIT("4:") \
78 /* 16x block */ \
79 __ASM_EMIT("add $16, %[count]") /* 32 - 16 */ \
80 __ASM_EMIT("jl 6f") \
81 __ASM_EMIT(SEL("", "vmovups 0x000(%[" SRC "], %[off]), %%ymm4")) \
82 __ASM_EMIT(SEL("", "vmovups 0x020(%[" SRC "], %[off]), %%ymm5")) \
83 __ASM_EMIT(OP "ps " SEL("0x000(%[" SRC "], %[off])", "%%ymm0") ", " SEL("%%ymm0", "%%ymm4") ", %%ymm4") \
84 __ASM_EMIT(OP "ps " SEL("0x020(%[" SRC "], %[off])", "%%ymm1") ", " SEL("%%ymm1", "%%ymm5") ", %%ymm5") \
85 __ASM_EMIT("vmovups %%ymm4, 0x000(%[" DST "], %[off])") \
86 __ASM_EMIT("vmovups %%ymm5, 0x020(%[" DST "], %[off])") \
87 __ASM_EMIT("sub $16, %[count]") \
88 __ASM_EMIT("add $0x40, %[off]") \
89 __ASM_EMIT("6:") \
90 /* 8x block */ \
91 __ASM_EMIT("add $8, %[count]") /* 16 - 8 */ \
92 __ASM_EMIT("jl 8f") \
93 __ASM_EMIT(SEL("", "vmovups 0x000(%[" SRC "], %[off]), %%ymm4")) \
94 __ASM_EMIT(OP "ps " SEL("0x000(%[" SRC "], %[off])", "%%ymm0") ", " SEL("%%ymm0", "%%ymm4") ", %%ymm4") \
95 __ASM_EMIT("vmovups %%ymm4, 0x000(%[" DST "], %[off])") \
96 __ASM_EMIT("sub $8, %[count]") \
97 __ASM_EMIT("add $0x20, %[off]") \
98 __ASM_EMIT("8:") \
99 /* 4x block */ \
100 __ASM_EMIT("add $4, %[count]") /* 8 - 4 */ \
101 __ASM_EMIT("jl 10f") \
102 __ASM_EMIT(SEL("", "vmovups 0x000(%[" SRC "], %[off]), %%xmm4")) \
103 __ASM_EMIT(OP "ps " SEL("0x000(%[" SRC "], %[off])", "%%xmm0") ", " SEL("%%xmm0", "%%xmm4") ", %%xmm4") \
104 __ASM_EMIT("vmovups %%xmm4, 0x000(%[" DST "], %[off])") \
105 __ASM_EMIT("sub $4, %[count]") \
106 __ASM_EMIT("add $0x10, %[off]") \
107 __ASM_EMIT("10:") \
108 /* 1x blocks */ \
109 __ASM_EMIT("add $3, %[count]") /* 8 - 4 */ \
110 __ASM_EMIT("jl 12f") \
111 __ASM_EMIT("11:") \
112 __ASM_EMIT(SEL("", "vmovss 0x000(%[" SRC "], %[off]), %%xmm4")) \
113 __ASM_EMIT(OP "ss " SEL("0x000(%[" SRC "], %[off])", "%%xmm0") ", " SEL("%%xmm0", "%%xmm4") ", %%xmm4") \
114 __ASM_EMIT("vmovss %%xmm4, 0x000(%[" DST "], %[off])") \
115 __ASM_EMIT("add $0x04, %[off]") \
116 __ASM_EMIT("dec %[count]") \
117 __ASM_EMIT("jge 11b") \
118 __ASM_EMIT("12:")
119
120 void add_k2(float *dst, float k, size_t count)
121 {
122 IF_ARCH_X86(size_t off);
123 ARCH_X86_ASM
124 (
125 OP_K4_CORE("dst", "dst", "vadd", OP_DSEL)
126 : [count] "+r" (count), [off] "=&r" (off),
127 [k] "+Yz" (k)
128 : [dst] "r" (dst)
129 : "cc", "memory",
130 "%xmm1",
131 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
132 );
133 }
134
135 void sub_k2(float *dst, float k, size_t count)
136 {
137 IF_ARCH_X86(size_t off);
138 ARCH_X86_ASM
139 (
140 OP_K4_CORE("dst", "dst", "vsub", OP_RSEL)
141 : [count] "+r" (count), [off] "=&r" (off),
142 [k] "+Yz" (k)
143 : [dst] "r" (dst)
144 : "cc", "memory",
145 "%xmm1",
146 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
147 );
148 }
149
150 void rsub_k2(float *dst, float k, size_t count)
151 {
152 IF_ARCH_X86(size_t off);
153 ARCH_X86_ASM
154 (
155 OP_K4_CORE("dst", "dst", "vsub", OP_DSEL)
156 : [count] "+r" (count), [off] "=&r" (off),
157 [k] "+Yz" (k)
158 : [dst] "r" (dst)
159 : "cc", "memory",
160 "%xmm1",
161 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
162 );
163 }
164
165 void mul_k2(float *dst, float k, size_t count)
166 {
167 IF_ARCH_X86(size_t off);
168 ARCH_X86_ASM
169 (
170 OP_K4_CORE("dst", "dst", "vmul", OP_DSEL)
171 : [count] "+r" (count), [off] "=&r" (off),
172 [k] "+Yz" (k)
173 : [dst] "r" (dst)
174 : "cc", "memory",
175 "%xmm1",
176 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
177 );
178 }
179
180 void div_k2(float *dst, float k, size_t count)
181 {
182 mul_k2(dst, 1.0f/k, count);
183 }
184
185 void rdiv_k2(float *dst, float k, size_t count)
186 {
187 IF_ARCH_X86(size_t off);
188 ARCH_X86_ASM
189 (
190 OP_K4_CORE("dst", "dst", "vdiv", OP_DSEL)
191 : [count] "+r" (count), [off] "=&r" (off),
192 [k] "+Yz" (k)
193 : [dst] "r" (dst)
194 : "cc", "memory",
195 "%xmm1",
196 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
197 );
198 }
199
200 void add_k3(float *dst, const float *src, float k, size_t count)
201 {
202 IF_ARCH_X86(size_t off);
203 ARCH_X86_ASM
204 (
205 OP_K4_CORE("dst", "src", "vadd", OP_DSEL)
206 : [count] "+r" (count), [off] "=&r" (off),
207 [k] "+Yz" (k)
208 : [src] "r" (src), [dst] "r" (dst)
209 : "cc", "memory",
210 "%xmm1",
211 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
212 );
213 }
214
215 void sub_k3(float *dst, const float *src, float k, size_t count)
216 {
217 IF_ARCH_X86(size_t off);
218 ARCH_X86_ASM
219 (
220 OP_K4_CORE("dst", "src", "vsub", OP_RSEL)
221 : [count] "+r" (count), [off] "=&r" (off),
222 [k] "+Yz" (k)
223 : [src] "r" (src), [dst] "r" (dst)
224 : "cc", "memory",
225 "%xmm1",
226 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
227 );
228 }
229
230 void rsub_k3(float *dst, const float *src, float k, size_t count)
231 {
232 IF_ARCH_X86(size_t off);
233 ARCH_X86_ASM
234 (
235 OP_K4_CORE("dst", "src", "vsub", OP_DSEL)
236 : [count] "+r" (count), [off] "=&r" (off),
237 [k] "+Yz" (k)
238 : [src] "r" (src), [dst] "r" (dst)
239 : "cc", "memory",
240 "%xmm1",
241 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
242 );
243 }
244
245 void mul_k3(float *dst, const float *src, float k, size_t count)
246 {
247 IF_ARCH_X86(size_t off);
248 ARCH_X86_ASM
249 (
250 OP_K4_CORE("dst", "src", "vmul", OP_DSEL)
251 : [count] "+r" (count), [off] "=&r" (off),
252 [k] "+Yz" (k)
253 : [src] "r" (src), [dst] "r" (dst)
254 : "cc", "memory",
255 "%xmm1",
256 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
257 );
258 }
259
260 void div_k3(float *dst, const float *src, float k, size_t count)
261 {
262 mul_k3(dst, src, 1.0f/k, count);
263 }
264
265 void rdiv_k3(float *dst, const float *src, float k, size_t count)
266 {
267 IF_ARCH_X86(size_t off);
268 ARCH_X86_ASM
269 (
270 OP_K4_CORE("dst", "src", "vdiv", OP_DSEL)
271 : [count] "+r" (count), [off] "=&r" (off),
272 [k] "+Yz" (k)
273 : [src] "r" (src), [dst] "r" (dst)
274 : "cc", "memory",
275 "%xmm1",
276 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
277 );
278 }
279
280 #undef OP_K4_CORE
281 #undef OP_DSEL
282 #undef OP_RSEL
283
284 #define FMOD_KX_CORE(DST, SRC) \
285 __ASM_EMIT("vbroadcastss %[k], %%zmm0") \
286 __ASM_EMIT("xor %[off], %[off]") \
287 __ASM_EMIT("vmovaps %%zmm0, %%zmm1") \
288 /* x32 blocks */ \
289 __ASM_EMIT("sub $32, %[count]") \
290 __ASM_EMIT("jb 2f") \
291 __ASM_EMIT("1:") \
292 __ASM_EMIT("vmovups 0x00(%[" SRC "], %[off]), %%zmm2") \
293 __ASM_EMIT("vmovups 0x40(%[" SRC "], %[off]), %%zmm3") \
294 __ASM_EMIT("vdivps %%zmm0, %%zmm2, %%zmm4") \
295 __ASM_EMIT("vdivps %%zmm1, %%zmm3, %%zmm5") \
296 __ASM_EMIT("vcvttps2dq %%zmm4, %%zmm4") \
297 __ASM_EMIT("vcvttps2dq %%zmm5, %%zmm5") \
298 __ASM_EMIT("vcvtdq2ps %%zmm4, %%zmm4") \
299 __ASM_EMIT("vcvtdq2ps %%zmm5, %%zmm5") \
300 __ASM_EMIT("vfnmadd231ps %%zmm0, %%zmm4, %%zmm2") \
301 __ASM_EMIT("vfnmadd231ps %%zmm1, %%zmm5, %%zmm3") \
302 __ASM_EMIT("vmovups %%zmm2, 0x00(%[" DST "], %[off])") \
303 __ASM_EMIT("vmovups %%zmm3, 0x40(%[" DST "], %[off])") \
304 __ASM_EMIT("add $0x80, %[off]") \
305 __ASM_EMIT("sub $32, %[count]") \
306 __ASM_EMIT("jae 1b") \
307 __ASM_EMIT("2:") \
308 /* x16 blocks */ \
309 __ASM_EMIT("add $16, %[count]") \
310 __ASM_EMIT("jl 4f") \
311 __ASM_EMIT("vmovups 0x00(%[" SRC "], %[off]), %%ymm2") \
312 __ASM_EMIT("vmovups 0x20(%[" SRC "], %[off]), %%ymm3") \
313 __ASM_EMIT("vdivps %%ymm0, %%ymm2, %%ymm4") \
314 __ASM_EMIT("vdivps %%ymm1, %%ymm3, %%ymm5") \
315 __ASM_EMIT("vcvttps2dq %%ymm4, %%ymm4") \
316 __ASM_EMIT("vcvttps2dq %%ymm5, %%ymm5") \
317 __ASM_EMIT("vcvtdq2ps %%ymm4, %%ymm4") \
318 __ASM_EMIT("vcvtdq2ps %%ymm5, %%ymm5") \
319 __ASM_EMIT("vfnmadd231ps %%ymm0, %%ymm4, %%ymm2") \
320 __ASM_EMIT("vfnmadd231ps %%ymm1, %%ymm5, %%ymm3") \
321 __ASM_EMIT("vmovups %%ymm2, 0x00(%[" DST "], %[off])") \
322 __ASM_EMIT("vmovups %%ymm3, 0x20(%[" DST "], %[off])") \
323 __ASM_EMIT("sub $16, %[count]") \
324 __ASM_EMIT("add $0x40, %[off]") \
325 __ASM_EMIT("4:") \
326 /* x8 block */ \
327 __ASM_EMIT("add $8, %[count]") \
328 __ASM_EMIT("jl 6f") \
329 __ASM_EMIT("vmovups 0x00(%[" SRC "], %[off]), %%xmm2") \
330 __ASM_EMIT("vmovups 0x10(%[" SRC "], %[off]), %%xmm3") \
331 __ASM_EMIT("vdivps %%xmm0, %%xmm2, %%xmm4") \
332 __ASM_EMIT("vdivps %%xmm1, %%xmm3, %%xmm5") \
333 __ASM_EMIT("vcvttps2dq %%xmm4, %%xmm4") \
334 __ASM_EMIT("vcvttps2dq %%xmm5, %%xmm5") \
335 __ASM_EMIT("vcvtdq2ps %%xmm4, %%xmm4") \
336 __ASM_EMIT("vcvtdq2ps %%xmm5, %%xmm5") \
337 __ASM_EMIT("vfnmadd231ps %%xmm0, %%xmm4, %%xmm2") \
338 __ASM_EMIT("vfnmadd231ps %%xmm1, %%xmm5, %%xmm3") \
339 __ASM_EMIT("vmovups %%xmm2, 0x00(%[" DST "], %[off])") \
340 __ASM_EMIT("vmovups %%xmm3, 0x10(%[" DST "], %[off])") \
341 __ASM_EMIT("sub $8, %[count]") \
342 __ASM_EMIT("add $0x20, %[off]") \
343 __ASM_EMIT("6:") \
344 /* x4 block */ \
345 __ASM_EMIT("add $4, %[count]") \
346 __ASM_EMIT("jl 8f") \
347 __ASM_EMIT("vmovups 0x00(%[" SRC "], %[off]), %%xmm2") \
348 __ASM_EMIT("vdivps %%xmm0, %%xmm2, %%xmm4") \
349 __ASM_EMIT("vcvttps2dq %%xmm4, %%xmm4") \
350 __ASM_EMIT("vcvtdq2ps %%xmm4, %%xmm4") \
351 __ASM_EMIT("vfnmadd231ps %%xmm0, %%xmm4, %%xmm2") \
352 __ASM_EMIT("vmovups %%xmm2, 0x00(%[" DST "], %[off])") \
353 __ASM_EMIT("sub $4, %[count]") \
354 __ASM_EMIT("add $0x10, %[off]") \
355 __ASM_EMIT("8:") \
356 /* x1 blocks */ \
357 __ASM_EMIT("add $3, %[count]") \
358 __ASM_EMIT("jl 10f") \
359 __ASM_EMIT("9:") \
360 __ASM_EMIT("vmovss 0x00(%[" SRC "], %[off]), %%xmm2") \
361 __ASM_EMIT("vdivps %%xmm0, %%xmm2, %%xmm4") \
362 __ASM_EMIT("vcvttps2dq %%xmm4, %%xmm4") \
363 __ASM_EMIT("vcvtdq2ps %%xmm4, %%xmm4") \
364 __ASM_EMIT("vfnmadd231ps %%xmm0, %%xmm4, %%xmm2") \
365 __ASM_EMIT("vmovss %%xmm2, 0x00(%[" DST "], %[off])") \
366 __ASM_EMIT("add $0x04, %[off]") \
367 __ASM_EMIT("dec %[count]") \
368 __ASM_EMIT("jge 9b") \
369 __ASM_EMIT("10:")
370
371 void mod_k2(float *dst, float k, size_t count)
372 {
373 IF_ARCH_X86(size_t off);
374 ARCH_X86_ASM
375 (
376 FMOD_KX_CORE("dst", "dst")
377 : [count] "+r" (count), [off] "=&r" (off),
378 [k] "+Yz" (k)
379 : [dst] "r" (dst)
380 : "cc", "memory",
381 "%xmm1", "%xmm2", "%xmm3",
382 "%xmm4", "%xmm5"
383 );
384 }
385
386 void mod_k3(float *dst, const float *src, float k, size_t count)
387 {
388 IF_ARCH_X86(size_t off);
389 ARCH_X86_ASM
390 (
391 FMOD_KX_CORE("dst", "src")
392 : [count] "+r" (count), [off] "=&r" (off),
393 [k] "+Yz" (k)
394 : [src] "r" (src), [dst] "r" (dst)
395 : "cc", "memory",
396 "%xmm1", "%xmm2", "%xmm3",
397 "%xmm4", "%xmm5"
398 );
399 }
400
401 #undef FMOD_KX_CORE
402
403 #define FRMOD_KX_CORE(DST, SRC) \
404 __ASM_EMIT("vbroadcastss %[k], %%zmm0") \
405 __ASM_EMIT("xor %[off], %[off]") \
406 __ASM_EMIT("vmovaps %%zmm0, %%zmm1") \
407 /* x32 blocks */ \
408 __ASM_EMIT("sub $32, %[count]") \
409 __ASM_EMIT("jb 2f") \
410 __ASM_EMIT("1:") \
411 __ASM_EMIT("vmovups 0x00(%[" SRC "], %[off]), %%zmm2") \
412 __ASM_EMIT("vmovups 0x40(%[" SRC "], %[off]), %%zmm3") \
413 __ASM_EMIT("vdivps %%zmm2, %%zmm0, %%zmm4") \
414 __ASM_EMIT("vdivps %%zmm3, %%zmm1, %%zmm5") \
415 __ASM_EMIT("vcvttps2dq %%zmm4, %%zmm4") \
416 __ASM_EMIT("vcvttps2dq %%zmm5, %%zmm5") \
417 __ASM_EMIT("vcvtdq2ps %%zmm4, %%zmm4") \
418 __ASM_EMIT("vcvtdq2ps %%zmm5, %%zmm5") \
419 __ASM_EMIT("vfnmadd132ps %%zmm4, %%zmm0, %%zmm2") \
420 __ASM_EMIT("vfnmadd132ps %%zmm5, %%zmm1, %%zmm3") \
421 __ASM_EMIT("vmovups %%zmm2, 0x00(%[" DST "], %[off])") \
422 __ASM_EMIT("vmovups %%zmm3, 0x40(%[" DST "], %[off])") \
423 __ASM_EMIT("add $0x80, %[off]") \
424 __ASM_EMIT("sub $32, %[count]") \
425 __ASM_EMIT("jae 1b") \
426 __ASM_EMIT("2:") \
427 /* x16 blocks */ \
428 __ASM_EMIT("add $16, %[count]") \
429 __ASM_EMIT("jl 4f") \
430 __ASM_EMIT("vmovups 0x00(%[" SRC "], %[off]), %%ymm2") \
431 __ASM_EMIT("vmovups 0x20(%[" SRC "], %[off]), %%ymm3") \
432 __ASM_EMIT("vdivps %%ymm2, %%ymm0, %%ymm4") \
433 __ASM_EMIT("vdivps %%ymm3, %%ymm1, %%ymm5") \
434 __ASM_EMIT("vcvttps2dq %%ymm4, %%ymm4") \
435 __ASM_EMIT("vcvttps2dq %%ymm5, %%ymm5") \
436 __ASM_EMIT("vcvtdq2ps %%ymm4, %%ymm4") \
437 __ASM_EMIT("vcvtdq2ps %%ymm5, %%ymm5") \
438 __ASM_EMIT("vfnmadd132ps %%ymm4, %%ymm0, %%ymm2") \
439 __ASM_EMIT("vfnmadd132ps %%ymm5, %%ymm1, %%ymm3") \
440 __ASM_EMIT("vmovups %%ymm2, 0x00(%[" DST "], %[off])") \
441 __ASM_EMIT("vmovups %%ymm3, 0x20(%[" DST "], %[off])") \
442 __ASM_EMIT("sub $16, %[count]") \
443 __ASM_EMIT("add $0x40, %[off]") \
444 __ASM_EMIT("4:") \
445 /* x8 block */ \
446 __ASM_EMIT("add $8, %[count]") \
447 __ASM_EMIT("jl 6f") \
448 __ASM_EMIT("vmovups 0x00(%[" SRC "], %[off]), %%xmm2") \
449 __ASM_EMIT("vmovups 0x10(%[" SRC "], %[off]), %%xmm3") \
450 __ASM_EMIT("vdivps %%xmm2, %%xmm0, %%xmm4") \
451 __ASM_EMIT("vdivps %%xmm3, %%xmm1, %%xmm5") \
452 __ASM_EMIT("vcvttps2dq %%xmm4, %%xmm4") \
453 __ASM_EMIT("vcvttps2dq %%xmm5, %%xmm5") \
454 __ASM_EMIT("vcvtdq2ps %%xmm4, %%xmm4") \
455 __ASM_EMIT("vcvtdq2ps %%xmm5, %%xmm5") \
456 __ASM_EMIT("vfnmadd132ps %%xmm4, %%xmm0, %%xmm2") \
457 __ASM_EMIT("vfnmadd132ps %%xmm5, %%xmm1, %%xmm3") \
458 __ASM_EMIT("vmovups %%xmm2, 0x00(%[" DST "], %[off])") \
459 __ASM_EMIT("vmovups %%xmm3, 0x10(%[" DST "], %[off])") \
460 __ASM_EMIT("sub $8, %[count]") \
461 __ASM_EMIT("add $0x20, %[off]") \
462 __ASM_EMIT("6:") \
463 /* x4 block */ \
464 __ASM_EMIT("add $4, %[count]") \
465 __ASM_EMIT("jl 8f") \
466 __ASM_EMIT("vmovups 0x00(%[" SRC "], %[off]), %%xmm2") \
467 __ASM_EMIT("vdivps %%xmm2, %%xmm0, %%xmm4") \
468 __ASM_EMIT("vcvttps2dq %%xmm4, %%xmm4") \
469 __ASM_EMIT("vcvtdq2ps %%xmm4, %%xmm4") \
470 __ASM_EMIT("vfnmadd132ps %%xmm4, %%xmm0, %%xmm2") \
471 __ASM_EMIT("vmovups %%xmm2, 0x00(%[" DST "], %[off])") \
472 __ASM_EMIT("sub $4, %[count]") \
473 __ASM_EMIT("add $0x10, %[off]") \
474 __ASM_EMIT("8:") \
475 /* x1 blocks */ \
476 __ASM_EMIT("add $3, %[count]") \
477 __ASM_EMIT("jl 10f") \
478 __ASM_EMIT("9:") \
479 __ASM_EMIT("vmovss 0x00(%[" SRC "], %[off]), %%xmm2") \
480 __ASM_EMIT("vdivps %%xmm2, %%xmm0, %%xmm4") \
481 __ASM_EMIT("vcvttps2dq %%xmm4, %%xmm4") \
482 __ASM_EMIT("vcvtdq2ps %%xmm4, %%xmm4") \
483 __ASM_EMIT("vfnmadd132ps %%xmm4, %%xmm0, %%xmm2") \
484 __ASM_EMIT("vmovss %%xmm2, 0x00(%[" DST "], %[off])") \
485 __ASM_EMIT("add $0x04, %[off]") \
486 __ASM_EMIT("dec %[count]") \
487 __ASM_EMIT("jge 9b") \
488 __ASM_EMIT("10:")
489
490 void rmod_k2(float *dst, float k, size_t count)
491 {
492 IF_ARCH_X86(size_t off);
493 ARCH_X86_ASM
494 (
495 FRMOD_KX_CORE("dst", "dst")
496 : [count] "+r" (count), [off] "=&r" (off),
497 [k] "+Yz" (k)
498 : [dst] "r" (dst)
499 : "cc", "memory",
500 "%xmm1", "%xmm2", "%xmm3",
501 "%xmm4", "%xmm5"
502 );
503 }
504
505 void rmod_k3(float *dst, const float *src, float k, size_t count)
506 {
507 IF_ARCH_X86(size_t off);
508 ARCH_X86_ASM
509 (
510 FRMOD_KX_CORE("dst", "src")
511 : [count] "+r" (count), [off] "=&r" (off),
512 [k] "+Yz" (k)
513 : [src] "r" (src), [dst] "r" (dst)
514 : "cc", "memory",
515 "%xmm1", "%xmm2", "%xmm3",
516 "%xmm4", "%xmm5"
517 );
518 }
519
520 #undef FRMOD_KX_CORE
521
522 } /* namespace avx512 */
523 } /* namespace lsp */
524
525
526
527
528 #endif /* PRIVATE_DSP_ARCH_X86_AVX512_PMATH_OP_KX_H_ */