/**

 * RGB assembler

 * Copyright © 2017 František Kučera (frantovo.cz)

 *

 * This program is free software: you can redistribute it and/or modify

 * it under the terms of the GNU General Public License as published by

 * the Free Software Foundation, either version 3 of the License, or

 * (at your option) any later version.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the

 * GNU General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program. If not, see <http://www.gnu.org/licenses/>.

 */

#pragma once

#include "types.h"

const address_t MEMORY_SIZE = 1024;

template<typename T> T logMemoryError(const address_t &index) {

	wprintf(L"memory error: index = %d, sizeof(T) = %d, MEMORY_SIZE = %d\n", index, sizeof (T), MEMORY_SIZE);

	// TODO: return error value or throw exception

	return T();

}

/**

 * Reads data on given position in memory and increments the index (position).

 * 

 * @param memory array of bytes / octets

 * @param index offset in same units as memory type

 * @return value found at given position

 */

template<typename T> T read(octet_t * memory, address_t &index) {

	// TODO: map higher memory to static hardcoded areas or peripherals

	if (index + sizeof (T) <= MEMORY_SIZE) {

		T * value = reinterpret_cast<T*> (memory + index);

		index += sizeof (T);

		return *value;

	} else {

		return logMemoryError<T>(index);

	}

}

/**

 * Writes data to given position in memory and increments the index (position).

 * @param memory array of bytes / octets

 * @param index offset in same units as memory type

 * @param value value to be written at given position

 */

template<typename T> T write(octet_t * memory, address_t &index, const T value) {

	if (index + sizeof (T) <= MEMORY_SIZE) {

		T * m = reinterpret_cast<T*> (memory + index);

		*m = value;

		index += sizeof (value);

	} else {

		return logMemoryError<T>(index);

	}

}