QuanTAlib/lib/reversals/pivotwood/Pivotwood.cs

// PIVOTWOOD: Woodie's Pivot Points
// Calculates 7 support/resistance levels from previous bar's HLC with close weighted 2×.
// Woodie's formula weights the closing price twice, biasing the pivot toward recent action.

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

namespace QuanTAlib;

/// <summary>
/// PIVOTWOOD: Woodie's Pivot Points
/// </summary>
/// <remarks>
/// Computes 7 horizontal support/resistance levels from the previous bar's
/// high, low, and close. Unlike classic pivots where PP = (H+L+C)/3,
/// Woodie's formula weights the close price twice: PP = (H+L+2C)/4.
/// This biases the pivot toward the most recent closing price, giving
/// more weight to where the market settled.
///
/// Calculation (using previous bar's H, L, C):
/// <code>
/// PP = (H + L + 2*C) / 4          (weighted close)
/// R1 = 2*PP - L                    S1 = 2*PP - H
/// R2 = PP + (H - L)                S2 = PP - (H - L)
/// R3 = H + 2*(PP - L)              S3 = L - 2*(H - PP)
/// </code>
///
/// <b>Key characteristics:</b>
/// - O(1) computation: pure arithmetic from previous bar's HLC
/// - 7 outputs: PP, R1, R2, R3, S1, S2, S3
/// - WarmupPeriod = 2 (need previous bar's HLC)
/// - No configurable parameters
/// - Close-weighted PP biases toward recent price action
/// </remarks>
/// <seealso href="Pivotwood.md">Detailed documentation</seealso>
[SkipLocalsInit]
public sealed class Pivotwood : ITValuePublisher
{
    [StructLayout(LayoutKind.Auto)]
    private record struct State(
        double PrevHigh,
        double PrevLow,
        double PrevClose,
        double LastValidHigh,
        double LastValidLow,
        double LastValidClose);

    private State _s;
    private State _ps;
    private int _count;

    private readonly TBarPublishedHandler _barHandler;

    /// <summary>Display name for the indicator.</summary>
    public string Name { get; }

    /// <summary>Bars required for the indicator to warm up.</summary>
    public int WarmupPeriod { get; }

    /// <summary>Central Pivot Point: (prevH + prevL + 2*prevC) / 4</summary>
    public double PP { get; private set; }

    /// <summary>Resistance 1: 2*PP - prevL</summary>
    public double R1 { get; private set; }

    /// <summary>Resistance 2: PP + range</summary>
    public double R2 { get; private set; }

    /// <summary>Resistance 3: prevH + 2*(PP - prevL)</summary>
    public double R3 { get; private set; }

    /// <summary>Support 1: 2*PP - prevH</summary>
    public double S1 { get; private set; }

    /// <summary>Support 2: PP - range</summary>
    public double S2 { get; private set; }

    /// <summary>Support 3: prevL - 2*(prevH - PP)</summary>
    public double S3 { get; private set; }

    /// <summary>Primary output value (PP as TValue).</summary>
    public TValue Last { get; private set; }

    /// <summary>True when enough bars have been processed for valid output.</summary>
    public bool IsHot => _count >= 2;

    public event TValuePublishedHandler? Pub;

    /// <summary>
    /// Creates a Woodie's Pivot Points indicator.
    /// </summary>
    public Pivotwood()
    {
        _count = 0;
        _s = new State(double.NaN, double.NaN, double.NaN, double.NaN, double.NaN, double.NaN);
        _ps = _s;

        PP = double.NaN;
        R1 = double.NaN;
        R2 = double.NaN;
        R3 = double.NaN;
        S1 = double.NaN;
        S2 = double.NaN;
        S3 = double.NaN;

        Name = "Pivotwood";
        WarmupPeriod = 2;
        _barHandler = HandleBar;
    }

    /// <summary>
    /// Creates a Woodie's Pivot Points indicator chained to a TBarSeries source.
    /// </summary>
    public Pivotwood(TBarSeries source)
        : this()
    {
        Prime(source);
        source.Pub += _barHandler;
    }

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

    [MethodImpl(MethodImplOptions.AggressiveInlining)]
    private void PubEvent(TValue value, bool isNew = true) =>
        Pub?.Invoke(this, new TValueEventArgs { Value = value, IsNew = isNew });

