| 1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345 |
- #include "config.h"
- #include "config_simd.h"
- #include "voice.h"
- #include <algorithm>
- #include <array>
- #include <atomic>
- #include <cassert>
- #include <climits>
- #include <cstdint>
- #include <cstdlib>
- #include <iterator>
- #include <memory>
- #include <new>
- #include <optional>
- #include <utility>
- #include <vector>
- #include "alnumeric.h"
- #include "alspan.h"
- #include "alstring.h"
- #include "ambidefs.h"
- #include "async_event.h"
- #include "buffer_storage.h"
- #include "context.h"
- #include "cpu_caps.h"
- #include "devformat.h"
- #include "device.h"
- #include "filters/biquad.h"
- #include "filters/nfc.h"
- #include "filters/splitter.h"
- #include "fmt_traits.h"
- #include "logging.h"
- #include "mixer.h"
- #include "mixer/defs.h"
- #include "mixer/hrtfdefs.h"
- #include "opthelpers.h"
- #include "resampler_limits.h"
- #include "ringbuffer.h"
- #include "vector.h"
- #include "voice_change.h"
- struct CTag;
- #if HAVE_SSE
- struct SSETag;
- #endif
- #if HAVE_NEON
- struct NEONTag;
- #endif
- static_assert(!(DeviceBase::MixerLineSize&3), "MixerLineSize must be a multiple of 4");
- static_assert(!(MaxResamplerEdge&3), "MaxResamplerEdge is not a multiple of 4");
- static_assert((BufferLineSize-1)/MaxPitch > 0, "MaxPitch is too large for BufferLineSize!");
- static_assert((INT_MAX>>MixerFracBits)/MaxPitch > BufferLineSize,
- "MaxPitch and/or BufferLineSize are too large for MixerFracBits!");
- namespace {
- using uint = unsigned int;
- using namespace std::chrono;
- using namespace std::string_view_literals;
- using HrtfMixerFunc = void(*)(const al::span<const float> InSamples,
- const al::span<float2> AccumSamples, const uint IrSize, const MixHrtfFilter *hrtfparams,
- const size_t SamplesToDo);
- using HrtfMixerBlendFunc = void(*)(const al::span<const float> InSamples,
- const al::span<float2> AccumSamples, const uint IrSize, const HrtfFilter *oldparams,
- const MixHrtfFilter *newparams, const size_t SamplesToDo);
- HrtfMixerFunc MixHrtfSamples{MixHrtf_<CTag>};
- HrtfMixerBlendFunc MixHrtfBlendSamples{MixHrtfBlend_<CTag>};
- inline MixerOutFunc SelectMixer()
- {
- #if HAVE_NEON
- if((CPUCapFlags&CPU_CAP_NEON))
- return Mix_<NEONTag>;
- #endif
- #if HAVE_SSE
- if((CPUCapFlags&CPU_CAP_SSE))
- return Mix_<SSETag>;
- #endif
- return Mix_<CTag>;
- }
- inline MixerOneFunc SelectMixerOne()
- {
- #if HAVE_NEON
- if((CPUCapFlags&CPU_CAP_NEON))
- return Mix_<NEONTag>;
- #endif
- #if HAVE_SSE
- if((CPUCapFlags&CPU_CAP_SSE))
- return Mix_<SSETag>;
- #endif
- return Mix_<CTag>;
- }
- inline HrtfMixerFunc SelectHrtfMixer()
- {
- #if HAVE_NEON
- if((CPUCapFlags&CPU_CAP_NEON))
- return MixHrtf_<NEONTag>;
- #endif
- #if HAVE_SSE
- if((CPUCapFlags&CPU_CAP_SSE))
- return MixHrtf_<SSETag>;
- #endif
- return MixHrtf_<CTag>;
- }
- inline HrtfMixerBlendFunc SelectHrtfBlendMixer()
- {
- #if HAVE_NEON
- if((CPUCapFlags&CPU_CAP_NEON))
- return MixHrtfBlend_<NEONTag>;
- #endif
- #if HAVE_SSE
- if((CPUCapFlags&CPU_CAP_SSE))
- return MixHrtfBlend_<SSETag>;
- #endif
- return MixHrtfBlend_<CTag>;
- }
- } // namespace
- void Voice::InitMixer(std::optional<std::string> resopt)
- {
- if(resopt)
- {
- struct ResamplerEntry {
- const std::string_view name;
- const Resampler resampler;
- };
- constexpr std::array ResamplerList{
- ResamplerEntry{"none"sv, Resampler::Point},
- ResamplerEntry{"point"sv, Resampler::Point},
- ResamplerEntry{"linear"sv, Resampler::Linear},
- ResamplerEntry{"spline"sv, Resampler::Spline},
- ResamplerEntry{"gaussian"sv, Resampler::Gaussian},
- ResamplerEntry{"bsinc12"sv, Resampler::BSinc12},
- ResamplerEntry{"fast_bsinc12"sv, Resampler::FastBSinc12},
- ResamplerEntry{"bsinc24"sv, Resampler::BSinc24},
- ResamplerEntry{"fast_bsinc24"sv, Resampler::FastBSinc24},
- ResamplerEntry{"bsinc48"sv, Resampler::BSinc48},
- ResamplerEntry{"fast_bsinc48"sv, Resampler::FastBSinc48},
- };
- std::string_view resampler{*resopt};
-
- if (al::case_compare(resampler, "cubic"sv) == 0)
- {
- WARN("Resampler option \"{}\" is deprecated, using spline", *resopt);
- resampler = "spline"sv;
- }
- else if(al::case_compare(resampler, "sinc4"sv) == 0
- || al::case_compare(resampler, "sinc8"sv) == 0)
- {
- WARN("Resampler option \"{}\" is deprecated, using gaussian", *resopt);
- resampler = "gaussian"sv;
- }
- else if(al::case_compare(resampler, "bsinc"sv) == 0)
- {
- WARN("Resampler option \"{}\" is deprecated, using bsinc12", *resopt);
- resampler = "bsinc12"sv;
- }
- auto iter = std::find_if(ResamplerList.begin(), ResamplerList.end(),
- [resampler](const ResamplerEntry &entry) -> bool
- { return al::case_compare(resampler, entry.name) == 0; });
- if(iter == ResamplerList.end())
- ERR("Invalid resampler: {}", *resopt);
- else
- ResamplerDefault = iter->resampler;
- }
- MixSamplesOut = SelectMixer();
- MixSamplesOne = SelectMixerOne();
- MixHrtfBlendSamples = SelectHrtfBlendMixer();
- MixHrtfSamples = SelectHrtfMixer();
- }
- namespace {
- /* IMA ADPCM Stepsize table */
- constexpr std::array<int,89> IMAStep_size{{
- 7, 8, 9, 10, 11, 12, 13, 14, 16, 17, 19,
- 21, 23, 25, 28, 31, 34, 37, 41, 45, 50, 55,
- 60, 66, 73, 80, 88, 97, 107, 118, 130, 143, 157,
- 173, 190, 209, 230, 253, 279, 307, 337, 371, 408, 449,
- 494, 544, 598, 658, 724, 796, 876, 963, 1060, 1166, 1282,
- 1411, 1552, 1707, 1878, 2066, 2272, 2499, 2749, 3024, 3327, 3660,
- 4026, 4428, 4871, 5358, 5894, 6484, 7132, 7845, 8630, 9493,10442,
- 11487,12635,13899,15289,16818,18500,20350,22358,24633,27086,29794,
- 32767
- }};
- /* IMA4 ADPCM Codeword decode table */
- constexpr std::array<int,16> IMA4Codeword{{
- 1, 3, 5, 7, 9, 11, 13, 15,
- -1,-3,-5,-7,-9,-11,-13,-15,
- }};
- /* IMA4 ADPCM Step index adjust decode table */
- constexpr std::array<int,16> IMA4Index_adjust{{
- -1,-1,-1,-1, 2, 4, 6, 8,
- -1,-1,-1,-1, 2, 4, 6, 8
- }};
- /* MSADPCM Adaption table */
- constexpr std::array<int,16> MSADPCMAdaption{{
- 230, 230, 230, 230, 307, 409, 512, 614,
- 768, 614, 512, 409, 307, 230, 230, 230
- }};
- /* MSADPCM Adaption Coefficient tables */
- constexpr std::array MSADPCMAdaptionCoeff{
- std::array{256, 0},
- std::array{512, -256},
- std::array{ 0, 0},
- std::array{192, 64},
- std::array{240, 0},
- std::array{460, -208},
- std::array{392, -232}
- };
- void SendSourceStoppedEvent(ContextBase *context, uint id)
- {
- RingBuffer *ring{context->mAsyncEvents.get()};
- auto evt_vec = ring->getWriteVector();
- if(evt_vec[0].len < 1) return;
- auto &evt = InitAsyncEvent<AsyncSourceStateEvent>(evt_vec[0].buf);
- evt.mId = id;
- evt.mState = AsyncSrcState::Stop;
- ring->writeAdvance(1);
- }
- al::span<const float> DoFilters(BiquadFilter &lpfilter, BiquadFilter &hpfilter,
- const al::span<float,BufferLineSize> dst, const al::span<const float> src, int type)
- {
- switch(type)
- {
- case AF_None:
- lpfilter.clear();
- hpfilter.clear();
- break;
- case AF_LowPass:
- lpfilter.process(src, dst);
- hpfilter.clear();
- return dst.first(src.size());
- case AF_HighPass:
- lpfilter.clear();
- hpfilter.process(src, dst);
- return dst.first(src.size());
- case AF_BandPass:
- DualBiquad{lpfilter, hpfilter}.process(src, dst);
- return dst.first(src.size());
- }
- return src;
- }
- template<FmtType Type>
- inline void LoadSamples(const al::span<float> dstSamples, const al::span<const std::byte> srcData,
- const size_t srcChan, const size_t srcOffset, const size_t srcStep,
- const size_t samplesPerBlock [[maybe_unused]]) noexcept
- {
- using TypeTraits = al::FmtTypeTraits<Type>;
- using SampleType = typename TypeTraits::Type;
- assert(srcChan < srcStep);
- auto converter = TypeTraits{};
- al::span<const SampleType> src{reinterpret_cast<const SampleType*>(srcData.data()),
- srcData.size()/sizeof(SampleType)};
- auto ssrc = src.cbegin() + ptrdiff_t(srcOffset*srcStep + srcChan);
- dstSamples.front() = converter(*ssrc);
- std::generate(dstSamples.begin()+1, dstSamples.end(), [&ssrc,srcStep,converter]
- {
- ssrc += ptrdiff_t(srcStep);
- return converter(*ssrc);
- });
- }
- template<>
- inline void LoadSamples<FmtIMA4>(al::span<float> dstSamples, al::span<const std::byte> src,
- const size_t srcChan, const size_t srcOffset, const size_t srcStep,
- const size_t samplesPerBlock) noexcept
- {
- static constexpr int MaxStepIndex{static_cast<int>(IMAStep_size.size()) - 1};
- assert(srcStep > 0 || srcStep <= 2);
- assert(srcChan < srcStep);
- assert(samplesPerBlock > 1);
- const size_t blockBytes{((samplesPerBlock-1)/2 + 4)*srcStep};
- /* Skip to the ADPCM block containing the srcOffset sample. */
- src = src.subspan(srcOffset/samplesPerBlock*blockBytes);
- /* Calculate how many samples need to be skipped in the block. */
- size_t skip{srcOffset % samplesPerBlock};
- /* NOTE: This could probably be optimized better. */
- auto dst = dstSamples.begin();
- while(dst != dstSamples.end())
- {
- /* Each IMA4 block starts with a signed 16-bit sample, and a signed(?)
- * 16-bit table index. The table index needs to be clamped.
- */
- auto prevSample = int(src[srcChan*4 + 0]) | (int(src[srcChan*4 + 1]) << 8);
- auto prevIndex = int(src[srcChan*4 + 2]) | (int(src[srcChan*4 + 3]) << 8);
- const auto nibbleData = src.subspan((srcStep+srcChan)*4);
- src = src.subspan(blockBytes);
- /* Sign-extend the 16-bit sample and index values. */
- prevSample = (prevSample^0x8000) - 32768;
- prevIndex = std::clamp((prevIndex^0x8000) - 32768, 0, MaxStepIndex);
- if(skip == 0)
- {
- *dst = static_cast<float>(prevSample) / 32768.0f;
- if(++dst == dstSamples.end()) return;
- }
- else
- --skip;
- /* The rest of the block is arranged as a series of nibbles, contained
- * in 4 *bytes* per channel interleaved. So every 8 nibbles we need to
- * skip 4 bytes per channel to get the next nibbles for this channel.
- */
- auto decode_nibble = [&prevSample,&prevIndex,srcStep,nibbleData](const size_t nibbleOffset)
- noexcept -> int
- {
- static constexpr auto NibbleMask = std::byte{0xf};
- const auto byteShift = (nibbleOffset&1) * 4;
- const auto wordOffset = (nibbleOffset>>1) & ~3_uz;
- const auto byteOffset = wordOffset*srcStep + ((nibbleOffset>>1)&3);
- const auto nibble = al::to_underlying((nibbleData[byteOffset]>>byteShift)&NibbleMask);
- prevSample += IMA4Codeword[nibble] * IMAStep_size[static_cast<uint>(prevIndex)] / 8;
- prevSample = std::clamp(prevSample, -32768, 32767);
- prevIndex += IMA4Index_adjust[nibble];
- prevIndex = std::clamp(prevIndex, 0, MaxStepIndex);
- return prevSample;
- };
- /* First, decode the samples that we need to skip in the block (will
- * always be less than the block size). They need to be decoded despite
- * being ignored for proper state on the remaining samples.
- */
- size_t nibbleOffset{0};
- const size_t startOffset{skip + 1};
- for(;skip;--skip)
- {
- std::ignore = decode_nibble(nibbleOffset);
- ++nibbleOffset;
- }
- /* Second, decode the rest of the block and write to the output, until
- * the end of the block or the end of output.
- */
- const auto todo = std::min(samplesPerBlock - startOffset,
- size_t(std::distance(dst, dstSamples.end())));
- dst = std::generate_n(dst, todo, [&]
- {
- const auto sample = decode_nibble(nibbleOffset);
- ++nibbleOffset;
- return static_cast<float>(sample) / 32768.0f;
- });
- }
- }
- template<>
- inline void LoadSamples<FmtMSADPCM>(al::span<float> dstSamples, al::span<const std::byte> src,
- const size_t srcChan, const size_t srcOffset, const size_t srcStep,
- const size_t samplesPerBlock) noexcept
- {
- assert(srcStep > 0 || srcStep <= 2);
- assert(srcChan < srcStep);
- assert(samplesPerBlock > 2);
- const size_t blockBytes{((samplesPerBlock-2)/2 + 7)*srcStep};
- src = src.subspan(srcOffset/samplesPerBlock*blockBytes);
- size_t skip{srcOffset % samplesPerBlock};
- auto dst = dstSamples.begin();
- while(dst != dstSamples.end())
- {
- /* Each MS ADPCM block starts with an 8-bit block predictor, used to
- * dictate how the two sample history values are mixed with the decoded
- * sample, and an initial signed 16-bit scaling value which scales the
- * nibble sample value. This is followed by the two initial 16-bit
- * sample history values.
- */
- const auto blockpred = std::min(uint8_t(src[srcChan]),
- uint8_t{MSADPCMAdaptionCoeff.size()-1});
- auto scale = int(src[srcStep + 2*srcChan + 0]) | (int(src[srcStep + 2*srcChan + 1]) << 8);
- auto sampleHistory = std::array{
- int(src[3*srcStep + 2*srcChan + 0]) | (int(src[3*srcStep + 2*srcChan + 1])<<8),
- int(src[5*srcStep + 2*srcChan + 0]) | (int(src[5*srcStep + 2*srcChan + 1])<<8)};
- const auto nibbleData = src.subspan(7*srcStep);
- src = src.subspan(blockBytes);
- const auto coeffs = al::span{MSADPCMAdaptionCoeff[blockpred]};
- scale = (scale^0x8000) - 32768;
- sampleHistory[0] = (sampleHistory[0]^0x8000) - 32768;
- sampleHistory[1] = (sampleHistory[1]^0x8000) - 32768;
- /* The second history sample is "older", so it's the first to be
- * written out.
- */
- if(skip == 0)
- {
- *dst = static_cast<float>(sampleHistory[1]) / 32768.0f;
- if(++dst == dstSamples.end()) return;
- *dst = static_cast<float>(sampleHistory[0]) / 32768.0f;
- if(++dst == dstSamples.end()) return;
- }
- else if(skip == 1)
- {
- --skip;
- *dst = static_cast<float>(sampleHistory[0]) / 32768.0f;
- if(++dst == dstSamples.end()) return;
- }
- else
- skip -= 2;
- /* The rest of the block is a series of nibbles, interleaved per-
- * channel.
- */
- auto decode_nibble = [&sampleHistory,&scale,coeffs,nibbleData](const size_t nibbleOffset)
- noexcept -> int
- {
- static constexpr auto NibbleMask = std::byte{0xf};
- const auto byteOffset = nibbleOffset>>1;
- const auto byteShift = ((nibbleOffset&1)^1) * 4;
- const auto nibble = al::to_underlying((nibbleData[byteOffset]>>byteShift)&NibbleMask);
- const auto pred = ((nibble^0x08) - 0x08) * scale;
- const auto diff = (sampleHistory[0]*coeffs[0] + sampleHistory[1]*coeffs[1]) / 256;
- const auto sample = std::clamp(pred + diff, -32768, 32767);
- sampleHistory[1] = sampleHistory[0];
- sampleHistory[0] = sample;
- scale = MSADPCMAdaption[nibble] * scale / 256;
- scale = std::max(16, scale);
- return sample;
- };
- /* First, skip samples. */
- const size_t startOffset{skip + 2};
- size_t nibbleOffset{srcChan};
- for(;skip;--skip)
- {
- std::ignore = decode_nibble(nibbleOffset);
- nibbleOffset += srcStep;
- }
- /* Now decode the rest of the block, until the end of the block or the
- * dst buffer is filled.
- */
- const auto todo = std::min(samplesPerBlock - startOffset,
- size_t(std::distance(dst, dstSamples.end())));
- dst = std::generate_n(dst, todo, [&]
- {
- const auto sample = decode_nibble(nibbleOffset);
- nibbleOffset += srcStep;
- return static_cast<float>(sample) / 32768.0f;
- });
- }
- }
- void LoadSamples(const al::span<float> dstSamples, const al::span<const std::byte> src,
- const size_t srcChan, const size_t srcOffset, const FmtType srcType, const size_t srcStep,
- const size_t samplesPerBlock) noexcept
- {
- #define HANDLE_FMT(T) case T: \
- LoadSamples<T>(dstSamples, src, srcChan, srcOffset, srcStep, \
- samplesPerBlock); \
- break
- switch(srcType)
- {
- HANDLE_FMT(FmtUByte);
- HANDLE_FMT(FmtShort);
- HANDLE_FMT(FmtInt);
- HANDLE_FMT(FmtFloat);
- HANDLE_FMT(FmtDouble);
- HANDLE_FMT(FmtMulaw);
- HANDLE_FMT(FmtAlaw);
- HANDLE_FMT(FmtIMA4);
- HANDLE_FMT(FmtMSADPCM);
- }
- #undef HANDLE_FMT
- }
- void LoadBufferStatic(VoiceBufferItem *buffer, VoiceBufferItem *bufferLoopItem,
- const size_t dataPosInt, const FmtType sampleType, const size_t srcChannel,
- const size_t srcStep, al::span<float> voiceSamples)
- {
- if(!bufferLoopItem)
- {
- float lastSample{0.0f};
- /* Load what's left to play from the buffer */
- if(buffer->mSampleLen > dataPosInt) LIKELY
- {
- const size_t buffer_remaining{buffer->mSampleLen - dataPosInt};
- const size_t remaining{std::min(voiceSamples.size(), buffer_remaining)};
- LoadSamples(voiceSamples.first(remaining), buffer->mSamples, srcChannel, dataPosInt,
- sampleType, srcStep, buffer->mBlockAlign);
- lastSample = voiceSamples[remaining-1];
- voiceSamples = voiceSamples.subspan(remaining);
- }
- if(const size_t toFill{voiceSamples.size()})
- std::fill_n(voiceSamples.begin(), toFill, lastSample);
- }
- else
- {
- const size_t loopStart{buffer->mLoopStart};
- const size_t loopEnd{buffer->mLoopEnd};
- ASSUME(loopEnd > loopStart);
- const size_t intPos{(dataPosInt < loopEnd) ? dataPosInt
- : (((dataPosInt-loopStart)%(loopEnd-loopStart)) + loopStart)};
- /* Load what's left of this loop iteration */
- const size_t remaining{std::min(voiceSamples.size(), loopEnd-dataPosInt)};
- LoadSamples(voiceSamples.first(remaining), buffer->mSamples, srcChannel, intPos,
- sampleType, srcStep, buffer->mBlockAlign);
- voiceSamples = voiceSamples.subspan(remaining);
- /* Load repeats of the loop to fill the buffer. */
- const size_t loopSize{loopEnd - loopStart};
- while(const size_t toFill{std::min(voiceSamples.size(), loopSize)})
- {
- LoadSamples(voiceSamples.first(toFill), buffer->mSamples, srcChannel, loopStart,
- sampleType, srcStep, buffer->mBlockAlign);
- voiceSamples = voiceSamples.subspan(toFill);
- }
- }
- }
- void LoadBufferCallback(VoiceBufferItem *buffer, const size_t dataPosInt,
- const size_t numCallbackSamples, const FmtType sampleType, const size_t srcChannel,
- const size_t srcStep, al::span<float> voiceSamples)
- {
- float lastSample{0.0f};
- if(numCallbackSamples > dataPosInt) LIKELY
- {
- const size_t remaining{std::min(voiceSamples.size(), numCallbackSamples-dataPosInt)};
- LoadSamples(voiceSamples.first(remaining), buffer->mSamples, srcChannel, dataPosInt,
- sampleType, srcStep, buffer->mBlockAlign);
- lastSample = voiceSamples[remaining-1];
- voiceSamples = voiceSamples.subspan(remaining);
- }
- if(const size_t toFill{voiceSamples.size()})
- std::fill_n(voiceSamples.begin(), toFill, lastSample);
- }
- void LoadBufferQueue(VoiceBufferItem *buffer, VoiceBufferItem *bufferLoopItem,
- size_t dataPosInt, const FmtType sampleType, const size_t srcChannel,
- const size_t srcStep, al::span<float> voiceSamples)
- {
- float lastSample{0.0f};
- /* Crawl the buffer queue to fill in the temp buffer */
- while(buffer && !voiceSamples.empty())
- {
- if(dataPosInt >= buffer->mSampleLen)
- {
- dataPosInt -= buffer->mSampleLen;
- buffer = buffer->mNext.load(std::memory_order_acquire);
- if(!buffer) buffer = bufferLoopItem;
- continue;
- }
- const size_t remaining{std::min(voiceSamples.size(), buffer->mSampleLen-dataPosInt)};
- LoadSamples(voiceSamples.first(remaining), buffer->mSamples, srcChannel, dataPosInt,
- sampleType, srcStep, buffer->mBlockAlign);
- lastSample = voiceSamples[remaining-1];
- voiceSamples = voiceSamples.subspan(remaining);
- if(voiceSamples.empty())
- break;
- dataPosInt = 0;
- buffer = buffer->mNext.load(std::memory_order_acquire);
- if(!buffer) buffer = bufferLoopItem;
- }
- if(const size_t toFill{voiceSamples.size()})
- std::fill_n(voiceSamples.begin(), toFill, lastSample);
- }
- void DoHrtfMix(const al::span<const float> samples, DirectParams &parms, const float TargetGain,
- const size_t Counter, size_t OutPos, const bool IsPlaying, DeviceBase *Device)
- {
- const uint IrSize{Device->mIrSize};
- const auto HrtfSamples = al::span{Device->ExtraSampleData};
- const auto AccumSamples = al::span{Device->HrtfAccumData};
- /* Copy the HRTF history and new input samples into a temp buffer. */
- auto src_iter = std::copy(parms.Hrtf.History.begin(), parms.Hrtf.History.end(),
- HrtfSamples.begin());
- std::copy_n(samples.begin(), samples.size(), src_iter);
- /* Copy the last used samples back into the history buffer for later. */
- if(IsPlaying) LIKELY
- {
- const auto endsamples = HrtfSamples.subspan(samples.size(), parms.Hrtf.History.size());
- std::copy_n(endsamples.cbegin(), endsamples.size(), parms.Hrtf.History.begin());
- }
- /* If fading and this is the first mixing pass, fade between the IRs. */
- size_t fademix{0};
- if(Counter && OutPos == 0)
- {
- fademix = std::min(samples.size(), Counter);
- float gain{TargetGain};
- /* The new coefficients need to fade in completely since they're
- * replacing the old ones. To keep the gain fading consistent,
- * interpolate between the old and new target gains given how much of
- * the fade time this mix handles.
- */
- if(Counter > fademix)
- {
- const float a{static_cast<float>(fademix) / static_cast<float>(Counter)};
- gain = lerpf(parms.Hrtf.Old.Gain, TargetGain, a);
- }
- MixHrtfFilter hrtfparams{
- parms.Hrtf.Target.Coeffs,
- parms.Hrtf.Target.Delay,
- 0.0f, gain / static_cast<float>(fademix)};
- MixHrtfBlendSamples(HrtfSamples, AccumSamples.subspan(OutPos), IrSize, &parms.Hrtf.Old,
- &hrtfparams, fademix);
- /* Update the old parameters with the result. */
- parms.Hrtf.Old = parms.Hrtf.Target;
- parms.Hrtf.Old.Gain = gain;
- OutPos += fademix;
- }
- if(fademix < samples.size())
- {
- const size_t todo{samples.size() - fademix};
- float gain{TargetGain};
- /* Interpolate the target gain if the gain fading lasts longer than
- * this mix.
- */
- if(Counter > samples.size())
- {
- const float a{static_cast<float>(todo) / static_cast<float>(Counter-fademix)};
- gain = lerpf(parms.Hrtf.Old.Gain, TargetGain, a);
- }
- MixHrtfFilter hrtfparams{
- parms.Hrtf.Target.Coeffs,
- parms.Hrtf.Target.Delay,
- parms.Hrtf.Old.Gain,
- (gain - parms.Hrtf.Old.Gain) / static_cast<float>(todo)};
- MixHrtfSamples(HrtfSamples.subspan(fademix), AccumSamples.subspan(OutPos), IrSize,
- &hrtfparams, todo);
- /* Store the now-current gain for next time. */
- parms.Hrtf.Old.Gain = gain;
- }
- }
- void DoNfcMix(const al::span<const float> samples, al::span<FloatBufferLine> OutBuffer,
- DirectParams &parms, const al::span<const float,MaxOutputChannels> OutGains,
- const uint Counter, const uint OutPos, DeviceBase *Device)
- {
- using FilterProc = void (NfcFilter::*)(const al::span<const float>, const al::span<float>);
- static constexpr std::array<FilterProc,MaxAmbiOrder+1> NfcProcess{{
- nullptr, &NfcFilter::process1, &NfcFilter::process2, &NfcFilter::process3}};
- MixSamples(samples, al::span{OutBuffer[0]}.subspan(OutPos), parms.Gains.Current[0],
- OutGains[0], Counter);
- OutBuffer = OutBuffer.subspan(1);
- auto CurrentGains = al::span{parms.Gains.Current}.subspan(1);
- auto TargetGains = OutGains.subspan(1);
- const auto nfcsamples = al::span{Device->ExtraSampleData}.first(samples.size());
- size_t order{1};
- while(const size_t chancount{Device->NumChannelsPerOrder[order]})
- {
- (parms.NFCtrlFilter.*NfcProcess[order])(samples, nfcsamples);
- MixSamples(nfcsamples, OutBuffer.first(chancount), CurrentGains, TargetGains, Counter,
- OutPos);
- if(++order == MaxAmbiOrder+1)
- break;
- OutBuffer = OutBuffer.subspan(chancount);
- CurrentGains = CurrentGains.subspan(chancount);
- TargetGains = TargetGains.subspan(chancount);
- }
- }
- } // namespace
- void Voice::mix(const State vstate, ContextBase *Context, const nanoseconds deviceTime,
- const uint SamplesToDo)
- {
- static constexpr std::array<float,MaxOutputChannels> SilentTarget{};
- ASSUME(SamplesToDo > 0);
- DeviceBase *Device{Context->mDevice};
- const uint NumSends{Device->NumAuxSends};
- /* Get voice info */
- int DataPosInt{mPosition.load(std::memory_order_relaxed)};
- uint DataPosFrac{mPositionFrac.load(std::memory_order_relaxed)};
- VoiceBufferItem *BufferListItem{mCurrentBuffer.load(std::memory_order_relaxed)};
- VoiceBufferItem *BufferLoopItem{mLoopBuffer.load(std::memory_order_relaxed)};
- const uint increment{mStep};
- if(increment < 1) UNLIKELY
- {
- /* If the voice is supposed to be stopping but can't be mixed, just
- * stop it before bailing.
- */
- if(vstate == Stopping)
- mPlayState.store(Stopped, std::memory_order_release);
- return;
- }
- /* If the static voice's current position is beyond the buffer loop end
- * position, disable looping.
- */
- if(mFlags.test(VoiceIsStatic) && BufferLoopItem)
- {
- if(DataPosInt >= 0 && static_cast<uint>(DataPosInt) >= BufferListItem->mLoopEnd)
- BufferLoopItem = nullptr;
- }
- uint OutPos{0u};
- /* Check if we're doing a delayed start, and we start in this update. */
- if(mStartTime > deviceTime) UNLIKELY
- {
- /* If the voice is supposed to be stopping but hasn't actually started
- * yet, make sure its stopped.
- */
- if(vstate == Stopping)
- {
- mPlayState.store(Stopped, std::memory_order_release);
- return;
- }
- /* If the start time is too far ahead, don't bother. */
- auto diff = mStartTime - deviceTime;
- if(diff >= seconds{1})
- return;
- /* Get the number of samples ahead of the current time that output
- * should start at. Skip this update if it's beyond the output sample
- * count.
- */
- OutPos = static_cast<uint>(round<seconds>(diff * Device->mSampleRate).count());
- if(OutPos >= SamplesToDo) return;
- }
- /* Calculate the number of samples to mix, and the number of (resampled)
- * samples that need to be loaded (mixing samples and decoder padding).
- */
- const uint samplesToMix{SamplesToDo - OutPos};
- const uint samplesToLoad{samplesToMix + mDecoderPadding};
- /* Get a span of pointers to hold the floating point, deinterlaced,
- * resampled buffer data to be mixed.
- */
- auto SamplePointers = std::array<float*,DeviceBase::MixerChannelsMax>{};
- const auto MixingSamples = al::span{SamplePointers}.first(mChans.size());
- {
- const uint channelStep{(samplesToLoad+3u)&~3u};
- auto base = Device->mSampleData.end() - MixingSamples.size()*channelStep;
- std::generate(MixingSamples.begin(), MixingSamples.end(), [&base,channelStep]
- {
- const auto ret = base;
- base += channelStep;
- return al::to_address(ret);
- });
- }
- /* UHJ2 and SuperStereo only have 2 buffer channels, but 3 mixing channels
- * (3rd channel is generated from decoding). MonoDup only has 1 buffer
- * channel, but 2 mixing channels (2nd channel is just duplicated).
- */
- const size_t realChannels{(mFmtChannels == FmtMonoDup) ? 1u
- : (mFmtChannels == FmtUHJ2 || mFmtChannels == FmtSuperStereo) ? 2u
- : MixingSamples.size()};
- for(size_t chan{0};chan < realChannels;++chan)
- {
- static constexpr uint ResBufSize{std::tuple_size_v<decltype(DeviceBase::mResampleData)>};
- static constexpr uint srcSizeMax{ResBufSize - MaxResamplerEdge};
- const al::span prevSamples{mPrevSamples[chan]};
- std::copy(prevSamples.cbegin(), prevSamples.cend(), Device->mResampleData.begin());
- const auto resampleBuffer = al::span{Device->mResampleData}.subspan<MaxResamplerEdge>();
- int intPos{DataPosInt};
- uint fracPos{DataPosFrac};
- /* Load samples for this channel from the available buffer(s), with
- * resampling.
- */
- for(uint samplesLoaded{0};samplesLoaded < samplesToLoad;)
- {
- /* Calculate the number of dst samples that can be loaded this
- * iteration, given the available resampler buffer size, and the
- * number of src samples that are needed to load it.
- */
- auto calc_buffer_sizes = [fracPos,increment](uint dstBufferSize)
- {
- /* If ext=true, calculate the last written dst pos from the dst
- * count, convert to the last read src pos, then add one to get
- * the src count.
- *
- * If ext=false, convert the dst count to src count directly.
- *
- * Without this, the src count could be short by one when
- * increment < 1.0, or not have a full src at the end when
- * increment > 1.0.
- */
- const bool ext{increment <= MixerFracOne};
- uint64_t dataSize64{dstBufferSize - ext};
- dataSize64 = (dataSize64*increment + fracPos) >> MixerFracBits;
- /* Also include resampler padding. */
- dataSize64 += ext + MaxResamplerEdge;
- if(dataSize64 <= srcSizeMax)
- return std::array{dstBufferSize, static_cast<uint>(dataSize64)};
- /* If the source size got saturated, we can't fill the desired
- * dst size. Figure out how many dst samples we can fill.
- */
- dataSize64 = srcSizeMax - MaxResamplerEdge;
- dataSize64 = ((dataSize64<<MixerFracBits) - fracPos) / increment;
- if(dataSize64 < dstBufferSize)
- {
- /* Some resamplers require the destination being 16-byte
- * aligned, so limit to a multiple of 4 samples to maintain
- * alignment if we need to do another iteration after this.
- */
- dstBufferSize = static_cast<uint>(dataSize64) & ~3u;
- }
- return std::array{dstBufferSize, srcSizeMax};
- };
- const auto [dstBufferSize, srcBufferSize] = calc_buffer_sizes(
- samplesToLoad - samplesLoaded);
- size_t srcSampleDelay{0};
- if(intPos < 0) UNLIKELY
- {
- /* If the current position is negative, there's that many
- * silent samples to load before using the buffer.
- */
- srcSampleDelay = static_cast<uint>(-intPos);
- if(srcSampleDelay >= srcBufferSize)
- {
- /* If the number of silent source samples exceeds the
- * number to load, the output will be silent.
- */
- std::fill_n(MixingSamples[chan]+samplesLoaded, dstBufferSize, 0.0f);
- std::fill_n(resampleBuffer.begin(), srcBufferSize, 0.0f);
- goto skip_resample;
- }
- std::fill_n(resampleBuffer.begin(), srcSampleDelay, 0.0f);
- }
- /* Load the necessary samples from the given buffer(s). */
- if(!BufferListItem) UNLIKELY
- {
- const uint avail{std::min(srcBufferSize, MaxResamplerEdge)};
- const uint tofill{std::max(srcBufferSize, MaxResamplerEdge)};
- const auto srcbuf = resampleBuffer.first(tofill);
- /* When loading from a voice that ended prematurely, only take
- * the samples that get closest to 0 amplitude. This helps
- * certain sounds fade out better.
- */
- auto srciter = std::min_element(srcbuf.begin(), srcbuf.begin()+ptrdiff_t(avail),
- [](const float l, const float r) { return std::abs(l) < std::abs(r); });
- std::fill(srciter+1, srcbuf.end(), *srciter);
- }
- else if(mFlags.test(VoiceIsStatic))
- {
- const auto uintPos = static_cast<uint>(std::max(intPos, 0));
- const auto bufferSamples = resampleBuffer.subspan(srcSampleDelay,
- srcBufferSize-srcSampleDelay);
- LoadBufferStatic(BufferListItem, BufferLoopItem, uintPos, mFmtType, chan,
- mFrameStep, bufferSamples);
- }
- else if(mFlags.test(VoiceIsCallback))
- {
- const auto uintPos = static_cast<uint>(std::max(intPos, 0));
- const uint callbackBase{mCallbackBlockBase * mSamplesPerBlock};
- const size_t bufferOffset{uintPos - callbackBase};
- const size_t needSamples{bufferOffset + srcBufferSize - srcSampleDelay};
- const size_t needBlocks{(needSamples + mSamplesPerBlock-1) / mSamplesPerBlock};
- if(!mFlags.test(VoiceCallbackStopped) && needBlocks > mNumCallbackBlocks)
- {
- const size_t byteOffset{mNumCallbackBlocks*size_t{mBytesPerBlock}};
- const size_t needBytes{(needBlocks-mNumCallbackBlocks)*size_t{mBytesPerBlock}};
- const int gotBytes{BufferListItem->mCallback(BufferListItem->mUserData,
- &BufferListItem->mSamples[byteOffset], static_cast<int>(needBytes))};
- if(gotBytes < 0)
- mFlags.set(VoiceCallbackStopped);
- else if(static_cast<uint>(gotBytes) < needBytes)
- {
- mFlags.set(VoiceCallbackStopped);
- mNumCallbackBlocks += static_cast<uint>(gotBytes) / mBytesPerBlock;
- }
- else
- mNumCallbackBlocks = static_cast<uint>(needBlocks);
- }
- const size_t numSamples{size_t{mNumCallbackBlocks} * mSamplesPerBlock};
- const auto bufferSamples = resampleBuffer.subspan(srcSampleDelay,
- srcBufferSize-srcSampleDelay);
- LoadBufferCallback(BufferListItem, bufferOffset, numSamples, mFmtType, chan,
- mFrameStep, bufferSamples);
- }
- else
- {
- const auto uintPos = static_cast<uint>(std::max(intPos, 0));
- const auto bufferSamples = resampleBuffer.subspan(srcSampleDelay,
- srcBufferSize-srcSampleDelay);
- LoadBufferQueue(BufferListItem, BufferLoopItem, uintPos, mFmtType, chan,
- mFrameStep, bufferSamples);
- }
- /* If there's a matching sample step and no phase offset, use a
- * simple copy for resampling.
- */
- if(increment == MixerFracOne && fracPos == 0)
- std::copy_n(resampleBuffer.cbegin(), dstBufferSize,
- MixingSamples[chan]+samplesLoaded);
- else
- mResampler(&mResampleState, Device->mResampleData, fracPos, increment,
- {MixingSamples[chan]+samplesLoaded, dstBufferSize});
- /* Store the last source samples used for next time. */
- if(vstate == Playing) LIKELY
- {
- /* Only store samples for the end of the mix, excluding what
- * gets loaded for decoder padding.
- */
- const uint loadEnd{samplesLoaded + dstBufferSize};
- if(samplesToMix > samplesLoaded && samplesToMix <= loadEnd) LIKELY
- {
- const size_t dstOffset{samplesToMix - samplesLoaded};
- const size_t srcOffset{(dstOffset*increment + fracPos) >> MixerFracBits};
- std::copy_n(Device->mResampleData.cbegin()+srcOffset, prevSamples.size(),
- prevSamples.begin());
- }
- }
- skip_resample:
- samplesLoaded += dstBufferSize;
- if(samplesLoaded < samplesToLoad)
- {
- fracPos += dstBufferSize*increment;
- const uint srcOffset{fracPos >> MixerFracBits};
- fracPos &= MixerFracMask;
- intPos += static_cast<int>(srcOffset);
- /* If more samples need to be loaded, copy the back of the
- * resampleBuffer to the front to reuse it. prevSamples isn't
- * reliable since it's only updated for the end of the mix.
- */
- std::copy_n(Device->mResampleData.cbegin()+srcOffset, MaxResamplerPadding,
- Device->mResampleData.begin());
- }
- }
- }
- if(mFmtChannels == FmtMonoDup)
- {
- /* NOTE: a mono source shouldn't have a decoder or the VoiceIsAmbisonic
- * flag, so aliasing instead of copying to the second channel shouldn't
- * be a problem.
- */
- MixingSamples[1] = MixingSamples[0];
- }
- else for(auto &samples : MixingSamples.subspan(realChannels))
- std::fill_n(samples, samplesToLoad, 0.0f);
- if(mDecoder)
- mDecoder->decode(MixingSamples, samplesToMix, (vstate==Playing));
- if(mFlags.test(VoiceIsAmbisonic))
- {
- auto voiceSamples = MixingSamples.begin();
- for(auto &chandata : mChans)
- {
- chandata.mAmbiSplitter.processScale({*voiceSamples, samplesToMix},
- chandata.mAmbiHFScale, chandata.mAmbiLFScale);
- ++voiceSamples;
- }
- }
- const uint Counter{mFlags.test(VoiceIsFading) ? std::min(samplesToMix, 64u) : 0u};
- if(!Counter)
- {
- /* No fading, just overwrite the old/current params. */
- for(auto &chandata : mChans)
- {
- {
- DirectParams &parms = chandata.mDryParams;
- if(!mFlags.test(VoiceHasHrtf))
- parms.Gains.Current = parms.Gains.Target;
- else
- parms.Hrtf.Old = parms.Hrtf.Target;
- }
- for(uint send{0};send < NumSends;++send)
- {
- if(mSend[send].Buffer.empty())
- continue;
- SendParams &parms = chandata.mWetParams[send];
- parms.Gains.Current = parms.Gains.Target;
- }
- }
- }
- auto voiceSamples = MixingSamples.begin();
- for(auto &chandata : mChans)
- {
- /* Now filter and mix to the appropriate outputs. */
- const al::span<float,BufferLineSize> FilterBuf{Device->FilteredData};
- {
- DirectParams &parms = chandata.mDryParams;
- const auto samples = DoFilters(parms.LowPass, parms.HighPass, FilterBuf,
- {*voiceSamples, samplesToMix}, mDirect.FilterType);
- if(mFlags.test(VoiceHasHrtf))
- {
- const float TargetGain{parms.Hrtf.Target.Gain * float(vstate == Playing)};
- DoHrtfMix(samples, parms, TargetGain, Counter, OutPos, (vstate == Playing),
- Device);
- }
- else
- {
- const auto TargetGains = (vstate == Playing) ? al::span{parms.Gains.Target}
- : al::span{SilentTarget};
- if(mFlags.test(VoiceHasNfc))
- DoNfcMix(samples, mDirect.Buffer, parms, TargetGains, Counter, OutPos, Device);
- else
- MixSamples(samples, mDirect.Buffer, parms.Gains.Current, TargetGains, Counter,
- OutPos);
- }
- }
- for(uint send{0};send < NumSends;++send)
- {
- if(mSend[send].Buffer.empty())
- continue;
- SendParams &parms = chandata.mWetParams[send];
- const auto samples = DoFilters(parms.LowPass, parms.HighPass, FilterBuf,
- {*voiceSamples, samplesToMix}, mSend[send].FilterType);
- const auto TargetGains = (vstate == Playing) ? al::span{parms.Gains.Target}
- : al::span{SilentTarget};
- MixSamples(samples, mSend[send].Buffer, parms.Gains.Current, TargetGains, Counter,
- OutPos);
- }
- ++voiceSamples;
- }
- mFlags.set(VoiceIsFading);
- /* Don't update positions and buffers if we were stopping. */
- if(vstate == Stopping) UNLIKELY
- {
- mPlayState.store(Stopped, std::memory_order_release);
- return;
- }
- /* Update voice positions and buffers as needed. */
- DataPosFrac += increment*samplesToMix;
- DataPosInt += static_cast<int>(DataPosFrac>>MixerFracBits);
- DataPosFrac &= MixerFracMask;
- uint buffers_done{0u};
- if(BufferListItem && DataPosInt > 0) LIKELY
- {
- if(mFlags.test(VoiceIsStatic))
- {
- if(BufferLoopItem)
- {
- /* Handle looping static source */
- const uint LoopStart{BufferListItem->mLoopStart};
- const uint LoopEnd{BufferListItem->mLoopEnd};
- uint DataPosUInt{static_cast<uint>(DataPosInt)};
- if(DataPosUInt >= LoopEnd)
- {
- assert(LoopEnd > LoopStart);
- DataPosUInt = ((DataPosUInt-LoopStart)%(LoopEnd-LoopStart)) + LoopStart;
- DataPosInt = static_cast<int>(DataPosUInt);
- }
- }
- else
- {
- /* Handle non-looping static source */
- if(static_cast<uint>(DataPosInt) >= BufferListItem->mSampleLen)
- BufferListItem = nullptr;
- }
- }
- else if(mFlags.test(VoiceIsCallback))
- {
- /* Handle callback buffer source */
- const uint currentBlock{static_cast<uint>(DataPosInt) / mSamplesPerBlock};
- const uint blocksDone{currentBlock - mCallbackBlockBase};
- if(blocksDone < mNumCallbackBlocks)
- {
- const size_t byteOffset{blocksDone*size_t{mBytesPerBlock}};
- const size_t byteEnd{mNumCallbackBlocks*size_t{mBytesPerBlock}};
- const al::span data{BufferListItem->mSamples};
- std::copy(data.cbegin()+ptrdiff_t(byteOffset), data.cbegin()+ptrdiff_t(byteEnd),
- data.begin());
- mNumCallbackBlocks -= blocksDone;
- mCallbackBlockBase += blocksDone;
- }
- else
- {
- BufferListItem = nullptr;
- mNumCallbackBlocks = 0;
- mCallbackBlockBase += blocksDone;
- }
- }
- else
- {
- /* Handle streaming source */
- do {
- if(BufferListItem->mSampleLen > static_cast<uint>(DataPosInt))
- break;
- DataPosInt -= static_cast<int>(BufferListItem->mSampleLen);
- ++buffers_done;
- BufferListItem = BufferListItem->mNext.load(std::memory_order_relaxed);
- if(!BufferListItem) BufferListItem = BufferLoopItem;
- } while(BufferListItem);
- }
- }
- /* Capture the source ID in case it gets reset for stopping. */
- const uint SourceID{mSourceID.load(std::memory_order_relaxed)};
- /* Update voice info */
- mPosition.store(DataPosInt, std::memory_order_relaxed);
- mPositionFrac.store(DataPosFrac, std::memory_order_relaxed);
- mCurrentBuffer.store(BufferListItem, std::memory_order_relaxed);
- if(!BufferListItem)
- {
- mLoopBuffer.store(nullptr, std::memory_order_relaxed);
- mSourceID.store(0u, std::memory_order_relaxed);
- }
- std::atomic_thread_fence(std::memory_order_release);
- /* Send any events now, after the position/buffer info was updated. */
- const auto enabledevt = Context->mEnabledEvts.load(std::memory_order_acquire);
- if(buffers_done > 0 && enabledevt.test(al::to_underlying(AsyncEnableBits::BufferCompleted)))
- {
- RingBuffer *ring{Context->mAsyncEvents.get()};
- auto evt_vec = ring->getWriteVector();
- if(evt_vec[0].len > 0)
- {
- auto &evt = InitAsyncEvent<AsyncBufferCompleteEvent>(evt_vec[0].buf);
- evt.mId = SourceID;
- evt.mCount = buffers_done;
- ring->writeAdvance(1);
- }
- }
- if(!BufferListItem)
- {
- /* If the voice just ended, set it to Stopping so the next render
- * ensures any residual noise fades to 0 amplitude.
- */
- mPlayState.store(Stopping, std::memory_order_release);
- if(enabledevt.test(al::to_underlying(AsyncEnableBits::SourceState)))
- SendSourceStoppedEvent(Context, SourceID);
- }
- }
- void Voice::prepare(DeviceBase *device)
- {
- /* Even if storing really high order ambisonics, we only mix channels for
- * orders up to the device order. The rest are simply dropped.
- */
- uint num_channels{(mFmtChannels == FmtMonoDup) ? 2
- : (mFmtChannels == FmtUHJ2 || mFmtChannels == FmtSuperStereo) ? 3
- : ChannelsFromFmt(mFmtChannels, std::min(mAmbiOrder, device->mAmbiOrder))};
- if(num_channels > device->MixerChannelsMax) UNLIKELY
- {
- ERR("Unexpected channel count: {} (limit: {}, {} : {})", num_channels,
- device->MixerChannelsMax, NameFromFormat(mFmtChannels), mAmbiOrder);
- num_channels = device->MixerChannelsMax;
- }
- if(mChans.capacity() > 2 && num_channels < mChans.capacity())
- {
- decltype(mChans){}.swap(mChans);
- decltype(mPrevSamples){}.swap(mPrevSamples);
- }
- mChans.reserve(std::max(2u, num_channels));
- mChans.resize(num_channels);
- mPrevSamples.reserve(std::max(2u, num_channels));
- mPrevSamples.resize(num_channels);
- mDecoder = nullptr;
- mDecoderPadding = 0;
- if(mFmtChannels == FmtSuperStereo)
- {
- switch(UhjDecodeQuality)
- {
- case UhjQualityType::IIR:
- mDecoder = std::make_unique<UhjStereoDecoderIIR>();
- mDecoderPadding = UhjStereoDecoderIIR::sInputPadding;
- break;
- case UhjQualityType::FIR256:
- mDecoder = std::make_unique<UhjStereoDecoder<UhjLength256>>();
- mDecoderPadding = UhjStereoDecoder<UhjLength256>::sInputPadding;
- break;
- case UhjQualityType::FIR512:
- mDecoder = std::make_unique<UhjStereoDecoder<UhjLength512>>();
- mDecoderPadding = UhjStereoDecoder<UhjLength512>::sInputPadding;
- break;
- }
- }
- else if(IsUHJ(mFmtChannels))
- {
- switch(UhjDecodeQuality)
- {
- case UhjQualityType::IIR:
- mDecoder = std::make_unique<UhjDecoderIIR>();
- mDecoderPadding = UhjDecoderIIR::sInputPadding;
- break;
- case UhjQualityType::FIR256:
- mDecoder = std::make_unique<UhjDecoder<UhjLength256>>();
- mDecoderPadding = UhjDecoder<UhjLength256>::sInputPadding;
- break;
- case UhjQualityType::FIR512:
- mDecoder = std::make_unique<UhjDecoder<UhjLength512>>();
- mDecoderPadding = UhjDecoder<UhjLength512>::sInputPadding;
- break;
- }
- }
- /* Clear the stepping value explicitly so the mixer knows not to mix this
- * until the update gets applied.
- */
- mStep = 0;
- /* Make sure the sample history is cleared. */
- std::fill(mPrevSamples.begin(), mPrevSamples.end(), HistoryLine{});
- if(mFmtChannels == FmtUHJ2 && !device->mUhjEncoder)
- {
- /* 2-channel UHJ needs different shelf filters. However, we can't just
- * use different shelf filters after mixing it, given any old speaker
- * setup the user has. To make this work, we apply the expected shelf
- * filters for decoding UHJ2 to quad (only needs LF scaling), and act
- * as if those 4 quad channels are encoded right back into B-Format.
- *
- * This isn't perfect, but without an entirely separate and limited
- * UHJ2 path, it's better than nothing.
- *
- * Note this isn't needed with UHJ output (UHJ2->B-Format->UHJ2 is
- * identity, so don't mess with it).
- */
- const BandSplitter splitter{device->mXOverFreq / static_cast<float>(device->mSampleRate)};
- for(auto &chandata : mChans)
- {
- chandata.mAmbiHFScale = 1.0f;
- chandata.mAmbiLFScale = 1.0f;
- chandata.mAmbiSplitter = splitter;
- chandata.mDryParams = DirectParams{};
- chandata.mDryParams.NFCtrlFilter = device->mNFCtrlFilter;
- std::fill_n(chandata.mWetParams.begin(), device->NumAuxSends, SendParams{});
- }
- mChans[0].mAmbiLFScale = DecoderBase::sWLFScale;
- mChans[1].mAmbiLFScale = DecoderBase::sXYLFScale;
- mChans[2].mAmbiLFScale = DecoderBase::sXYLFScale;
- mFlags.set(VoiceIsAmbisonic);
- }
- /* Don't need to set the VoiceIsAmbisonic flag if the device is not higher
- * order than the voice. No HF scaling is necessary to mix it.
- */
- else if(mAmbiOrder && device->mAmbiOrder > mAmbiOrder)
- {
- auto OrdersSpan = Is2DAmbisonic(mFmtChannels)
- ? al::span<const uint8_t>{AmbiIndex::OrderFrom2DChannel}
- : al::span<const uint8_t>{AmbiIndex::OrderFromChannel};
- auto OrderFromChan = OrdersSpan.cbegin();
- const auto scales = AmbiScale::GetHFOrderScales(mAmbiOrder, device->mAmbiOrder,
- device->m2DMixing);
- const BandSplitter splitter{device->mXOverFreq / static_cast<float>(device->mSampleRate)};
- for(auto &chandata : mChans)
- {
- chandata.mAmbiHFScale = scales[*(OrderFromChan++)];
- chandata.mAmbiLFScale = 1.0f;
- chandata.mAmbiSplitter = splitter;
- chandata.mDryParams = DirectParams{};
- chandata.mDryParams.NFCtrlFilter = device->mNFCtrlFilter;
- std::fill_n(chandata.mWetParams.begin(), device->NumAuxSends, SendParams{});
- }
- mFlags.set(VoiceIsAmbisonic);
- }
- else
- {
- for(auto &chandata : mChans)
- {
- chandata.mDryParams = DirectParams{};
- chandata.mDryParams.NFCtrlFilter = device->mNFCtrlFilter;
- std::fill_n(chandata.mWetParams.begin(), device->NumAuxSends, SendParams{});
- }
- mFlags.reset(VoiceIsAmbisonic);
- }
- }
|