StoicGoose.Unity/Assets/Plugins/StoicGooseUnity/StoicGoose.Core/Sound/SphinxSoundController.cs

using StoicGoose.Common.Attributes;
using StoicGoose.Core.Interfaces;

using static StoicGoose.Common.Utilities.BitHandling;

namespace StoicGoose.Core.Sound
{
	public class SphinxSoundController : SoundControllerCommon
	{
		public override byte MaxMasterVolume => 3;
		public override int NumChannels => 5;

		readonly SoundChannelHyperVoice channelHyperVoice = default;

		public SphinxSoundController(IMachine machine, int rate, int outChannels) : base(machine, rate, outChannels)
		{
			channelHyperVoice = new();
		}

		public override void Reset()
		{
			base.Reset();

			channelHyperVoice.Reset();
		}

		public override void StepChannels()
		{
			base.StepChannels();

			channelHyperVoice.Step();
		}

		public override int[] GenerateSample()
		{
			channelSampleBuffers[0].Add((short)(channel1.IsEnabled ? (channel1.OutputLeft & 0x07FF) << 5 : 0));
			channelSampleBuffers[0].Add((short)(channel1.IsEnabled ? (channel1.OutputRight & 0x07FF) << 5 : 0));
			channelSampleBuffers[1].Add((short)(channel2.IsEnabled ? (channel2.OutputLeft & 0x07FF) << 5 : 0));
			channelSampleBuffers[1].Add((short)(channel2.IsEnabled ? (channel2.OutputRight & 0x07FF) << 5 : 0));
			channelSampleBuffers[2].Add((short)(channel3.IsEnabled ? (channel3.OutputLeft & 0x07FF) << 5 : 0));
			channelSampleBuffers[2].Add((short)(channel3.IsEnabled ? (channel3.OutputRight & 0x07FF) << 5 : 0));
			channelSampleBuffers[3].Add((short)(channel4.IsEnabled ? (channel4.OutputLeft & 0x07FF) << 5 : 0));
			channelSampleBuffers[3].Add((short)(channel4.IsEnabled ? (channel4.OutputRight & 0x07FF) << 5 : 0));
			channelSampleBuffers[4].Add((short)(channelHyperVoice.IsEnabled ? (channelHyperVoice.OutputLeft & 0x07FF) << 5 : 0));
			channelSampleBuffers[4].Add((short)(channelHyperVoice.IsEnabled ? (channelHyperVoice.OutputRight & 0x07FF) << 5 : 0));

			var mixedLeft = 0;
			if (channel1.IsEnabled) mixedLeft += channel1.OutputLeft;
			if (channel2.IsEnabled) mixedLeft += channel2.OutputLeft;
			if (channel3.IsEnabled) mixedLeft += channel3.OutputLeft;
			if (channel4.IsEnabled) mixedLeft += channel4.OutputLeft;
			if (channelHyperVoice.IsEnabled && headphonesConnected) mixedLeft += channelHyperVoice.OutputLeft;
			mixedLeft = (mixedLeft & 0x07FF) << 5;

			var mixedRight = 0;
			if (channel1.IsEnabled) mixedRight += channel1.OutputRight;
			if (channel2.IsEnabled) mixedRight += channel2.OutputRight;
			if (channel3.IsEnabled) mixedRight += channel3.OutputRight;
			if (channel4.IsEnabled) mixedRight += channel4.OutputRight;
			if (channelHyperVoice.IsEnabled && headphonesConnected) mixedRight += channelHyperVoice.OutputRight;
			mixedRight = (mixedRight & 0x07FF) << 5;

			return new[] { mixedLeft, mixedRight };
		}

