QuanTAlib/lib/trends_IIR/vidya/Vidya.cs

using System.Runtime.CompilerServices;
using System.Runtime.InteropServices;

namespace QuanTAlib;

/// <summary>
/// VIDYA: Variable Index Dynamic Average
/// </summary>
/// <remarks>
/// Tushar Chande's adaptive MA using CMO as volatility index to modulate smoothing.
/// Flat in choppy markets, responsive in trending conditions.
///
/// Calculation: <c>VI = |CMO|; α' = α×VI; VIDYA = α'×P + (1-α')×VIDYA_{t-1}</c>.
/// </remarks>
/// <seealso href="Vidya.md">Detailed documentation</seealso>
/// <seealso href="vidya.pine">Reference Pine Script implementation</seealso>
[SkipLocalsInit]
public sealed class Vidya : AbstractBase
{
    private readonly int _period;
    private readonly double _alpha;
    private readonly RingBuffer _ups;
    private readonly RingBuffer _downs;
    private readonly ITValuePublisher? _source;
    private readonly TValuePublishedHandler? _pubHandler;
    private bool _isNew = true;
    private bool _disposed;

    [StructLayout(LayoutKind.Auto)]
    private record struct State(
        double PrevClose, double LastVidya,
        double CurrentClose, double CurrentVidya,
        bool IsInitialized, int BarCount
    );
    private State _state;
    private State _p_state;

    public Vidya(int period)
    {
        if (period <= 0)
        {
            throw new ArgumentException("Period must be greater than 0", nameof(period));
        }

        _period = period;
        _alpha = 2.0 / (period + 1);
        _ups = new RingBuffer(period);
        _downs = new RingBuffer(period);
        Name = $"Vidya({period})";
        WarmupPeriod = period;
        InitState();
    }

    public Vidya(ITValuePublisher source, int period) : this(period)
    {
        _source = source;
        _pubHandler = Handle;
        source.Pub += _pubHandler;
    }

    protected override void Dispose(bool disposing)
    {
        if (!_disposed)
        {
            if (disposing && _source != null && _pubHandler != null)
            {
                _source.Pub -= _pubHandler;
            }
            _disposed = true;
        }
        base.Dispose(disposing);
    }

    private void Handle(object? sender, in TValueEventArgs e) => Update(e.Value, e.IsNew);

    public bool IsNew => _isNew;
    public override bool IsHot => _state.BarCount >= _period;

    [MethodImpl(MethodImplOptions.AggressiveInlining)]
    public override TValue Update(TValue input, bool isNew = true)
    {
        _isNew = isNew;
        if (isNew)
        {
            _state.BarCount++;
            if (_state.IsInitialized)
            {
                _state.PrevClose = _state.CurrentClose;
                _state.LastVidya = _state.CurrentVidya;
            }
            _p_state = _state;
        }
        else
        {
            _state = _p_state;
        }

        double price = input.Value;
        if (!double.IsFinite(price))
        {
            if (!_state.IsInitialized)
            {
                return input;
            }

            price = _state.CurrentClose;
        }

        if (_state.BarCount <= 1)
        {
            _state.PrevClose = price;
            _state.LastVidya = price;
            _state.CurrentClose = price;
            _state.CurrentVidya = price;
            _state.IsInitialized = true;
            _ups.Add(0, isNew);
            _downs.Add(0, isNew);
            Last = new TValue(input.Time, _state.CurrentVidya);
            PubEvent(Last);
            return Last;
        }

        double change = price - _state.PrevClose;
        double up = change > 0 ? change : 0;
        double down = change < 0 ? -change : 0;

        _ups.Add(up, isNew);
        _downs.Add(down, isNew);

        double sumUp = _ups.Sum;
        double sumDown = _downs.Sum;
        double sum = sumUp + sumDown;

        double vi = 0;
        if (sum > double.Epsilon)
        {
            vi = Math.Abs(sumUp - sumDown) / sum;
        }

        double dynamicAlpha = _alpha * vi;
        double dynamicDecay = 1.0 - dynamicAlpha;
        _state.CurrentVidya = Math.FusedMultiplyAdd(_state.LastVidya, dynamicDecay, dynamicAlpha * price);
        _state.CurrentClose = price;

        Last = new TValue(input.Time, _state.CurrentVidya);
        PubEvent(Last);
        return Last;
    }

    public override TSeries Update(TSeries source)
    {
        if (source.Count == 0)
        {
            return [];
        }

        int len = source.Count;
        var t = new List<long>(len);
        var v = new List<double>(len);
        CollectionsMarshal.SetCount(t, len);
        CollectionsMarshal.SetCount(v, len);

        var tSpan = CollectionsMarshal.AsSpan(t);
        var vSpan = CollectionsMarshal.AsSpan(v);

        Batch(source.Values, vSpan, _period);
        source.Times.CopyTo(tSpan);

        // Replay only the last _period bars to restore internal state
        Reset();
        int start = 0;
        if (len > 2 * _period)
        {
            start = len - _period;
            _state.BarCount = start;
            _state.IsInitialized = true;
            _state.PrevClose = source.Values[start - 1];
            _state.LastVidya = vSpan[start - 1];
            _state.CurrentClose = _state.PrevClose;
            _state.CurrentVidya = _state.LastVidya;

            // Pre-fill buffers with the previous period's data to ensure correct VI calculation
            for (int i = start - _period; i < start; i++)
            {
                double price = source.Values[i];
                double prev = source.Values[i - 1];
                double change = price - prev;
                double up = change > 0 ? change : 0;
                double down = change < 0 ? -change : 0;
                _ups.Add(up);
                _downs.Add(down);
            }
        }

        for (int i = start; i < len; i++)
        {
            Update(new TValue(source.Times[i], source.Values[i]));
        }

        return new TSeries(t, v);
    }

