#include "mem.h"



void memInit(ArmMem* mem){
	
	UInt8 i;
	
	for(i = 0; i < MAX_MEM_REGIONS; i++){
		mem->regions[i].sz = 0;
	}
}


void memDeinit(_UNUSED_ ArmMem* mem){
	
	//nothing here
}

Boolean memRegionAdd(ArmMem* mem, UInt32 pa, UInt32 sz, ArmMemAccessF aF, void* uD){

	UInt8 i;
	
	//check for intersection with another region
	
	for(i = 0; i < MAX_MEM_REGIONS; i++){
		
		if(!mem->regions[i].sz) continue;
		if((mem->regions[i].pa <= pa && mem->regions[i].pa + mem->regions[i].sz > pa) || (pa <= mem->regions[i].pa && pa + sz > mem->regions[i].pa)){
		
			return false;		//intersection -> fail
		}
	}
	
	
	//find a free region and put it there
	
	for(i = 0; i < MAX_MEM_REGIONS; i++){
		if(mem->regions[i].sz == 0){
		
			mem->regions[i].pa = pa;
			mem->regions[i].sz = sz;
			mem->regions[i].aF = aF;
			mem->regions[i].uD = uD;
		
			return true;
		}
	}
	
	
	//fail miserably
	
	return false;	
}

Boolean memRegionDel(ArmMem* mem, UInt32 pa, UInt32 sz){

	UInt8 i;
	
	for(i = 0; i < MAX_MEM_REGIONS; i++){
		if(mem->regions[i].pa == pa && mem->regions[i].sz ==sz){
		
			mem->regions[i].sz = 0;
			return true;
		}
	}
	
	return false;
}

Boolean memAccess(ArmMem* mem, UInt32 addr, UInt8 size, Boolean write, void* buf){
	
	UInt8 i;
	
	for(i = 0; i < MAX_MEM_REGIONS; i++){
		if(mem->regions[i].pa <= addr && mem->regions[i].pa + mem->regions[i].sz > addr){
		
			return mem->regions[i].aF(mem->regions[i].uD, addr, size, write & 0x7F, buf);
		}
	}
	
	if(!(write & 0x80)){	//high bit in write tells us to not print this error (used by gdb stub)
		
		err_str("Memory ");
		err_str(write ? "write" : "read");
		err_str(" of ");
		err_dec(size);
		err_str(" bytes at physical addr 0x");
		err_hex(addr);
		err_str(" fails, halting\r\n");
		while(1);
	}
	
	return false;
}