1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
|
#include "config.h"
#include "alMain.h"
#include "alSource.h"
#include "hrtf.h"
#include "mixer_defs.h"
#include "align.h"
#include "alu.h"
#define MAX_UPDATE_SAMPLES 128
static inline void ApplyCoeffsStep(ALuint Offset, ALfloat (*restrict Values)[2],
const ALuint irSize,
ALfloat (*restrict Coeffs)[2],
const ALfloat (*restrict CoeffStep)[2],
ALfloat left, ALfloat right);
static inline void ApplyCoeffs(ALuint Offset, ALfloat (*restrict Values)[2],
const ALuint irSize,
ALfloat (*restrict Coeffs)[2],
ALfloat left, ALfloat right);
void MixHrtf(ALfloat (*restrict OutBuffer)[BUFFERSIZE], ALuint lidx, ALuint ridx,
const ALfloat *data, ALuint Counter, ALuint Offset, ALuint OutPos,
const ALuint IrSize, const MixHrtfParams *hrtfparams, HrtfState *hrtfstate,
ALuint BufferSize)
{
ALfloat (*Coeffs)[2] = hrtfparams->Current->Coeffs;
ALuint Delay[2] = { hrtfparams->Current->Delay[0], hrtfparams->Current->Delay[1] };
ALfloat out[MAX_UPDATE_SAMPLES][2];
ALfloat left, right;
ALuint minsize;
ALuint pos, i;
pos = 0;
if(Counter == 0)
goto skip_stepping;
minsize = minu(BufferSize, Counter);
while(pos < minsize)
{
ALuint todo = minu(minsize-pos, MAX_UPDATE_SAMPLES);
for(i = 0;i < todo;i++)
{
hrtfstate->History[Offset&HRTF_HISTORY_MASK] = data[pos++];
left = lerp(hrtfstate->History[(Offset-(Delay[0]>>HRTFDELAY_BITS))&HRTF_HISTORY_MASK],
hrtfstate->History[(Offset-(Delay[0]>>HRTFDELAY_BITS)-1)&HRTF_HISTORY_MASK],
(Delay[0]&HRTFDELAY_MASK)*(1.0f/HRTFDELAY_FRACONE));
right = lerp(hrtfstate->History[(Offset-(Delay[1]>>HRTFDELAY_BITS))&HRTF_HISTORY_MASK],
hrtfstate->History[(Offset-(Delay[1]>>HRTFDELAY_BITS)-1)&HRTF_HISTORY_MASK],
(Delay[1]&HRTFDELAY_MASK)*(1.0f/HRTFDELAY_FRACONE));
Delay[0] += hrtfparams->Steps.Delay[0];
Delay[1] += hrtfparams->Steps.Delay[1];
hrtfstate->Values[(Offset+IrSize)&HRIR_MASK][0] = 0.0f;
hrtfstate->Values[(Offset+IrSize)&HRIR_MASK][1] = 0.0f;
Offset++;
ApplyCoeffsStep(Offset, hrtfstate->Values, IrSize, Coeffs, hrtfparams->Steps.Coeffs, left, right);
out[i][0] = hrtfstate->Values[Offset&HRIR_MASK][0];
out[i][1] = hrtfstate->Values[Offset&HRIR_MASK][1];
}
for(i = 0;i < todo;i++)
OutBuffer[lidx][OutPos+i] += out[i][0];
for(i = 0;i < todo;i++)
OutBuffer[ridx][OutPos+i] += out[i][1];
OutPos += todo;
}
if(pos == Counter)
{
*hrtfparams->Current = *hrtfparams->Target;
Delay[0] = hrtfparams->Target->Delay[0];
Delay[1] = hrtfparams->Target->Delay[1];
}
else
{
hrtfparams->Current->Delay[0] = Delay[0];
hrtfparams->Current->Delay[1] = Delay[1];
}
skip_stepping:
Delay[0] >>= HRTFDELAY_BITS;
Delay[1] >>= HRTFDELAY_BITS;
while(pos < BufferSize)
{
ALuint todo = minu(BufferSize-pos, MAX_UPDATE_SAMPLES);
for(i = 0;i < todo;i++)
{
hrtfstate->History[Offset&HRTF_HISTORY_MASK] = data[pos++];
left = hrtfstate->History[(Offset-Delay[0])&HRTF_HISTORY_MASK];
right = hrtfstate->History[(Offset-Delay[1])&HRTF_HISTORY_MASK];
hrtfstate->Values[(Offset+IrSize)&HRIR_MASK][0] = 0.0f;
hrtfstate->Values[(Offset+IrSize)&HRIR_MASK][1] = 0.0f;
Offset++;
ApplyCoeffs(Offset, hrtfstate->Values, IrSize, Coeffs, left, right);
out[i][0] = hrtfstate->Values[Offset&HRIR_MASK][0];
out[i][1] = hrtfstate->Values[Offset&HRIR_MASK][1];
}
for(i = 0;i < todo;i++)
OutBuffer[lidx][OutPos+i] += out[i][0];
for(i = 0;i < todo;i++)
OutBuffer[ridx][OutPos+i] += out[i][1];
OutPos += todo;
}
}
void MixDirectHrtf(ALfloat (*restrict OutBuffer)[BUFFERSIZE], ALuint lidx, ALuint ridx,
const ALfloat *data, ALuint Offset, const ALuint IrSize,
ALfloat (*restrict Coeffs)[2], ALfloat (*restrict Values)[2],
ALuint BufferSize)
{
ALfloat out[MAX_UPDATE_SAMPLES][2];
ALfloat insample;
ALuint pos, i;
for(pos = 0;pos < BufferSize;)
{
ALuint todo = minu(BufferSize-pos, MAX_UPDATE_SAMPLES);
for(i = 0;i < todo;i++)
{
Values[(Offset+IrSize)&HRIR_MASK][0] = 0.0f;
Values[(Offset+IrSize)&HRIR_MASK][1] = 0.0f;
Offset++;
insample = *(data++);
ApplyCoeffs(Offset, Values, IrSize, Coeffs, insample, insample);
out[i][0] = Values[Offset&HRIR_MASK][0];
out[i][1] = Values[Offset&HRIR_MASK][1];
}
for(i = 0;i < todo;i++)
OutBuffer[lidx][pos+i] += out[i][0];
for(i = 0;i < todo;i++)
OutBuffer[ridx][pos+i] += out[i][1];
pos += todo;
}
}
|
