namespace BizHawk.Emulation.Cores.Intellivision
{
	public sealed partial class Intellivision
	{
		private const ushort UNMAPPED = 0xFFFF;

		private byte[] ScratchpadRam = new byte[240];
		private ushort[] SystemRam = new ushort[352];
		private ushort[] ExecutiveRom = new ushort[4096]; // TODO: Intellivision II support?
		public byte[] GraphicsRom = new byte[2048];
		public byte[] GraphicsRam = new byte[512];

		public ushort ReadMemory(ushort addr, bool peek)
		{
			ushort? cart = _cart.ReadCart(addr, peek);
			ushort? stic = _stic.ReadSTIC(addr, peek);
			ushort? psg = _psg.ReadPSG(addr, peek);
			ushort? core = null;

			switch (addr & 0xF000)
			{
				case 0x0000:
					if (addr <= 0x007F)
					{
						// STIC.
						break;
					}
					else if (addr <= 0x00FF)
					{
						// Unoccupied.
						break;
					}
					else if (addr <= 0x01EF)
					{
						core = (ushort)(ScratchpadRam[addr - 0x0100] & 0x00FF);
					}
					else if (addr <= 0x01FF)
					{
						// PSG.

						//controllers
						if (addr==0x01FE)
						{
							if (!peek)
								_islag = false;
							return _psg.Register[14];
						}

						if (addr == 0x01FF)
						{
							if (!peek)
								_islag = false;
							return _psg.Register[15];
						}
						break;
					}
					else if (addr <= 0x035F)
					{
						core = SystemRam[addr - 0x0200];
					}
					else if (addr <= 0x03FF)
					{
						// TODO: Garbage values for Intellivision II.
						break;
					}
					else if (addr <= 0x04FF)
					{
						// TODO: Additional EXEC ROM for Intellivision II.
						break;
					}
					break;
				case 0x1000:
					core = (ushort)(ExecutiveRom[addr - 0x1000] & 0x3FF);
					break;
				case 0x3000:
					if (addr <= 0x37FF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							core = (byte)(GraphicsRom[addr - 0x3000] & 0x00FF);
						}
					}
					else if (addr <= 0x39FF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							core = (byte)(GraphicsRam[addr - 0x3800] & 0x00FF);
						}
					}
					else if (addr <= 0x3BFF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							core = (byte)(GraphicsRam[addr - 0x3A00] & 0x00FF);
						}
					}
					else if (addr <= 0x3DFF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							core = (byte)(GraphicsRam[addr - 0x3C00] & 0x00FF);
						}
					}
					else
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							core = (byte)(GraphicsRam[addr - 0x3E00] & 0x00FF);
						}
					}
					break;
				case 0x7000:
					if (addr <= 0x77FF)
					{
						// Available to cartridges.
						break;
					}
					else if (addr <= 0x79FF)
					{
						// Write-only Graphics RAM.
						break;
					}
					else if (addr <= 0x7BFF)
					{
						// Write-only Graphics RAM.
						break;
					}
					else if (addr <= 0x7DFF)
					{
						// Write-only Graphics RAM.
						break;
					}
					else
					{
						// Write-only Graphics RAM.
						break;
					}
				case 0xB000:
					if (addr <= 0xB7FF)
					{
						// Available to cartridges.
						break;
					}
					else if (addr <= 0xB9FF)
					{
						// Write-only Graphics RAM.
						break;
					}
					else if (addr <= 0xBBFF)
					{
						// Write-only Graphics RAM.
						break;
					}
					else if (addr <= 0xBDFF)
					{
						// Write-only Graphics RAM.
						break;
					}
					else
					{
						// Write-only Graphics RAM.
						break;
					}
				case 0xF000:
					if (addr <= 0xF7FF)
					{
						// Available to cartridges.
						break;
					}
					else if (addr <= 0xF9FF)
					{
						// Write-only Graphics RAM.
						break;
					}
					else if (addr <= 0xFBFF)
					{
						// Write-only Graphics RAM.
						break;
					}
					else if (addr <= 0xFDFF)
					{
						// Write-only Graphics RAM.
						break;
					}
					else
					{
						// Write-only Graphics RAM.
						break;
					}
			}

			if (cart != null)
			{
				return (ushort)cart;
			}
			else if (stic != null)
			{
				return (ushort)stic;
			}
			else if (psg != null)
			{
				return (ushort)psg;
			}
			else if (core != null)
			{
				return (ushort)core;
			}

			return UNMAPPED;
		}

		public bool WriteMemory(ushort addr, ushort value, bool poke)
		{
			bool cart = _cart.WriteCart(addr, value, poke);
			bool stic = _stic.WriteSTIC(addr, value, poke);
			bool psg = _psg.WritePSG(addr, value, poke);
			switch (addr & 0xF000)
			{
				case 0x0000:
					if (addr <= 0x007F)
					{
						// STIC.
						break;
					}
					else if (addr <= 0x00FF)
					{
						// Unoccupied.
						break;
					}
					else if (addr <= 0x01EF)
					{
						ScratchpadRam[addr - 0x0100] = (byte)(value & 0x00FF);
						return true;
					}
					else if (addr <= 0x01FF)
					{
						// PSG.
						break;
					}
					else if (addr <= 0x035F)
					{
						SystemRam[addr - 0x0200] = value;
						return true;
					}
					else if (addr <= 0x03FF)
					{
						// Read-only garbage values for Intellivision II.
						break;
					}
					else if (addr <= 0x04FF)
					{
						// Read-only additional EXEC ROM for Intellivision II.
						break;
					}
					break;
				case 0x1000:
					// Read-only Executive ROM.
					break;
				case 0x3000:
					if (addr <= 0x37FF)
					{
						// Read-only Graphics ROM.
						break;
					}
					else if (addr <= 0x39FF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr - 0x3800] = (byte)(value & 0x00FF);
							return true;
						}

						return false;
					}
					else if (addr <= 0x3BFF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr - 0x3A00] = (byte)(value & 0x00FF);
							return true;
						}

						return false;
					}
					else if (addr <= 0x3DFF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr - 0x3C00] = (byte)(value & 0x00FF);
							return true;
						}

						return false;
					}
					else
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr - 0x3E00] = (byte)(value & 0x00FF);
							return true;
						}

						return false;
					}
				case 0x7000:
					if (addr <= 0x77FF)
					{
						// Available to cartridges.
						break;
					}
					else if (addr <= 0x79FF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr & 0x01FF] = (byte)(value & 0x00FF);
							return true;
						}

						return false;
					}
					else if (addr <= 0x7BFF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr & 0x01FF] = (byte)(value & 0x00FF);
							return true;
						}

						return false;
					}
					else if (addr <= 0x7DFF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr & 0x01FF] = (byte)(value & 0x00FF);
							return true;
						}

						return false;
					}
					else
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr & 0x01FF] = (byte)(value & 0x00FF);
							return true;
						}

						return false;
					}
				case 0x9000:
				case 0xA000:
				case 0xB000:
					if (addr <= 0xB7FF)
					{
						// Available to cartridges.
						break;
					}
					else if (addr <= 0xB9FF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr - 0xB800] = (byte)(value & 0x00FF);
							return true;
						}
						return false;

					}
					else if (addr <= 0xBBFF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr - 0xBA00] = (byte)(value & 0x00FF);
							return true;
						}
						return false;
					}
					else if (addr <= 0xBDFF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr - 0xBC00] = (byte)(value & 0x00FF);
							return true;
						}
						return false;
					}
					else
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr - 0xBE00] = (byte)(value & 0x00FF);
							return true;
						}
						return false;
					}
				case 0xF000:
					if (addr <= 0xF7FF)
					{
						// Available to cartridges.
						break;
					}
					else if (addr <= 0xF9FF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr - 0xF800] = (byte)(value & 0x00FF);
							return true;
						}

						return false;
					}
					else if (addr <= 0xFBFF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr - 0xFA00] = (byte)(value & 0x00FF);
							return true;
						}

						return false;
					}
					else if (addr <= 0xFDFF)
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr - 0xFC00] = (byte)(value & 0x00FF);
							return true;
						}

						return false;
					}
					else
					{
						if (_stic.in_vb_2 | !_stic.active_display)
						{
							GraphicsRam[addr - 0xFE00] = (byte)(value & 0x00FF);
							return true;
						}

						return false;
					}
			}

			return (cart || stic || psg);
		}
	}
}