From 130837fdc0f5f3821998593e8b2bf5a57531e430 Mon Sep 17 00:00:00 2001
From: adelikat <adelikat@tasvideos.org>
Date: Sat, 3 Sep 2016 20:09:13 -0400
Subject: [PATCH] NESHawk - Implement the Subor boards (mappers 166, 167)

---
 .../BizHawk.Emulation.Cores.csproj            |   1 +
 .../Consoles/Nintendo/NES/Boards/Subor.cs     | 104 ++++++++++++++++++
 2 files changed, 105 insertions(+)
 create mode 100644 BizHawk.Emulation.Cores/Consoles/Nintendo/NES/Boards/Subor.cs

diff --git a/BizHawk.Emulation.Cores/BizHawk.Emulation.Cores.csproj b/BizHawk.Emulation.Cores/BizHawk.Emulation.Cores.csproj
index a684268e3f..983afdc06b 100644
--- a/BizHawk.Emulation.Cores/BizHawk.Emulation.Cores.csproj
+++ b/BizHawk.Emulation.Cores/BizHawk.Emulation.Cores.csproj
@@ -706,6 +706,7 @@
     <Compile Include="Consoles\Nintendo\NES\Boards\Sachen8259.cs" />
     <Compile Include="Consoles\Nintendo\NES\Boards\SachenSimple.cs" />
     <Compile Include="Consoles\Nintendo\NES\Boards\SEEPROM.cs" />
+    <Compile Include="Consoles\Nintendo\NES\Boards\Subor.cs" />
     <Compile Include="Consoles\Nintendo\NES\Boards\Sunsoft1.cs" />
     <Compile Include="Consoles\Nintendo\NES\Boards\Sunsoft1_Alt.cs" />
     <Compile Include="Consoles\Nintendo\NES\Boards\Sunsoft2_m89.cs" />
diff --git a/BizHawk.Emulation.Cores/Consoles/Nintendo/NES/Boards/Subor.cs b/BizHawk.Emulation.Cores/Consoles/Nintendo/NES/Boards/Subor.cs
new file mode 100644
index 0000000000..02e711333b
--- /dev/null
+++ b/BizHawk.Emulation.Cores/Consoles/Nintendo/NES/Boards/Subor.cs
@@ -0,0 +1,104 @@
+using BizHawk.Common;
+
+namespace BizHawk.Emulation.Cores.Nintendo.NES
+{
+	public sealed class Subor : NES.NESBoardBase
+	{
+		private ByteBuffer regs = new ByteBuffer(4);
+		private bool is167;
+
+		public override bool Configure(NES.EDetectionOrigin origin)
+		{
+			switch (Cart.board_type)
+			{
+				case "MAPPER166":
+					break;
+				case "MAPPER167":
+					is167 = true;
+					break;
+				default:
+					return false;
+			}
+
+			return true;
+		}
+
+		public override void SyncState(Serializer ser)
+		{
+			base.SyncState(ser);
+			ser.Sync("regs", ref regs);
+			ser.Sync("is167", ref is167);
+		}
+
+		public override void WritePRG(int addr, byte value)
+		{
+			regs[(addr >> 13) & 0x03] = value;
+		}
+
+		public override byte ReadPRG(int addr)
+		{
+			int basea, bank;
+			basea = ((regs[0] ^ regs[1]) & 0x10) << 1;
+			bank = (regs[2] ^ regs[3]) & 0x1f;
+
+			if ((regs[1] & 0x08) > 0)
+			{
+				bank &= 0xFE;
+				if (is167)
+				{
+					if (addr < 0x4000)
+					{
+						return ROM[((basea + bank + 1) * 0x4000) + (addr & 0x3FFF)];
+					}
+					else
+					{
+						return ROM[((basea + bank + 0) * 0x4000) + (addr & 0x3FFF)];
+					}
+				}
+				else
+				{
+					if (addr < 0x4000)
+					{
+						return ROM[((basea + bank + 0) * 0x4000) + (addr & 0x3FFF)];
+					}
+					else
+					{
+						return ROM[((basea + bank + 1) * 0x4000) + (addr & 0x3FFF)];
+					}
+				}
+			}
+			else
+			{
+				if ((regs[1] & 0x04) > 0)
+				{
+					if (addr < 0x4000)
+					{
+						return ROM[(0x1F * 0x4000) + (addr & 0x3FFF)];
+					}
+					else
+					{
+						return ROM[((basea + bank) * 0x4000) + (addr & 0x3FFF)];
+					}
+				}
+				else
+				{
+					if (addr < 0x4000)
+					{
+						return ROM[((basea + bank) * 0x4000) + (addr & 0x3FFF)];
+					}
+					else
+					{
+						if (is167)
+						{
+							return ROM[(0x20 * 0x4000) + (addr & 0x3FFF)];
+						}
+						else
+						{
+							return ROM[(0x07 * 0x4000) + (addr & 0x3FFF)];
+						}
+					}
+				}
+			}
+		}
+	}
+}