Somewhat better scheduler I guess

This commit is contained in:
gdkchan 2018-02-19 16:37:13 -03:00
parent 8df0b62fe0
commit 770cb4b655
10 changed files with 323 additions and 282 deletions

View file

@ -1,6 +1,5 @@
using System.IO; using System.IO;
using System.Text; using System.Text;
using System.Threading;
namespace ChocolArm64.Memory namespace ChocolArm64.Memory
{ {
@ -21,32 +20,6 @@ namespace ChocolArm64.Memory
} }
} }
public static int ReadInt32Exclusive(AMemory Memory, long Position)
{
while (!Memory.AcquireAddress(Position))
{
Thread.Yield();
}
int Value = Memory.ReadInt32(Position);
Memory.ReleaseAddress(Position);
return Value;
}
public static void WriteInt32Exclusive(AMemory Memory, long Position, int Value)
{
while (!Memory.AcquireAddress(Position))
{
Thread.Yield();
}
Memory.WriteInt32(Position, Value);
Memory.ReleaseAddress(Position);
}
public static byte[] ReadBytes(AMemory Memory, long Position, int Size) public static byte[] ReadBytes(AMemory Memory, long Position, int Size)
{ {
byte[] Data = new byte[Size]; byte[] Data = new byte[Size];

View file

@ -1,6 +1,6 @@
using ChocolArm64.Memory;
using Ryujinx.OsHle.Handles; using Ryujinx.OsHle.Handles;
using System.Collections.Generic; using System.Collections.Generic;
using System.Threading;
namespace Ryujinx.OsHle namespace Ryujinx.OsHle
{ {
@ -11,6 +11,8 @@ namespace Ryujinx.OsHle
private long CondVarAddress; private long CondVarAddress;
private long Timeout; private long Timeout;
private bool OwnsCondVarValue;
private List<HThread> WaitingThreads; private List<HThread> WaitingThreads;
public CondVar(Process Process, long CondVarAddress, long Timeout) public CondVar(Process Process, long CondVarAddress, long Timeout)
@ -24,34 +26,43 @@ namespace Ryujinx.OsHle
public void WaitForSignal(HThread Thread) public void WaitForSignal(HThread Thread)
{ {
int Count = ReadCondVarValue(); int Count = Process.Memory.ReadInt32(CondVarAddress);
if (Count <= 0) if (Count <= 0)
{ {
//FIXME: We shouldn't need to do that?
Process.Scheduler.Yield(Thread);
return;
}
WriteCondVarValue(Count - 1);
lock (WaitingThreads) lock (WaitingThreads)
{ {
WaitingThreads.Add(Thread); WaitingThreads.Add(Thread);
} }
if (Timeout != -1) if (Timeout == -1)
{
Process.Scheduler.WaitForSignal(Thread, (int)(Timeout / 1000000));
}
else
{ {
Process.Scheduler.WaitForSignal(Thread); Process.Scheduler.WaitForSignal(Thread);
} }
else
{
Process.Scheduler.WaitForSignal(Thread, (int)(Timeout / 1000000));
lock (WaitingThreads)
{
WaitingThreads.Remove(Thread);
}
}
} }
public void SetSignal(int Count) AcquireCondVarValue();
Count = Process.Memory.ReadInt32(CondVarAddress);
if (Count > 0)
{
Process.Memory.WriteInt32(CondVarAddress, Count - 1);
}
ReleaseCondVarValue();
}
public void SetSignal(HThread Thread, int Count)
{ {
lock (WaitingThreads) lock (WaitingThreads)
{ {
@ -59,7 +70,11 @@ namespace Ryujinx.OsHle
{ {
Process.Scheduler.Signal(WaitingThreads.ToArray()); Process.Scheduler.Signal(WaitingThreads.ToArray());
WriteCondVarValue(WaitingThreads.Count); AcquireCondVarValue();
Process.Memory.WriteInt32(CondVarAddress, WaitingThreads.Count);
ReleaseCondVarValue();
WaitingThreads.Clear(); WaitingThreads.Clear();
} }
@ -85,19 +100,39 @@ namespace Ryujinx.OsHle
WaitingThreads.RemoveAt(HighestPrioIndex); WaitingThreads.RemoveAt(HighestPrioIndex);
} }
WriteCondVarValue(Count); AcquireCondVarValue();
}
Process.Memory.WriteInt32(CondVarAddress, Count);
ReleaseCondVarValue();
} }
} }
private int ReadCondVarValue() Process.Scheduler.Suspend(Thread.ProcessorId);
{ Process.Scheduler.Resume(Thread);
return AMemoryHelper.ReadInt32Exclusive(Process.Memory, CondVarAddress);
} }
private void WriteCondVarValue(int Value) private void AcquireCondVarValue()
{ {
AMemoryHelper.WriteInt32Exclusive(Process.Memory, CondVarAddress, Value); if (!OwnsCondVarValue)
{
while (!Process.Memory.AcquireAddress(CondVarAddress))
{
Thread.Yield();
}
OwnsCondVarValue = true;
}
}
private void ReleaseCondVarValue()
{
if (OwnsCondVarValue)
{
OwnsCondVarValue = false;
Process.Memory.ReleaseAddress(CondVarAddress);
}
} }
} }
} }

