fork/rust-sdks

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

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

livekit/livekit-ffi@0.13.0
5.6 KiB223 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#include <limits.h>
5#include <math.h>
6#include <string.h>
7
8#include "data-io.h"
9#include "internal.h"
10
11
12
13#define DEINTERLEAVE_FROM(T,flag) do { \
14  unsigned i; \
15  size_t j; \
16  T const * src = *src0; \
17  if (ch > 1) for (j = 0; j < n; ++j) \
18    for (i = 0; i < ch; ++i) dest[i][j] = (DEINTERLEAVE_TO)*src++; \
19  else if (flag) memcpy(dest[0], src, n * sizeof(T)), src = &src[n]; \
20  else for (j = 0; j < n; dest[0][j++] = (DEINTERLEAVE_TO)*src++); \
21  *src0 = src; \
22} while (0)
23
24
25
26#if WITH_CR64 || WITH_CR64S
27void _soxr_deinterleave(double * * dest, /* Round/clipping not needed here */
28    soxr_datatype_t data_type, void const * * src0, size_t n, unsigned ch)
29{
30#define DEINTERLEAVE_TO double
31  switch (data_type & 3) {
32    case SOXR_FLOAT32: DEINTERLEAVE_FROM(float, 0); break;
33    case SOXR_FLOAT64: DEINTERLEAVE_FROM(double, 1); break;
34    case SOXR_INT32:   DEINTERLEAVE_FROM(int32_t, 0); break;
35    case SOXR_INT16:   DEINTERLEAVE_FROM(int16_t, 0); break;
36    default: break;
37  }
38}
39#endif
40
41
42
43#if WITH_CR32 || WITH_CR32S || WITH_VR32
44void _soxr_deinterleave_f(float * * dest, /* Round/clipping not needed here */
45    soxr_datatype_t data_type, void const * * src0, size_t n, unsigned ch)
46{
47#undef DEINTERLEAVE_TO
48#define DEINTERLEAVE_TO float
49  switch (data_type & 3) {
50    case SOXR_FLOAT32: DEINTERLEAVE_FROM(float, 1); break;
51    case SOXR_FLOAT64: DEINTERLEAVE_FROM(double, 0); break;
52    case SOXR_INT32:   DEINTERLEAVE_FROM(int32_t, 0); break;
53    case SOXR_INT16:   DEINTERLEAVE_FROM(int16_t, 0); break;
54    default: break;
55  }
56}
57#endif
58
59
60
61#include "rint.h"
62
63
64
65#if defined FE_INVALID && defined FPU_RINT32 && defined __STDC_VERSION__
66  #if __STDC_VERSION__ >= 199901L
67    #pragma STDC FENV_ACCESS ON
68  #endif
69#endif
70
71#if WITH_CR64 || WITH_CR64S
72#define FLOATX double
73
74#define LSX_RINT_CLIP_2 lsx_rint32_clip_2
75#define LSX_RINT_CLIP lsx_rint32_clip
76#define RINT_CLIP rint32_clip
77#define RINT rint32D
78#if defined FPU_RINT32
79  #define FPU_RINT
80#endif
81#define RINT_T int32_t
82#define RINT_MAX 2147483647L
83#include "rint-clip.h"
84
85#define LSX_RINT_CLIP_2 lsx_rint16_clip_2
86#define LSX_RINT_CLIP lsx_rint16_clip
87#define RINT_CLIP rint16_clip
88#define RINT rint16D
89#if defined FPU_RINT16
90  #define FPU_RINT
91#endif
92#define RINT_T int16_t
93#define RINT_MAX 32767
94#include "rint-clip.h"
95
96#define LSX_RINT_CLIP_2 lsx_rint16_clip_2_dither
97#define LSX_RINT_CLIP lsx_rint16_clip_dither
98#define RINT_CLIP rint16_clip_dither
99#define RINT rint16D
100#if defined FPU_RINT16
101  #define FPU_RINT
102#endif
103#define RINT_T int16_t
104#define RINT_MAX 32767
105#define DITHER
106#include "rint-clip.h"
107
108#undef FLOATX
109#endif
110
111
112
113#if WITH_CR32 || WITH_CR32S || WITH_VR32
114#define FLOATX float
115
116#define LSX_RINT_CLIP_2 lsx_rint32_clip_2_f
117#define LSX_RINT_CLIP lsx_rint32_clip_f
118#define RINT_CLIP rint32_clip_f
119#define RINT rint32F
120#if defined FPU_RINT32
121  #define FPU_RINT
122#endif
123#define RINT_T int32_t
124#define RINT_MAX 2147483647L
125#include "rint-clip.h"
126
127#define LSX_RINT_CLIP_2 lsx_rint16_clip_2_f
128#define LSX_RINT_CLIP lsx_rint16_clip_f
129#define RINT_CLIP rint16_clip_f
130#define RINT rint16F
131#if defined FPU_RINT16
132  #define FPU_RINT
133#endif
134#define RINT_T int16_t
135#define RINT_MAX 32767
136#include "rint-clip.h"
137
138#define LSX_RINT_CLIP_2 lsx_rint16_clip_2_dither_f
139#define LSX_RINT_CLIP lsx_rint16_clip_dither_f
140#define RINT_CLIP rint16_clip_dither_f
141#define RINT rint16D
142#if defined FPU_RINT16
143  #define FPU_RINT
144#endif
145#define RINT_T int16_t
146#define RINT_MAX 32767
147#define DITHER
148#include "rint-clip.h"
149
150#undef FLOATX
151#endif
152
153#if defined FE_INVALID && defined FPU_RINT32 && defined __STDC_VERSION__
154  #if __STDC_VERSION__ >= 199901L
155    #pragma STDC FENV_ACCESS OFF
156  #endif
157#endif
158
159
160
161#define INTERLEAVE_TO(T,flag) do { \
162  unsigned i; \
163  size_t j; \
164  T * dest = *dest0; \
165  if (ch > 1) \
166  for (j = 0; j < n; ++j) for (i = 0; i < ch; ++i) *dest++ = (T)src[i][j]; \
167  else if (flag) memcpy(dest, src[0], n * sizeof(T)), dest = &dest[n]; \
168  else for (j = 0; j < n; *dest++ = (T)src[0][j++]); \
169  *dest0 = dest; \
170  return 0; \
171} while (0)
172
173#if WITH_CR64 || WITH_CR64S
174size_t /* clips */ _soxr_interleave(soxr_datatype_t data_type, void * * dest0,
175  double const * const * src, size_t n, unsigned ch, unsigned long * seed)
176{
177  switch (data_type & 3) {
178    case SOXR_FLOAT32: INTERLEAVE_TO(float, 0);
179    case SOXR_FLOAT64: INTERLEAVE_TO(double, 1);
180
181    case SOXR_INT32: if (ch == 1)
182        return lsx_rint32_clip(dest0, src[0], n);
183      return lsx_rint32_clip_2(dest0, src, ch, n);
184
185    case SOXR_INT16: if (seed) {
186      if (ch == 1)
187        return lsx_rint16_clip_dither(dest0, src[0], n, seed);
188      return lsx_rint16_clip_2_dither(dest0, src, ch, n, seed);
189    }
190    if (ch == 1)
191        return lsx_rint16_clip(dest0, src[0], n);
192      return lsx_rint16_clip_2(dest0, src, ch, n);
193    default: break;
194  }
195  return 0;
196}
197#endif
198
199#if WITH_CR32 || WITH_CR32S || WITH_VR32
200size_t /* clips */ _soxr_interleave_f(soxr_datatype_t data_type, void * * dest0,
201  float const * const * src, size_t n, unsigned ch, unsigned long * seed)
202{
203  switch (data_type & 3) {
204    case SOXR_FLOAT32: INTERLEAVE_TO(float, 1);
205    case SOXR_FLOAT64: INTERLEAVE_TO(double, 0);
206
207    case SOXR_INT32: if (ch == 1)
208        return lsx_rint32_clip_f(dest0, src[0], n);
209      return lsx_rint32_clip_2_f(dest0, src, ch, n);
210
211    case SOXR_INT16: if (seed) {
212      if (ch == 1)
213        return lsx_rint16_clip_dither_f(dest0, src[0], n, seed);
214      return lsx_rint16_clip_2_dither_f(dest0, src, ch, n, seed);
215    }
216    if (ch == 1)
217        return lsx_rint16_clip_f(dest0, src[0], n);
218      return lsx_rint16_clip_2_f(dest0, src, ch, n);
219    default: break;
220  }
221  return 0;
222}
223#endif