731e52c440
Bundle libOpenMPT as a dynamic framework, which should be safe once again, now that there is only one version to bundle. Also, now it is using the versions of libvorbisfile and libmpg123 that are bundled with the player, instead of compiling minimp3 and stbvorbis. Signed-off-by: Christopher Snowhill <kode54@gmail.com>
487 lines
11 KiB
C++
487 lines
11 KiB
C++
/*
|
|
* DSP.cpp
|
|
* -----------
|
|
* Purpose: Mixing code for various DSPs (EQ, Mega-Bass, ...)
|
|
* Notes : Ugh... This should really be removed at some point.
|
|
* Authors: Olivier Lapicque
|
|
* OpenMPT Devs
|
|
* The OpenMPT source code is released under the BSD license. Read LICENSE for more details.
|
|
*/
|
|
|
|
|
|
#include "stdafx.h"
|
|
#include "DSP.h"
|
|
#include "openmpt/soundbase/MixSample.hpp"
|
|
#include <math.h>
|
|
|
|
OPENMPT_NAMESPACE_BEGIN
|
|
|
|
#ifndef NO_DSP
|
|
|
|
|
|
// Bass Expansion
|
|
#define DEFAULT_XBASS_RANGE 14 // (x+2)*20 Hz (320Hz)
|
|
#define DEFAULT_XBASS_DEPTH 6 // 1+(3>>(x-4)) (+6dB)
|
|
|
|
|
|
////////////////////////////////////////////////////////////////////
|
|
// DSP Effects internal state
|
|
|
|
static void X86_StereoDCRemoval(int *, uint32 count, int32 &nDCRFlt_Y1l, int32 &nDCRFlt_X1l, int32 &nDCRFlt_Y1r, int32 &nDCRFlt_X1r);
|
|
static void X86_MonoDCRemoval(int *, uint32 count, int32 &nDCRFlt_Y1l, int32 &nDCRFlt_X1l);
|
|
|
|
///////////////////////////////////////////////////////////////////////////////////
|
|
//
|
|
// Biquad setup
|
|
//
|
|
|
|
|
|
#define PI 3.14159265358979323f
|
|
static inline float Sgn(float x) { return (x >= 0) ? 1.0f : -1.0f; }
|
|
static void ShelfEQ(int32 scale,
|
|
int32 &outA1, int32 &outB0, int32 &outB1,
|
|
int32 F_c, int32 F_s, float gainDC, float gainFT, float gainPI)
|
|
{
|
|
float a1, b0, b1;
|
|
float gainFT2, gainDC2, gainPI2;
|
|
float alpha, beta0, beta1, rho;
|
|
float wT, quad;
|
|
|
|
wT = PI * F_c / F_s;
|
|
gainPI2 = gainPI * gainPI;
|
|
gainFT2 = gainFT * gainFT;
|
|
gainDC2 = gainDC * gainDC;
|
|
|
|
quad = gainPI2 + gainDC2 - (gainFT2*2);
|
|
|
|
alpha = 0;
|
|
|
|
if (quad != 0)
|
|
{
|
|
float lambda = (gainPI2 - gainDC2) / quad;
|
|
alpha = (float)(lambda - Sgn(lambda)*sqrt(lambda*lambda - 1.0f));
|
|
}
|
|
|
|
beta0 = 0.5f * ((gainDC + gainPI) + (gainDC - gainPI) * alpha);
|
|
beta1 = 0.5f * ((gainDC - gainPI) + (gainDC + gainPI) * alpha);
|
|
rho = (float)((sin((wT*0.5f) - (PI/4.0f))) / (sin((wT*0.5f) + (PI/4.0f))));
|
|
|
|
quad = 1.0f / (1.0f + rho*alpha);
|
|
|
|
b0 = ((beta0 + rho*beta1) * quad);
|
|
b1 = ((beta1 + rho*beta0) * quad);
|
|
a1 = - ((rho + alpha) * quad);
|
|
|
|
outA1 = mpt::saturate_round<int32>(a1 * scale);
|
|
outB0 = mpt::saturate_round<int32>(b0 * scale);
|
|
outB1 = mpt::saturate_round<int32>(b1 * scale);
|
|
}
|
|
|
|
|
|
CSurroundSettings::CSurroundSettings() : m_nProLogicDepth(12), m_nProLogicDelay(20)
|
|
{
|
|
|
|
}
|
|
|
|
|
|
CMegaBassSettings::CMegaBassSettings() : m_nXBassDepth(DEFAULT_XBASS_DEPTH), m_nXBassRange(DEFAULT_XBASS_RANGE)
|
|
{
|
|
|
|
}
|
|
|
|
|
|
CSurround::CSurround()
|
|
{
|
|
// Surround Encoding: 1 delay line + low-pass filter + high-pass filter
|
|
nSurroundSize = 0;
|
|
nSurroundPos = 0;
|
|
nDolbyDepth = 0;
|
|
|
|
// Surround Biquads
|
|
nDolbyHP_Y1 = 0;
|
|
nDolbyHP_X1 = 0;
|
|
nDolbyLP_Y1 = 0;
|
|
nDolbyHP_B0 = 0;
|
|
nDolbyHP_B1 = 0;
|
|
nDolbyHP_A1 = 0;
|
|
nDolbyLP_B0 = 0;
|
|
nDolbyLP_B1 = 0;
|
|
nDolbyLP_A1 = 0;
|
|
|
|
MemsetZero(SurroundBuffer);
|
|
|
|
}
|
|
|
|
|
|
CMegaBass::CMegaBass()
|
|
{
|
|
|
|
// Bass Expansion: low-pass filter
|
|
nXBassFlt_Y1 = 0;
|
|
nXBassFlt_X1 = 0;
|
|
nXBassFlt_B0 = 0;
|
|
nXBassFlt_B1 = 0;
|
|
nXBassFlt_A1 = 0;
|
|
|
|
// DC Removal Biquad
|
|
nDCRFlt_Y1lf = 0;
|
|
nDCRFlt_X1lf = 0;
|
|
nDCRFlt_Y1rf = 0;
|
|
nDCRFlt_X1rf = 0;
|
|
nDCRFlt_Y1lb = 0;
|
|
nDCRFlt_X1lb = 0;
|
|
nDCRFlt_Y1rb = 0;
|
|
nDCRFlt_X1rb = 0;
|
|
|
|
}
|
|
|
|
|
|
void CSurround::Initialize(bool bReset, DWORD MixingFreq)
|
|
{
|
|
MPT_UNREFERENCED_PARAMETER(bReset);
|
|
if (!m_Settings.m_nProLogicDelay) m_Settings.m_nProLogicDelay = 20;
|
|
|
|
// Pro-Logic Surround
|
|
nSurroundPos = nSurroundSize = 0;
|
|
{
|
|
memset(SurroundBuffer, 0, sizeof(SurroundBuffer));
|
|
nSurroundSize = (MixingFreq * m_Settings.m_nProLogicDelay) / 1000;
|
|
if (nSurroundSize > SURROUNDBUFFERSIZE) nSurroundSize = SURROUNDBUFFERSIZE;
|
|
nDolbyDepth = m_Settings.m_nProLogicDepth;
|
|
if (nDolbyDepth < 1) nDolbyDepth = 1;
|
|
if (nDolbyDepth > 16) nDolbyDepth = 16;
|
|
// Setup biquad filters
|
|
ShelfEQ(1024, nDolbyHP_A1, nDolbyHP_B0, nDolbyHP_B1, 200, MixingFreq, 0, 0.5f, 1);
|
|
ShelfEQ(1024, nDolbyLP_A1, nDolbyLP_B0, nDolbyLP_B1, 7000, MixingFreq, 1, 0.75f, 0);
|
|
nDolbyHP_X1 = nDolbyHP_Y1 = 0;
|
|
nDolbyLP_Y1 = 0;
|
|
// Surround Level
|
|
nDolbyHP_B0 = (nDolbyHP_B0 * nDolbyDepth) >> 5;
|
|
nDolbyHP_B1 = (nDolbyHP_B1 * nDolbyDepth) >> 5;
|
|
// +6dB
|
|
nDolbyLP_B0 *= 2;
|
|
nDolbyLP_B1 *= 2;
|
|
}
|
|
}
|
|
|
|
|
|
void CMegaBass::Initialize(bool bReset, DWORD MixingFreq)
|
|
{
|
|
// Bass Expansion Reset
|
|
{
|
|
int32 a1 = 0, b0 = 1024, b1 = 0;
|
|
int nXBassCutOff = 50 + (m_Settings.m_nXBassRange+2) * 20;
|
|
int nXBassGain = m_Settings.m_nXBassDepth;
|
|
nXBassGain = std::clamp(nXBassGain, 2, 8);
|
|
nXBassCutOff = std::clamp(nXBassCutOff, 60, 600);
|
|
ShelfEQ(1024, a1, b0, b1, nXBassCutOff, MixingFreq,
|
|
1.0f + (1.0f/16.0f) * (0x300 >> nXBassGain),
|
|
1.0f,
|
|
0.0000001f);
|
|
if (nXBassGain > 5)
|
|
{
|
|
b0 >>= (nXBassGain-5);
|
|
b1 >>= (nXBassGain-5);
|
|
}
|
|
nXBassFlt_A1 = a1;
|
|
nXBassFlt_B0 = b0;
|
|
nXBassFlt_B1 = b1;
|
|
//Log("b0=%d b1=%d a1=%d\n", b0, b1, a1);
|
|
}
|
|
if (bReset)
|
|
{
|
|
nXBassFlt_X1 = 0;
|
|
nXBassFlt_Y1 = 0;
|
|
nDCRFlt_X1lf = 0;
|
|
nDCRFlt_X1rf = 0;
|
|
nDCRFlt_Y1lf = 0;
|
|
nDCRFlt_Y1rf = 0;
|
|
nDCRFlt_X1lb = 0;
|
|
nDCRFlt_X1rb = 0;
|
|
nDCRFlt_Y1lb = 0;
|
|
nDCRFlt_Y1rb = 0;
|
|
}
|
|
}
|
|
|
|
|
|
// 2-channel surround
|
|
void CSurround::ProcessStereoSurround(int * MixSoundBuffer, int count)
|
|
{
|
|
int *pr = MixSoundBuffer, hy1 = nDolbyHP_Y1;
|
|
for (int r=count; r; r--)
|
|
{
|
|
// Delay
|
|
int secho = SurroundBuffer[nSurroundPos];
|
|
SurroundBuffer[nSurroundPos] = (pr[0]+pr[1]+256) >> 9;
|
|
// High-pass
|
|
int v0 = (nDolbyHP_B0 * secho + nDolbyHP_B1 * nDolbyHP_X1 + nDolbyHP_A1 * hy1) >> 10;
|
|
nDolbyHP_X1 = secho;
|
|
// Low-pass
|
|
int v = (nDolbyLP_B0 * v0 + nDolbyLP_B1 * hy1 + nDolbyLP_A1 * nDolbyLP_Y1) >> (10-8);
|
|
hy1 = v0;
|
|
nDolbyLP_Y1 = v >> 8;
|
|
// Add echo
|
|
pr[0] += v;
|
|
pr[1] -= v;
|
|
if (++nSurroundPos >= nSurroundSize) nSurroundPos = 0;
|
|
pr += 2;
|
|
}
|
|
nDolbyHP_Y1 = hy1;
|
|
}
|
|
|
|
|
|
// 4-channels surround
|
|
void CSurround::ProcessQuadSurround(int * MixSoundBuffer, int * MixRearBuffer, int count)
|
|
{
|
|
int *pr = MixSoundBuffer, hy1 = nDolbyHP_Y1;
|
|
for (int r=count; r; r--)
|
|
{
|
|
int vl = pr[0] >> 1;
|
|
int vr = pr[1] >> 1;
|
|
pr[(uint32)(MixRearBuffer-MixSoundBuffer)] += vl;
|
|
pr[((uint32)(MixRearBuffer-MixSoundBuffer))+1] += vr;
|
|
// Delay
|
|
int secho = SurroundBuffer[nSurroundPos];
|
|
SurroundBuffer[nSurroundPos] = (vr+vl+256) >> 9;
|
|
// High-pass
|
|
int v0 = (nDolbyHP_B0 * secho + nDolbyHP_B1 * nDolbyHP_X1 + nDolbyHP_A1 * hy1) >> 10;
|
|
nDolbyHP_X1 = secho;
|
|
// Low-pass
|
|
int v = (nDolbyLP_B0 * v0 + nDolbyLP_B1 * hy1 + nDolbyLP_A1 * nDolbyLP_Y1) >> (10-8);
|
|
hy1 = v0;
|
|
nDolbyLP_Y1 = v >> 8;
|
|
// Add echo
|
|
pr[(uint32)(MixRearBuffer-MixSoundBuffer)] += v;
|
|
pr[((uint32)(MixRearBuffer-MixSoundBuffer))+1] += v;
|
|
if (++nSurroundPos >= nSurroundSize) nSurroundPos = 0;
|
|
pr += 2;
|
|
}
|
|
nDolbyHP_Y1 = hy1;
|
|
}
|
|
|
|
|
|
void CSurround::Process(int * MixSoundBuffer, int * MixRearBuffer, int count, uint32 nChannels)
|
|
{
|
|
|
|
if(nChannels >= 2)
|
|
|
|
// Dolby Pro-Logic Surround
|
|
{
|
|
if (nChannels > 2) ProcessQuadSurround(MixSoundBuffer, MixRearBuffer, count); else
|
|
ProcessStereoSurround(MixSoundBuffer, count);
|
|
}
|
|
|
|
}
|
|
|
|
|
|
void CMegaBass::Process(int * MixSoundBuffer, int * MixRearBuffer, int count, uint32 nChannels)
|
|
{
|
|
|
|
if(nChannels >= 2)
|
|
{
|
|
X86_StereoDCRemoval(MixSoundBuffer, count, nDCRFlt_Y1lf, nDCRFlt_X1lf, nDCRFlt_Y1rf, nDCRFlt_X1rf);
|
|
if(nChannels > 2) X86_StereoDCRemoval(MixRearBuffer, count, nDCRFlt_Y1lb, nDCRFlt_X1lb, nDCRFlt_Y1rb, nDCRFlt_X1rb);
|
|
int *px = MixSoundBuffer;
|
|
int *py = MixRearBuffer;
|
|
int x1 = nXBassFlt_X1;
|
|
int y1 = nXBassFlt_Y1;
|
|
if(nChannels > 2) for (int x=count; x; x--)
|
|
{
|
|
int x_m = (px[0]+px[1]+py[0]+py[1]+0x100)>>9;
|
|
|
|
y1 = (nXBassFlt_B0 * x_m + nXBassFlt_B1 * x1 + nXBassFlt_A1 * y1) >> (10-8);
|
|
x1 = x_m;
|
|
px[0] += y1;
|
|
px[1] += y1;
|
|
py[0] += y1;
|
|
py[1] += y1;
|
|
y1 = (y1+0x80) >> 8;
|
|
px += 2;
|
|
py += 2;
|
|
} else for (int x=count; x; x--)
|
|
{
|
|
int x_m = (px[0]+px[1]+0x100)>>9;
|
|
|
|
y1 = (nXBassFlt_B0 * x_m + nXBassFlt_B1 * x1 + nXBassFlt_A1 * y1) >> (10-8);
|
|
x1 = x_m;
|
|
px[0] += y1;
|
|
px[1] += y1;
|
|
y1 = (y1+0x80) >> 8;
|
|
px += 2;
|
|
}
|
|
nXBassFlt_X1 = x1;
|
|
nXBassFlt_Y1 = y1;
|
|
} else
|
|
{
|
|
X86_MonoDCRemoval(MixSoundBuffer, count, nDCRFlt_Y1lf, nDCRFlt_X1lf);
|
|
int *px = MixSoundBuffer;
|
|
int x1 = nXBassFlt_X1;
|
|
int y1 = nXBassFlt_Y1;
|
|
for (int x=count; x; x--)
|
|
{
|
|
int x_m = (px[0]+0x80)>>8;
|
|
|
|
y1 = (nXBassFlt_B0 * x_m + nXBassFlt_B1 * x1 + nXBassFlt_A1 * y1) >> (10-8);
|
|
x1 = x_m;
|
|
px[0] += y1;
|
|
y1 = (y1+0x40) >> 8;
|
|
px++;
|
|
}
|
|
nXBassFlt_X1 = x1;
|
|
nXBassFlt_Y1 = y1;
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
//////////////////////////////////////////////////////////////////////////
|
|
//
|
|
// DC Removal
|
|
//
|
|
|
|
#define DCR_AMOUNT 9
|
|
|
|
static void X86_StereoDCRemoval(int *pBuffer, uint32 nSamples, int32 &nDCRFlt_Y1l, int32 &nDCRFlt_X1l, int32 &nDCRFlt_Y1r, int32 &nDCRFlt_X1r)
|
|
{
|
|
int y1l = nDCRFlt_Y1l, x1l = nDCRFlt_X1l;
|
|
int y1r = nDCRFlt_Y1r, x1r = nDCRFlt_X1r;
|
|
|
|
while(nSamples--)
|
|
{
|
|
int inL = pBuffer[0];
|
|
int inR = pBuffer[1];
|
|
int diffL = x1l - inL;
|
|
int diffR = x1r - inR;
|
|
x1l = inL;
|
|
x1r = inR;
|
|
int outL = diffL / (1 << (DCR_AMOUNT + 1)) - diffL + y1l;
|
|
int outR = diffR / (1 << (DCR_AMOUNT + 1)) - diffR + y1r;
|
|
pBuffer[0] = outL;
|
|
pBuffer[1] = outR;
|
|
pBuffer += 2;
|
|
y1l = outL - outL / (1 << DCR_AMOUNT);
|
|
y1r = outR - outR / (1 << DCR_AMOUNT);
|
|
}
|
|
|
|
nDCRFlt_Y1l = y1l;
|
|
nDCRFlt_X1l = x1l;
|
|
nDCRFlt_Y1r = y1r;
|
|
nDCRFlt_X1r = x1r;
|
|
}
|
|
|
|
|
|
static void X86_MonoDCRemoval(int *pBuffer, uint32 nSamples, int32 &nDCRFlt_Y1l, int32 &nDCRFlt_X1l)
|
|
{
|
|
int y1l = nDCRFlt_Y1l, x1l = nDCRFlt_X1l;
|
|
while(nSamples--)
|
|
{
|
|
int inM = pBuffer[0];
|
|
int diff = x1l - inM;
|
|
x1l = inM;
|
|
pBuffer[0] = inM = diff / (1 << (DCR_AMOUNT + 1)) - diff + y1l;
|
|
pBuffer++;
|
|
y1l = inM - inM / (1 << DCR_AMOUNT);
|
|
}
|
|
|
|
nDCRFlt_Y1l = y1l;
|
|
nDCRFlt_X1l = x1l;
|
|
}
|
|
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Clean DSP Effects interface
|
|
|
|
// [XBass level 0(quiet)-100(loud)], [cutoff in Hz 20-100]
|
|
void CMegaBass::SetXBassParameters(uint32 nDepth, uint32 nRange)
|
|
{
|
|
if (nDepth > 100) nDepth = 100;
|
|
uint32 gain = nDepth / 20;
|
|
if (gain > 4) gain = 4;
|
|
m_Settings.m_nXBassDepth = 8 - gain; // filter attenuation 1/256 .. 1/16
|
|
uint32 range = nRange / 5;
|
|
if (range > 5) range -= 5; else range = 0;
|
|
if (nRange > 16) nRange = 16;
|
|
m_Settings.m_nXBassRange = 21 - range; // filter average on 0.5-1.6ms
|
|
}
|
|
|
|
|
|
// [Surround level 0(quiet)-100(heavy)] [delay in ms, usually 5-50ms]
|
|
void CSurround::SetSurroundParameters(uint32 nDepth, uint32 nDelay)
|
|
{
|
|
uint32 gain = (nDepth * 16) / 100;
|
|
if (gain > 16) gain = 16;
|
|
if (gain < 1) gain = 1;
|
|
m_Settings.m_nProLogicDepth = gain;
|
|
if (nDelay < 4) nDelay = 4;
|
|
if (nDelay > 50) nDelay = 50;
|
|
m_Settings.m_nProLogicDelay = nDelay;
|
|
}
|
|
|
|
|
|
BitCrushSettings::BitCrushSettings()
|
|
: m_Bits(8)
|
|
{
|
|
return;
|
|
}
|
|
|
|
|
|
BitCrush::BitCrush()
|
|
{
|
|
}
|
|
|
|
|
|
void BitCrush::Initialize(bool bReset, DWORD MixingFreq)
|
|
{
|
|
MPT_UNREFERENCED_PARAMETER(bReset);
|
|
MPT_UNREFERENCED_PARAMETER(MixingFreq);
|
|
}
|
|
|
|
|
|
void BitCrush::Process(int * MixSoundBuffer, int * MixRearBuffer, int count, uint32 nChannels)
|
|
{
|
|
if(m_Settings.m_Bits <= 0)
|
|
{
|
|
return;
|
|
}
|
|
if(m_Settings.m_Bits > MixSampleIntTraits::mix_precision_bits)
|
|
{
|
|
return;
|
|
}
|
|
unsigned int mask = ~((1u << (MixSampleIntTraits::mix_precision_bits - m_Settings.m_Bits)) - 1u);
|
|
if(nChannels == 4)
|
|
{
|
|
for(int frame = 0; frame < count; ++frame)
|
|
{
|
|
MixSoundBuffer[frame*2 + 0] &= mask;
|
|
MixSoundBuffer[frame*2 + 1] &= mask;
|
|
MixRearBuffer[frame*2 + 0] &= mask;
|
|
MixRearBuffer[frame*2 + 1] &= mask;
|
|
}
|
|
} else if(nChannels == 2)
|
|
{
|
|
for(int frame = 0; frame < count; ++frame)
|
|
{
|
|
MixSoundBuffer[frame*2 + 0] &= mask;
|
|
MixSoundBuffer[frame*2 + 1] &= mask;
|
|
}
|
|
} else if(nChannels == 1)
|
|
{
|
|
for(int frame = 0; frame < count; ++frame)
|
|
{
|
|
MixSoundBuffer[frame] &= mask;
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
#else
|
|
|
|
|
|
MPT_MSVC_WORKAROUND_LNK4221(DSP)
|
|
|
|
|
|
#endif // NO_DSP
|
|
|
|
|
|
OPENMPT_NAMESPACE_END
|