franta-hg@29: /**
franta-hg@29:  * RGB assembler
franta-hg@29:  * Copyright © 2017 František Kučera (frantovo.cz)
franta-hg@29:  *
franta-hg@29:  * This program is free software: you can redistribute it and/or modify
franta-hg@29:  * it under the terms of the GNU General Public License as published by
franta-hg@29:  * the Free Software Foundation, either version 3 of the License, or
franta-hg@29:  * (at your option) any later version.
franta-hg@29:  *
franta-hg@29:  * This program is distributed in the hope that it will be useful,
franta-hg@29:  * but WITHOUT ANY WARRANTY; without even the implied warranty of
franta-hg@29:  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
franta-hg@29:  * GNU General Public License for more details.
franta-hg@29:  *
franta-hg@29:  * You should have received a copy of the GNU General Public License
franta-hg@29:  * along with this program. If not, see <http://www.gnu.org/licenses/>.
franta-hg@29:  */
franta-hg@29: 
franta-hg@20: #pragma once
franta-hg@20: 
franta-hg@20: #include "types.h"
franta-hg@20: 
franta-hg@20: const address_t MEMORY_SIZE = 1024;
franta-hg@20: 
franta-hg@20: template<typename T> T logMemoryError(const address_t &index) {
franta-hg@20: 	wprintf(L"memory error: index = %d, sizeof(T) = %d, MEMORY_SIZE = %d\n", index, sizeof (T), MEMORY_SIZE);
franta-hg@20: 	// TODO: return error value or throw exception
franta-hg@20: 	return T();
franta-hg@20: }
franta-hg@20: 
franta-hg@20: /**
franta-hg@20:  * Reads data on given position in memory and increments the index (position).
franta-hg@20:  * 
franta-hg@20:  * @param memory array of bytes / octets
franta-hg@20:  * @param index offset in same units as memory type
franta-hg@20:  * @return value found at given position
franta-hg@20:  */
franta-hg@20: template<typename T> T read(octet_t * memory, address_t &index) {
franta-hg@20: 	// TODO: map higher memory to static hardcoded areas or peripherals
franta-hg@20: 	if (index + sizeof (T) <= MEMORY_SIZE) {
franta-hg@20: 		T * value = reinterpret_cast<T*> (memory + index);
franta-hg@20: 		index += sizeof (T);
franta-hg@20: 		return *value;
franta-hg@20: 	} else {
franta-hg@20: 		return logMemoryError<T>(index);
franta-hg@20: 	}
franta-hg@20: }
franta-hg@20: 
franta-hg@20: /**
franta-hg@20:  * Writes data to given position in memory and increments the index (position).
franta-hg@20:  * @param memory array of bytes / octets
franta-hg@20:  * @param index offset in same units as memory type
franta-hg@20:  * @param value value to be written at given position
franta-hg@20:  */
franta-hg@20: template<typename T> T write(octet_t * memory, address_t &index, const T value) {
franta-hg@20: 	if (index + sizeof (T) <= MEMORY_SIZE) {
franta-hg@20: 		T * m = reinterpret_cast<T*> (memory + index);
franta-hg@20: 		*m = value;
franta-hg@20: 		index += sizeof (value);
franta-hg@20: 	} else {
franta-hg@20: 		return logMemoryError<T>(index);
franta-hg@20: 	}
franta-hg@20: }