Debian Codegraph @

modules/lsp-dsp-lib/include/private/dsp/arch/x86/sse/complex.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: 31 мар. 2020 г.
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_SSE_COMPLEX_H_
23 #define PRIVATE_DSP_ARCH_X86_SSE_COMPLEX_H_
24
25 #ifndef PRIVATE_DSP_ARCH_X86_SSE_IMPL
26 #error "This header should not be included directly"
27 #endif /* PRIVATE_DSP_ARCH_X86_SSE_IMPL */
28
29 namespace lsp
30 {
31 namespace sse
32 {
33 void complex_mul2(float *dst_re, float *dst_im, const float *src_re, const float *src_im, size_t count)
34 {
35 IF_ARCH_X86(size_t off);
36 ARCH_X86_ASM
37 (
38 __ASM_EMIT ("xor %[off], %[off]")
39 /* x4 blocks */
40 __ASM_EMIT32("subl $4, %[count]")
41 __ASM_EMIT64("sub $4, %[count]")
42 __ASM_EMIT ("jb 2f")
43 __ASM_EMIT ("1:")
44 __ASM_EMIT ("movups 0x00(%[dst_re], %[off]), %%xmm0") /* xmm0 = ar0 ar1 ar2 ar3 */
45 __ASM_EMIT ("movups 0x00(%[src_re], %[off]), %%xmm4") /* xmm4 = br0 br1 br2 br3 */
46 __ASM_EMIT ("movups 0x00(%[dst_im], %[off]), %%xmm2") /* xmm2 = ai0 ai1 ai2 ai3 */
47 __ASM_EMIT ("movups 0x00(%[src_im], %[off]), %%xmm6") /* xmm6 = bi0 bi1 bi2 bi3 */
48 __ASM_EMIT ("movaps %%xmm0, %%xmm1") /* xmm1 = ar0 ar1 ar2 ar3 */
49 __ASM_EMIT ("mulps %%xmm4, %%xmm0") /* xmm0 = ar0*br0 ar1*br1 ar2*br2 ar3*br3 */
50 __ASM_EMIT ("mulps %%xmm6, %%xmm1") /* xmm1 = ar0*bi0 ar1*bi1 ar2*bi2 ar3*bi3 */
51 __ASM_EMIT ("mulps %%xmm2, %%xmm6") /* xmm6 = ai0*bi0 ai1*bi1 ai2*bi2 ai3*bi3 */
52 __ASM_EMIT ("mulps %%xmm2, %%xmm4") /* xmm4 = ai0*br0 ai1*br1 ai2*br2 ai3*br3 */
53 __ASM_EMIT ("addps %%xmm4, %%xmm1") /* xmm1 = ar[i]*bi[i] + ai[i]*br[i] = i0 i1 i2 i3 */
54 __ASM_EMIT ("subps %%xmm6, %%xmm0") /* xmm0 = ar[i]*br[i] - ai[i]*bi[i] = r0 r1 r2 r3 */
55 __ASM_EMIT ("movups %%xmm0, 0x00(%[dst_re], %[off])")
56 __ASM_EMIT ("movups %%xmm1, 0x00(%[dst_im], %[off])")
57 __ASM_EMIT ("add $0x10, %[off]")
58 __ASM_EMIT32("subl $4, %[count]")
59 __ASM_EMIT64("sub $4, %[count]")
60 __ASM_EMIT ("jae 1b")
61 __ASM_EMIT ("2:")
62 /* x1 blocks */
63 __ASM_EMIT32("addl $3, %[count]")
64 __ASM_EMIT64("add $3, %[count]")
65 __ASM_EMIT ("jl 4f")
66 __ASM_EMIT ("3:")
67 __ASM_EMIT ("movss 0x00(%[dst_re], %[off]), %%xmm0") /* xmm0 = ar */
68 __ASM_EMIT ("movss 0x00(%[src_re], %[off]), %%xmm4") /* xmm4 = br */
69 __ASM_EMIT ("movss 0x00(%[dst_im], %[off]), %%xmm2") /* xmm2 = ai */
70 __ASM_EMIT ("movss 0x00(%[src_im], %[off]), %%xmm6") /* xmm6 = bi */
71 __ASM_EMIT ("movaps %%xmm0, %%xmm1") /* xmm1 = ar */
72 __ASM_EMIT ("mulss %%xmm4, %%xmm0") /* xmm0 = ar*br */
73 __ASM_EMIT ("mulss %%xmm6, %%xmm1") /* xmm1 = ar*bi */
74 __ASM_EMIT ("mulss %%xmm2, %%xmm6") /* xmm6 = ai*bi */
75 __ASM_EMIT ("mulss %%xmm2, %%xmm4") /* xmm4 = ai*br */
76 __ASM_EMIT ("addss %%xmm4, %%xmm1") /* xmm1 = ar*bi + ai*br = i */
77 __ASM_EMIT ("subss %%xmm6, %%xmm0") /* xmm0 = ar*br - ai*bi = r */
78 __ASM_EMIT ("movss %%xmm0, 0x00(%[dst_re], %[off])")
79 __ASM_EMIT ("movss %%xmm1, 0x00(%[dst_im], %[off])")
80 __ASM_EMIT ("add $0x04, %[off]")
81 __ASM_EMIT32("decl %[count]")
82 __ASM_EMIT64("dec %[count]")
83 __ASM_EMIT ("jge 3b")
84 __ASM_EMIT ("4:")
85 /* end */
86
87 : [count] __ASM_ARG_RW(count), [off] "=&r" (off)
88 : [dst_re] "r" (dst_re), [dst_im] "r" (dst_im),
89 [src_re] "r" (src_re), [src_im] "r" (src_im)
90 : "cc", "memory",
91 "%xmm0", "%xmm1", "%xmm2", "%xmm4",
92 "%xmm5", "%xmm6"
93 );
94 }
95
96 void complex_mul3(float *dst_re, float *dst_im, const float *src1_re, const float *src1_im, const float *src2_re, const float *src2_im, size_t count)
97 {
98 IF_ARCH_I386(float *ptr_re, *ptr_im);
99 IF_ARCH_X86(size_t off);
100 ARCH_X86_ASM
101 (
102 __ASM_EMIT ("xor %[off], %[off]")
103 /* x4 block */
104 __ASM_EMIT32("subl $4, %[count]")
105 __ASM_EMIT64("sub $4, %[count]")
106 __ASM_EMIT ("jb 2f")
107 __ASM_EMIT ("1:")
108 __ASM_EMIT32("mov %[src1_re], %[ptr_re]") \
109 __ASM_EMIT32("mov %[src1_im], %[ptr_im]") \
110 __ASM_EMIT ("movups 0x00(%[src2_re], %[off]), %%xmm4") /* xmm4 = br0 br1 br2 br3 */
111 __ASM_EMIT ("movups 0x00(%[src2_im], %[off]), %%xmm6") /* xmm6 = bi0 bi1 bi2 bi3 */
112 __ASM_EMIT32("movups 0x00(%[ptr_re], %[off]), %%xmm0") /* xmm0 = ar0 ar1 ar2 ar3 */
113 __ASM_EMIT32("movups 0x00(%[ptr_im], %[off]), %%xmm2") /* xmm2 = ai0 ai1 ai2 ai3 */
114 __ASM_EMIT64("movups 0x00(%[src1_re], %[off]), %%xmm0") /* xmm0 = ar0 ar1 ar2 ar3 */
115 __ASM_EMIT64("movups 0x00(%[src1_im], %[off]), %%xmm2") /* xmm2 = ai0 ai1 ai2 ai3 */
116 __ASM_EMIT32("mov %[dst_re], %[ptr_re]") \
117 __ASM_EMIT32("mov %[dst_im], %[ptr_im]") \
118 __ASM_EMIT ("movaps %%xmm0, %%xmm1") /* xmm1 = ar0 ar1 ar2 ar3 */
119 __ASM_EMIT ("mulps %%xmm4, %%xmm0") /* xmm0 = ar0*br0 ar1*br1 ar2*br2 ar3*br3 */
120 __ASM_EMIT ("mulps %%xmm6, %%xmm1") /* xmm1 = ar0*bi0 ar1*bi1 ar2*bi2 ar3*bi3 */
121 __ASM_EMIT ("mulps %%xmm2, %%xmm6") /* xmm6 = ai0*bi0 ai1*bi1 ai2*bi2 ai3*bi3 */
122 __ASM_EMIT ("mulps %%xmm2, %%xmm4") /* xmm4 = ai0*br0 ai1*br1 ai2*br2 ai3*br3 */
123 __ASM_EMIT ("addps %%xmm4, %%xmm1") /* xmm1 = ar[i]*bi[i] + ai[i]*br[i] = i0 i1 i2 i3 */
124 __ASM_EMIT ("subps %%xmm6, %%xmm0") /* xmm0 = ar[i]*br[i] - ai[i]*bi[i] = r0 r1 r2 r3 */
125 __ASM_EMIT32("movups %%xmm0, 0x00(%[ptr_re], %[off])")
126 __ASM_EMIT32("movups %%xmm1, 0x00(%[ptr_im], %[off])")
127 __ASM_EMIT64("movups %%xmm0, 0x00(%[dst_re], %[off])")
128 __ASM_EMIT64("movups %%xmm1, 0x00(%[dst_im], %[off])")
129 __ASM_EMIT ("add $0x10, %[off]")
130 __ASM_EMIT32("subl $4, %[count]")
131 __ASM_EMIT64("sub $4, %[count]")
132 __ASM_EMIT ("jae 1b")
133 __ASM_EMIT ("2:")
134 /* x1 blocks */
135 __ASM_EMIT32("addl $3, %[count]")
136 __ASM_EMIT64("add $3, %[count]")
137 __ASM_EMIT ("jl 4f")
138 __ASM_EMIT ("3:")
139 __ASM_EMIT32("mov %[src1_re], %[ptr_re]") \
140 __ASM_EMIT32("mov %[src1_im], %[ptr_im]") \
141 __ASM_EMIT ("movss 0x00(%[src2_re], %[off]), %%xmm4") /* xmm4 = br0 br1 br2 br3 */
142 __ASM_EMIT ("movss 0x00(%[src2_im], %[off]), %%xmm6") /* xmm6 = bi0 bi1 bi2 bi3 */
143 __ASM_EMIT32("movss 0x00(%[ptr_re], %[off]), %%xmm0") /* xmm0 = ar0 ar1 ar2 ar3 */
144 __ASM_EMIT32("movss 0x00(%[ptr_im], %[off]), %%xmm2") /* xmm2 = ai0 ai1 ai2 ai3 */
145 __ASM_EMIT64("movss 0x00(%[src1_re], %[off]), %%xmm0") /* xmm0 = ar0 ar1 ar2 ar3 */
146 __ASM_EMIT64("movss 0x00(%[src1_im], %[off]), %%xmm2") /* xmm2 = ai0 ai1 ai2 ai3 */
147 __ASM_EMIT32("mov %[dst_re], %[ptr_re]") \
148 __ASM_EMIT32("mov %[dst_im], %[ptr_im]") \
149 __ASM_EMIT ("movaps %%xmm0, %%xmm1") /* xmm1 = ar0 ar1 ar2 ar3 */
150 __ASM_EMIT ("mulss %%xmm4, %%xmm0") /* xmm0 = ar0*br0 ar1*br1 ar2*br2 ar3*br3 */
151 __ASM_EMIT ("mulss %%xmm6, %%xmm1") /* xmm1 = ar0*bi0 ar1*bi1 ar2*bi2 ar3*bi3 */
152 __ASM_EMIT ("mulss %%xmm2, %%xmm6") /* xmm6 = ai0*bi0 ai1*bi1 ai2*bi2 ai3*bi3 */
153 __ASM_EMIT ("mulss %%xmm2, %%xmm4") /* xmm4 = ai0*br0 ai1*br1 ai2*br2 ai3*br3 */
154 __ASM_EMIT ("addss %%xmm4, %%xmm1") /* xmm1 = ar[i]*bi[i] + ai[i]*br[i] = i0 i1 i2 i3 */
155 __ASM_EMIT ("subss %%xmm6, %%xmm0") /* xmm0 = ar[i]*br[i] - ai[i]*bi[i] = r0 r1 r2 r3 */
156 __ASM_EMIT32("movss %%xmm0, 0x00(%[ptr_re], %[off])")
157 __ASM_EMIT32("movss %%xmm1, 0x00(%[ptr_im], %[off])")
158 __ASM_EMIT64("movss %%xmm0, 0x00(%[dst_re], %[off])")
159 __ASM_EMIT64("movss %%xmm1, 0x00(%[dst_im], %[off])")
160 __ASM_EMIT ("add $0x04, %[off]")
161 __ASM_EMIT32("decl %[count]")
162 __ASM_EMIT64("dec %[count]")
163 __ASM_EMIT ("jge 3b")
164 __ASM_EMIT ("4:")
165 /* end */
166
167 : __IF_32(
168 [ptr_re] "=&r" (ptr_re), [ptr_im] "=&r" (ptr_im),
169 )
170 [count] "+r" (count), [off] "=&r" (off)
171 : [dst_re] X86_GREG (dst_re), [dst_im] X86_GREG (dst_im),
172 [src1_re] X86_GREG (src1_re), [src1_im] X86_GREG (src1_im),
173 [src2_re] "r" (src2_re), [src2_im] "r" (src2_im)
174 : "cc", "memory",
175 "%xmm0", "%xmm1", "%xmm2", "%xmm4", "%xmm5", "%xmm6"
176 );
177 }
178
179 IF_ARCH_X86(
180 static const uint32_t complex_div_const[] __lsp_aligned16 =
181 {
182 LSP_DSP_VEC4(0x3f800000), /* 1.0f */
183 LSP_DSP_VEC4(0x80000000) /* sign bit */
184 };
185 );
186
187 #define COMPLEX_DIV2_CORE(DSTR, DSTI, TR, TI, BR, BI) \
188 __ASM_EMIT ("xor %[off], %[off]") \
189 /* x4 blocks */ \
190 __ASM_EMIT32("subl $4, %[count]") \
191 __ASM_EMIT64("sub $4, %[count]") \
192 __ASM_EMIT ("jb 2f") \
193 __ASM_EMIT ("1:") \
194 __ASM_EMIT ("movups 0x00(%[" BR "], %[off]), %%xmm2") /* xmm2 = br */ \
195 __ASM_EMIT ("movups 0x00(%[" BI "], %[off]), %%xmm3") /* xmm3 = bi */ \
196 __ASM_EMIT ("movups 0x00(%[" TR "], %[off]), %%xmm0") /* xmm0 = tr */ \
197 __ASM_EMIT ("movups 0x00(%[" TI "], %[off]), %%xmm1") /* xmm1 = ti */ \
198 __ASM_EMIT ("movaps %%xmm2, %%xmm6") /* xmm6 = br */ \
199 __ASM_EMIT ("movaps %%xmm3, %%xmm7") /* xmm7 = bi */ \
200 __ASM_EMIT ("movaps %%xmm0, %%xmm4") /* xmm4 = tr */ \
201 __ASM_EMIT ("movaps %%xmm1, %%xmm5") /* xmm5 = ti */ \
202 __ASM_EMIT ("mulps %%xmm6, %%xmm6") /* xmm6 = br*br */ \
203 __ASM_EMIT ("mulps %%xmm7, %%xmm7") /* xmm7 = bi*bi */ \
204 __ASM_EMIT ("mulps %%xmm2, %%xmm0") /* xmm0 = tr*br */ \
205 __ASM_EMIT ("mulps %%xmm2, %%xmm1") /* xmm1 = ti*br */ \
206 __ASM_EMIT ("addps %%xmm6, %%xmm7") /* xmm7 = R = br*br + bi*bi */ \
207 __ASM_EMIT ("movaps 0x00 + %[CC], %%xmm6") /* xmm6 = 1 */ \
208 __ASM_EMIT ("mulps %%xmm3, %%xmm5") /* xmm5 = ti*bi */ \
209 __ASM_EMIT ("mulps %%xmm3, %%xmm4") /* xmm4 = tr*bi */ \
210 __ASM_EMIT ("divps %%xmm7, %%xmm6") /* xmm6 = 1/R */ \
211 __ASM_EMIT ("addps %%xmm5, %%xmm0") /* xmm0 = r = tr*br + ti*bi */ \
212 __ASM_EMIT ("subps %%xmm4, %%xmm1") /* xmm1 = i = ti*br - tr*bi */ \
213 __ASM_EMIT ("mulps %%xmm6, %%xmm0") /* xmm0 = r/R */ \
214 __ASM_EMIT ("mulps %%xmm6, %%xmm1") /* xmm1 = i/R */ \
215 __ASM_EMIT ("movups %%xmm0, 0x00(%[" DSTR "], %[off])") \
216 __ASM_EMIT ("movups %%xmm1, 0x00(%[" DSTI "], %[off])") \
217 __ASM_EMIT ("add $0x10, %[off]") \
218 __ASM_EMIT32("subl $4, %[count]") \
219 __ASM_EMIT64("sub $4, %[count]") \
220 __ASM_EMIT ("jae 1b") \
221 __ASM_EMIT ("2:") \
222 /* x1 blocks */ \
223 __ASM_EMIT32("addl $3, %[count]") \
224 __ASM_EMIT64("add $3, %[count]") \
225 __ASM_EMIT ("jl 4f") \
226 __ASM_EMIT ("3:") \
227 __ASM_EMIT ("movss 0x00(%[" BR "], %[off]), %%xmm2") /* xmm2 = br */ \
228 __ASM_EMIT ("movss 0x00(%[" BI "], %[off]), %%xmm3") /* xmm3 = bi */ \
229 __ASM_EMIT ("movss 0x00(%[" TR "], %[off]), %%xmm0") /* xmm0 = tr */ \
230 __ASM_EMIT ("movss 0x00(%[" TI "], %[off]), %%xmm1") /* xmm1 = ti */ \
231 __ASM_EMIT ("movaps %%xmm2, %%xmm6") /* xmm6 = br */ \
232 __ASM_EMIT ("movaps %%xmm3, %%xmm7") /* xmm7 = bi */ \
233 __ASM_EMIT ("movaps %%xmm0, %%xmm4") /* xmm4 = tr */ \
234 __ASM_EMIT ("movaps %%xmm1, %%xmm5") /* xmm5 = ti */ \
235 __ASM_EMIT ("mulss %%xmm6, %%xmm6") /* xmm6 = br*br */ \
236 __ASM_EMIT ("mulss %%xmm7, %%xmm7") /* xmm7 = bi*bi */ \
237 __ASM_EMIT ("mulss %%xmm2, %%xmm0") /* xmm0 = tr*br */ \
238 __ASM_EMIT ("mulss %%xmm2, %%xmm1") /* xmm1 = ti*br */ \
239 __ASM_EMIT ("addss %%xmm6, %%xmm7") /* xmm7 = R = br*br + bi*bi */ \
240 __ASM_EMIT ("movaps 0x00 + %[CC], %%xmm6") /* xmm6 = 1 */ \
241 __ASM_EMIT ("mulss %%xmm3, %%xmm5") /* xmm5 = ti*bi */ \
242 __ASM_EMIT ("mulss %%xmm3, %%xmm4") /* xmm4 = tr*bi */ \
243 __ASM_EMIT ("divss %%xmm7, %%xmm6") /* xmm6 = 1/R */ \
244 __ASM_EMIT ("addss %%xmm5, %%xmm0") /* xmm0 = r = tr*br + ti*bi */ \
245 __ASM_EMIT ("subss %%xmm4, %%xmm1") /* xmm1 = i = ti*br - tr*bi */ \
246 __ASM_EMIT ("mulss %%xmm6, %%xmm0") /* xmm0 = r/R */ \
247 __ASM_EMIT ("mulss %%xmm6, %%xmm1") /* xmm1 = i/R */ \
248 __ASM_EMIT ("movss %%xmm0, 0x00(%[" DSTR "], %[off])") \
249 __ASM_EMIT ("movss %%xmm1, 0x00(%[" DSTI "], %[off])") \
250 __ASM_EMIT ("add $0x04, %[off]") \
251 __ASM_EMIT32("decl %[count]") \
252 __ASM_EMIT64("dec %[count]") \
253 __ASM_EMIT ("jge 3b") \
254 __ASM_EMIT ("4:") \
255 /* end */
256
257 void complex_div2(float *dst_re, float *dst_im, const float *src_re, const float *src_im, size_t count)
258 {
259 IF_ARCH_X86(size_t off);
260 ARCH_X86_ASM
261 (
262 COMPLEX_DIV2_CORE("dst_re", "dst_im", "dst_re", "dst_im", "src_re", "src_im")
263 : [off] "=&r" (off),
264 [count] X86_PGREG(count)
265 : [dst_re] "r" (dst_re), [dst_im] "r" (dst_im),
266 [src_re] "r" (src_re), [src_im] "r" (src_im),
267 [CC] "o" (complex_div_const)
268 : "cc", "memory",
269 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
270 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
271 );
272 }
273
274 void complex_rdiv2(float *dst_re, float *dst_im, const float *src_re, const float *src_im, size_t count)
275 {
276 IF_ARCH_X86(size_t off);
277 ARCH_X86_ASM
278 (
279 COMPLEX_DIV2_CORE("dst_re", "dst_im", "src_re", "src_im", "dst_re", "dst_im")
280 : [off] "=&r" (off),
281 [count] X86_PGREG(count)
282 : [dst_re] "r" (dst_re), [dst_im] "r" (dst_im),
283 [src_re] "r" (src_re), [src_im] "r" (src_im),
284 [CC] "o" (complex_div_const)
285 : "cc", "memory",
286 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
287 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
288 );
289 }
290
291 #undef COMPLEX_DIV2_CORE
292
293 void complex_div3(float *dst_re, float *dst_im, const float *t_re, const float *t_im, const float *b_re, const float *b_im, size_t count)
294 {
295 IF_ARCH_I386(float *ptr_re, *ptr_im);
296 IF_ARCH_X86(size_t off);
297 ARCH_X86_ASM
298 (
299 __ASM_EMIT ("xor %[off], %[off]")
300 // x4 blocks
301 __ASM_EMIT32("subl $4, %[count]") \
302 __ASM_EMIT64("sub $4, %[count]") \
303 __ASM_EMIT ("jb 2f")
304 __ASM_EMIT ("1:")
305 __ASM_EMIT32("mov %[t_re], %[ptr_re]")
306 __ASM_EMIT32("mov %[t_im], %[ptr_im]")
307 __ASM_EMIT ("movups 0x00(%[b_re], %[off]), %%xmm2") // xmm2 = br
308 __ASM_EMIT ("movups 0x00(%[b_im], %[off]), %%xmm3") // xmm3 = bi
309 __ASM_EMIT32("movups 0x00(%[ptr_re], %[off]), %%xmm0") // xmm0 = tr
310 __ASM_EMIT32("movups 0x00(%[ptr_im], %[off]), %%xmm1") // xmm1 = ti
311 __ASM_EMIT64("movups 0x00(%[t_re], %[off]), %%xmm0") // xmm0 = tr
312 __ASM_EMIT64("movups 0x00(%[t_im], %[off]), %%xmm1") // xmm1 = ti
313 __ASM_EMIT32("mov %[dst_re], %[ptr_re]")
314 __ASM_EMIT32("mov %[dst_im], %[ptr_im]")
315 __ASM_EMIT ("movaps %%xmm2, %%xmm6") /* xmm6 = br */
316 __ASM_EMIT ("movaps %%xmm3, %%xmm7") /* xmm7 = bi */
317 __ASM_EMIT ("movaps %%xmm0, %%xmm4") /* xmm4 = tr */
318 __ASM_EMIT ("movaps %%xmm1, %%xmm5") /* xmm5 = ti */
319 __ASM_EMIT ("mulps %%xmm6, %%xmm6") /* xmm6 = br*br */
320 __ASM_EMIT ("mulps %%xmm7, %%xmm7") /* xmm7 = bi*bi */
321 __ASM_EMIT ("mulps %%xmm2, %%xmm0") /* xmm0 = tr*br */
322 __ASM_EMIT ("mulps %%xmm2, %%xmm1") /* xmm1 = ti*br */
323 __ASM_EMIT ("addps %%xmm6, %%xmm7") /* xmm7 = R = br*br + bi*bi */
324 __ASM_EMIT ("movaps 0x00 + %[CC], %%xmm6") /* xmm6 = 1 */
325 __ASM_EMIT ("mulps %%xmm3, %%xmm5") /* xmm5 = ti*bi */
326 __ASM_EMIT ("mulps %%xmm3, %%xmm4") /* xmm4 = tr*bi */
327 __ASM_EMIT ("divps %%xmm7, %%xmm6") /* xmm6 = 1/R */
328 __ASM_EMIT ("addps %%xmm5, %%xmm0") /* xmm0 = r = tr*br + ti*bi */
329 __ASM_EMIT ("subps %%xmm4, %%xmm1") /* xmm1 = i = ti*br - tr*bi */
330 __ASM_EMIT ("mulps %%xmm6, %%xmm0") /* xmm0 = r/R */
331 __ASM_EMIT ("mulps %%xmm6, %%xmm1") /* xmm1 = i/R */
332 __ASM_EMIT32("movups %%xmm0, 0x00(%[ptr_re], %[off])")
333 __ASM_EMIT32("movups %%xmm1, 0x00(%[ptr_im], %[off])")
334 __ASM_EMIT64("movups %%xmm0, 0x00(%[dst_re], %[off])")
335 __ASM_EMIT64("movups %%xmm1, 0x00(%[dst_im], %[off])")
336 __ASM_EMIT ("add $0x10, %[off]")
337 __ASM_EMIT32("subl $4, %[count]") \
338 __ASM_EMIT64("sub $4, %[count]") \
339 __ASM_EMIT ("jae 1b")
340 __ASM_EMIT ("2:")
341 // x1 blocks
342 __ASM_EMIT32("addl $3, %[count]") \
343 __ASM_EMIT64("add $3, %[count]") \
344 __ASM_EMIT ("jl 4f")
345 __ASM_EMIT ("3:")
346 __ASM_EMIT32("mov %[t_re], %[ptr_re]")
347 __ASM_EMIT32("mov %[t_im], %[ptr_im]")
348 __ASM_EMIT ("movss 0x00(%[b_re], %[off]), %%xmm2") // xmm2 = br
349 __ASM_EMIT ("movss 0x00(%[b_im], %[off]), %%xmm3") // xmm3 = bi
350 __ASM_EMIT32("movss 0x00(%[ptr_re], %[off]), %%xmm0") // xmm0 = tr
351 __ASM_EMIT32("movss 0x00(%[ptr_im], %[off]), %%xmm1") // xmm1 = ti
352 __ASM_EMIT64("movss 0x00(%[t_re], %[off]), %%xmm0") // xmm0 = tr
353 __ASM_EMIT64("movss 0x00(%[t_im], %[off]), %%xmm1") // xmm1 = ti
354 __ASM_EMIT32("mov %[dst_re], %[ptr_re]")
355 __ASM_EMIT32("mov %[dst_im], %[ptr_im]")
356 __ASM_EMIT ("movaps %%xmm2, %%xmm6") /* xmm6 = br */ \
357 __ASM_EMIT ("movaps %%xmm3, %%xmm7") /* xmm7 = bi */ \
358 __ASM_EMIT ("movaps %%xmm0, %%xmm4") /* xmm4 = tr */ \
359 __ASM_EMIT ("movaps %%xmm1, %%xmm5") /* xmm5 = ti */ \
360 __ASM_EMIT ("mulss %%xmm6, %%xmm6") /* xmm6 = br*br */ \
361 __ASM_EMIT ("mulss %%xmm7, %%xmm7") /* xmm7 = bi*bi */ \
362 __ASM_EMIT ("mulss %%xmm2, %%xmm0") /* xmm0 = tr*br */ \
363 __ASM_EMIT ("mulss %%xmm2, %%xmm1") /* xmm1 = ti*br */ \
364 __ASM_EMIT ("addss %%xmm6, %%xmm7") /* xmm7 = R = br*br + bi*bi */ \
365 __ASM_EMIT ("movaps 0x00 + %[CC], %%xmm6") /* xmm6 = 1 */ \
366 __ASM_EMIT ("mulss %%xmm3, %%xmm5") /* xmm5 = ti*bi */ \
367 __ASM_EMIT ("mulss %%xmm3, %%xmm4") /* xmm4 = tr*bi */ \
368 __ASM_EMIT ("divss %%xmm7, %%xmm6") /* xmm6 = 1/R */ \
369 __ASM_EMIT ("addss %%xmm5, %%xmm0") /* xmm0 = r = tr*br + ti*bi */ \
370 __ASM_EMIT ("subss %%xmm4, %%xmm1") /* xmm1 = i = ti*br - tr*bi */ \
371 __ASM_EMIT ("mulss %%xmm6, %%xmm0") /* xmm0 = r/R */ \
372 __ASM_EMIT ("mulss %%xmm6, %%xmm1") /* xmm1 = i/R */ \
373 __ASM_EMIT32("movss %%xmm0, 0x00(%[ptr_re], %[off])")
374 __ASM_EMIT32("movss %%xmm1, 0x00(%[ptr_im], %[off])")
375 __ASM_EMIT64("movss %%xmm0, 0x00(%[dst_re], %[off])")
376 __ASM_EMIT64("movss %%xmm1, 0x00(%[dst_im], %[off])")
377 __ASM_EMIT ("add $0x04, %[off]")
378 __ASM_EMIT32("decl %[count]") \
379 __ASM_EMIT64("dec %[count]") \
380 __ASM_EMIT ("jge 3b")
381 __ASM_EMIT ("4:")
382 /* end */
383
384 : __IF_32(
385 [ptr_re] "=&r" (ptr_re), [ptr_im] "=&r" (ptr_im),
386 )
387 [count] X86_PGREG(count), [off] "=&r" (off)
388 : [dst_re] X86_GREG (dst_re), [dst_im] X86_GREG (dst_im),
389 [t_re] X86_GREG (t_re), [t_im] X86_GREG (t_im),
390 [b_re] "r" (b_re), [b_im] "r" (b_im),
391 [CC] "o" (complex_div_const)
392 : "cc", "memory",
393 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
394 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
395 );
396 }
397
398 void complex_mod(float *dst, const float *src_re, const float *src_im, size_t count)
399 {
400 size_t off;
401
402 ARCH_X86_ASM
403 (
404 __ASM_EMIT("xor %[off], %[off]")
405 __ASM_EMIT("sub $16, %[count]")
406 __ASM_EMIT("jb 2f")
407
408 // 16x blocks
409 __ASM_EMIT("1:")
410 __ASM_EMIT("movups 0x00(%[src_re], %[off]), %%xmm0")
411 __ASM_EMIT("movups 0x10(%[src_re], %[off]), %%xmm1")
412 __ASM_EMIT("movups 0x20(%[src_re], %[off]), %%xmm2")
413 __ASM_EMIT("movups 0x30(%[src_re], %[off]), %%xmm3")
414 __ASM_EMIT("movups 0x00(%[src_im], %[off]), %%xmm4")
415 __ASM_EMIT("movups 0x10(%[src_im], %[off]), %%xmm5")
416 __ASM_EMIT("movups 0x20(%[src_im], %[off]), %%xmm6")
417 __ASM_EMIT("movups 0x30(%[src_im], %[off]), %%xmm7")
418 __ASM_EMIT("mulps %%xmm0, %%xmm0")
419 __ASM_EMIT("mulps %%xmm1, %%xmm1")
420 __ASM_EMIT("mulps %%xmm2, %%xmm2")
421 __ASM_EMIT("mulps %%xmm3, %%xmm3")
422 __ASM_EMIT("mulps %%xmm4, %%xmm4")
423 __ASM_EMIT("mulps %%xmm5, %%xmm5")
424 __ASM_EMIT("mulps %%xmm6, %%xmm6")
425 __ASM_EMIT("mulps %%xmm7, %%xmm7")
426 __ASM_EMIT("addps %%xmm4, %%xmm0")
427 __ASM_EMIT("addps %%xmm5, %%xmm1")
428 __ASM_EMIT("addps %%xmm6, %%xmm2")
429 __ASM_EMIT("addps %%xmm7, %%xmm3")
430 __ASM_EMIT("sqrtps %%xmm0, %%xmm0")
431 __ASM_EMIT("sqrtps %%xmm1, %%xmm1")
432 __ASM_EMIT("sqrtps %%xmm2, %%xmm2")
433 __ASM_EMIT("sqrtps %%xmm3, %%xmm3")
434 __ASM_EMIT("movups %%xmm0, 0x00(%[dst], %[off])")
435 __ASM_EMIT("movups %%xmm1, 0x10(%[dst], %[off])")
436 __ASM_EMIT("movups %%xmm2, 0x20(%[dst], %[off])")
437 __ASM_EMIT("movups %%xmm3, 0x30(%[dst], %[off])")
438 __ASM_EMIT("add $0x40, %[off]")
439 __ASM_EMIT("sub $16, %[count]")
440 __ASM_EMIT("jae 1b")
441
442 // 4x blocks
443 __ASM_EMIT("2:")
444 __ASM_EMIT("add $12, %[count]")
445 __ASM_EMIT("jl 4f")
446 __ASM_EMIT("3:")
447 __ASM_EMIT("movups 0x00(%[src_re], %[off]), %%xmm0")
448 __ASM_EMIT("movups 0x00(%[src_im], %[off]), %%xmm4")
449 __ASM_EMIT("mulps %%xmm0, %%xmm0")
450 __ASM_EMIT("mulps %%xmm4, %%xmm4")
451 __ASM_EMIT("addps %%xmm4, %%xmm0")
452 __ASM_EMIT("sqrtps %%xmm0, %%xmm0")
453 __ASM_EMIT("movups %%xmm0, 0x00(%[dst], %[off])")
454 __ASM_EMIT("add $0x10, %[off]")
455 __ASM_EMIT("sub $4, %[count]")
456 __ASM_EMIT("jae 3b")
457
458 // 1x blocks
459 __ASM_EMIT("4:")
460 __ASM_EMIT("add $3, %[count]")
461 __ASM_EMIT("jl 6f")
462 __ASM_EMIT("5:")
463 __ASM_EMIT("movss 0x00(%[src_re], %[off]), %%xmm0")
464 __ASM_EMIT("movss 0x00(%[src_im], %[off]), %%xmm4")
465 __ASM_EMIT("mulss %%xmm0, %%xmm0")
466 __ASM_EMIT("mulss %%xmm4, %%xmm4")
467 __ASM_EMIT("addss %%xmm4, %%xmm0")
468 __ASM_EMIT("sqrtss %%xmm0, %%xmm0")
469 __ASM_EMIT("movss %%xmm0, 0x00(%[dst], %[off])")
470 __ASM_EMIT("add $0x4, %[off]")
471 __ASM_EMIT("dec %[count]")
472 __ASM_EMIT("jge 5b")
473
474 // End
475 __ASM_EMIT("6:")
476 : [dst] "+r" (dst), [src_re] "+r" (src_re), [src_im] "+r"(src_im),
477 [count] "+r" (count), [off] "=&r" (off)
478 :
479 : "cc", "memory",
480 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
481 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
482 );
483 }
484
485
486 void complex_rcp2(float *dst_re, float *dst_im, const float *src_re, const float *src_im, size_t count)
487 {
488 IF_ARCH_I386(float **save);
489
490 ARCH_X86_ASM (
491 /* Do block processing */
492 __ASM_EMIT("test %[count], %[count]")
493 __ASM_EMIT("jz 50f")
494
495 __ASM_EMIT("sub $8, %[count]") /* count -= 8 */
496 __ASM_EMIT("jb 2f")
497 __ASM_EMIT("1:")
498 /* Perform 8x RCP */
499 __ASM_EMIT("movups 0x00(%[src_re]), %%xmm0") /* xmm0 = r0 */
500 __ASM_EMIT("movups 0x10(%[src_re]), %%xmm2") /* xmm2 = r1 */
501 __ASM_EMIT("movups 0x00(%[src_im]), %%xmm1") /* xmm1 = i0 */
502 __ASM_EMIT("movups 0x10(%[src_im]), %%xmm3") /* xmm3 = i1 */
503 __ASM_EMIT32("mov %[src_re], %[save]") /* *save = src_re */
504 __ASM_EMIT("movaps %%xmm0, %%xmm4") /* xmm4 = r0 */
505 __ASM_EMIT("movaps %%xmm1, %%xmm5") /* xmm5 = i0 */
506 __ASM_EMIT("movaps %%xmm2, %%xmm6") /* xmm6 = r1 */
507 __ASM_EMIT("movaps %%xmm3, %%xmm7") /* xmm7 = i1 */
508 __ASM_EMIT("mulps %%xmm0, %%xmm4") /* xmm4 = r0*r0 */
509 __ASM_EMIT("mulps %%xmm1, %%xmm5") /* xmm5 = i0*i0 */
510 __ASM_EMIT("mulps %%xmm2, %%xmm6") /* xmm6 = r1*r1 */
511 __ASM_EMIT("mulps %%xmm3, %%xmm7") /* xmm7 = i1*i1 */
512 __ASM_EMIT("addps %%xmm5, %%xmm4") /* xmm4 = r0*r0 + i0*i0 */
513 __ASM_EMIT("addps %%xmm7, %%xmm6") /* xmm6 = r1*r1 + i1*i1 */
514 __ASM_EMIT32("lea %[CC], %[src_re]")
515 __ASM_EMIT32("movaps 0x00(%[src_re]), %%xmm5") /* xmm5 = 1 */
516 __ASM_EMIT32("xorps 0x10(%[src_re]), %%xmm1") /* xmm1 = -i0 */
517 __ASM_EMIT64("movaps 0x00(%[CC]), %%xmm5") /* xmm5 = 1 */
518 __ASM_EMIT64("xorps 0x10(%[CC]), %%xmm1") /* xmm1 = -i0 */
519 __ASM_EMIT("movaps %%xmm5, %%xmm7") /* xmm7 = 1 */
520 __ASM_EMIT32("xorps 0x10(%[src_re]), %%xmm3") /* xmm3 = -i1 */
521 __ASM_EMIT64("xorps 0x10(%[CC]), %%xmm3") /* xmm3 = -i1 */
522 __ASM_EMIT("divps %%xmm4, %%xmm5") /* xmm5 = 1 / (r0*r0 + i0*i0) */
523 __ASM_EMIT("divps %%xmm6, %%xmm7") /* xmm7 = 1 / (r1*r1 + i1*i1) */
524 __ASM_EMIT("mulps %%xmm5, %%xmm0") /* xmm0 = r0' = r0 / (r0*r0 + i0*i0) */
525 __ASM_EMIT("mulps %%xmm7, %%xmm2") /* xmm2 = r1' = r1 / (r1*r1 + i1*i1) */
526 __ASM_EMIT("mulps %%xmm5, %%xmm1") /* xmm1 = i0' = -i0 / (r0*r0 + i0*i0) */
527 __ASM_EMIT("mulps %%xmm7, %%xmm3") /* xmm3 = i1' = -i1 / (r1*r1 + i1*i1) */
528 __ASM_EMIT32("mov %[save], %[src_re]") /* src_re= *save */
529 __ASM_EMIT("movups %%xmm0, 0x00(%[dst_re])") /* dst_re[0] = r0' */
530 __ASM_EMIT("movups %%xmm2, 0x10(%[dst_re])") /* dst_re[1] = r1' */
531 __ASM_EMIT("movups %%xmm1, 0x00(%[dst_im])") /* dst_im[0] = i0' */
532 __ASM_EMIT("movups %%xmm3, 0x10(%[dst_im])") /* dst_im[1] = i1' */
533 __ASM_EMIT("add $0x20, %[src_re]") /* src_re += 8 */
534 __ASM_EMIT("add $0x20, %[src_im]") /* src_im += 8 */
535 __ASM_EMIT("add $0x20, %[dst_re]") /* dst_re += 8 */
536 __ASM_EMIT("add $0x20, %[dst_im]") /* dst_im += 8 */
537 __ASM_EMIT("sub $8, %[count]") /* count -= 8 */
538 __ASM_EMIT("jae 1b")
539 /* 4x RCP */
540 __ASM_EMIT("2:")
541 __ASM_EMIT("add $4, %[count]") /* count += 4 */
542 __ASM_EMIT("jl 10f")
543 __ASM_EMIT("movups 0x00(%[src_re]), %%xmm0") /* xmm0 = r0 */
544 __ASM_EMIT("movups 0x00(%[src_im]), %%xmm1") /* xmm1 = i0 */
545 __ASM_EMIT32("mov %[src_re], %[save]") /* *save = src_re */
546 __ASM_EMIT("movaps %%xmm0, %%xmm4") /* xmm4 = r0 */
547 __ASM_EMIT("movaps %%xmm1, %%xmm5") /* xmm5 = i0 */
548 __ASM_EMIT("mulps %%xmm0, %%xmm4") /* xmm4 = r0*r0 */
549 __ASM_EMIT("mulps %%xmm1, %%xmm5") /* xmm5 = i0*i0 */
550 __ASM_EMIT("addps %%xmm5, %%xmm4") /* xmm4 = r0*r0 + i0*i0 */
551 __ASM_EMIT32("lea %[CC], %[src_re]")
552 __ASM_EMIT32("movaps 0x00(%[src_re]), %%xmm5") /* xmm5 = 1 */
553 __ASM_EMIT32("xorps 0x10(%[src_re]), %%xmm1") /* xmm1 = -i0 */
554 __ASM_EMIT64("movaps 0x00(%[CC]), %%xmm5") /* xmm5 = 1 */
555 __ASM_EMIT64("xorps 0x10(%[CC]), %%xmm1") /* xmm1 = -i0 */
556 __ASM_EMIT("divps %%xmm4, %%xmm5") /* xmm5 = 1 / (r0*r0 + i0*i0) */
557 __ASM_EMIT("mulps %%xmm5, %%xmm0") /* xmm0 = r0' = r0 / (r0*r0 + i0*i0) */
558 __ASM_EMIT("mulps %%xmm5, %%xmm1") /* xmm1 = i0' = -i0 / (r0*r0 + i0*i0) */
559 __ASM_EMIT32("mov %[save], %[src_re]") /* src_re= *save */
560 __ASM_EMIT("movups %%xmm0, 0x00(%[dst_re])") /* dst_re[0] = r0' */
561 __ASM_EMIT("movups %%xmm1, 0x00(%[dst_im])") /* dst_im[0] = i0' */
562 __ASM_EMIT("add $0x10, %[src_re]") /* src_re += 4 */
563 __ASM_EMIT("add $0x10, %[src_im]") /* src_im += 4 */
564 __ASM_EMIT("add $0x10, %[dst_re]") /* dst_re += 4 */
565 __ASM_EMIT("add $0x10, %[dst_im]") /* dst_im += 4 */
566 __ASM_EMIT("sub $4, %[count]") /* count -= 4 */
567 /* 1x RCP */
568 __ASM_EMIT("10:")
569 __ASM_EMIT("add $4, %[count]") /* count += 4 */
570 __ASM_EMIT("jle 50f")
571 __ASM_EMIT("40:")
572 __ASM_EMIT("movss 0x00(%[src_re]), %%xmm0") /* xmm0 = r0 */
573 __ASM_EMIT("movss 0x00(%[src_im]), %%xmm1") /* xmm1 = i0 */
574 __ASM_EMIT32("mov %[src_re], %[save]") /* *save = src_re */
575 __ASM_EMIT("movaps %%xmm0, %%xmm4") /* xmm4 = r0 */
576 __ASM_EMIT("movaps %%xmm1, %%xmm5") /* xmm5 = i0 */
577 __ASM_EMIT("mulss %%xmm0, %%xmm4") /* xmm4 = r0*r0 */
578 __ASM_EMIT("mulss %%xmm1, %%xmm5") /* xmm5 = i0*i0 */
579 __ASM_EMIT("addss %%xmm5, %%xmm4") /* xmm4 = r0*r0 + i0*i0 */
580 __ASM_EMIT32("lea %[CC], %[src_re]")
581 __ASM_EMIT32("movaps 0x00(%[src_re]), %%xmm5") /* xmm5 = 1 */
582 __ASM_EMIT32("xorps 0x10(%[src_re]), %%xmm1") /* xmm1 = -i0 */
583 __ASM_EMIT64("movaps 0x00(%[CC]), %%xmm5") /* xmm5 = 1 */
584 __ASM_EMIT64("xorps 0x10(%[CC]), %%xmm1") /* xmm1 = -i0 */
585 __ASM_EMIT("divss %%xmm4, %%xmm5") /* xmm5 = 1 / (r0*r0 + i0*i0) */
586 __ASM_EMIT("mulss %%xmm5, %%xmm0") /* xmm0 = r0' = r0 / (r0*r0 + i0*i0) */
587 __ASM_EMIT("mulss %%xmm5, %%xmm1") /* xmm1 = i0' = -i0 / (r0*r0 + i0*i0) */
588 __ASM_EMIT32("mov %[save], %[src_re]") /* src_re= *save */
589 __ASM_EMIT("movss %%xmm0, 0x00(%[dst_re])") /* dst_re[0] = r0' */
590 __ASM_EMIT("movss %%xmm1, 0x00(%[dst_im])") /* dst_im[0] = i0' */
591 __ASM_EMIT("add $0x04, %[src_re]") /* src_re++ */
592 __ASM_EMIT("add $0x04, %[src_im]") /* src_im++ */
593 __ASM_EMIT("add $0x04, %[dst_re]") /* dst_re++ */
594 __ASM_EMIT("add $0x04, %[dst_im]") /* dst_im++ */
595 __ASM_EMIT("dec %[count]") /* count-- */
596 __ASM_EMIT("jnz 40b")
597
598 __ASM_EMIT("50:")
599 : [dst_re] "+r" (dst_re), [dst_im] "+r" (dst_im),
600 [src_re] "+r" (src_re), [src_im] "+r" (src_im),
601 [count] "+r" (count)
602 : __IF_32([CC] "m" (complex_div_const), [save] "m" (save))
603 __IF_64([CC] "r" (complex_div_const))
604 : "cc", "memory",
605 "%xmm0", "%xmm1", "%xmm2", "%xmm4",
606 "%xmm5", "%xmm6"
607 );
608 }
609
610 void complex_rcp1(float *dst_re, float *dst_im, size_t count)
611 {
612 ARCH_X86_ASM (
613 /* Do block processing */
614 __ASM_EMIT("test %[count], %[count]")
615 __ASM_EMIT("jz 50f")
616
617 __ASM_EMIT("sub $8, %[count]") /* count -= 8 */
618 __ASM_EMIT("jb 2f")
619 __ASM_EMIT("1:")
620 /* Perform 8x RCP */
621 __ASM_EMIT("movups 0x00(%[dst_re]), %%xmm0") /* xmm0 = r0 */
622 __ASM_EMIT("movups 0x10(%[dst_re]), %%xmm2") /* xmm2 = r1 */
623 __ASM_EMIT("movups 0x00(%[dst_im]), %%xmm1") /* xmm1 = i0 */
624 __ASM_EMIT("movups 0x10(%[dst_im]), %%xmm3") /* xmm3 = i1 */
625 __ASM_EMIT("movaps %%xmm0, %%xmm4") /* xmm4 = r0 */
626 __ASM_EMIT("movaps %%xmm1, %%xmm5") /* xmm5 = i0 */
627 __ASM_EMIT("movaps %%xmm2, %%xmm6") /* xmm6 = r1 */
628 __ASM_EMIT("movaps %%xmm3, %%xmm7") /* xmm7 = i1 */
629 __ASM_EMIT("mulps %%xmm0, %%xmm4") /* xmm4 = r0*r0 */
630 __ASM_EMIT("mulps %%xmm1, %%xmm5") /* xmm5 = i0*i0 */
631 __ASM_EMIT("mulps %%xmm2, %%xmm6") /* xmm6 = r1*r1 */
632 __ASM_EMIT("mulps %%xmm3, %%xmm7") /* xmm7 = i1*i1 */
633 __ASM_EMIT("addps %%xmm5, %%xmm4") /* xmm4 = r0*r0 + i0*i0 */
634 __ASM_EMIT("addps %%xmm7, %%xmm6") /* xmm6 = r1*r1 + i1*i1 */
635 __ASM_EMIT("movaps 0x00(%[CC]), %%xmm5") /* xmm5 = 1 */
636 __ASM_EMIT("xorps 0x10(%[CC]), %%xmm1") /* xmm1 = -i0 */
637 __ASM_EMIT("movaps %%xmm5, %%xmm7") /* xmm7 = 1 */
638 __ASM_EMIT("xorps 0x10(%[CC]), %%xmm3") /* xmm3 = -i1 */
639 __ASM_EMIT("divps %%xmm4, %%xmm5") /* xmm5 = 1 / (r0*r0 + i0*i0) */
640 __ASM_EMIT("divps %%xmm6, %%xmm7") /* xmm7 = 1 / (r1*r1 + i1*i1) */
641 __ASM_EMIT("mulps %%xmm5, %%xmm0") /* xmm0 = r0' = r0 / (r0*r0 + i0*i0) */
642 __ASM_EMIT("mulps %%xmm7, %%xmm2") /* xmm2 = r1' = r1 / (r1*r1 + i1*i1) */
643 __ASM_EMIT("mulps %%xmm5, %%xmm1") /* xmm1 = i0' = -i0 / (r0*r0 + i0*i0) */
644 __ASM_EMIT("mulps %%xmm7, %%xmm3") /* xmm3 = i1' = -i1 / (r1*r1 + i1*i1) */
645 __ASM_EMIT("movups %%xmm0, 0x00(%[dst_re])") /* dst_re[0] = r0' */
646 __ASM_EMIT("movups %%xmm2, 0x10(%[dst_re])") /* dst_re[1] = r1' */
647 __ASM_EMIT("movups %%xmm1, 0x00(%[dst_im])") /* dst_im[0] = i0' */
648 __ASM_EMIT("movups %%xmm3, 0x10(%[dst_im])") /* dst_im[1] = i1' */
649 __ASM_EMIT("add $0x20, %[dst_re]") /* dst_re += 8 */
650 __ASM_EMIT("add $0x20, %[dst_im]") /* dst_im += 8 */
651 __ASM_EMIT("sub $8, %[count]") /* count -= 8 */
652 __ASM_EMIT("jae 1b")
653 /* 4x RCP */
654 __ASM_EMIT("2:")
655 __ASM_EMIT("add $4, %[count]") /* count += 4 */
656 __ASM_EMIT("jl 10f")
657 __ASM_EMIT("movups 0x00(%[dst_re]), %%xmm0") /* xmm0 = r0 */
658 __ASM_EMIT("movups 0x00(%[dst_im]), %%xmm1") /* xmm1 = i0 */
659 __ASM_EMIT("movaps %%xmm0, %%xmm4") /* xmm4 = r0 */
660 __ASM_EMIT("movaps %%xmm1, %%xmm5") /* xmm5 = i0 */
661 __ASM_EMIT("mulps %%xmm0, %%xmm4") /* xmm4 = r0*r0 */
662 __ASM_EMIT("mulps %%xmm1, %%xmm5") /* xmm5 = i0*i0 */
663 __ASM_EMIT("addps %%xmm5, %%xmm4") /* xmm4 = r0*r0 + i0*i0 */
664 __ASM_EMIT("movaps 0x00(%[CC]), %%xmm5") /* xmm5 = 1 */
665 __ASM_EMIT("xorps 0x10(%[CC]), %%xmm1") /* xmm1 = -i0 */
666 __ASM_EMIT("divps %%xmm4, %%xmm5") /* xmm5 = 1 / (r0*r0 + i0*i0) */
667 __ASM_EMIT("mulps %%xmm5, %%xmm0") /* xmm0 = r0' = r0 / (r0*r0 + i0*i0) */
668 __ASM_EMIT("mulps %%xmm5, %%xmm1") /* xmm1 = i0' = -i0 / (r0*r0 + i0*i0) */
669 __ASM_EMIT("movups %%xmm0, 0x00(%[dst_re])") /* dst_re[0] = r0' */
670 __ASM_EMIT("movups %%xmm1, 0x00(%[dst_im])") /* dst_im[0] = i0' */
671 __ASM_EMIT("add $0x10, %[dst_re]") /* dst_re += 4 */
672 __ASM_EMIT("add $0x10, %[dst_im]") /* dst_im += 4 */
673 __ASM_EMIT("sub $4, %[count]") /* count -= 4 */
674
675 /* 1x RCP */
676 __ASM_EMIT("10:")
677 __ASM_EMIT("add $4, %[count]") /* count += 4 */
678 __ASM_EMIT("jle 50f")
679 __ASM_EMIT("40:")
680 __ASM_EMIT("movss 0x00(%[dst_re]), %%xmm0") /* xmm0 = r0 */
681 __ASM_EMIT("movss 0x00(%[dst_im]), %%xmm1") /* xmm1 = i0 */
682 __ASM_EMIT("movaps %%xmm0, %%xmm4") /* xmm4 = r0 */
683 __ASM_EMIT("movaps %%xmm1, %%xmm5") /* xmm5 = i0 */
684 __ASM_EMIT("mulss %%xmm0, %%xmm4") /* xmm4 = r0*r0 */
685 __ASM_EMIT("mulss %%xmm1, %%xmm5") /* xmm5 = i0*i0 */
686 __ASM_EMIT("addss %%xmm5, %%xmm4") /* xmm4 = r0*r0 + i0*i0 */
687 __ASM_EMIT("movaps 0x00(%[CC]), %%xmm5") /* xmm5 = 1 */
688 __ASM_EMIT("xorps 0x10(%[CC]), %%xmm1") /* xmm1 = -i0 */
689 __ASM_EMIT("divss %%xmm4, %%xmm5") /* xmm5 = 1 / (r0*r0 + i0*i0) */
690 __ASM_EMIT("mulss %%xmm5, %%xmm0") /* xmm0 = r0' = r0 / (r0*r0 + i0*i0) */
691 __ASM_EMIT("mulss %%xmm5, %%xmm1") /* xmm1 = i0' = -i0 / (r0*r0 + i0*i0) */
692 __ASM_EMIT("movss %%xmm0, 0x00(%[dst_re])") /* dst_re[0] = r0' */
693 __ASM_EMIT("movss %%xmm1, 0x00(%[dst_im])") /* dst_im[0] = i0' */
694 __ASM_EMIT("add $0x04, %[dst_re]") /* dst_re++ */
695 __ASM_EMIT("add $0x04, %[dst_im]") /* dst_im++ */
696 __ASM_EMIT("dec %[count]") /* count-- */
697 __ASM_EMIT("jnz 40b")
698
699 __ASM_EMIT("50:")
700 : [dst_re] "+r" (dst_re), [dst_im] "+r" (dst_im),
701 [count] "+r" (count)
702 : [CC] "r" (complex_div_const)
703 : "cc", "memory",
704 "%xmm0", "%xmm1", "%xmm2", "%xmm3",
705 "%xmm4", "%xmm5", "%xmm6", "%xmm7"
706 );
707 }
708 } /* namespace sse */
709 } /* namespace lsp */
710
711 #endif /* PRIVATE_DSP_ARCH_X86_SSE_COMPLEX_H_ */