View file

@ -1,4 +1,5 @@
using System; using System;
using System.Collections.Concurrent;
using System.Collections.Generic; using System.Collections.Generic;
using System.Threading; using System.Threading;
@ -6,19 +7,8 @@ namespace Ryujinx.OsHle.Handles
{ {
class KProcessScheduler : IDisposable class KProcessScheduler : IDisposable
{ {
private enum ThreadState
{
WaitingToRun,
WaitingSignal,
Running
}
private class SchedulerThread : IDisposable private class SchedulerThread : IDisposable
{ {
public bool Signaled { get; set; }
public ThreadState State { get; set; }
public HThread Thread { get; private set; } public HThread Thread { get; private set; }
public AutoResetEvent WaitEvent { get; private set; } public AutoResetEvent WaitEvent { get; private set; }
@ -44,9 +34,70 @@ namespace Ryujinx.OsHle.Handles
} }
} }
private Dictionary<HThread, SchedulerThread> AllThreads; private class ThreadQueue
{
private List<SchedulerThread> Threads;
private Queue<SchedulerThread>[] WaitingThreads; public ThreadQueue()
{
Threads = new List<SchedulerThread>();
}
public void Push(SchedulerThread Thread)
{
lock (Threads)
{
Threads.Add(Thread);
}
}
public SchedulerThread Pop(int MinPriority = 0x40)
{
lock (Threads)
{
SchedulerThread SchedThread;
int HighestPriority = MinPriority;
int HighestPrioIndex = -1;
for (int Index = 0; Index < Threads.Count; Index++)
{
SchedThread = Threads[Index];
if (HighestPriority > SchedThread.Thread.Priority)
{
HighestPriority = SchedThread.Thread.Priority;
HighestPrioIndex = Index;
}
}
if (HighestPrioIndex == -1)
{
return null;
}
SchedThread = Threads[HighestPrioIndex];
Threads.RemoveAt(HighestPrioIndex);
return SchedThread;
}
}
public bool HasThread(SchedulerThread SchedThread)
{
lock (Threads)
{
return Threads.Contains(SchedThread);
}
}
}
private ConcurrentDictionary<HThread, SchedulerThread> AllThreads;
private ThreadQueue[] WaitingToRun;
private HashSet<int> ActiveProcessors; private HashSet<int> ActiveProcessors;
@ -54,13 +105,13 @@ namespace Ryujinx.OsHle.Handles
public KProcessScheduler() public KProcessScheduler()
{ {
AllThreads = new Dictionary<HThread, SchedulerThread>(); AllThreads = new ConcurrentDictionary<HThread, SchedulerThread>();
WaitingThreads = new Queue<SchedulerThread>[4]; WaitingToRun = new ThreadQueue[4];
for (int Index = 0; Index < WaitingThreads.Length; Index++) for (int Index = 0; Index < 4; Index++)
{ {
WaitingThreads[Index] = new Queue<SchedulerThread>(); WaitingToRun[Index] = new ThreadQueue();
} }
ActiveProcessors = new HashSet<int>(); ActiveProcessors = new HashSet<int>();
@ -72,132 +123,171 @@ namespace Ryujinx.OsHle.Handles
{ {
lock (SchedLock) lock (SchedLock)
{ {
if (AllThreads.ContainsKey(Thread)) SchedulerThread SchedThread = new SchedulerThread(Thread);
if (!AllThreads.TryAdd(Thread, SchedThread))
{ {
return; return;
} }
SchedulerThread SchedThread = new SchedulerThread(Thread);
AllThreads.Add(Thread, SchedThread);
if (!ActiveProcessors.Contains(Thread.ProcessorId)) if (!ActiveProcessors.Contains(Thread.ProcessorId))
{ {
ActiveProcessors.Add(Thread.ProcessorId); ActiveProcessors.Add(Thread.ProcessorId);
Thread.Thread.Execute(); Thread.Thread.Execute();
SetThreadAsRunning(SchedThread); Logging.Debug($"{GetDbgThreadInfo(Thread)} running.");
SchedThread.State = ThreadState.Running;
} }
else else
{ {
InsertSorted(SchedThread); WaitingToRun[Thread.ProcessorId].Push(SchedThread);
SchedThread.State = ThreadState.WaitingToRun;
Logging.Debug($"{GetDbgThreadInfo(SchedThread.Thread)} waiting to run."); Logging.Debug($"{GetDbgThreadInfo(SchedThread.Thread)} waiting to run.");
} }
} }
} }
public void WaitForSignal(HThread Thread, int TimeoutMs) public void Suspend(int ProcessorId)
{ {
Logging.Debug($"{GetDbgThreadInfo(Thread)} entering signal wait state with timeout."); lock (SchedLock)
{
SchedulerThread SchedThread = WaitingToRun[ProcessorId].Pop();
PutThreadToWait(Thread, ThreadState.WaitingSignal, TimeoutMs); if (SchedThread != null)
{
RunThread(SchedThread);
}
else
{
ActiveProcessors.Remove(ProcessorId);
}
}
} }
public void WaitForSignal(HThread Thread) public void Resume(HThread CurrThread)
{ {
SchedulerThread SchedThread;
Logging.Debug($"{GetDbgThreadInfo(CurrThread)} entering ipc delay wait state.");
lock (SchedLock)
{
if (!AllThreads.TryGetValue(CurrThread, out SchedThread))
{
Logging.Error($"{GetDbgThreadInfo(CurrThread)} was not found on the scheduler queue!");
return;
}
}
TryResumingExecution(SchedThread);
}
public void WaitForSignal(HThread Thread, int Timeout = -1)
{
SchedulerThread SchedThread;
Logging.Debug($"{GetDbgThreadInfo(Thread)} entering signal wait state."); Logging.Debug($"{GetDbgThreadInfo(Thread)} entering signal wait state.");
PutThreadToWait(Thread, ThreadState.WaitingSignal); lock (SchedLock)
{
SchedThread = WaitingToRun[Thread.ProcessorId].Pop();
if (SchedThread != null)
{
RunThread(SchedThread);
}
else
{
ActiveProcessors.Remove(Thread.ProcessorId);
}
if (!AllThreads.TryGetValue(Thread, out SchedThread))
{
Logging.Error($"{GetDbgThreadInfo(Thread)} was not found on the scheduler queue!");
return;
}
}
if (Timeout >= 0)
{
Logging.Debug($"{GetDbgThreadInfo(Thread)} has wait timeout of {Timeout}ms.");
SchedThread.WaitEvent.WaitOne(Timeout);
}
else
{
SchedThread.WaitEvent.WaitOne();
}
TryResumingExecution(SchedThread);
}
private void TryResumingExecution(SchedulerThread SchedThread)
{
HThread Thread = SchedThread.Thread;
lock (SchedLock)
{
if (ActiveProcessors.Add(Thread.ProcessorId))
{
Logging.Debug($"{GetDbgThreadInfo(Thread)} resuming execution...");
return;
}
WaitingToRun[Thread.ProcessorId].Push(SchedThread);
}
SchedThread.WaitEvent.WaitOne();
Logging.Debug($"{GetDbgThreadInfo(Thread)} resuming execution...");
} }
public void Yield(HThread Thread) public void Yield(HThread Thread)
{
Logging.Debug($"{GetDbgThreadInfo(Thread)} yielded execution.");
if (WaitingThreads[Thread.ProcessorId].Count == 0)
{
Logging.Debug($"{GetDbgThreadInfo(Thread)} resumed because theres nothing to run.");
return;
}
PutThreadToWait(Thread, ThreadState.WaitingToRun);
}
private void PutThreadToWait(HThread Thread, ThreadState State, int TimeoutMs = -1)
{ {
SchedulerThread SchedThread; SchedulerThread SchedThread;
Logging.Debug($"{GetDbgThreadInfo(Thread)} yielded execution.");
lock (SchedLock) lock (SchedLock)
{ {
SchedThread = WaitingToRun[Thread.ProcessorId].Pop(Thread.Priority);
if (SchedThread == null)
{
Logging.Debug($"{GetDbgThreadInfo(Thread)} resumed because theres nothing better to run.");
return;
}
RunThread(SchedThread);
if (!AllThreads.TryGetValue(Thread, out SchedThread)) if (!AllThreads.TryGetValue(Thread, out SchedThread))
{ {
return; Logging.Error($"{GetDbgThreadInfo(Thread)} was not found on the scheduler queue!");
}
if (SchedThread.Signaled && SchedThread.State == ThreadState.WaitingSignal)
{
SchedThread.Signaled = false;
return; return;
} }
ActiveProcessors.Remove(Thread.ProcessorId); WaitingToRun[Thread.ProcessorId].Push(SchedThread);
SchedThread.State = State;
TryRunningWaitingThead(SchedThread.Thread.ProcessorId);
if (State == ThreadState.WaitingSignal)
{
InsertSorted(SchedThread);
}
else
{
InsertAtEnd(SchedThread);
}
}
if (TimeoutMs >= 0)
{
Logging.Debug($"{GetDbgThreadInfo(SchedThread.Thread)} waiting with timeout of {TimeoutMs}ms.");
SchedThread.WaitEvent.WaitOne(TimeoutMs);
}
else
{
Logging.Debug($"{GetDbgThreadInfo(SchedThread.Thread)} waiting indefinitely.");
SchedThread.WaitEvent.WaitOne();
}
while (true)
{
lock (SchedLock)
{
Logging.Debug($"Trying to run {GetDbgThreadInfo(SchedThread.Thread)}.");
if (!ActiveProcessors.Contains(SchedThread.Thread.ProcessorId))
{
SetThreadAsRunning(SchedThread);
break;
}
else
{
SchedThread.State = ThreadState.WaitingToRun;
Logging.Debug($"{GetDbgThreadInfo(SchedThread.Thread)} waiting to run.");
}
} }
SchedThread.WaitEvent.WaitOne(); SchedThread.WaitEvent.WaitOne();
Logging.Debug($"{GetDbgThreadInfo(Thread)} resuming execution...");
}
private void RunThread(SchedulerThread SchedThread)
{
if (!SchedThread.Thread.Thread.Execute())
{
SchedThread.WaitEvent.Set();
}
else
{
Logging.Debug($"{GetDbgThreadInfo(SchedThread.Thread)} running.");
} }
} }
@ -205,105 +295,19 @@ namespace Ryujinx.OsHle.Handles
{ {
lock (SchedLock) lock (SchedLock)
{ {
HashSet<int> SignaledProcessorIds = new HashSet<int>();
foreach (HThread Thread in Threads) foreach (HThread Thread in Threads)
{
if (AllThreads.TryGetValue(Thread, out SchedulerThread SchedThread))
{
if (!WaitingToRun[Thread.ProcessorId].HasThread(SchedThread))
{ {
Logging.Debug($"{GetDbgThreadInfo(Thread)} signaled."); Logging.Debug($"{GetDbgThreadInfo(Thread)} signaled.");
if (AllThreads.TryGetValue(Thread, out SchedulerThread SchedThread))
{
if (SchedThread.State == ThreadState.WaitingSignal)
{
SchedThread.State = ThreadState.WaitingToRun;
SignaledProcessorIds.Add(Thread.ProcessorId);
}
SchedThread.Signaled = true;
}
}
foreach (int ProcessorId in SignaledProcessorIds)
{
TryRunningWaitingThead(ProcessorId);
}
}
}
private void TryRunningWaitingThead(int ProcessorId)
{
Logging.Debug($"TryRunningWaitingThead core {ProcessorId}.");
lock (SchedLock)
{
if (!ActiveProcessors.Contains(ProcessorId) && WaitingThreads[ProcessorId].Count > 0)
{
SchedulerThread SchedThread = WaitingThreads[ProcessorId].Dequeue();
Logging.Debug($"Now trying to run {GetDbgThreadInfo(SchedThread.Thread)}.");
if (!SchedThread.Thread.Thread.Execute())
{
SchedThread.WaitEvent.Set(); SchedThread.WaitEvent.Set();
} }
else
{
SetThreadAsRunning(SchedThread);
}
}
else
{
Logging.Debug($"Processor id {ProcessorId} already being used or no waiting threads.");
} }
} }
} }
private void SetThreadAsRunning(SchedulerThread SchedThread)
{
ActiveProcessors.Add(SchedThread.Thread.ProcessorId);
SchedThread.State = ThreadState.Running;
SchedThread.Signaled = false;
Logging.Debug($"{GetDbgThreadInfo(SchedThread.Thread)} running.");
}
private void InsertSorted(SchedulerThread SchedThread)
{
HThread Thread = SchedThread.Thread;
Queue<SchedulerThread> CoreQueue = WaitingThreads[Thread.ProcessorId];
Queue<SchedulerThread> TempQueue = new Queue<SchedulerThread>(CoreQueue.Count);
while (CoreQueue.Count > 0)
{
if (CoreQueue.Peek().Thread.Priority >= Thread.Priority)
{
break;
}
TempQueue.Enqueue(CoreQueue.Dequeue());
}
CoreQueue.Enqueue(SchedThread);
while (CoreQueue.Count > 0)
{
TempQueue.Enqueue(CoreQueue.Dequeue());
}
while (TempQueue.Count > 0)
{
CoreQueue.Enqueue(TempQueue.Dequeue());
}
}
private void InsertAtEnd(SchedulerThread SchedThread)
{
WaitingThreads[SchedThread.Thread.ProcessorId].Enqueue(SchedThread);
} }
private string GetDbgThreadInfo(HThread Thread) private string GetDbgThreadInfo(HThread Thread)
@ -320,15 +324,10 @@ namespace Ryujinx.OsHle.Handles
{ {
if (Disposing) if (Disposing)
{ {
foreach (Queue<SchedulerThread> SchedThreads in WaitingThreads) foreach (SchedulerThread SchedThread in AllThreads.Values)
{
foreach (SchedulerThread SchedThread in SchedThreads)
{ {
SchedThread.Dispose(); SchedThread.Dispose();
} }
SchedThreads.Clear();
}
} }
} }
} }

View file

@ -1,6 +1,6 @@
using ChocolArm64.Memory;
using Ryujinx.OsHle.Handles; using Ryujinx.OsHle.Handles;
using System.Collections.Concurrent; using System.Collections.Concurrent;
using System.Threading;
namespace Ryujinx.OsHle namespace Ryujinx.OsHle
{ {
@ -12,6 +12,8 @@ namespace Ryujinx.OsHle
private long MutexAddress; private long MutexAddress;
private bool OwnsMutexValue;
private object EnterWaitLock; private object EnterWaitLock;
private ConcurrentQueue<HThread> WaitingThreads; private ConcurrentQueue<HThread> WaitingThreads;
@ -30,9 +32,11 @@ namespace Ryujinx.OsHle
public void WaitForLock(HThread RequestingThread, int RequestingThreadHandle) public void WaitForLock(HThread RequestingThread, int RequestingThreadHandle)
{ {
AcquireMutexValue();
lock (EnterWaitLock) lock (EnterWaitLock)
{ {
int CurrentThreadHandle = ReadMutexValue() & ~MutexHasListenersMask; int CurrentThreadHandle = Process.Memory.ReadInt32(MutexAddress) & ~MutexHasListenersMask;
if (CurrentThreadHandle == RequestingThreadHandle || if (CurrentThreadHandle == RequestingThreadHandle ||
CurrentThreadHandle == 0) CurrentThreadHandle == 0)
@ -40,7 +44,9 @@ namespace Ryujinx.OsHle
return; return;
} }
WriteMutexValue(CurrentThreadHandle | MutexHasListenersMask); Process.Memory.WriteInt32(MutexAddress, CurrentThreadHandle | MutexHasListenersMask);
ReleaseMutexValue();
WaitingThreads.Enqueue(RequestingThread); WaitingThreads.Enqueue(RequestingThread);
} }
@ -50,24 +56,32 @@ namespace Ryujinx.OsHle
public void GiveUpLock(int ThreadHandle) public void GiveUpLock(int ThreadHandle)
{ {
AcquireMutexValue();
lock (EnterWaitLock) lock (EnterWaitLock)
{ {
int CurrentThread = ReadMutexValue() & ~MutexHasListenersMask; int CurrentThread = Process.Memory.ReadInt32(MutexAddress) & ~MutexHasListenersMask;
if (CurrentThread == ThreadHandle) if (CurrentThread == ThreadHandle)
{ {
Unlock(); Unlock();
} }
} }
ReleaseMutexValue();
} }
public void Unlock() public void Unlock()
{ {
AcquireMutexValue();
lock (EnterWaitLock) lock (EnterWaitLock)
{ {
int HasListeners = WaitingThreads.Count > 1 ? MutexHasListenersMask : 0; int HasListeners = WaitingThreads.Count > 1 ? MutexHasListenersMask : 0;
WriteMutexValue(HasListeners); Process.Memory.WriteInt32(MutexAddress, HasListeners);
ReleaseMutexValue();
HThread[] UnlockedThreads = new HThread[WaitingThreads.Count]; HThread[] UnlockedThreads = new HThread[WaitingThreads.Count];
@ -82,14 +96,27 @@ namespace Ryujinx.OsHle
} }
} }
private int ReadMutexValue() private void AcquireMutexValue()
{ {
return AMemoryHelper.ReadInt32Exclusive(Process.Memory, MutexAddress); if (!OwnsMutexValue)
{
while (!Process.Memory.AcquireAddress(MutexAddress))
{
Thread.Yield();
} }
private void WriteMutexValue(int Value) OwnsMutexValue = true;
}
}
private void ReleaseMutexValue()
{ {
AMemoryHelper.WriteInt32Exclusive(Process.Memory, MutexAddress, Value); if (OwnsMutexValue)
{
OwnsMutexValue = false;
Process.Memory.ReleaseAddress(MutexAddress);
}
} }
} }
} }