    [MethodImpl(MethodImplOptions.AggressiveInlining)]
    public TValue Update(TBar input, bool isNew = true)
    {
        if (isNew)
        {
            _ps = _s;
            _count++;
        }
        else
        {
            _s = _ps;
        }

        var s = _s;

        // Validate inputs - substitute last-valid on NaN/Infinity
        double high = input.High;
        double low = input.Low;
        double close = input.Close;

        if (double.IsFinite(high)) { s.LastValidHigh = high; }
        else { high = s.LastValidHigh; }

        if (double.IsFinite(low)) { s.LastValidLow = low; }
        else { low = s.LastValidLow; }

        if (double.IsFinite(close)) { s.LastValidClose = close; }
        else { close = s.LastValidClose; }

        // If still no valid data, return NaN
        if (double.IsNaN(high) || double.IsNaN(low) || double.IsNaN(close))
        {
            _s = s;
            SetAllNaN();
            Last = new TValue(input.Time, double.NaN);
            PubEvent(Last, isNew);
            return Last;
        }

        // First bar: store HLC but cannot compute pivots yet (no previous bar)
        if (_count < 2)
        {
            s.PrevHigh = high;
            s.PrevLow = low;
            s.PrevClose = close;
            _s = s;
            SetAllNaN();
            Last = new TValue(input.Time, double.NaN);
            PubEvent(Last, isNew);
            return Last;
        }

        // Compute pivot levels from PREVIOUS bar's HLC
        double pH = s.PrevHigh;
        double pL = s.PrevLow;
        double pC = s.PrevClose;

        // Woodie's PP: weight close 2× → (H + L + 2C) / 4
        double pp = (pH + pL + Math.FusedMultiplyAdd(2.0, pC, 0.0)) * 0.25;
        double range = pH - pL;

        PP = pp;
        R1 = Math.FusedMultiplyAdd(2.0, pp, -pL);    // 2*PP - L
        S1 = Math.FusedMultiplyAdd(2.0, pp, -pH);    // 2*PP - H
        R2 = pp + range;                               // PP + range
        S2 = pp - range;                               // PP - range
        R3 = Math.FusedMultiplyAdd(2.0, pp - pL, pH); // H + 2*(PP - L)
        S3 = Math.FusedMultiplyAdd(-2.0, pH - pp, pL); // L - 2*(H - PP)

        // Store current bar's HLC as "previous" for next bar
        s.PrevHigh = high;
        s.PrevLow = low;
        s.PrevClose = close;
        _s = s;

        Last = new TValue(input.Time, PP);
        PubEvent(Last, isNew);
        return Last;
    }

    [MethodImpl(MethodImplOptions.AggressiveInlining)]
    public TValue Update(TValue input, bool isNew = true) =>
        Update(new TBar(input.Time, input.Value, input.Value, input.Value, input.Value, 0), isNew);

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

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

        CollectionsMarshal.SetCount(t, len);
        CollectionsMarshal.SetCount(v, len);

        Batch(source.HighValues, source.LowValues, source.CloseValues,
            CollectionsMarshal.AsSpan(v));

        source.Times.CopyTo(CollectionsMarshal.AsSpan(t));

        // Prime internal state for continued streaming
        Prime(source);

        var lastTime = new DateTime(source.Times[^1], DateTimeKind.Utc);
        Last = new TValue(lastTime, CollectionsMarshal.AsSpan(v)[^1]);

