Ryujinx/Ryujinx.Core/Hid/Hid.cs

using ChocolArm64.Memory;
using System.Diagnostics;

namespace Ryujinx.Core.Input
{
    public class Hid
    {
        /*
         * Reference:
         * https://github.com/reswitched/libtransistor/blob/development/lib/hid.c
         * https://github.com/reswitched/libtransistor/blob/development/include/libtransistor/hid.h
         * https://github.com/switchbrew/libnx/blob/master/nx/source/services/hid.c
         * https://github.com/switchbrew/libnx/blob/master/nx/include/switch/services/hid.h
         */

        private const int HidHeaderSize            = 0x400;
        private const int HidTouchScreenSize       = 0x3000;
        private const int HidMouseSize             = 0x400;
        private const int HidKeyboardSize          = 0x400;
        private const int HidUnkSection1Size       = 0x400;
        private const int HidUnkSection2Size       = 0x400;
        private const int HidUnkSection3Size       = 0x400;
        private const int HidUnkSection4Size       = 0x400;
        private const int HidUnkSection5Size       = 0x200;
        private const int HidUnkSection6Size       = 0x200;
        private const int HidUnkSection7Size       = 0x200;
        private const int HidUnkSection8Size       = 0x800;
        private const int HidControllerSerialsSize = 0x4000;
        private const int HidControllersSize       = 0x32000;
        private const int HidUnkSection9Size       = 0x800;

        private const int HidTouchHeaderSize = 0x28;
        private const int HidTouchEntrySize  = 0x298;

        private const int HidTouchEntryHeaderSize = 0x10;
        private const int HidTouchEntryTouchSize  = 0x28;

        private const int HidControllerSize        = 0x5000;
        private const int HidControllerHeaderSize  = 0x28;
        private const int HidControllerLayoutsSize = 0x350;

        private const int HidControllersLayoutHeaderSize = 0x20;
        private const int HidControllersInputEntrySize   = 0x30;

        private const int HidHeaderOffset            = 0;
        private const int HidTouchScreenOffset       = HidHeaderOffset            + HidHeaderSize;
        private const int HidMouseOffset             = HidTouchScreenOffset       + HidTouchScreenSize;
        private const int HidKeyboardOffset          = HidMouseOffset             + HidMouseSize;
        private const int HidUnkSection1Offset       = HidKeyboardOffset          + HidKeyboardSize;
        private const int HidUnkSection2Offset       = HidUnkSection1Offset       + HidUnkSection1Size;
        private const int HidUnkSection3Offset       = HidUnkSection2Offset       + HidUnkSection2Size;
        private const int HidUnkSection4Offset       = HidUnkSection3Offset       + HidUnkSection3Size;
        private const int HidUnkSection5Offset       = HidUnkSection4Offset       + HidUnkSection4Size;
        private const int HidUnkSection6Offset       = HidUnkSection5Offset       + HidUnkSection5Size;
        private const int HidUnkSection7Offset       = HidUnkSection6Offset       + HidUnkSection6Size;
        private const int HidUnkSection8Offset       = HidUnkSection7Offset       + HidUnkSection7Size;
        private const int HidControllerSerialsOffset = HidUnkSection8Offset       + HidUnkSection8Size;
        private const int HidControllersOffset       = HidControllerSerialsOffset + HidControllerSerialsSize;
        private const int HidUnkSection9Offset       = HidControllersOffset       + HidControllersSize;

        private const int HidEntryCount = 17;

        private long SharedMemOffset;

        private Switch Ns;

        public Hid(Switch Ns)
        {
            this.Ns = Ns;
        }

        public void Init(long HidOffset)
        {
            SharedMemOffset = HidOffset;

            InitializeJoyconPair(
                JoyConColor.Body_Neon_Red,
                JoyConColor.Buttons_Neon_Red,
                JoyConColor.Body_Neon_Blue,
                JoyConColor.Buttons_Neon_Blue);
        }

        public void InitializeJoyconPair(
            JoyConColor LeftColorBody,
            JoyConColor LeftColorButtons,
            JoyConColor RightColorBody,
            JoyConColor RightColorButtons)
        {
            long BaseControllerOffset = HidControllersOffset + 8 * HidControllerSize;

            HidControllerType Type =
                HidControllerType.ControllerType_Handheld |
                HidControllerType.ControllerType_JoyconPair;

            bool IsHalf = false;

            HidControllerColorDesc SingleColorDesc =
                HidControllerColorDesc.ColorDesc_ColorsNonexistent;

            JoyConColor SingleColorBody    = JoyConColor.Black;
            JoyConColor SingleColorButtons = JoyConColor.Black;

            HidControllerColorDesc SplitColorDesc = 0;

            WriteInt32(BaseControllerOffset + 0x0,  (int)Type);

            WriteInt32(BaseControllerOffset + 0x4,  IsHalf ? 1 : 0);

            WriteInt32(BaseControllerOffset + 0x8,  (int)SingleColorDesc);
            WriteInt32(BaseControllerOffset + 0xc,  (int)SingleColorBody);
            WriteInt32(BaseControllerOffset + 0x10, (int)SingleColorButtons);
            WriteInt32(BaseControllerOffset + 0x14, (int)SplitColorDesc);

            WriteInt32(BaseControllerOffset + 0x18, (int)LeftColorBody);
            WriteInt32(BaseControllerOffset + 0x1c, (int)LeftColorButtons);

            WriteInt32(BaseControllerOffset + 0x20, (int)RightColorBody);
            WriteInt32(BaseControllerOffset + 0x24, (int)RightColorButtons);
        }

