Ryujinx/Ryujinx.HLE/HOS/Services/Nv/INvDrvServices.cs

226 lines
6.7 KiB
C#
Raw Normal View History

2018-02-04 23:08:20 +00:00
using ChocolArm64.Memory;
using Ryujinx.Common.Logging;
using Ryujinx.HLE.HOS.Ipc;
using Ryujinx.HLE.HOS.Kernel.Common;
using Ryujinx.HLE.HOS.Kernel.Process;
using Ryujinx.HLE.HOS.Kernel.Threading;
using Ryujinx.HLE.HOS.Services.Nv.NvGpuAS;
using Ryujinx.HLE.HOS.Services.Nv.NvGpuGpu;
using Ryujinx.HLE.HOS.Services.Nv.NvHostChannel;
using Ryujinx.HLE.HOS.Services.Nv.NvHostCtrl;
using Ryujinx.HLE.HOS.Services.Nv.NvMap;
2018-02-04 23:08:20 +00:00
using System;
using System.Collections.Generic;
namespace Ryujinx.HLE.HOS.Services.Nv
2018-02-04 23:08:20 +00:00
{
class INvDrvServices : IpcService
2018-02-04 23:08:20 +00:00
{
private delegate int IoctlProcessor(ServiceCtx context, int cmd);
2018-02-04 23:08:20 +00:00
private Dictionary<int, ServiceProcessRequest> _commands;
public override IReadOnlyDictionary<int, ServiceProcessRequest> Commands => _commands;
private static Dictionary<string, IoctlProcessor> _ioctlProcessors =
new Dictionary<string, IoctlProcessor>()
{
{ "/dev/nvhost-as-gpu", ProcessIoctlNvGpuAS },
{ "/dev/nvhost-ctrl", ProcessIoctlNvHostCtrl },
{ "/dev/nvhost-ctrl-gpu", ProcessIoctlNvGpuGpu },
{ "/dev/nvhost-gpu", ProcessIoctlNvHostChannel },
{ "/dev/nvhost-nvdec", ProcessIoctlNvHostChannel },
{ "/dev/nvhost-vic", ProcessIoctlNvHostChannel },
{ "/dev/nvmap", ProcessIoctlNvMap }
};
public static GlobalStateTable Fds { get; private set; }
private KEvent _event;
public INvDrvServices(Horizon system)
{
_commands = new Dictionary<int, ServiceProcessRequest>()
{
{ 0, Open },
{ 1, Ioctl },
{ 2, Close },
{ 3, Initialize },
{ 4, QueryEvent },
{ 8, SetClientPid },
{ 11, Ioctl },
{ 13, FinishInitialize }
};
_event = new KEvent(system);
}
static INvDrvServices()
{
Fds = new GlobalStateTable();
}
public long Open(ServiceCtx context)
2018-02-04 23:08:20 +00:00
{
long namePtr = context.Request.SendBuff[0].Position;
2018-02-04 23:08:20 +00:00
string name = MemoryHelper.ReadAsciiString(context.Memory, namePtr);
2018-02-04 23:08:20 +00:00
int fd = Fds.Add(context.Process, new NvFd(name));
2018-02-04 23:08:20 +00:00
context.ResponseData.Write(fd);
context.ResponseData.Write(0);
2018-02-04 23:08:20 +00:00
return 0;
}
public long Ioctl(ServiceCtx context)
2018-02-04 23:08:20 +00:00
{
int fd = context.RequestData.ReadInt32();
int cmd = context.RequestData.ReadInt32();
NvFd fdData = Fds.GetData<NvFd>(context.Process, fd);
2018-02-04 23:08:20 +00:00
int result;
2018-02-04 23:08:20 +00:00
if (_ioctlProcessors.TryGetValue(fdData.Name, out IoctlProcessor process))
2018-02-04 23:08:20 +00:00
{
result = process(context, cmd);
2018-02-04 23:08:20 +00:00
}
else
{
throw new NotImplementedException($"{fdData.Name} {cmd:x4}");
2018-02-04 23:08:20 +00:00
}
//TODO: Verify if the error codes needs to be translated.
context.ResponseData.Write(result);
return 0;
2018-02-04 23:08:20 +00:00
}
public long Close(ServiceCtx context)
2018-02-04 23:08:20 +00:00
{
int fd = context.RequestData.ReadInt32();
2018-02-04 23:08:20 +00:00
Fds.Delete(context.Process, fd);
2018-02-04 23:08:20 +00:00
context.ResponseData.Write(0);
2018-02-04 23:08:20 +00:00
return 0;
}
public long Initialize(ServiceCtx context)
2018-02-04 23:08:20 +00:00
{
long transferMemSize = context.RequestData.ReadInt64();
int transferMemHandle = context.Request.HandleDesc.ToCopy[0];
2018-02-04 23:08:20 +00:00
NvMapIoctl.InitializeNvMap(context);
2018-02-04 23:08:20 +00:00
context.ResponseData.Write(0);
2018-02-04 23:08:20 +00:00
return 0;
}
public long QueryEvent(ServiceCtx context)
2018-02-04 23:08:20 +00:00
{
int fd = context.RequestData.ReadInt32();
int eventId = context.RequestData.ReadInt32();
2018-02-04 23:08:20 +00:00
//TODO: Use Fd/EventId, different channels have different events.
if (context.Process.HandleTable.GenerateHandle(_event.ReadableEvent, out int handle) != KernelResult.Success)
{
throw new InvalidOperationException("Out of handles!");
}
context.Response.HandleDesc = IpcHandleDesc.MakeCopy(handle);
2018-02-04 23:08:20 +00:00
context.ResponseData.Write(0);
2018-02-04 23:08:20 +00:00
return 0;
}
public long SetClientPid(ServiceCtx context)
{
long pid = context.RequestData.ReadInt64();
context.ResponseData.Write(0);
return 0;
}
public long FinishInitialize(ServiceCtx context)
{
Logger.PrintStub(LogClass.ServiceNv, "Stubbed.");
return 0;
}
private static int ProcessIoctlNvGpuAS(ServiceCtx context, int cmd)
2018-02-04 23:08:20 +00:00
{
return ProcessIoctl(context, cmd, NvGpuASIoctl.ProcessIoctl);
2018-02-04 23:08:20 +00:00
}
private static int ProcessIoctlNvHostCtrl(ServiceCtx context, int cmd)
2018-02-04 23:08:20 +00:00
{
return ProcessIoctl(context, cmd, NvHostCtrlIoctl.ProcessIoctl);
2018-02-04 23:08:20 +00:00
}
private static int ProcessIoctlNvGpuGpu(ServiceCtx context, int cmd)
2018-02-04 23:08:20 +00:00
{
return ProcessIoctl(context, cmd, NvGpuGpuIoctl.ProcessIoctl);
2018-02-04 23:08:20 +00:00
}
private static int ProcessIoctlNvHostChannel(ServiceCtx context, int cmd)
2018-02-04 23:08:20 +00:00
{
return ProcessIoctl(context, cmd, NvHostChannelIoctl.ProcessIoctl);
2018-02-04 23:08:20 +00:00
}
private static int ProcessIoctlNvMap(ServiceCtx context, int cmd)
2018-02-04 23:08:20 +00:00
{
return ProcessIoctl(context, cmd, NvMapIoctl.ProcessIoctl);
2018-02-04 23:08:20 +00:00
}
private static int ProcessIoctl(ServiceCtx context, int cmd, IoctlProcessor processor)
2018-02-04 23:08:20 +00:00
{
if (CmdIn(cmd) && context.Request.GetBufferType0x21().Position == 0)
2018-02-04 23:08:20 +00:00
{
Logger.PrintError(LogClass.ServiceNv, "Input buffer is null!");
return NvResult.InvalidInput;
2018-02-04 23:08:20 +00:00
}
if (CmdOut(cmd) && context.Request.GetBufferType0x22().Position == 0)
2018-02-04 23:08:20 +00:00
{
Logger.PrintError(LogClass.ServiceNv, "Output buffer is null!");
return NvResult.InvalidInput;
2018-02-04 23:08:20 +00:00
}
return processor(context, cmd);
2018-02-04 23:08:20 +00:00
}
private static bool CmdIn(int cmd)
{
return ((cmd >> 30) & 1) != 0;
}
private static bool CmdOut(int cmd)
2018-02-04 23:08:20 +00:00
{
return ((cmd >> 31) & 1) != 0;
2018-02-04 23:08:20 +00:00
}
public static void UnloadProcess(KProcess process)
2018-02-04 23:08:20 +00:00
{
Fds.DeleteProcess(process);
NvGpuASIoctl.UnloadProcess(process);
2018-02-04 23:08:20 +00:00
NvHostChannelIoctl.UnloadProcess(process);
NvHostCtrlIoctl.UnloadProcess(process);
2018-02-04 23:08:20 +00:00
NvMapIoctl.UnloadProcess(process);
2018-02-04 23:08:20 +00:00
}
}
}