diff --git a/src/resample.c b/src/resample.c --- a/src/resample.c +++ b/src/resample.c @@ -91,23 +91,17 @@ static void speex_free(void *ptr) {free( #ifndef NULL #define NULL 0 #endif #ifndef UINT32_MAX #define UINT32_MAX 4294967295U #endif -#ifdef USE_SSE -#include "resample_sse.h" -#endif - -#ifdef USE_NEON -#include "resample_neon.h" -#endif +#include "simd_detect.h" /* Number of elements to allocate on the stack */ #ifdef VAR_ARRAYS #define FIXED_STACK_ALLOC 8192 #else #define FIXED_STACK_ALLOC 1024 #endif @@ -341,17 +335,19 @@ static int resampler_basic_direct_single const spx_uint32_t den_rate = st->den_rate; spx_word32_t sum; while (!(last_sample >= (spx_int32_t)*in_len || out_sample >= (spx_int32_t)*out_len)) { const spx_word16_t *sinct = & sinc_table[samp_frac_num*N]; const spx_word16_t *iptr = & in[last_sample]; -#ifndef OVERRIDE_INNER_PRODUCT_SINGLE +#ifdef OVERRIDE_INNER_PRODUCT_SINGLE + if (!moz_speex_have_single_simd()) { +#endif int j; sum = 0; for(j=0;j= den_rate) { samp_frac_num -= den_rate; @@ -399,29 +397,33 @@ static int resampler_basic_direct_double const spx_uint32_t den_rate = st->den_rate; double sum; while (!(last_sample >= (spx_int32_t)*in_len || out_sample >= (spx_int32_t)*out_len)) { const spx_word16_t *sinct = & sinc_table[samp_frac_num*N]; const spx_word16_t *iptr = & in[last_sample]; -#ifndef OVERRIDE_INNER_PRODUCT_DOUBLE +#ifdef OVERRIDE_INNER_PRODUCT_DOUBLE + if(moz_speex_have_double_simd()) { +#endif int j; double accum[4] = {0,0,0,0}; for(j=0;j= den_rate) { samp_frac_num -= den_rate; @@ -455,34 +457,38 @@ static int resampler_basic_interpolate_s #ifdef FIXED_POINT const spx_word16_t frac = PDIV32(SHL32((samp_frac_num*st->oversample) % st->den_rate,15),st->den_rate); #else const spx_word16_t frac = ((float)((samp_frac_num*st->oversample) % st->den_rate))/st->den_rate; #endif spx_word16_t interp[4]; -#ifndef OVERRIDE_INTERPOLATE_PRODUCT_SINGLE +#ifdef OVERRIDE_INTERPOLATE_PRODUCT_SINGLE + if (!moz_speex_have_single_simd()) { +#endif int j; spx_word32_t accum[4] = {0,0,0,0}; for(j=0;jsinc_table[4+(j+1)*st->oversample-offset-2]); accum[1] += MULT16_16(curr_in,st->sinc_table[4+(j+1)*st->oversample-offset-1]); accum[2] += MULT16_16(curr_in,st->sinc_table[4+(j+1)*st->oversample-offset]); accum[3] += MULT16_16(curr_in,st->sinc_table[4+(j+1)*st->oversample-offset+1]); } cubic_coef(frac, interp); sum = MULT16_32_Q15(interp[0],accum[0]) + MULT16_32_Q15(interp[1],accum[1]) + MULT16_32_Q15(interp[2],accum[2]) + MULT16_32_Q15(interp[3],accum[3]); sum = SATURATE32PSHR(sum, 15, 32767); -#else +#ifdef OVERRIDE_INTERPOLATE_PRODUCT_SINGLE + } else { cubic_coef(frac, interp); sum = interpolate_product_single(iptr, st->sinc_table + st->oversample + 4 - offset - 2, N, st->oversample, interp); + } #endif out[out_stride * out_sample++] = sum; last_sample += int_advance; samp_frac_num += frac_advance; if (samp_frac_num >= den_rate) { samp_frac_num -= den_rate; @@ -518,33 +524,37 @@ static int resampler_basic_interpolate_d #ifdef FIXED_POINT const spx_word16_t frac = PDIV32(SHL32((samp_frac_num*st->oversample) % st->den_rate,15),st->den_rate); #else const spx_word16_t frac = ((float)((samp_frac_num*st->oversample) % st->den_rate))/st->den_rate; #endif spx_word16_t interp[4]; -#ifndef OVERRIDE_INTERPOLATE_PRODUCT_DOUBLE +#ifdef OVERRIDE_INTERPOLATE_PRODUCT_DOUBLE + if (!moz_speex_have_double_simd()) { +#endif int j; double accum[4] = {0,0,0,0}; for(j=0;jsinc_table[4+(j+1)*st->oversample-offset-2]); accum[1] += MULT16_16(curr_in,st->sinc_table[4+(j+1)*st->oversample-offset-1]); accum[2] += MULT16_16(curr_in,st->sinc_table[4+(j+1)*st->oversample-offset]); accum[3] += MULT16_16(curr_in,st->sinc_table[4+(j+1)*st->oversample-offset+1]); } cubic_coef(frac, interp); sum = MULT16_32_Q15(interp[0],accum[0]) + MULT16_32_Q15(interp[1],accum[1]) + MULT16_32_Q15(interp[2],accum[2]) + MULT16_32_Q15(interp[3],accum[3]); -#else +#ifdef OVERRIDE_INTERPOLATE_PRODUCT_DOUBLE + } else { cubic_coef(frac, interp); sum = interpolate_product_double(iptr, st->sinc_table + st->oversample + 4 - offset - 2, N, st->oversample, interp); + } #endif out[out_stride * out_sample++] = PSHR32(sum,15); last_sample += int_advance; samp_frac_num += frac_advance; if (samp_frac_num >= den_rate) { samp_frac_num -= den_rate; diff --git a/src/resample_neon.c b/src/resample_neon.c --- a/src/resample_neon.c +++ b/src/resample_neon.c @@ -32,16 +32,17 @@ PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ #include +#include "simd_detect.h" #ifdef FIXED_POINT #if defined(__aarch64__) static inline int32_t saturate_32bit_to_16bit(int32_t a) { int32_t ret; asm ("fmov s0, %w[a]\n" "sqxtn h0, s0\n" "sxtl v0.4s, v0.4h\n" @@ -73,17 +74,17 @@ } #endif #undef WORD2INT #define WORD2INT(x) (saturate_32bit_to_16bit(x)) #define OVERRIDE_INNER_PRODUCT_SINGLE /* Only works when len % 4 == 0 and len >= 4 */ #if defined(__aarch64__) -static inline int32_t inner_product_single(const int16_t *a, const int16_t *b, unsigned int len) +inline int32_t inner_product_single(const int16_t *a, const int16_t *b, unsigned int len) { int32_t ret; uint32_t remainder = len % 16; len = len - remainder; asm volatile (" cmp %w[len], #0\n" " b.ne 1f\n" " ld1 {v16.4h}, [%[b]], #8\n" @@ -128,17 +129,17 @@ : [ret] "=r" (ret), [a] "+r" (a), [b] "+r" (b), [len] "+r" (len), [remainder] "+r" (remainder) : : "cc", "v0", "v16", "v17", "v18", "v19", "v20", "v21", "v22", "v23"); return ret; } #else -static inline int32_t inner_product_single(const int16_t *a, const int16_t *b, unsigned int len) +inline int32_t inner_product_single(const int16_t *a, const int16_t *b, unsigned int len) { int32_t ret; uint32_t remainder = len % 16; len = len - remainder; asm volatile (" cmp %[len], #0\n" " bne 1f\n" " vld1.16 {d16}, [%[b]]!\n" @@ -218,17 +219,17 @@ #endif #undef WORD2INT #define WORD2INT(x) (saturate_float_to_16bit(x)) #define OVERRIDE_INNER_PRODUCT_SINGLE /* Only works when len % 4 == 0 and len >= 4 */ #if defined(__aarch64__) -static inline float inner_product_single(const float *a, const float *b, unsigned int len) +inline float inner_product_single(const float *a, const float *b, unsigned int len) { float ret; uint32_t remainder = len % 16; len = len - remainder; asm volatile (" cmp %w[len], #0\n" " b.ne 1f\n" " ld1 {v16.4s}, [%[b]], #16\n" @@ -273,17 +274,17 @@ : [ret] "=w" (ret), [a] "+r" (a), [b] "+r" (b), [len] "+r" (len), [remainder] "+r" (remainder) : : "cc", "v1", "v2", "v3", "v4", "v16", "v17", "v18", "v19", "v20", "v21", "v22", "v23"); return ret; } #else -static inline float inner_product_single(const float *a, const float *b, unsigned int len) +inline float inner_product_single(const float *a, const float *b, unsigned int len) { float ret; uint32_t remainder = len % 16; len = len - remainder; asm volatile (" cmp %[len], #0\n" " bne 1f\n" " vld1.32 {q4}, [%[b]]!\n" diff --git a/src/resample_sse.c b/src/resample_sse.c --- a/src/resample_sse.c +++ b/src/resample_sse.c @@ -29,37 +29,39 @@ EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ +#include "simd_detect.h" + #include #define OVERRIDE_INNER_PRODUCT_SINGLE -static inline float inner_product_single(const float *a, const float *b, unsigned int len) +float inner_product_single(const float *a, const float *b, unsigned int len) { int i; float ret; __m128 sum = _mm_setzero_ps(); for (i=0;i #define OVERRIDE_INNER_PRODUCT_DOUBLE -static inline double inner_product_double(const float *a, const float *b, unsigned int len) +double inner_product_double(const float *a, const float *b, unsigned int len) { int i; double ret; __m128d sum = _mm_setzero_pd(); __m128 t; for (i=0;i