fork/rust-sdks
git clone https://git.julia.blue/fork/rust-sdks
2e4d385
main
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 */ 28soxr_datatype_t data_type ,void const * * src0 ,size_t n ,unsigned ch ) 29{ 30#define DEINTERLEAVE_TO double 31switch (data_type & 3 ) { 32case SOXR_FLOAT32 :DEINTERLEAVE_FROM (float ,0 );break ; 33case SOXR_FLOAT64 :DEINTERLEAVE_FROM (double ,1 );break ; 34case SOXR_INT32 :DEINTERLEAVE_FROM (int32_t ,0 );break ; 35case SOXR_INT16 :DEINTERLEAVE_FROM (int16_t ,0 );break ; 36default :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 */ 45soxr_datatype_t data_type ,void const * * src0 ,size_t n ,unsigned ch ) 46{ 47#undef DEINTERLEAVE_TO 48#define DEINTERLEAVE_TO float 49switch (data_type & 3 ) { 50case SOXR_FLOAT32 :DEINTERLEAVE_FROM (float ,1 );break ; 51case SOXR_FLOAT64 :DEINTERLEAVE_FROM (double ,0 );break ; 52case SOXR_INT32 :DEINTERLEAVE_FROM (int32_t ,0 );break ; 53case SOXR_INT16 :DEINTERLEAVE_FROM (int16_t ,0 );break ; 54default :break ; 55 } 56} 57#endif 58 59 60 61#include "rint.h" 62 63 64 65#if definedFE_INVALID && definedFPU_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 definedFPU_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 definedFPU_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 definedFPU_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 definedFPU_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 definedFPU_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 definedFPU_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 definedFE_INVALID && definedFPU_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 , 175double const * const * src ,size_t n ,unsigned ch ,unsigned long * seed ) 176{ 177switch (data_type & 3 ) { 178case SOXR_FLOAT32 :INTERLEAVE_TO (float ,0 ); 179case SOXR_FLOAT64 :INTERLEAVE_TO (double ,1 ); 180 181case SOXR_INT32 :if (ch == 1 ) 182return lsx_rint32_clip (dest0 ,src [0 ],n ); 183return lsx_rint32_clip_2 (dest0 ,src ,ch ,n ); 184 185case SOXR_INT16 :if (seed ) { 186if (ch == 1 ) 187return lsx_rint16_clip_dither (dest0 ,src [0 ],n ,seed ); 188return lsx_rint16_clip_2_dither (dest0 ,src ,ch ,n ,seed ); 189 } 190if (ch == 1 ) 191return lsx_rint16_clip (dest0 ,src [0 ],n ); 192return lsx_rint16_clip_2 (dest0 ,src ,ch ,n ); 193default :break ; 194 } 195return 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 , 201float const * const * src ,size_t n ,unsigned ch ,unsigned long * seed ) 202{ 203switch (data_type & 3 ) { 204case SOXR_FLOAT32 :INTERLEAVE_TO (float ,1 ); 205case SOXR_FLOAT64 :INTERLEAVE_TO (double ,0 ); 206 207case SOXR_INT32 :if (ch == 1 ) 208return lsx_rint32_clip_f (dest0 ,src [0 ],n ); 209return lsx_rint32_clip_2_f (dest0 ,src ,ch ,n ); 210 211case SOXR_INT16 :if (seed ) { 212if (ch == 1 ) 213return lsx_rint16_clip_dither_f (dest0 ,src [0 ],n ,seed ); 214return lsx_rint16_clip_2_dither_f (dest0 ,src ,ch ,n ,seed ); 215 } 216if (ch == 1 ) 217return lsx_rint16_clip_f (dest0 ,src [0 ],n ); 218return lsx_rint16_clip_2_f (dest0 ,src ,ch ,n ); 219default :break ; 220 } 221return 0 ; 222} 223#endif