GamepadStickState.cs

namespace Gondwana.Input.Gamepad;

public readonly struct GamepadStickState
{
    public float X { get; }

    public float Y { get; }

    public int RawX { get; }

    public int RawY { get; }

    public GamepadStickState(float x, float y, int rawX = 0, int rawY = 0)
    {
        X = x;
        Y = y;
        RawX = rawX;
        RawY = rawY;
    }

    public static GamepadStickState FromRaw16(int rawX, int rawY)
    {
        const float range = 32767f; // signed range: -32768 to 32767
        float normX = Math.Clamp(rawX / range, -1f, 1f);
        float normY = Math.Clamp(rawY / range, -1f, 1f);
        return new GamepadStickState(normX, normY, rawX, rawY);
    }

    public static GamepadStickState FromRawUnsigned16(ushort rawX, ushort rawY)
    {
        float normX = (rawX - 32768f) / 32767f;
        float normY = (rawY - 32768f) / 32767f;
        return new GamepadStickState(normX, normY, rawX, rawY);
    }

    public float Magnitude => MathF.Sqrt(X * X + Y * Y);

    public float Angle => MathF.Atan2(Y, X);

    public bool IsEngaged(float threshold = 0.15f) => Magnitude >= threshold;

    public StickDirection Direction(float threshold = 0.15f)
    {
        if (!IsEngaged(threshold)) return StickDirection.None;
 
        var dir = StickDirection.None;
        if (Y >= threshold) dir |= StickDirection.Up;
        if (Y <= -threshold) dir |= StickDirection.Down;
        if (X <= -threshold) dir |= StickDirection.Left;
        if (X >= threshold) dir |= StickDirection.Right;
 
        return dir;
    }

    public GamepadStickState WithDeadzone(float threshold = 0.15f)
    {
        return IsEngaged(threshold) ? this : new GamepadStickState(0, 0, RawX, RawY);
    }

    public override string ToString() => $"({X:0.00}, {Y:0.00})";
}