Debian Codegraph @

modules/lsp-dsp-lib/include/private/dsp/arch/x86/avx512/pmath/fmop_vv.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: 26 окт. 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_FMOP_VV_H_
23 #define PRIVATE_DSP_ARCH_X86_AVX512_PMATH_FMOP_VV_H_
24
25 namespace lsp
26 {
27 namespace avx512
28 {
29 #define OP_DSEL(a, b) a
30 #define OP_RSEL(a, b) b
31
32 #define FMADDSUB_VV_CORE(DST, A, B, C, OP) \
33 __ASM_EMIT("xor %[off], %[off]") \
34 /* 64x blocks */ \
35 __ASM_EMIT("sub $64, %[count]") \
36 __ASM_EMIT("jb 2f") \
37 __ASM_EMIT("1:") \
38 __ASM_EMIT("vmovups 0x000(%[" A "], %[off]), %%zmm0") \
39 __ASM_EMIT("vmovups 0x040(%[" A "], %[off]), %%zmm1") \
40 __ASM_EMIT("vmovups 0x080(%[" A "], %[off]), %%zmm2") \
41 __ASM_EMIT("vmovups 0x0c0(%[" A "], %[off]), %%zmm3") \
42 __ASM_EMIT("vmovups 0x000(%[" B "], %[off]), %%zmm4") \
43 __ASM_EMIT("vmovups 0x040(%[" B "], %[off]), %%zmm5") \
44 __ASM_EMIT("vmovups 0x080(%[" B "], %[off]), %%zmm6") \
45 __ASM_EMIT("vmovups 0x0c0(%[" B "], %[off]), %%zmm7") \
46 __ASM_EMIT(OP "ps 0x000(%[" C "], %[off]), %%zmm4, %%zmm0") \
47 __ASM_EMIT(OP "ps 0x040(%[" C "], %[off]), %%zmm5, %%zmm1") \
48 __ASM_EMIT(OP "ps 0x080(%[" C "], %[off]), %%zmm6, %%zmm2") \
49 __ASM_EMIT(OP "ps 0x0c0(%[" C "], %[off]), %%zmm7, %%zmm3") \
50 __ASM_EMIT("vmovups %%zmm0, 0x000(%[" DST "], %[off])") \
51 __ASM_EMIT("vmovups %%zmm1, 0x040(%[" DST "], %[off])") \
52 __ASM_EMIT("vmovups %%zmm2, 0x080(%[" DST "], %[off])") \
53 __ASM_EMIT("vmovups %%zmm3, 0x0c0(%[" DST "], %[off])") \
54 __ASM_EMIT("add $0x100, %[off]") \
55 __ASM_EMIT("sub $64, %[count]") \
56 __ASM_EMIT("jae 1b") \
57 __ASM_EMIT("2:") \
58 /* 32x blocks */ \
59 __ASM_EMIT("add $32, %[count]") \
60 __ASM_EMIT("jl 4f") \
61 __ASM_EMIT("vmovups 0x000(%[" A "], %[off]), %%ymm0") \
62 __ASM_EMIT("vmovups 0x020(%[" A "], %[off]), %%ymm1") \
63 __ASM_EMIT("vmovups 0x040(%[" A "], %[off]), %%ymm2") \
64 __ASM_EMIT("vmovups 0x060(%[" A "], %[off]), %%ymm3") \
65 __ASM_EMIT("vmovups 0x000(%[" B "], %[off]), %%ymm4") \
66 __ASM_EMIT("vmovups 0x020(%[" B "], %[off]), %%ymm5") \
67 __ASM_EMIT("vmovups 0x040(%[" B "], %[off]), %%ymm6") \
68 __ASM_EMIT("vmovups 0x060(%[" B "], %[off]), %%ymm7") \
69 __ASM_EMIT(OP "ps 0x000(%[" C "], %[off]), %%ymm4, %%ymm0") \
70 __ASM_EMIT(OP "ps 0x020(%[" C "], %[off]), %%ymm5, %%ymm1") \
71 __ASM_EMIT(OP "ps 0x040(%[" C "], %[off]), %%ymm6, %%ymm2") \
72 __ASM_EMIT(OP "ps 0x060(%[" C "], %[off]), %%ymm7, %%ymm3") \
73 __ASM_EMIT("vmovups %%ymm0, 0x000(%[" DST "], %[off])") \
74 __ASM_EMIT("vmovups %%ymm1, 0x020(%[" DST "], %[off])") \
75 __ASM_EMIT("vmovups %%ymm2, 0x040(%[" DST "], %[off])") \
76 __ASM_EMIT("vmovups %%ymm3, 0x060(%[" DST "], %[off])") \
77 __ASM_EMIT("sub $32, %[count]") \
78 __ASM_EMIT("add $0x80, %[off]") \
79 __ASM_EMIT("4:") \
80 /* 16x block */ \
81 __ASM_EMIT("add $16, %[count]") \
82 __ASM_EMIT("jl 6f") \
83 __ASM_EMIT("vmovups 0x000(%[" A "], %[off]), %%ymm0") \
84 __ASM_EMIT("vmovups 0x020(%[" A "], %[off]), %%ymm1") \
85 __ASM_EMIT("vmovups 0x000(%[" B "], %[off]), %%ymm4") \
86 __ASM_EMIT("vmovups 0x020(%[" B "], %[off]), %%ymm5") \
87 __ASM_EMIT(OP "ps 0x000(%[" C "], %[off]), %%ymm4, %%ymm0") \
88 __ASM_EMIT(OP "ps 0x020(%[" C "], %[off]), %%ymm5, %%ymm1") \
89 __ASM_EMIT("vmovups %%ymm0, 0x000(%[" DST "], %[off])") \
90 __ASM_EMIT("vmovups %%ymm1, 0x020(%[" DST "], %[off])") \
91 __ASM_EMIT("add $0x40, %[off]") \
92 __ASM_EMIT("sub $16, %[count]") \
93 __ASM_EMIT("6:") \
94 /* 8x block */ \
95 __ASM_EMIT("add $8, %[count]") \
96 __ASM_EMIT("jl 8f") \
97 __ASM_EMIT("vmovups 0x000(%[" A "], %[off]), %%ymm0") \
98 __ASM_EMIT("vmovups 0x000(%[" B "], %[off]), %%ymm4") \
99 __ASM_EMIT(OP "ps 0x000(%[" C "], %[off]), %%ymm4, %%ymm0") \
100 __ASM_EMIT("vmovups %%ymm0, 0x000(%[" DST "], %[off])") \
101 __ASM_EMIT("add $0x20, %[off]") \
102 __ASM_EMIT("sub $8, %[count]") \
103 __ASM_EMIT("8:") \
104 /* 4x block */ \
105 __ASM_EMIT("add $4, %[count]") \
106 __ASM_EMIT("jl 10f") \
107 __ASM_EMIT("vmovups 0x000(%[" A "], %[off]), %%xmm0") \
108 __ASM_EMIT("vmovups 0x000(%[" B "], %[off]), %%xmm4") \
109 __ASM_EMIT(OP "ps 0x000(%[" C "], %[off]), %%xmm4, %%xmm0") \
110 __ASM_EMIT("vmovups %%xmm0, 0x000(%[" DST "], %[off])") \
111 __ASM_EMIT("add $0x10, %[off]") \
112 __ASM_EMIT("sub $4, %[count]") \
113 __ASM_EMIT("10:") \
114 /* 1x blocks */ \
115 __ASM_EMIT("add $3, %[count]") \
116 __ASM_EMIT("jl 12f") \
117 __ASM_EMIT("11:") \
118 __ASM_EMIT("vmovss 0x000(%[" A "], %[off]), %%xmm0") \
119 __ASM_EMIT("vmovss 0x000(%[" B "], %[off]), %%xmm4") \
120 __ASM_EMIT(OP "ss 0x000(%[" C "], %[off]), %%xmm4, %%xmm0") \
121 __ASM_EMIT("vmovss %%xmm0, 0x000(%[" DST "], %[off])") \
122 __ASM_EMIT("add $0x04, %[off]") \
123 __ASM_EMIT("dec %[count]") \
124 __ASM_EMIT("jge 11b") \
125 __ASM_EMIT("12:")
126
127 void fmadd3(float *dst, const float *a, const float *b, size_t count)
128 {
129 IF_ARCH_X86(size_t off);
130 ARCH_X86_ASM
131 (
132 FMADDSUB_VV_CORE("dst", "dst", "a", "b", "vfmadd231")
133 : [off] "=&r" (off), [count] "+r" (count)
134 : [dst] "r" (dst), [a] "r" (a), [b] "r" (b)
135 : "cc", "memory",
136 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
137 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
138 );
139 }
140
141 void fmsub3(float *dst, const float *a, const float *b, size_t count)
142 {
143 IF_ARCH_X86(size_t off);
144 ARCH_X86_ASM
145 (
146 FMADDSUB_VV_CORE("dst", "dst", "a", "b", "vfnmadd231")
147 : [off] "=&r" (off), [count] "+r" (count)
148 : [dst] "r" (dst), [a] "r" (a), [b] "r" (b)
149 : "cc", "memory",
150 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
151 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
152 );
153 }
154
155 void fmrsub3(float *dst, const float *a, const float *b, size_t count)
156 {
157 IF_ARCH_X86(size_t off);
158 ARCH_X86_ASM
159 (
160 FMADDSUB_VV_CORE("dst", "dst", "a", "b", "vfmsub231")
161 : [off] "=&r" (off), [count] "+r" (count)
162 : [dst] "r" (dst), [a] "r" (a), [b] "r" (b)
163 : "cc", "memory",
164 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
165 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
166 );
167 }
168
169 void fmadd4(float *dst, const float *a, const float *b, const float *c, size_t count)
170 {
171 IF_ARCH_X86(size_t off);
172 ARCH_X86_ASM
173 (
174 FMADDSUB_VV_CORE("dst", "a", "b", "c", "vfmadd231")
175 : [off] "=&r" (off), [count] "+r" (count)
176 : [dst] "r" (dst), [a] "r" (a), [b] "r" (b), [c] "r" (c)
177 : "cc", "memory",
178 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
179 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
180 );
181 }
182
183 void fmsub4(float *dst, const float *a, const float *b, const float *c, size_t count)
184 {
185 IF_ARCH_X86(size_t off);
186 ARCH_X86_ASM
187 (
188 FMADDSUB_VV_CORE("dst", "a", "b", "c", "vfnmadd231")
189 : [off] "=&r" (off), [count] "+r" (count)
190 : [dst] "r" (dst), [a] "r" (a), [b] "r" (b), [c] "r" (c)
191 : "cc", "memory",
192 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
193 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
194 );
195 }
196
197 void fmrsub4(float *dst, const float *a, const float *b, const float *c, size_t count)
198 {
199 IF_ARCH_X86(size_t off);
200 ARCH_X86_ASM
201 (
202 FMADDSUB_VV_CORE("dst", "a", "b", "c", "vfmsub231")
203 : [off] "=&r" (off), [count] "+r" (count)
204 : [dst] "r" (dst), [a] "r" (a), [b] "r" (b), [c] "r" (c)
205 : "cc", "memory",
206 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
207 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
208 );
209 }
210
211 #undef FMADDSUB_VV_CORE
212
213 #define FMOP_VV_CORE(DST, A, B, C, OP, SEL) \
214 __ASM_EMIT("xor %[off], %[off]") \
215 /* 64x blocks */ \
216 __ASM_EMIT("sub $64, %[count]") \
217 __ASM_EMIT("jb 2f") \
218 __ASM_EMIT("1:") \
219 __ASM_EMIT("vmovups 0x000(%[" B "], %[off]), %%zmm4") \
220 __ASM_EMIT("vmovups 0x040(%[" B "], %[off]), %%zmm5") \
221 __ASM_EMIT("vmovups 0x080(%[" B "], %[off]), %%zmm6") \
222 __ASM_EMIT("vmovups 0x0c0(%[" B "], %[off]), %%zmm7") \
223 __ASM_EMIT("vmovups 0x000(%[" A "], %[off]), %%zmm0") \
224 __ASM_EMIT("vmovups 0x040(%[" A "], %[off]), %%zmm1") \
225 __ASM_EMIT("vmovups 0x080(%[" A "], %[off]), %%zmm2") \
226 __ASM_EMIT("vmovups 0x0c0(%[" A "], %[off]), %%zmm3") \
227 __ASM_EMIT("vmulps 0x000(%[" C "], %[off]), %%zmm4, %%zmm4") \
228 __ASM_EMIT("vmulps 0x040(%[" C "], %[off]), %%zmm5, %%zmm5") \
229 __ASM_EMIT("vmulps 0x080(%[" C "], %[off]), %%zmm6, %%zmm6") \
230 __ASM_EMIT("vmulps 0x0c0(%[" C "], %[off]), %%zmm7, %%zmm7") \
231 __ASM_EMIT(OP "ps " SEL("%%zmm4", "%%zmm0") ", " SEL("%%zmm0", "%%zmm4") ", %%zmm0") \
232 __ASM_EMIT(OP "ps " SEL("%%zmm5", "%%zmm1") ", " SEL("%%zmm1", "%%zmm5") ", %%zmm1") \
233 __ASM_EMIT(OP "ps " SEL("%%zmm6", "%%zmm2") ", " SEL("%%zmm2", "%%zmm6") ", %%zmm2") \
234 __ASM_EMIT(OP "ps " SEL("%%zmm7", "%%zmm3") ", " SEL("%%zmm3", "%%zmm7") ", %%zmm3") \
235 __ASM_EMIT("vmovups %%zmm0, 0x000(%[" DST "], %[off])") \
236 __ASM_EMIT("vmovups %%zmm1, 0x040(%[" DST "], %[off])") \
237 __ASM_EMIT("vmovups %%zmm2, 0x080(%[" DST "], %[off])") \
238 __ASM_EMIT("vmovups %%zmm3, 0x0c0(%[" DST "], %[off])") \
239 __ASM_EMIT("add $0x100, %[off]") \
240 __ASM_EMIT("sub $64, %[count]") \
241 __ASM_EMIT("jae 1b") \
242 __ASM_EMIT("2:") \
243 /* 32x blocks */ \
244 __ASM_EMIT("add $32, %[count]") \
245 __ASM_EMIT("jl 4f") \
246 __ASM_EMIT("vmovups 0x000(%[" B "], %[off]), %%ymm4") \
247 __ASM_EMIT("vmovups 0x020(%[" B "], %[off]), %%ymm5") \
248 __ASM_EMIT("vmovups 0x040(%[" B "], %[off]), %%ymm6") \
249 __ASM_EMIT("vmovups 0x060(%[" B "], %[off]), %%ymm7") \
250 __ASM_EMIT("vmovups 0x000(%[" A "], %[off]), %%ymm0") \
251 __ASM_EMIT("vmovups 0x020(%[" A "], %[off]), %%ymm1") \
252 __ASM_EMIT("vmovups 0x040(%[" A "], %[off]), %%ymm2") \
253 __ASM_EMIT("vmovups 0x060(%[" A "], %[off]), %%ymm3") \
254 __ASM_EMIT("vmulps 0x000(%[" C "], %[off]), %%ymm4, %%ymm4") \
255 __ASM_EMIT("vmulps 0x020(%[" C "], %[off]), %%ymm5, %%ymm5") \
256 __ASM_EMIT("vmulps 0x040(%[" C "], %[off]), %%ymm6, %%ymm6") \
257 __ASM_EMIT("vmulps 0x060(%[" C "], %[off]), %%ymm7, %%ymm7") \
258 __ASM_EMIT(OP "ps " SEL("%%ymm4", "%%ymm0") ", " SEL("%%ymm0", "%%ymm4") ", %%ymm0") \
259 __ASM_EMIT(OP "ps " SEL("%%ymm5", "%%ymm1") ", " SEL("%%ymm1", "%%ymm5") ", %%ymm1") \
260 __ASM_EMIT(OP "ps " SEL("%%ymm6", "%%ymm2") ", " SEL("%%ymm2", "%%ymm6") ", %%ymm2") \
261 __ASM_EMIT(OP "ps " SEL("%%ymm7", "%%ymm3") ", " SEL("%%ymm3", "%%ymm7") ", %%ymm3") \
262 __ASM_EMIT("vmovups %%ymm0, 0x000(%[" DST "], %[off])") \
263 __ASM_EMIT("vmovups %%ymm1, 0x020(%[" DST "], %[off])") \
264 __ASM_EMIT("vmovups %%ymm2, 0x040(%[" DST "], %[off])") \
265 __ASM_EMIT("vmovups %%ymm3, 0x060(%[" DST "], %[off])") \
266 __ASM_EMIT("sub $32, %[count]") \
267 __ASM_EMIT("add $0x80, %[off]") \
268 __ASM_EMIT("4:") \
269 /* 16x block */ \
270 __ASM_EMIT("add $16, %[count]") \
271 __ASM_EMIT("jl 6f") \
272 __ASM_EMIT("vmovups 0x000(%[" B "], %[off]), %%ymm4") \
273 __ASM_EMIT("vmovups 0x020(%[" B "], %[off]), %%ymm5") \
274 __ASM_EMIT("vmovups 0x000(%[" A "], %[off]), %%ymm0") \
275 __ASM_EMIT("vmovups 0x020(%[" A "], %[off]), %%ymm1") \
276 __ASM_EMIT("vmulps 0x000(%[" C "], %[off]), %%ymm4, %%ymm4") \
277 __ASM_EMIT("vmulps 0x020(%[" C "], %[off]), %%ymm5, %%ymm5") \
278 __ASM_EMIT(OP "ps " SEL("%%ymm4", "%%ymm0") ", " SEL("%%ymm0", "%%ymm4") ", %%ymm0") \
279 __ASM_EMIT(OP "ps " SEL("%%ymm5", "%%ymm1") ", " SEL("%%ymm1", "%%ymm5") ", %%ymm1") \
280 __ASM_EMIT("vmovups %%ymm0, 0x000(%[" DST "], %[off])") \
281 __ASM_EMIT("vmovups %%ymm1, 0x020(%[" DST "], %[off])") \
282 __ASM_EMIT("add $0x40, %[off]") \
283 __ASM_EMIT("sub $16, %[count]") \
284 __ASM_EMIT("6:") \
285 /* 8x block */ \
286 __ASM_EMIT("add $8, %[count]") \
287 __ASM_EMIT("jl 8f") \
288 __ASM_EMIT("vmovups 0x000(%[" B "], %[off]), %%ymm4") \
289 __ASM_EMIT("vmovups 0x000(%[" A "], %[off]), %%ymm0") \
290 __ASM_EMIT("vmulps 0x000(%[" C "], %[off]), %%ymm4, %%ymm4") \
291 __ASM_EMIT(OP "ps " SEL("%%ymm4", "%%ymm0") ", " SEL("%%ymm0", "%%ymm4") ", %%ymm0") \
292 __ASM_EMIT("vmovups %%ymm0, 0x000(%[" DST "], %[off])") \
293 __ASM_EMIT("add $0x20, %[off]") \
294 __ASM_EMIT("sub $8, %[count]") \
295 __ASM_EMIT("8:") \
296 /* 4x block */ \
297 __ASM_EMIT("add $4, %[count]") \
298 __ASM_EMIT("jl 10f") \
299 __ASM_EMIT("vmovups 0x000(%[" B "], %[off]), %%xmm4") \
300 __ASM_EMIT("vmovups 0x000(%[" A "], %[off]), %%xmm0") \
301 __ASM_EMIT("vmulps 0x000(%[" C "], %[off]), %%xmm4, %%xmm4") \
302 __ASM_EMIT(OP "ps " SEL("%%xmm4", "%%xmm0") ", " SEL("%%xmm0", "%%xmm4") ", %%xmm0") \
303 __ASM_EMIT("vmovups %%xmm0, 0x000(%[" DST "], %[off])") \
304 __ASM_EMIT("add $0x10, %[off]") \
305 __ASM_EMIT("sub $4, %[count]") \
306 __ASM_EMIT("10:") \
307 /* 1x blocks */ \
308 __ASM_EMIT("add $3, %[count]") \
309 __ASM_EMIT("jl 12f") \
310 __ASM_EMIT("11:") \
311 __ASM_EMIT("vmovss 0x000(%[" B "], %[off]), %%xmm4") \
312 __ASM_EMIT("vmovss 0x000(%[" A "], %[off]), %%xmm0") \
313 __ASM_EMIT("vmulss 0x000(%[" C "], %[off]), %%xmm4, %%xmm4") \
314 __ASM_EMIT(OP "ss " SEL("%%xmm4", "%%xmm0") ", " SEL("%%xmm0", "%%xmm4") ", %%xmm0") \
315 __ASM_EMIT("vmovss %%xmm0, 0x000(%[" DST "], %[off])") \
316 __ASM_EMIT("add $0x04, %[off]") \
317 __ASM_EMIT("dec %[count]") \
318 __ASM_EMIT("jge 11b") \
319 __ASM_EMIT("12:")
320
321 void fmmul3(float *dst, const float *a, const float *b, size_t count)
322 {
323 IF_ARCH_X86(size_t off);
324 ARCH_X86_ASM
325 (
326 FMOP_VV_CORE("dst", "dst", "a", "b", "vmul", OP_DSEL)
327 : [off] "=&r" (off), [count] "+r" (count)
328 : [dst] "r"(dst), [a] "r" (a), [b] "r" (b)
329 : "cc", "memory",
330 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
331 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
332 );
333 }
334
335 void fmdiv3(float *dst, const float *a, const float *b, size_t count)
336 {
337 IF_ARCH_X86(size_t off);
338 ARCH_X86_ASM
339 (
340 FMOP_VV_CORE("dst", "dst", "a", "b", "vdiv", OP_DSEL)
341 : [off] "=&r" (off), [count] "+r" (count)
342 : [dst] "r"(dst), [a] "r" (a), [b] "r" (b)
343 : "cc", "memory",
344 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
345 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
346 );
347 }
348
349 void fmrdiv3(float *dst, const float *a, const float *b, size_t count)
350 {
351 IF_ARCH_X86(size_t off);
352 ARCH_X86_ASM
353 (
354 FMOP_VV_CORE("dst", "dst", "a", "b", "vdiv", OP_RSEL)
355 : [off] "=&r" (off), [count] "+r" (count)
356 : [dst] "r"(dst), [a] "r" (a), [b] "r" (b)
357 : "cc", "memory",
358 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
359 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
360 );
361 }
362
363 void fmmul4(float *dst, const float *a, const float *b, const float *c, size_t count)
364 {
365 IF_ARCH_X86(size_t off);
366 ARCH_X86_ASM
367 (
368 FMOP_VV_CORE("dst", "a", "b", "c", "vmul", OP_DSEL)
369 : [off] "=&r" (off), [count] "+r" (count)
370 : [dst] "r"(dst), [a] "r" (a), [b] "r" (b), [c] "r" (c)
371 : "cc", "memory",
372 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
373 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
374 );
375 }
376
377 void fmdiv4(float *dst, const float *a, const float *b, const float *c, size_t count)
378 {
379 IF_ARCH_X86(size_t off);
380 ARCH_X86_ASM
381 (
382 FMOP_VV_CORE("dst", "a", "b", "c", "vdiv", OP_DSEL)
383 : [off] "=&r" (off), [count] "+r" (count)
384 : [dst] "r"(dst), [a] "r" (a), [b] "r" (b), [c] "r" (c)
385 : "cc", "memory",
386 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
387 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
388 );
389 }
390
391 void fmrdiv4(float *dst, const float *a, const float *b, const float *c, size_t count)
392 {
393 IF_ARCH_X86(size_t off);
394 ARCH_X86_ASM
395 (
396 FMOP_VV_CORE("dst", "a", "b", "c", "vdiv", OP_RSEL)
397 : [off] "=&r" (off), [count] "+r" (count)
398 : [dst] "r"(dst), [a] "r" (a), [b] "r" (b), [c] "r" (c)
399 : "cc", "memory",
400 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
401 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
402 );
403 }
404
405 #undef FMOP_VV_CORE
406
407 #define FMA_OFF(a, b) a
408 #define FMA_ON(a, b) b
409
410 #define FMOD_VV_CORE(DST, SRC1, SRC2, SRC3, OP_SEL) \
411 __ASM_EMIT("xor %[off], %[off]") \
412 /* x32 blocks */ \
413 __ASM_EMIT32("subl $32, %[count]") \
414 __ASM_EMIT64("sub $32, %[count]") \
415 __ASM_EMIT("jb 2f") \
416 __ASM_EMIT("1:") \
417 __ASM_EMIT("vmovups 0x00(%[" SRC3 "], %[off]), %%zmm0") \
418 __ASM_EMIT("vmovups 0x40(%[" SRC3 "], %[off]), %%zmm1") \
419 __ASM_EMIT("vmovups 0x00(%[" SRC1 "], %[off]), " OP_SEL("%%zmm2", "%%zmm6")) \
420 __ASM_EMIT("vmovups 0x40(%[" SRC1 "], %[off]), " OP_SEL("%%zmm3", "%%zmm7")) \
421 __ASM_EMIT("vmulps 0x00(%[" SRC2 "], %[off]), %%zmm0, " OP_SEL("%%zmm6", "%%zmm2")) \
422 __ASM_EMIT("vmulps 0x40(%[" SRC2 "], %[off]), %%zmm1, " OP_SEL("%%zmm7", "%%zmm3")) \
423 __ASM_EMIT("vdivps %%zmm6, %%zmm2, %%zmm4") \
424 __ASM_EMIT("vdivps %%zmm7, %%zmm3, %%zmm5") \
425 __ASM_EMIT("vcvttps2dq %%zmm4, %%zmm4") \
426 __ASM_EMIT("vcvttps2dq %%zmm5, %%zmm5") \
427 __ASM_EMIT("vcvtdq2ps %%zmm4, %%zmm4") \
428 __ASM_EMIT("vcvtdq2ps %%zmm5, %%zmm5") \
429 __ASM_EMIT("vfnmadd231ps %%zmm6, %%zmm4, %%zmm2") \
430 __ASM_EMIT("vfnmadd231ps %%zmm7, %%zmm5, %%zmm3") \
431 __ASM_EMIT("vmovups %%zmm2, 0x00(%[" DST "], %[off])") \
432 __ASM_EMIT("vmovups %%zmm3, 0x40(%[" DST "], %[off])") \
433 __ASM_EMIT("add $0x80, %[off]") \
434 __ASM_EMIT32("subl $32, %[count]") \
435 __ASM_EMIT64("sub $32, %[count]") \
436 __ASM_EMIT("jae 1b") \
437 __ASM_EMIT("2:") \
438 /* x16 blocks */ \
439 __ASM_EMIT32("addl $16, %[count]") \
440 __ASM_EMIT64("add $16, %[count]") \
441 __ASM_EMIT("jl 4f") \
442 __ASM_EMIT("vmovups 0x00(%[" SRC3 "], %[off]), %%ymm0") \
443 __ASM_EMIT("vmovups 0x20(%[" SRC3 "], %[off]), %%ymm1") \
444 __ASM_EMIT("vmovups 0x00(%[" SRC1 "], %[off]), " OP_SEL("%%ymm2", "%%ymm6")) \
445 __ASM_EMIT("vmovups 0x20(%[" SRC1 "], %[off]), " OP_SEL("%%ymm3", "%%ymm7")) \
446 __ASM_EMIT("vmulps 0x00(%[" SRC2 "], %[off]), %%ymm0, " OP_SEL("%%ymm6", "%%ymm2")) \
447 __ASM_EMIT("vmulps 0x20(%[" SRC2 "], %[off]), %%ymm1, " OP_SEL("%%ymm7", "%%ymm3")) \
448 __ASM_EMIT("vdivps %%ymm6, %%ymm2, %%ymm4") \
449 __ASM_EMIT("vdivps %%ymm7, %%ymm3, %%ymm5") \
450 __ASM_EMIT("vcvttps2dq %%ymm4, %%ymm4") \
451 __ASM_EMIT("vcvttps2dq %%ymm5, %%ymm5") \
452 __ASM_EMIT("vcvtdq2ps %%ymm4, %%ymm4") \
453 __ASM_EMIT("vcvtdq2ps %%ymm5, %%ymm5") \
454 __ASM_EMIT("vfnmadd231ps %%ymm6, %%ymm4, %%ymm2") \
455 __ASM_EMIT("vfnmadd231ps %%ymm7, %%ymm5, %%ymm3") \
456 __ASM_EMIT("vmovups %%ymm2, 0x00(%[" DST "], %[off])") \
457 __ASM_EMIT("vmovups %%ymm3, 0x20(%[" DST "], %[off])") \
458 __ASM_EMIT32("subl $16, %[count]") \
459 __ASM_EMIT64("sub $16, %[count]") \
460 __ASM_EMIT("add $0x40, %[off]") \
461 __ASM_EMIT("4:") \
462 /* x8 block */ \
463 __ASM_EMIT32("addl $8, %[count]") \
464 __ASM_EMIT64("add $8, %[count]") \
465 __ASM_EMIT("jl 6f") \
466 __ASM_EMIT("vmovups 0x00(%[" SRC3 "], %[off]), %%xmm0") \
467 __ASM_EMIT("vmovups 0x10(%[" SRC3 "], %[off]), %%xmm1") \
468 __ASM_EMIT("vmovups 0x00(%[" SRC1 "], %[off]), " OP_SEL("%%xmm2", "%%xmm6")) \
469 __ASM_EMIT("vmovups 0x10(%[" SRC1 "], %[off]), " OP_SEL("%%xmm3", "%%xmm7")) \
470 __ASM_EMIT("vmulps 0x00(%[" SRC2 "], %[off]), %%xmm0, " OP_SEL("%%xmm6", "%%xmm2")) \
471 __ASM_EMIT("vmulps 0x10(%[" SRC2 "], %[off]), %%xmm1, " OP_SEL("%%xmm7", "%%xmm3")) \
472 __ASM_EMIT("vdivps %%xmm6, %%xmm2, %%xmm4") \
473 __ASM_EMIT("vdivps %%xmm7, %%xmm3, %%xmm5") \
474 __ASM_EMIT("vcvttps2dq %%xmm4, %%xmm4") \
475 __ASM_EMIT("vcvttps2dq %%xmm5, %%xmm5") \
476 __ASM_EMIT("vcvtdq2ps %%xmm4, %%xmm4") \
477 __ASM_EMIT("vcvtdq2ps %%xmm5, %%xmm5") \
478 __ASM_EMIT("vfnmadd231ps %%xmm6, %%xmm4, %%xmm2") \
479 __ASM_EMIT("vfnmadd231ps %%xmm7, %%xmm5, %%xmm3") \
480 __ASM_EMIT("vmovups %%xmm2, 0x00(%[" DST "], %[off])") \
481 __ASM_EMIT("vmovups %%xmm3, 0x10(%[" DST "], %[off])") \
482 __ASM_EMIT32("subl $8, %[count]") \
483 __ASM_EMIT64("sub $8, %[count]") \
484 __ASM_EMIT("add $0x20, %[off]") \
485 __ASM_EMIT("6:") \
486 /* x4 block */ \
487 __ASM_EMIT32("addl $4, %[count]") \
488 __ASM_EMIT64("add $4, %[count]") \
489 __ASM_EMIT("jl 8f") \
490 __ASM_EMIT("vmovups 0x00(%[" SRC3 "], %[off]), %%xmm0") \
491 __ASM_EMIT("vmovups 0x00(%[" SRC1 "], %[off]), " OP_SEL("%%xmm2", "%%xmm6")) \
492 __ASM_EMIT("vmulps 0x00(%[" SRC2 "], %[off]), %%xmm0, " OP_SEL("%%xmm6", "%%xmm2")) \
493 __ASM_EMIT("vdivps %%xmm6, %%xmm2, %%xmm4") \
494 __ASM_EMIT("vcvttps2dq %%xmm4, %%xmm4") \
495 __ASM_EMIT("vcvtdq2ps %%xmm4, %%xmm4") \
496 __ASM_EMIT("vfnmadd231ps %%xmm6, %%xmm4, %%xmm2") \
497 __ASM_EMIT("vmovups %%xmm2, 0x00(%[" DST "], %[off])") \
498 __ASM_EMIT32("subl $4, %[count]") \
499 __ASM_EMIT64("sub $4, %[count]") \
500 __ASM_EMIT("add $0x10, %[off]") \
501 __ASM_EMIT("8:") \
502 /* x1 blocks */ \
503 __ASM_EMIT32("addl $3, %[count]") \
504 __ASM_EMIT64("add $3, %[count]") \
505 __ASM_EMIT("jl 10f") \
506 __ASM_EMIT("9:") \
507 __ASM_EMIT("vmovss 0x00(%[" SRC3 "], %[off]), %%xmm0") \
508 __ASM_EMIT("vmovss 0x00(%[" SRC1 "], %[off]), " OP_SEL("%%xmm2", "%%xmm6")) \
509 __ASM_EMIT("vmulss 0x00(%[" SRC2 "], %[off]), %%xmm0, " OP_SEL("%%xmm6", "%%xmm2")) \
510 __ASM_EMIT("vdivss %%xmm6, %%xmm2, %%xmm4") \
511 __ASM_EMIT("vcvttps2dq %%xmm4, %%xmm4") \
512 __ASM_EMIT("vcvtdq2ps %%xmm4, %%xmm4") \
513 __ASM_EMIT("vfnmadd231ss %%xmm6, %%xmm4, %%xmm2") \
514 __ASM_EMIT("vmovss %%xmm2, 0x00(%[" DST "], %[off])") \
515 __ASM_EMIT("add $0x04, %[off]") \
516 __ASM_EMIT32("decl %[count]") \
517 __ASM_EMIT64("dec %[count]") \
518 __ASM_EMIT("jge 9b") \
519 __ASM_EMIT("10:")
520
521 void fmmod3(float *dst, const float *a, const float *b, size_t count)
522 {
523 IF_ARCH_X86(size_t off);
524 ARCH_X86_ASM
525 (
526 FMOD_VV_CORE("dst", "dst", "a", "b", OP_DSEL)
527 : [off] "=&r" (off), [count] "+r" (count)
528 : [dst] "r"(dst), [a] "r" (a), [b] "r" (b)
529 : "cc", "memory",
530 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
531 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
532 );
533 }
534
535 void fmrmod3(float *dst, const float *a, const float *b, size_t count)
536 {
537 IF_ARCH_X86(size_t off);
538 ARCH_X86_ASM
539 (
540 FMOD_VV_CORE("dst", "dst", "a", "b", OP_RSEL)
541 : [off] "=&r" (off), [count] "+r" (count)
542 : [dst] "r"(dst), [a] "r" (a), [b] "r" (b)
543 : "cc", "memory",
544 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
545 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
546 );
547 }
548
549 void fmmod4(float *dst, const float *a, const float *b, const float *c, size_t count)
550 {
551 IF_ARCH_X86(size_t off);
552 ARCH_X86_ASM
553 (
554 FMOD_VV_CORE("dst", "a", "b", "c", OP_DSEL)
555 : [off] "=&r" (off), [count] __ASM_ARG_RW(count)
556 : [dst] "r"(dst), [a] "r" (a), [b] "r" (b), [c] "r" (c)
557 : "cc", "memory",
558 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
559 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
560 );
561 }
562
563 void fmrmod4(float *dst, const float *a, const float *b, const float *c, size_t count)
564 {
565 IF_ARCH_X86(size_t off);
566 ARCH_X86_ASM
567 (
568 FMOD_VV_CORE("dst", "a", "b", "c", OP_RSEL)
569 : [off] "=&r" (off), [count] __ASM_ARG_RW(count)
570 : [dst] "r"(dst), [a] "r" (a), [b] "r" (b), [c] "r" (c)
571 : "cc", "memory",
572 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
573 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
574 );
575 }
576
577
578 #undef FMOD_VV_CORE
579
580 #undef FMA_OFF
581 #undef FMA_ON
582
583 #undef OP_DSEL
584 #undef OP_RSEL
585 } /* namespace avx512 */
586 } /* namespace lsp */
587
588
589
590 #endif /* PRIVATE_DSP_ARCH_X86_AVX512_PMATH_FMOP_VV_H_ */