mirror of
https://github.com/ryujinx-mirror/ryujinx.git
synced 2024-10-21 15:01:41 +00:00
150 lines
4.6 KiB
C#
150 lines
4.6 KiB
C#
|
using Ryujinx.Common.Memory;
|
|||
|
using System;
|
|||
|
using System.Runtime.CompilerServices;
|
|||
|
using System.Threading;
|
|||
|
|
|||
|
namespace Ryujinx.HLE.HOS.Services.Hid.Types.SharedMemory.Common
|
|||
|
{
|
|||
|
struct RingLifo<T> where T: unmanaged
|
|||
|
{
|
|||
|
private const ulong MaxEntries = 17;
|
|||
|
|
|||
|
#pragma warning disable CS0169
|
|||
|
private ulong _unused;
|
|||
|
#pragma warning restore CS0169
|
|||
|
#pragma warning disable CS0414
|
|||
|
private ulong _bufferCount;
|
|||
|
#pragma warning restore CS0414
|
|||
|
private ulong _index;
|
|||
|
private ulong _count;
|
|||
|
private Array17<AtomicStorage<T>> _storage;
|
|||
|
|
|||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|||
|
private ulong ReadCurrentIndex()
|
|||
|
{
|
|||
|
return Interlocked.Read(ref _index);
|
|||
|
}
|
|||
|
|
|||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|||
|
private ulong ReadCurrentCount()
|
|||
|
{
|
|||
|
return Interlocked.Read(ref _count);
|
|||
|
}
|
|||
|
|
|||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|||
|
private static ulong GetNextIndexForWrite(ulong index)
|
|||
|
{
|
|||
|
return (index + 1) % MaxEntries;
|
|||
|
}
|
|||
|
|
|||
|
public ref AtomicStorage<T> GetCurrentAtomicEntryRef()
|
|||
|
{
|
|||
|
ulong countAvailaible = Math.Min(Math.Max(0, ReadCurrentCount()), 1);
|
|||
|
|
|||
|
if (countAvailaible == 0)
|
|||
|
{
|
|||
|
_storage[0] = default;
|
|||
|
|
|||
|
return ref _storage[0];
|
|||
|
}
|
|||
|
|
|||
|
ulong index = ReadCurrentIndex();
|
|||
|
|
|||
|
while (true)
|
|||
|
{
|
|||
|
int inputEntryIndex = (int)((index + MaxEntries + 1 - countAvailaible) % MaxEntries);
|
|||
|
|
|||
|
ref AtomicStorage<T> result = ref _storage[inputEntryIndex];
|
|||
|
|
|||
|
ulong samplingNumber0 = result.ReadSamplingNumberAtomic();
|
|||
|
ulong samplingNumber1 = result.ReadSamplingNumberAtomic();
|
|||
|
|
|||
|
if (samplingNumber0 != samplingNumber1 && (result.SamplingNumber - result.SamplingNumber) != 1)
|
|||
|
{
|
|||
|
ulong tempCount = Math.Min(ReadCurrentCount(), countAvailaible);
|
|||
|
|
|||
|
countAvailaible = Math.Min(tempCount, 1);
|
|||
|
index = ReadCurrentIndex();
|
|||
|
|
|||
|
continue;
|
|||
|
}
|
|||
|
|
|||
|
return ref result;
|
|||
|
}
|
|||
|
}
|
|||
|
|
|||
|
public ref T GetCurrentEntryRef()
|
|||
|
{
|
|||
|
return ref GetCurrentAtomicEntryRef().Object;
|
|||
|
}
|
|||
|
|
|||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|||
|
public ReadOnlySpan<AtomicStorage<T>> ReadEntries(uint maxCount)
|
|||
|
{
|
|||
|
ulong countAvailaible = Math.Min(Math.Max(0, ReadCurrentCount()), maxCount);
|
|||
|
|
|||
|
if (countAvailaible == 0)
|
|||
|
{
|
|||
|
return ReadOnlySpan<AtomicStorage<T>>.Empty;
|
|||
|
}
|
|||
|
|
|||
|
ulong index = ReadCurrentIndex();
|
|||
|
|
|||
|
AtomicStorage<T>[] result = new AtomicStorage<T>[countAvailaible];
|
|||
|
|
|||
|
for (ulong i = 0; i < countAvailaible; i++)
|
|||
|
{
|
|||
|
int inputEntryIndex = (int)((index + MaxEntries + 1 - countAvailaible + i) % MaxEntries);
|
|||
|
int outputEntryIndex = (int)(countAvailaible - i - 1);
|
|||
|
|
|||
|
ulong samplingNumber0 = _storage[inputEntryIndex].ReadSamplingNumberAtomic();
|
|||
|
result[outputEntryIndex] = _storage[inputEntryIndex];
|
|||
|
ulong samplingNumber1 = _storage[inputEntryIndex].ReadSamplingNumberAtomic();
|
|||
|
|
|||
|
if (samplingNumber0 != samplingNumber1 && (i > 0 && (result[outputEntryIndex].SamplingNumber - result[outputEntryIndex].SamplingNumber) != 1))
|
|||
|
{
|
|||
|
ulong tempCount = Math.Min(ReadCurrentCount(), countAvailaible);
|
|||
|
|
|||
|
countAvailaible = Math.Min(tempCount, maxCount);
|
|||
|
index = ReadCurrentIndex();
|
|||
|
|
|||
|
i -= 1;
|
|||
|
}
|
|||
|
}
|
|||
|
|
|||
|
return result;
|
|||
|
}
|
|||
|
|
|||
|
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|||
|
public void Write(ref T value)
|
|||
|
{
|
|||
|
ulong targetIndex = GetNextIndexForWrite(ReadCurrentIndex());
|
|||
|
|
|||
|
_storage[(int)targetIndex].SetObject(ref value);
|
|||
|
|
|||
|
Interlocked.Exchange(ref _index, targetIndex);
|
|||
|
|
|||
|
ulong count = ReadCurrentCount();
|
|||
|
|
|||
|
if (count < (MaxEntries - 1))
|
|||
|
{
|
|||
|
Interlocked.Increment(ref _count);
|
|||
|
}
|
|||
|
}
|
|||
|
|
|||
|
public void Clear()
|
|||
|
{
|
|||
|
Interlocked.Exchange(ref _count, 0);
|
|||
|
Interlocked.Exchange(ref _index, 0);
|
|||
|
}
|
|||
|
|
|||
|
public static RingLifo<T> Create()
|
|||
|
{
|
|||
|
return new RingLifo<T>
|
|||
|
{
|
|||
|
_bufferCount = MaxEntries
|
|||
|
};
|
|||
|
}
|
|||
|
}
|
|||
|
}
|