?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Handle BS2B cross-feed right after click removal
[openal-soft/openal-hmr.git] / Alc / ALu.c
blob398912da491a69605e4ed6eebec8fc75178a9464
1 /**
2 * OpenAL cross platform audio library
3 * Copyright (C) 1999-2007 by authors.
4 * This library is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU Library General Public
6 * License as published by the Free Software Foundation; either
7 * version 2 of the License, or (at your option) any later version.
8 *
9 * This library is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * Library General Public License for more details.
13 *
14 * You should have received a copy of the GNU Library General Public
15 * License along with this library; if not, write to the
16 * Free Software Foundation, Inc., 59 Temple Place - Suite 330,
17 * Boston, MA 02111-1307, USA.
18 * Or go to http://www.gnu.org/copyleft/lgpl.html
19 */
20
21 #include "config.h"
22
23 #include <math.h>
24 #include <stdlib.h>
25 #include <string.h>
26 #include <ctype.h>
27 #include <assert.h>
28
29 #include "alMain.h"
30 #include "AL/al.h"
31 #include "AL/alc.h"
32 #include "alSource.h"
33 #include "alBuffer.h"
34 #include "alListener.h"
35 #include "alAuxEffectSlot.h"
36 #include "alu.h"
37 #include "bs2b.h"
38
39
40 struct ChanMap {
41 enum Channel channel;
42 ALfloat angle;
43 };
44
45 /* Cone scalar */
46 ALfloat ConeScale = 0.5f;
47
48 /* Localized Z scalar for mono sources */
49 ALfloat ZScale = 1.0f;
50
51
52 static __inline ALvoid aluMatrixVector(ALfloat *vector,ALfloat w,ALfloat matrix[4][4])
53 {
54 ALfloat temp[4] = {
55 vector[0], vector[1], vector[2], w
56 };
57
58 vector[0] = temp[0]*matrix[0][0] + temp[1]*matrix[1][0] + temp[2]*matrix[2][0] + temp[3]*matrix[3][0];
59 vector[1] = temp[0]*matrix[0][1] + temp[1]*matrix[1][1] + temp[2]*matrix[2][1] + temp[3]*matrix[3][1];
60 vector[2] = temp[0]*matrix[0][2] + temp[1]*matrix[1][2] + temp[2]*matrix[2][2] + temp[3]*matrix[3][2];
61 }
62
63
64 ALvoid CalcNonAttnSourceParams(ALsource *ALSource, const ALCcontext *ALContext)
65 {
66 static const struct ChanMap MonoMap[1] = { { FRONT_CENTER, 0.0f } };
67 static const struct ChanMap StereoMap[2] = {
68 { FRONT_LEFT, -30.0f * F_PI/180.0f },
69 { FRONT_RIGHT, 30.0f * F_PI/180.0f }
70 };
71 static const struct ChanMap RearMap[2] = {
72 { BACK_LEFT, -150.0f * F_PI/180.0f },
73 { BACK_RIGHT, 150.0f * F_PI/180.0f }
74 };
75 static const struct ChanMap QuadMap[4] = {
76 { FRONT_LEFT, -45.0f * F_PI/180.0f },
77 { FRONT_RIGHT, 45.0f * F_PI/180.0f },
78 { BACK_LEFT, -135.0f * F_PI/180.0f },
79 { BACK_RIGHT, 135.0f * F_PI/180.0f }
80 };
81 static const struct ChanMap X51Map[6] = {
82 { FRONT_LEFT, -30.0f * F_PI/180.0f },
83 { FRONT_RIGHT, 30.0f * F_PI/180.0f },
84 { FRONT_CENTER, 0.0f * F_PI/180.0f },
85 { LFE, 0.0f },
86 { BACK_LEFT, -110.0f * F_PI/180.0f },
87 { BACK_RIGHT, 110.0f * F_PI/180.0f }
88 };
89 static const struct ChanMap X61Map[7] = {
90 { FRONT_LEFT, -30.0f * F_PI/180.0f },
91 { FRONT_RIGHT, 30.0f * F_PI/180.0f },
92 { FRONT_CENTER, 0.0f * F_PI/180.0f },
93 { LFE, 0.0f },
94 { BACK_CENTER, 180.0f * F_PI/180.0f },
95 { SIDE_LEFT, -90.0f * F_PI/180.0f },
96 { SIDE_RIGHT, 90.0f * F_PI/180.0f }
97 };
98 static const struct ChanMap X71Map[8] = {
99 { FRONT_LEFT, -30.0f * F_PI/180.0f },
100 { FRONT_RIGHT, 30.0f * F_PI/180.0f },
101 { FRONT_CENTER, 0.0f * F_PI/180.0f },
102 { LFE, 0.0f },
103 { BACK_LEFT, -150.0f * F_PI/180.0f },
104 { BACK_RIGHT, 150.0f * F_PI/180.0f },
105 { SIDE_LEFT, -90.0f * F_PI/180.0f },
106 { SIDE_RIGHT, 90.0f * F_PI/180.0f }
107 };
108
109 ALCdevice *Device = ALContext->Device;
110 ALfloat SourceVolume,ListenerGain,MinVolume,MaxVolume;
111 ALbufferlistitem *BufferListItem;
112 enum FmtChannels Channels;
113 ALfloat (*SrcMatrix)[MAXCHANNELS];
114 ALfloat DryGain, DryGainHF;
115 ALfloat WetGain[MAX_SENDS];
116 ALfloat WetGainHF[MAX_SENDS];
117 ALint NumSends, Frequency;
118 const ALfloat *ChannelGain;
119 const struct ChanMap *chans = NULL;
120 enum Resampler Resampler;
121 ALint num_channels = 0;
122 ALboolean DirectChannels;
123 ALfloat Pitch;
124 ALfloat cw;
125 ALuint pos;
126 ALint i, c;
127
128 /* Get device properties */
129 NumSends = Device->NumAuxSends;
130 Frequency = Device->Frequency;
131
132 /* Get listener properties */
133 ListenerGain = ALContext->Listener.Gain;
134
135 /* Get source properties */
136 SourceVolume = ALSource->flGain;
137 MinVolume = ALSource->flMinGain;
138 MaxVolume = ALSource->flMaxGain;
139 Pitch = ALSource->flPitch;
140 Resampler = ALSource->Resampler;
141 DirectChannels = ALSource->DirectChannels;
142
143 /* Calculate the stepping value */
144 Channels = FmtMono;
145 BufferListItem = ALSource->queue;
146 while(BufferListItem != NULL)
147 {
148 ALbuffer *ALBuffer;
149 if((ALBuffer=BufferListItem->buffer) != NULL)
150 {
151 ALsizei maxstep = STACK_DATA_SIZE/sizeof(ALfloat) /
152 ALSource->NumChannels;
153 maxstep -= ResamplerPadding[Resampler] +
154 ResamplerPrePadding[Resampler] + 1;
155 maxstep = mini(maxstep, INT_MAX>>FRACTIONBITS);
156
157 Pitch = Pitch * ALBuffer->Frequency / Frequency;
158 if(Pitch > (ALfloat)maxstep)
159 ALSource->Params.Step = maxstep<<FRACTIONBITS;
160 else
161 {
162 ALSource->Params.Step = fastf2i(Pitch*FRACTIONONE);
163 if(ALSource->Params.Step == 0)
164 ALSource->Params.Step = 1;
165 }
166 if(ALSource->Params.Step == FRACTIONONE)
167 Resampler = PointResampler;
168
169 Channels = ALBuffer->FmtChannels;
170 break;
171 }
172 BufferListItem = BufferListItem->next;
173 }
174 if(!DirectChannels && Device->Hrtf)
175 ALSource->Params.DoMix = SelectHrtfMixer(Resampler);
176 else
177 ALSource->Params.DoMix = SelectMixer(Resampler);
178
179 /* Calculate gains */
180 DryGain = clampf(SourceVolume, MinVolume, MaxVolume);
181 DryGain *= ALSource->DirectGain;
182 DryGainHF = ALSource->DirectGainHF;
183 for(i = 0;i < NumSends;i++)
184 {
185 WetGain[i] = clampf(SourceVolume, MinVolume, MaxVolume);
186 WetGain[i] *= ALSource->Send[i].WetGain;
187 WetGainHF[i] = ALSource->Send[i].WetGainHF;
188 }
189
190 SrcMatrix = ALSource->Params.DryGains;
191 for(i = 0;i < MAXCHANNELS;i++)
192 {
193 for(c = 0;c < MAXCHANNELS;c++)
194 SrcMatrix[i][c] = 0.0f;
195 }
196 switch(Channels)
197 {
198 case FmtMono:
199 chans = MonoMap;
200 num_channels = 1;
201 break;
202 case FmtStereo:
203 if(!DirectChannels && (Device->Flags&DEVICE_DUPLICATE_STEREO))
204 {
205 DryGain *= aluSqrt(2.0f/4.0f);
206 for(c = 0;c < 2;c++)
207 {
208 pos = aluCart2LUTpos(aluCos(RearMap[c].angle),
209 aluSin(RearMap[c].angle));
210 ChannelGain = Device->PanningLUT[pos];
211
212 for(i = 0;i < (ALint)Device->NumChan;i++)
213 {
214 enum Channel chan = Device->Speaker2Chan[i];
215 SrcMatrix[c][chan] += DryGain * ListenerGain *
216 ChannelGain[chan];
217 }
218 }
219 }
220 chans = StereoMap;
221 num_channels = 2;
222 break;
223
224 case FmtRear:
225 chans = RearMap;
226 num_channels = 2;
227 break;
228
229 case FmtQuad:
230 chans = QuadMap;
231 num_channels = 4;
232 break;
233
234 case FmtX51:
235 chans = X51Map;
236 num_channels = 6;
237 break;
238
239 case FmtX61:
240 chans = X61Map;
241 num_channels = 7;
242 break;
243
244 case FmtX71:
245 chans = X71Map;
246 num_channels = 8;
247 break;
248 }
249
250 if(DirectChannels != AL_FALSE)
251 {
252 for(c = 0;c < num_channels;c++)
253 SrcMatrix[c][chans[c].channel] += DryGain * ListenerGain;
254 }
255 else if(Device->Hrtf)
256 {
257 for(c = 0;c < num_channels;c++)
258 {
259 if(chans[c].channel == LFE)
260 {
261 /* Skip LFE */
262 ALSource->Params.HrtfDelay[c][0] = 0;
263 ALSource->Params.HrtfDelay[c][1] = 0;
264 for(i = 0;i < HRIR_LENGTH;i++)
265 {
266 ALSource->Params.HrtfCoeffs[c][i][0] = 0.0f;
267 ALSource->Params.HrtfCoeffs[c][i][1] = 0.0f;
268 }
269 }
270 else
271 {
272 /* Get the static HRIR coefficients and delays for this
273 * channel. */
274 GetLerpedHrtfCoeffs(Device->Hrtf,
275 0.0f, F_PI/180.0f * chans[c].angle,
276 DryGain*ListenerGain,
277 ALSource->Params.HrtfCoeffs[c],
278 ALSource->Params.HrtfDelay[c]);
279 }
280 ALSource->HrtfCounter = 0;
281 }
282 }
283 else
284 {
285 for(c = 0;c < num_channels;c++)
286 {
287 if(chans[c].channel == LFE) /* Special-case LFE */
288 {
289 SrcMatrix[c][LFE] += DryGain * ListenerGain;
290 continue;
291 }
292 pos = aluCart2LUTpos(aluCos(chans[c].angle), aluSin(chans[c].angle));
293 ChannelGain = Device->PanningLUT[pos];
294
295 for(i = 0;i < (ALint)Device->NumChan;i++)
296 {
297 enum Channel chan = Device->Speaker2Chan[i];
298 SrcMatrix[c][chan] += DryGain * ListenerGain *
299 ChannelGain[chan];
300 }
301 }
302 }
303 for(i = 0;i < NumSends;i++)
304 {
305 ALeffectslot *Slot = ALSource->Send[i].Slot;
306
307 if(!Slot && i == 0)
308 Slot = Device->DefaultSlot;
309 if(Slot && Slot->effect.type == AL_EFFECT_NULL)
310 Slot = NULL;
311 ALSource->Params.Send[i].Slot = Slot;
312 ALSource->Params.Send[i].WetGain = WetGain[i] * ListenerGain;
313 }
314
315 /* Update filter coefficients. Calculations based on the I3DL2
316 * spec. */
317 cw = aluCos(F_PI*2.0f * LOWPASSFREQREF / Frequency);
318
319 /* We use two chained one-pole filters, so we need to take the
320 * square root of the squared gain, which is the same as the base
321 * gain. */
322 ALSource->Params.iirFilter.coeff = lpCoeffCalc(DryGainHF, cw);
323 for(i = 0;i < NumSends;i++)
324 {
325 /* We use a one-pole filter, so we need to take the squared gain */
326 ALfloat a = lpCoeffCalc(WetGainHF[i]*WetGainHF[i], cw);
327 ALSource->Params.Send[i].iirFilter.coeff = a;
328 }
329 }
330
331 ALvoid CalcSourceParams(ALsource *ALSource, const ALCcontext *ALContext)
332 {
333 const ALCdevice *Device = ALContext->Device;
334 ALfloat InnerAngle,OuterAngle,Angle,Distance,ClampedDist;
335 ALfloat Direction[3],Position[3],SourceToListener[3];
336 ALfloat Velocity[3],ListenerVel[3];
337 ALfloat MinVolume,MaxVolume,MinDist,MaxDist,Rolloff;
338 ALfloat ConeVolume,ConeHF,SourceVolume,ListenerGain;
339 ALfloat DopplerFactor, DopplerVelocity, SpeedOfSound;
340 ALfloat AirAbsorptionFactor;
341 ALfloat RoomAirAbsorption[MAX_SENDS];
342 ALbufferlistitem *BufferListItem;
343 ALfloat Attenuation, EffectiveDist;
344 ALfloat RoomAttenuation[MAX_SENDS];
345 ALfloat MetersPerUnit;
346 ALfloat RoomRolloffBase;
347 ALfloat RoomRolloff[MAX_SENDS];
348 ALfloat DecayDistance[MAX_SENDS];
349 ALfloat DryGain;
350 ALfloat DryGainHF;
351 ALboolean DryGainHFAuto;
352 ALfloat WetGain[MAX_SENDS];
353 ALfloat WetGainHF[MAX_SENDS];
354 ALboolean WetGainAuto;
355 ALboolean WetGainHFAuto;
356 enum Resampler Resampler;
357 ALfloat Pitch;
358 ALuint Frequency;
359 ALint NumSends;
360 ALfloat cw;
361 ALint i;
362
363 DryGainHF = 1.0f;
364 for(i = 0;i < MAX_SENDS;i++)
365 WetGainHF[i] = 1.0f;
366
367 //Get context properties
368 DopplerFactor = ALContext->DopplerFactor * ALSource->DopplerFactor;
369 DopplerVelocity = ALContext->DopplerVelocity;
370 SpeedOfSound = ALContext->flSpeedOfSound;
371 NumSends = Device->NumAuxSends;
372 Frequency = Device->Frequency;
373
374 //Get listener properties
375 ListenerGain = ALContext->Listener.Gain;
376 MetersPerUnit = ALContext->Listener.MetersPerUnit;
377 ListenerVel[0] = ALContext->Listener.Velocity[0];
378 ListenerVel[1] = ALContext->Listener.Velocity[1];
379 ListenerVel[2] = ALContext->Listener.Velocity[2];
380
381 //Get source properties
382 SourceVolume = ALSource->flGain;
383 MinVolume = ALSource->flMinGain;
384 MaxVolume = ALSource->flMaxGain;
385 Pitch = ALSource->flPitch;
386 Resampler = ALSource->Resampler;
387 Position[0] = ALSource->vPosition[0];
388 Position[1] = ALSource->vPosition[1];
389 Position[2] = ALSource->vPosition[2];
390 Direction[0] = ALSource->vOrientation[0];
391 Direction[1] = ALSource->vOrientation[1];
392 Direction[2] = ALSource->vOrientation[2];
393 Velocity[0] = ALSource->vVelocity[0];
394 Velocity[1] = ALSource->vVelocity[1];
395 Velocity[2] = ALSource->vVelocity[2];
396 MinDist = ALSource->flRefDistance;
397 MaxDist = ALSource->flMaxDistance;
398 Rolloff = ALSource->flRollOffFactor;
399 InnerAngle = ALSource->flInnerAngle * ConeScale;
400 OuterAngle = ALSource->flOuterAngle * ConeScale;
401 AirAbsorptionFactor = ALSource->AirAbsorptionFactor;
402 DryGainHFAuto = ALSource->DryGainHFAuto;
403 WetGainAuto = ALSource->WetGainAuto;
404 WetGainHFAuto = ALSource->WetGainHFAuto;
405 RoomRolloffBase = ALSource->RoomRolloffFactor;
406 for(i = 0;i < NumSends;i++)
407 {
408 ALeffectslot *Slot = ALSource->Send[i].Slot;
409
410 if(!Slot && i == 0)
411 Slot = Device->DefaultSlot;
412 if(!Slot || Slot->effect.type == AL_EFFECT_NULL)
413 {
414 Slot = NULL;
415 RoomRolloff[i] = 0.0f;
416 DecayDistance[i] = 0.0f;
417 RoomAirAbsorption[i] = 1.0f;
418 }
419 else if(Slot->AuxSendAuto)
420 {
421 RoomRolloff[i] = RoomRolloffBase;
422 if(IsReverbEffect(Slot->effect.type))
423 {
424 RoomRolloff[i] += Slot->effect.Reverb.RoomRolloffFactor;
425 DecayDistance[i] = Slot->effect.Reverb.DecayTime *
426 SPEEDOFSOUNDMETRESPERSEC;
427 RoomAirAbsorption[i] = Slot->effect.Reverb.AirAbsorptionGainHF;
428 }
429 else
430 {
431 DecayDistance[i] = 0.0f;
432 RoomAirAbsorption[i] = 1.0f;
433 }
434 }
435 else
436 {
437 /* If the slot's auxiliary send auto is off, the data sent to the
438 * effect slot is the same as the dry path, sans filter effects */
439 RoomRolloff[i] = Rolloff;
440 DecayDistance[i] = 0.0f;
441 RoomAirAbsorption[i] = AIRABSORBGAINHF;
442 }
443
444 ALSource->Params.Send[i].Slot = Slot;
445 }
446
447 //1. Translate Listener to origin (convert to head relative)
448 if(ALSource->bHeadRelative == AL_FALSE)
449 {
450 ALfloat Matrix[4][4];
451 for(i = 0;i < 4;i++)
452 {
453 ALint i2;
454 for(i2 = 0;i2 < 4;i2++)
455 Matrix[i][i2] = ALContext->Listener.Matrix[i][i2];
456 }
457
458 /* Translate position */
459 Position[0] -= ALContext->Listener.Position[0];
460 Position[1] -= ALContext->Listener.Position[1];
461 Position[2] -= ALContext->Listener.Position[2];
462
463 /* Transform source vectors into listener space */
464 aluMatrixVector(Position, 1.0f, Matrix);
465 aluMatrixVector(Direction, 0.0f, Matrix);
466 aluMatrixVector(Velocity, 0.0f, Matrix);
467 }
468 else
469 {
470 ListenerVel[0] = 0.0f;
471 ListenerVel[1] = 0.0f;
472 ListenerVel[2] = 0.0f;
473 }
474
475 SourceToListener[0] = -Position[0];
476 SourceToListener[1] = -Position[1];
477 SourceToListener[2] = -Position[2];
478 aluNormalize(SourceToListener);
479 aluNormalize(Direction);
480
481 //2. Calculate distance attenuation
482 Distance = aluSqrt(aluDotproduct(Position, Position));
483 ClampedDist = Distance;
484
485 Attenuation = 1.0f;
486 for(i = 0;i < NumSends;i++)
487 RoomAttenuation[i] = 1.0f;
488 switch(ALContext->SourceDistanceModel ? ALSource->DistanceModel :
489 ALContext->DistanceModel)
490 {
491 case InverseDistanceClamped:
492 ClampedDist = clampf(ClampedDist, MinDist, MaxDist);
493 if(MaxDist < MinDist)
494 break;
495 //fall-through
496 case InverseDistance:
497 if(MinDist > 0.0f)
498 {
499 if((MinDist + (Rolloff * (ClampedDist - MinDist))) > 0.0f)
500 Attenuation = MinDist / (MinDist + (Rolloff * (ClampedDist - MinDist)));
501 for(i = 0;i < NumSends;i++)
502 {
503 if((MinDist + (RoomRolloff[i] * (ClampedDist - MinDist))) > 0.0f)
504 RoomAttenuation[i] = MinDist / (MinDist + (RoomRolloff[i] * (ClampedDist - MinDist)));
505 }
506 }
507 break;
508
509 case LinearDistanceClamped:
510 ClampedDist = clampf(ClampedDist, MinDist, MaxDist);
511 if(MaxDist < MinDist)
512 break;
513 //fall-through
514 case LinearDistance:
515 if(MaxDist != MinDist)
516 {
517 Attenuation = 1.0f - (Rolloff*(ClampedDist-MinDist)/(MaxDist - MinDist));
518 Attenuation = maxf(Attenuation, 0.0f);
519 for(i = 0;i < NumSends;i++)
520 {
521 RoomAttenuation[i] = 1.0f - (RoomRolloff[i]*(ClampedDist-MinDist)/(MaxDist - MinDist));
522 RoomAttenuation[i] = maxf(RoomAttenuation[i], 0.0f);
523 }
524 }
525 break;
526
527 case ExponentDistanceClamped:
528 ClampedDist = clampf(ClampedDist, MinDist, MaxDist);
529 if(MaxDist < MinDist)
530 break;
531 //fall-through
532 case ExponentDistance:
533 if(ClampedDist > 0.0f && MinDist > 0.0f)
534 {
535 Attenuation = aluPow(ClampedDist/MinDist, -Rolloff);
536 for(i = 0;i < NumSends;i++)
537 RoomAttenuation[i] = aluPow(ClampedDist/MinDist, -RoomRolloff[i]);
538 }
539 break;
540
541 case DisableDistance:
542 break;
543 }
544
545 // Source Gain + Attenuation
546 DryGain = SourceVolume * Attenuation;
547 for(i = 0;i < NumSends;i++)
548 WetGain[i] = SourceVolume * RoomAttenuation[i];
549
550 // Distance-based air absorption
551 EffectiveDist = 0.0f;
552 if(MinDist > 0.0f && Attenuation < 1.0f)
553 EffectiveDist = (MinDist/Attenuation - MinDist)*MetersPerUnit;
554 if(AirAbsorptionFactor > 0.0f && EffectiveDist > 0.0f)
555 {
556 DryGainHF *= aluPow(AIRABSORBGAINHF, AirAbsorptionFactor*EffectiveDist);
557 for(i = 0;i < NumSends;i++)
558 WetGainHF[i] *= aluPow(RoomAirAbsorption[i],
559 AirAbsorptionFactor*EffectiveDist);
560 }
561
562 if(WetGainAuto)
563 {
564 /* Apply a decay-time transformation to the wet path, based on the
565 * attenuation of the dry path.
566 *
567 * Using the approximate (effective) source to listener distance, the
568 * initial decay of the reverb effect is calculated and applied to the
569 * wet path.
570 */
571 for(i = 0;i < NumSends;i++)
572 {
573 if(DecayDistance[i] > 0.0f)
574 WetGain[i] *= aluPow(0.001f /* -60dB */,
575 EffectiveDist / DecayDistance[i]);
576 }
577 }
578
579 /* Calculate directional soundcones */
580 Angle = aluAcos(aluDotproduct(Direction,SourceToListener)) * (180.0f/F_PI);
581 if(Angle >= InnerAngle && Angle <= OuterAngle)
582 {
583 ALfloat scale = (Angle-InnerAngle) / (OuterAngle-InnerAngle);
584 ConeVolume = lerp(1.0f, ALSource->flOuterGain, scale);
585 ConeHF = lerp(1.0f, ALSource->OuterGainHF, scale);
586 }
587 else if(Angle > OuterAngle)
588 {
589 ConeVolume = ALSource->flOuterGain;
590 ConeHF = ALSource->OuterGainHF;
591 }
592 else
593 {
594 ConeVolume = 1.0f;
595 ConeHF = 1.0f;
596 }
597
598 DryGain *= ConeVolume;
599 if(WetGainAuto)
600 {
601 for(i = 0;i < NumSends;i++)
602 WetGain[i] *= ConeVolume;
603 }
604 if(DryGainHFAuto)
605 DryGainHF *= ConeHF;
606 if(WetGainHFAuto)
607 {
608 for(i = 0;i < NumSends;i++)
609 WetGainHF[i] *= ConeHF;
610 }
611
612 // Clamp to Min/Max Gain
613 DryGain = clampf(DryGain, MinVolume, MaxVolume);
614 for(i = 0;i < NumSends;i++)
615 WetGain[i] = clampf(WetGain[i], MinVolume, MaxVolume);
616
617 // Apply filter gains and filters
618 DryGain *= ALSource->DirectGain * ListenerGain;
619 DryGainHF *= ALSource->DirectGainHF;
620 for(i = 0;i < NumSends;i++)
621 {
622 WetGain[i] *= ALSource->Send[i].WetGain * ListenerGain;
623 WetGainHF[i] *= ALSource->Send[i].WetGainHF;
624 }
625
626 // Calculate Velocity
627 if(DopplerFactor != 0.0f)
628 {
629 ALfloat VSS, VLS;
630 ALfloat MaxVelocity = (SpeedOfSound*DopplerVelocity) /
631 DopplerFactor;
632
633 VSS = aluDotproduct(Velocity, SourceToListener);
634 if(VSS >= MaxVelocity)
635 VSS = (MaxVelocity - 1.0f);
636 else if(VSS <= -MaxVelocity)
637 VSS = -MaxVelocity + 1.0f;
638
639 VLS = aluDotproduct(ListenerVel, SourceToListener);
640 if(VLS >= MaxVelocity)
641 VLS = (MaxVelocity - 1.0f);
642 else if(VLS <= -MaxVelocity)
643 VLS = -MaxVelocity + 1.0f;
644
645 Pitch *= ((SpeedOfSound*DopplerVelocity) - (DopplerFactor*VLS)) /
646 ((SpeedOfSound*DopplerVelocity) - (DopplerFactor*VSS));
647 }
648
649 BufferListItem = ALSource->queue;
650 while(BufferListItem != NULL)
651 {
652 ALbuffer *ALBuffer;
653 if((ALBuffer=BufferListItem->buffer) != NULL)
654 {
655 ALsizei maxstep = STACK_DATA_SIZE/sizeof(ALfloat) /
656 ALSource->NumChannels;
657 maxstep -= ResamplerPadding[Resampler] +
658 ResamplerPrePadding[Resampler] + 1;
659 maxstep = mini(maxstep, INT_MAX>>FRACTIONBITS);
660
661 Pitch = Pitch * ALBuffer->Frequency / Frequency;
662 if(Pitch > (ALfloat)maxstep)
663 ALSource->Params.Step = maxstep<<FRACTIONBITS;
664 else
665 {
666 ALSource->Params.Step = fastf2i(Pitch*FRACTIONONE);
667 if(ALSource->Params.Step == 0)
668 ALSource->Params.Step = 1;
669 }
670 if(ALSource->Params.Step == FRACTIONONE)
671 Resampler = PointResampler;
672
673 break;
674 }
675 BufferListItem = BufferListItem->next;
676 }
677 if(Device->Hrtf)
678 ALSource->Params.DoMix = SelectHrtfMixer(Resampler);
679 else
680 ALSource->Params.DoMix = SelectMixer(Resampler);
681
682 if(Device->Hrtf)
683 {
684 // Use a binaural HRTF algorithm for stereo headphone playback
685 ALfloat delta, ev = 0.0f, az = 0.0f;
686
687 if(Distance > 0.0f)
688 {
689 ALfloat invlen = 1.0f/Distance;
690 Position[0] *= invlen;
691 Position[1] *= invlen;
692 Position[2] *= invlen;
693
694 // Calculate elevation and azimuth only when the source is not at
695 // the listener. This prevents +0 and -0 Z from producing
696 // inconsistent panning.
697 ev = aluAsin(Position[1]);
698 az = aluAtan2(Position[0], -Position[2]*ZScale);
699 }
700
701 // Check to see if the HRIR is already moving.
702 if(ALSource->HrtfMoving)
703 {
704 // Calculate the normalized HRTF transition factor (delta).
705 delta = CalcHrtfDelta(ALSource->Params.HrtfGain, DryGain,
706 ALSource->Params.HrtfDir, Position);
707 // If the delta is large enough, get the moving HRIR target
708 // coefficients, target delays, steppping values, and counter.
709 if(delta > 0.001f)
710 {
711 ALSource->HrtfCounter = GetMovingHrtfCoeffs(Device->Hrtf,
712 ev, az, DryGain, delta,
713 ALSource->HrtfCounter,
714 ALSource->Params.HrtfCoeffs[0],
715 ALSource->Params.HrtfDelay[0],
716 ALSource->Params.HrtfCoeffStep,
717 ALSource->Params.HrtfDelayStep);
718 ALSource->Params.HrtfGain = DryGain;
719 ALSource->Params.HrtfDir[0] = Position[0];
720 ALSource->Params.HrtfDir[1] = Position[1];
721 ALSource->Params.HrtfDir[2] = Position[2];
722 }
723 }
724 else
725 {
726 // Get the initial (static) HRIR coefficients and delays.
727 GetLerpedHrtfCoeffs(Device->Hrtf, ev, az, DryGain,
728 ALSource->Params.HrtfCoeffs[0],
729 ALSource->Params.HrtfDelay[0]);
730 ALSource->HrtfCounter = 0;
731 ALSource->Params.HrtfGain = DryGain;
732 ALSource->Params.HrtfDir[0] = Position[0];
733 ALSource->Params.HrtfDir[1] = Position[1];
734 ALSource->Params.HrtfDir[2] = Position[2];
735 }
736 }
737 else
738 {
739 // Use energy-preserving panning algorithm for multi-speaker playback
740 ALfloat DirGain, AmbientGain;
741 const ALfloat *ChannelGain;
742 ALfloat length;
743 ALint pos;
744
745 length = maxf(Distance, MinDist);
746 if(length > 0.0f)
747 {
748 ALfloat invlen = 1.0f/length;
749 Position[0] *= invlen;
750 Position[1] *= invlen;
751 Position[2] *= invlen;
752 }
753
754 pos = aluCart2LUTpos(-Position[2]*ZScale, Position[0]);
755 ChannelGain = Device->PanningLUT[pos];
756
757 DirGain = aluSqrt(Position[0]*Position[0] + Position[2]*Position[2]);
758 // elevation adjustment for directional gain. this sucks, but
759 // has low complexity
760 AmbientGain = aluSqrt(1.0f/Device->NumChan);
761 for(i = 0;i < MAXCHANNELS;i++)
762 {
763 ALuint i2;
764 for(i2 = 0;i2 < MAXCHANNELS;i2++)
765 ALSource->Params.DryGains[i][i2] = 0.0f;
766 }
767 for(i = 0;i < (ALint)Device->NumChan;i++)
768 {
769 enum Channel chan = Device->Speaker2Chan[i];
770 ALfloat gain = lerp(AmbientGain, ChannelGain[chan], DirGain);
771 ALSource->Params.DryGains[0][chan] = DryGain * gain;
772 }
773 }
774 for(i = 0;i < NumSends;i++)
775 ALSource->Params.Send[i].WetGain = WetGain[i];
776
777 /* Update filter coefficients. */
778 cw = aluCos(F_PI*2.0f * LOWPASSFREQREF / Frequency);
779
780 ALSource->Params.iirFilter.coeff = lpCoeffCalc(DryGainHF, cw);
781 for(i = 0;i < NumSends;i++)
782 {
783 ALfloat a = lpCoeffCalc(WetGainHF[i]*WetGainHF[i], cw);
784 ALSource->Params.Send[i].iirFilter.coeff = a;
785 }
786 }
787
788
789 static __inline ALfloat aluF2F(ALfloat val)
790 { return val; }
791 static __inline ALint aluF2I(ALfloat val)
792 {
793 if(val > 1.0f) return 2147483647;
794 if(val < -1.0f) return -2147483647-1;
795 return fastf2i((ALfloat)(val*2147483647.0));
796 }
797 static __inline ALuint aluF2UI(ALfloat val)
798 { return aluF2I(val)+2147483648u; }
799 static __inline ALshort aluF2S(ALfloat val)
800 { return aluF2I(val)>>16; }
801 static __inline ALushort aluF2US(ALfloat val)
802 { return aluF2S(val)+32768; }
803 static __inline ALbyte aluF2B(ALfloat val)
804 { return aluF2I(val)>>24; }
805 static __inline ALubyte aluF2UB(ALfloat val)
806 { return aluF2B(val)+128; }
807
808 #define DECL_TEMPLATE(T, N, func) \
809 static void Write_##T##_##N(ALCdevice *device, T *RESTRICT buffer, \
810 ALuint SamplesToDo) \
811 { \
812 ALfloat (*RESTRICT DryBuffer)[MAXCHANNELS] = device->DryBuffer; \
813 const enum Channel *ChanMap = device->DevChannels; \
814 ALuint i, j; \
815 \
816 for(i = 0;i < SamplesToDo;i++) \
817 { \
818 for(j = 0;j < N;j++) \
819 *(buffer++) = func(DryBuffer[i][ChanMap[j]]); \
820 } \
821 }
822
823 DECL_TEMPLATE(ALfloat, 1, aluF2F)
824 DECL_TEMPLATE(ALfloat, 2, aluF2F)
825 DECL_TEMPLATE(ALfloat, 4, aluF2F)
826 DECL_TEMPLATE(ALfloat, 6, aluF2F)
827 DECL_TEMPLATE(ALfloat, 7, aluF2F)
828 DECL_TEMPLATE(ALfloat, 8, aluF2F)
829
830 DECL_TEMPLATE(ALuint, 1, aluF2UI)
831 DECL_TEMPLATE(ALuint, 2, aluF2UI)
832 DECL_TEMPLATE(ALuint, 4, aluF2UI)
833 DECL_TEMPLATE(ALuint, 6, aluF2UI)
834 DECL_TEMPLATE(ALuint, 7, aluF2UI)
835 DECL_TEMPLATE(ALuint, 8, aluF2UI)
836
837 DECL_TEMPLATE(ALint, 1, aluF2I)
838 DECL_TEMPLATE(ALint, 2, aluF2I)
839 DECL_TEMPLATE(ALint, 4, aluF2I)
840 DECL_TEMPLATE(ALint, 6, aluF2I)
841 DECL_TEMPLATE(ALint, 7, aluF2I)
842 DECL_TEMPLATE(ALint, 8, aluF2I)
843
844 DECL_TEMPLATE(ALushort, 1, aluF2US)
845 DECL_TEMPLATE(ALushort, 2, aluF2US)
846 DECL_TEMPLATE(ALushort, 4, aluF2US)
847 DECL_TEMPLATE(ALushort, 6, aluF2US)
848 DECL_TEMPLATE(ALushort, 7, aluF2US)
849 DECL_TEMPLATE(ALushort, 8, aluF2US)
850
851 DECL_TEMPLATE(ALshort, 1, aluF2S)
852 DECL_TEMPLATE(ALshort, 2, aluF2S)
853 DECL_TEMPLATE(ALshort, 4, aluF2S)
854 DECL_TEMPLATE(ALshort, 6, aluF2S)
855 DECL_TEMPLATE(ALshort, 7, aluF2S)
856 DECL_TEMPLATE(ALshort, 8, aluF2S)
857
858 DECL_TEMPLATE(ALubyte, 1, aluF2UB)
859 DECL_TEMPLATE(ALubyte, 2, aluF2UB)
860 DECL_TEMPLATE(ALubyte, 4, aluF2UB)
861 DECL_TEMPLATE(ALubyte, 6, aluF2UB)
862 DECL_TEMPLATE(ALubyte, 7, aluF2UB)
863 DECL_TEMPLATE(ALubyte, 8, aluF2UB)
864
865 DECL_TEMPLATE(ALbyte, 1, aluF2B)
866 DECL_TEMPLATE(ALbyte, 2, aluF2B)
867 DECL_TEMPLATE(ALbyte, 4, aluF2B)
868 DECL_TEMPLATE(ALbyte, 6, aluF2B)
869 DECL_TEMPLATE(ALbyte, 7, aluF2B)
870 DECL_TEMPLATE(ALbyte, 8, aluF2B)
871
872 #undef DECL_TEMPLATE
873
874 #define DECL_TEMPLATE(T) \
875 static void Write_##T(ALCdevice *device, T *buffer, ALuint SamplesToDo) \
876 { \
877 switch(device->FmtChans) \
878 { \
879 case DevFmtMono: \
880 Write_##T##_1(device, buffer, SamplesToDo); \
881 break; \
882 case DevFmtStereo: \
883 Write_##T##_2(device, buffer, SamplesToDo); \
884 break; \
885 case DevFmtQuad: \
886 Write_##T##_4(device, buffer, SamplesToDo); \
887 break; \
888 case DevFmtX51: \
889 case DevFmtX51Side: \
890 Write_##T##_6(device, buffer, SamplesToDo); \
891 break; \
892 case DevFmtX61: \
893 Write_##T##_7(device, buffer, SamplesToDo); \
894 break; \
895 case DevFmtX71: \
896 Write_##T##_8(device, buffer, SamplesToDo); \
897 break; \
898 } \
899 }
900
901 DECL_TEMPLATE(ALfloat)
902 DECL_TEMPLATE(ALuint)
903 DECL_TEMPLATE(ALint)
904 DECL_TEMPLATE(ALushort)
905 DECL_TEMPLATE(ALshort)
906 DECL_TEMPLATE(ALubyte)
907 DECL_TEMPLATE(ALbyte)
908
909 #undef DECL_TEMPLATE
910
911 ALvoid aluMixData(ALCdevice *device, ALvoid *buffer, ALsizei size)
912 {
913 ALuint SamplesToDo;
914 ALeffectslot **slot, **slot_end;
915 ALsource **src, **src_end;
916 ALCcontext *ctx;
917 int fpuState;
918 ALuint i, c;
919
920 fpuState = SetMixerFPUMode();
921
922 while(size > 0)
923 {
924 /* Setup variables */
925 SamplesToDo = minu(size, BUFFERSIZE);
926
927 /* Clear mixing buffer */
928 memset(device->DryBuffer, 0, SamplesToDo*MAXCHANNELS*sizeof(ALfloat));
929
930 LockDevice(device);
931 ctx = device->ContextList;
932 while(ctx)
933 {
934 ALenum DeferUpdates = ctx->DeferUpdates;
935 ALenum UpdateSources = AL_FALSE;
936
937 if(!DeferUpdates)
938 UpdateSources = ExchangeInt(&ctx->UpdateSources, AL_FALSE);
939
940 src = ctx->ActiveSources;
941 src_end = src + ctx->ActiveSourceCount;
942 while(src != src_end)
943 {
944 if((*src)->state != AL_PLAYING)
945 {
946 --(ctx->ActiveSourceCount);
947 *src = *(--src_end);
948 continue;
949 }
950
951 if(!DeferUpdates && (ExchangeInt(&(*src)->NeedsUpdate, AL_FALSE) ||
952 UpdateSources))
953 ALsource_Update(*src, ctx);
954
955 MixSource(*src, device, SamplesToDo);
956 src++;
957 }
958
959 /* effect slot processing */
960 slot = ctx->ActiveEffectSlots;
961 slot_end = slot + ctx->ActiveEffectSlotCount;
962 while(slot != slot_end)
963 {
964 for(c = 0;c < SamplesToDo;c++)
965 {
966 (*slot)->WetBuffer[c] += (*slot)->ClickRemoval[0];
967 (*slot)->ClickRemoval[0] -= (*slot)->ClickRemoval[0] * (1.0f/256.0f);
968 }
969 (*slot)->ClickRemoval[0] += (*slot)->PendingClicks[0];
970 (*slot)->PendingClicks[0] = 0.0f;
971
972 if(!DeferUpdates && ExchangeInt(&(*slot)->NeedsUpdate, AL_FALSE))
973 ALeffectState_Update((*slot)->EffectState, ctx, *slot);
974
975 ALeffectState_Process((*slot)->EffectState, SamplesToDo,
976 (*slot)->WetBuffer, device->DryBuffer);
977
978 for(i = 0;i < SamplesToDo;i++)
979 (*slot)->WetBuffer[i] = 0.0f;
980
981 slot++;
982 }
983
984 ctx = ctx->next;
985 }
986
987 slot = &device->DefaultSlot;
988 if(*slot != NULL)
989 {
990 for(c = 0;c < SamplesToDo;c++)
991 {
992 (*slot)->WetBuffer[c] += (*slot)->ClickRemoval[0];
993 (*slot)->ClickRemoval[0] -= (*slot)->ClickRemoval[0] * (1.0f/256.0f);
994 }
995 (*slot)->ClickRemoval[0] += (*slot)->PendingClicks[0];
996 (*slot)->PendingClicks[0] = 0.0f;
997
998 if(ExchangeInt(&(*slot)->NeedsUpdate, AL_FALSE))
999 ALeffectState_Update((*slot)->EffectState, ctx, *slot);
1000
1001 ALeffectState_Process((*slot)->EffectState, SamplesToDo,
1002 (*slot)->WetBuffer, device->DryBuffer);
1003
1004 for(i = 0;i < SamplesToDo;i++)
1005 (*slot)->WetBuffer[i] = 0.0f;
1006 }
1007 UnlockDevice(device);
1008
1009 //Post processing loop
1010 if(device->FmtChans == DevFmtMono)
1011 {
1012 for(i = 0;i < SamplesToDo;i++)
1013 {
1014 device->DryBuffer[i][FRONT_CENTER] += device->ClickRemoval[FRONT_CENTER];
1015 device->ClickRemoval[FRONT_CENTER] -= device->ClickRemoval[FRONT_CENTER] * (1.0f/256.0f);
1016 }
1017 device->ClickRemoval[FRONT_CENTER] += device->PendingClicks[FRONT_CENTER];
1018 device->PendingClicks[FRONT_CENTER] = 0.0f;
1019 }
1020 else if(device->FmtChans == DevFmtStereo)
1021 {
1022 /* Assumes the first two channels are FRONT_LEFT and FRONT_RIGHT */
1023 for(i = 0;i < SamplesToDo;i++)
1024 {
1025 for(c = 0;c < 2;c++)
1026 {
1027 device->DryBuffer[i][c] += device->ClickRemoval[c];
1028 device->ClickRemoval[c] -= device->ClickRemoval[c] * (1.0f/256.0f);
1029 }
1030 }
1031 for(c = 0;c < 2;c++)
1032 {
1033 device->ClickRemoval[c] += device->PendingClicks[c];
1034 device->PendingClicks[c] = 0.0f;
1035 }
1036 if(device->Bs2b)
1037 {
1038 for(i = 0;i < SamplesToDo;i++)
1039 bs2b_cross_feed(device->Bs2b, &device->DryBuffer[i][0]);
1040 }
1041 }
1042 else
1043 {
1044 for(i = 0;i < SamplesToDo;i++)
1045 {
1046 for(c = 0;c < MAXCHANNELS;c++)
1047 {
1048 device->DryBuffer[i][c] += device->ClickRemoval[c];
1049 device->ClickRemoval[c] -= device->ClickRemoval[c] * (1.0f/256.0f);
1050 }
1051 }
1052 for(c = 0;c < MAXCHANNELS;c++)
1053 {
1054 device->ClickRemoval[c] += device->PendingClicks[c];
1055 device->PendingClicks[c] = 0.0f;
1056 }
1057 }
1058
1059 if(buffer)
1060 {
1061 switch(device->FmtType)
1062 {
1063 case DevFmtByte:
1064 Write_ALbyte(device, buffer, SamplesToDo);
1065 break;
1066 case DevFmtUByte:
1067 Write_ALubyte(device, buffer, SamplesToDo);
1068 break;
1069 case DevFmtShort:
1070 Write_ALshort(device, buffer, SamplesToDo);
1071 break;
1072 case DevFmtUShort:
1073 Write_ALushort(device, buffer, SamplesToDo);
1074 break;
1075 case DevFmtInt:
1076 Write_ALint(device, buffer, SamplesToDo);
1077 break;
1078 case DevFmtUInt:
1079 Write_ALuint(device, buffer, SamplesToDo);
1080 break;
1081 case DevFmtFloat:
1082 Write_ALfloat(device, buffer, SamplesToDo);
1083 break;
1084 }
1085 }
1086
1087 size -= SamplesToDo;
1088 }
1089
1090 RestoreFPUMode(fpuState);
1091 }
1092
1093
1094 ALvoid aluHandleDisconnect(ALCdevice *device)
1095 {
1096 ALCcontext *Context;
1097
1098 LockDevice(device);
1099 device->Connected = ALC_FALSE;
1100
1101 Context = device->ContextList;
1102 while(Context)
1103 {
1104 ALsource **src, **src_end;
1105
1106 src = Context->ActiveSources;
1107 src_end = src + Context->ActiveSourceCount;
1108 while(src != src_end)
1109 {
1110 if((*src)->state == AL_PLAYING)
1111 {
1112 (*src)->state = AL_STOPPED;
1113 (*src)->BuffersPlayed = (*src)->BuffersInQueue;
1114 (*src)->position = 0;
1115 (*src)->position_fraction = 0;
1116 }
1117 src++;
1118 }
1119 Context->ActiveSourceCount = 0;
1120
1121 Context = Context->next;
1122 }
1123 UnlockDevice(device);
1124 }
fork of openal-soft for dark-hammer project