		public override byte ReadPort(ushort port)
		{
			var retVal = (byte)0;

			switch (port)
			{
				case 0x6A:
					/* REG_HYPER_CTRL */
					ChangeBit(ref retVal, 7, channelHyperVoice.IsEnabled);
					retVal |= (byte)((channelHyperVoice.CtrlUnknown << 4) & 0b111);
					retVal |= (byte)((channelHyperVoice.ScalingMode << 2) & 0b11);
					retVal |= (byte)((channelHyperVoice.Volume << 0) & 0b11);
					break;

				case 0x6B:
					/* REG_HYPER_CHAN_CTRL */
					ChangeBit(ref retVal, 6, channelHyperVoice.RightEnable);
					ChangeBit(ref retVal, 5, channelHyperVoice.LeftEnable);
					retVal |= (byte)((channelHyperVoice.ChanCtrlUnknown << 0) & 0b1111);
					break;

				case 0x95:
					/* REG_SND_HYPERVOICE */
					retVal |= channelHyperVoice.Data;
					break;

				case 0x96:
				case 0x97:
				case 0x98:
				case 0x99:
				case 0x9A:
				case 0x9B:
				case 0x9C:
				case 0x9D:
					/* REG_SND_9x */
					retVal = 0;
					break;

				default:
					/* Fall through to common */
					retVal |= base.ReadPort(port);
					break;
			}

			return retVal;
		}

		public override void WritePort(ushort port, byte value)
		{
			switch (port)
			{
				case 0x6A:
					/* REG_HYPER_CTRL */
					channelHyperVoice.IsEnabled = IsBitSet(value, 7);
					channelHyperVoice.CtrlUnknown = (byte)((value >> 4) & 0b111);
					channelHyperVoice.ScalingMode = (byte)((value >> 2) & 0b11);
					channelHyperVoice.Volume = (byte)((value >> 0) & 0b11);
					break;

				case 0x6B:
					/* REG_HYPER_CHAN_CTRL */
					channelHyperVoice.RightEnable = IsBitSet(value, 6);
					channelHyperVoice.LeftEnable = IsBitSet(value, 5);
					channelHyperVoice.ChanCtrlUnknown = (byte)((value >> 0) & 0b1111);
					break;

				case 0x95:
					/* REG_SND_HYPERVOICE */
					channelHyperVoice.Data = value;
					break;

				case 0x96:
				case 0x97:
				case 0x98:
				case 0x99:
				case 0x9A:
				case 0x9B:
				case 0x9C:
				case 0x9D:
					/* REG_SND_9x */
					break;

				default:
					/* Fall through to common */
					base.WritePort(port, value);
					break;
			}
		}

		[Port("REG_HYPER_CTRL", 0x06A)]
		[BitDescription("Is HyperVoice enabled?", 7)]
		public bool ChannelHyperVoiceIsEnable => channelHyperVoice.IsEnabled;
		[Port("REG_HYPER_CTRL", 0x06A)]
		[BitDescription("HyperVoice control unknown", 4, 6)]
		public byte ChannelHyperVoiceCtrlUnknown => channelHyperVoice.CtrlUnknown;
		[Port("REG_HYPER_CTRL", 0x06A)]
		[BitDescription("HyperVoice scaling mode", 2, 3)]
		public int ChannelHyperVoiceScalingMode => channelHyperVoice.ScalingMode;
		[Port("REG_HYPER_CTRL", 0x06A)]
		[BitDescription("HyperVoice volume", 0, 1)]
		public int ChannelHyperVoiceVolume => channelHyperVoice.Volume;

		[Port("REG_HYPER_CHAN_CTRL", 0x06B)]
		[BitDescription("Is HyperVoice right channel enabled?", 6)]
		public bool ChannelHyperVoiceChanRightEnable => channelHyperVoice.RightEnable;
		[Port("REG_HYPER_CHAN_CTRL", 0x06B)]
		[BitDescription("Is HyperVoice left channel enabled?", 5)]
		public bool ChannelHyperVoiceChanLeftEnable => channelHyperVoice.LeftEnable;
		[Port("REG_HYPER_CHAN_CTRL", 0x06B)]
		[BitDescription("HyperVoice channel control unknown", 0, 3)]
		public byte ChannelHyperVoiceChanCtrlUnknown => channelHyperVoice.ChanCtrlUnknown;

		[Port("REG_SND_HYPERVOICE", 0x095)]
		[BitDescription("HyperVoice channel working sample")]
		public byte ChannelHyperVoiceData => channelHyperVoice.Data;
	}
}