    public override void Prime(ReadOnlySpan<double> source, TimeSpan? step = null)
    {
        if (source.Length == 0)
        {
            return;
        }

        // Reset state
        Reset();

        // Process all data to build up state
        // For recursive indicators like VIDYA, we generally need to process from the start
        // or at least a significant warmup period.
        // Given we don't know the "correct" previous VIDYA without processing,
        // we process the whole provided history.

        double prevClose = source[0];
        double lastVidya = source[0];

        // Initialize state
        _state.PrevClose = prevClose;
        _state.LastVidya = lastVidya;
        _state.CurrentClose = prevClose;
        _state.CurrentVidya = lastVidya;
        _state.IsInitialized = true;
        _state.BarCount = 1;
        _ups.Add(0);
        _downs.Add(0);

        for (int i = 1; i < source.Length; i++)
        {
            double price = source[i];
            if (!double.IsFinite(price))
            {
                price = prevClose;
            }

            double change = price - prevClose;
            double up = change > 0 ? change : 0;
            double down = change < 0 ? -change : 0;

            _ups.Add(up);
            _downs.Add(down);
            _state.BarCount++;

            double sumUp = _ups.Sum;
            double sumDown = _downs.Sum;
            double sum = sumUp + sumDown;

            double vi = 0;
            if (sum > double.Epsilon)
            {
                vi = Math.Abs(sumUp - sumDown) / sum;
            }

            double dynamicAlpha = _alpha * vi;
            double dynamicDecay = 1.0 - dynamicAlpha;
            double currentVidya = Math.FusedMultiplyAdd(lastVidya, dynamicDecay, dynamicAlpha * price);

            _state.CurrentVidya = currentVidya;
            _state.CurrentClose = price;

            prevClose = price;
            lastVidya = currentVidya;
        }

        _state.PrevClose = prevClose;
        _state.LastVidya = lastVidya;

        // Set Last
        // Note: Time is not available in Span, so we use MinValue.
        // It will be updated on next Update.
        Last = new TValue(DateTime.MinValue, _state.CurrentVidya);
        _p_state = _state;
    }

    public override void Reset()
    {
        _ups.Clear();
        _downs.Clear();
        InitState();
        _p_state = _state;
        Last = default;
    }

    private void InitState()
    {
        _state = new State(
            PrevClose: double.NaN,
            LastVidya: double.NaN,
            CurrentClose: double.NaN,
            CurrentVidya: double.NaN,
            IsInitialized: false,
            BarCount: 0
        );
    }

    public static TSeries Batch(TSeries source, int period)
    {
        var vidya = new Vidya(period);
        return vidya.Update(source);
    }

    public static void Batch(ReadOnlySpan<double> source, Span<double> output, int period)
    {
        if (period <= 0)
        {
            throw new ArgumentException("Period must be greater than 0", nameof(period));
        }

        if (source.Length != output.Length)
        {
            throw new ArgumentException("Source and output must have the same length", nameof(output));
        }

        if (source.Length == 0)
        {
            return;
        }

        double alpha = 2.0 / (period + 1);

        // Use arrays for buffers to avoid heap allocations if possible,
        // but period is dynamic.
        // We can use ArrayPool or just new double[period] if period is small.
        // For simplicity and safety with large periods, let's use ArrayPool.

        double[] ups = System.Buffers.ArrayPool<double>.Shared.Rent(period);
        double[] downs = System.Buffers.ArrayPool<double>.Shared.Rent(period);
        Array.Clear(ups, 0, period);
        Array.Clear(downs, 0, period);

        try
        {
            int head = 0;
            double sumUp = 0;
            double sumDown = 0;

            double prevClose = source[0];
            double lastVidya = source[0];

            output[0] = source[0];

            for (int i = 1; i < source.Length; i++)
            {
                double price = source[i];
                if (!double.IsFinite(price))
                {
                    price = prevClose;
                }

                double change = price - prevClose;
                double up = change > 0 ? change : 0;
                double down = change < 0 ? -change : 0;

                sumUp -= ups[head];
                sumDown -= downs[head];

                ups[head] = up;
                downs[head] = down;

                sumUp += up;
                sumDown += down;

                head++;
                if (head >= period)
                {
                    head = 0;
                }

                double sum = sumUp + sumDown;
                double vi = 0;
                if (sum > double.Epsilon)
                {
                    vi = Math.Abs(sumUp - sumDown) / sum;
                }

                double dynamicAlpha = alpha * vi;
                double dynamicDecay = 1.0 - dynamicAlpha;
                double currentVidya = Math.FusedMultiplyAdd(lastVidya, dynamicDecay, dynamicAlpha * price);

                output[i] = currentVidya;

                prevClose = price;
                lastVidya = currentVidya;
            }
        }
        finally
        {
            System.Buffers.ArrayPool<double>.Shared.Return(ups);
            System.Buffers.ArrayPool<double>.Shared.Return(downs);
        }
    }

    public static (TSeries Results, Vidya Indicator) Calculate(TSeries source, int period)
    {
        var indicator = new Vidya(period);
        TSeries results = indicator.Update(source);
        return (results, indicator);
    }
}