SDL3

src/Ryujinx.Input.SDL3/SDL3GamepadDriver.cs

@@ -0,0 +1,231 @@
+using Ryujinx.Common.Logging;
+using Ryujinx.Input.SDL3;
+using Ryujinx.SDL3.Common;
+using System;
+using System.Collections.Generic;
+using System.Linq;
+using System.Runtime.InteropServices;
+using System.Text;
+using System.Threading;
+using static SDL3.SDL;
+
+namespace Ryujinx.Input.SDl3
+{
+    public class SDL3GamepadDriver : IGamepadDriver
+    {
+        private readonly Dictionary<uint, string> _gamepadsInstanceIdsMapping;
+        private readonly List<string> _gamepadsIds;
+        private readonly Lock _lock = new();
+
+        public ReadOnlySpan<string> GamepadsIds
+        {
+            get
+            {
+                lock (_lock)
+                {
+                    return _gamepadsIds.ToArray();
+                }
+            }
+        }
+
+        public string DriverName => "SDL3";
+
+        public event Action<string> OnGamepadConnected;
+        public event Action<string> OnGamepadDisconnected;
+
+        public SDL3GamepadDriver()
+        {
+            _gamepadsInstanceIdsMapping = new Dictionary<uint, string>();
+            _gamepadsIds = new List<string>();
+
+            SDL3Driver.Instance.Initialize();
+            SDL3Driver.Instance.OnJoyStickConnected += HandleJoyStickConnected;
+            SDL3Driver.Instance.OnJoystickDisconnected += HandleJoyStickDisconnected;
+            SDL3Driver.Instance.OnJoyBatteryUpdated += HandleJoyBatteryUpdated;
+
+            IntPtr joystickArray = SDL_GetJoysticks(out int count);
+
+            var joystickIDs = new int[count];
+            Marshal.Copy(joystickArray, joystickIDs, 0, count);
+
+            for (int i = 0; i < count; i++)
+            {
+                HandleJoyStickConnected((uint)joystickIDs[i]);
+            }
+        }
+
+        private string GenerateGamepadId(uint joystickIndex)
+        {
+
+            int bufferSize = 33;
+            Span<byte> pszGUID = stackalloc byte[bufferSize];
+            SDL_GUIDToString(SDL_GetJoystickGUIDForID(joystickIndex), pszGUID, bufferSize);
+            var guid = Encoding.UTF8.GetString(pszGUID);
+
+            // if (guid == new SDL_GUID())
+            // {
+            //     return null;
+            // }
+
+            string id;
+            lock (_lock)
+            {
+                int guidIndex = 0;
+                id = guidIndex + guid;
+
+                while (_gamepadsIds.Contains(id))
+                {
+                    id = (++guidIndex) + "-" + guid;
+                }
+            }
+
+            return id;
+        }
+
+        private uint GetJoystickIndexByGamepadId(string id)
+        {
+            lock (_lock)
+            {
+                return _gamepadsInstanceIdsMapping.FirstOrDefault(x=>x.Value == id).Key; 
+            }
+        }
+
+        private void HandleJoyStickDisconnected(uint joystickInstanceId)
+        {
+            bool joyConPairDisconnected = false;
+            if (!_gamepadsInstanceIdsMapping.Remove(joystickInstanceId, out string id))
+                return;
+
+            lock (_lock)
+            {
+                _gamepadsIds.Remove(id);
+                if (!SDL3JoyConPair.IsCombinable(_gamepadsInstanceIdsMapping))
+                {
+                    _gamepadsIds.Remove(SDL3JoyConPair.Id);
+                    joyConPairDisconnected = true;
+                }
+            }
+
+            OnGamepadDisconnected?.Invoke(id);
+            if (joyConPairDisconnected)
+            {
+                OnGamepadDisconnected?.Invoke(SDL3JoyConPair.Id);
+            }
+        }
+
+        private void HandleJoyStickConnected(uint joystickInstanceId)
+        {
+            bool joyConPairConnected = false;
+
+
+            if (SDL_IsGamepad(joystickInstanceId))
+            {
+                if (_gamepadsInstanceIdsMapping.ContainsKey(joystickInstanceId))
+                {
+                    // Sometimes a JoyStick connected event fires after the app starts even though it was connected before
+                    // so it is rejected to avoid doubling the entries.
+                    return;
+                }
+
+                string id = GenerateGamepadId(joystickInstanceId);
+                if (id == null)
+                {
+                    return;
+                }
+
+                if (_gamepadsInstanceIdsMapping.TryAdd(joystickInstanceId, id))
+                {
+                    lock (_lock)
+                    {
+                        if (joystickInstanceId <= _gamepadsIds.FindLastIndex(_ => true))
+                        {
+                            // _gamepadsIds.Insert(joystickDeviceId, id);
+                        }
+                        else
+                            _gamepadsIds.Add(id);
+
+                        if (SDL3JoyConPair.IsCombinable(_gamepadsInstanceIdsMapping))
+                        {
+                            _gamepadsIds.Remove(SDL3JoyConPair.Id);
+                            _gamepadsIds.Add(SDL3JoyConPair.Id);
+                            joyConPairConnected = true;
+                        }
+                    }
+
+                    OnGamepadConnected?.Invoke(id);
+                    if (joyConPairConnected)
+                    {
+                        OnGamepadConnected?.Invoke(SDL3JoyConPair.Id);
+                    }
+                }
+            }
+        }
+
+        private void HandleJoyBatteryUpdated(uint joystickDeviceId,  SDL_JoyBatteryEvent joyBatteryEvent)
+        {
+            Logger.Info?.Print(LogClass.Hid,
+                $"{SDL_GetGamepadNameForID(joystickDeviceId)}, Battery percent: {joyBatteryEvent.percent}");
+        }
+
+        protected virtual void Dispose(bool disposing)
+        {
+            if (disposing)
+            {
+                SDL3Driver.Instance.OnJoyStickConnected -= HandleJoyStickConnected;
+                SDL3Driver.Instance.OnJoystickDisconnected -= HandleJoyStickDisconnected;
+
+                // Simulate a full disconnect when disposing
+                foreach (string id in _gamepadsIds)
+                {
+                    OnGamepadDisconnected?.Invoke(id);
+                }
+
+                lock (_lock)
+                {
+                    _gamepadsIds.Clear();
+                }
+
+                SDL3Driver.Instance.Dispose();
+            }
+        }
+
+        public void Dispose()
+        {
+            GC.SuppressFinalize(this);
+            Dispose(true);
+        }
+
+        public IGamepad GetGamepad(string id)
+        {
+            if (id == SDL3JoyConPair.Id)
+            {
+                lock (_lock)
+                {
+                    return SDL3JoyConPair.GetGamepad(_gamepadsInstanceIdsMapping);
+                }
+            }
+
+            var instanceId = GetJoystickIndexByGamepadId(id);
+
+            if (instanceId == nint.Zero)
+            {
+                return null;
+            }
+            
+            nint gamepadHandle = SDL_OpenGamepad(instanceId);
+
+            if (gamepadHandle == nint.Zero)
+            {
+                return null;
+            }
+
+            Console.WriteLine(SDL_GetGamepadName(gamepadHandle));
+            if (SDL_GetGamepadName(gamepadHandle).StartsWith(SDL3JoyCon.Prefix))
+            {
+                return new SDL3JoyCon(gamepadHandle, id);
+            }
+
+            return new SDL3Gamepad(gamepadHandle, id);
+        }
+    }
+}