#include "bus.h"

Bus::Bus() : map() {}

std::optional<Bus::MapEntry> Bus::find_entry(u16 addr)
{
  for(auto it = map.begin(); it != map.end(); ++it)
    {
      if (addr >= it->start && addr <= it->end)
        return std::make_optional(*it);
    }

  return {};
}

void Bus::map_device(u16 start, u16 end, Mem_device* dev)
{
  map.push_back(Bus::MapEntry{ start, end, dev });
}

void Bus::write8(u16 addr, u8 data)
{
  auto mapentry = find_entry(addr);

  if(!mapentry) return;

  mapentry->dev->write8(addr - mapentry->start, data);
}

u8 Bus::read8(u16 addr)
{
  auto mapentry = find_entry(addr);

  if(!mapentry) return 0xFFu;

  return mapentry->dev->read8(addr - mapentry->start);
}

void Bus::write16(u16 addr, u16 data)
{
  auto mapentry = find_entry(addr);
  if(!mapentry) return;
  mapentry->dev->write16(addr - mapentry->start, data);
}

u16 Bus::read16(u16 addr)
{
  auto mapentry = find_entry(addr);
  if(!mapentry) return 0xFFFFu;
  return mapentry->dev->read16(addr - mapentry->start);
}