#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);

	}

}