ComSquare/sources/Memory/ARectangleMemory.cpp

//
// Created by anonymus-raccoon on 1/29/20.
//

#include <iostream>
#include "ARectangleMemory.hpp"
#include "../Exceptions/InvalidAddress.hpp"

namespace ComSquare::Memory
{
	uint8_t ARectangleMemory::read(uint24_t addr)
	{
		addr += this->getStart();
		uint8_t bank = addr >> 16u;
		uint16_t page = addr;
		unsigned bankCount = bank - this->_startBank;
		unsigned pageCount = this->_endPage - this->_startPage;

		if (bank < this->_startBank || bank > this->_endBank)
			throw InvalidAddress("Rectangle memory read Invalid Bank", addr);
		if (page < this->_startPage || page > this->_endPage)
			throw InvalidAddress("Rectangle memory read Invalid Page", addr);
		page -= this->_startPage;
		page += pageCount * bankCount;
		return this->read_internal(page);
	}

	void ARectangleMemory::write(uint24_t addr, uint8_t data)
	{
		addr += this->getStart();
		uint8_t bank = addr >> 16u;
		uint16_t page = addr;
		unsigned bankCount = bank - this->_startBank;
		unsigned pageCount = this->_endPage - this->_startPage;

		if (bank < this->_startBank || bank > this->_endBank)
			throw InvalidRectangleAddress("Rectangle memory write Invalid Bank", addr, bank, this->_startBank, this->_endBank);
		if (page < this->_startPage || page > this->_endPage)
			throw InvalidRectangleAddress("Rectangle memory write Invalid Page", addr, page, this->_startPage, this->_endPage);
		page -= this->_startPage;
		page += pageCount * bankCount;
		this->write_internal(page, data);
	}

	bool ARectangleMemory::hasMemoryAt(uint24_t addr)
	{
		uint8_t bank = addr >> 16u;
		uint16_t page = addr;

		if (this->_startBank <= bank && bank <= this->_endBank)
			if (this->_startPage <= page && page <= this->_endPage)
				return true;
		return false;
	}

	uint24_t ARectangleMemory::getStart()
	{
		return (this->_startBank << 16u) + this->_startPage;
	}

	void ARectangleMemory::setMemoryRegion(uint8_t startBank, uint8_t endBank, uint16_t startPage, uint16_t endPage)
	{
		this->_startBank = startBank;
		this->_endBank = endBank;
		this->_startPage = startPage;
		this->_endPage = endPage;
	}
}