        return new TSeries(t, v);
    }

    public void Prime(TBarSeries source)
    {
        Reset();

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

        for (int i = 0; i < source.Count; i++)
        {
            Update(source[i], isNew: true);
        }
    }

    public void Prime(ReadOnlySpan<double> source, TimeSpan? step = null)
    {
        Reset();

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

        long t = DateTime.UtcNow.Ticks;
        long stepTicks = (step ?? TimeSpan.FromMinutes(1)).Ticks;

        for (int i = 0; i < source.Length; i++)
        {
            double val = source[i];
            Update(new TBar(t, val, val, val, val, 0), isNew: true);
            t += stepTicks;
        }
    }

    public void Reset()
    {
        _count = 0;
        _s = new State(double.NaN, double.NaN, double.NaN, double.NaN, double.NaN, double.NaN);
        _ps = _s;
        SetAllNaN();
        Last = default;
    }

    [MethodImpl(MethodImplOptions.AggressiveInlining)]
    private void SetAllNaN()
    {
        PP = double.NaN;
        R1 = double.NaN;
        R2 = double.NaN;
        R3 = double.NaN;
        S1 = double.NaN;
        S2 = double.NaN;
        S3 = double.NaN;
    }

    /// <summary>
    /// Batch computation of Woodie's Pivot Points over span data.
    /// Writes PP values to <paramref name="ppOutput"/>.
    /// </summary>
    [MethodImpl(MethodImplOptions.AggressiveInlining)]
    public static void Batch(
        ReadOnlySpan<double> high,
        ReadOnlySpan<double> low,
        ReadOnlySpan<double> close,
        Span<double> ppOutput)
    {
        if (high.Length != low.Length || high.Length != close.Length)
        {
            throw new ArgumentException("Input spans must have the same length.", nameof(high));
        }
        if (ppOutput.Length < high.Length)
        {
            throw new ArgumentException("Output span must be at least as long as input.", nameof(ppOutput));
        }

        int len = high.Length;
        if (len == 0)
        {
            return;
        }

        // First bar: no previous data
        ppOutput[0] = double.NaN;

        // Remaining bars: compute Woodie's PP from previous bar's HLC
        for (int i = 1; i < len; i++)
        {
            double pH = high[i - 1];
            double pL = low[i - 1];
            double pC = close[i - 1];
            ppOutput[i] = (pH + pL + Math.FusedMultiplyAdd(2.0, pC, 0.0)) * 0.25;
        }
    }

    public static TSeries Batch(TBarSeries source)
    {
        if (source == null || source.Count == 0)
        {
            return new TSeries([], []);
        }

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

        CollectionsMarshal.SetCount(t, len);
        CollectionsMarshal.SetCount(v, len);

        Batch(source.HighValues, source.LowValues, source.CloseValues,
            CollectionsMarshal.AsSpan(v));

        source.Times.CopyTo(CollectionsMarshal.AsSpan(t));

        return new TSeries(t, v);
    }

    /// <summary>
    /// Batch computation of all 7 Woodie's Pivot Point levels over span data.
    /// </summary>
    [MethodImpl(MethodImplOptions.AggressiveInlining)]
    public static void BatchAll(
        ReadOnlySpan<double> high,
        ReadOnlySpan<double> low,
        ReadOnlySpan<double> close,
        Span<double> ppOut,
        Span<double> r1Out,
        Span<double> s1Out,
        Span<double> r2Out,
        Span<double> s2Out,
        Span<double> r3Out,
        Span<double> s3Out)
    {
        if (high.Length != low.Length || high.Length != close.Length)
        {
            throw new ArgumentException("Input spans must have the same length.", nameof(high));
        }

        int len = high.Length;

        if (ppOut.Length < len) { throw new ArgumentException("Output span too short.", nameof(ppOut)); }
        if (r1Out.Length < len) { throw new ArgumentException("Output span too short.", nameof(r1Out)); }
        if (s1Out.Length < len) { throw new ArgumentException("Output span too short.", nameof(s1Out)); }
        if (r2Out.Length < len) { throw new ArgumentException("Output span too short.", nameof(r2Out)); }
        if (s2Out.Length < len) { throw new ArgumentException("Output span too short.", nameof(s2Out)); }
        if (r3Out.Length < len) { throw new ArgumentException("Output span too short.", nameof(r3Out)); }
        if (s3Out.Length < len) { throw new ArgumentException("Output span too short.", nameof(s3Out)); }

        if (len == 0)
        {
            return;
        }

        // First bar: no previous data
        ppOut[0] = double.NaN;
        r1Out[0] = double.NaN;
        s1Out[0] = double.NaN;
        r2Out[0] = double.NaN;
        s2Out[0] = double.NaN;
        r3Out[0] = double.NaN;
        s3Out[0] = double.NaN;

        for (int i = 1; i < len; i++)
        {
            double pH = high[i - 1];
            double pL = low[i - 1];
            double pC = close[i - 1];

            double pp = (pH + pL + Math.FusedMultiplyAdd(2.0, pC, 0.0)) * 0.25;
            double range = pH - pL;

            ppOut[i] = pp;
            r1Out[i] = Math.FusedMultiplyAdd(2.0, pp, -pL);
            s1Out[i] = Math.FusedMultiplyAdd(2.0, pp, -pH);
            r2Out[i] = pp + range;
            s2Out[i] = pp - range;
            r3Out[i] = Math.FusedMultiplyAdd(2.0, pp - pL, pH);
            s3Out[i] = Math.FusedMultiplyAdd(-2.0, pH - pp, pL);
        }
    }

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