fork/rust-sdks

git clone https://git.julia.blue/fork/rust-sdks

Théo Monnomsoxr-sys (#438)2e4d385

livekit/livekit-ffi@0.13.0
1.9 KiB61 linesraw
1/* SoX Resampler Library      Copyright (c) 2007-16 robs@users.sourceforge.net
2 * Licence for this file: LGPL v2.1                  See LICENCE for details. */
3
4/* Decimate by 2 using a FIR with odd length (LEN). */
5/* Input must be preceded and followed by LEN >> 1 samples. */
6
7#define COEFS ((sample_t const *)p->coefs)
8
9#if SIMD_SSE
10  #define BEGINNING v4_t sum, q1, q2, t
11  #define ____ \
12    q1 = _mm_shuffle_ps(t=vLdu(input+2*j),vLdu(input+2*j+4),_MM_SHUFFLE(3,1,3,1)); \
13    q2 = _mm_shuffle_ps(vLdu(input-2*j-4),vLdu(input-2*j-8),_MM_SHUFFLE(1,3,1,3)); \
14    sum = vAdd(j? sum : vMul(vSet1(.5), t), vMul(vAdd(q1, q2), vLd(COEFS+j))); \
15    j += 4;
16  #define __ \
17    q1 = _mm_shuffle_ps(vLdu(input+2*j), vLdu(input-2*j-4), _MM_SHUFFLE(1,3,3,1)); \
18    q2 = _mm_loadl_pi(q2, (__m64*)(COEFS+j)), q2 = _mm_movelh_ps(q2, q2); \
19    sum = vAdd(sum, vMul(q1, q2)); \
20    j += 2;
21  #define _ \
22    q1 = _mm_add_ss(_mm_load_ss(input+2*j+1), _mm_load_ss(input-2*j-1)); \
23    sum = _mm_add_ss(sum, _mm_mul_ss(q1, _mm_load_ss(COEFS+j))); \
24    ++j;
25  #define END vStorSum(output+i, sum)
26/* #elif SIMD_AVX; No good solution found. */
27/* #elif SIMD_NEON; No need: gcc -O3 does a good job by itself. */
28#else
29  #define BEGINNING sample_t sum = input[0] * .5f
30  #define ____ __ __
31  #define __ _ _
32  #define _ sum += (input[-(2*j +1)] + input[(2*j +1)]) * COEFS[j], ++j;
33  #define END output[i] = sum
34#endif
35
36
37
38static void FUNCTION_H(stage_t * p, fifo_t * output_fifo)
39{
40  sample_t const * __restrict input = stage_read_p(p);
41  int num_in = min(stage_occupancy(p), p->input_size);
42  int i, num_out = (num_in + 1) >> 1;
43  sample_t * __restrict output = fifo_reserve(output_fifo, num_out);
44
45  for (i = 0; i < num_out; ++i, input += 2) {
46    int j = 0;
47    BEGINNING; CONVOLVE; END;
48  }
49  fifo_read(&p->fifo, 2 * num_out, NULL);
50}
51
52
53
54#undef _
55#undef __
56#undef ____
57#undef BEGINNING
58#undef END
59#undef COEFS
60#undef CONVOLVE
61#undef FUNCTION_H