        public void SetJoyconButton(
            HidControllerId      ControllerId,
            HidControllerLayouts ControllerLayout,
            HidControllerButtons Buttons,
            HidJoystickPosition  LeftStick,
            HidJoystickPosition  RightStick)
        {
            long ControllerOffset = HidControllersOffset + (int)ControllerId * HidControllerSize;

            ControllerOffset += HidControllerHeaderSize;

            ControllerOffset += (int)ControllerLayout * HidControllerLayoutsSize;

            long LastEntry = ReadInt64(ControllerOffset + 0x10);

            long CurrEntry = (LastEntry + 1) % HidEntryCount;

            long Timestamp = Stopwatch.GetTimestamp();

            WriteInt64(ControllerOffset + 0x0,  Timestamp);
            WriteInt64(ControllerOffset + 0x8,  HidEntryCount);
            WriteInt64(ControllerOffset + 0x10, CurrEntry);
            WriteInt64(ControllerOffset + 0x18, HidEntryCount - 1);

            ControllerOffset += HidControllersLayoutHeaderSize;

            ControllerOffset += CurrEntry * HidControllersInputEntrySize;

            WriteInt64(ControllerOffset + 0x0,  Timestamp);
            WriteInt64(ControllerOffset + 0x8,  Timestamp);

            WriteInt64(ControllerOffset + 0x10, (uint)Buttons);

            WriteInt32(ControllerOffset + 0x18, LeftStick.DX);
            WriteInt32(ControllerOffset + 0x1c, LeftStick.DY);

            WriteInt64(ControllerOffset + 0x20, RightStick.DX);
            WriteInt64(ControllerOffset + 0x24, RightStick.DY);

            WriteInt64(ControllerOffset + 0x28,
                (uint)HidControllerConnState.Controller_State_Connected |
                (uint)HidControllerConnState.Controller_State_Wired);
        }

        public void SetTouchPoints(params HidTouchPoint[] Points)
        {
            Logging.Debug("hid touch");

            long LastEntry = ReadInt64(HidTouchScreenOffset + 0x10);

            long CurrEntry = (LastEntry + 1) % HidEntryCount;

            long Timestamp = Stopwatch.GetTimestamp();

            WriteInt64(HidTouchScreenOffset + 0x0,  Timestamp);
            WriteInt64(HidTouchScreenOffset + 0x8,  HidEntryCount);
            WriteInt64(HidTouchScreenOffset + 0x10, CurrEntry);
            WriteInt64(HidTouchScreenOffset + 0x18, HidEntryCount - 1);
            WriteInt64(HidTouchScreenOffset + 0x20, Timestamp);            

            long TouchEntryOffset = HidTouchScreenOffset + HidTouchHeaderSize;

            long LastEntryOffset = TouchEntryOffset + LastEntry * HidTouchEntrySize;

            long LastTimestamp = ReadInt64(LastEntryOffset);

            TouchEntryOffset += CurrEntry * HidTouchEntrySize;            

            WriteInt64(TouchEntryOffset + 0x0, LastTimestamp + 1);
            WriteInt64(TouchEntryOffset + 0x8, Points.Length);

            TouchEntryOffset += HidTouchEntryHeaderSize;

            const int Padding = 0;

            int Index = 0;

            foreach (HidTouchPoint Point in Points)
            {
                WriteInt64(TouchEntryOffset + 0x0,  Timestamp);
                WriteInt32(TouchEntryOffset + 0x8,  Padding);
                WriteInt32(TouchEntryOffset + 0xc,  Index++);
                WriteInt32(TouchEntryOffset + 0x10, Point.X);
                WriteInt32(TouchEntryOffset + 0x14, Point.Y);
                WriteInt32(TouchEntryOffset + 0x18, Point.DiameterX);
                WriteInt32(TouchEntryOffset + 0x1c, Point.DiameterY);
                WriteInt32(TouchEntryOffset + 0x20, Point.Angle);
                WriteInt32(TouchEntryOffset + 0x24, Padding);

                TouchEntryOffset += HidTouchEntryTouchSize;
            }
        }

        private unsafe long ReadInt64(long Position)
        {
            Position += SharedMemOffset;

            if ((ulong)Position + 8 > AMemoryMgr.AddrSize) return 0;

            return *((long*)((byte*)Ns.Ram + Position));
        }

        private unsafe void WriteInt32(long Position, int Value)
        {
            Position += SharedMemOffset;

            if ((ulong)Position + 4 > AMemoryMgr.AddrSize) return;

            Logging.Debug($"hid wr32 {Position:x8} {Value:x8}");

            *((int*)((byte*)Ns.Ram + Position)) = Value;
        }

        private unsafe void WriteInt64(long Position, long Value)
        {
            Position += SharedMemOffset;

            if ((ulong)Position + 8 > AMemoryMgr.AddrSize) return;

            Logging.Debug($"hid wr64 {Position:x8} {Value:x16}");

            *((long*)((byte*)Ns.Ram + Position)) = Value;
        }
    }
}