View file

@ -231,9 +231,14 @@ namespace Ryujinx.OsHle
return (int)((Position - TlsPageAddr) / TlsSize); return (int)((Position - TlsPageAddr) / TlsSize);
} }
public bool TryGetThread(long Tpidr, out HThread Thread) public HThread GetThread(long Tpidr)
{ {
return ThreadsByTpidr.TryGetValue(Tpidr, out Thread); if (!ThreadsByTpidr.TryGetValue(Tpidr, out HThread Thread))
{
Logging.Error($"Thread with TPIDR 0x{Tpidr:x16} not found!");
}
return Thread;
} }
public void Dispose() public void Dispose()

View file

@ -4,6 +4,7 @@ using Ryujinx.OsHle.Exceptions;
using Ryujinx.OsHle.Handles; using Ryujinx.OsHle.Handles;
using Ryujinx.OsHle.Ipc; using Ryujinx.OsHle.Ipc;
using System; using System;
using System.Threading;
namespace Ryujinx.OsHle.Svc namespace Ryujinx.OsHle.Svc
{ {
@ -37,16 +38,10 @@ namespace Ryujinx.OsHle.Svc
//TODO: Implement events. //TODO: Implement events.
//Logging.Info($"SvcWaitSynchronization Thread {ThreadState.ThreadId}"); HThread CurrThread = Process.GetThread(ThreadState.Tpidr);
if (Process.TryGetThread(ThreadState.Tpidr, out HThread Thread)) Process.Scheduler.Suspend(CurrThread.ProcessorId);
{ Process.Scheduler.Resume(CurrThread);
Process.Scheduler.Yield(Thread);
}
else
{
Logging.Error($"Thread with TPIDR_EL0 0x{ThreadState.Tpidr:x16} not found!");
}
ThreadState.X0 = (int)SvcResult.Success; ThreadState.X0 = (int)SvcResult.Success;
} }
@ -99,6 +94,10 @@ namespace Ryujinx.OsHle.Svc
Handle = (int)ThreadState.X0; Handle = (int)ThreadState.X0;
} }
HThread CurrThread = Process.GetThread(ThreadState.Tpidr);
Process.Scheduler.Suspend(CurrThread.ProcessorId);
byte[] CmdData = AMemoryHelper.ReadBytes(Memory, CmdPtr, (int)Size); byte[] CmdData = AMemoryHelper.ReadBytes(Memory, CmdPtr, (int)Size);
HSession Session = Ns.Os.Handles.GetData<HSession>(Handle); HSession Session = Ns.Os.Handles.GetData<HSession>(Handle);
@ -117,6 +116,10 @@ namespace Ryujinx.OsHle.Svc
{ {
ThreadState.X0 = (int)SvcResult.ErrBadIpcReq; ThreadState.X0 = (int)SvcResult.ErrBadIpcReq;
} }
Thread.Yield();
Process.Scheduler.Resume(CurrThread);
} }
private void SvcBreak(AThreadState ThreadState) private void SvcBreak(AThreadState ThreadState)

