/* * Copyright (C) 2023 Linux Studio Plugins Project * (C) 2023 Vladimir Sadovnikov * * This file is part of lsp-dsp-lib * Created on: 9 сент. 2023 г. * * 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_AVX512_COMPLEX_H_ #define PRIVATE_DSP_ARCH_X86_AVX512_COMPLEX_H_ #ifndef PRIVATE_DSP_ARCH_X86_AVX512_IMPL #error "This header should not be included directly" #endif /* PRIVATE_DSP_ARCH_X86_AVX512_IMPL */ namespace lsp { namespace avx512 { #define COMPLEX_MUL3_CORE(DST, SRC1, SRC2) \ __ASM_EMIT ("xor %[off], %[off]") \ /* x16 blocks */ \ __ASM_EMIT32("subl $16, %[count]") \ __ASM_EMIT64("sub $16, %[count]") \ __ASM_EMIT ("jb 2f") \ __ASM_EMIT ("1:") \ __ASM_EMIT32("mov %[" SRC1 "_re], %[ptr_re]") \ __ASM_EMIT32("mov %[" SRC1 "_im], %[ptr_im]") \ __ASM_EMIT32("vmovups 0x00(%[ptr_re], %[off]), %%zmm4") /* zmm4 = ar */ \ __ASM_EMIT32("vmovups 0x00(%[ptr_im], %[off]), %%zmm5") /* zmm5 = ai */ \ __ASM_EMIT64("vmovups 0x00(%[" SRC1 "_re], %[off]), %%zmm4") /* zmm4 = ar */ \ __ASM_EMIT64("vmovups 0x00(%[" SRC1 "_im], %[off]), %%zmm5") /* zmm5 = ai */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC2 "_re], %[off]), %%zmm0") /* zmm0 = br */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC2 "_im], %[off]), %%zmm1") /* zmm1 = bi */ \ __ASM_EMIT ("vmulps %%zmm0, %%zmm5, %%zmm2") /* zmm2 = ai*br */ \ __ASM_EMIT ("vmulps %%zmm1, %%zmm5, %%zmm3") /* zmm3 = ai*bi */ \ __ASM_EMIT32("mov %[" DST "_re], %[ptr_re]") \ __ASM_EMIT32("mov %[" DST "_im], %[ptr_im]") \ __ASM_EMIT ("vfmsub132ps %%zmm4, %%zmm3, %%zmm0") /* ymm0 = ar*br - ai*bi = r */ \ __ASM_EMIT ("vfmadd132ps %%zmm4, %%zmm2, %%zmm1") /* ymm1 = ar*bi + ai*br = i */ \ __ASM_EMIT32("vmovups %%zmm0, 0x00(%[ptr_re], %[off])") \ __ASM_EMIT32("vmovups %%zmm1, 0x00(%[ptr_im], %[off])") \ __ASM_EMIT64("vmovups %%zmm0, 0x00(%[" DST "_re], %[off])") \ __ASM_EMIT64("vmovups %%zmm1, 0x00(%[" DST "_im], %[off])") \ __ASM_EMIT ("add $0x40, %[off]") \ __ASM_EMIT32("subl $16, %[count]") \ __ASM_EMIT64("sub $16, %[count]") \ __ASM_EMIT ("jae 1b") \ __ASM_EMIT ("2:") \ /* x8 blocks */ \ __ASM_EMIT32("addl $8, %[count]") \ __ASM_EMIT64("add $8, %[count]") \ __ASM_EMIT ("jl 4f") \ __ASM_EMIT32("mov %[" SRC1 "_re], %[ptr_re]") \ __ASM_EMIT32("mov %[" SRC1 "_im], %[ptr_im]") \ __ASM_EMIT32("vmovups 0x00(%[ptr_re], %[off]), %%ymm4") /* ymm4 = ar */ \ __ASM_EMIT32("vmovups 0x00(%[ptr_im], %[off]), %%ymm5") /* ymm5 = ai */ \ __ASM_EMIT64("vmovups 0x00(%[" SRC1 "_re], %[off]), %%ymm4") /* ymm4 = ar */ \ __ASM_EMIT64("vmovups 0x00(%[" SRC1 "_im], %[off]), %%ymm5") /* ymm5 = ai */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC2 "_re], %[off]), %%ymm0") /* ymm0 = br */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC2 "_im], %[off]), %%ymm1") /* ymm1 = bi */ \ __ASM_EMIT ("vmulps %%ymm0, %%ymm5, %%ymm2") /* ymm2 = ai*br */ \ __ASM_EMIT ("vmulps %%ymm1, %%ymm5, %%ymm3") /* ymm3 = ai*bi */ \ __ASM_EMIT32("mov %[" DST "_re], %[ptr_re]") \ __ASM_EMIT32("mov %[" DST "_im], %[ptr_im]") \ __ASM_EMIT ("vfmsub132ps %%ymm4, %%ymm3, %%ymm0") /* ymm0 = ar*br - ai*bi = r */ \ __ASM_EMIT ("vfmadd132ps %%ymm4, %%ymm2, %%ymm1") /* ymm1 = ar*bi + ai*br = i */ \ __ASM_EMIT32("vmovups %%ymm0, 0x00(%[ptr_re], %[off])") \ __ASM_EMIT32("vmovups %%ymm1, 0x00(%[ptr_im], %[off])") \ __ASM_EMIT64("vmovups %%ymm0, 0x00(%[" DST "_re], %[off])") \ __ASM_EMIT64("vmovups %%ymm1, 0x00(%[" DST "_im], %[off])") \ __ASM_EMIT ("add $0x20, %[off]") \ __ASM_EMIT32("subl $8, %[count]") \ __ASM_EMIT64("sub $8, %[count]") \ __ASM_EMIT ("jae 1b") \ __ASM_EMIT ("4:") \ /* 4x block */ \ __ASM_EMIT32("addl $4, %[count]") \ __ASM_EMIT64("add $4, %[count]") \ __ASM_EMIT ("jl 6f") \ __ASM_EMIT32("mov %[" SRC1 "_re], %[ptr_re]") \ __ASM_EMIT32("mov %[" SRC1 "_im], %[ptr_im]") \ __ASM_EMIT32("vmovups 0x00(%[ptr_re], %[off]), %%xmm4") /* xmm4 = ar */ \ __ASM_EMIT32("vmovups 0x00(%[ptr_im], %[off]), %%xmm5") /* xmm5 = ai */ \ __ASM_EMIT64("vmovups 0x00(%[" SRC1 "_re], %[off]), %%xmm4") /* xmm4 = ar */ \ __ASM_EMIT64("vmovups 0x00(%[" SRC1 "_im], %[off]), %%xmm5") /* xmm5 = ai */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC2 "_re], %[off]), %%xmm0") /* xmm0 = br */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC2 "_im], %[off]), %%xmm1") /* xmm1 = bi */ \ __ASM_EMIT ("vmulps %%xmm0, %%xmm5, %%xmm2") /* xmm2 = ai*br */ \ __ASM_EMIT ("vmulps %%xmm1, %%xmm5, %%xmm3") /* xmm3 = ai*bi */ \ __ASM_EMIT32("mov %[" DST "_re], %[ptr_re]") \ __ASM_EMIT32("mov %[" DST "_im], %[ptr_im]") \ __ASM_EMIT ("vfmsub132ps %%xmm4, %%xmm3, %%xmm0") /* xmm0 = ar*br - ai*bi = r */ \ __ASM_EMIT ("vfmadd132ps %%xmm4, %%xmm2, %%xmm1") /* xmm1 = ar*bi + ai*br = i */ \ __ASM_EMIT32("vmovups %%xmm0, 0x00(%[ptr_re], %[off])") \ __ASM_EMIT32("vmovups %%xmm1, 0x00(%[ptr_im], %[off])") \ __ASM_EMIT64("vmovups %%xmm0, 0x00(%[" DST "_re], %[off])") \ __ASM_EMIT64("vmovups %%xmm1, 0x00(%[" DST "_im], %[off])") \ __ASM_EMIT ("add $0x10, %[off]") \ __ASM_EMIT32("subl $4, %[count]") \ __ASM_EMIT64("sub $4, %[count]") \ __ASM_EMIT ("6:") \ /* 1x blocks */ \ __ASM_EMIT32("addl $3, %[count]") \ __ASM_EMIT64("add $3, %[count]") \ __ASM_EMIT ("jl 8f") \ __ASM_EMIT ("7:") \ __ASM_EMIT32("mov %[" SRC1 "_re], %[ptr_re]") \ __ASM_EMIT32("mov %[" SRC1 "_im], %[ptr_im]") \ __ASM_EMIT32("vmovss 0x00(%[ptr_re], %[off]), %%xmm4") /* xmm4 = ar */ \ __ASM_EMIT32("vmovss 0x00(%[ptr_im], %[off]), %%xmm5") /* xmm5 = ai */ \ __ASM_EMIT64("vmovss 0x00(%[" SRC1 "_re], %[off]), %%xmm4") /* xmm4 = ar */ \ __ASM_EMIT64("vmovss 0x00(%[" SRC1 "_im], %[off]), %%xmm5") /* xmm5 = ai */ \ __ASM_EMIT ("vmovss 0x00(%[" SRC2 "_re], %[off]), %%xmm0") /* xmm0 = br */ \ __ASM_EMIT ("vmovss 0x00(%[" SRC2 "_im], %[off]), %%xmm1") /* xmm1 = bi */ \ __ASM_EMIT ("vmulps %%xmm0, %%xmm5, %%xmm2") /* xmm2 = ai*br */ \ __ASM_EMIT ("vmulps %%xmm1, %%xmm5, %%xmm3") /* xmm3 = ai*bi */ \ __ASM_EMIT32("mov %[" DST "_re], %[ptr_re]") \ __ASM_EMIT32("mov %[" DST "_im], %[ptr_im]") \ __ASM_EMIT ("vfmsub132ss %%xmm4, %%xmm3, %%xmm0") /* xmm0 = ar*br - ai*bi = r */ \ __ASM_EMIT ("vfmadd132ss %%xmm4, %%xmm2, %%xmm1") /* xmm1 = ar*bi + ai*br = i */ \ __ASM_EMIT32("vmovss %%xmm0, 0x00(%[ptr_re], %[off])") \ __ASM_EMIT32("vmovss %%xmm1, 0x00(%[ptr_im], %[off])") \ __ASM_EMIT64("vmovss %%xmm0, 0x00(%[" DST "_re], %[off])") \ __ASM_EMIT64("vmovss %%xmm1, 0x00(%[" DST "_im], %[off])") \ __ASM_EMIT ("add $0x04, %[off]") \ __ASM_EMIT32("decl %[count]") \ __ASM_EMIT64("dec %[count]") \ __ASM_EMIT ("jge 7b") \ __ASM_EMIT ("8:") 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 ( COMPLEX_MUL3_CORE("dst", "src1", "src2") : __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), [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", "%xmm3", "%xmm4", "%xmm5" ); } #define COMPLEX_MUL2_CORE(DST, SRC, SEL) \ __ASM_EMIT ("xor %[off], %[off]") \ /* x16 blocks */ \ __ASM_EMIT32("subl $16, %[count]") \ __ASM_EMIT64("sub $16, %[count]") \ __ASM_EMIT ("jb 2f") \ __ASM_EMIT ("1:") \ __ASM_EMIT ("vmovups 0x00(%[" DST "_re], %[off]), %%zmm4") /* zmm4 = ar */ \ __ASM_EMIT ("vmovups 0x00(%[" DST "_im], %[off]), %%zmm5") /* zmm5 = ai */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_re], %[off]), %%zmm0") /* zmm0 = br */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_im], %[off]), %%zmm1") /* zmm1 = bi */ \ __ASM_EMIT ("vmulps %%zmm0, %%zmm5, %%zmm2") /* ymm2 = ai*br */ \ __ASM_EMIT ("vmulps %%zmm1, %%zmm5, %%zmm3") /* ymm3 = ai*bi */ \ __ASM_EMIT ("vfmsub132ps %%zmm4, %%zmm3, %%zmm0") /* ymm0 = ar*br - ai*bi = r */ \ __ASM_EMIT ("vfmadd132ps %%zmm4, %%zmm2, %%zmm1") /* ymm1 = ar*bi + ai*br = i */ \ __ASM_EMIT ("vmovups %%zmm0, 0x00(%[" DST "_re], %[off])") \ __ASM_EMIT ("vmovups %%zmm1, 0x00(%[" DST "_im], %[off])") \ __ASM_EMIT ("add $0x40, %[off]") \ __ASM_EMIT32("subl $16, %[count]") \ __ASM_EMIT64("sub $16, %[count]") \ __ASM_EMIT ("jae 1b") \ __ASM_EMIT ("2:") \ /* x8 blocks */ \ __ASM_EMIT32("addl $8, %[count]") \ __ASM_EMIT64("add $8, %[count]") \ __ASM_EMIT ("jl 4f") \ __ASM_EMIT ("vmovups 0x00(%[" DST "_re], %[off]), %%ymm4") /* ymm4 = ar */ \ __ASM_EMIT ("vmovups 0x00(%[" DST "_im], %[off]), %%ymm5") /* ymm5 = ai */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_re], %[off]), %%ymm0") /* ymm0 = br */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_im], %[off]), %%ymm1") /* ymm1 = bi */ \ __ASM_EMIT ("vmulps %%ymm0, %%ymm5, %%ymm2") /* ymm2 = ai*br */ \ __ASM_EMIT ("vmulps %%ymm1, %%ymm5, %%ymm3") /* ymm3 = ai*bi */ \ __ASM_EMIT ("vfmsub132ps %%ymm4, %%ymm3, %%ymm0") /* ymm0 = ar*br - ai*bi = r */ \ __ASM_EMIT ("vfmadd132ps %%ymm4, %%ymm2, %%ymm1") /* ymm1 = ar*bi + ai*br = i */ \ __ASM_EMIT ("vmovups %%ymm0, 0x00(%[" DST "_re], %[off])") \ __ASM_EMIT ("vmovups %%ymm1, 0x00(%[" DST "_im], %[off])") \ __ASM_EMIT ("add $0x20, %[off]") \ __ASM_EMIT32("subl $8, %[count]") \ __ASM_EMIT64("sub $8, %[count]") \ __ASM_EMIT ("jae 1b") \ __ASM_EMIT ("4:") \ /* 4x block */ \ __ASM_EMIT32("addl $4, %[count]") \ __ASM_EMIT64("add $4, %[count]") \ __ASM_EMIT ("jl 6f") \ __ASM_EMIT ("vmovups 0x00(%[" DST "_re], %[off]), %%xmm4") /* xmm4 = ar */ \ __ASM_EMIT ("vmovups 0x00(%[" DST "_im], %[off]), %%xmm5") /* xmm5 = ai */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_re], %[off]), %%xmm0") /* xmm0 = br */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_im], %[off]), %%xmm1") /* xmm1 = bi */ \ __ASM_EMIT ("vmulps %%xmm0, %%xmm5, %%xmm2") /* xmm2 = ai*br */ \ __ASM_EMIT ("vmulps %%xmm1, %%xmm5, %%xmm3") /* xmm3 = ai*bi */ \ __ASM_EMIT ("vfmsub132ps %%xmm4, %%xmm3, %%xmm0") /* xmm0 = ar*br - ai*bi = r */ \ __ASM_EMIT ("vfmadd132ps %%xmm4, %%xmm2, %%xmm1") /* xmm1 = ar*bi + ai*br = i */ \ __ASM_EMIT ("vmovups %%xmm0, 0x00(%[" DST "_re], %[off])") \ __ASM_EMIT ("vmovups %%xmm1, 0x00(%[" DST "_im], %[off])") \ __ASM_EMIT ("add $0x10, %[off]") \ __ASM_EMIT32("subl $4, %[count]") \ __ASM_EMIT64("sub $4, %[count]") \ __ASM_EMIT ("6:") \ /* 1x blocks */ \ __ASM_EMIT32("addl $3, %[count]") \ __ASM_EMIT64("add $3, %[count]") \ __ASM_EMIT ("jl 8f") \ __ASM_EMIT ("7:") \ __ASM_EMIT ("vmovss 0x00(%[" DST "_re], %[off]), %%xmm4") /* xmm4 = ar */ \ __ASM_EMIT ("vmovss 0x00(%[" DST "_im], %[off]), %%xmm5") /* xmm5 = ai */ \ __ASM_EMIT ("vmovss 0x00(%[" SRC "_re], %[off]), %%xmm0") /* xmm0 = br */ \ __ASM_EMIT ("vmovss 0x00(%[" SRC "_im], %[off]), %%xmm1") /* xmm1 = bi */ \ __ASM_EMIT ("vmulps %%xmm0, %%xmm5, %%xmm2") /* xmm2 = ai*br */ \ __ASM_EMIT ("vmulps %%xmm1, %%xmm5, %%xmm3") /* xmm3 = ai*bi */ \ __ASM_EMIT ("vfmsub132ss %%xmm4, %%xmm3, %%xmm0") /* xmm0 = ar*br - ai*bi = r */ \ __ASM_EMIT ("vfmadd132ss %%xmm4, %%xmm2, %%xmm1") /* xmm1 = ar*bi + ai*br = i */ \ __ASM_EMIT ("vmovss %%xmm0, 0x00(%[" DST "_re], %[off])") \ __ASM_EMIT ("vmovss %%xmm1, 0x00(%[" DST "_im], %[off])") \ __ASM_EMIT ("add $0x04, %[off]") \ __ASM_EMIT32("decl %[count]") \ __ASM_EMIT64("dec %[count]") \ __ASM_EMIT ("jge 7b") \ __ASM_EMIT ("8:") 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 ( COMPLEX_MUL2_CORE("dst", "src", FMA_OFF) : [count] X86_PGREG (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", "%xmm3", "%xmm4", "%xmm5" ); } #define COMPLEX_MOD_CORE(DST, SRC) \ __ASM_EMIT ("xor %[off], %[off]") \ /* x64 blocks */ \ __ASM_EMIT ("sub $64, %[count]") \ __ASM_EMIT ("jb 2f") \ __ASM_EMIT ("1:") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_re], %[off]), %%zmm0") /* zmm0 = r */ \ __ASM_EMIT ("vmovups 0x40(%[" SRC "_re], %[off]), %%zmm1") \ __ASM_EMIT ("vmovups 0x80(%[" SRC "_re], %[off]), %%zmm2") \ __ASM_EMIT ("vmovups 0xc0(%[" SRC "_re], %[off]), %%zmm3") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_im], %[off]), %%zmm4") /* zmm4 = i */ \ __ASM_EMIT ("vmovups 0x40(%[" SRC "_im], %[off]), %%zmm5") \ __ASM_EMIT ("vmovups 0x80(%[" SRC "_im], %[off]), %%zmm6") \ __ASM_EMIT ("vmovups 0xc0(%[" SRC "_im], %[off]), %%zmm7") \ __ASM_EMIT ("vmulps %%zmm0, %%zmm0, %%zmm0") /* zmm0 = r*r */ \ __ASM_EMIT ("vmulps %%zmm1, %%zmm1, %%zmm1") \ __ASM_EMIT ("vmulps %%zmm2, %%zmm2, %%zmm2") \ __ASM_EMIT ("vmulps %%zmm3, %%zmm3, %%zmm3") \ __ASM_EMIT ("vfmadd231ps %%zmm4, %%zmm4, %%zmm0") /* zmm0 = r*r + i*i */ \ __ASM_EMIT ("vfmadd231ps %%zmm5, %%zmm5, %%zmm1") \ __ASM_EMIT ("vfmadd231ps %%zmm6, %%zmm6, %%zmm2") \ __ASM_EMIT ("vfmadd231ps %%zmm7, %%zmm7, %%zmm3") \ __ASM_EMIT ("vsqrtps %%zmm0, %%zmm0") /* zmm0 = sqrt(r*r + i*i) */ \ __ASM_EMIT ("vsqrtps %%zmm1, %%zmm1") \ __ASM_EMIT ("vsqrtps %%zmm2, %%zmm2") \ __ASM_EMIT ("vsqrtps %%zmm3, %%zmm3") \ __ASM_EMIT ("vmovups %%zmm0, 0x00(%[" DST "], %[off])") \ __ASM_EMIT ("vmovups %%zmm1, 0x40(%[" DST "], %[off])") \ __ASM_EMIT ("vmovups %%zmm2, 0x80(%[" DST "], %[off])") \ __ASM_EMIT ("vmovups %%zmm3, 0xc0(%[" DST "], %[off])") \ __ASM_EMIT ("add $0x100, %[off]") \ __ASM_EMIT ("sub $64, %[count]") \ __ASM_EMIT ("jae 1b") \ __ASM_EMIT ("2:") \ /* x32 block */ \ __ASM_EMIT ("add $32, %[count]") \ __ASM_EMIT ("jl 4f") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_re], %[off]), %%zmm0") /* zmm0 = r */ \ __ASM_EMIT ("vmovups 0x40(%[" SRC "_re], %[off]), %%zmm1") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_im], %[off]), %%zmm4") /* zmm4 = i */ \ __ASM_EMIT ("vmovups 0x40(%[" SRC "_im], %[off]), %%zmm5") \ __ASM_EMIT ("vmulps %%zmm0, %%zmm0, %%zmm0") /* zmm0 = r*r */ \ __ASM_EMIT ("vmulps %%zmm1, %%zmm1, %%zmm1") \ __ASM_EMIT ("vfmadd231ps %%zmm4, %%zmm4, %%zmm0") /* zmm0 = r*r + i*i */ \ __ASM_EMIT ("vfmadd231ps %%zmm5, %%zmm5, %%zmm1") \ __ASM_EMIT ("vsqrtps %%zmm0, %%zmm0") /* zmm0 = sqrt(r*r + i*i) */ \ __ASM_EMIT ("vsqrtps %%zmm1, %%zmm1") \ __ASM_EMIT ("vmovups %%zmm0, 0x00(%[" DST "], %[off])") \ __ASM_EMIT ("vmovups %%zmm1, 0x40(%[" DST "], %[off])") \ __ASM_EMIT ("sub $32, %[count]") \ __ASM_EMIT ("add $0x80, %[off]") \ __ASM_EMIT ("4:") \ /* x16 blocks */ \ __ASM_EMIT ("add $16, %[count]") \ __ASM_EMIT ("jl 6f") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_re], %[off]), %%ymm0") /* ymm0 = r */ \ __ASM_EMIT ("vmovups 0x20(%[" SRC "_re], %[off]), %%ymm1") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_im], %[off]), %%ymm2") /* ymm2 = i */ \ __ASM_EMIT ("vmovups 0x20(%[" SRC "_im], %[off]), %%ymm3") \ __ASM_EMIT ("vmulps %%ymm0, %%ymm0, %%ymm0") /* ymm0 = r*r */ \ __ASM_EMIT ("vmulps %%ymm1, %%ymm1, %%ymm1") \ __ASM_EMIT ("vfmadd231ps %%ymm2, %%ymm2, %%ymm0") /* ymm0 = r*r + i*i */ \ __ASM_EMIT ("vfmadd231ps %%ymm3, %%ymm3, %%ymm1") \ __ASM_EMIT ("vsqrtps %%ymm0, %%ymm0") /* ymm0 = sqrt(r*r + i*i) */ \ __ASM_EMIT ("vsqrtps %%ymm1, %%ymm1") \ __ASM_EMIT ("vmovups %%ymm0, 0x00(%[" DST "], %[off])") \ __ASM_EMIT ("vmovups %%ymm1, 0x20(%[" DST "], %[off])") \ __ASM_EMIT ("sub $16, %[count]") \ __ASM_EMIT ("add $0x40, %[off]") \ __ASM_EMIT ("6:") \ /* x8 block */ \ __ASM_EMIT ("add $8, %[count]") \ __ASM_EMIT ("jl 8f") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_re], %[off]), %%ymm0") /* ymm0 = r */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_im], %[off]), %%ymm2") /* ymm2 = i */ \ __ASM_EMIT ("vmulps %%ymm0, %%ymm0, %%ymm0") /* ymm0 = r*r */ \ __ASM_EMIT ("vfmadd231ps %%ymm2, %%ymm2, %%ymm0") /* ymm0 = r*r + i*i */ \ __ASM_EMIT ("vsqrtps %%ymm0, %%ymm0") /* ymm0 = sqrt(r*r + i*i) */ \ __ASM_EMIT ("vmovups %%ymm0, 0x00(%[" DST "], %[off])") \ __ASM_EMIT ("add $0x20, %[off]") \ __ASM_EMIT ("sub $8, %[count]") \ __ASM_EMIT ("8:") \ /* x4 block */ \ __ASM_EMIT ("add $4, %[count]") \ __ASM_EMIT ("jl 10f") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_re], %[off]), %%xmm0") /* xmm0 = r */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_im], %[off]), %%xmm2") /* xmm2 = i */ \ __ASM_EMIT ("vmulps %%xmm0, %%xmm0, %%xmm0") /* xmm0 = r*r */ \ __ASM_EMIT ("vfmadd231ps %%xmm2, %%xmm2, %%xmm0") /* xmm0 = r*r + i*i */ \ __ASM_EMIT ("vsqrtps %%xmm0, %%xmm0") /* xmm0 = sqrt(r*r + i*i) */ \ __ASM_EMIT ("vmovups %%xmm0, 0x00(%[" DST "], %[off])") \ __ASM_EMIT ("add $0x10, %[off]") \ __ASM_EMIT ("sub $4, %[count]") \ __ASM_EMIT ("10:") \ /* x1 block */ \ __ASM_EMIT ("add $3, %[count]") \ __ASM_EMIT ("jl 12f") \ __ASM_EMIT ("11:") \ __ASM_EMIT ("vmovss 0x00(%[" SRC "_re], %[off]), %%xmm0") /* xmm0 = r */ \ __ASM_EMIT ("vmovss 0x00(%[" SRC "_im], %[off]), %%xmm2") /* xmm2 = i */ \ __ASM_EMIT ("vmulss %%xmm0, %%xmm0, %%xmm0") /* xmm0 = r*r */ \ __ASM_EMIT ("vfmadd231ps %%xmm2, %%xmm2, %%xmm0") /* xmm0 = r*r + i*i */ \ __ASM_EMIT ("vsqrtss %%xmm0, %%xmm0, %%xmm0") /* xmm0 = sqrt(r*r + i*i) */ \ __ASM_EMIT ("vmovss %%xmm0, 0x00(%[" DST "], %[off])") \ __ASM_EMIT ("add $0x04, %[off]") \ __ASM_EMIT ("dec %[count]") \ __ASM_EMIT ("jge 11b") \ __ASM_EMIT ("12:") \ void complex_mod(float *dst, const float *src_re, const float *src_im, size_t count) { IF_ARCH_X86(size_t off); ARCH_X86_ASM ( COMPLEX_MOD_CORE("dst", "src") : [count] "+r" (count), [off] "=&r" (off) : [dst] "r" (dst), [src_re] "r" (src_re), [src_im] "r" (src_im) : "cc", "memory", "%xmm0", "%xmm1", "%xmm2", "%xmm3", "%xmm4", "%xmm5", "%xmm6", "%xmm7" ); } IF_ARCH_X86( static uint32_t complex_div_const[] __lsp_aligned64 = { LSP_DSP_VEC16(0x3f800000), // 1.0 LSP_DSP_VEC16(0x80000000) // signbit }; ) #define COMPLEX_DIV3_CORE(DSTR, DSTI, TR, TI, BR, BI) \ __ASM_EMIT ("xor %[off], %[off]") \ __ASM_EMIT ("vmovaps 0x00 + %[CC], %%zmm6") /* zmm6 = 1 */ \ /* x16 blocks */ \ __ASM_EMIT32("subl $16, %[count]") \ __ASM_EMIT64("sub $16, %[count]") \ __ASM_EMIT ("jb 2f") \ __ASM_EMIT ("1:") \ __ASM_EMIT ("vmovups 0x00(%[" BR "], %[off]), %%zmm2") /* zmm2 = br */ \ __ASM_EMIT ("vmovups 0x00(%[" BI "], %[off]), %%zmm3") /* zmm3 = bi */ \ __ASM_EMIT32("vmovups 0x00(%[ptr_re], %[off]), %%zmm0") /* zmm0 = tr */ \ __ASM_EMIT32("vmovups 0x00(%[ptr_re], %[off]), %%zmm1") /* zmm1 = ti */ \ __ASM_EMIT64("vmovups 0x00(%[" TR "], %[off]), %%zmm0") /* zmm0 = tr */ \ __ASM_EMIT64("vmovups 0x00(%[" TI "], %[off]), %%zmm1") /* zmm1 = ti */ \ __ASM_EMIT32("mov %[" DSTR "], %[ptr_re]") \ __ASM_EMIT32("mov %[" DSTI "], %[ptr_im]") \ __ASM_EMIT ("vmulps %%zmm2, %%zmm2, %%zmm7") /* zmm7 = br*br */ \ __ASM_EMIT ("vmulps %%zmm3, %%zmm1, %%zmm4") /* zmm4 = ti*bi */ \ __ASM_EMIT ("vmulps %%zmm3, %%zmm0, %%zmm5") /* zmm5 = tr*bi */ \ __ASM_EMIT ("vfmadd231ps %%zmm3, %%zmm3, %%zmm7") /* zmm7 = M = br*br + bi*bi */ \ __ASM_EMIT ("vmovaps 0x00 + %[CC], %%zmm6") /* zmm6 = 1 */ \ __ASM_EMIT ("vdivps %%zmm7, %%zmm6, %%zmm7") /* zmm7 = R = 1/M */ \ __ASM_EMIT ("vfmadd132ps %%zmm2, %%zmm4, %%zmm0") /* zmm0 = r = tr*br + ti*bi */ \ __ASM_EMIT ("vfmsub132ps %%zmm2, %%zmm5, %%zmm1") /* zmm1 = i = tr*br - tr*bi */ \ __ASM_EMIT ("vmulps %%zmm7, %%zmm0, %%zmm0") /* zmm0 = r/R */ \ __ASM_EMIT ("vmulps %%zmm7, %%zmm1, %%zmm1") /* zmm1 = i/R */ \ __ASM_EMIT32("vmovups %%zmm0, 0x00(%[ptr_re], %[off])") \ __ASM_EMIT32("vmovups %%zmm1, 0x00(%[ptr_re], %[off])") \ __ASM_EMIT64("vmovups %%zmm0, 0x00(%[" DSTR "], %[off])") \ __ASM_EMIT64("vmovups %%zmm1, 0x00(%[" DSTI "], %[off])") \ __ASM_EMIT ("add $0x40, %[off]") \ __ASM_EMIT32("subl $16, %[count]") \ __ASM_EMIT64("sub $16, %[count]") \ __ASM_EMIT ("jae 1b") \ __ASM_EMIT ("2:") \ /* x8 blocks */ \ __ASM_EMIT32("addl $8, %[count]") \ __ASM_EMIT64("add $8, %[count]") \ __ASM_EMIT ("jl 4f") \ __ASM_EMIT32("mov %[" TR "], %[ptr_re]") \ __ASM_EMIT32("mov %[" TI "], %[ptr_im]") \ __ASM_EMIT ("vmovups 0x00(%[" BR "], %[off]), %%ymm2") /* ymm2 = br */ \ __ASM_EMIT ("vmovups 0x00(%[" BI "], %[off]), %%ymm3") /* ymm3 = bi */ \ __ASM_EMIT32("vmovups 0x00(%[ptr_re], %[off]), %%ymm0") /* ymm0 = tr */ \ __ASM_EMIT32("vmovups 0x00(%[ptr_re], %[off]), %%ymm1") /* ymm1 = ti */ \ __ASM_EMIT64("vmovups 0x00(%[" TR "], %[off]), %%ymm0") /* ymm0 = tr */ \ __ASM_EMIT64("vmovups 0x00(%[" TI "], %[off]), %%ymm1") /* ymm1 = ti */ \ __ASM_EMIT32("mov %[" DSTR "], %[ptr_re]") \ __ASM_EMIT32("mov %[" DSTI "], %[ptr_im]") \ __ASM_EMIT ("vmulps %%ymm2, %%ymm2, %%ymm7") /* ymm7 = br*br */ \ __ASM_EMIT ("vmulps %%ymm3, %%ymm1, %%ymm4") /* ymm4 = ti*bi */ \ __ASM_EMIT ("vmulps %%ymm3, %%ymm0, %%ymm5") /* ymm5 = tr*bi */ \ __ASM_EMIT ("vfmadd231ps %%ymm3, %%ymm3, %%ymm7") /* ymm7 = M = br*br + bi*bi */ \ __ASM_EMIT ("vmovaps 0x00 + %[CC], %%ymm6") /* ymm6 = 1 */ \ __ASM_EMIT ("vdivps %%ymm7, %%ymm6, %%ymm7") /* ymm7 = R = 1/M */ \ __ASM_EMIT ("vfmadd132ps %%ymm2, %%ymm4, %%ymm0") /* ymm0 = r = tr*br + ti*bi */ \ __ASM_EMIT ("vfmsub132ps %%ymm2, %%ymm5, %%ymm1") /* ymm1 = i = tr*br - tr*bi */ \ __ASM_EMIT ("vmulps %%ymm7, %%ymm0, %%ymm0") /* ymm0 = r/R */ \ __ASM_EMIT ("vmulps %%ymm7, %%ymm1, %%ymm1") /* ymm1 = i/R */ \ __ASM_EMIT32("vmovups %%ymm0, 0x00(%[ptr_re], %[off])") \ __ASM_EMIT32("vmovups %%ymm1, 0x00(%[ptr_re], %[off])") \ __ASM_EMIT64("vmovups %%ymm0, 0x00(%[" DSTR "], %[off])") \ __ASM_EMIT64("vmovups %%ymm1, 0x00(%[" DSTI "], %[off])") \ __ASM_EMIT32("subl $8, %[count]") \ __ASM_EMIT64("sub $8, %[count]") \ __ASM_EMIT ("add $0x20, %[off]") \ __ASM_EMIT ("4:") \ /* 4x block */ \ __ASM_EMIT32("addl $4, %[count]") \ __ASM_EMIT64("add $4, %[count]") \ __ASM_EMIT ("jl 6f") \ __ASM_EMIT32("mov %[" TR "], %[ptr_re]") \ __ASM_EMIT32("mov %[" TI "], %[ptr_im]") \ __ASM_EMIT ("vmovups 0x00(%[" BR "], %[off]), %%xmm2") /* xmm2 = br */ \ __ASM_EMIT ("vmovups 0x00(%[" BI "], %[off]), %%xmm3") /* xmm3 = bi */ \ __ASM_EMIT32("vmovups 0x00(%[ptr_re], %[off]), %%xmm0") /* xmm0 = tr */ \ __ASM_EMIT32("vmovups 0x00(%[ptr_re], %[off]), %%xmm1") /* xmm1 = ti */ \ __ASM_EMIT64("vmovups 0x00(%[" TR "], %[off]), %%xmm0") /* xmm0 = tr */ \ __ASM_EMIT64("vmovups 0x00(%[" TI "], %[off]), %%xmm1") /* xmm1 = ti */ \ __ASM_EMIT32("mov %[" DSTR "], %[ptr_re]") \ __ASM_EMIT32("mov %[" DSTI "], %[ptr_im]") \ __ASM_EMIT ("vmulps %%xmm2, %%xmm2, %%xmm7") /* xmm7 = br*br */ \ __ASM_EMIT ("vmulps %%xmm3, %%xmm1, %%xmm4") /* xmm4 = ti*bi */ \ __ASM_EMIT ("vmulps %%xmm3, %%xmm0, %%xmm5") /* xmm5 = tr*bi */ \ __ASM_EMIT ("vfmadd231ps %%xmm3, %%xmm3, %%xmm7") /* xmm7 = M = br*br + bi*bi */ \ __ASM_EMIT ("vmovaps 0x00 + %[CC], %%xmm6") /* xmm6 = 1 */ \ __ASM_EMIT ("vdivps %%xmm7, %%xmm6, %%xmm7") /* xmm7 = R = 1/M */ \ __ASM_EMIT ("vfmadd132ps %%xmm2, %%xmm4, %%xmm0") /* xmm0 = r = tr*br + ti*bi */ \ __ASM_EMIT ("vfmsub132ps %%xmm2, %%xmm5, %%xmm1") /* xmm1 = i = tr*br - tr*bi */ \ __ASM_EMIT ("vmulps %%xmm7, %%xmm0, %%xmm0") /* xmm0 = r/R */ \ __ASM_EMIT ("vmulps %%xmm7, %%xmm1, %%xmm1") /* xmm1 = i/R */ \ __ASM_EMIT32("vmovups %%xmm0, 0x00(%[ptr_re], %[off])") \ __ASM_EMIT32("vmovups %%xmm1, 0x00(%[ptr_re], %[off])") \ __ASM_EMIT64("vmovups %%xmm0, 0x00(%[" DSTR "], %[off])") \ __ASM_EMIT64("vmovups %%xmm1, 0x00(%[" DSTI "], %[off])") \ __ASM_EMIT32("subl $4, %[count]") \ __ASM_EMIT64("sub $4, %[count]") \ __ASM_EMIT ("add $0x10, %[off]") \ __ASM_EMIT ("6:") \ /* 1x blocks */ \ __ASM_EMIT32("addl $3, %[count]") \ __ASM_EMIT64("add $3, %[count]") \ __ASM_EMIT ("jl 8f") \ __ASM_EMIT ("7:") \ __ASM_EMIT32("mov %[" TR "], %[ptr_re]") \ __ASM_EMIT32("mov %[" TI "], %[ptr_im]") \ __ASM_EMIT ("vmovss 0x00(%[" BR "], %[off]), %%xmm2") /* xmm2 = br */ \ __ASM_EMIT ("vmovss 0x00(%[" BI "], %[off]), %%xmm3") /* xmm3 = bi */ \ __ASM_EMIT32("vmovss 0x00(%[ptr_re], %[off]), %%xmm0") /* xmm0 = tr */ \ __ASM_EMIT32("vmovss 0x00(%[ptr_re], %[off]), %%xmm1") /* xmm1 = ti */ \ __ASM_EMIT64("vmovss 0x00(%[" TR "], %[off]), %%xmm0") /* xmm0 = tr */ \ __ASM_EMIT64("vmovss 0x00(%[" TI "], %[off]), %%xmm1") /* xmm1 = ti */ \ __ASM_EMIT32("mov %[" DSTR "], %[ptr_re]") \ __ASM_EMIT32("mov %[" DSTI "], %[ptr_im]") \ __ASM_EMIT ("vmulss %%xmm2, %%xmm2, %%xmm7") /* xmm7 = br*br */ \ __ASM_EMIT ("vmulss %%xmm3, %%xmm1, %%xmm4") /* xmm4 = ti*bi */ \ __ASM_EMIT ("vmulss %%xmm3, %%xmm0, %%xmm5") /* xmm5 = tr*bi */ \ __ASM_EMIT ("vfmadd231ss %%xmm3, %%xmm3, %%xmm7") /* xmm7 = M = br*br + bi*bi */ \ __ASM_EMIT ("vmovaps 0x00 + %[CC], %%xmm6") /* xmm6 = 1 */ \ __ASM_EMIT ("vdivss %%xmm7, %%xmm6, %%xmm7") /* xmm7 = R = 1/M */ \ __ASM_EMIT ("vfmadd132ss %%xmm2, %%xmm4, %%xmm0") /* xmm0 = r = tr*br + ti*bi */ \ __ASM_EMIT ("vfmsub132ss %%xmm2, %%xmm5, %%xmm1") /* xmm1 = i = tr*br - tr*bi */ \ __ASM_EMIT ("vmulss %%xmm7, %%xmm0, %%xmm0") /* xmm0 = r/R */ \ __ASM_EMIT ("vmulss %%xmm7, %%xmm1, %%xmm1") /* xmm1 = i/R */ \ __ASM_EMIT32("vmovss %%xmm0, 0x00(%[ptr_re], %[off])") \ __ASM_EMIT32("vmovss %%xmm1, 0x00(%[ptr_re], %[off])") \ __ASM_EMIT64("vmovss %%xmm0, 0x00(%[" DSTR "], %[off])") \ __ASM_EMIT64("vmovss %%xmm1, 0x00(%[" DSTI "], %[off])") \ __ASM_EMIT ("add $0x04, %[off]") \ __ASM_EMIT32("decl %[count]") \ __ASM_EMIT64("dec %[count]") \ __ASM_EMIT ("jge 7b") \ __ASM_EMIT ("8:") void complex_div3(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 ( COMPLEX_DIV3_CORE("dst_re", "dst_im", "src1_re", "src1_im", "src2_re", "src2_im") : __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), [src1_re] X86_GREG (src1_re), [src1_im] X86_GREG (src1_im), [src2_re] "r" (src2_re), [src2_im] "r" (src2_im), [CC] "o" (complex_div_const) : "cc", "memory", "%xmm0", "%xmm1", "%xmm2", "%xmm3", "%xmm4", "%xmm5", "%xmm6", "%xmm7" ); } #undef COMPLEX_DIV3_CORE #define COMPLEX_DIV2_CORE(DSTR, DSTI, TR, TI, BR, BI) \ __ASM_EMIT ("xor %[off], %[off]") \ __ASM_EMIT ("vmovaps 0x00 + %[CC], %%zmm6") /* zmm6 = 1 */ \ /* x16 blocks */ \ __ASM_EMIT32("subl $16, %[count]") \ __ASM_EMIT64("sub $16, %[count]") \ __ASM_EMIT ("jb 2f") \ __ASM_EMIT ("1:") \ __ASM_EMIT ("vmovups 0x00(%[" BR "], %[off]), %%zmm2") /* zmm2 = br */ \ __ASM_EMIT ("vmovups 0x00(%[" BI "], %[off]), %%zmm3") /* zmm3 = bi */ \ __ASM_EMIT ("vmovups 0x00(%[" TR "], %[off]), %%zmm0") /* zmm0 = tr */ \ __ASM_EMIT ("vmovups 0x00(%[" TI "], %[off]), %%zmm1") /* zmm1 = ti */ \ __ASM_EMIT ("vmulps %%zmm2, %%zmm2, %%zmm7") /* zmm7 = br*br */ \ __ASM_EMIT ("vmulps %%zmm3, %%zmm1, %%zmm4") /* zmm4 = ti*bi */ \ __ASM_EMIT ("vmulps %%zmm3, %%zmm0, %%zmm5") /* zmm5 = tr*bi */ \ __ASM_EMIT ("vfmadd231ps %%zmm3, %%zmm3, %%zmm7") /* zmm7 = M = br*br + bi*bi */ \ __ASM_EMIT ("vdivps %%zmm7, %%zmm6, %%zmm7") /* zmm7 = R = 1/M */ \ __ASM_EMIT ("vfmadd132ps %%zmm2, %%zmm4, %%zmm0") /* zmm0 = r = tr*br + ti*bi */ \ __ASM_EMIT ("vfmsub132ps %%zmm2, %%zmm5, %%zmm1") /* zmm1 = i = tr*br - tr*bi */ \ __ASM_EMIT ("vmulps %%zmm7, %%zmm0, %%zmm0") /* zmm0 = r/R */ \ __ASM_EMIT ("vmulps %%zmm7, %%zmm1, %%zmm1") /* zmm1 = i/R */ \ __ASM_EMIT ("vmovups %%zmm0, 0x00(%[" DSTR "], %[off])") \ __ASM_EMIT ("vmovups %%zmm1, 0x00(%[" DSTI "], %[off])") \ __ASM_EMIT ("add $0x40, %[off]") \ __ASM_EMIT32("subl $16, %[count]") \ __ASM_EMIT64("sub $16, %[count]") \ __ASM_EMIT ("jae 1b") \ __ASM_EMIT ("2:") \ /* x8 block */ \ __ASM_EMIT32("addl $8, %[count]") \ __ASM_EMIT64("add $8, %[count]") \ __ASM_EMIT ("jl 4f") \ __ASM_EMIT ("vmovups 0x00(%[" BR "], %[off]), %%ymm2") /* ymm2 = br */ \ __ASM_EMIT ("vmovups 0x00(%[" BI "], %[off]), %%ymm3") /* ymm3 = bi */ \ __ASM_EMIT ("vmovups 0x00(%[" TR "], %[off]), %%ymm0") /* ymm0 = tr */ \ __ASM_EMIT ("vmovups 0x00(%[" TI "], %[off]), %%ymm1") /* ymm1 = ti */ \ __ASM_EMIT ("vmulps %%ymm2, %%ymm2, %%ymm7") /* ymm7 = br*br */ \ __ASM_EMIT ("vmulps %%ymm3, %%ymm1, %%ymm4") /* ymm4 = ti*bi */ \ __ASM_EMIT ("vmulps %%ymm3, %%ymm0, %%ymm5") /* ymm5 = tr*bi */ \ __ASM_EMIT ("vfmadd231ps %%ymm3, %%ymm3, %%ymm7") /* ymm7 = M = br*br + bi*bi */ \ __ASM_EMIT ("vdivps %%ymm7, %%ymm6, %%ymm7") /* ymm7 = R = 1/M */ \ __ASM_EMIT ("vfmadd132ps %%ymm2, %%ymm4, %%ymm0") /* ymm0 = r = tr*br + ti*bi */ \ __ASM_EMIT ("vfmsub132ps %%ymm2, %%ymm5, %%ymm1") /* ymm1 = i = tr*br - tr*bi */ \ __ASM_EMIT ("vmulps %%ymm7, %%ymm0, %%ymm0") /* ymm0 = r/R */ \ __ASM_EMIT ("vmulps %%ymm7, %%ymm1, %%ymm1") /* ymm1 = i/R */ \ __ASM_EMIT ("vmovups %%ymm0, 0x00(%[" DSTR "], %[off])") \ __ASM_EMIT ("vmovups %%ymm1, 0x00(%[" DSTI "], %[off])") \ __ASM_EMIT32("subl $8, %[count]") \ __ASM_EMIT64("sub $8, %[count]") \ __ASM_EMIT ("add $0x20, %[off]") \ __ASM_EMIT ("4:") \ /* 4x block */ \ __ASM_EMIT32("addl $4, %[count]") \ __ASM_EMIT64("add $4, %[count]") \ __ASM_EMIT ("jl 6f") \ __ASM_EMIT ("vmovups 0x00(%[" BR "], %[off]), %%xmm2") /* xmm2 = br */ \ __ASM_EMIT ("vmovups 0x00(%[" BI "], %[off]), %%xmm3") /* xmm3 = bi */ \ __ASM_EMIT ("vmovups 0x00(%[" TR "], %[off]), %%xmm0") /* xmm0 = tr */ \ __ASM_EMIT ("vmovups 0x00(%[" TI "], %[off]), %%xmm1") /* xmm1 = ti */ \ __ASM_EMIT ("vmulps %%xmm2, %%xmm2, %%xmm7") /* xmm7 = br*br */ \ __ASM_EMIT ("vmulps %%xmm3, %%xmm1, %%xmm4") /* xmm4 = ti*bi */ \ __ASM_EMIT ("vmulps %%xmm3, %%xmm0, %%xmm5") /* xmm5 = tr*bi */ \ __ASM_EMIT ("vfmadd231ps %%xmm3, %%xmm3, %%xmm7") /* xmm7 = M = br*br + bi*bi */ \ __ASM_EMIT ("vdivps %%xmm7, %%xmm6, %%xmm7") /* xmm7 = R = 1/M */ \ __ASM_EMIT ("vfmadd132ps %%xmm2, %%xmm4, %%xmm0") /* xmm0 = r = tr*br + ti*bi */ \ __ASM_EMIT ("vfmsub132ps %%xmm2, %%xmm5, %%xmm1") /* xmm1 = i = tr*br - tr*bi */ \ __ASM_EMIT ("vmulps %%xmm7, %%xmm0, %%xmm0") /* xmm0 = r/R */ \ __ASM_EMIT ("vmulps %%xmm7, %%xmm1, %%xmm1") /* xmm1 = i/R */ \ __ASM_EMIT ("vmovups %%xmm0, 0x00(%[" DSTR "], %[off])") \ __ASM_EMIT ("vmovups %%xmm1, 0x00(%[" DSTI "], %[off])") \ __ASM_EMIT32("subl $4, %[count]") \ __ASM_EMIT64("sub $4, %[count]") \ __ASM_EMIT ("add $0x10, %[off]") \ __ASM_EMIT ("6:") \ /* 1x blocks */ \ __ASM_EMIT32("addl $3, %[count]") \ __ASM_EMIT64("add $3, %[count]") \ __ASM_EMIT ("jl 8f") \ __ASM_EMIT ("7:") \ __ASM_EMIT ("vmovss 0x00(%[" BR "], %[off]), %%xmm2") /* xmm2 = br */ \ __ASM_EMIT ("vmovss 0x00(%[" BI "], %[off]), %%xmm3") /* xmm3 = bi */ \ __ASM_EMIT ("vmovss 0x00(%[" TR "], %[off]), %%xmm0") /* xmm0 = tr */ \ __ASM_EMIT ("vmovss 0x00(%[" TI "], %[off]), %%xmm1") /* xmm1 = ti */ \ __ASM_EMIT ("vmulss %%xmm2, %%xmm2, %%xmm7") /* xmm7 = br*br */ \ __ASM_EMIT ("vmulss %%xmm3, %%xmm1, %%xmm4") /* xmm4 = ti*bi */ \ __ASM_EMIT ("vmulss %%xmm3, %%xmm0, %%xmm5") /* xmm5 = tr*bi */ \ __ASM_EMIT ("vfmadd231ss %%xmm3, %%xmm3, %%xmm7") /* xmm7 = M = br*br + bi*bi */ \ __ASM_EMIT ("vmovaps 0x00 + %[CC], %%xmm6") /* xmm6 = 1 */ \ __ASM_EMIT ("vdivss %%xmm7, %%xmm6, %%xmm7") /* xmm7 = R = 1/M */ \ __ASM_EMIT ("vfmadd132ss %%xmm2, %%xmm4, %%xmm0") /* xmm0 = r = tr*br + ti*bi */ \ __ASM_EMIT ("vfmsub132ss %%xmm2, %%xmm5, %%xmm1") /* xmm1 = i = tr*br - tr*bi */ \ __ASM_EMIT ("vmulss %%xmm7, %%xmm0, %%xmm0") /* xmm0 = r/R */ \ __ASM_EMIT ("vmulss %%xmm7, %%xmm1, %%xmm1") /* xmm1 = i/R */ \ __ASM_EMIT ("vmovss %%xmm0, 0x00(%[" DSTR "], %[off])") \ __ASM_EMIT ("vmovss %%xmm1, 0x00(%[" DSTI "], %[off])") \ __ASM_EMIT ("add $0x04, %[off]") \ __ASM_EMIT32("decl %[count]") \ __ASM_EMIT64("dec %[count]") \ __ASM_EMIT ("jge 7b") \ __ASM_EMIT ("8:") 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") : [count] X86_PGREG (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] "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") : [count] X86_PGREG (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] "o" (complex_div_const) : "cc", "memory", "%xmm0", "%xmm1", "%xmm2", "%xmm3", "%xmm4", "%xmm5", "%xmm6", "%xmm7" ); } #undef COMPLEX_DIV2_CORE #define COMPLEX_RCP_CORE(DST, SRC, SEL) \ __ASM_EMIT ("xor %[off], %[off]") \ __ASM_EMIT ("vmovaps 0x00 + %[CC], %%zmm6") /* zmm6 = 1 */ \ /* x32 blocks */ \ __ASM_EMIT32("subl $32, %[count]") \ __ASM_EMIT64("sub $32, %[count]") \ __ASM_EMIT ("jb 2f") \ __ASM_EMIT ("1:") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_re], %[off]), %%zmm0") /* zmm0 = ar */ \ __ASM_EMIT ("vmovups 0x40(%[" SRC "_re], %[off]), %%zmm1") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_im], %[off]), %%zmm2") /* zmm2 = ai */ \ __ASM_EMIT ("vmovups 0x40(%[" SRC "_im], %[off]), %%zmm3") \ __ASM_EMIT ("vmulps %%zmm0, %%zmm0, %%zmm4") /* zmm4 = ar*ar */ \ __ASM_EMIT ("vmulps %%zmm1, %%zmm1, %%zmm5") \ __ASM_EMIT ("vfmadd231ps %%zmm2, %%zmm2, %%zmm4") /* zmm4 = R = ar*ar+ai*ai */ \ __ASM_EMIT ("vfmadd231ps %%zmm3, %%zmm3, %%zmm5") \ __ASM_EMIT ("vdivps %%zmm4, %%zmm6, %%zmm4") /* zmm4 = 1/R */ \ __ASM_EMIT ("vdivps %%zmm5, %%zmm6, %%zmm5") \ __ASM_EMIT ("vpxord 0x40 + %[CC], %%zmm2, %%zmm2") /* zmm2 = -ai */ \ __ASM_EMIT ("vpxord 0x40 + %[CC], %%zmm3, %%zmm3") \ __ASM_EMIT ("vmulps %%zmm4, %%zmm0, %%zmm0") /* zmm0 = ar/R */ \ __ASM_EMIT ("vmulps %%zmm5, %%zmm1, %%zmm1") \ __ASM_EMIT ("vmulps %%zmm4, %%zmm2, %%zmm2") /* zmm1 = -ai/R */ \ __ASM_EMIT ("vmulps %%zmm5, %%zmm3, %%zmm3") \ __ASM_EMIT ("vmovups %%zmm0, 0x00(%[" DST "_re], %[off])") \ __ASM_EMIT ("vmovups %%zmm1, 0x40(%[" DST "_re], %[off])") \ __ASM_EMIT ("vmovups %%zmm2, 0x00(%[" DST "_im], %[off])") \ __ASM_EMIT ("vmovups %%zmm3, 0x40(%[" DST "_im], %[off])") \ __ASM_EMIT ("add $0x80, %[off]") \ __ASM_EMIT32("subl $32, %[count]") \ __ASM_EMIT64("sub $32, %[count]") \ __ASM_EMIT ("jae 1b") \ __ASM_EMIT ("2:") \ /* x16 blocks */ \ __ASM_EMIT32("addl $16, %[count]") \ __ASM_EMIT64("add $16, %[count]") \ __ASM_EMIT ("jl 4f") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_re], %[off]), %%ymm0") /* ymm0 = ar */ \ __ASM_EMIT ("vmovups 0x20(%[" SRC "_re], %[off]), %%ymm1") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_im], %[off]), %%ymm2") /* ymm2 = ai */ \ __ASM_EMIT ("vmovups 0x20(%[" SRC "_im], %[off]), %%ymm3") \ __ASM_EMIT ("vmulps %%ymm0, %%ymm0, %%ymm4") /* ymm4 = ar*ar */ \ __ASM_EMIT ("vmulps %%ymm1, %%ymm1, %%ymm5") \ __ASM_EMIT ("vfmadd231ps %%ymm2, %%ymm2, %%ymm4") /* ymm4 = R = ar*ar+ai*ai */ \ __ASM_EMIT ("vfmadd231ps %%ymm3, %%ymm3, %%ymm5") \ __ASM_EMIT ("vdivps %%ymm4, %%ymm6, %%ymm4") /* ymm4 = 1/R */ \ __ASM_EMIT ("vdivps %%ymm5, %%ymm6, %%ymm5") \ __ASM_EMIT ("vpxord 0x40 + %[CC], %%ymm2, %%ymm2") /* ymm2 = -ai */ \ __ASM_EMIT ("vpxord 0x40 + %[CC], %%ymm3, %%ymm3") \ __ASM_EMIT ("vmulps %%ymm4, %%ymm0, %%ymm0") /* ymm0 = ar/R */ \ __ASM_EMIT ("vmulps %%ymm5, %%ymm1, %%ymm1") \ __ASM_EMIT ("vmulps %%ymm4, %%ymm2, %%ymm2") /* ymm1 = -ai/R */ \ __ASM_EMIT ("vmulps %%ymm5, %%ymm3, %%ymm3") \ __ASM_EMIT ("vmovups %%ymm0, 0x00(%[" DST "_re], %[off])") \ __ASM_EMIT ("vmovups %%ymm1, 0x20(%[" DST "_re], %[off])") \ __ASM_EMIT ("vmovups %%ymm2, 0x00(%[" DST "_im], %[off])") \ __ASM_EMIT ("vmovups %%ymm3, 0x20(%[" DST "_im], %[off])") \ __ASM_EMIT ("add $0x40, %[off]") \ __ASM_EMIT32("subl $16, %[count]") \ __ASM_EMIT64("sub $16, %[count]") \ __ASM_EMIT ("jae 1b") \ __ASM_EMIT ("4:") \ /* 8x block */ \ __ASM_EMIT32("addl $8, %[count]") \ __ASM_EMIT64("add $8, %[count]") \ __ASM_EMIT ("jl 6f") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_re], %[off]), %%xmm0") /* xmm0 = ar */ \ __ASM_EMIT ("vmovups 0x10(%[" SRC "_re], %[off]), %%xmm1") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_im], %[off]), %%xmm2") /* xmm2 = ai */ \ __ASM_EMIT ("vmovups 0x10(%[" SRC "_im], %[off]), %%xmm3") \ __ASM_EMIT ("vmulps %%xmm0, %%xmm0, %%xmm4") /* xmm4 = ar*ar */ \ __ASM_EMIT ("vmulps %%xmm1, %%xmm1, %%xmm5") \ __ASM_EMIT ("vfmadd231ps %%xmm2, %%xmm2, %%xmm4") /* xmm4 = R = ar*ar+ai*ai */ \ __ASM_EMIT ("vfmadd231ps %%xmm3, %%xmm3, %%xmm5") \ __ASM_EMIT ("vdivps %%xmm4, %%xmm6, %%xmm4") /* xmm4 = 1/R */ \ __ASM_EMIT ("vdivps %%xmm5, %%xmm6, %%xmm5") \ __ASM_EMIT ("vpxord 0x40 + %[CC], %%xmm2, %%xmm2") /* xmm2 = -ai */ \ __ASM_EMIT ("vpxord 0x40 + %[CC], %%xmm3, %%xmm3") \ __ASM_EMIT ("vmulps %%xmm4, %%xmm0, %%xmm0") /* xmm0 = ar/R */ \ __ASM_EMIT ("vmulps %%xmm5, %%xmm1, %%xmm1") \ __ASM_EMIT ("vmulps %%xmm4, %%xmm2, %%xmm2") /* xmm1 = -ai/R */ \ __ASM_EMIT ("vmulps %%xmm5, %%xmm3, %%xmm3") \ __ASM_EMIT ("vmovups %%xmm0, 0x00(%[" DST "_re], %[off])") \ __ASM_EMIT ("vmovups %%xmm1, 0x10(%[" DST "_re], %[off])") \ __ASM_EMIT ("vmovups %%xmm2, 0x00(%[" DST "_im], %[off])") \ __ASM_EMIT ("vmovups %%xmm3, 0x10(%[" DST "_im], %[off])") \ __ASM_EMIT32("subl $8, %[count]") \ __ASM_EMIT64("sub $8, %[count]") \ __ASM_EMIT ("add $0x20, %[off]") \ __ASM_EMIT ("6:") \ /* 4x block */ \ __ASM_EMIT32("addl $4, %[count]") \ __ASM_EMIT64("add $4, %[count]") \ __ASM_EMIT ("jl 8f") \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_re], %[off]), %%xmm0") /* xmm0 = ar */ \ __ASM_EMIT ("vmovups 0x00(%[" SRC "_im], %[off]), %%xmm2") /* xmm2 = ai */ \ __ASM_EMIT ("vmulps %%xmm0, %%xmm0, %%xmm4") /* xmm4 = ar*ar */ \ __ASM_EMIT ("vfmadd231ps %%xmm2, %%xmm2, %%xmm4") /* xmm4 = R = ar*ar+ai*ai */ \ __ASM_EMIT ("vdivps %%xmm4, %%xmm6, %%xmm4") /* xmm4 = 1/R */ \ __ASM_EMIT ("vpxord 0x40 + %[CC], %%xmm2, %%xmm2") /* xmm2 = -ai */ \ __ASM_EMIT ("vmulps %%xmm4, %%xmm0, %%xmm0") /* xmm0 = ar/R */ \ __ASM_EMIT ("vmulps %%xmm4, %%xmm2, %%xmm2") /* xmm1 = -ai/R */ \ __ASM_EMIT ("vmovups %%xmm0, 0x00(%[" DST "_re], %[off])") \ __ASM_EMIT ("vmovups %%xmm2, 0x00(%[" DST "_im], %[off])") \ __ASM_EMIT32("subl $4, %[count]") \ __ASM_EMIT64("sub $4, %[count]") \ __ASM_EMIT ("add $0x10, %[off]") \ __ASM_EMIT ("8:") \ /* 1x blocks */ \ __ASM_EMIT32("addl $3, %[count]") \ __ASM_EMIT64("add $3, %[count]") \ __ASM_EMIT ("jl 10f") \ __ASM_EMIT ("9:") \ __ASM_EMIT ("vmovss 0x00(%[" SRC "_re], %[off]), %%xmm0") /* xmm0 = ar */ \ __ASM_EMIT ("vmovss 0x00(%[" SRC "_im], %[off]), %%xmm2") /* xmm2 = ai */ \ __ASM_EMIT ("vmulss %%xmm0, %%xmm0, %%xmm4") /* xmm4 = ar*ar */ \ __ASM_EMIT ("vfmadd231ss %%xmm2, %%xmm2, %%xmm4") /* xmm4 = R = ar*ar+ai*ai */ \ __ASM_EMIT ("vdivss %%xmm4, %%xmm6, %%xmm4") /* xmm4 = 1/R */ \ __ASM_EMIT ("vpxord 0x40 + %[CC], %%xmm2, %%xmm2") /* xmm2 = -ai */ \ __ASM_EMIT ("vmulss %%xmm4, %%xmm0, %%xmm0") /* xmm0 = ar/R */ \ __ASM_EMIT ("vmulss %%xmm4, %%xmm2, %%xmm2") /* xmm1 = -ai/R */ \ __ASM_EMIT ("vmovss %%xmm0, 0x00(%[" DST "_re], %[off])") \ __ASM_EMIT ("vmovss %%xmm2, 0x00(%[" DST "_im], %[off])") \ __ASM_EMIT ("add $0x04, %[off]") \ __ASM_EMIT32("decl %[count]") \ __ASM_EMIT64("dec %[count]") \ __ASM_EMIT ("jge 9b") \ __ASM_EMIT ("10:") void complex_rcp1(float *dst_re, float *dst_im, size_t count) { IF_ARCH_X86(size_t off); ARCH_X86_ASM ( COMPLEX_RCP_CORE("dst", "dst", FMA_OFF) : [count] "+r" (count), [off] "=&r" (off) : [dst_re] "r" (dst_re), [dst_im] "r" (dst_im), [CC] "o" (complex_div_const) : "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_X86(size_t off); ARCH_X86_ASM ( COMPLEX_RCP_CORE("dst", "src", FMA_OFF) : [count] X86_PGREG (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] "o" (complex_div_const) : "cc", "memory", "%xmm0", "%xmm1", "%xmm2", "%xmm3", "%xmm4", "%xmm5", "%xmm6", "%xmm7" ); } #undef COMPLEX_RCP_CORE } /* namespace avx512 */ } /* namespace lsp */ #endif /* PRIVATE_DSP_ARCH_X86_AVX512_COMPLEX_H_ */