From 0c52f9d2e00123995035d2bc4cbe580dc791a7e9 Mon Sep 17 00:00:00 2001
From: MadMaurice <madmaurice@zom.bi>
Date: Thu, 31 Aug 2023 00:28:40 +0200
Subject: [PATCH] memory - Add bank device

---
 Makeconf        |  1 +
 memory/bank.cpp | 44 ++++++++++++++++++++++++++++++++++++++++++++
 memory/bank.h   | 23 +++++++++++++++++++++++
 3 files changed, 68 insertions(+)
 create mode 100644 memory/bank.cpp
 create mode 100644 memory/bank.h

diff --git a/Makeconf b/Makeconf
index 8f19b57..086f66a 100644
--- a/Makeconf
+++ b/Makeconf
@@ -3,6 +3,7 @@ modules := memory/device \
            memory/ram \
            memory/bootrom_overlay \
            memory/register \
+		   memory/bank \
            cpu/cpu \
            cpu/decoder
 
diff --git a/memory/bank.cpp b/memory/bank.cpp
new file mode 100644
index 0000000..b70c728
--- /dev/null
+++ b/memory/bank.cpp
@@ -0,0 +1,44 @@
+#include <memory/bank.h>
+
+Bank::Bank()
+  : banks(), current_bank(nullptr)
+{}
+
+void Bank::addBank(u8 idx, Mem_device* dev)
+{
+  banks[idx] = dev;
+}
+
+void Bank::setBank(u8 idx)
+{
+  auto it = banks.find(idx);
+  if(it == banks.end())
+    current_bank = nullptr;
+  else
+    current_bank = it->second;
+}
+
+
+void Bank::write8(u16 addr, u8 data)
+{
+  if(current_bank == nullptr) return;
+  current_bank->write8(addr, data);
+}
+
+u8 Bank::read8(u16 addr)
+{
+  if(current_bank == nullptr) return 0xFFu;
+  return current_bank->read8(addr);
+}
+
+void Bank::write16(u16 addr, u16 data)
+{
+  if(current_bank == nullptr) return;
+  current_bank->write16(addr, data);
+}
+
+u16 Bank::read16(u16 addr)
+{
+  if(current_bank == nullptr) return 0xFFu;
+  return current_bank->read16(addr);
+}
diff --git a/memory/bank.h b/memory/bank.h
new file mode 100644
index 0000000..c6be8bc
--- /dev/null
+++ b/memory/bank.h
@@ -0,0 +1,23 @@
+#pragma once
+
+#include <memory/device.h>
+
+#include <map>
+
+class Bank : public Mem_device {
+private:
+  Mem_device* current_bank;
+  std::map<u8, Mem_device*> banks;
+public:
+  Bank();
+
+  void addBank(u8 idx, Mem_device* dev);
+
+  void setBank(u8 bank);
+
+  void write8(u16 addr, u8 data);
+  u8 read8(u16 addr);
+
+  void write16(u16 addr, u16 data);
+  u16 read16(u16 addr);
+};