340 lines
14 KiB
C#
340 lines
14 KiB
C#
|
using ChocolArm64.State;
|
||
|
|
using Ryujinx.Common.Logging;
|
||
|
|
using Ryujinx.HLE.HOS.Kernel.Common;
|
||
|
|
using System;
|
||
|
|
using System.Collections.Generic;
|
||
|
|
using System.Reflection;
|
||
|
|
using System.Reflection.Emit;
|
||
|
|
|
||
|
|
namespace Ryujinx.HLE.HOS.Kernel.SupervisorCall
|
||
|
|
{
|
||
|
|
static class SvcTable
|
||
|
|
{
|
||
|
|
private const int SvcFuncMaxArguments = 8;
|
||
|
|
|
||
|
|
private static Dictionary<int, string> _svcFuncs64;
|
||
|
|
|
||
|
|
private static Action<SvcHandler, CpuThreadState>[] _svcTable64;
|
||
|
|
|
||
|
|
static SvcTable()
|
||
|
|
{
|
||
|
|
_svcFuncs64 = new Dictionary<int, string>
|
||
|
|
{
|
||
|
|
{ 0x01, nameof(SvcHandler.SetHeapSize64) },
|
||
|
|
{ 0x03, nameof(SvcHandler.SetMemoryAttribute64) },
|
||
|
|
{ 0x04, nameof(SvcHandler.MapMemory64) },
|
||
|
|
{ 0x05, nameof(SvcHandler.UnmapMemory64) },
|
||
|
|
{ 0x06, nameof(SvcHandler.QueryMemory64) },
|
||
|
|
{ 0x07, nameof(SvcHandler.ExitProcess64) },
|
||
|
|
{ 0x08, nameof(SvcHandler.CreateThread64) },
|
||
|
|
{ 0x09, nameof(SvcHandler.StartThread64) },
|
||
|
|
{ 0x0a, nameof(SvcHandler.ExitThread64) },
|
||
|
|
{ 0x0b, nameof(SvcHandler.SleepThread64) },
|
||
|
|
{ 0x0c, nameof(SvcHandler.GetThreadPriority64) },
|
||
|
|
{ 0x0d, nameof(SvcHandler.SetThreadPriority64) },
|
||
|
|
{ 0x0e, nameof(SvcHandler.GetThreadCoreMask64) },
|
||
|
|
{ 0x0f, nameof(SvcHandler.SetThreadCoreMask64) },
|
||
|
|
{ 0x10, nameof(SvcHandler.GetCurrentProcessorNumber64) },
|
||
|
|
{ 0x11, nameof(SvcHandler.SignalEvent64) },
|
||
|
|
{ 0x12, nameof(SvcHandler.ClearEvent64) },
|
||
|
|
{ 0x13, nameof(SvcHandler.MapSharedMemory64) },
|
||
|
|
{ 0x14, nameof(SvcHandler.UnmapSharedMemory64) },
|
||
|
|
{ 0x15, nameof(SvcHandler.CreateTransferMemory64) },
|
||
|
|
{ 0x16, nameof(SvcHandler.CloseHandle64) },
|
||
|
|
{ 0x17, nameof(SvcHandler.ResetSignal64) },
|
||
|
|
{ 0x18, nameof(SvcHandler.WaitSynchronization64) },
|
||
|
|
{ 0x19, nameof(SvcHandler.CancelSynchronization64) },
|
||
|
|
{ 0x1a, nameof(SvcHandler.ArbitrateLock64) },
|
||
|
|
{ 0x1b, nameof(SvcHandler.ArbitrateUnlock64) },
|
||
|
|
{ 0x1c, nameof(SvcHandler.WaitProcessWideKeyAtomic64) },
|
||
|
|
{ 0x1d, nameof(SvcHandler.SignalProcessWideKey64) },
|
||
|
|
{ 0x1e, nameof(SvcHandler.GetSystemTick64) },
|
||
|
|
{ 0x1f, nameof(SvcHandler.ConnectToNamedPort64) },
|
||
|
|
{ 0x21, nameof(SvcHandler.SendSyncRequest64) },
|
||
|
|
{ 0x22, nameof(SvcHandler.SendSyncRequestWithUserBuffer64) },
|
||
|
|
{ 0x24, nameof(SvcHandler.GetProcessId64) },
|
||
|
|
{ 0x25, nameof(SvcHandler.GetThreadId64) },
|
||
|
|
{ 0x26, nameof(SvcHandler.Break64) },
|
||
|
|
{ 0x27, nameof(SvcHandler.OutputDebugString64) },
|
||
|
|
{ 0x29, nameof(SvcHandler.GetInfo64) },
|
||
|
|
{ 0x2c, nameof(SvcHandler.MapPhysicalMemory64) },
|
||
|
|
{ 0x2d, nameof(SvcHandler.UnmapPhysicalMemory64) },
|
||
|
|
{ 0x32, nameof(SvcHandler.SetThreadActivity64) },
|
||
|
|
{ 0x33, nameof(SvcHandler.GetThreadContext364) },
|
||
|
|
{ 0x34, nameof(SvcHandler.WaitForAddress64) },
|
||
|
|
{ 0x35, nameof(SvcHandler.SignalToAddress64) },
|
||
|
|
{ 0x45, nameof(SvcHandler.CreateEvent64) },
|
||
|
|
{ 0x65, nameof(SvcHandler.GetProcessList64) },
|
||
|
|
{ 0x6f, nameof(SvcHandler.GetSystemInfo64) },
|
||
|
|
{ 0x70, nameof(SvcHandler.CreatePort64) },
|
||
|
|
{ 0x71, nameof(SvcHandler.ManageNamedPort64) }
|
||
|
|
};
|
||
|
|
|
||
|
|
_svcTable64 = new Action<SvcHandler, CpuThreadState>[0x80];
|
||
|
|
}
|
||
|
|
|
||
|
|
public static Action<SvcHandler, CpuThreadState> GetSvcFunc(int svcId)
|
||
|
|
{
|
||
|
|
if (_svcTable64[svcId] != null)
|
||
|
|
{
|
||
|
|
return _svcTable64[svcId];
|
||
|
|
}
|
||
|
|
|
||
|
|
if (_svcFuncs64.TryGetValue(svcId, out string svcName))
|
||
|
|
{
|
||
|
|
return _svcTable64[svcId] = GenerateMethod(svcName);
|
||
|
|
}
|
||
|
|
|
||
|
|
return null;
|
||
|
|
}
|
||
|
|
|
||
|
|
private static Action<SvcHandler, CpuThreadState> GenerateMethod(string svcName)
|
||
|
|
{
|
||
|
|
Type[] argTypes = new Type[] { typeof(SvcHandler), typeof(CpuThreadState) };
|
||
|
|
|
||
|
|
DynamicMethod method = new DynamicMethod(svcName, null, argTypes);
|
||
|
|
|
||
|
|
MethodInfo methodInfo = typeof(SvcHandler).GetMethod(svcName);
|
||
|
|
|
||
|
|
ParameterInfo[] methodArgs = methodInfo.GetParameters();
|
||
|
|
|
||
|
|
if (methodArgs.Length > SvcFuncMaxArguments)
|
||
|
|
{
|
||
|
|
throw new InvalidOperationException($"Method \"{svcName}\" has too many arguments, max is 8.");
|
||
|
|
}
|
||
|
|
|
||
|
|
ILGenerator generator = method.GetILGenerator();
|
||
|
|
|
||
|
|
void ConvertToArgType(Type sourceType)
|
||
|
|
{
|
||
|
|
CheckIfTypeIsSupported(sourceType, svcName);
|
||
|
|
|
||
|
|
switch (Type.GetTypeCode(sourceType))
|
||
|
|
{
|
||
|
|
case TypeCode.UInt32: generator.Emit(OpCodes.Conv_U4); break;
|
||
|
|
case TypeCode.Int32: generator.Emit(OpCodes.Conv_I4); break;
|
||
|
|
case TypeCode.UInt16: generator.Emit(OpCodes.Conv_U2); break;
|
||
|
|
case TypeCode.Int16: generator.Emit(OpCodes.Conv_I2); break;
|
||
|
|
case TypeCode.Byte: generator.Emit(OpCodes.Conv_U1); break;
|
||
|
|
case TypeCode.SByte: generator.Emit(OpCodes.Conv_I1); break;
|
||
|
|
|
||
|
|
case TypeCode.Boolean:
|
||
|
|
generator.Emit(OpCodes.Conv_I4);
|
||
|
|
generator.Emit(OpCodes.Ldc_I4_1);
|
||
|
|
generator.Emit(OpCodes.And);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void ConvertToFieldType(Type sourceType)
|
||
|
|
{
|
||
|
|
CheckIfTypeIsSupported(sourceType, svcName);
|
||
|
|
|
||
|
|
switch (Type.GetTypeCode(sourceType))
|
||
|
|
{
|
||
|
|
case TypeCode.UInt32:
|
||
|
|
case TypeCode.Int32:
|
||
|
|
case TypeCode.UInt16:
|
||
|
|
case TypeCode.Int16:
|
||
|
|
case TypeCode.Byte:
|
||
|
|
case TypeCode.SByte:
|
||
|
|
case TypeCode.Boolean:
|
||
|
|
generator.Emit(OpCodes.Conv_U8);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
//For functions returning output values, the first registers
|
||
|
|
//are used to hold pointers where the value will be stored,
|
||
|
|
//so they can't be used to pass argument and we must
|
||
|
|
//skip them.
|
||
|
|
int byRefArgsCount = 0;
|
||
|
|
|
||
|
|
for (int index = 0; index < methodArgs.Length; index++)
|
||
|
|
{
|
||
|
|
if (methodArgs[index].ParameterType.IsByRef)
|
||
|
|
{
|
||
|
|
byRefArgsCount++;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
//Print all the arguments for debugging purposes.
|
||
|
|
int inputArgsCount = methodArgs.Length - byRefArgsCount;
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Ldc_I4_S, inputArgsCount);
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Newarr, typeof(object));
|
||
|
|
|
||
|
|
string argsFormat = svcName;
|
||
|
|
|
||
|
|
for (int index = 0; index < inputArgsCount; index++)
|
||
|
|
{
|
||
|
|
argsFormat += $" {methodArgs[index].Name}: 0x{{{index}:X8}},";
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Dup);
|
||
|
|
generator.Emit(OpCodes.Ldc_I4_S, index);
|
||
|
|
generator.Emit(OpCodes.Conv_I);
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Ldarg_1);
|
||
|
|
generator.Emit(OpCodes.Ldfld, GetStateFieldX(byRefArgsCount + index));
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Box, typeof(ulong));
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Stelem_Ref);
|
||
|
|
}
|
||
|
|
|
||
|
|
argsFormat = argsFormat.Substring(0, argsFormat.Length - 1);
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Ldstr, argsFormat);
|
||
|
|
|
||
|
|
BindingFlags staticNonPublic = BindingFlags.NonPublic | BindingFlags.Static;
|
||
|
|
|
||
|
|
MethodInfo printArgsMethod = typeof(SvcTable).GetMethod(nameof(PrintArguments), staticNonPublic);
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Call, printArgsMethod);
|
||
|
|
|
||
|
|
//Call the SVC function handler.
|
||
|
|
generator.Emit(OpCodes.Ldarg_0);
|
||
|
|
|
||
|
|
List<LocalBuilder> locals = new List<LocalBuilder>();
|
||
|
|
|
||
|
|
for (int index = 0; index < methodArgs.Length; index++)
|
||
|
|
{
|
||
|
|
Type argType = methodArgs[index].ParameterType;
|
||
|
|
|
||
|
|
if (argType.IsByRef)
|
||
|
|
{
|
||
|
|
argType = argType.GetElementType();
|
||
|
|
|
||
|
|
LocalBuilder local = generator.DeclareLocal(argType);
|
||
|
|
|
||
|
|
locals.Add(local);
|
||
|
|
|
||
|
|
if (!methodArgs[index].IsOut)
|
||
|
|
{
|
||
|
|
throw new InvalidOperationException($"Method \"{svcName}\" has a invalid ref type \"{argType.Name}\".");
|
||
|
|
}
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Ldloca_S, (byte)local.LocalIndex);
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
generator.Emit(OpCodes.Ldarg_1);
|
||
|
|
generator.Emit(OpCodes.Ldfld, GetStateFieldX(byRefArgsCount + index));
|
||
|
|
|
||
|
|
ConvertToArgType(argType);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Call, methodInfo);
|
||
|
|
|
||
|
|
int outRegIndex = 0;
|
||
|
|
|
||
|
|
Type retType = methodInfo.ReturnType;
|
||
|
|
|
||
|
|
//Print result code.
|
||
|
|
if (retType == typeof(KernelResult))
|
||
|
|
{
|
||
|
|
MethodInfo printResultMethod = typeof(SvcTable).GetMethod(nameof(PrintResult), staticNonPublic);
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Dup);
|
||
|
|
generator.Emit(OpCodes.Ldstr, svcName);
|
||
|
|
generator.Emit(OpCodes.Call, printResultMethod);
|
||
|
|
}
|
||
|
|
|
||
|
|
//Save return value into register X0 (when the method has a return value).
|
||
|
|
if (retType != typeof(void))
|
||
|
|
{
|
||
|
|
CheckIfTypeIsSupported(retType, svcName);
|
||
|
|
|
||
|
|
LocalBuilder tempLocal = generator.DeclareLocal(retType);
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Stloc, tempLocal);
|
||
|
|
generator.Emit(OpCodes.Ldarg_1);
|
||
|
|
generator.Emit(OpCodes.Ldloc, tempLocal);
|
||
|
|
|
||
|
|
ConvertToFieldType(retType);
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Stfld, GetStateFieldX(outRegIndex++));
|
||
|
|
}
|
||
|
|
|
||
|
|
for (int index = 0; index < locals.Count; index++)
|
||
|
|
{
|
||
|
|
generator.Emit(OpCodes.Ldarg_1);
|
||
|
|
generator.Emit(OpCodes.Ldloc, locals[index]);
|
||
|
|
|
||
|
|
ConvertToFieldType(locals[index].LocalType);
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Stfld, GetStateFieldX(outRegIndex++));
|
||
|
|
}
|
||
|
|
|
||
|
|
//Zero out the remaining unused registers.
|
||
|
|
while (outRegIndex < SvcFuncMaxArguments)
|
||
|
|
{
|
||
|
|
generator.Emit(OpCodes.Ldarg_1);
|
||
|
|
generator.Emit(OpCodes.Ldc_I8, 0L);
|
||
|
|
generator.Emit(OpCodes.Stfld, GetStateFieldX(outRegIndex++));
|
||
|
|
}
|
||
|
|
|
||
|
|
generator.Emit(OpCodes.Ret);
|
||
|
|
|
||
|
|
return (Action<SvcHandler, CpuThreadState>)method.CreateDelegate(typeof(Action<SvcHandler, CpuThreadState>));
|
||
|
|
}
|
||
|
|
|
||
|
|
private static FieldInfo GetStateFieldX(int index)
|
||
|
|
{
|
||
|
|
switch (index)
|
||
|
|
{
|
||
|
|
case 0: return typeof(CpuThreadState).GetField(nameof(CpuThreadState.X0));
|
||
|
|
case 1: return typeof(CpuThreadState).GetField(nameof(CpuThreadState.X1));
|
||
|
|
case 2: return typeof(CpuThreadState).GetField(nameof(CpuThreadState.X2));
|
||
|
|
case 3: return typeof(CpuThreadState).GetField(nameof(CpuThreadState.X3));
|
||
|
|
case 4: return typeof(CpuThreadState).GetField(nameof(CpuThreadState.X4));
|
||
|
|
case 5: return typeof(CpuThreadState).GetField(nameof(CpuThreadState.X5));
|
||
|
|
case 6: return typeof(CpuThreadState).GetField(nameof(CpuThreadState.X6));
|
||
|
|
case 7: return typeof(CpuThreadState).GetField(nameof(CpuThreadState.X7));
|
||
|
|
}
|
||
|
|
|
||
|
|
throw new ArgumentOutOfRangeException(nameof(index));
|
||
|
|
}
|
||
|
|
|
||
|
|
private static void CheckIfTypeIsSupported(Type type, string svcName)
|
||
|
|
{
|
||
|
|
switch (Type.GetTypeCode(type))
|
||
|
|
{
|
||
|
|
case TypeCode.UInt64:
|
||
|
|
case TypeCode.Int64:
|
||
|
|
case TypeCode.UInt32:
|
||
|
|
case TypeCode.Int32:
|
||
|
|
case TypeCode.UInt16:
|
||
|
|
case TypeCode.Int16:
|
||
|
|
case TypeCode.Byte:
|
||
|
|
case TypeCode.SByte:
|
||
|
|
case TypeCode.Boolean:
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
throw new InvalidSvcException($"Method \"{svcName}\" has a invalid ref type \"{type.Name}\".");
|
||
|
|
}
|
||
|
|
|
||
|
|
private static void PrintResult(KernelResult result, string svcName)
|
||
|
|
{
|
||
|
|
if (result != KernelResult.Success &&
|
||
|
|
result != KernelResult.TimedOut &&
|
||
|
|
result != KernelResult.Cancelled &&
|
||
|
|
result != KernelResult.InvalidState)
|
||
|
|
{
|
||
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"{svcName} returned error {result}.");
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
Logger.PrintDebug(LogClass.KernelSvc, $"{svcName} returned result {result}.");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
private static void PrintArguments(object[] argValues, string format)
|
||
|
|
{
|
||
|
|
Logger.PrintDebug(LogClass.KernelSvc, string.Format(format, argValues));
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|