forked from Mirror/Ryujinx
581 lines
No EOL
20 KiB
C#
581 lines
No EOL
20 KiB
C#
using ChocolArm64.State;
|
|
using Ryujinx.Common.Logging;
|
|
|
|
using static Ryujinx.HLE.HOS.ErrorCode;
|
|
|
|
namespace Ryujinx.HLE.HOS.Kernel
|
|
{
|
|
partial class SvcHandler
|
|
{
|
|
private void SvcSetHeapSize(CpuThreadState ThreadState)
|
|
{
|
|
ulong Size = ThreadState.X1;
|
|
|
|
if ((Size & 0xfffffffe001fffff) != 0)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Heap size 0x{Size:x16} is not aligned!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidSize);
|
|
|
|
return;
|
|
}
|
|
|
|
KernelResult Result = Process.MemoryManager.SetHeapSize(Size, out ulong Position);
|
|
|
|
ThreadState.X0 = (ulong)Result;
|
|
|
|
if (Result == KernelResult.Success)
|
|
{
|
|
ThreadState.X1 = Position;
|
|
}
|
|
else
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Operation failed with error \"{Result}\".");
|
|
}
|
|
}
|
|
|
|
private void SvcSetMemoryAttribute(CpuThreadState ThreadState)
|
|
{
|
|
ulong Position = ThreadState.X0;
|
|
ulong Size = ThreadState.X1;
|
|
|
|
if (!PageAligned(Position))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Address 0x{Position:x16} is not page aligned!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidAddress);
|
|
|
|
return;
|
|
}
|
|
|
|
if (!PageAligned(Size) || Size == 0)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Size 0x{Size:x16} is not page aligned or is zero!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidSize);
|
|
|
|
return;
|
|
}
|
|
|
|
MemoryAttribute AttributeMask = (MemoryAttribute)ThreadState.X2;
|
|
MemoryAttribute AttributeValue = (MemoryAttribute)ThreadState.X3;
|
|
|
|
MemoryAttribute Attributes = AttributeMask | AttributeValue;
|
|
|
|
if (Attributes != AttributeMask ||
|
|
(Attributes | MemoryAttribute.Uncached) != MemoryAttribute.Uncached)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, "Invalid memory attributes!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidMaskValue);
|
|
|
|
return;
|
|
}
|
|
|
|
KernelResult Result = Process.MemoryManager.SetMemoryAttribute(
|
|
Position,
|
|
Size,
|
|
AttributeMask,
|
|
AttributeValue);
|
|
|
|
if (Result != KernelResult.Success)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Operation failed with error \"{Result}\".");
|
|
}
|
|
else
|
|
{
|
|
Memory.StopObservingRegion((long)Position, (long)Size);
|
|
}
|
|
|
|
ThreadState.X0 = (ulong)Result;
|
|
}
|
|
|
|
private void SvcMapMemory(CpuThreadState ThreadState)
|
|
{
|
|
ulong Dst = ThreadState.X0;
|
|
ulong Src = ThreadState.X1;
|
|
ulong Size = ThreadState.X2;
|
|
|
|
if (!PageAligned(Src | Dst))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, "Addresses are not page aligned!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidAddress);
|
|
|
|
return;
|
|
}
|
|
|
|
if (!PageAligned(Size) || Size == 0)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Size 0x{Size:x16} is not page aligned or is zero!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidSize);
|
|
|
|
return;
|
|
}
|
|
|
|
if (Src + Size <= Src || Dst + Size <= Dst)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, "Addresses outside of range!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.NoAccessPerm);
|
|
|
|
return;
|
|
}
|
|
|
|
KProcess CurrentProcess = System.Scheduler.GetCurrentProcess();
|
|
|
|
if (!CurrentProcess.MemoryManager.InsideAddrSpace(Src, Size))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Src address 0x{Src:x16} out of range!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.NoAccessPerm);
|
|
|
|
return;
|
|
}
|
|
|
|
if (CurrentProcess.MemoryManager.OutsideStackRegion(Dst, Size) ||
|
|
CurrentProcess.MemoryManager.InsideHeapRegion (Dst, Size) ||
|
|
CurrentProcess.MemoryManager.InsideAliasRegion (Dst, Size))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Dst address 0x{Dst:x16} out of range!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidMemRange);
|
|
|
|
return;
|
|
}
|
|
|
|
KernelResult Result = Process.MemoryManager.Map(Dst, Src, Size);
|
|
|
|
if (Result != KernelResult.Success)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Operation failed with error 0x{Result:x}!");
|
|
}
|
|
|
|
ThreadState.X0 = (ulong)Result;
|
|
}
|
|
|
|
private void SvcUnmapMemory(CpuThreadState ThreadState)
|
|
{
|
|
ulong Dst = ThreadState.X0;
|
|
ulong Src = ThreadState.X1;
|
|
ulong Size = ThreadState.X2;
|
|
|
|
if (!PageAligned(Src | Dst))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, "Addresses are not page aligned!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidAddress);
|
|
|
|
return;
|
|
}
|
|
|
|
if (!PageAligned(Size) || Size == 0)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Size 0x{Size:x16} is not page aligned or is zero!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidSize);
|
|
|
|
return;
|
|
}
|
|
|
|
if (Src + Size <= Src || Dst + Size <= Dst)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, "Addresses outside of range!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.NoAccessPerm);
|
|
|
|
return;
|
|
}
|
|
|
|
KProcess CurrentProcess = System.Scheduler.GetCurrentProcess();
|
|
|
|
if (!CurrentProcess.MemoryManager.InsideAddrSpace(Src, Size))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Src address 0x{Src:x16} out of range!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.NoAccessPerm);
|
|
|
|
return;
|
|
}
|
|
|
|
if (CurrentProcess.MemoryManager.OutsideStackRegion(Dst, Size) ||
|
|
CurrentProcess.MemoryManager.InsideHeapRegion (Dst, Size) ||
|
|
CurrentProcess.MemoryManager.InsideAliasRegion (Dst, Size))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Dst address 0x{Dst:x16} out of range!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidMemRange);
|
|
|
|
return;
|
|
}
|
|
|
|
KernelResult Result = Process.MemoryManager.Unmap(Dst, Src, Size);
|
|
|
|
if (Result != KernelResult.Success)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Operation failed with error 0x{Result:x}!");
|
|
}
|
|
|
|
ThreadState.X0 = (ulong)Result;
|
|
}
|
|
|
|
private void SvcQueryMemory(CpuThreadState ThreadState)
|
|
{
|
|
long InfoPtr = (long)ThreadState.X0;
|
|
ulong Position = ThreadState.X2;
|
|
|
|
KMemoryInfo BlkInfo = Process.MemoryManager.QueryMemory(Position);
|
|
|
|
Memory.WriteUInt64(InfoPtr + 0x00, BlkInfo.Address);
|
|
Memory.WriteUInt64(InfoPtr + 0x08, BlkInfo.Size);
|
|
Memory.WriteInt32 (InfoPtr + 0x10, (int)BlkInfo.State & 0xff);
|
|
Memory.WriteInt32 (InfoPtr + 0x14, (int)BlkInfo.Attribute);
|
|
Memory.WriteInt32 (InfoPtr + 0x18, (int)BlkInfo.Permission);
|
|
Memory.WriteInt32 (InfoPtr + 0x1c, BlkInfo.IpcRefCount);
|
|
Memory.WriteInt32 (InfoPtr + 0x20, BlkInfo.DeviceRefCount);
|
|
Memory.WriteInt32 (InfoPtr + 0x24, 0);
|
|
|
|
ThreadState.X0 = 0;
|
|
ThreadState.X1 = 0;
|
|
}
|
|
|
|
private void SvcMapSharedMemory(CpuThreadState ThreadState)
|
|
{
|
|
int Handle = (int)ThreadState.X0;
|
|
ulong Address = ThreadState.X1;
|
|
ulong Size = ThreadState.X2;
|
|
|
|
if (!PageAligned(Address))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Address 0x{Address:x16} is not page aligned!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidAddress);
|
|
|
|
return;
|
|
}
|
|
|
|
if (!PageAligned(Size) || Size == 0)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Size 0x{Size:x16} is not page aligned or is zero!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidSize);
|
|
|
|
return;
|
|
}
|
|
|
|
if (Address + Size <= Address)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Invalid region address 0x{Address:x16} / size 0x{Size:x16}!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.NoAccessPerm);
|
|
|
|
return;
|
|
}
|
|
|
|
MemoryPermission Permission = (MemoryPermission)ThreadState.X3;
|
|
|
|
if ((Permission | MemoryPermission.Write) != MemoryPermission.ReadAndWrite)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Invalid permission {Permission}!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidPermission);
|
|
|
|
return;
|
|
}
|
|
|
|
KProcess CurrentProcess = System.Scheduler.GetCurrentProcess();
|
|
|
|
KSharedMemory SharedMemory = CurrentProcess.HandleTable.GetObject<KSharedMemory>(Handle);
|
|
|
|
if (SharedMemory == null)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Invalid shared memory handle 0x{Handle:x8}!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidHandle);
|
|
|
|
return;
|
|
}
|
|
|
|
if (CurrentProcess.MemoryManager.IsInvalidRegion (Address, Size) ||
|
|
CurrentProcess.MemoryManager.InsideHeapRegion (Address, Size) ||
|
|
CurrentProcess.MemoryManager.InsideAliasRegion(Address, Size))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Address 0x{Address:x16} out of range!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.NoAccessPerm);
|
|
|
|
return;
|
|
}
|
|
|
|
KernelResult Result = SharedMemory.MapIntoProcess(
|
|
CurrentProcess.MemoryManager,
|
|
Address,
|
|
Size,
|
|
CurrentProcess,
|
|
Permission);
|
|
|
|
if (Result != KernelResult.Success)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Operation failed with error \"{Result}\".");
|
|
}
|
|
|
|
ThreadState.X0 = (ulong)Result;
|
|
}
|
|
|
|
private void SvcUnmapSharedMemory(CpuThreadState ThreadState)
|
|
{
|
|
int Handle = (int)ThreadState.X0;
|
|
ulong Address = ThreadState.X1;
|
|
ulong Size = ThreadState.X2;
|
|
|
|
if (!PageAligned(Address))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Address 0x{Address:x16} is not page aligned!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidAddress);
|
|
|
|
return;
|
|
}
|
|
|
|
if (!PageAligned(Size) || Size == 0)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Size 0x{Size:x16} is not page aligned or is zero!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidSize);
|
|
|
|
return;
|
|
}
|
|
|
|
if (Address + Size <= Address)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Invalid region address 0x{Address:x16} / size 0x{Size:x16}!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.NoAccessPerm);
|
|
|
|
return;
|
|
}
|
|
|
|
KProcess CurrentProcess = System.Scheduler.GetCurrentProcess();
|
|
|
|
KSharedMemory SharedMemory = CurrentProcess.HandleTable.GetObject<KSharedMemory>(Handle);
|
|
|
|
if (SharedMemory == null)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Invalid shared memory handle 0x{Handle:x8}!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidHandle);
|
|
|
|
return;
|
|
}
|
|
|
|
if (CurrentProcess.MemoryManager.IsInvalidRegion (Address, Size) ||
|
|
CurrentProcess.MemoryManager.InsideHeapRegion (Address, Size) ||
|
|
CurrentProcess.MemoryManager.InsideAliasRegion(Address, Size))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Address 0x{Address:x16} out of range!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.NoAccessPerm);
|
|
|
|
return;
|
|
}
|
|
|
|
KernelResult Result = SharedMemory.UnmapFromProcess(
|
|
CurrentProcess.MemoryManager,
|
|
Address,
|
|
Size,
|
|
CurrentProcess);
|
|
|
|
if (Result != KernelResult.Success)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Operation failed with error \"{Result}\".");
|
|
}
|
|
|
|
ThreadState.X0 = (ulong)Result;
|
|
}
|
|
|
|
private void SvcCreateTransferMemory(CpuThreadState ThreadState)
|
|
{
|
|
ulong Address = ThreadState.X1;
|
|
ulong Size = ThreadState.X2;
|
|
|
|
if (!PageAligned(Address))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Address 0x{Address:x16} is not page aligned!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidAddress);
|
|
|
|
return;
|
|
}
|
|
|
|
if (!PageAligned(Size) || Size == 0)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Size 0x{Size:x16} is not page aligned or is zero!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidAddress);
|
|
|
|
return;
|
|
}
|
|
|
|
if (Address + Size <= Address)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Invalid region address 0x{Address:x16} / size 0x{Size:x16}!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.NoAccessPerm);
|
|
|
|
return;
|
|
}
|
|
|
|
MemoryPermission Permission = (MemoryPermission)ThreadState.X3;
|
|
|
|
if (Permission > MemoryPermission.ReadAndWrite || Permission == MemoryPermission.Write)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Invalid permission {Permission}!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidPermission);
|
|
|
|
return;
|
|
}
|
|
|
|
Process.MemoryManager.ReserveTransferMemory(Address, Size, Permission);
|
|
|
|
KTransferMemory TransferMemory = new KTransferMemory(Address, Size);
|
|
|
|
KernelResult Result = Process.HandleTable.GenerateHandle(TransferMemory, out int Handle);
|
|
|
|
ThreadState.X0 = (uint)Result;
|
|
ThreadState.X1 = (ulong)Handle;
|
|
}
|
|
|
|
private void SvcMapPhysicalMemory(CpuThreadState ThreadState)
|
|
{
|
|
ulong Address = ThreadState.X0;
|
|
ulong Size = ThreadState.X1;
|
|
|
|
if (!PageAligned(Address))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Address 0x{Address:x16} is not page aligned!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidAddress);
|
|
|
|
return;
|
|
}
|
|
|
|
if (!PageAligned(Size) || Size == 0)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Size 0x{Size:x16} is not page aligned or is zero!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidSize);
|
|
|
|
return;
|
|
}
|
|
|
|
if (Address + Size <= Address)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Invalid region address 0x{Address:x16} / size 0x{Size:x16}!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.NoAccessPerm);
|
|
|
|
return;
|
|
}
|
|
|
|
KProcess CurrentProcess = System.Scheduler.GetCurrentProcess();
|
|
|
|
if ((CurrentProcess.PersonalMmHeapPagesCount & 0xfffffffffffff) == 0)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"System resource size is zero.");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidState);
|
|
|
|
return;
|
|
}
|
|
|
|
if (!CurrentProcess.MemoryManager.InsideAddrSpace (Address, Size) ||
|
|
CurrentProcess.MemoryManager.OutsideAliasRegion(Address, Size))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Invalid address {Address:x16}.");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.NoAccessPerm);
|
|
|
|
return;
|
|
}
|
|
|
|
KernelResult Result = Process.MemoryManager.MapPhysicalMemory(Address, Size);
|
|
|
|
if (Result != KernelResult.Success)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Operation failed with error 0x{Result:x}!");
|
|
}
|
|
|
|
ThreadState.X0 = (ulong)Result;
|
|
}
|
|
|
|
private void SvcUnmapPhysicalMemory(CpuThreadState ThreadState)
|
|
{
|
|
ulong Address = ThreadState.X0;
|
|
ulong Size = ThreadState.X1;
|
|
|
|
if (!PageAligned(Address))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Address 0x{Address:x16} is not page aligned!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidAddress);
|
|
|
|
return;
|
|
}
|
|
|
|
if (!PageAligned(Size) || Size == 0)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Size 0x{Size:x16} is not page aligned or is zero!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidSize);
|
|
|
|
return;
|
|
}
|
|
|
|
if (Address + Size <= Address)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Invalid region address 0x{Address:x16} / size 0x{Size:x16}!");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.NoAccessPerm);
|
|
|
|
return;
|
|
}
|
|
|
|
KProcess CurrentProcess = System.Scheduler.GetCurrentProcess();
|
|
|
|
if ((CurrentProcess.PersonalMmHeapPagesCount & 0xfffffffffffff) == 0)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"System resource size is zero.");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.InvalidState);
|
|
|
|
return;
|
|
}
|
|
|
|
if (!CurrentProcess.MemoryManager.InsideAddrSpace (Address, Size) ||
|
|
CurrentProcess.MemoryManager.OutsideAliasRegion(Address, Size))
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Invalid address {Address:x16}.");
|
|
|
|
ThreadState.X0 = MakeError(ErrorModule.Kernel, KernelErr.NoAccessPerm);
|
|
|
|
return;
|
|
}
|
|
|
|
KernelResult Result = Process.MemoryManager.UnmapPhysicalMemory(Address, Size);
|
|
|
|
if (Result != KernelResult.Success)
|
|
{
|
|
Logger.PrintWarning(LogClass.KernelSvc, $"Operation failed with error 0x{Result:x}!");
|
|
}
|
|
|
|
ThreadState.X0 = (ulong)Result;
|
|
}
|
|
|
|
private static bool PageAligned(ulong Position)
|
|
{
|
|
return (Position & (KMemoryManager.PageSize - 1)) == 0;
|
|
}
|
|
}
|
|
} |