/*
* Copyright (C) 2023 Linux Studio Plugins Project
* (C) 2023 Vladimir Sadovnikov
*
* This file is part of lsp-dsp-lib
* Created on: 31 мар. 2020 г.
*
* lsp-dsp-lib is free software: you can redistribute it and/or modify
* it under the terms of the GNU Lesser General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* any later version.
*
* lsp-dsp-lib is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU Lesser General Public License for more details.
*
* You should have received a copy of the GNU Lesser General Public License
* along with lsp-dsp-lib. If not, see .
*/
#ifndef PRIVATE_DSP_ARCH_X86_SSE_COMPLEX_H_
#define PRIVATE_DSP_ARCH_X86_SSE_COMPLEX_H_
#ifndef PRIVATE_DSP_ARCH_X86_SSE_IMPL
#error "This header should not be included directly"
#endif /* PRIVATE_DSP_ARCH_X86_SSE_IMPL */
namespace lsp
{
namespace sse
{
void complex_mul2(float *dst_re, float *dst_im, const float *src_re, const float *src_im, size_t count)
{
IF_ARCH_X86(size_t off);
ARCH_X86_ASM
(
__ASM_EMIT ("xor %[off], %[off]")
/* x4 blocks */
__ASM_EMIT32("subl $4, %[count]")
__ASM_EMIT64("sub $4, %[count]")
__ASM_EMIT ("jb 2f")
__ASM_EMIT ("1:")
__ASM_EMIT ("movups 0x00(%[dst_re], %[off]), %%xmm0") /* xmm0 = ar0 ar1 ar2 ar3 */
__ASM_EMIT ("movups 0x00(%[src_re], %[off]), %%xmm4") /* xmm4 = br0 br1 br2 br3 */
__ASM_EMIT ("movups 0x00(%[dst_im], %[off]), %%xmm2") /* xmm2 = ai0 ai1 ai2 ai3 */
__ASM_EMIT ("movups 0x00(%[src_im], %[off]), %%xmm6") /* xmm6 = bi0 bi1 bi2 bi3 */
__ASM_EMIT ("movaps %%xmm0, %%xmm1") /* xmm1 = ar0 ar1 ar2 ar3 */
__ASM_EMIT ("mulps %%xmm4, %%xmm0") /* xmm0 = ar0*br0 ar1*br1 ar2*br2 ar3*br3 */
__ASM_EMIT ("mulps %%xmm6, %%xmm1") /* xmm1 = ar0*bi0 ar1*bi1 ar2*bi2 ar3*bi3 */
__ASM_EMIT ("mulps %%xmm2, %%xmm6") /* xmm6 = ai0*bi0 ai1*bi1 ai2*bi2 ai3*bi3 */
__ASM_EMIT ("mulps %%xmm2, %%xmm4") /* xmm4 = ai0*br0 ai1*br1 ai2*br2 ai3*br3 */
__ASM_EMIT ("addps %%xmm4, %%xmm1") /* xmm1 = ar[i]*bi[i] + ai[i]*br[i] = i0 i1 i2 i3 */
__ASM_EMIT ("subps %%xmm6, %%xmm0") /* xmm0 = ar[i]*br[i] - ai[i]*bi[i] = r0 r1 r2 r3 */
__ASM_EMIT ("movups %%xmm0, 0x00(%[dst_re], %[off])")
__ASM_EMIT ("movups %%xmm1, 0x00(%[dst_im], %[off])")
__ASM_EMIT ("add $0x10, %[off]")
__ASM_EMIT32("subl $4, %[count]")
__ASM_EMIT64("sub $4, %[count]")
__ASM_EMIT ("jae 1b")
__ASM_EMIT ("2:")
/* x1 blocks */
__ASM_EMIT32("addl $3, %[count]")
__ASM_EMIT64("add $3, %[count]")
__ASM_EMIT ("jl 4f")
__ASM_EMIT ("3:")
__ASM_EMIT ("movss 0x00(%[dst_re], %[off]), %%xmm0") /* xmm0 = ar */
__ASM_EMIT ("movss 0x00(%[src_re], %[off]), %%xmm4") /* xmm4 = br */
__ASM_EMIT ("movss 0x00(%[dst_im], %[off]), %%xmm2") /* xmm2 = ai */
__ASM_EMIT ("movss 0x00(%[src_im], %[off]), %%xmm6") /* xmm6 = bi */
__ASM_EMIT ("movaps %%xmm0, %%xmm1") /* xmm1 = ar */
__ASM_EMIT ("mulss %%xmm4, %%xmm0") /* xmm0 = ar*br */
__ASM_EMIT ("mulss %%xmm6, %%xmm1") /* xmm1 = ar*bi */
__ASM_EMIT ("mulss %%xmm2, %%xmm6") /* xmm6 = ai*bi */
__ASM_EMIT ("mulss %%xmm2, %%xmm4") /* xmm4 = ai*br */
__ASM_EMIT ("addss %%xmm4, %%xmm1") /* xmm1 = ar*bi + ai*br = i */
__ASM_EMIT ("subss %%xmm6, %%xmm0") /* xmm0 = ar*br - ai*bi = r */
__ASM_EMIT ("movss %%xmm0, 0x00(%[dst_re], %[off])")
__ASM_EMIT ("movss %%xmm1, 0x00(%[dst_im], %[off])")
__ASM_EMIT ("add $0x04, %[off]")
__ASM_EMIT32("decl %[count]")
__ASM_EMIT64("dec %[count]")
__ASM_EMIT ("jge 3b")
__ASM_EMIT ("4:")
/* end */
: [count] __ASM_ARG_RW(count), [off] "=&r" (off)
: [dst_re] "r" (dst_re), [dst_im] "r" (dst_im),
[src_re] "r" (src_re), [src_im] "r" (src_im)
: "cc", "memory",
"%xmm0", "%xmm1", "%xmm2", "%xmm4",
"%xmm5", "%xmm6"
);
}
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)
{
IF_ARCH_I386(float *ptr_re, *ptr_im);
IF_ARCH_X86(size_t off);
ARCH_X86_ASM
(
__ASM_EMIT ("xor %[off], %[off]")
/* x4 block */
__ASM_EMIT32("subl $4, %[count]")
__ASM_EMIT64("sub $4, %[count]")
__ASM_EMIT ("jb 2f")
__ASM_EMIT ("1:")
__ASM_EMIT32("mov %[src1_re], %[ptr_re]") \
__ASM_EMIT32("mov %[src1_im], %[ptr_im]") \
__ASM_EMIT ("movups 0x00(%[src2_re], %[off]), %%xmm4") /* xmm4 = br0 br1 br2 br3 */
__ASM_EMIT ("movups 0x00(%[src2_im], %[off]), %%xmm6") /* xmm6 = bi0 bi1 bi2 bi3 */
__ASM_EMIT32("movups 0x00(%[ptr_re], %[off]), %%xmm0") /* xmm0 = ar0 ar1 ar2 ar3 */
__ASM_EMIT32("movups 0x00(%[ptr_im], %[off]), %%xmm2") /* xmm2 = ai0 ai1 ai2 ai3 */
__ASM_EMIT64("movups 0x00(%[src1_re], %[off]), %%xmm0") /* xmm0 = ar0 ar1 ar2 ar3 */
__ASM_EMIT64("movups 0x00(%[src1_im], %[off]), %%xmm2") /* xmm2 = ai0 ai1 ai2 ai3 */
__ASM_EMIT32("mov %[dst_re], %[ptr_re]") \
__ASM_EMIT32("mov %[dst_im], %[ptr_im]") \
__ASM_EMIT ("movaps %%xmm0, %%xmm1") /* xmm1 = ar0 ar1 ar2 ar3 */
__ASM_EMIT ("mulps %%xmm4, %%xmm0") /* xmm0 = ar0*br0 ar1*br1 ar2*br2 ar3*br3 */
__ASM_EMIT ("mulps %%xmm6, %%xmm1") /* xmm1 = ar0*bi0 ar1*bi1 ar2*bi2 ar3*bi3 */
__ASM_EMIT ("mulps %%xmm2, %%xmm6") /* xmm6 = ai0*bi0 ai1*bi1 ai2*bi2 ai3*bi3 */
__ASM_EMIT ("mulps %%xmm2, %%xmm4") /* xmm4 = ai0*br0 ai1*br1 ai2*br2 ai3*br3 */
__ASM_EMIT ("addps %%xmm4, %%xmm1") /* xmm1 = ar[i]*bi[i] + ai[i]*br[i] = i0 i1 i2 i3 */
__ASM_EMIT ("subps %%xmm6, %%xmm0") /* xmm0 = ar[i]*br[i] - ai[i]*bi[i] = r0 r1 r2 r3 */
__ASM_EMIT32("movups %%xmm0, 0x00(%[ptr_re], %[off])")
__ASM_EMIT32("movups %%xmm1, 0x00(%[ptr_im], %[off])")
__ASM_EMIT64("movups %%xmm0, 0x00(%[dst_re], %[off])")
__ASM_EMIT64("movups %%xmm1, 0x00(%[dst_im], %[off])")
__ASM_EMIT ("add $0x10, %[off]")
__ASM_EMIT32("subl $4, %[count]")
__ASM_EMIT64("sub $4, %[count]")
__ASM_EMIT ("jae 1b")
__ASM_EMIT ("2:")
/* x1 blocks */
__ASM_EMIT32("addl $3, %[count]")
__ASM_EMIT64("add $3, %[count]")
__ASM_EMIT ("jl 4f")
__ASM_EMIT ("3:")
__ASM_EMIT32("mov %[src1_re], %[ptr_re]") \
__ASM_EMIT32("mov %[src1_im], %[ptr_im]") \
__ASM_EMIT ("movss 0x00(%[src2_re], %[off]), %%xmm4") /* xmm4 = br0 br1 br2 br3 */
__ASM_EMIT ("movss 0x00(%[src2_im], %[off]), %%xmm6") /* xmm6 = bi0 bi1 bi2 bi3 */
__ASM_EMIT32("movss 0x00(%[ptr_re], %[off]), %%xmm0") /* xmm0 = ar0 ar1 ar2 ar3 */
__ASM_EMIT32("movss 0x00(%[ptr_im], %[off]), %%xmm2") /* xmm2 = ai0 ai1 ai2 ai3 */
__ASM_EMIT64("movss 0x00(%[src1_re], %[off]), %%xmm0") /* xmm0 = ar0 ar1 ar2 ar3 */
__ASM_EMIT64("movss 0x00(%[src1_im], %[off]), %%xmm2") /* xmm2 = ai0 ai1 ai2 ai3 */
__ASM_EMIT32("mov %[dst_re], %[ptr_re]") \
__ASM_EMIT32("mov %[dst_im], %[ptr_im]") \
__ASM_EMIT ("movaps %%xmm0, %%xmm1") /* xmm1 = ar0 ar1 ar2 ar3 */
__ASM_EMIT ("mulss %%xmm4, %%xmm0") /* xmm0 = ar0*br0 ar1*br1 ar2*br2 ar3*br3 */
__ASM_EMIT ("mulss %%xmm6, %%xmm1") /* xmm1 = ar0*bi0 ar1*bi1 ar2*bi2 ar3*bi3 */
__ASM_EMIT ("mulss %%xmm2, %%xmm6") /* xmm6 = ai0*bi0 ai1*bi1 ai2*bi2 ai3*bi3 */
__ASM_EMIT ("mulss %%xmm2, %%xmm4") /* xmm4 = ai0*br0 ai1*br1 ai2*br2 ai3*br3 */
__ASM_EMIT ("addss %%xmm4, %%xmm1") /* xmm1 = ar[i]*bi[i] + ai[i]*br[i] = i0 i1 i2 i3 */
__ASM_EMIT ("subss %%xmm6, %%xmm0") /* xmm0 = ar[i]*br[i] - ai[i]*bi[i] = r0 r1 r2 r3 */
__ASM_EMIT32("movss %%xmm0, 0x00(%[ptr_re], %[off])")
__ASM_EMIT32("movss %%xmm1, 0x00(%[ptr_im], %[off])")
__ASM_EMIT64("movss %%xmm0, 0x00(%[dst_re], %[off])")
__ASM_EMIT64("movss %%xmm1, 0x00(%[dst_im], %[off])")
__ASM_EMIT ("add $0x04, %[off]")
__ASM_EMIT32("decl %[count]")
__ASM_EMIT64("dec %[count]")
__ASM_EMIT ("jge 3b")
__ASM_EMIT ("4:")
/* end */
: __IF_32(
[ptr_re] "=&r" (ptr_re), [ptr_im] "=&r" (ptr_im),
)
[count] "+r" (count), [off] "=&r" (off)
: [dst_re] X86_GREG (dst_re), [dst_im] X86_GREG (dst_im),
[src1_re] X86_GREG (src1_re), [src1_im] X86_GREG (src1_im),
[src2_re] "r" (src2_re), [src2_im] "r" (src2_im)
: "cc", "memory",
"%xmm0", "%xmm1", "%xmm2", "%xmm4", "%xmm5", "%xmm6"
);
}
IF_ARCH_X86(
static const uint32_t complex_div_const[] __lsp_aligned16 =
{
LSP_DSP_VEC4(0x3f800000), /* 1.0f */
LSP_DSP_VEC4(0x80000000) /* sign bit */
};
);
#define COMPLEX_DIV2_CORE(DSTR, DSTI, TR, TI, BR, BI) \
__ASM_EMIT ("xor %[off], %[off]") \
/* x4 blocks */ \
__ASM_EMIT32("subl $4, %[count]") \
__ASM_EMIT64("sub $4, %[count]") \
__ASM_EMIT ("jb 2f") \
__ASM_EMIT ("1:") \
__ASM_EMIT ("movups 0x00(%[" BR "], %[off]), %%xmm2") /* xmm2 = br */ \
__ASM_EMIT ("movups 0x00(%[" BI "], %[off]), %%xmm3") /* xmm3 = bi */ \
__ASM_EMIT ("movups 0x00(%[" TR "], %[off]), %%xmm0") /* xmm0 = tr */ \
__ASM_EMIT ("movups 0x00(%[" TI "], %[off]), %%xmm1") /* xmm1 = ti */ \
__ASM_EMIT ("movaps %%xmm2, %%xmm6") /* xmm6 = br */ \
__ASM_EMIT ("movaps %%xmm3, %%xmm7") /* xmm7 = bi */ \
__ASM_EMIT ("movaps %%xmm0, %%xmm4") /* xmm4 = tr */ \
__ASM_EMIT ("movaps %%xmm1, %%xmm5") /* xmm5 = ti */ \
__ASM_EMIT ("mulps %%xmm6, %%xmm6") /* xmm6 = br*br */ \
__ASM_EMIT ("mulps %%xmm7, %%xmm7") /* xmm7 = bi*bi */ \
__ASM_EMIT ("mulps %%xmm2, %%xmm0") /* xmm0 = tr*br */ \
__ASM_EMIT ("mulps %%xmm2, %%xmm1") /* xmm1 = ti*br */ \
__ASM_EMIT ("addps %%xmm6, %%xmm7") /* xmm7 = R = br*br + bi*bi */ \
__ASM_EMIT ("movaps 0x00 + %[CC], %%xmm6") /* xmm6 = 1 */ \
__ASM_EMIT ("mulps %%xmm3, %%xmm5") /* xmm5 = ti*bi */ \
__ASM_EMIT ("mulps %%xmm3, %%xmm4") /* xmm4 = tr*bi */ \
__ASM_EMIT ("divps %%xmm7, %%xmm6") /* xmm6 = 1/R */ \
__ASM_EMIT ("addps %%xmm5, %%xmm0") /* xmm0 = r = tr*br + ti*bi */ \
__ASM_EMIT ("subps %%xmm4, %%xmm1") /* xmm1 = i = ti*br - tr*bi */ \
__ASM_EMIT ("mulps %%xmm6, %%xmm0") /* xmm0 = r/R */ \
__ASM_EMIT ("mulps %%xmm6, %%xmm1") /* xmm1 = i/R */ \
__ASM_EMIT ("movups %%xmm0, 0x00(%[" DSTR "], %[off])") \
__ASM_EMIT ("movups %%xmm1, 0x00(%[" DSTI "], %[off])") \
__ASM_EMIT ("add $0x10, %[off]") \
__ASM_EMIT32("subl $4, %[count]") \
__ASM_EMIT64("sub $4, %[count]") \
__ASM_EMIT ("jae 1b") \
__ASM_EMIT ("2:") \
/* x1 blocks */ \
__ASM_EMIT32("addl $3, %[count]") \
__ASM_EMIT64("add $3, %[count]") \
__ASM_EMIT ("jl 4f") \
__ASM_EMIT ("3:") \
__ASM_EMIT ("movss 0x00(%[" BR "], %[off]), %%xmm2") /* xmm2 = br */ \
__ASM_EMIT ("movss 0x00(%[" BI "], %[off]), %%xmm3") /* xmm3 = bi */ \
__ASM_EMIT ("movss 0x00(%[" TR "], %[off]), %%xmm0") /* xmm0 = tr */ \
__ASM_EMIT ("movss 0x00(%[" TI "], %[off]), %%xmm1") /* xmm1 = ti */ \
__ASM_EMIT ("movaps %%xmm2, %%xmm6") /* xmm6 = br */ \
__ASM_EMIT ("movaps %%xmm3, %%xmm7") /* xmm7 = bi */ \
__ASM_EMIT ("movaps %%xmm0, %%xmm4") /* xmm4 = tr */ \
__ASM_EMIT ("movaps %%xmm1, %%xmm5") /* xmm5 = ti */ \
__ASM_EMIT ("mulss %%xmm6, %%xmm6") /* xmm6 = br*br */ \
__ASM_EMIT ("mulss %%xmm7, %%xmm7") /* xmm7 = bi*bi */ \
__ASM_EMIT ("mulss %%xmm2, %%xmm0") /* xmm0 = tr*br */ \
__ASM_EMIT ("mulss %%xmm2, %%xmm1") /* xmm1 = ti*br */ \
__ASM_EMIT ("addss %%xmm6, %%xmm7") /* xmm7 = R = br*br + bi*bi */ \
__ASM_EMIT ("movaps 0x00 + %[CC], %%xmm6") /* xmm6 = 1 */ \
__ASM_EMIT ("mulss %%xmm3, %%xmm5") /* xmm5 = ti*bi */ \
__ASM_EMIT ("mulss %%xmm3, %%xmm4") /* xmm4 = tr*bi */ \
__ASM_EMIT ("divss %%xmm7, %%xmm6") /* xmm6 = 1/R */ \
__ASM_EMIT ("addss %%xmm5, %%xmm0") /* xmm0 = r = tr*br + ti*bi */ \
__ASM_EMIT ("subss %%xmm4, %%xmm1") /* xmm1 = i = ti*br - tr*bi */ \
__ASM_EMIT ("mulss %%xmm6, %%xmm0") /* xmm0 = r/R */ \
__ASM_EMIT ("mulss %%xmm6, %%xmm1") /* xmm1 = i/R */ \
__ASM_EMIT ("movss %%xmm0, 0x00(%[" DSTR "], %[off])") \
__ASM_EMIT ("movss %%xmm1, 0x00(%[" DSTI "], %[off])") \
__ASM_EMIT ("add $0x04, %[off]") \
__ASM_EMIT32("decl %[count]") \
__ASM_EMIT64("dec %[count]") \
__ASM_EMIT ("jge 3b") \
__ASM_EMIT ("4:") \
/* end */
void complex_div2(float *dst_re, float *dst_im, const float *src_re, const float *src_im, size_t count)
{
IF_ARCH_X86(size_t off);
ARCH_X86_ASM
(
COMPLEX_DIV2_CORE("dst_re", "dst_im", "dst_re", "dst_im", "src_re", "src_im")
: [off] "=&r" (off),
[count] X86_PGREG(count)
: [dst_re] "r" (dst_re), [dst_im] "r" (dst_im),
[src_re] "r" (src_re), [src_im] "r" (src_im),
[CC] "o" (complex_div_const)
: "cc", "memory",
"%xmm0", "%xmm1", "%xmm2", "%xmm3",
"%xmm4", "%xmm5", "%xmm6", "%xmm7"
);
}
void complex_rdiv2(float *dst_re, float *dst_im, const float *src_re, const float *src_im, size_t count)
{
IF_ARCH_X86(size_t off);
ARCH_X86_ASM
(
COMPLEX_DIV2_CORE("dst_re", "dst_im", "src_re", "src_im", "dst_re", "dst_im")
: [off] "=&r" (off),
[count] X86_PGREG(count)
: [dst_re] "r" (dst_re), [dst_im] "r" (dst_im),
[src_re] "r" (src_re), [src_im] "r" (src_im),
[CC] "o" (complex_div_const)
: "cc", "memory",
"%xmm0", "%xmm1", "%xmm2", "%xmm3",
"%xmm4", "%xmm5", "%xmm6", "%xmm7"
);
}
#undef COMPLEX_DIV2_CORE
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)
{
IF_ARCH_I386(float *ptr_re, *ptr_im);
IF_ARCH_X86(size_t off);
ARCH_X86_ASM
(
__ASM_EMIT ("xor %[off], %[off]")
// x4 blocks
__ASM_EMIT32("subl $4, %[count]") \
__ASM_EMIT64("sub $4, %[count]") \
__ASM_EMIT ("jb 2f")
__ASM_EMIT ("1:")
__ASM_EMIT32("mov %[t_re], %[ptr_re]")
__ASM_EMIT32("mov %[t_im], %[ptr_im]")
__ASM_EMIT ("movups 0x00(%[b_re], %[off]), %%xmm2") // xmm2 = br
__ASM_EMIT ("movups 0x00(%[b_im], %[off]), %%xmm3") // xmm3 = bi
__ASM_EMIT32("movups 0x00(%[ptr_re], %[off]), %%xmm0") // xmm0 = tr
__ASM_EMIT32("movups 0x00(%[ptr_im], %[off]), %%xmm1") // xmm1 = ti
__ASM_EMIT64("movups 0x00(%[t_re], %[off]), %%xmm0") // xmm0 = tr
__ASM_EMIT64("movups 0x00(%[t_im], %[off]), %%xmm1") // xmm1 = ti
__ASM_EMIT32("mov %[dst_re], %[ptr_re]")
__ASM_EMIT32("mov %[dst_im], %[ptr_im]")
__ASM_EMIT ("movaps %%xmm2, %%xmm6") /* xmm6 = br */
__ASM_EMIT ("movaps %%xmm3, %%xmm7") /* xmm7 = bi */
__ASM_EMIT ("movaps %%xmm0, %%xmm4") /* xmm4 = tr */
__ASM_EMIT ("movaps %%xmm1, %%xmm5") /* xmm5 = ti */
__ASM_EMIT ("mulps %%xmm6, %%xmm6") /* xmm6 = br*br */
__ASM_EMIT ("mulps %%xmm7, %%xmm7") /* xmm7 = bi*bi */
__ASM_EMIT ("mulps %%xmm2, %%xmm0") /* xmm0 = tr*br */
__ASM_EMIT ("mulps %%xmm2, %%xmm1") /* xmm1 = ti*br */
__ASM_EMIT ("addps %%xmm6, %%xmm7") /* xmm7 = R = br*br + bi*bi */
__ASM_EMIT ("movaps 0x00 + %[CC], %%xmm6") /* xmm6 = 1 */
__ASM_EMIT ("mulps %%xmm3, %%xmm5") /* xmm5 = ti*bi */
__ASM_EMIT ("mulps %%xmm3, %%xmm4") /* xmm4 = tr*bi */
__ASM_EMIT ("divps %%xmm7, %%xmm6") /* xmm6 = 1/R */
__ASM_EMIT ("addps %%xmm5, %%xmm0") /* xmm0 = r = tr*br + ti*bi */
__ASM_EMIT ("subps %%xmm4, %%xmm1") /* xmm1 = i = ti*br - tr*bi */
__ASM_EMIT ("mulps %%xmm6, %%xmm0") /* xmm0 = r/R */
__ASM_EMIT ("mulps %%xmm6, %%xmm1") /* xmm1 = i/R */
__ASM_EMIT32("movups %%xmm0, 0x00(%[ptr_re], %[off])")
__ASM_EMIT32("movups %%xmm1, 0x00(%[ptr_im], %[off])")
__ASM_EMIT64("movups %%xmm0, 0x00(%[dst_re], %[off])")
__ASM_EMIT64("movups %%xmm1, 0x00(%[dst_im], %[off])")
__ASM_EMIT ("add $0x10, %[off]")
__ASM_EMIT32("subl $4, %[count]") \
__ASM_EMIT64("sub $4, %[count]") \
__ASM_EMIT ("jae 1b")
__ASM_EMIT ("2:")
// x1 blocks
__ASM_EMIT32("addl $3, %[count]") \
__ASM_EMIT64("add $3, %[count]") \
__ASM_EMIT ("jl 4f")
__ASM_EMIT ("3:")
__ASM_EMIT32("mov %[t_re], %[ptr_re]")
__ASM_EMIT32("mov %[t_im], %[ptr_im]")
__ASM_EMIT ("movss 0x00(%[b_re], %[off]), %%xmm2") // xmm2 = br
__ASM_EMIT ("movss 0x00(%[b_im], %[off]), %%xmm3") // xmm3 = bi
__ASM_EMIT32("movss 0x00(%[ptr_re], %[off]), %%xmm0") // xmm0 = tr
__ASM_EMIT32("movss 0x00(%[ptr_im], %[off]), %%xmm1") // xmm1 = ti
__ASM_EMIT64("movss 0x00(%[t_re], %[off]), %%xmm0") // xmm0 = tr
__ASM_EMIT64("movss 0x00(%[t_im], %[off]), %%xmm1") // xmm1 = ti
__ASM_EMIT32("mov %[dst_re], %[ptr_re]")
__ASM_EMIT32("mov %[dst_im], %[ptr_im]")
__ASM_EMIT ("movaps %%xmm2, %%xmm6") /* xmm6 = br */ \
__ASM_EMIT ("movaps %%xmm3, %%xmm7") /* xmm7 = bi */ \
__ASM_EMIT ("movaps %%xmm0, %%xmm4") /* xmm4 = tr */ \
__ASM_EMIT ("movaps %%xmm1, %%xmm5") /* xmm5 = ti */ \
__ASM_EMIT ("mulss %%xmm6, %%xmm6") /* xmm6 = br*br */ \
__ASM_EMIT ("mulss %%xmm7, %%xmm7") /* xmm7 = bi*bi */ \
__ASM_EMIT ("mulss %%xmm2, %%xmm0") /* xmm0 = tr*br */ \
__ASM_EMIT ("mulss %%xmm2, %%xmm1") /* xmm1 = ti*br */ \
__ASM_EMIT ("addss %%xmm6, %%xmm7") /* xmm7 = R = br*br + bi*bi */ \
__ASM_EMIT ("movaps 0x00 + %[CC], %%xmm6") /* xmm6 = 1 */ \
__ASM_EMIT ("mulss %%xmm3, %%xmm5") /* xmm5 = ti*bi */ \
__ASM_EMIT ("mulss %%xmm3, %%xmm4") /* xmm4 = tr*bi */ \
__ASM_EMIT ("divss %%xmm7, %%xmm6") /* xmm6 = 1/R */ \
__ASM_EMIT ("addss %%xmm5, %%xmm0") /* xmm0 = r = tr*br + ti*bi */ \
__ASM_EMIT ("subss %%xmm4, %%xmm1") /* xmm1 = i = ti*br - tr*bi */ \
__ASM_EMIT ("mulss %%xmm6, %%xmm0") /* xmm0 = r/R */ \
__ASM_EMIT ("mulss %%xmm6, %%xmm1") /* xmm1 = i/R */ \
__ASM_EMIT32("movss %%xmm0, 0x00(%[ptr_re], %[off])")
__ASM_EMIT32("movss %%xmm1, 0x00(%[ptr_im], %[off])")
__ASM_EMIT64("movss %%xmm0, 0x00(%[dst_re], %[off])")
__ASM_EMIT64("movss %%xmm1, 0x00(%[dst_im], %[off])")
__ASM_EMIT ("add $0x04, %[off]")
__ASM_EMIT32("decl %[count]") \
__ASM_EMIT64("dec %[count]") \
__ASM_EMIT ("jge 3b")
__ASM_EMIT ("4:")
/* end */
: __IF_32(
[ptr_re] "=&r" (ptr_re), [ptr_im] "=&r" (ptr_im),
)
[count] X86_PGREG(count), [off] "=&r" (off)
: [dst_re] X86_GREG (dst_re), [dst_im] X86_GREG (dst_im),
[t_re] X86_GREG (t_re), [t_im] X86_GREG (t_im),
[b_re] "r" (b_re), [b_im] "r" (b_im),
[CC] "o" (complex_div_const)
: "cc", "memory",
"%xmm0", "%xmm1", "%xmm2", "%xmm3",
"%xmm4", "%xmm5", "%xmm6", "%xmm7"
);
}
void complex_mod(float *dst, const float *src_re, const float *src_im, size_t count)
{
size_t off;
ARCH_X86_ASM
(
__ASM_EMIT("xor %[off], %[off]")
__ASM_EMIT("sub $16, %[count]")
__ASM_EMIT("jb 2f")
// 16x blocks
__ASM_EMIT("1:")
__ASM_EMIT("movups 0x00(%[src_re], %[off]), %%xmm0")
__ASM_EMIT("movups 0x10(%[src_re], %[off]), %%xmm1")
__ASM_EMIT("movups 0x20(%[src_re], %[off]), %%xmm2")
__ASM_EMIT("movups 0x30(%[src_re], %[off]), %%xmm3")
__ASM_EMIT("movups 0x00(%[src_im], %[off]), %%xmm4")
__ASM_EMIT("movups 0x10(%[src_im], %[off]), %%xmm5")
__ASM_EMIT("movups 0x20(%[src_im], %[off]), %%xmm6")
__ASM_EMIT("movups 0x30(%[src_im], %[off]), %%xmm7")
__ASM_EMIT("mulps %%xmm0, %%xmm0")
__ASM_EMIT("mulps %%xmm1, %%xmm1")
__ASM_EMIT("mulps %%xmm2, %%xmm2")
__ASM_EMIT("mulps %%xmm3, %%xmm3")
__ASM_EMIT("mulps %%xmm4, %%xmm4")
__ASM_EMIT("mulps %%xmm5, %%xmm5")
__ASM_EMIT("mulps %%xmm6, %%xmm6")
__ASM_EMIT("mulps %%xmm7, %%xmm7")
__ASM_EMIT("addps %%xmm4, %%xmm0")
__ASM_EMIT("addps %%xmm5, %%xmm1")
__ASM_EMIT("addps %%xmm6, %%xmm2")
__ASM_EMIT("addps %%xmm7, %%xmm3")
__ASM_EMIT("sqrtps %%xmm0, %%xmm0")
__ASM_EMIT("sqrtps %%xmm1, %%xmm1")
__ASM_EMIT("sqrtps %%xmm2, %%xmm2")
__ASM_EMIT("sqrtps %%xmm3, %%xmm3")
__ASM_EMIT("movups %%xmm0, 0x00(%[dst], %[off])")
__ASM_EMIT("movups %%xmm1, 0x10(%[dst], %[off])")
__ASM_EMIT("movups %%xmm2, 0x20(%[dst], %[off])")
__ASM_EMIT("movups %%xmm3, 0x30(%[dst], %[off])")
__ASM_EMIT("add $0x40, %[off]")
__ASM_EMIT("sub $16, %[count]")
__ASM_EMIT("jae 1b")
// 4x blocks
__ASM_EMIT("2:")
__ASM_EMIT("add $12, %[count]")
__ASM_EMIT("jl 4f")
__ASM_EMIT("3:")
__ASM_EMIT("movups 0x00(%[src_re], %[off]), %%xmm0")
__ASM_EMIT("movups 0x00(%[src_im], %[off]), %%xmm4")
__ASM_EMIT("mulps %%xmm0, %%xmm0")
__ASM_EMIT("mulps %%xmm4, %%xmm4")
__ASM_EMIT("addps %%xmm4, %%xmm0")
__ASM_EMIT("sqrtps %%xmm0, %%xmm0")
__ASM_EMIT("movups %%xmm0, 0x00(%[dst], %[off])")
__ASM_EMIT("add $0x10, %[off]")
__ASM_EMIT("sub $4, %[count]")
__ASM_EMIT("jae 3b")
// 1x blocks
__ASM_EMIT("4:")
__ASM_EMIT("add $3, %[count]")
__ASM_EMIT("jl 6f")
__ASM_EMIT("5:")
__ASM_EMIT("movss 0x00(%[src_re], %[off]), %%xmm0")
__ASM_EMIT("movss 0x00(%[src_im], %[off]), %%xmm4")
__ASM_EMIT("mulss %%xmm0, %%xmm0")
__ASM_EMIT("mulss %%xmm4, %%xmm4")
__ASM_EMIT("addss %%xmm4, %%xmm0")
__ASM_EMIT("sqrtss %%xmm0, %%xmm0")
__ASM_EMIT("movss %%xmm0, 0x00(%[dst], %[off])")
__ASM_EMIT("add $0x4, %[off]")
__ASM_EMIT("dec %[count]")
__ASM_EMIT("jge 5b")
// End
__ASM_EMIT("6:")
: [dst] "+r" (dst), [src_re] "+r" (src_re), [src_im] "+r"(src_im),
[count] "+r" (count), [off] "=&r" (off)
:
: "cc", "memory",
"%xmm0", "%xmm1", "%xmm2", "%xmm3",
"%xmm4", "%xmm5", "%xmm6", "%xmm7"
);
}
void complex_rcp2(float *dst_re, float *dst_im, const float *src_re, const float *src_im, size_t count)
{
IF_ARCH_I386(float **save);
ARCH_X86_ASM (
/* Do block processing */
__ASM_EMIT("test %[count], %[count]")
__ASM_EMIT("jz 50f")
__ASM_EMIT("sub $8, %[count]") /* count -= 8 */
__ASM_EMIT("jb 2f")
__ASM_EMIT("1:")
/* Perform 8x RCP */
__ASM_EMIT("movups 0x00(%[src_re]), %%xmm0") /* xmm0 = r0 */
__ASM_EMIT("movups 0x10(%[src_re]), %%xmm2") /* xmm2 = r1 */
__ASM_EMIT("movups 0x00(%[src_im]), %%xmm1") /* xmm1 = i0 */
__ASM_EMIT("movups 0x10(%[src_im]), %%xmm3") /* xmm3 = i1 */
__ASM_EMIT32("mov %[src_re], %[save]") /* *save = src_re */
__ASM_EMIT("movaps %%xmm0, %%xmm4") /* xmm4 = r0 */
__ASM_EMIT("movaps %%xmm1, %%xmm5") /* xmm5 = i0 */
__ASM_EMIT("movaps %%xmm2, %%xmm6") /* xmm6 = r1 */
__ASM_EMIT("movaps %%xmm3, %%xmm7") /* xmm7 = i1 */
__ASM_EMIT("mulps %%xmm0, %%xmm4") /* xmm4 = r0*r0 */
__ASM_EMIT("mulps %%xmm1, %%xmm5") /* xmm5 = i0*i0 */
__ASM_EMIT("mulps %%xmm2, %%xmm6") /* xmm6 = r1*r1 */
__ASM_EMIT("mulps %%xmm3, %%xmm7") /* xmm7 = i1*i1 */
__ASM_EMIT("addps %%xmm5, %%xmm4") /* xmm4 = r0*r0 + i0*i0 */
__ASM_EMIT("addps %%xmm7, %%xmm6") /* xmm6 = r1*r1 + i1*i1 */
__ASM_EMIT32("lea %[CC], %[src_re]")
__ASM_EMIT32("movaps 0x00(%[src_re]), %%xmm5") /* xmm5 = 1 */
__ASM_EMIT32("xorps 0x10(%[src_re]), %%xmm1") /* xmm1 = -i0 */
__ASM_EMIT64("movaps 0x00(%[CC]), %%xmm5") /* xmm5 = 1 */
__ASM_EMIT64("xorps 0x10(%[CC]), %%xmm1") /* xmm1 = -i0 */
__ASM_EMIT("movaps %%xmm5, %%xmm7") /* xmm7 = 1 */
__ASM_EMIT32("xorps 0x10(%[src_re]), %%xmm3") /* xmm3 = -i1 */
__ASM_EMIT64("xorps 0x10(%[CC]), %%xmm3") /* xmm3 = -i1 */
__ASM_EMIT("divps %%xmm4, %%xmm5") /* xmm5 = 1 / (r0*r0 + i0*i0) */
__ASM_EMIT("divps %%xmm6, %%xmm7") /* xmm7 = 1 / (r1*r1 + i1*i1) */
__ASM_EMIT("mulps %%xmm5, %%xmm0") /* xmm0 = r0' = r0 / (r0*r0 + i0*i0) */
__ASM_EMIT("mulps %%xmm7, %%xmm2") /* xmm2 = r1' = r1 / (r1*r1 + i1*i1) */
__ASM_EMIT("mulps %%xmm5, %%xmm1") /* xmm1 = i0' = -i0 / (r0*r0 + i0*i0) */
__ASM_EMIT("mulps %%xmm7, %%xmm3") /* xmm3 = i1' = -i1 / (r1*r1 + i1*i1) */
__ASM_EMIT32("mov %[save], %[src_re]") /* src_re= *save */
__ASM_EMIT("movups %%xmm0, 0x00(%[dst_re])") /* dst_re[0] = r0' */
__ASM_EMIT("movups %%xmm2, 0x10(%[dst_re])") /* dst_re[1] = r1' */
__ASM_EMIT("movups %%xmm1, 0x00(%[dst_im])") /* dst_im[0] = i0' */
__ASM_EMIT("movups %%xmm3, 0x10(%[dst_im])") /* dst_im[1] = i1' */
__ASM_EMIT("add $0x20, %[src_re]") /* src_re += 8 */
__ASM_EMIT("add $0x20, %[src_im]") /* src_im += 8 */
__ASM_EMIT("add $0x20, %[dst_re]") /* dst_re += 8 */
__ASM_EMIT("add $0x20, %[dst_im]") /* dst_im += 8 */
__ASM_EMIT("sub $8, %[count]") /* count -= 8 */
__ASM_EMIT("jae 1b")
/* 4x RCP */
__ASM_EMIT("2:")
__ASM_EMIT("add $4, %[count]") /* count += 4 */
__ASM_EMIT("jl 10f")
__ASM_EMIT("movups 0x00(%[src_re]), %%xmm0") /* xmm0 = r0 */
__ASM_EMIT("movups 0x00(%[src_im]), %%xmm1") /* xmm1 = i0 */
__ASM_EMIT32("mov %[src_re], %[save]") /* *save = src_re */
__ASM_EMIT("movaps %%xmm0, %%xmm4") /* xmm4 = r0 */
__ASM_EMIT("movaps %%xmm1, %%xmm5") /* xmm5 = i0 */
__ASM_EMIT("mulps %%xmm0, %%xmm4") /* xmm4 = r0*r0 */
__ASM_EMIT("mulps %%xmm1, %%xmm5") /* xmm5 = i0*i0 */
__ASM_EMIT("addps %%xmm5, %%xmm4") /* xmm4 = r0*r0 + i0*i0 */
__ASM_EMIT32("lea %[CC], %[src_re]")
__ASM_EMIT32("movaps 0x00(%[src_re]), %%xmm5") /* xmm5 = 1 */
__ASM_EMIT32("xorps 0x10(%[src_re]), %%xmm1") /* xmm1 = -i0 */
__ASM_EMIT64("movaps 0x00(%[CC]), %%xmm5") /* xmm5 = 1 */
__ASM_EMIT64("xorps 0x10(%[CC]), %%xmm1") /* xmm1 = -i0 */
__ASM_EMIT("divps %%xmm4, %%xmm5") /* xmm5 = 1 / (r0*r0 + i0*i0) */
__ASM_EMIT("mulps %%xmm5, %%xmm0") /* xmm0 = r0' = r0 / (r0*r0 + i0*i0) */
__ASM_EMIT("mulps %%xmm5, %%xmm1") /* xmm1 = i0' = -i0 / (r0*r0 + i0*i0) */
__ASM_EMIT32("mov %[save], %[src_re]") /* src_re= *save */
__ASM_EMIT("movups %%xmm0, 0x00(%[dst_re])") /* dst_re[0] = r0' */
__ASM_EMIT("movups %%xmm1, 0x00(%[dst_im])") /* dst_im[0] = i0' */
__ASM_EMIT("add $0x10, %[src_re]") /* src_re += 4 */
__ASM_EMIT("add $0x10, %[src_im]") /* src_im += 4 */
__ASM_EMIT("add $0x10, %[dst_re]") /* dst_re += 4 */
__ASM_EMIT("add $0x10, %[dst_im]") /* dst_im += 4 */
__ASM_EMIT("sub $4, %[count]") /* count -= 4 */
/* 1x RCP */
__ASM_EMIT("10:")
__ASM_EMIT("add $4, %[count]") /* count += 4 */
__ASM_EMIT("jle 50f")
__ASM_EMIT("40:")
__ASM_EMIT("movss 0x00(%[src_re]), %%xmm0") /* xmm0 = r0 */
__ASM_EMIT("movss 0x00(%[src_im]), %%xmm1") /* xmm1 = i0 */
__ASM_EMIT32("mov %[src_re], %[save]") /* *save = src_re */
__ASM_EMIT("movaps %%xmm0, %%xmm4") /* xmm4 = r0 */
__ASM_EMIT("movaps %%xmm1, %%xmm5") /* xmm5 = i0 */
__ASM_EMIT("mulss %%xmm0, %%xmm4") /* xmm4 = r0*r0 */
__ASM_EMIT("mulss %%xmm1, %%xmm5") /* xmm5 = i0*i0 */
__ASM_EMIT("addss %%xmm5, %%xmm4") /* xmm4 = r0*r0 + i0*i0 */
__ASM_EMIT32("lea %[CC], %[src_re]")
__ASM_EMIT32("movaps 0x00(%[src_re]), %%xmm5") /* xmm5 = 1 */
__ASM_EMIT32("xorps 0x10(%[src_re]), %%xmm1") /* xmm1 = -i0 */
__ASM_EMIT64("movaps 0x00(%[CC]), %%xmm5") /* xmm5 = 1 */
__ASM_EMIT64("xorps 0x10(%[CC]), %%xmm1") /* xmm1 = -i0 */
__ASM_EMIT("divss %%xmm4, %%xmm5") /* xmm5 = 1 / (r0*r0 + i0*i0) */
__ASM_EMIT("mulss %%xmm5, %%xmm0") /* xmm0 = r0' = r0 / (r0*r0 + i0*i0) */
__ASM_EMIT("mulss %%xmm5, %%xmm1") /* xmm1 = i0' = -i0 / (r0*r0 + i0*i0) */
__ASM_EMIT32("mov %[save], %[src_re]") /* src_re= *save */
__ASM_EMIT("movss %%xmm0, 0x00(%[dst_re])") /* dst_re[0] = r0' */
__ASM_EMIT("movss %%xmm1, 0x00(%[dst_im])") /* dst_im[0] = i0' */
__ASM_EMIT("add $0x04, %[src_re]") /* src_re++ */
__ASM_EMIT("add $0x04, %[src_im]") /* src_im++ */
__ASM_EMIT("add $0x04, %[dst_re]") /* dst_re++ */
__ASM_EMIT("add $0x04, %[dst_im]") /* dst_im++ */
__ASM_EMIT("dec %[count]") /* count-- */
__ASM_EMIT("jnz 40b")
__ASM_EMIT("50:")
: [dst_re] "+r" (dst_re), [dst_im] "+r" (dst_im),
[src_re] "+r" (src_re), [src_im] "+r" (src_im),
[count] "+r" (count)
: __IF_32([CC] "m" (complex_div_const), [save] "m" (save))
__IF_64([CC] "r" (complex_div_const))
: "cc", "memory",
"%xmm0", "%xmm1", "%xmm2", "%xmm4",
"%xmm5", "%xmm6"
);
}
void complex_rcp1(float *dst_re, float *dst_im, size_t count)
{
ARCH_X86_ASM (
/* Do block processing */
__ASM_EMIT("test %[count], %[count]")
__ASM_EMIT("jz 50f")
__ASM_EMIT("sub $8, %[count]") /* count -= 8 */
__ASM_EMIT("jb 2f")
__ASM_EMIT("1:")
/* Perform 8x RCP */
__ASM_EMIT("movups 0x00(%[dst_re]), %%xmm0") /* xmm0 = r0 */
__ASM_EMIT("movups 0x10(%[dst_re]), %%xmm2") /* xmm2 = r1 */
__ASM_EMIT("movups 0x00(%[dst_im]), %%xmm1") /* xmm1 = i0 */
__ASM_EMIT("movups 0x10(%[dst_im]), %%xmm3") /* xmm3 = i1 */
__ASM_EMIT("movaps %%xmm0, %%xmm4") /* xmm4 = r0 */
__ASM_EMIT("movaps %%xmm1, %%xmm5") /* xmm5 = i0 */
__ASM_EMIT("movaps %%xmm2, %%xmm6") /* xmm6 = r1 */
__ASM_EMIT("movaps %%xmm3, %%xmm7") /* xmm7 = i1 */
__ASM_EMIT("mulps %%xmm0, %%xmm4") /* xmm4 = r0*r0 */
__ASM_EMIT("mulps %%xmm1, %%xmm5") /* xmm5 = i0*i0 */
__ASM_EMIT("mulps %%xmm2, %%xmm6") /* xmm6 = r1*r1 */
__ASM_EMIT("mulps %%xmm3, %%xmm7") /* xmm7 = i1*i1 */
__ASM_EMIT("addps %%xmm5, %%xmm4") /* xmm4 = r0*r0 + i0*i0 */
__ASM_EMIT("addps %%xmm7, %%xmm6") /* xmm6 = r1*r1 + i1*i1 */
__ASM_EMIT("movaps 0x00(%[CC]), %%xmm5") /* xmm5 = 1 */
__ASM_EMIT("xorps 0x10(%[CC]), %%xmm1") /* xmm1 = -i0 */
__ASM_EMIT("movaps %%xmm5, %%xmm7") /* xmm7 = 1 */
__ASM_EMIT("xorps 0x10(%[CC]), %%xmm3") /* xmm3 = -i1 */
__ASM_EMIT("divps %%xmm4, %%xmm5") /* xmm5 = 1 / (r0*r0 + i0*i0) */
__ASM_EMIT("divps %%xmm6, %%xmm7") /* xmm7 = 1 / (r1*r1 + i1*i1) */
__ASM_EMIT("mulps %%xmm5, %%xmm0") /* xmm0 = r0' = r0 / (r0*r0 + i0*i0) */
__ASM_EMIT("mulps %%xmm7, %%xmm2") /* xmm2 = r1' = r1 / (r1*r1 + i1*i1) */
__ASM_EMIT("mulps %%xmm5, %%xmm1") /* xmm1 = i0' = -i0 / (r0*r0 + i0*i0) */
__ASM_EMIT("mulps %%xmm7, %%xmm3") /* xmm3 = i1' = -i1 / (r1*r1 + i1*i1) */
__ASM_EMIT("movups %%xmm0, 0x00(%[dst_re])") /* dst_re[0] = r0' */
__ASM_EMIT("movups %%xmm2, 0x10(%[dst_re])") /* dst_re[1] = r1' */
__ASM_EMIT("movups %%xmm1, 0x00(%[dst_im])") /* dst_im[0] = i0' */
__ASM_EMIT("movups %%xmm3, 0x10(%[dst_im])") /* dst_im[1] = i1' */
__ASM_EMIT("add $0x20, %[dst_re]") /* dst_re += 8 */
__ASM_EMIT("add $0x20, %[dst_im]") /* dst_im += 8 */
__ASM_EMIT("sub $8, %[count]") /* count -= 8 */
__ASM_EMIT("jae 1b")
/* 4x RCP */
__ASM_EMIT("2:")
__ASM_EMIT("add $4, %[count]") /* count += 4 */
__ASM_EMIT("jl 10f")
__ASM_EMIT("movups 0x00(%[dst_re]), %%xmm0") /* xmm0 = r0 */
__ASM_EMIT("movups 0x00(%[dst_im]), %%xmm1") /* xmm1 = i0 */
__ASM_EMIT("movaps %%xmm0, %%xmm4") /* xmm4 = r0 */
__ASM_EMIT("movaps %%xmm1, %%xmm5") /* xmm5 = i0 */
__ASM_EMIT("mulps %%xmm0, %%xmm4") /* xmm4 = r0*r0 */
__ASM_EMIT("mulps %%xmm1, %%xmm5") /* xmm5 = i0*i0 */
__ASM_EMIT("addps %%xmm5, %%xmm4") /* xmm4 = r0*r0 + i0*i0 */
__ASM_EMIT("movaps 0x00(%[CC]), %%xmm5") /* xmm5 = 1 */
__ASM_EMIT("xorps 0x10(%[CC]), %%xmm1") /* xmm1 = -i0 */
__ASM_EMIT("divps %%xmm4, %%xmm5") /* xmm5 = 1 / (r0*r0 + i0*i0) */
__ASM_EMIT("mulps %%xmm5, %%xmm0") /* xmm0 = r0' = r0 / (r0*r0 + i0*i0) */
__ASM_EMIT("mulps %%xmm5, %%xmm1") /* xmm1 = i0' = -i0 / (r0*r0 + i0*i0) */
__ASM_EMIT("movups %%xmm0, 0x00(%[dst_re])") /* dst_re[0] = r0' */
__ASM_EMIT("movups %%xmm1, 0x00(%[dst_im])") /* dst_im[0] = i0' */
__ASM_EMIT("add $0x10, %[dst_re]") /* dst_re += 4 */
__ASM_EMIT("add $0x10, %[dst_im]") /* dst_im += 4 */
__ASM_EMIT("sub $4, %[count]") /* count -= 4 */
/* 1x RCP */
__ASM_EMIT("10:")
__ASM_EMIT("add $4, %[count]") /* count += 4 */
__ASM_EMIT("jle 50f")
__ASM_EMIT("40:")
__ASM_EMIT("movss 0x00(%[dst_re]), %%xmm0") /* xmm0 = r0 */
__ASM_EMIT("movss 0x00(%[dst_im]), %%xmm1") /* xmm1 = i0 */
__ASM_EMIT("movaps %%xmm0, %%xmm4") /* xmm4 = r0 */
__ASM_EMIT("movaps %%xmm1, %%xmm5") /* xmm5 = i0 */
__ASM_EMIT("mulss %%xmm0, %%xmm4") /* xmm4 = r0*r0 */
__ASM_EMIT("mulss %%xmm1, %%xmm5") /* xmm5 = i0*i0 */
__ASM_EMIT("addss %%xmm5, %%xmm4") /* xmm4 = r0*r0 + i0*i0 */
__ASM_EMIT("movaps 0x00(%[CC]), %%xmm5") /* xmm5 = 1 */
__ASM_EMIT("xorps 0x10(%[CC]), %%xmm1") /* xmm1 = -i0 */
__ASM_EMIT("divss %%xmm4, %%xmm5") /* xmm5 = 1 / (r0*r0 + i0*i0) */
__ASM_EMIT("mulss %%xmm5, %%xmm0") /* xmm0 = r0' = r0 / (r0*r0 + i0*i0) */
__ASM_EMIT("mulss %%xmm5, %%xmm1") /* xmm1 = i0' = -i0 / (r0*r0 + i0*i0) */
__ASM_EMIT("movss %%xmm0, 0x00(%[dst_re])") /* dst_re[0] = r0' */
__ASM_EMIT("movss %%xmm1, 0x00(%[dst_im])") /* dst_im[0] = i0' */
__ASM_EMIT("add $0x04, %[dst_re]") /* dst_re++ */
__ASM_EMIT("add $0x04, %[dst_im]") /* dst_im++ */
__ASM_EMIT("dec %[count]") /* count-- */
__ASM_EMIT("jnz 40b")
__ASM_EMIT("50:")
: [dst_re] "+r" (dst_re), [dst_im] "+r" (dst_im),
[count] "+r" (count)
: [CC] "r" (complex_div_const)
: "cc", "memory",
"%xmm0", "%xmm1", "%xmm2", "%xmm3",
"%xmm4", "%xmm5", "%xmm6", "%xmm7"
);
}
} /* namespace sse */
} /* namespace lsp */
#endif /* PRIVATE_DSP_ARCH_X86_SSE_COMPLEX_H_ */