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;
  88     ALuint pos;
  89     ALuint c;
  90     (void)Source;
  91
  92     for(c = 0;c < MaxChannels;c++)
  93     {
  94         DrySend = params->Gains[srcchan][c];
  95         if(DrySend < 0.00001f)
  96             continue;
  97
  98         if(OutPos == 0)
  99             ClickRemoval[c] -= data[0]*DrySend;
 100         for(pos = 0;pos < BufferSize;pos++)
 101             DryBuffer[c][OutPos+pos] += data[pos]*DrySend;
 102         if(OutPos+pos == SamplesToDo)
 103             PendingClicks[c] += data[pos]*DrySend;
 104     }
 105 }
 106
 107
 108 void MixSend_C(SendParams *params, const ALfloat *RESTRICT data,
 109   ALuint OutPos, ALuint SamplesToDo, ALuint BufferSize)
 110 {
 111     ALeffectslot *Slot = params->Slot;
 112     ALfloat (*RESTRICT WetBuffer)[BUFFERSIZE] = Slot->WetBuffer;
 113     ALfloat *RESTRICT WetClickRemoval = Slot->ClickRemoval;
 114     ALfloat *RESTRICT WetPendingClicks = Slot->PendingClicks;
 115     ALfloat  WetSend = params->Gain;
 116     ALuint pos;
 117
 118     if(OutPos == 0)
 119         WetClickRemoval[0] -= data[0] * WetSend;
 120     for(pos = 0;pos < BufferSize;pos++)
 121         WetBuffer[0][OutPos+pos] += data[pos] * WetSend;
 122     if(OutPos+pos == SamplesToDo)
 123         WetPendingClicks[0] += data[pos] * WetSend;
 124 }