src/Ryujinx.Audio/Renderer/Dsp/Effect/DelayLineReverb3d.cs


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76

using System.Diagnostics;

namespace Ryujinx.Audio.Renderer.Dsp.Effect
{
    public class DelayLine3d : IDelayLine
    {
        private float[] _workBuffer;
        private uint _sampleRate;
        private uint _currentSampleIndex;
        private uint _lastSampleIndex;

        public uint CurrentSampleCount { get; private set; }
        public uint SampleCountMax { get; private set; }

        public DelayLine3d(uint sampleRate, float delayTimeMax)
        {
            _sampleRate = sampleRate;
            SampleCountMax = IDelayLine.GetSampleCount(_sampleRate, delayTimeMax);
            _workBuffer = new float[SampleCountMax + 1];

            SetDelay(delayTimeMax);
        }

        private void ConfigureDelay(uint targetSampleCount)
        {
            if (SampleCountMax >= targetSampleCount)
            {
                CurrentSampleCount = targetSampleCount;
                _lastSampleIndex = (_currentSampleIndex + targetSampleCount) % (SampleCountMax + 1);
            }
        }

        public void SetDelay(float delayTime)
        {
            ConfigureDelay(IDelayLine.GetSampleCount(_sampleRate, delayTime));
        }

        public float Read()
        {
            return _workBuffer[_currentSampleIndex];
        }

        public float Update(float value)
        {
            Debug.Assert(!float.IsNaN(value) && !float.IsInfinity(value));

            _workBuffer[_lastSampleIndex++] = value;

            float output = Read();

            _currentSampleIndex++;

            if (_currentSampleIndex >= SampleCountMax)
            {
                _currentSampleIndex = 0;
            }

            if (_lastSampleIndex >= SampleCountMax)
            {
                _lastSampleIndex = 0;
            }

            return output;
        }

        public float TapUnsafe(uint sampleIndex, int offset)
        {
            return IDelayLine.Tap(_workBuffer, (int)_lastSampleIndex, (int)sampleIndex + offset, (int)SampleCountMax + 1);
        }

        public float Tap(uint sampleIndex)
        {
            return TapUnsafe(sampleIndex, -1);
        }
    }
}