ProjectOnrinto_Godot/Scripts/Data/TrackData.cs

using System.Collections.Generic;
using System.Linq;
using Godot;

namespace Onrinto.Chart;

public class TrackData
{
    public int BPM { get; set; }
    public double Offset { get; set; }
    public double TicksPerBeat { get; set; }
    public double BeatDuration => 60.0 / BPM;
    public List<ChartEvent> Events { get; set; } = new List<ChartEvent>();
    public List<TempoPoint> TempoPoints { get; set; } = new List<TempoPoint>();
    public List<SpeedPoint> RelativeSpeedPoints { get; set; } = new List<SpeedPoint>();
    public List<SpeedPoint> AbsoluteSpeedPoints { get; set; } = new List<SpeedPoint>();

    public List<double> TempoSecondsTable { get; private set; } = new List<double>();
    public List<float> RelativeZTable { get; private set; } = new List<float>();

    public void Initialize()
    {
        InitializeTempoTable();
        InitializeRelativeZTable(RelativeSpeedPoints);

        foreach(var e in Events)
        {
            e.HitTime = TickToSeconds(e.Tick);
            e.HitAbsZ = GetZ(e.HitTime, RelativeSpeedPoints, RelativeZTable);
        }
    }

    public void InitializeTempoTable()
    {
        TempoSecondsTable.Clear();
        if(TempoPoints == null || TempoPoints.Count == 0) return;

        TempoPoints = TempoPoints.OrderBy(tp => tp.Tick).ToList();
        double cachedSeconds = 0.0;
        TempoSecondsTable.Add(cachedSeconds);

        for(int i = 0; i < TempoPoints.Count - 1; i++)
        {
            double ticksDelta = TempoPoints[i + 1].Tick - TempoPoints[i].Tick;
            double secondsDelta = ticksDelta / TicksPerBeat * 60.0 / TempoPoints[i].BPM;
            cachedSeconds += secondsDelta;
            TempoSecondsTable.Add(cachedSeconds);
        }
    }

    public void InitializeRelativeZTable(List<SpeedPoint> speedPoints)
    {
        RelativeZTable.Clear();
        if(speedPoints == null || speedPoints.Count == 0) return;

        speedPoints = speedPoints.OrderBy(sp => sp.Tick).ToList();
        float cachedZ = 0.0f;
        RelativeZTable.Add(cachedZ);

        for(int i = 0; i < speedPoints.Count - 1; i++)
        {
            double timeDelta = TickToSeconds(speedPoints[i + 1].Tick) - TickToSeconds(speedPoints[i].Tick);
            
            if(speedPoints[i].IsLinear)
            {
                cachedZ += (float)timeDelta * (speedPoints[i].Speed + speedPoints[i + 1].Speed) * 0.5f;
            }
            else
            {
                cachedZ += (float)timeDelta * speedPoints[i].Speed;
            }
            RelativeZTable.Add(cachedZ);
        }
    }

    public double TickToSeconds(double tick)
    {
        if(TempoPoints == null || TempoPoints.Count == 0) 
            return tick / TicksPerBeat * 60.0 / BPM;

        int idx = 0;
        for(int i = 0; i < TempoPoints.Count; i++)
        {
            if(tick >= TempoPoints[i].Tick) idx = i;
            else break;
        }

        return TempoSecondsTable[idx] + (tick - TempoPoints[idx].Tick) / TicksPerBeat * 60.0 / TempoPoints[idx].BPM;
    }

    public float GetZ(double time, List<SpeedPoint> speedPoints, List<float> zTable)
    {
        if(speedPoints == null || speedPoints.Count == 0) return 0.0f;

        int idx = 0;
        for(int i = 0; i < speedPoints.Count; i++)
        {
            if(time >= TickToSeconds(speedPoints[i].Tick)) idx = i;
            else break;
        }

        var point = speedPoints[idx];
        float cachedZ = zTable[idx];
        double pointTime = TickToSeconds(point.Tick);
        double deltaTime = time - pointTime;

        if(point.IsLinear && idx < speedPoints.Count - 1)
        {
            double nextTime = TickToSeconds(speedPoints[idx + 1].Tick);
            float t = (float)((time - pointTime) / (nextTime - pointTime));
            float currentSpeed = Mathf.Lerp(point.Speed, speedPoints[idx + 1].Speed, t);
            return cachedZ + (float)deltaTime * (point.Speed + currentSpeed) * 0.5f;
        }
        else
        {
            return cachedZ + (float)deltaTime * point.Speed;
        }
    }
}