Ryujinx/Ryujinx.Core/OsHle/Services/Nv/INvDrvServices.cs

229 lines
6.5 KiB
C#
Raw Normal View History

2018-02-05 00:08:20 +01:00
using ChocolArm64.Memory;
2018-04-24 20:57:39 +02:00
using Ryujinx.Core.Logging;
using Ryujinx.Core.OsHle.Handles;
using Ryujinx.Core.OsHle.Ipc;
using Ryujinx.Core.OsHle.Services.Nv.NvGpuAS;
using Ryujinx.Core.OsHle.Services.Nv.NvGpuGpu;
using Ryujinx.Core.OsHle.Services.Nv.NvHostChannel;
using Ryujinx.Core.OsHle.Services.Nv.NvHostCtrl;
using Ryujinx.Core.OsHle.Services.Nv.NvMap;
2018-02-05 00:08:20 +01:00
using System;
using System.Collections.Generic;
2018-03-20 21:00:00 +01:00
namespace Ryujinx.Core.OsHle.Services.Nv
2018-02-05 00:08:20 +01:00
{
class INvDrvServices : IpcService, IDisposable
2018-02-05 00:08:20 +01:00
{
private delegate int IoctlProcessor(ServiceCtx Context, int Cmd);
2018-02-05 00:08:20 +01:00
private Dictionary<int, ServiceProcessRequest> m_Commands;
public override IReadOnlyDictionary<int, ServiceProcessRequest> Commands => m_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/nvmap", ProcessIoctlNvMap }
};
public static GlobalStateTable Fds { get; private set; }
private KEvent Event;
public INvDrvServices()
{
m_Commands = new Dictionary<int, ServiceProcessRequest>()
{
{ 0, Open },
{ 1, Ioctl },
{ 2, Close },
{ 3, Initialize },
{ 4, QueryEvent },
{ 8, SetClientPid },
{ 13, FinishInitialize }
};
Event = new KEvent();
}
static INvDrvServices()
{
Fds = new GlobalStateTable();
}
public long Open(ServiceCtx Context)
2018-02-05 00:08:20 +01:00
{
long NamePtr = Context.Request.SendBuff[0].Position;
string Name = AMemoryHelper.ReadAsciiString(Context.Memory, NamePtr);
int Fd = Fds.Add(Context.Process, new NvFd(Name));
2018-02-05 00:08:20 +01:00
Context.ResponseData.Write(Fd);
Context.ResponseData.Write(0);
return 0;
}
public long Ioctl(ServiceCtx Context)
2018-02-05 00:08:20 +01:00
{
int Fd = Context.RequestData.ReadInt32();
int Cmd = Context.RequestData.ReadInt32();
NvFd FdData = Fds.GetData<NvFd>(Context.Process, Fd);
2018-02-05 00:08:20 +01:00
int Result;
2018-02-05 00:08:20 +01:00
if (IoctlProcessors.TryGetValue(FdData.Name, out IoctlProcessor Process))
2018-02-05 00:08:20 +01:00
{
Result = Process(Context, Cmd);
2018-02-05 00:08:20 +01:00
}
else
{
throw new NotImplementedException($"{FdData.Name} {Cmd:x4}");
}
//TODO: Verify if the error codes needs to be translated.
Context.ResponseData.Write(Result);
return 0;
2018-02-05 00:08:20 +01:00
}
public long Close(ServiceCtx Context)
2018-02-05 00:08:20 +01:00
{
int Fd = Context.RequestData.ReadInt32();
Fds.Delete(Context.Process, Fd);
2018-02-05 00:08:20 +01:00
Context.ResponseData.Write(0);
return 0;
}
public long Initialize(ServiceCtx Context)
2018-02-05 00:08:20 +01:00
{
long TransferMemSize = Context.RequestData.ReadInt64();
int TransferMemHandle = Context.Request.HandleDesc.ToCopy[0];
NvMapIoctl.InitializeNvMap(Context);
2018-02-05 00:08:20 +01:00
Context.ResponseData.Write(0);
2018-02-05 00:08:20 +01:00
return 0;
}
public long QueryEvent(ServiceCtx Context)
2018-02-05 00:08:20 +01:00
{
int Fd = Context.RequestData.ReadInt32();
int EventId = Context.RequestData.ReadInt32();
//TODO: Use Fd/EventId, different channels have different events.
int Handle = Context.Process.HandleTable.OpenHandle(Event);
Context.Response.HandleDesc = IpcHandleDesc.MakeCopy(Handle);
2018-02-05 00:08:20 +01:00
Context.ResponseData.Write(0);
return 0;
}
public long SetClientPid(ServiceCtx Context)
{
long Pid = Context.RequestData.ReadInt64();
Context.ResponseData.Write(0);
return 0;
}
public long FinishInitialize(ServiceCtx Context)
{
Context.Ns.Log.PrintStub(LogClass.ServiceNv, "Stubbed.");
return 0;
}
private static int ProcessIoctlNvGpuAS(ServiceCtx Context, int Cmd)
2018-02-05 00:08:20 +01:00
{
return ProcessIoctl(Context, Cmd, NvGpuASIoctl.ProcessIoctl);
2018-02-05 00:08:20 +01:00
}
private static int ProcessIoctlNvHostCtrl(ServiceCtx Context, int Cmd)
2018-02-05 00:08:20 +01:00
{
return ProcessIoctl(Context, Cmd, NvHostCtrlIoctl.ProcessIoctl);
2018-02-05 00:08:20 +01:00
}
private static int ProcessIoctlNvGpuGpu(ServiceCtx Context, int Cmd)
2018-02-05 00:08:20 +01:00
{
return ProcessIoctl(Context, Cmd, NvGpuGpuIoctl.ProcessIoctl);
2018-02-05 00:08:20 +01:00
}
private static int ProcessIoctlNvHostChannel(ServiceCtx Context, int Cmd)
2018-02-05 00:08:20 +01:00
{
return ProcessIoctl(Context, Cmd, NvHostChannelIoctl.ProcessIoctl);
2018-02-05 00:08:20 +01:00
}
private static int ProcessIoctlNvMap(ServiceCtx Context, int Cmd)
2018-02-05 00:08:20 +01:00
{
return ProcessIoctl(Context, Cmd, NvMapIoctl.ProcessIoctl);
2018-02-05 00:08:20 +01:00
}
private static int ProcessIoctl(ServiceCtx Context, int Cmd, IoctlProcessor Processor)
2018-02-05 00:08:20 +01:00
{
if (CmdIn(Cmd) && Context.Request.GetBufferType0x21().Position == 0)
2018-02-05 00:08:20 +01:00
{
Context.Ns.Log.PrintError(LogClass.ServiceNv, "Input buffer is null!");
return NvResult.InvalidInput;
2018-02-05 00:08:20 +01:00
}
if (CmdOut(Cmd) && Context.Request.GetBufferType0x22().Position == 0)
2018-02-05 00:08:20 +01:00
{
Context.Ns.Log.PrintError(LogClass.ServiceNv, "Output buffer is null!");
return NvResult.InvalidInput;
2018-02-05 00:08:20 +01:00
}
return Processor(Context, Cmd);
2018-02-05 00:08:20 +01:00
}
private static bool CmdIn(int Cmd)
{
return ((Cmd >> 30) & 1) != 0;
}
private static bool CmdOut(int Cmd)
2018-02-05 00:08:20 +01:00
{
return ((Cmd >> 31) & 1) != 0;
2018-02-05 00:08:20 +01:00
}
public static void UnloadProcess(Process Process)
2018-02-05 00:08:20 +01:00
{
Fds.DeleteProcess(Process);
NvGpuASIoctl.UnloadProcess(Process);
2018-02-05 00:08:20 +01:00
NvHostCtrlIoctl.UnloadProcess(Process);
2018-02-05 00:08:20 +01:00
NvMapIoctl.UnloadProcess(Process);
2018-02-05 00:08:20 +01:00
}
public void Dispose()
{
Dispose(true);
}
protected virtual void Dispose(bool Disposing)
{
if (Disposing)
{
Event.Dispose();
}
}
2018-02-05 00:08:20 +01:00
}
}