fork/rust-sdks

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

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

main
3.6 KiB158 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#if defined DITHER
5
6#define DITHERING + (1./32)*(int)(((ran1>>=3)&31)-((ran2>>=3)&31))
7#define DITHER_RAND (seed = 1664525UL * seed + 1013904223UL) >> 3
8#define DITHER_VARS unsigned long ran1 = DITHER_RAND, ran2 = DITHER_RAND
9#define SEED_ARG , unsigned long * seed0
10#define SAVE_SEED *seed0 = seed
11#define COPY_SEED unsigned long seed = *seed0;
12#define COPY_SEED1 unsigned long seed1 = seed
13#define PASS_SEED1 , &seed1
14#define PASS_SEED  , &seed
15#define FLOATD double
16
17#else
18
19#define DITHERING
20#define DITHER_VARS
21#define SEED_ARG
22#define SAVE_SEED
23#define COPY_SEED
24#define COPY_SEED1
25#define PASS_SEED1
26#define PASS_SEED
27#define FLOATD FLOATX
28
29#endif
30
31#define DO_16 _;_;_;_;_;_;_;_;_;_;_;_;_;_;_;_
32
33
34
35#if defined FE_INVALID && defined FPU_RINT
36static void RINT_CLIP(RINT_T * const dest, FLOATX const * const src,
37    unsigned stride, size_t i, size_t const n, size_t * const clips SEED_ARG)
38{
39  COPY_SEED
40  DITHER_VARS;
41  for (; i < n; ++i) {
42    FLOATD const d = src[i] DITHERING;
43    RINT(dest[stride * i], d);
44    if (fe_test_invalid()) {
45      fe_clear_invalid();
46      dest[stride * i] = d > 0? RINT_MAX : -RINT_MAX - 1;
47      ++*clips;
48    }
49  }
50  SAVE_SEED;
51}
52#endif
53
54
55
56static size_t LSX_RINT_CLIP(void * * const dest0, FLOATX const * const src,
57    size_t const n SEED_ARG)
58{
59  size_t i, clips = 0;
60  RINT_T * dest = *dest0;
61  COPY_SEED
62#if defined FE_INVALID && defined FPU_RINT
63#define _ RINT(dest[i], src[i] DITHERING); ++i
64  for (i = 0; i < (n & ~15u);) {
65    COPY_SEED1;
66    DITHER_VARS;
67    DO_16;
68    if (fe_test_invalid()) {
69      fe_clear_invalid();
70      RINT_CLIP(dest, src, 1, i - 16, i, &clips PASS_SEED1);
71    }
72  }
73  RINT_CLIP(dest, src, 1, i, n, &clips PASS_SEED);
74#else
75#define _ d = src[i] DITHERING, dest[i++] = (RINT_T)(d > 0? \
76    d+.5 >= N? ++clips, N-1 : d+.5 : d-.5 <= -N-1? ++clips, -N:d-.5)
77  const double N = 1. + RINT_MAX;
78  double d;
79  for (i = 0; i < (n & ~15u);) {
80    DITHER_VARS;
81    DO_16;
82  }
83  {
84    DITHER_VARS;
85    for (; i < n; _);
86  }
87#endif
88  SAVE_SEED;
89  *dest0 = dest + n;
90  return clips;
91}
92#undef _
93
94
95
96static size_t LSX_RINT_CLIP_2(void * * dest0, FLOATX const * const * srcs,
97    unsigned const stride, size_t const n SEED_ARG)
98{
99  unsigned j;
100  size_t i, clips = 0;
101  RINT_T * dest = *dest0;
102  COPY_SEED
103#if defined FE_INVALID && defined FPU_RINT
104#define _ RINT(dest[stride * i], src[i] DITHERING); ++i
105  for (j = 0; j < stride; ++j, ++dest) {
106    FLOATX const * const src = srcs[j];
107    for (i = 0; i < (n & ~15u);) {
108      COPY_SEED1;
109      DITHER_VARS;
110      DO_16;
111      if (fe_test_invalid()) {
112        fe_clear_invalid();
113        RINT_CLIP(dest, src, stride, i - 16, i, &clips PASS_SEED1);
114      }
115    }
116    RINT_CLIP(dest, src, stride, i, n, &clips PASS_SEED);
117  }
118#else
119#define _ d = src[i] DITHERING, dest[stride * i++] = (RINT_T)(d > 0? \
120    d+.5 >= N? ++clips, N-1 : d+.5 : d-.5 <= -N-1? ++clips, -N:d-.5)
121  const double N = 1. + RINT_MAX;
122  double d;
123  for (j = 0; j < stride; ++j, ++dest) {
124    FLOATX const * const src = srcs[j];
125    for (i = 0; i < (n & ~15u);) {
126      DITHER_VARS;
127      DO_16;
128    }
129    {
130      DITHER_VARS;
131      for (; i < n; _);
132    }
133  }
134#endif
135  SAVE_SEED;
136  *dest0 = dest + stride * (n - 1);
137  return clips;
138}
139#undef _
140
141#undef FLOATD
142#undef PASS_SEED
143#undef PASS_SEED1
144#undef COPY_SEED1
145#undef COPY_SEED
146#undef SAVE_SEED
147#undef SEED_ARG
148#undef DITHER_VARS
149#undef DITHERING
150#undef DITHER
151
152#undef RINT_MAX
153#undef RINT_T
154#undef FPU_RINT
155#undef RINT
156#undef RINT_CLIP
157#undef LSX_RINT_CLIP
158#undef LSX_RINT_CLIP_2