|
@@ -1,244 +1,112 @@
|
|
|
-using Concentus;
|
|
|
|
|
-using Concentus.Enums;
|
|
|
|
|
-using Concentus.Structs;
|
|
|
|
|
using Ryujinx.HLE.HOS.Services.Audio.Types;
|
|
using Ryujinx.HLE.HOS.Services.Audio.Types;
|
|
|
using System;
|
|
using System;
|
|
|
-using System.IO;
|
|
|
|
|
using System.Runtime.InteropServices;
|
|
using System.Runtime.InteropServices;
|
|
|
|
|
|
|
|
namespace Ryujinx.HLE.HOS.Services.Audio.HardwareOpusDecoderManager
|
|
namespace Ryujinx.HLE.HOS.Services.Audio.HardwareOpusDecoderManager
|
|
|
{
|
|
{
|
|
|
class IHardwareOpusDecoder : IpcService
|
|
class IHardwareOpusDecoder : IpcService
|
|
|
{
|
|
{
|
|
|
- private int _sampleRate;
|
|
|
|
|
- private int _channelsCount;
|
|
|
|
|
- private bool _reset;
|
|
|
|
|
|
|
+ private readonly IDecoder _decoder;
|
|
|
|
|
+ private readonly OpusDecoderFlags _flags;
|
|
|
|
|
|
|
|
- private OpusDecoder _decoder;
|
|
|
|
|
-
|
|
|
|
|
- public IHardwareOpusDecoder(int sampleRate, int channelsCount)
|
|
|
|
|
|
|
+ public IHardwareOpusDecoder(int sampleRate, int channelsCount, OpusDecoderFlags flags)
|
|
|
{
|
|
{
|
|
|
- _sampleRate = sampleRate;
|
|
|
|
|
- _channelsCount = channelsCount;
|
|
|
|
|
- _reset = false;
|
|
|
|
|
-
|
|
|
|
|
- _decoder = new OpusDecoder(sampleRate, channelsCount);
|
|
|
|
|
|
|
+ _decoder = new Decoder(sampleRate, channelsCount);
|
|
|
|
|
+ _flags = flags;
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
- private ResultCode GetPacketNumSamples(out int numSamples, byte[] packet)
|
|
|
|
|
|
|
+ public IHardwareOpusDecoder(int sampleRate, int channelsCount, int streams, int coupledStreams, OpusDecoderFlags flags, byte[] mapping)
|
|
|
{
|
|
{
|
|
|
- int result = OpusPacketInfo.GetNumSamples(_decoder, packet, 0, packet.Length);
|
|
|
|
|
-
|
|
|
|
|
- numSamples = result;
|
|
|
|
|
-
|
|
|
|
|
- if (result == OpusError.OPUS_INVALID_PACKET)
|
|
|
|
|
- {
|
|
|
|
|
- return ResultCode.OpusInvalidInput;
|
|
|
|
|
- }
|
|
|
|
|
- else if (result == OpusError.OPUS_BAD_ARG)
|
|
|
|
|
- {
|
|
|
|
|
- return ResultCode.OpusInvalidInput;
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
- return ResultCode.Success;
|
|
|
|
|
|
|
+ _decoder = new MultiSampleDecoder(sampleRate, channelsCount, streams, coupledStreams, mapping);
|
|
|
|
|
+ _flags = flags;
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
- private ResultCode DecodeInterleavedInternal(BinaryReader input, out short[] outPcmData, long outputSize, out uint outConsumed, out int outSamples)
|
|
|
|
|
|
|
+ [CommandHipc(0)]
|
|
|
|
|
+ // DecodeInterleavedOld(buffer<unknown, 5>) -> (u32, u32, buffer<unknown, 6>)
|
|
|
|
|
+ public ResultCode DecodeInterleavedOld(ServiceCtx context)
|
|
|
{
|
|
{
|
|
|
- outPcmData = null;
|
|
|
|
|
- outConsumed = 0;
|
|
|
|
|
- outSamples = 0;
|
|
|
|
|
-
|
|
|
|
|
- long streamSize = input.BaseStream.Length;
|
|
|
|
|
-
|
|
|
|
|
- if (streamSize < Marshal.SizeOf<OpusPacketHeader>())
|
|
|
|
|
- {
|
|
|
|
|
- return ResultCode.OpusInvalidInput;
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
- OpusPacketHeader header = OpusPacketHeader.FromStream(input);
|
|
|
|
|
-
|
|
|
|
|
- uint totalSize = header.length + (uint)Marshal.SizeOf<OpusPacketHeader>();
|
|
|
|
|
-
|
|
|
|
|
- if (totalSize > streamSize)
|
|
|
|
|
- {
|
|
|
|
|
- return ResultCode.OpusInvalidInput;
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
- byte[] opusData = input.ReadBytes((int)header.length);
|
|
|
|
|
-
|
|
|
|
|
- ResultCode result = GetPacketNumSamples(out int numSamples, opusData);
|
|
|
|
|
-
|
|
|
|
|
- if (result == ResultCode.Success)
|
|
|
|
|
- {
|
|
|
|
|
- if ((uint)numSamples * (uint)_channelsCount * sizeof(short) > outputSize)
|
|
|
|
|
- {
|
|
|
|
|
- return ResultCode.OpusInvalidInput;
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
- outPcmData = new short[numSamples * _channelsCount];
|
|
|
|
|
-
|
|
|
|
|
- if (_reset)
|
|
|
|
|
- {
|
|
|
|
|
- _reset = false;
|
|
|
|
|
-
|
|
|
|
|
- _decoder.ResetState();
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
- try
|
|
|
|
|
- {
|
|
|
|
|
- outSamples = _decoder.Decode(opusData, 0, opusData.Length, outPcmData, 0, outPcmData.Length / _channelsCount);
|
|
|
|
|
- outConsumed = totalSize;
|
|
|
|
|
- }
|
|
|
|
|
- catch (OpusException)
|
|
|
|
|
- {
|
|
|
|
|
- // TODO: as OpusException doesn't provide us the exact error code, this is kind of inaccurate in some cases...
|
|
|
|
|
- return ResultCode.OpusInvalidInput;
|
|
|
|
|
- }
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
- return ResultCode.Success;
|
|
|
|
|
|
|
+ return DecodeInterleavedInternal(context, OpusDecoderFlags.None, reset: false, withPerf: false);
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
- [CommandHipc(0)]
|
|
|
|
|
- // DecodeInterleaved(buffer<unknown, 5>) -> (u32, u32, buffer<unknown, 6>)
|
|
|
|
|
- public ResultCode DecodeInterleavedOriginal(ServiceCtx context)
|
|
|
|
|
|
|
+ [CommandHipc(2)]
|
|
|
|
|
+ // DecodeInterleavedForMultiStreamOld(buffer<unknown, 5>) -> (u32, u32, buffer<unknown, 6>)
|
|
|
|
|
+ public ResultCode DecodeInterleavedForMultiStreamOld(ServiceCtx context)
|
|
|
{
|
|
{
|
|
|
- ResultCode result;
|
|
|
|
|
-
|
|
|
|
|
- ulong inPosition = context.Request.SendBuff[0].Position;
|
|
|
|
|
- ulong inSize = context.Request.SendBuff[0].Size;
|
|
|
|
|
- ulong outputPosition = context.Request.ReceiveBuff[0].Position;
|
|
|
|
|
- ulong outputSize = context.Request.ReceiveBuff[0].Size;
|
|
|
|
|
-
|
|
|
|
|
- byte[] buffer = new byte[inSize];
|
|
|
|
|
-
|
|
|
|
|
- context.Memory.Read(inPosition, buffer);
|
|
|
|
|
-
|
|
|
|
|
- using (BinaryReader inputStream = new BinaryReader(new MemoryStream(buffer)))
|
|
|
|
|
- {
|
|
|
|
|
- result = DecodeInterleavedInternal(inputStream, out short[] outPcmData, (long)outputSize, out uint outConsumed, out int outSamples);
|
|
|
|
|
-
|
|
|
|
|
- if (result == ResultCode.Success)
|
|
|
|
|
- {
|
|
|
|
|
- byte[] pcmDataBytes = new byte[outPcmData.Length * sizeof(short)];
|
|
|
|
|
- Buffer.BlockCopy(outPcmData, 0, pcmDataBytes, 0, pcmDataBytes.Length);
|
|
|
|
|
- context.Memory.Write(outputPosition, pcmDataBytes);
|
|
|
|
|
-
|
|
|
|
|
- context.ResponseData.Write(outConsumed);
|
|
|
|
|
- context.ResponseData.Write(outSamples);
|
|
|
|
|
- }
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
- return result;
|
|
|
|
|
|
|
+ return DecodeInterleavedInternal(context, OpusDecoderFlags.None, reset: false, withPerf: false);
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
[CommandHipc(4)] // 6.0.0+
|
|
[CommandHipc(4)] // 6.0.0+
|
|
|
// DecodeInterleavedWithPerfOld(buffer<unknown, 5>) -> (u32, u32, u64, buffer<unknown, 0x46>)
|
|
// DecodeInterleavedWithPerfOld(buffer<unknown, 5>) -> (u32, u32, u64, buffer<unknown, 0x46>)
|
|
|
public ResultCode DecodeInterleavedWithPerfOld(ServiceCtx context)
|
|
public ResultCode DecodeInterleavedWithPerfOld(ServiceCtx context)
|
|
|
{
|
|
{
|
|
|
- ResultCode result;
|
|
|
|
|
-
|
|
|
|
|
- ulong inPosition = context.Request.SendBuff[0].Position;
|
|
|
|
|
- ulong inSize = context.Request.SendBuff[0].Size;
|
|
|
|
|
- ulong outputPosition = context.Request.ReceiveBuff[0].Position;
|
|
|
|
|
- ulong outputSize = context.Request.ReceiveBuff[0].Size;
|
|
|
|
|
-
|
|
|
|
|
- byte[] buffer = new byte[inSize];
|
|
|
|
|
-
|
|
|
|
|
- context.Memory.Read(inPosition, buffer);
|
|
|
|
|
-
|
|
|
|
|
- using (BinaryReader inputStream = new BinaryReader(new MemoryStream(buffer)))
|
|
|
|
|
- {
|
|
|
|
|
- result = DecodeInterleavedInternal(inputStream, out short[] outPcmData, (long)outputSize, out uint outConsumed, out int outSamples);
|
|
|
|
|
-
|
|
|
|
|
- if (result == ResultCode.Success)
|
|
|
|
|
- {
|
|
|
|
|
- byte[] pcmDataBytes = new byte[outPcmData.Length * sizeof(short)];
|
|
|
|
|
- Buffer.BlockCopy(outPcmData, 0, pcmDataBytes, 0, pcmDataBytes.Length);
|
|
|
|
|
- context.Memory.Write(outputPosition, pcmDataBytes);
|
|
|
|
|
-
|
|
|
|
|
- context.ResponseData.Write(outConsumed);
|
|
|
|
|
- context.ResponseData.Write(outSamples);
|
|
|
|
|
-
|
|
|
|
|
- // This is the time the DSP took to process the request, TODO: fill this.
|
|
|
|
|
- context.ResponseData.Write(0);
|
|
|
|
|
- }
|
|
|
|
|
- }
|
|
|
|
|
|
|
+ return DecodeInterleavedInternal(context, OpusDecoderFlags.None, reset: false, withPerf: true);
|
|
|
|
|
+ }
|
|
|
|
|
|
|
|
- return result;
|
|
|
|
|
|
|
+ [CommandHipc(5)] // 6.0.0+
|
|
|
|
|
+ // DecodeInterleavedForMultiStreamWithPerfOld(buffer<unknown, 5>) -> (u32, u32, u64, buffer<unknown, 0x46>)
|
|
|
|
|
+ public ResultCode DecodeInterleavedForMultiStreamWithPerfOld(ServiceCtx context)
|
|
|
|
|
+ {
|
|
|
|
|
+ return DecodeInterleavedInternal(context, OpusDecoderFlags.None, reset: false, withPerf: true);
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
[CommandHipc(6)] // 6.0.0+
|
|
[CommandHipc(6)] // 6.0.0+
|
|
|
- // DecodeInterleavedOld(bool reset, buffer<unknown, 5>) -> (u32, u32, u64, buffer<unknown, 0x46>)
|
|
|
|
|
- public ResultCode DecodeInterleavedOld(ServiceCtx context)
|
|
|
|
|
|
|
+ // DecodeInterleavedWithPerfAndResetOld(bool reset, buffer<unknown, 5>) -> (u32, u32, u64, buffer<unknown, 0x46>)
|
|
|
|
|
+ public ResultCode DecodeInterleavedWithPerfAndResetOld(ServiceCtx context)
|
|
|
{
|
|
{
|
|
|
- ResultCode result;
|
|
|
|
|
-
|
|
|
|
|
- _reset = context.RequestData.ReadBoolean();
|
|
|
|
|
-
|
|
|
|
|
- ulong inPosition = context.Request.SendBuff[0].Position;
|
|
|
|
|
- ulong inSize = context.Request.SendBuff[0].Size;
|
|
|
|
|
- ulong outputPosition = context.Request.ReceiveBuff[0].Position;
|
|
|
|
|
- ulong outputSize = context.Request.ReceiveBuff[0].Size;
|
|
|
|
|
|
|
+ bool reset = context.RequestData.ReadBoolean();
|
|
|
|
|
|
|
|
- byte[] buffer = new byte[inSize];
|
|
|
|
|
-
|
|
|
|
|
- context.Memory.Read(inPosition, buffer);
|
|
|
|
|
-
|
|
|
|
|
- using (BinaryReader inputStream = new BinaryReader(new MemoryStream(buffer)))
|
|
|
|
|
- {
|
|
|
|
|
- result = DecodeInterleavedInternal(inputStream, out short[] outPcmData, (long)outputSize, out uint outConsumed, out int outSamples);
|
|
|
|
|
-
|
|
|
|
|
- if (result == ResultCode.Success)
|
|
|
|
|
- {
|
|
|
|
|
- byte[] pcmDataBytes = new byte[outPcmData.Length * sizeof(short)];
|
|
|
|
|
- Buffer.BlockCopy(outPcmData, 0, pcmDataBytes, 0, pcmDataBytes.Length);
|
|
|
|
|
- context.Memory.Write(outputPosition, pcmDataBytes);
|
|
|
|
|
-
|
|
|
|
|
- context.ResponseData.Write(outConsumed);
|
|
|
|
|
- context.ResponseData.Write(outSamples);
|
|
|
|
|
|
|
+ return DecodeInterleavedInternal(context, OpusDecoderFlags.None, reset, withPerf: true);
|
|
|
|
|
+ }
|
|
|
|
|
|
|
|
- // This is the time the DSP took to process the request, TODO: fill this.
|
|
|
|
|
- context.ResponseData.Write(0);
|
|
|
|
|
- }
|
|
|
|
|
- }
|
|
|
|
|
|
|
+ [CommandHipc(7)] // 6.0.0+
|
|
|
|
|
+ // DecodeInterleavedForMultiStreamWithPerfAndResetOld(bool reset, buffer<unknown, 5>) -> (u32, u32, u64, buffer<unknown, 0x46>)
|
|
|
|
|
+ public ResultCode DecodeInterleavedForMultiStreamWithPerfAndResetOld(ServiceCtx context)
|
|
|
|
|
+ {
|
|
|
|
|
+ bool reset = context.RequestData.ReadBoolean();
|
|
|
|
|
|
|
|
- return result;
|
|
|
|
|
|
|
+ return DecodeInterleavedInternal(context, OpusDecoderFlags.None, reset, withPerf: true);
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
[CommandHipc(8)] // 7.0.0+
|
|
[CommandHipc(8)] // 7.0.0+
|
|
|
// DecodeInterleaved(bool reset, buffer<unknown, 0x45>) -> (u32, u32, u64, buffer<unknown, 0x46>)
|
|
// DecodeInterleaved(bool reset, buffer<unknown, 0x45>) -> (u32, u32, u64, buffer<unknown, 0x46>)
|
|
|
public ResultCode DecodeInterleaved(ServiceCtx context)
|
|
public ResultCode DecodeInterleaved(ServiceCtx context)
|
|
|
{
|
|
{
|
|
|
- ResultCode result;
|
|
|
|
|
|
|
+ bool reset = context.RequestData.ReadBoolean();
|
|
|
|
|
|
|
|
- _reset = context.RequestData.ReadBoolean();
|
|
|
|
|
|
|
+ return DecodeInterleavedInternal(context, _flags, reset, withPerf: true);
|
|
|
|
|
+ }
|
|
|
|
|
|
|
|
|
|
+ [CommandHipc(9)] // 7.0.0+
|
|
|
|
|
+ // DecodeInterleavedForMultiStream(bool reset, buffer<unknown, 0x45>) -> (u32, u32, u64, buffer<unknown, 0x46>)
|
|
|
|
|
+ public ResultCode DecodeInterleavedForMultiStream(ServiceCtx context)
|
|
|
|
|
+ {
|
|
|
|
|
+ bool reset = context.RequestData.ReadBoolean();
|
|
|
|
|
+
|
|
|
|
|
+ return DecodeInterleavedInternal(context, _flags, reset, withPerf: true);
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ private ResultCode DecodeInterleavedInternal(ServiceCtx context, OpusDecoderFlags flags, bool reset, bool withPerf)
|
|
|
|
|
+ {
|
|
|
ulong inPosition = context.Request.SendBuff[0].Position;
|
|
ulong inPosition = context.Request.SendBuff[0].Position;
|
|
|
ulong inSize = context.Request.SendBuff[0].Size;
|
|
ulong inSize = context.Request.SendBuff[0].Size;
|
|
|
ulong outputPosition = context.Request.ReceiveBuff[0].Position;
|
|
ulong outputPosition = context.Request.ReceiveBuff[0].Position;
|
|
|
ulong outputSize = context.Request.ReceiveBuff[0].Size;
|
|
ulong outputSize = context.Request.ReceiveBuff[0].Size;
|
|
|
|
|
|
|
|
- byte[] buffer = new byte[inSize];
|
|
|
|
|
|
|
+ ReadOnlySpan<byte> input = context.Memory.GetSpan(inPosition, (int)inSize);
|
|
|
|
|
|
|
|
- context.Memory.Read(inPosition, buffer);
|
|
|
|
|
|
|
+ ResultCode result = _decoder.DecodeInterleaved(reset, input, out short[] outPcmData, outputSize, out uint outConsumed, out int outSamples);
|
|
|
|
|
|
|
|
- using (BinaryReader inputStream = new BinaryReader(new MemoryStream(buffer)))
|
|
|
|
|
|
|
+ if (result == ResultCode.Success)
|
|
|
{
|
|
{
|
|
|
- result = DecodeInterleavedInternal(inputStream, out short[] outPcmData, (long)outputSize, out uint outConsumed, out int outSamples);
|
|
|
|
|
|
|
+ context.Memory.Write(outputPosition, MemoryMarshal.Cast<short, byte>(outPcmData.AsSpan()));
|
|
|
|
|
|
|
|
- if (result == ResultCode.Success)
|
|
|
|
|
- {
|
|
|
|
|
- byte[] pcmDataBytes = new byte[outPcmData.Length * sizeof(short)];
|
|
|
|
|
- Buffer.BlockCopy(outPcmData, 0, pcmDataBytes, 0, pcmDataBytes.Length);
|
|
|
|
|
- context.Memory.Write(outputPosition, pcmDataBytes);
|
|
|
|
|
-
|
|
|
|
|
- context.ResponseData.Write(outConsumed);
|
|
|
|
|
- context.ResponseData.Write(outSamples);
|
|
|
|
|
|
|
+ context.ResponseData.Write(outConsumed);
|
|
|
|
|
+ context.ResponseData.Write(outSamples);
|
|
|
|
|
|
|
|
|
|
+ if (withPerf)
|
|
|
|
|
+ {
|
|
|
// This is the time the DSP took to process the request, TODO: fill this.
|
|
// This is the time the DSP took to process the request, TODO: fill this.
|
|
|
- context.ResponseData.Write(0);
|
|
|
|
|
|
|
+ context.ResponseData.Write(0UL);
|
|
|
}
|
|
}
|
|
|
}
|
|
}
|
|
|
|
|
|