Alc/mixer_c.c

   1 #include "config.h"
   2
   3 #include "alMain.h"
   4 #include "alu.h"
   5 #include "alSource.h"
   6 #include "alAuxEffectSlot.h"
   7
   8
   9 static __inline ALfloat point32(const ALfloat *vals, ALint step, ALint frac)
  10 { return vals[0]; (void)step; (void)frac; }
  11 static __inline ALfloat lerp32(const ALfloat *vals, ALint step, ALint frac)
  12 { return lerp(vals[0], vals[step], frac * (1.0f/FRACTIONONE)); }
  13 static __inline ALfloat cubic32(const ALfloat *vals, ALint step, ALint frac)
  14 { return cubic(vals[-step], vals[0], vals[step], vals[step+step],
  15                frac * (1.0f/FRACTIONONE)); }
  16
  17 #define DECL_TEMPLATE(Sampler)                                                \
  18 void Resample_##Sampler##_C(const ALfloat *data, ALuint frac,                 \
  19   ALuint increment, ALuint NumChannels, ALfloat *RESTRICT OutBuffer,          \
  20   ALuint BufferSize)                                                          \
  21 {                                                                             \
  22     ALuint pos = 0;                                                           \
  23     ALfloat value;                                                            \
  24     ALuint i;                                                                 \
  25                                                                               \
  26     for(i = 0;i < BufferSize+1;i++)                                           \
  27     {                                                                         \
  28         value = Sampler(data + pos*NumChannels, NumChannels, frac);           \
  29         OutBuffer[i] = value;                                                 \
  30                                                                               \
  31         frac += increment;                                                    \
  32         pos  += frac>>FRACTIONBITS;                                           \
  33         frac &= FRACTIONMASK;                                                 \
  34     }                                                                         \
  35 }
  36
  37 DECL_TEMPLATE(point32)
  38 DECL_TEMPLATE(lerp32)
  39 DECL_TEMPLATE(cubic32)
  40
  41 #undef DECL_TEMPLATE
  42
  43
  44 static __inline void ApplyCoeffsStep(ALuint Offset, ALfloat (*RESTRICT Values)[2],
  45                                      const ALuint IrSize,
  46                                      ALfloat (*RESTRICT Coeffs)[2],
  47                                      ALfloat (*RESTRICT CoeffStep)[2],
  48                                      ALfloat left, ALfloat right)
  49 {
  50     ALuint c;
  51     for(c = 0;c < IrSize;c++)
  52     {
  53         const ALuint off = (Offset+c)&HRIR_MASK;
  54         Values[off][0] += Coeffs[c][0] * left;
  55         Values[off][1] += Coeffs[c][1] * right;
  56         Coeffs[c][0] += CoeffStep[c][0];
  57         Coeffs[c][1] += CoeffStep[c][1];
  58     }
  59 }
  60
  61 static __inline void ApplyCoeffs(ALuint Offset, ALfloat (*RESTRICT Values)[2],
  62                                  const ALuint IrSize,
  63                                  ALfloat (*RESTRICT Coeffs)[2],
  64                                  ALfloat left, ALfloat right)
  65 {
  66     ALuint c;
  67     for(c = 0;c < IrSize;c++)
  68     {
  69         const ALuint off = (Offset+c)&HRIR_MASK;
  70         Values[off][0] += Coeffs[c][0] * left;
  71         Values[off][1] += Coeffs[c][1] * right;
  72     }
  73 }
  74
  75 #define SUFFIX C
  76 #include "mixer_inc.c"
  77 #undef SUFFIX
  78
  79
  80 void MixDirect_C(ALsource *Source, ALCdevice *Device, DirectParams *params,
  81   const ALfloat *RESTRICT data, ALuint srcchan,
  82   ALuint OutPos, ALuint SamplesToDo, ALuint BufferSize)
  83 {
  84     ALfloat (*RESTRICT DryBuffer)[BUFFERSIZE] = Device->DryBuffer;
  85     ALfloat *RESTRICT ClickRemoval = Device->ClickRemoval;
  86     ALfloat *RESTRICT PendingClicks = Device->PendingClicks;
  87     ALfloat DrySend[MaxChannels];
  88     ALuint pos;
  89     ALuint c;
  90     (void)Source;
  91
  92     for(c = 0;c < MaxChannels;c++)
  93         DrySend[c] = params->Gains[srcchan][c];
  94
  95     pos = 0;
  96     if(OutPos == 0)
  97     {
  98         for(c = 0;c < MaxChannels;c++)
  99             ClickRemoval[c] -= data[pos]*DrySend[c];
 100     }
 101     for(c = 0;c < MaxChannels;c++)
 102     {
 103         for(pos = 0;pos < BufferSize;pos++)
 104             DryBuffer[c][OutPos+pos] += data[pos]*DrySend[c];
 105     }
 106     if(OutPos+pos == SamplesToDo)
 107     {
 108         for(c = 0;c < MaxChannels;c++)
 109             PendingClicks[c] += data[pos]*DrySend[c];
 110     }
 111 }
 112
 113
 114 void MixSend_C(SendParams *params, const ALfloat *RESTRICT data,
 115   ALuint OutPos, ALuint SamplesToDo, ALuint BufferSize)
 116 {
 117     ALeffectslot *Slot = params->Slot;
 118     ALfloat *WetBuffer = Slot->WetBuffer;
 119     ALfloat *WetClickRemoval = Slot->ClickRemoval;
 120     ALfloat *WetPendingClicks = Slot->PendingClicks;
 121     ALfloat  WetSend = params->Gain;
 122     ALuint pos;
 123
 124     pos = 0;
 125     if(OutPos == 0)
 126     {
 127         WetClickRemoval[0] -= data[pos] * WetSend;
 128     }
 129     for(pos = 0;pos < BufferSize;pos++)
 130     {
 131         WetBuffer[OutPos] += data[pos] * WetSend;
 132         OutPos++;
 133     }
 134     if(OutPos == SamplesToDo)
 135     {
 136         WetPendingClicks[0] += data[pos] * WetSend;
 137     }
 138 }