mirror of
https://github.com/QB64Official/qb64.git
synced 2024-09-20 00:54:48 +00:00
1119 lines
44 KiB
C
1119 lines
44 KiB
C
|
/**
|
||
|
* OpenAL cross platform audio library
|
||
|
* Copyright (C) 1999-2007 by authors.
|
||
|
* This library is free software; you can redistribute it and/or
|
||
|
* modify it under the terms of the GNU Library General Public
|
||
|
* License as published by the Free Software Foundation; either
|
||
|
* version 2 of the License, or (at your option) any later version.
|
||
|
*
|
||
|
* This library is distributed in the hope that it will be useful,
|
||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||
|
* Library General Public License for more details.
|
||
|
*
|
||
|
* You should have received a copy of the GNU Library General Public
|
||
|
* License along with this library; if not, write to the
|
||
|
* Free Software Foundation, Inc., 59 Temple Place - Suite 330,
|
||
|
* Boston, MA 02111-1307, USA.
|
||
|
* Or go to http://www.gnu.org/copyleft/lgpl.html
|
||
|
*/
|
||
|
|
||
|
#include "config.h"
|
||
|
|
||
|
#include <math.h>
|
||
|
#include <stdlib.h>
|
||
|
#include <string.h>
|
||
|
#include <ctype.h>
|
||
|
#include <assert.h>
|
||
|
#include <unistd.h>
|
||
|
|
||
|
#include "alMain.h"
|
||
|
#include "AL/al.h"
|
||
|
#include "AL/alc.h"
|
||
|
#include "alSource.h"
|
||
|
#include "alBuffer.h"
|
||
|
#include "alListener.h"
|
||
|
#include "alAuxEffectSlot.h"
|
||
|
#include "alu.h"
|
||
|
#include "bs2b.h"
|
||
|
|
||
|
#ifdef MAX_SOURCES_LOW
|
||
|
// For throttling AlSource.c
|
||
|
int alc_max_sources = MAX_SOURCES_LOW;
|
||
|
int alc_active_sources = 0;
|
||
|
int alc_num_cores = 0;
|
||
|
#endif
|
||
|
|
||
|
static __inline ALvoid aluCrossproduct(const ALfp *inVector1, const ALfp *inVector2, ALfp *outVector)
|
||
|
{
|
||
|
outVector[0] = (ALfpMult(inVector1[1],inVector2[2]) - ALfpMult(inVector1[2],inVector2[1]));
|
||
|
outVector[1] = (ALfpMult(inVector1[2],inVector2[0]) - ALfpMult(inVector1[0],inVector2[2]));
|
||
|
outVector[2] = (ALfpMult(inVector1[0],inVector2[1]) - ALfpMult(inVector1[1],inVector2[0]));
|
||
|
}
|
||
|
|
||
|
static __inline ALfp aluDotproduct(const ALfp *inVector1, const ALfp *inVector2)
|
||
|
{
|
||
|
return (ALfpMult(inVector1[0],inVector2[0]) + ALfpMult(inVector1[1],inVector2[1]) +
|
||
|
ALfpMult(inVector1[2],inVector2[2]));
|
||
|
}
|
||
|
|
||
|
static __inline ALvoid aluNormalize(ALfp *inVector)
|
||
|
{
|
||
|
ALfp length, inverse_length;
|
||
|
|
||
|
length = aluSqrt(aluDotproduct(inVector, inVector));
|
||
|
if(length != int2ALfp(0))
|
||
|
{
|
||
|
inverse_length = ALfpDiv(int2ALfp(1),length);
|
||
|
inVector[0] = ALfpMult(inVector[0], inverse_length);
|
||
|
inVector[1] = ALfpMult(inVector[1], inverse_length);
|
||
|
inVector[2] = ALfpMult(inVector[2], inverse_length);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static __inline ALvoid aluMatrixVector(ALfp *vector,ALfp w,ALfp matrix[4][4])
|
||
|
{
|
||
|
ALfp temp[4] = {
|
||
|
vector[0], vector[1], vector[2], w
|
||
|
};
|
||
|
|
||
|
vector[0] = ALfpMult(temp[0],matrix[0][0]) + ALfpMult(temp[1],matrix[1][0]) + ALfpMult(temp[2],matrix[2][0]) + ALfpMult(temp[3],matrix[3][0]);
|
||
|
vector[1] = ALfpMult(temp[0],matrix[0][1]) + ALfpMult(temp[1],matrix[1][1]) + ALfpMult(temp[2],matrix[2][1]) + ALfpMult(temp[3],matrix[3][1]);
|
||
|
vector[2] = ALfpMult(temp[0],matrix[0][2]) + ALfpMult(temp[1],matrix[1][2]) + ALfpMult(temp[2],matrix[2][2]) + ALfpMult(temp[3],matrix[3][2]);
|
||
|
}
|
||
|
|
||
|
|
||
|
ALvoid CalcNonAttnSourceParams(ALsource *ALSource, const ALCcontext *ALContext)
|
||
|
{
|
||
|
ALfp SourceVolume,ListenerGain,MinVolume,MaxVolume;
|
||
|
ALbufferlistitem *BufferListItem;
|
||
|
enum DevFmtChannels DevChans;
|
||
|
enum FmtChannels Channels;
|
||
|
ALfp DryGain, DryGainHF;
|
||
|
ALfp WetGain[MAX_SENDS];
|
||
|
ALfp WetGainHF[MAX_SENDS];
|
||
|
ALint NumSends, Frequency;
|
||
|
ALboolean DupStereo;
|
||
|
ALfp Pitch;
|
||
|
ALfp cw;
|
||
|
ALint i;
|
||
|
|
||
|
/* Get device properties */
|
||
|
DevChans = ALContext->Device->FmtChans;
|
||
|
DupStereo = ALContext->Device->DuplicateStereo;
|
||
|
NumSends = ALContext->Device->NumAuxSends;
|
||
|
Frequency = ALContext->Device->Frequency;
|
||
|
|
||
|
/* Get listener properties */
|
||
|
ListenerGain = ALContext->Listener.Gain;
|
||
|
|
||
|
/* Get source properties */
|
||
|
SourceVolume = ALSource->flGain;
|
||
|
MinVolume = ALSource->flMinGain;
|
||
|
MaxVolume = ALSource->flMaxGain;
|
||
|
Pitch = ALSource->flPitch;
|
||
|
|
||
|
/* Calculate the stepping value */
|
||
|
Channels = FmtMono;
|
||
|
BufferListItem = ALSource->queue;
|
||
|
while(BufferListItem != NULL)
|
||
|
{
|
||
|
ALbuffer *ALBuffer;
|
||
|
if((ALBuffer=BufferListItem->buffer) != NULL)
|
||
|
{
|
||
|
ALint maxstep = STACK_DATA_SIZE / FrameSizeFromFmt(ALBuffer->FmtChannels,
|
||
|
ALBuffer->FmtType);
|
||
|
maxstep -= ResamplerPadding[ALSource->Resampler] +
|
||
|
ResamplerPrePadding[ALSource->Resampler] + 1;
|
||
|
maxstep = min(maxstep, INT_MAX>>FRACTIONBITS);
|
||
|
|
||
|
Pitch = ALfpDiv(ALfpMult(Pitch, int2ALfp(ALBuffer->Frequency)), int2ALfp(Frequency));
|
||
|
if(Pitch > int2ALfp(maxstep))
|
||
|
ALSource->Params.Step = maxstep<<FRACTIONBITS;
|
||
|
else
|
||
|
{
|
||
|
ALSource->Params.Step = ALfp2int(ALfpMult(Pitch, int2ALfp(FRACTIONONE)));
|
||
|
if(ALSource->Params.Step == 0)
|
||
|
ALSource->Params.Step = 1;
|
||
|
}
|
||
|
|
||
|
Channels = ALBuffer->FmtChannels;
|
||
|
break;
|
||
|
}
|
||
|
BufferListItem = BufferListItem->next;
|
||
|
}
|
||
|
|
||
|
/* Calculate gains */
|
||
|
DryGain = SourceVolume;
|
||
|
DryGain = __min(DryGain,MaxVolume);
|
||
|
DryGain = __max(DryGain,MinVolume);
|
||
|
DryGainHF = int2ALfp(1);
|
||
|
|
||
|
switch(ALSource->DirectFilter.type)
|
||
|
{
|
||
|
case AL_FILTER_LOWPASS:
|
||
|
DryGain = ALfpMult(DryGain, ALSource->DirectFilter.Gain);
|
||
|
DryGainHF = ALfpMult(DryGainHF, ALSource->DirectFilter.GainHF);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
for(i = 0;i < MAXCHANNELS;i++)
|
||
|
{
|
||
|
ALuint i2;
|
||
|
for(i2 = 0;i2 < MAXCHANNELS;i2++)
|
||
|
ALSource->Params.DryGains[i][i2] = int2ALfp(0);
|
||
|
}
|
||
|
|
||
|
switch(Channels)
|
||
|
{
|
||
|
case FmtMono:
|
||
|
ALSource->Params.DryGains[0][FRONT_CENTER] = ALfpMult(DryGain, ListenerGain);
|
||
|
break;
|
||
|
case FmtStereo:
|
||
|
if(DupStereo == AL_FALSE)
|
||
|
{
|
||
|
ALSource->Params.DryGains[0][FRONT_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][FRONT_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
switch(DevChans)
|
||
|
{
|
||
|
case DevFmtMono:
|
||
|
case DevFmtStereo:
|
||
|
ALSource->Params.DryGains[0][FRONT_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][FRONT_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
break;
|
||
|
|
||
|
#ifdef STEREO_ONLY
|
||
|
case DevFmtQuad:
|
||
|
case DevFmtX51:
|
||
|
case DevFmtX61:
|
||
|
case DevFmtX71:
|
||
|
break;
|
||
|
#else
|
||
|
case DevFmtQuad:
|
||
|
case DevFmtX51:
|
||
|
DryGain = ALfpMult(DryGain, aluSqrt(float2ALfp(2.0f/4.0f)));
|
||
|
ALSource->Params.DryGains[0][FRONT_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][FRONT_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[0][BACK_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][BACK_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
break;
|
||
|
|
||
|
case DevFmtX61:
|
||
|
DryGain = ALfpMult(DryGain, aluSqrt(float2ALfp(2.0f/4.0f)));
|
||
|
ALSource->Params.DryGains[0][FRONT_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][FRONT_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[0][SIDE_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][SIDE_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
break;
|
||
|
|
||
|
case DevFmtX71:
|
||
|
DryGain = ALfpMult(DryGain, aluSqrt(float2ALfp(2.0f/6.0f)));
|
||
|
ALSource->Params.DryGains[0][FRONT_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][FRONT_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[0][BACK_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][BACK_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[0][SIDE_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][SIDE_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
break;
|
||
|
#endif
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case FmtRear:
|
||
|
#ifndef STEREO_ONLY
|
||
|
ALSource->Params.DryGains[0][BACK_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][BACK_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
#endif
|
||
|
break;
|
||
|
|
||
|
case FmtQuad:
|
||
|
ALSource->Params.DryGains[0][FRONT_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][FRONT_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
#ifndef STEREO_ONLY
|
||
|
ALSource->Params.DryGains[2][BACK_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[3][BACK_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
#endif
|
||
|
break;
|
||
|
|
||
|
case FmtX51:
|
||
|
ALSource->Params.DryGains[0][FRONT_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][FRONT_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
#ifndef STEREO_ONLY
|
||
|
ALSource->Params.DryGains[2][FRONT_CENTER] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[3][LFE] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[4][BACK_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[5][BACK_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
#endif
|
||
|
break;
|
||
|
|
||
|
case FmtX61:
|
||
|
ALSource->Params.DryGains[0][FRONT_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][FRONT_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
#ifndef STEREO_ONLY
|
||
|
ALSource->Params.DryGains[2][FRONT_CENTER] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[3][LFE] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[4][BACK_CENTER] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[5][SIDE_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[6][SIDE_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
#endif
|
||
|
break;
|
||
|
|
||
|
case FmtX71:
|
||
|
ALSource->Params.DryGains[0][FRONT_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[1][FRONT_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
#ifndef STEREO_ONLY
|
||
|
ALSource->Params.DryGains[2][FRONT_CENTER] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[3][LFE] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[4][BACK_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[5][BACK_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[6][SIDE_LEFT] = ALfpMult(DryGain, ListenerGain);
|
||
|
ALSource->Params.DryGains[7][SIDE_RIGHT] = ALfpMult(DryGain, ListenerGain);
|
||
|
#endif
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
for(i = 0;i < NumSends;i++)
|
||
|
{
|
||
|
WetGain[i] = SourceVolume;
|
||
|
WetGain[i] = __min(WetGain[i],MaxVolume);
|
||
|
WetGain[i] = __max(WetGain[i],MinVolume);
|
||
|
WetGainHF[i] = int2ALfp(1);
|
||
|
|
||
|
switch(ALSource->Send[i].WetFilter.type)
|
||
|
{
|
||
|
case AL_FILTER_LOWPASS:
|
||
|
WetGain[i] = ALfpMult(WetGain[i], ALSource->Send[i].WetFilter.Gain);
|
||
|
WetGainHF[i] = ALfpMult(WetGainHF[i], ALSource->Send[i].WetFilter.GainHF);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
ALSource->Params.Send[i].WetGain = ALfpMult(WetGain[i], ListenerGain);
|
||
|
}
|
||
|
|
||
|
/* Update filter coefficients. Calculations based on the I3DL2
|
||
|
* spec. */
|
||
|
cw = float2ALfp(cos(2.0*M_PI * LOWPASSFREQCUTOFF / Frequency));
|
||
|
|
||
|
/* We use two chained one-pole filters, so we need to take the
|
||
|
* square root of the squared gain, which is the same as the base
|
||
|
* gain. */
|
||
|
ALSource->Params.iirFilter.coeff = lpCoeffCalc(DryGainHF, cw);
|
||
|
|
||
|
for(i = 0;i < NumSends;i++)
|
||
|
{
|
||
|
/* We use a one-pole filter, so we need to take the squared gain */
|
||
|
ALfp a = lpCoeffCalc(ALfpMult(WetGainHF[i],WetGainHF[i]), cw);
|
||
|
ALSource->Params.Send[i].iirFilter.coeff = a;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
ALvoid CalcSourceParams(ALsource *ALSource, const ALCcontext *ALContext)
|
||
|
{
|
||
|
const ALCdevice *Device = ALContext->Device;
|
||
|
ALfp InnerAngle,OuterAngle,Angle,Distance,OrigDist;
|
||
|
ALfp Direction[3],Position[3],SourceToListener[3];
|
||
|
ALfp Velocity[3],ListenerVel[3];
|
||
|
ALfp MinVolume,MaxVolume,MinDist,MaxDist,Rolloff,OuterGainHF;
|
||
|
ALfp ConeVolume,ConeHF,SourceVolume,ListenerGain;
|
||
|
ALfp DopplerFactor, DopplerVelocity, SpeedOfSound;
|
||
|
ALfp AirAbsorptionFactor;
|
||
|
ALbufferlistitem *BufferListItem;
|
||
|
ALfp Attenuation, EffectiveDist;
|
||
|
ALfp RoomAttenuation[MAX_SENDS];
|
||
|
ALfp MetersPerUnit;
|
||
|
ALfp RoomRolloff[MAX_SENDS];
|
||
|
ALfp DryGain;
|
||
|
ALfp DryGainHF;
|
||
|
ALfp WetGain[MAX_SENDS];
|
||
|
ALfp WetGainHF[MAX_SENDS];
|
||
|
ALfp DirGain, AmbientGain;
|
||
|
const ALfp *SpeakerGain;
|
||
|
ALfp Pitch;
|
||
|
ALfp length;
|
||
|
ALuint Frequency;
|
||
|
ALint NumSends;
|
||
|
ALint pos, s, i;
|
||
|
ALfp cw;
|
||
|
|
||
|
DryGainHF = int2ALfp(1);
|
||
|
for(i = 0;i < MAX_SENDS;i++)
|
||
|
WetGainHF[i] = int2ALfp(1);
|
||
|
|
||
|
//Get context properties
|
||
|
DopplerFactor = ALfpMult(ALContext->DopplerFactor, ALSource->DopplerFactor);
|
||
|
DopplerVelocity = ALContext->DopplerVelocity;
|
||
|
SpeedOfSound = ALContext->flSpeedOfSound;
|
||
|
NumSends = Device->NumAuxSends;
|
||
|
Frequency = Device->Frequency;
|
||
|
|
||
|
//Get listener properties
|
||
|
ListenerGain = ALContext->Listener.Gain;
|
||
|
MetersPerUnit = ALContext->Listener.MetersPerUnit;
|
||
|
memcpy(ListenerVel, ALContext->Listener.Velocity, sizeof(ALContext->Listener.Velocity));
|
||
|
|
||
|
//Get source properties
|
||
|
SourceVolume = ALSource->flGain;
|
||
|
memcpy(Position, ALSource->vPosition, sizeof(ALSource->vPosition));
|
||
|
memcpy(Direction, ALSource->vOrientation, sizeof(ALSource->vOrientation));
|
||
|
memcpy(Velocity, ALSource->vVelocity, sizeof(ALSource->vVelocity));
|
||
|
MinVolume = ALSource->flMinGain;
|
||
|
MaxVolume = ALSource->flMaxGain;
|
||
|
MinDist = ALSource->flRefDistance;
|
||
|
MaxDist = ALSource->flMaxDistance;
|
||
|
Rolloff = ALSource->flRollOffFactor;
|
||
|
InnerAngle = ALSource->flInnerAngle;
|
||
|
OuterAngle = ALSource->flOuterAngle;
|
||
|
OuterGainHF = ALSource->OuterGainHF;
|
||
|
AirAbsorptionFactor = ALSource->AirAbsorptionFactor;
|
||
|
|
||
|
//1. Translate Listener to origin (convert to head relative)
|
||
|
if(ALSource->bHeadRelative == AL_FALSE)
|
||
|
{
|
||
|
ALfp U[3],V[3],N[3];
|
||
|
ALfp Matrix[4][4];
|
||
|
|
||
|
// Build transform matrix
|
||
|
memcpy(N, ALContext->Listener.Forward, sizeof(N)); // At-vector
|
||
|
aluNormalize(N); // Normalized At-vector
|
||
|
memcpy(V, ALContext->Listener.Up, sizeof(V)); // Up-vector
|
||
|
aluNormalize(V); // Normalized Up-vector
|
||
|
aluCrossproduct(N, V, U); // Right-vector
|
||
|
aluNormalize(U); // Normalized Right-vector
|
||
|
Matrix[0][0] = U[0]; Matrix[0][1] = V[0]; Matrix[0][2] = -1*N[0]; Matrix[0][3] = int2ALfp(0);
|
||
|
Matrix[1][0] = U[1]; Matrix[1][1] = V[1]; Matrix[1][2] = -1*N[1]; Matrix[1][3] = int2ALfp(0);
|
||
|
Matrix[2][0] = U[2]; Matrix[2][1] = V[2]; Matrix[2][2] = -1*N[2]; Matrix[2][3] = int2ALfp(0);
|
||
|
Matrix[3][0] = int2ALfp(0); Matrix[3][1] = int2ALfp(0); Matrix[3][2] = int2ALfp(0); Matrix[3][3] = int2ALfp(1);
|
||
|
|
||
|
// Translate position
|
||
|
Position[0] -= ALContext->Listener.Position[0];
|
||
|
Position[1] -= ALContext->Listener.Position[1];
|
||
|
Position[2] -= ALContext->Listener.Position[2];
|
||
|
|
||
|
// Transform source position and direction into listener space
|
||
|
aluMatrixVector(Position, int2ALfp(1), Matrix);
|
||
|
aluMatrixVector(Direction, int2ALfp(0), Matrix);
|
||
|
// Transform source and listener velocity into listener space
|
||
|
aluMatrixVector(Velocity, int2ALfp(0), Matrix);
|
||
|
aluMatrixVector(ListenerVel, int2ALfp(0), Matrix);
|
||
|
}
|
||
|
else
|
||
|
ListenerVel[0] = ListenerVel[1] = ListenerVel[2] = int2ALfp(0);
|
||
|
|
||
|
SourceToListener[0] = -1*Position[0];
|
||
|
SourceToListener[1] = -1*Position[1];
|
||
|
SourceToListener[2] = -1*Position[2];
|
||
|
aluNormalize(SourceToListener);
|
||
|
aluNormalize(Direction);
|
||
|
|
||
|
//2. Calculate distance attenuation
|
||
|
Distance = aluSqrt(aluDotproduct(Position, Position));
|
||
|
OrigDist = Distance;
|
||
|
|
||
|
Attenuation = int2ALfp(1);
|
||
|
for(i = 0;i < NumSends;i++)
|
||
|
{
|
||
|
RoomAttenuation[i] = int2ALfp(1);
|
||
|
|
||
|
RoomRolloff[i] = ALSource->RoomRolloffFactor;
|
||
|
if(ALSource->Send[i].Slot &&
|
||
|
(ALSource->Send[i].Slot->effect.type == AL_EFFECT_REVERB ||
|
||
|
ALSource->Send[i].Slot->effect.type == AL_EFFECT_EAXREVERB))
|
||
|
RoomRolloff[i] += ALSource->Send[i].Slot->effect.Reverb.RoomRolloffFactor;
|
||
|
}
|
||
|
|
||
|
switch(ALContext->SourceDistanceModel ? ALSource->DistanceModel :
|
||
|
ALContext->DistanceModel)
|
||
|
{
|
||
|
case AL_INVERSE_DISTANCE_CLAMPED:
|
||
|
Distance=__max(Distance,MinDist);
|
||
|
Distance=__min(Distance,MaxDist);
|
||
|
if(MaxDist < MinDist)
|
||
|
break;
|
||
|
//fall-through
|
||
|
case AL_INVERSE_DISTANCE:
|
||
|
if(MinDist > int2ALfp(0))
|
||
|
{
|
||
|
if((MinDist + ALfpMult(Rolloff, (Distance - MinDist))) > int2ALfp(0))
|
||
|
Attenuation = ALfpDiv(MinDist, (MinDist + ALfpMult(Rolloff, (Distance - MinDist))));
|
||
|
for(i = 0;i < NumSends;i++)
|
||
|
{
|
||
|
if((MinDist + ALfpMult(RoomRolloff[i], (Distance - MinDist))) > int2ALfp(0))
|
||
|
RoomAttenuation[i] = ALfpDiv(MinDist, (MinDist + ALfpMult(RoomRolloff[i], (Distance - MinDist))));
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case AL_LINEAR_DISTANCE_CLAMPED:
|
||
|
Distance=__max(Distance,MinDist);
|
||
|
Distance=__min(Distance,MaxDist);
|
||
|
if(MaxDist < MinDist)
|
||
|
break;
|
||
|
//fall-through
|
||
|
case AL_LINEAR_DISTANCE:
|
||
|
if(MaxDist != MinDist)
|
||
|
{
|
||
|
Attenuation = int2ALfp(1) - ALfpDiv(ALfpMult(Rolloff,(Distance-MinDist)), (MaxDist - MinDist));
|
||
|
Attenuation = __max(Attenuation, int2ALfp(0));
|
||
|
for(i = 0;i < NumSends;i++)
|
||
|
{
|
||
|
RoomAttenuation[i] = int2ALfp(1) - ALfpDiv(ALfpMult(RoomRolloff[i],(Distance-MinDist)),(MaxDist - MinDist));
|
||
|
RoomAttenuation[i] = __max(RoomAttenuation[i], int2ALfp(0));
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case AL_EXPONENT_DISTANCE_CLAMPED:
|
||
|
Distance=__max(Distance,MinDist);
|
||
|
Distance=__min(Distance,MaxDist);
|
||
|
if(MaxDist < MinDist)
|
||
|
break;
|
||
|
//fall-through
|
||
|
case AL_EXPONENT_DISTANCE:
|
||
|
if(Distance > int2ALfp(0) && MinDist > int2ALfp(0))
|
||
|
{
|
||
|
Attenuation = aluPow(ALfpDiv(Distance,MinDist), (-1*Rolloff));
|
||
|
for(i = 0;i < NumSends;i++)
|
||
|
RoomAttenuation[i] = aluPow(ALfpDiv(Distance,MinDist), (-1*RoomRolloff[i]));
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case AL_NONE:
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
// Source Gain + Attenuation
|
||
|
DryGain = ALfpMult(SourceVolume, Attenuation);
|
||
|
for(i = 0;i < NumSends;i++)
|
||
|
WetGain[i] = ALfpMult(SourceVolume, RoomAttenuation[i]);
|
||
|
|
||
|
EffectiveDist = int2ALfp(0);
|
||
|
if(MinDist > int2ALfp(0) && Attenuation < int2ALfp(1))
|
||
|
EffectiveDist = ALfpMult((ALfpDiv(MinDist,Attenuation) - MinDist),MetersPerUnit);
|
||
|
|
||
|
// Distance-based air absorption
|
||
|
if(AirAbsorptionFactor > int2ALfp(0) && EffectiveDist > int2ALfp(0))
|
||
|
{
|
||
|
ALfp absorb;
|
||
|
|
||
|
// Absorption calculation is done in dB
|
||
|
absorb = ALfpMult(ALfpMult(AirAbsorptionFactor,float2ALfp(AIRABSORBGAINDBHF)),
|
||
|
EffectiveDist);
|
||
|
// Convert dB to linear gain before applying
|
||
|
absorb = aluPow(int2ALfp(10), ALfpDiv(absorb,int2ALfp(20)));
|
||
|
|
||
|
DryGainHF = ALfpMult(DryGainHF,absorb);
|
||
|
}
|
||
|
|
||
|
//3. Apply directional soundcones
|
||
|
Angle = ALfpMult(aluAcos(aluDotproduct(Direction,SourceToListener)), float2ALfp(180.0f/M_PI));
|
||
|
if(Angle >= InnerAngle && Angle <= OuterAngle)
|
||
|
{
|
||
|
ALfp scale; scale = ALfpDiv((Angle-InnerAngle), (OuterAngle-InnerAngle));
|
||
|
ConeVolume = int2ALfp(1) + ALfpMult((ALSource->flOuterGain - int2ALfp(1)),scale);
|
||
|
ConeHF = (int2ALfp(1)+ALfpMult((OuterGainHF-int2ALfp(1)),scale));
|
||
|
}
|
||
|
else if(Angle > OuterAngle)
|
||
|
{
|
||
|
ConeVolume = (int2ALfp(1)+(ALSource->flOuterGain-int2ALfp(1)));
|
||
|
ConeHF = (int2ALfp(1)+(OuterGainHF-int2ALfp(1)));
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
ConeVolume = int2ALfp(1);
|
||
|
ConeHF = int2ALfp(1);
|
||
|
}
|
||
|
|
||
|
// Apply some high-frequency attenuation for sources behind the listener
|
||
|
// NOTE: This should be aluDotproduct({0,0,-1}, ListenerToSource), however
|
||
|
// that is equivalent to aluDotproduct({0,0,1}, SourceToListener), which is
|
||
|
// the same as SourceToListener[2]
|
||
|
Angle = ALfpMult(aluAcos(SourceToListener[2]), float2ALfp(180.0f/M_PI));
|
||
|
// Sources within the minimum distance attenuate less
|
||
|
if(OrigDist < MinDist)
|
||
|
Angle = ALfpMult(Angle, ALfpDiv(OrigDist,MinDist));
|
||
|
if(Angle > int2ALfp(90))
|
||
|
{
|
||
|
ALfp scale; scale = ALfpDiv((Angle-int2ALfp(90)), float2ALfp(180.1f-90.0f)); // .1 to account for fp errors
|
||
|
ConeHF = ALfpMult(ConeHF, (int2ALfp(1) - ALfpMult(Device->HeadDampen,scale)));
|
||
|
}
|
||
|
|
||
|
DryGain = ALfpMult(DryGain, ConeVolume);
|
||
|
if(ALSource->DryGainHFAuto)
|
||
|
DryGainHF = ALfpMult(DryGainHF, ConeHF);
|
||
|
|
||
|
// Clamp to Min/Max Gain
|
||
|
DryGain = __min(DryGain,MaxVolume);
|
||
|
DryGain = __max(DryGain,MinVolume);
|
||
|
|
||
|
for(i = 0;i < NumSends;i++)
|
||
|
{
|
||
|
ALeffectslot *Slot = ALSource->Send[i].Slot;
|
||
|
|
||
|
if(!Slot || Slot->effect.type == AL_EFFECT_NULL)
|
||
|
{
|
||
|
ALSource->Params.Send[i].WetGain = int2ALfp(0);
|
||
|
WetGainHF[i] = int2ALfp(1);
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
if(Slot->AuxSendAuto)
|
||
|
{
|
||
|
if(ALSource->WetGainAuto)
|
||
|
WetGain[i] = ALfpMult(WetGain[i], ConeVolume);
|
||
|
if(ALSource->WetGainHFAuto)
|
||
|
WetGainHF[i] = ALfpMult(WetGainHF[i], ConeHF);
|
||
|
|
||
|
// Clamp to Min/Max Gain
|
||
|
WetGain[i] = __min(WetGain[i],MaxVolume);
|
||
|
WetGain[i] = __max(WetGain[i],MinVolume);
|
||
|
|
||
|
if(Slot->effect.type == AL_EFFECT_REVERB ||
|
||
|
Slot->effect.type == AL_EFFECT_EAXREVERB)
|
||
|
{
|
||
|
/* Apply a decay-time transformation to the wet path, based on
|
||
|
* the attenuation of the dry path.
|
||
|
*
|
||
|
* Using the approximate (effective) source to listener
|
||
|
* distance, the initial decay of the reverb effect is
|
||
|
* calculated and applied to the wet path.
|
||
|
*/
|
||
|
WetGain[i] = ALfpMult(WetGain[i],
|
||
|
aluPow(int2ALfp(10),
|
||
|
ALfpDiv(ALfpMult(ALfpDiv(EffectiveDist,
|
||
|
ALfpMult(float2ALfp(SPEEDOFSOUNDMETRESPERSEC), Slot->effect.Reverb.DecayTime)),
|
||
|
int2ALfp(-60)),
|
||
|
int2ALfp(20))));
|
||
|
|
||
|
WetGainHF[i] = ALfpMult(WetGainHF[i],
|
||
|
aluPow(Slot->effect.Reverb.AirAbsorptionGainHF,
|
||
|
ALfpMult(AirAbsorptionFactor, EffectiveDist)));
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
/* If the slot's auxiliary send auto is off, the data sent to the
|
||
|
* effect slot is the same as the dry path, sans filter effects */
|
||
|
WetGain[i] = DryGain;
|
||
|
WetGainHF[i] = DryGainHF;
|
||
|
}
|
||
|
|
||
|
switch(ALSource->Send[i].WetFilter.type)
|
||
|
{
|
||
|
case AL_FILTER_LOWPASS:
|
||
|
WetGain[i] = ALfpMult(WetGain[i], ALSource->Send[i].WetFilter.Gain);
|
||
|
WetGainHF[i] = ALfpMult(WetGainHF[i], ALSource->Send[i].WetFilter.GainHF);
|
||
|
break;
|
||
|
}
|
||
|
ALSource->Params.Send[i].WetGain = ALfpMult(WetGain[i], ListenerGain);
|
||
|
}
|
||
|
|
||
|
// Apply filter gains and filters
|
||
|
switch(ALSource->DirectFilter.type)
|
||
|
{
|
||
|
case AL_FILTER_LOWPASS:
|
||
|
DryGain = ALfpMult(DryGain, ALSource->DirectFilter.Gain);
|
||
|
DryGainHF = ALfpMult(DryGainHF, ALSource->DirectFilter.GainHF);
|
||
|
break;
|
||
|
}
|
||
|
DryGain = ALfpMult(DryGain, ListenerGain);
|
||
|
|
||
|
// Calculate Velocity
|
||
|
Pitch = ALSource->flPitch;
|
||
|
if(DopplerFactor != int2ALfp(0))
|
||
|
{
|
||
|
ALfp VSS, VLS;
|
||
|
ALfp MaxVelocity; MaxVelocity = ALfpDiv(ALfpMult(SpeedOfSound,DopplerVelocity),
|
||
|
DopplerFactor);
|
||
|
|
||
|
VSS = aluDotproduct(Velocity, SourceToListener);
|
||
|
if(VSS >= MaxVelocity)
|
||
|
VSS = (MaxVelocity - int2ALfp(1));
|
||
|
else if(VSS <= -MaxVelocity)
|
||
|
VSS = (-MaxVelocity + int2ALfp(1));
|
||
|
|
||
|
VLS = aluDotproduct(ListenerVel, SourceToListener);
|
||
|
if(VLS >= MaxVelocity)
|
||
|
VLS = (MaxVelocity - int2ALfp(1));
|
||
|
else if(VLS <= -MaxVelocity)
|
||
|
VLS = -MaxVelocity + int2ALfp(1);
|
||
|
|
||
|
Pitch = ALfpMult(Pitch,
|
||
|
ALfpDiv((ALfpMult(SpeedOfSound,DopplerVelocity) - ALfpMult(DopplerFactor,VLS)),
|
||
|
(ALfpMult(SpeedOfSound,DopplerVelocity) - ALfpMult(DopplerFactor,VSS))));
|
||
|
}
|
||
|
|
||
|
BufferListItem = ALSource->queue;
|
||
|
while(BufferListItem != NULL)
|
||
|
{
|
||
|
ALbuffer *ALBuffer;
|
||
|
if((ALBuffer=BufferListItem->buffer) != NULL)
|
||
|
{
|
||
|
ALint maxstep = STACK_DATA_SIZE / FrameSizeFromFmt(ALBuffer->FmtChannels,
|
||
|
ALBuffer->FmtType);
|
||
|
maxstep -= ResamplerPadding[ALSource->Resampler] +
|
||
|
ResamplerPrePadding[ALSource->Resampler] + 1;
|
||
|
maxstep = min(maxstep, INT_MAX>>FRACTIONBITS);
|
||
|
|
||
|
Pitch = ALfpDiv(ALfpMult(Pitch, int2ALfp(ALBuffer->Frequency)), int2ALfp(Frequency));
|
||
|
if(Pitch > int2ALfp(maxstep))
|
||
|
ALSource->Params.Step = maxstep<<FRACTIONBITS;
|
||
|
else
|
||
|
{
|
||
|
ALSource->Params.Step = ALfp2int(ALfpMult(Pitch,float2ALfp(FRACTIONONE)));
|
||
|
if(ALSource->Params.Step == 0)
|
||
|
ALSource->Params.Step = 1;
|
||
|
}
|
||
|
break;
|
||
|
}
|
||
|
BufferListItem = BufferListItem->next;
|
||
|
}
|
||
|
|
||
|
// Use energy-preserving panning algorithm for multi-speaker playback
|
||
|
length = __max(OrigDist, MinDist);
|
||
|
if(length > int2ALfp(0))
|
||
|
{
|
||
|
ALfp invlen = ALfpDiv(int2ALfp(1), length);
|
||
|
Position[0] = ALfpMult(Position[0],invlen);
|
||
|
Position[1] = ALfpMult(Position[1],invlen);
|
||
|
Position[2] = ALfpMult(Position[2],invlen);
|
||
|
}
|
||
|
|
||
|
pos = aluCart2LUTpos((-1*Position[2]), Position[0]);
|
||
|
SpeakerGain = &Device->PanningLUT[MAXCHANNELS * pos];
|
||
|
|
||
|
DirGain = aluSqrt((ALfpMult(Position[0],Position[0]) + ALfpMult(Position[2],Position[2])));
|
||
|
// elevation adjustment for directional gain. this sucks, but
|
||
|
// has low complexity
|
||
|
AmbientGain = aluSqrt(float2ALfp(1.0f/Device->NumChan));
|
||
|
for(s = 0;s < MAXCHANNELS;s++)
|
||
|
{
|
||
|
ALuint s2;
|
||
|
for(s2 = 0;s2 < MAXCHANNELS;s2++)
|
||
|
ALSource->Params.DryGains[s][s2] = int2ALfp(0);
|
||
|
}
|
||
|
for(s = 0;s < (ALsizei)Device->NumChan;s++)
|
||
|
{
|
||
|
Channel chan = Device->Speaker2Chan[s];
|
||
|
ALfp gain; gain = AmbientGain + ALfpMult((SpeakerGain[chan]-AmbientGain),DirGain);
|
||
|
ALSource->Params.DryGains[0][chan] = ALfpMult(DryGain, gain);
|
||
|
}
|
||
|
|
||
|
/* Update filter coefficients. */
|
||
|
cw = __cos(ALfpDiv(float2ALfp(2.0*M_PI*LOWPASSFREQCUTOFF), int2ALfp(Frequency)));
|
||
|
|
||
|
/* Spatialized sources use four chained one-pole filters, so we need to
|
||
|
* take the fourth root of the squared gain, which is the same as the
|
||
|
* square root of the base gain. */
|
||
|
ALSource->Params.iirFilter.coeff = lpCoeffCalc(aluSqrt(DryGainHF), cw);
|
||
|
|
||
|
for(i = 0;i < NumSends;i++)
|
||
|
{
|
||
|
/* The wet path uses two chained one-pole filters, so take the
|
||
|
* base gain (square root of the squared gain) */
|
||
|
ALSource->Params.Send[i].iirFilter.coeff = lpCoeffCalc(WetGainHF[i], cw);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
|
||
|
static __inline ALfloat aluF2F(ALfp val)
|
||
|
{
|
||
|
return ALfp2float(val);
|
||
|
}
|
||
|
static __inline ALushort aluF2US(ALfp val)
|
||
|
{
|
||
|
if(val > int2ALfp(1)) return 65535;
|
||
|
if(val < int2ALfp(-1)) return 0;
|
||
|
return (ALushort)(ALfp2int(ALfpMult(val,int2ALfp(32767))) + 32768);
|
||
|
}
|
||
|
static __inline ALshort aluF2S(ALfp val)
|
||
|
{
|
||
|
if(val > int2ALfp(1)) return 32767;
|
||
|
if(val < int2ALfp(-1)) return -32768;
|
||
|
return (ALshort)(ALfp2int(ALfpMult(val,int2ALfp(32767))));
|
||
|
}
|
||
|
static __inline ALubyte aluF2UB(ALfp val)
|
||
|
{
|
||
|
ALushort i = aluF2US(val);
|
||
|
return i>>8;
|
||
|
}
|
||
|
static __inline ALbyte aluF2B(ALfp val)
|
||
|
{
|
||
|
ALshort i = aluF2S(val);
|
||
|
return i>>8;
|
||
|
}
|
||
|
|
||
|
static const Channel MonoChans[] = { FRONT_CENTER };
|
||
|
static const Channel StereoChans[] = { FRONT_LEFT, FRONT_RIGHT };
|
||
|
static const Channel QuadChans[] = { FRONT_LEFT, FRONT_RIGHT,
|
||
|
BACK_LEFT, BACK_RIGHT };
|
||
|
static const Channel X51Chans[] = { FRONT_LEFT, FRONT_RIGHT,
|
||
|
FRONT_CENTER, LFE,
|
||
|
BACK_LEFT, BACK_RIGHT };
|
||
|
static const Channel X61Chans[] = { FRONT_LEFT, FRONT_LEFT,
|
||
|
FRONT_CENTER, LFE, BACK_CENTER,
|
||
|
SIDE_LEFT, SIDE_RIGHT };
|
||
|
static const Channel X71Chans[] = { FRONT_LEFT, FRONT_RIGHT,
|
||
|
FRONT_CENTER, LFE,
|
||
|
BACK_LEFT, BACK_RIGHT,
|
||
|
SIDE_LEFT, SIDE_RIGHT };
|
||
|
|
||
|
#define DECL_TEMPLATE(T, chans,N, func) \
|
||
|
static void Write_##T##_##chans(ALCdevice *device, T *buffer, ALuint SamplesToDo)\
|
||
|
{ \
|
||
|
ALfp (*DryBuffer)[MAXCHANNELS] = device->DryBuffer; \
|
||
|
ALfp (*Matrix)[MAXCHANNELS] = device->ChannelMatrix; \
|
||
|
const ALuint *ChanMap = device->DevChannels; \
|
||
|
ALuint i, j, c; \
|
||
|
\
|
||
|
for(i = 0;i < SamplesToDo;i++) \
|
||
|
{ \
|
||
|
for(j = 0;j < N;j++) \
|
||
|
{ \
|
||
|
ALfp samp; samp = int2ALfp(0); \
|
||
|
for(c = 0;c < MAXCHANNELS;c++) { \
|
||
|
ALfp m = Matrix[c][chans[j]]; \
|
||
|
if (m != 0) \
|
||
|
samp += ALfpMult(DryBuffer[i][c], m); \
|
||
|
} \
|
||
|
((T*)buffer)[ChanMap[chans[j]]] = func(samp); \
|
||
|
} \
|
||
|
buffer = ((T*)buffer) + N; \
|
||
|
} \
|
||
|
}
|
||
|
|
||
|
DECL_TEMPLATE(ALfloat, MonoChans,1, aluF2F)
|
||
|
DECL_TEMPLATE(ALfloat, QuadChans,4, aluF2F)
|
||
|
DECL_TEMPLATE(ALfloat, X51Chans,6, aluF2F)
|
||
|
DECL_TEMPLATE(ALfloat, X61Chans,7, aluF2F)
|
||
|
DECL_TEMPLATE(ALfloat, X71Chans,8, aluF2F)
|
||
|
|
||
|
DECL_TEMPLATE(ALushort, MonoChans,1, aluF2US)
|
||
|
DECL_TEMPLATE(ALushort, QuadChans,4, aluF2US)
|
||
|
DECL_TEMPLATE(ALushort, X51Chans,6, aluF2US)
|
||
|
DECL_TEMPLATE(ALushort, X61Chans,7, aluF2US)
|
||
|
DECL_TEMPLATE(ALushort, X71Chans,8, aluF2US)
|
||
|
|
||
|
DECL_TEMPLATE(ALshort, MonoChans,1, aluF2S)
|
||
|
DECL_TEMPLATE(ALshort, QuadChans,4, aluF2S)
|
||
|
DECL_TEMPLATE(ALshort, X51Chans,6, aluF2S)
|
||
|
DECL_TEMPLATE(ALshort, X61Chans,7, aluF2S)
|
||
|
DECL_TEMPLATE(ALshort, X71Chans,8, aluF2S)
|
||
|
|
||
|
DECL_TEMPLATE(ALubyte, MonoChans,1, aluF2UB)
|
||
|
DECL_TEMPLATE(ALubyte, QuadChans,4, aluF2UB)
|
||
|
DECL_TEMPLATE(ALubyte, X51Chans,6, aluF2UB)
|
||
|
DECL_TEMPLATE(ALubyte, X61Chans,7, aluF2UB)
|
||
|
DECL_TEMPLATE(ALubyte, X71Chans,8, aluF2UB)
|
||
|
|
||
|
DECL_TEMPLATE(ALbyte, MonoChans,1, aluF2B)
|
||
|
DECL_TEMPLATE(ALbyte, QuadChans,4, aluF2B)
|
||
|
DECL_TEMPLATE(ALbyte, X51Chans,6, aluF2B)
|
||
|
DECL_TEMPLATE(ALbyte, X61Chans,7, aluF2B)
|
||
|
DECL_TEMPLATE(ALbyte, X71Chans,8, aluF2B)
|
||
|
|
||
|
#undef DECL_TEMPLATE
|
||
|
|
||
|
#define DECL_TEMPLATE(T, chans,N, func) \
|
||
|
static void Write_##T##_##chans(ALCdevice *device, T *buffer, ALuint SamplesToDo)\
|
||
|
{ \
|
||
|
ALfp (*DryBuffer)[MAXCHANNELS] = device->DryBuffer; \
|
||
|
ALfp (*Matrix)[MAXCHANNELS] = device->ChannelMatrix; \
|
||
|
const ALuint *ChanMap = device->DevChannels; \
|
||
|
ALuint i, j, c; \
|
||
|
\
|
||
|
if(device->Bs2b) \
|
||
|
{ \
|
||
|
for(i = 0;i < SamplesToDo;i++) \
|
||
|
{ \
|
||
|
ALfp samples[2] = { int2ALfp(0), int2ALfp(0) }; \
|
||
|
for(c = 0;c < MAXCHANNELS;c++) \
|
||
|
{ \
|
||
|
samples[0] += ALfpMult(DryBuffer[i][c],Matrix[c][FRONT_LEFT]); \
|
||
|
samples[1] += ALfpMult(DryBuffer[i][c],Matrix[c][FRONT_RIGHT]); \
|
||
|
} \
|
||
|
bs2b_cross_feed(device->Bs2b, samples); \
|
||
|
((T*)buffer)[ChanMap[FRONT_LEFT]] = func(samples[0]); \
|
||
|
((T*)buffer)[ChanMap[FRONT_RIGHT]] = func(samples[1]); \
|
||
|
buffer = ((T*)buffer) + 2; \
|
||
|
} \
|
||
|
} \
|
||
|
else \
|
||
|
{ \
|
||
|
for(i = 0;i < SamplesToDo;i++) \
|
||
|
{ \
|
||
|
for(j = 0;j < N;j++) \
|
||
|
{ \
|
||
|
ALfp samp = int2ALfp(0); \
|
||
|
for(c = 0;c < MAXCHANNELS;c++) \
|
||
|
samp += ALfpMult(DryBuffer[i][c], Matrix[c][chans[j]]); \
|
||
|
((T*)buffer)[ChanMap[chans[j]]] = func(samp); \
|
||
|
} \
|
||
|
buffer = ((T*)buffer) + N; \
|
||
|
} \
|
||
|
} \
|
||
|
}
|
||
|
|
||
|
DECL_TEMPLATE(ALfloat, StereoChans,2, aluF2F)
|
||
|
DECL_TEMPLATE(ALushort, StereoChans,2, aluF2US)
|
||
|
DECL_TEMPLATE(ALshort, StereoChans,2, aluF2S)
|
||
|
DECL_TEMPLATE(ALubyte, StereoChans,2, aluF2UB)
|
||
|
DECL_TEMPLATE(ALbyte, StereoChans,2, aluF2B)
|
||
|
|
||
|
#undef DECL_TEMPLATE
|
||
|
|
||
|
#define DECL_TEMPLATE(T, func) \
|
||
|
static void Write_##T(ALCdevice *device, T *buffer, ALuint SamplesToDo) \
|
||
|
{ \
|
||
|
switch(device->FmtChans) \
|
||
|
{ \
|
||
|
case DevFmtMono: \
|
||
|
Write_##T##_MonoChans(device, buffer, SamplesToDo); \
|
||
|
break; \
|
||
|
case DevFmtStereo: \
|
||
|
Write_##T##_StereoChans(device, buffer, SamplesToDo); \
|
||
|
break; \
|
||
|
case DevFmtQuad: \
|
||
|
Write_##T##_QuadChans(device, buffer, SamplesToDo); \
|
||
|
break; \
|
||
|
case DevFmtX51: \
|
||
|
Write_##T##_X51Chans(device, buffer, SamplesToDo); \
|
||
|
break; \
|
||
|
case DevFmtX61: \
|
||
|
Write_##T##_X61Chans(device, buffer, SamplesToDo); \
|
||
|
break; \
|
||
|
case DevFmtX71: \
|
||
|
Write_##T##_X71Chans(device, buffer, SamplesToDo); \
|
||
|
break; \
|
||
|
} \
|
||
|
}
|
||
|
|
||
|
DECL_TEMPLATE(ALfloat, aluF2F)
|
||
|
DECL_TEMPLATE(ALushort, aluF2US)
|
||
|
DECL_TEMPLATE(ALshort, aluF2S)
|
||
|
DECL_TEMPLATE(ALubyte, aluF2UB)
|
||
|
DECL_TEMPLATE(ALbyte, aluF2B)
|
||
|
|
||
|
#undef DECL_TEMPLATE
|
||
|
|
||
|
static __inline ALvoid aluMixDataPrivate(ALCdevice *device, ALvoid *buffer, ALsizei size)
|
||
|
{
|
||
|
ALuint SamplesToDo;
|
||
|
ALeffectslot *ALEffectSlot;
|
||
|
ALCcontext **ctx, **ctx_end;
|
||
|
ALsource **src, **src_end;
|
||
|
int fpuState;
|
||
|
ALuint i, c;
|
||
|
ALsizei e;
|
||
|
|
||
|
#if defined(HAVE_FESETROUND)
|
||
|
fpuState = fegetround();
|
||
|
fesetround(FE_TOWARDZERO);
|
||
|
#elif defined(HAVE__CONTROLFP)
|
||
|
fpuState = _controlfp(_RC_CHOP, _MCW_RC);
|
||
|
#else
|
||
|
(void)fpuState;
|
||
|
#endif
|
||
|
|
||
|
while(size > 0)
|
||
|
{
|
||
|
/* Setup variables */
|
||
|
SamplesToDo = min(size, BUFFERSIZE);
|
||
|
|
||
|
/* Clear mixing buffer */
|
||
|
memset(device->DryBuffer, 0, SamplesToDo*MAXCHANNELS*sizeof(ALfp));
|
||
|
|
||
|
SuspendContext(NULL);
|
||
|
ctx = device->Contexts;
|
||
|
ctx_end = ctx + device->NumContexts;
|
||
|
while(ctx != ctx_end)
|
||
|
{
|
||
|
SuspendContext(*ctx);
|
||
|
|
||
|
src = (*ctx)->ActiveSources;
|
||
|
src_end = src + (*ctx)->ActiveSourceCount;
|
||
|
while(src != src_end)
|
||
|
{
|
||
|
if((*src)->state != AL_PLAYING)
|
||
|
{
|
||
|
--((*ctx)->ActiveSourceCount);
|
||
|
*src = *(--src_end);
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
if((*src)->NeedsUpdate)
|
||
|
{
|
||
|
ALsource_Update(*src, *ctx);
|
||
|
(*src)->NeedsUpdate = AL_FALSE;
|
||
|
}
|
||
|
|
||
|
MixSource(*src, device, SamplesToDo);
|
||
|
src++;
|
||
|
}
|
||
|
|
||
|
/* effect slot processing */
|
||
|
for(e = 0;e < (*ctx)->EffectSlotMap.size;e++)
|
||
|
{
|
||
|
ALEffectSlot = (*ctx)->EffectSlotMap.array[e].value;
|
||
|
|
||
|
for(i = 0;i < SamplesToDo;i++)
|
||
|
{
|
||
|
ALEffectSlot->ClickRemoval[0] -= ALfpDiv(ALEffectSlot->ClickRemoval[0], int2ALfp(256));
|
||
|
ALEffectSlot->WetBuffer[i] += ALEffectSlot->ClickRemoval[0];
|
||
|
}
|
||
|
for(i = 0;i < 1;i++)
|
||
|
{
|
||
|
ALEffectSlot->ClickRemoval[i] += ALEffectSlot->PendingClicks[i];
|
||
|
ALEffectSlot->PendingClicks[i] = int2ALfp(0);
|
||
|
}
|
||
|
|
||
|
ALEffect_Process(ALEffectSlot->EffectState, ALEffectSlot,
|
||
|
SamplesToDo, ALEffectSlot->WetBuffer,
|
||
|
device->DryBuffer);
|
||
|
|
||
|
for(i = 0;i < SamplesToDo;i++)
|
||
|
ALEffectSlot->WetBuffer[i] = int2ALfp(0);
|
||
|
}
|
||
|
|
||
|
ProcessContext(*ctx);
|
||
|
ctx++;
|
||
|
}
|
||
|
ProcessContext(NULL);
|
||
|
|
||
|
//Post processing loop
|
||
|
for(i = 0;i < SamplesToDo;i++)
|
||
|
{
|
||
|
for(c = 0;c < MAXCHANNELS;c++)
|
||
|
{
|
||
|
device->ClickRemoval[c] -= ALfpDiv(device->ClickRemoval[c], int2ALfp(256));
|
||
|
device->DryBuffer[i][c] += device->ClickRemoval[c];
|
||
|
}
|
||
|
}
|
||
|
for(i = 0;i < MAXCHANNELS;i++)
|
||
|
{
|
||
|
device->ClickRemoval[i] += device->PendingClicks[i];
|
||
|
device->PendingClicks[i] = int2ALfp(0);
|
||
|
}
|
||
|
|
||
|
switch(device->FmtType)
|
||
|
{
|
||
|
case DevFmtByte:
|
||
|
Write_ALbyte(device, buffer, SamplesToDo);
|
||
|
break;
|
||
|
case DevFmtUByte:
|
||
|
Write_ALubyte(device, buffer, SamplesToDo);
|
||
|
break;
|
||
|
case DevFmtShort:
|
||
|
Write_ALshort(device, buffer, SamplesToDo);
|
||
|
break;
|
||
|
case DevFmtUShort:
|
||
|
Write_ALushort(device, buffer, SamplesToDo);
|
||
|
break;
|
||
|
case DevFmtFloat:
|
||
|
Write_ALfloat(device, buffer, SamplesToDo);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
size -= SamplesToDo;
|
||
|
}
|
||
|
|
||
|
#if defined(HAVE_FESETROUND)
|
||
|
fesetround(fpuState);
|
||
|
#elif defined(HAVE__CONTROLFP)
|
||
|
_controlfp(fpuState, _MCW_RC);
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
static inline long timespecdiff(struct timespec *starttime, struct timespec *finishtime)
|
||
|
{
|
||
|
long usec;
|
||
|
usec=(finishtime->tv_sec-starttime->tv_sec)*1000000;
|
||
|
usec+=(finishtime->tv_nsec-starttime->tv_nsec)/1000;
|
||
|
return usec;
|
||
|
}
|
||
|
|
||
|
ALvoid aluMixData(ALCdevice *device, ALvoid *buffer, ALsizei size)
|
||
|
{
|
||
|
#ifdef MAX_SOURCES_LOW
|
||
|
// Profile aluMixDataPrivate to set admission control parameters
|
||
|
static struct timespec ts_start;
|
||
|
static struct timespec ts_end;
|
||
|
long ts_diff;
|
||
|
int time_per_source;
|
||
|
int max_sources_within_deadline;
|
||
|
int mix_deadline_usec;
|
||
|
int max;
|
||
|
|
||
|
if (alc_num_cores == 0) {
|
||
|
// FIXME(Apportable) this is Linux specific
|
||
|
alc_num_cores = sysconf( _SC_NPROCESSORS_ONLN );
|
||
|
LOGI("_SC_NPROCESSORS_ONLN=%d", alc_num_cores);
|
||
|
}
|
||
|
|
||
|
if (alc_num_cores > 1) {
|
||
|
// Allow OpenAL to monopolize one core
|
||
|
mix_deadline_usec = ((size*1000000) / device->Frequency) / 2;
|
||
|
} else {
|
||
|
// Try to cap mixing at 20% CPU
|
||
|
mix_deadline_usec = ((size*1000000) / device->Frequency) / 5;
|
||
|
}
|
||
|
|
||
|
clock_gettime(CLOCK_MONOTONIC, &ts_start);
|
||
|
aluMixDataPrivate(device, buffer, size);
|
||
|
clock_gettime(CLOCK_MONOTONIC, &ts_end);
|
||
|
|
||
|
// Time in micro-seconds that aluMixData has taken to run
|
||
|
ts_diff = timespecdiff(&ts_start, &ts_end);
|
||
|
|
||
|
// Try to adjust the max sources limit adaptively, within a range
|
||
|
if (alc_active_sources > 0) {
|
||
|
time_per_source = max(1, ts_diff / alc_active_sources);
|
||
|
max_sources_within_deadline = mix_deadline_usec / time_per_source;
|
||
|
max = min(max(max_sources_within_deadline, MAX_SOURCES_LOW), MAX_SOURCES_HIGH);
|
||
|
if (max > alc_max_sources) {
|
||
|
alc_max_sources++;
|
||
|
} else if (max < alc_max_sources) {
|
||
|
alc_max_sources = max;
|
||
|
}
|
||
|
} else {
|
||
|
alc_max_sources = MAX_SOURCES_START;
|
||
|
}
|
||
|
#else
|
||
|
aluMixDataPrivate(device, buffer, size);
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
ALvoid aluHandleDisconnect(ALCdevice *device)
|
||
|
{
|
||
|
ALuint i;
|
||
|
|
||
|
SuspendContext(NULL);
|
||
|
for(i = 0;i < device->NumContexts;i++)
|
||
|
{
|
||
|
ALCcontext *Context = device->Contexts[i];
|
||
|
ALsource *source;
|
||
|
ALsizei pos;
|
||
|
|
||
|
SuspendContext(Context);
|
||
|
|
||
|
for(pos = 0;pos < Context->SourceMap.size;pos++)
|
||
|
{
|
||
|
source = Context->SourceMap.array[pos].value;
|
||
|
if(source->state == AL_PLAYING)
|
||
|
{
|
||
|
source->state = AL_STOPPED;
|
||
|
source->BuffersPlayed = source->BuffersInQueue;
|
||
|
source->position = 0;
|
||
|
source->position_fraction = 0;
|
||
|
}
|
||
|
}
|
||
|
ProcessContext(Context);
|
||
|
}
|
||
|
|
||
|
device->Connected = ALC_FALSE;
|
||
|
ProcessContext(NULL);
|
||
|
}
|