/* * Copyright (C) 2020 Linux Studio Plugins Project * (C) 2020 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_SMATH_H_ #define PRIVATE_DSP_ARCH_X86_SSE_SMATH_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 { float ipowf(float x, int deg) { float res = 1.0f; float one; ARCH_X86_ASM ( __ASM_EMIT("cmp $0, %[deg]") __ASM_EMIT("jz 100f") __ASM_EMIT("jl 10f") __ASM_EMIT("1:") __ASM_EMIT("test $1, %[deg]") __ASM_EMIT("jz 2f") __ASM_EMIT("mulss %[x], %[res]") __ASM_EMIT("dec %[deg]") __ASM_EMIT("jnz 1b") __ASM_EMIT("jmp 100f") __ASM_EMIT("2:") __ASM_EMIT("mulss %[x], %[x]") __ASM_EMIT("shr $1, %[deg]") __ASM_EMIT("jnz 1b") __ASM_EMIT("jmp 100f") __ASM_EMIT("10:") __ASM_EMIT("neg %[deg]") __ASM_EMIT("movaps %[res], %[one]") __ASM_EMIT("1:") __ASM_EMIT("test $1, %[deg]") __ASM_EMIT("jz 2f") __ASM_EMIT("mulss %[x], %[res]") __ASM_EMIT("dec %[deg]") __ASM_EMIT("jnz 1b") __ASM_EMIT("jmp 20f") __ASM_EMIT("2:") __ASM_EMIT("mulss %[x], %[x]") __ASM_EMIT("shr $1, %[deg]") __ASM_EMIT("jnz 1b") __ASM_EMIT("20:") __ASM_EMIT("divss %[res], %[one]") __ASM_EMIT("movaps %[one], %[res]") __ASM_EMIT("100:") : [x] "+x" (x), [res] "+x" (res), [deg] "+r" (deg), [one] "=&x" (one) : : "cc" ); return res; } IF_ARCH_X86( static const uint32_t irootf_const[] __lsp_aligned16 = { LSP_DSP_VEC4(0x3f800000), LSP_DSP_VEC4(0x7fffffff), LSP_DSP_VEC4(0x3727c5ac) }; ); float irootf(float x, int deg) { float a, tmp, k, sign, xp; float tres, tx; int tdeg; ARCH_X86_ASM ( __ASM_EMIT("cmp $1, %[deg]") __ASM_EMIT("jl 100f") // While deg is odd, just calculate sqrt function __ASM_EMIT("test $1, %[deg]") __ASM_EMIT("jne 2f") __ASM_EMIT("1:") __ASM_EMIT("shr $1, %[deg]") __ASM_EMIT("sqrtss %[x], %[x]") __ASM_EMIT("test $1, %[deg]") __ASM_EMIT("jz 1b") __ASM_EMIT("cmp $1, %[deg]") __ASM_EMIT("jbe 100f") // Prepare calculations __ASM_EMIT("2:") __ASM_EMIT("movaps 0x00(%[CC]), %[a]") __ASM_EMIT("cvtsi2ss %[deg], %[tmp]") __ASM_EMIT("movaps 0x10(%[CC]), %[sign]") __ASM_EMIT("divss %[tmp], %[a]") __ASM_EMIT("dec %[deg]") __ASM_EMIT("cvtsi2ss %[deg], %[k]") __ASM_EMIT("mulss %[a], %[k]") __ASM_EMIT("mulss %[x], %[a]") // Newton method __ASM_EMIT("1:") __ASM_EMIT("movaps %[x], %[xp]") // xp = x __ASM_EMIT("movaps 0x00(%[CC]), %[tres]") // tres = 1 __ASM_EMIT("movaps %[x], %[tx]") // tx = x __ASM_EMIT("mov %[deg], %[tdeg]") // tdeg = deg // Calculate tres = x ^ deg __ASM_EMIT("10:") __ASM_EMIT("test $1, %[tdeg]") // if (tdeg & 1) __ASM_EMIT("jz 2f") __ASM_EMIT("mulss %[tx], %[tres]") // tres *= tx __ASM_EMIT("dec %[tdeg]") // tdeg-- __ASM_EMIT("jnz 10b") __ASM_EMIT("jmp 20f") __ASM_EMIT("2:") __ASM_EMIT("mulss %[tx], %[tx]") // tx = tx * tx __ASM_EMIT("shr $1, %[tdeg]") // tdeg >>= 1 __ASM_EMIT("jnz 10b") __ASM_EMIT("20:") // Calculate x = k*x + a/tres __ASM_EMIT("movaps %[a], %[tx]") // tx = a __ASM_EMIT("mulss %[k], %[x]") // x = x*k __ASM_EMIT("divss %[tres], %[tx]") // tx = a/tres __ASM_EMIT("addss %[tx], %[x]") // x = x*k + a/tres // Estimate tolerance __ASM_EMIT("movaps %[x], %[tx]") // tx = x __ASM_EMIT("subss %[x], %[xp]") // xp = xp - x __ASM_EMIT("mulss 0x20(%[CC]), %[tx]") // tx = x * TOL __ASM_EMIT("andps %[sign], %[x]") // xp = abs(xp - x) __ASM_EMIT("andps %[sign], %[tx]") // xp = abs(xp - x) __ASM_EMIT("ucomiss %[tx], %[xp]") // abs(xp - x) <> x * TOL __ASM_EMIT("ja 1b") // Repeat loop if tolerance is not enough __ASM_EMIT("100:") : [x] "+x" (x), [a] "=&x" (a), [tmp] "=&x" (tmp), [k] "=&x" (k), [sign] "=&x" (sign), [xp] "=&x" (xp), [tres] "=&x" (tres), [tx] "=&x" (tx), [deg] "+r" (deg), [tdeg] "=&r" (tdeg) : [CC] "r" (irootf_const) : "cc" ); return x; // // Check validity of arguments // if (deg <= 1) // return x; // // // While root is odd, simple calc square root // if (!(deg & 1)) // { // do // { // x = sqrtf(x); // deg >>= 1; // } while (!(deg & 1)); // // if (deg <= 1) // return x; // } // // // Newton method // float xp; // float a = 1.0f / float(deg); // float k = float(--deg) * a; // a *= x; // // do // { // xp = x; // x = k*x + a / ipospowf(x, deg); // } while (fabs(x - xp) > (1e-5 * x)); // // return x; } } } #endif /* PRIVATE_DSP_ARCH_X86_SSE_SMATH_H_ */