Alc/mixer_neon.c

   1 #include "config.h"
   2
   3 #include <arm_neon.h>
   4
   5 #include "AL/al.h"
   6 #include "AL/alc.h"
   7 #include "alMain.h"
   8 #include "alu.h"
   9 #include "hrtf.h"
  10
  11
  12 static inline void ApplyCoeffsStep(ALuint Offset, ALfloat (*restrict Values)[2],
  13                                    const ALuint IrSize,
  14                                    ALfloat (*restrict Coeffs)[2],
  15                                    const ALfloat (*restrict CoeffStep)[2],
  16                                    ALfloat left, ALfloat right)
  17 {
  18     ALuint c;
  19     float32x4_t leftright4;
  20     {
  21         float32x2_t leftright2 = vdup_n_f32(0.0);
  22         leftright2 = vset_lane_f32(left, leftright2, 0);
  23         leftright2 = vset_lane_f32(right, leftright2, 1);
  24         leftright4 = vcombine_f32(leftright2, leftright2);
  25     }
  26     for(c = 0;c < IrSize;c += 2)
  27     {
  28         const ALuint o0 = (Offset+c)&HRIR_MASK;
  29         const ALuint o1 = (o0+1)&HRIR_MASK;
  30         float32x4_t vals = vcombine_f32(vld1_f32((float32_t*)&Values[o0][0]),
  31                                         vld1_f32((float32_t*)&Values[o1][0]));
  32         float32x4_t coefs = vld1q_f32((float32_t*)&Coeffs[c][0]);
  33         float32x4_t deltas = vld1q_f32(&CoeffStep[c][0]);
  34
  35         vals = vmlaq_f32(vals, coefs, leftright4);
  36         coefs = vaddq_f32(coefs, deltas);
  37
  38         vst1_f32((float32_t*)&Values[o0][0], vget_low_f32(vals));
  39         vst1_f32((float32_t*)&Values[o1][0], vget_high_f32(vals));
  40         vst1q_f32(&Coeffs[c][0], coefs);
  41     }
  42 }
  43
  44 static inline void ApplyCoeffs(ALuint Offset, ALfloat (*restrict Values)[2],
  45                                const ALuint IrSize,
  46                                ALfloat (*restrict Coeffs)[2],
  47                                ALfloat left, ALfloat right)
  48 {
  49     ALuint c;
  50     float32x4_t leftright4;
  51     {
  52         float32x2_t leftright2 = vdup_n_f32(0.0);
  53         leftright2 = vset_lane_f32(left, leftright2, 0);
  54         leftright2 = vset_lane_f32(right, leftright2, 1);
  55         leftright4 = vcombine_f32(leftright2, leftright2);
  56     }
  57     for(c = 0;c < IrSize;c += 2)
  58     {
  59         const ALuint o0 = (Offset+c)&HRIR_MASK;
  60         const ALuint o1 = (o0+1)&HRIR_MASK;
  61         float32x4_t vals = vcombine_f32(vld1_f32((float32_t*)&Values[o0][0]),
  62                                         vld1_f32((float32_t*)&Values[o1][0]));
  63         float32x4_t coefs = vld1q_f32((float32_t*)&Coeffs[c][0]);
  64
  65         vals = vmlaq_f32(vals, coefs, leftright4);
  66
  67         vst1_f32((float32_t*)&Values[o0][0], vget_low_f32(vals));
  68         vst1_f32((float32_t*)&Values[o1][0], vget_high_f32(vals));
  69     }
  70 }
  71
  72 #define MixHrtf MixHrtf_Neon
  73 #include "mixer_inc.c"
  74 #undef MixHrtf
  75
  76
  77 void Mix_Neon(const ALfloat *data, ALuint OutChans, ALfloat (*restrict OutBuffer)[BUFFERSIZE],
  78               MixGains *Gains, ALuint Counter, ALuint OutPos, ALuint BufferSize)
  79 {
  80     ALfloat gain, step;
  81     float32x4_t gain4;
  82     ALuint c;
  83
  84     for(c = 0;c < OutChans;c++)
  85     {
  86         ALuint pos = 0;
  87         gain = Gains[c].Current;
  88         step = Gains[c].Step;
  89         if(step != 0.0f && Counter > 0)
  90         {
  91             ALuint minsize = minu(BufferSize, Counter);
  92             for(;pos < minsize;pos++)
  93             {
  94                 OutBuffer[c][OutPos+pos] += data[pos]*gain;
  95                 gain += step;
  96             }
  97             if(pos == Counter)
  98                 gain = Gains[c].Target;
  99             Gains[c].Current = gain;
 100
 101             /* Mix until pos is aligned with 4 or the mix is done. */
 102             minsize = minu(BufferSize, (pos+3)&~3);
 103             for(;pos < minsize;pos++)
 104                 OutBuffer[c][OutPos+pos] += data[pos]*gain;
 105         }
 106
 107         if(!(fabsf(gain) > GAIN_SILENCE_THRESHOLD))
 108             continue;
 109         gain4 = vdupq_n_f32(gain);
 110         for(;BufferSize-pos > 3;pos += 4)
 111         {
 112             const float32x4_t val4 = vld1q_f32(&data[pos]);
 113             float32x4_t dry4 = vld1q_f32(&OutBuffer[c][OutPos+pos]);
 114             dry4 = vmlaq_f32(dry4, val4, gain4);
 115             vst1q_f32(&OutBuffer[c][OutPos+pos], dry4);
 116         }
 117         for(;pos < BufferSize;pos++)
 118             OutBuffer[c][OutPos+pos] += data[pos]*gain;
 119     }
 120 }
 121
 122 void MixRow_Neon(ALfloat *OutBuffer, const ALfloat *Mtx, ALfloat (*restrict data)[BUFFERSIZE], ALuint InChans, ALuint BufferSize)
 123 {
 124     float32x4_t gain4;
 125     ALuint c;
 126
 127     for(c = 0;c < InChans;c++)
 128     {
 129         ALuint pos = 0;
 130         ALfloat gain = Mtx[c];
 131         if(!(fabsf(gain) > GAIN_SILENCE_THRESHOLD))
 132             continue;
 133
 134         gain4 = vdupq_n_f32(gain);
 135         for(;BufferSize-pos > 3;pos += 4)
 136         {
 137             const float32x4_t val4 = vld1q_f32(&data[c][pos]);
 138             float32x4_t dry4 = vld1q_f32(&OutBuffer[pos]);
 139             dry4 = vmlaq_f32(dry4, val4, gain4);
 140             vst1q_f32(&OutBuffer[pos], dry4);
 141         }
 142         for(;pos < BufferSize;pos++)
 143             OutBuffer[pos] += data[c][pos]*gain;
 144     }
 145 }