void DspTempo::Process(DspChunk& chunk)
{
if (!m_active || chunk.IsEmpty())
return;
assert(chunk.GetRate() == m_rate);
assert(chunk.GetChannelCount() == m_channels);
// DirectShow speed is in double precision, SoundTouch operates in single.
// We have to adjust it dynamically.
AdjustTempo();
DspChunk::ToFloat(chunk);
m_stouch.putSamples((const float*)chunk.GetData(), (uint32_t)chunk.GetFrameCount());
DspChunk output(DspFormat::Float, m_channels, m_stouch.numSamples(), m_rate);
uint32_t done = m_stouch.receiveSamples((float*)output.GetData(), (uint32_t)output.GetFrameCount());
assert(done == output.GetFrameCount());
output.ShrinkTail(done);
auto& outSamples = (m_ftempo == m_ftempo1) ? m_outSamples1 : m_outSamples2;
outSamples += done;
chunk = std::move(output);
}
void DspTempo::Finish(DspChunk& chunk)
{
if (!m_active)
return;
Process(chunk);
m_stouch.flush();
uint32_t undone = m_stouch.numSamples();
if (undone > 0)
{
DspChunk output(DspFormat::Float, m_channels, chunk.GetFrameCount() + undone, m_rate);
if (!chunk.IsEmpty())
memcpy(output.GetData(), chunk.GetData(), chunk.GetSize());
m_stouch.flush();
uint32_t done = m_stouch.receiveSamples((float*)output.GetData() + chunk.GetSampleCount(), undone);
assert(done == undone);
output.ShrinkTail(chunk.GetFrameCount() + done);
chunk = std::move(output);
}
}
DspChunk DspRate::ProcessEosChunk(soxr_t soxr, DspChunk& chunk)
{
assert(soxr);
DspChunk output;
if (!chunk.IsEmpty())
output = ProcessChunk(soxr, chunk);
for (;;)
{
DspChunk tailChunk(DspFormat::Float, m_channels, m_outputRate, m_outputRate);
size_t inputDone = 0;
size_t outputDo = tailChunk.GetFrameCount();
size_t outputDone = 0;
soxr_process(soxr, nullptr, 0, &inputDone,
tailChunk.GetData(), outputDo, &outputDone);
tailChunk.ShrinkTail(outputDone);
DspChunk::MergeChunks(output, tailChunk);
if (outputDone < outputDo)
break;
}
return output;
}
void DspLimiter::Process(DspChunk& chunk)
{
if (chunk.IsEmpty())
return;
if (!m_exclusive || (chunk.GetFormat() != DspFormat::Float &&
chunk.GetFormat() != DspFormat::Double))
{
m_active = false;
return;
}
m_active = true;
// Analyze samples
float peak;
if (chunk.GetFormat() == DspFormat::Double)
{
double largePeak = GetPeak((double*)chunk.GetData(), chunk.GetSampleCount());
peak = std::nexttoward((float)largePeak, largePeak);
}
else
{
assert(chunk.GetFormat() == DspFormat::Float);
peak = GetPeak((float*)chunk.GetData(), chunk.GetSampleCount());
}
// Configure limiter
if (peak > 1.0f)
{
if (m_holdWindow <= 0)
{
NewTreshold(std::max(peak, 1.4f));
}
else if (peak > m_peak)
{
NewTreshold(peak);
}
m_holdWindow = (int64_t)m_rate * m_channels * 10; // 10 seconds
}
// Apply limiter
if (m_holdWindow > 0)
{
if (chunk.GetFormat() == DspFormat::Double)
{
ApplyLimiter<double>((double*)chunk.GetData(), chunk.GetSampleCount(), m_threshold);
}
else
{
assert(chunk.GetFormat() == DspFormat::Float);
ApplyLimiter((float*)chunk.GetData(), chunk.GetSampleCount(), m_threshold);
}
m_holdWindow -= chunk.GetSampleCount();
}
}
bool AudioRenderer::PushToDevice(DspChunk& chunk, CAMEvent* pFilledEvent)
{
bool firstIteration = true;
uint32_t sleepDuration = 0;
while (!chunk.IsEmpty())
{
// The device buffer is full or almost full at the beginning of the second and subsequent iterations.
// Sleep until the buffer may have significant amount of free space. Unless interrupted.
if (!firstIteration && m_flush.Wait(sleepDuration))
return false;
firstIteration = false;
CAutoLock objectLock(this);
assert(m_state != State_Stopped);
if (m_device)
{
try
{
m_device->Push(chunk, pFilledEvent);
sleepDuration = (m_device->IsRealtime() ? 50 : m_device->GetBufferDuration() / 4);
}
catch (HRESULT)
{
ClearDevice();
sleepDuration = 0;
}
}
else
{
// The code below emulates null audio device.
if (pFilledEvent)
pFilledEvent->Set();
sleepDuration = 1;
// Loop until the graph time passes the current sample end.
REFERENCE_TIME graphTime;
if (m_state == State_Running &&
SUCCEEDED(m_graphClock->GetTime(&graphTime)) &&
graphTime > m_startTime + m_sampleCorrection.GetLastFrameEnd() + m_sampleCorrection.GetTimeDivergence())
{
break;
}
}
}
return true;
}
void DspBalance::Process(DspChunk& chunk)
{
const float balance = m_renderer.GetBalance();
assert(balance >= -1.0f && balance <= 1.0f);
if (balance == 0.0f || chunk.IsEmpty() || chunk.GetChannelCount() != 2)
return;
DspChunk::ToFloat(chunk);
auto data = reinterpret_cast<float*>(chunk.GetData());
const float gain = std::abs(balance);
for (size_t i = (balance < 0.0f ? 1 : 0), n = chunk.GetSampleCount(); i < n; i += 2)
data[i] *= gain;
}
void DspRate::Process(DspChunk& chunk)
{
soxr_t soxr = GetBackend();
if (!soxr || chunk.IsEmpty())
return;
if (m_state == State::Variable && !m_inStateTransition && m_variableDelay > 0)
{
uint64_t inputPosition = llMulDiv(m_variableOutputFrames, m_inputRate, m_outputRate, 0);
int64_t adjustedFrames = inputPosition + m_variableDelay - m_variableInputFrames;
REFERENCE_TIME adjustTime = m_adjustTime - FramesToTimeLong(adjustedFrames, m_inputRate);
double ratio = (double)m_inputRate * 4 / (m_outputRate * (4 + (double)adjustTime / OneSecond));
// TODO: decrease jitter
soxr_set_io_ratio(m_soxrv, ratio, m_outputRate / 1000);
}
DspChunk output = ProcessChunk(soxr, chunk);
if (m_state == State::Variable)
{
m_variableInputFrames += chunk.GetFrameCount();
m_variableOutputFrames += output.GetFrameCount();
// soxr_delay() method is not implemented for variable rate conversion yet,
// but the delay stays more or less constant and we can calculate it in a roundabout way.
if (m_variableDelay == 0 && m_variableOutputFrames > 0)
{
uint64_t inputPosition = llMulDiv(m_variableOutputFrames, m_inputRate, m_outputRate, 0);
m_variableDelay = m_variableInputFrames - inputPosition;
}
}
FinishStateTransition(output, chunk, false);
chunk = std::move(output);
}
DspChunk DspRate::ProcessChunk(soxr_t soxr, DspChunk& chunk)
{
assert(soxr);
assert(!chunk.IsEmpty());
assert(chunk.GetRate() == m_inputRate);
assert(chunk.GetChannelCount() == m_channels);
DspChunk::ToFloat(chunk);
size_t outputFrames = (size_t)(2 * (uint64_t)chunk.GetFrameCount() * m_outputRate / m_inputRate);
DspChunk output(DspFormat::Float, chunk.GetChannelCount(), outputFrames, m_outputRate);
size_t inputDone = 0;
size_t outputDone = 0;
soxr_process(soxr, chunk.GetData(), chunk.GetFrameCount(), &inputDone,
output.GetData(), output.GetFrameCount(), &outputDone);
assert(inputDone == chunk.GetFrameCount());
output.ShrinkTail(outputDone);
return output;
}
void DspRate::FinishStateTransition(DspChunk& processedChunk, DspChunk& unprocessedChunk, bool eos)
{
if (m_inStateTransition)
{
assert(m_state == State::Variable);
DspChunk::ToFloat(processedChunk);
DspChunk::ToFloat(unprocessedChunk);
auto& first = m_transitionChunks.first;
auto& second = m_transitionChunks.second;
DspChunk::MergeChunks(first, processedChunk);
assert(processedChunk.IsEmpty());
if (m_soxrc)
{
// Transitioning from constant rate conversion to variable.
if (!m_transitionCorrelation.first)
m_transitionCorrelation = {true, (size_t)std::round(soxr_delay(m_soxrc))};
if (m_transitionCorrelation.second > 0)
{
DspChunk::MergeChunks(second, eos ? ProcessEosChunk(m_soxrc, unprocessedChunk) :
ProcessChunk(m_soxrc, unprocessedChunk));
}
else
{
// Nothing to flush from constant rate conversion buffer.
m_inStateTransition = false;
}
}
else
{
// Transitioning from pass-through to variable rate conversion.
m_transitionCorrelation = {};
DspChunk::MergeChunks(second, unprocessedChunk);
}
// Cross-fade.
if (m_inStateTransition)
{
const size_t transitionFrames = m_outputRate / 1000; // 1ms
if (first.GetFrameCount() >= transitionFrames &&
second.GetFrameCount() >= m_transitionCorrelation.second + transitionFrames)
{
second.ShrinkHead(second.GetFrameCount() - m_transitionCorrelation.second);
Crossfade(first, second, transitionFrames);
processedChunk = std::move(first);
m_inStateTransition = false;
}
else if (eos)
{
processedChunk = std::move(second);
m_inStateTransition = false;
}
}
if (!m_inStateTransition)
{
m_transitionCorrelation = {};
m_transitionChunks = {};
DestroyBackend(m_soxrc);
}
}
unprocessedChunk = {};
}
void AudioRenderer::ApplyRateCorrection(DspChunk& chunk)
{
CAutoLock objectLock(this);
assert(m_device);
assert(!m_device->IsBitstream());
assert(m_state == State_Running);
if (chunk.IsEmpty())
return;
const REFERENCE_TIME latency = llMulDiv(chunk.GetFrameCount(), OneSecond, chunk.GetRate(), 0) +
m_device->GetStreamLatency() + OneMillisecond * 10;
const REFERENCE_TIME remaining = m_device->GetEnd() - m_device->GetPosition();
REFERENCE_TIME deltaTime = 0;
if (m_live)
{
// Rate matching.
if (remaining > latency)
{
size_t dropFrames = (size_t)llMulDiv(m_device->GetWaveFormat()->nSamplesPerSec,
remaining - latency, OneSecond, 0);
dropFrames = std::min(dropFrames, chunk.GetFrameCount());
chunk.ShrinkHead(chunk.GetFrameCount() - dropFrames);
DebugOut("AudioRenderer drop", dropFrames, "frames for rate matching");
}
}
else
{
// Clock matching.
assert(m_externalClock);
REFERENCE_TIME graphTime, myTime, myStartTime;
if (SUCCEEDED(m_myClock.GetAudioClockStartTime(&myStartTime)) &&
SUCCEEDED(m_myClock.GetAudioClockTime(&myTime, nullptr)) &&
SUCCEEDED(m_graphClock->GetTime(&graphTime)) &&
myTime > myStartTime)
{
myTime -= m_device->GetSilence();
if (myTime > graphTime)
{
// Pad and adjust backwards.
REFERENCE_TIME padTime = myTime - graphTime;
assert(padTime >= 0);
size_t padFrames = (size_t)llMulDiv(m_device->GetWaveFormat()->nSamplesPerSec,
padTime, OneSecond, 0);
if (padFrames > m_device->GetWaveFormat()->nSamplesPerSec / 33) // ~30ms threshold
{
DspChunk tempChunk(chunk.GetFormat(), chunk.GetChannelCount(),
chunk.GetFrameCount() + padFrames, chunk.GetRate());
size_t padBytes = tempChunk.GetFrameSize() * padFrames;
ZeroMemory(tempChunk.GetData(), padBytes);
memcpy(tempChunk.GetData() + padBytes, chunk.GetData(), chunk.GetSize());
chunk = std::move(tempChunk);
REFERENCE_TIME paddedTime = llMulDiv(padFrames, OneSecond,
m_device->GetWaveFormat()->nSamplesPerSec, 0);
m_myClock.OffsetSlavedClock(-paddedTime);
padTime -= paddedTime;
assert(padTime >= 0);
DebugOut("AudioRenderer pad", paddedTime / 10000., "ms for clock matching at",
m_sampleCorrection.GetLastFrameEnd() / 10000., "frame position");
}
// Correct the rest with variable rate.
m_dspRealtimeRate.Adjust(padTime);
m_myClock.OffsetSlavedClock(-padTime);
}
else if (remaining > latency)
{
// Crop and adjust forwards.
assert(myTime <= graphTime);
REFERENCE_TIME dropTime = std::min(graphTime - myTime, remaining - latency);
assert(dropTime >= 0);
size_t dropFrames = (size_t)llMulDiv(m_device->GetWaveFormat()->nSamplesPerSec,
dropTime, OneSecond, 0);
dropFrames = std::min(dropFrames, chunk.GetFrameCount());
if (dropFrames > m_device->GetWaveFormat()->nSamplesPerSec / 33) // ~30ms threshold
{
chunk.ShrinkHead(chunk.GetFrameCount() - dropFrames);
REFERENCE_TIME droppedTime = llMulDiv(dropFrames, OneSecond,
m_device->GetWaveFormat()->nSamplesPerSec, 0);
m_myClock.OffsetSlavedClock(droppedTime);
dropTime -= droppedTime;
assert(dropTime >= 0);
DebugOut("AudioRenderer drop", droppedTime / 10000., "ms for clock matching at",
m_sampleCorrection.GetLastFrameEnd() / 10000., "frame position");
}
// Correct the rest with variable rate.
m_dspRealtimeRate.Adjust(-dropTime);
m_myClock.OffsetSlavedClock(dropTime);
}
}
}
}
bool AudioRenderer::Finish(bool blockUntilEnd, CAMEvent* pFilledEvent)
{
DspChunk chunk;
{
CAutoLock objectLock(this);
assert(m_state != State_Stopped);
// No device - nothing to block on.
if (!m_device)
blockUntilEnd = false;
try
{
// Apply dsp chain.
if (m_device && !m_device->IsBitstream())
{
auto f = [&](DspBase* pDsp)
{
pDsp->Finish(chunk);
};
EnumerateProcessors(f);
DspChunk::ToFormat(m_device->GetDspFormat(), chunk);
}
}
catch (std::bad_alloc&)
{
chunk = DspChunk();
assert(chunk.IsEmpty());
}
}
auto doBlock = [&]
{
// Increase system timer resolution.
TimePeriodHelper timePeriodHelper(1);
for (;;)
{
REFERENCE_TIME remaining = 0;
{
CAutoLock objectLock(this);
if (m_device)
{
try
{
remaining = m_device->Finish(pFilledEvent);
}
catch (HRESULT)
{
ClearDevice();
}
}
}
// The end of stream is reached.
if (remaining <= 0)
return true;
// Sleep until predicted end of stream.
if (m_flush.Wait(std::max(1, (int32_t)(remaining / OneMillisecond))))
return false;
}
};
// Send processed sample to the device, and block until the end of stream (if requested).
return PushToDevice(chunk, pFilledEvent) && (!blockUntilEnd || doBlock());
}