Subversion Repositories aemb

/*!  
  AEMB INSTRUCTION SET SIMULATOR 
  Copyright (C) 2009 Shawn Tan <shawn.tan@aeste.net>
 
  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/>.
*/
 
#include "InstMemory.hh"
 
#include <utility>
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <assert.h>
 
using namespace std;
 
namespace aemb
{
 
void InstMemory::putInst(const int addr, const int data)
{
	int word = addr >> 2; // word align the address
	mem.insert(make_pair(word, data));
}
 
int InstMemory::getInst(const int addr)
{
	int word = addr >> 2; // word align the address
	assert(!(addr & 0x03)); // check word alignment
	map<int,int>::iterator data = mem.find(word);
	assert(data != mem.end()); // check if the address is valid	
	return data->second;
} 
 
int InstMemory::readVmem()
{
	char str[255];
	char *tok = NULL;
	char *cend = NULL;
	long addr, data;
 
	while (fgets(str, 255, stdin) != NULL) {
		switch(str[0]) {
			case '@':
				// extract address
				tok = strtok(str," ");
				cend = tok;
				cend++;				
				addr = strtoul(cend, &cend, 16);
 
				#ifndef NDEBUG
				printf("\n");
				#endif
 
				// extract data
				//tok = strtok(NULL," ");				
				while ((tok = strtok(NULL, " ")) != NULL) {
					data = strtoul(tok, &cend, 16);
					putInst((addr << 2), data);
 
					#ifndef NDEBUG				
					printf("\t%X:%.8X", (unsigned int)addr,(unsigned int)data);
					#endif
 
					++addr;
				}		
			break;
 
			default: // ignored line
				//fprintf(stderr,"*** Error parsing VMEM format ***\n");
			break;			
		}
 
	}
 
	#ifndef NDEBUG
	printf("\nVMEM size: %d",mem.size());
	#endif
 
	return mem.size();	
}
 
void InstMemory::dumpMem()
{
	map<int,int>::iterator iter;
 
	for (iter = mem.begin(); iter != mem.end(); ++iter) {
		#ifndef NDEBUG
		printf("\n%X : %.8X",iter->first, iter->second);
		#endif
	}
 
}
 
InstMemory::InstMemory()
{
}
 
InstMemory::~InstMemory()
{
}
 
}