View file

@ -1,6 +1,5 @@
using ChocolArm64.State; using ChocolArm64.State;
using Ryujinx.OsHle.Handles; using Ryujinx.OsHle.Handles;
using System.Threading;
namespace Ryujinx.OsHle.Svc namespace Ryujinx.OsHle.Svc
{ {
@ -18,6 +17,7 @@ namespace Ryujinx.OsHle.Svc
{ {
if (ProcessorId == -2) if (ProcessorId == -2)
{ {
//TODO: Get this value from the NPDM file.
ProcessorId = 0; ProcessorId = 0;
} }
@ -55,16 +55,16 @@ namespace Ryujinx.OsHle.Svc
{ {
ulong NanoSecs = ThreadState.X0; ulong NanoSecs = ThreadState.X0;
if (Process.TryGetThread(ThreadState.Tpidr, out HThread CurrThread)) HThread CurrThread = Process.GetThread(ThreadState.Tpidr);
if (NanoSecs == 0)
{ {
Process.Scheduler.Yield(CurrThread); Process.Scheduler.Yield(CurrThread);
} }
else else
{ {
Logging.Error($"Thread with TPIDR_EL0 0x{ThreadState.Tpidr:x16} not found!"); Process.Scheduler.WaitForSignal(CurrThread, (int)(NanoSecs / 1000000));
} }
Thread.Sleep((int)(NanoSecs / 1000000));
} }
private void SvcGetThreadPriority(AThreadState ThreadState) private void SvcGetThreadPriority(AThreadState ThreadState)

View file

@ -43,10 +43,11 @@ namespace Ryujinx.OsHle.Svc
HThread Thread = Ns.Os.Handles.GetData<HThread>(ThreadHandle); HThread Thread = Ns.Os.Handles.GetData<HThread>(ThreadHandle);
if (Ns.Os.Mutexes.TryGetValue(MutexAddress, out Mutex M)) Mutex M = new Mutex(Process, MutexAddress, ThreadHandle);
{
M = Ns.Os.Mutexes.GetOrAdd(MutexAddress, M);
M.GiveUpLock(ThreadHandle); M.GiveUpLock(ThreadHandle);
}
CondVar Cv = new CondVar(Process, CondVarAddress, Timeout); CondVar Cv = new CondVar(Process, CondVarAddress, Timeout);
@ -54,10 +55,6 @@ namespace Ryujinx.OsHle.Svc
Cv.WaitForSignal(Thread); Cv.WaitForSignal(Thread);
M = new Mutex(Process, MutexAddress, ThreadHandle);
M = Ns.Os.Mutexes.GetOrAdd(MutexAddress, M);
M.WaitForLock(Thread, ThreadHandle); M.WaitForLock(Thread, ThreadHandle);
ThreadState.X0 = (int)SvcResult.Success; ThreadState.X0 = (int)SvcResult.Success;
@ -68,9 +65,11 @@ namespace Ryujinx.OsHle.Svc
long CondVarAddress = (long)ThreadState.X0; long CondVarAddress = (long)ThreadState.X0;
int Count = (int)ThreadState.X1; int Count = (int)ThreadState.X1;
HThread CurrThread = Process.GetThread(ThreadState.Tpidr);
if (Ns.Os.CondVars.TryGetValue(CondVarAddress, out CondVar Cv)) if (Ns.Os.CondVars.TryGetValue(CondVarAddress, out CondVar Cv))
{ {
Cv.SetSignal(Count); Cv.SetSignal(CurrThread, Count);
} }
ThreadState.X0 = (int)SvcResult.Success; ThreadState.X0 = (int)SvcResult.Success;