Subversion Repositories or1k

/* parce.c -- Architecture independent load
   Copyright (C) 1999 Damjan Lampret, lampret@opencores.org
 
This file is part of OpenRISC 1000 Architectural Simulator.
 
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 2 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, write to the Free Software
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */
 
#include <stdio.h>
#include <ctype.h>
#include <string.h>
#include <stdlib.h>
 
#include "abstract.h"
#include "arch.h"
#include "dmmu.h"
#include "coff.h"
#include "debug_unit.h"
#include "opcode/or32.h"
#include "parse.h"
 
#define MAXLINE_LEN	18000
 
extern char *disassembled;
 
/* Unused mem memory marker. It is used when allocating program and data memory
   during parsing */
unsigned int freemem;
 
/* Translation table provided by microkernel. Only used if simulating microkernel. */
static unsigned long transl_table;
 
/* Used to signal whether during loading of programs a translation fault occured. */
static unsigned long transl_error;
 
 
int nonempty(char *line)
{
	int i;
 
	for(i = 0; i < strlen(line); i++)
		if (!isspace(line[i]))
			return(1);
	return(0);
}
 
int nondigit(char *line)
{
	int i;
 
	for(i = 0; i < strlen(line); i++)
		if (!isdigit(line[i]))
			return(1);
	return(0);
}
 
char *strtoken(char *in, char *out, int which)
{
	char	*super;
	char	*sub;
	char	*newline;
 
	super = strdup(in);
	sub = strtok(super, " \t");
	while (sub && --which)
		sub = strtok(NULL, " \t");
	if (sub && !which) {
		if ((newline = strchr(sub, '\n')))
			newline[0] = '\0';
		strcpy(out, sub);
	} else
		out[0] = '\0';
	free(super);
	if ((newline = strchr(out, '\r')))	/* get rid of CR */
		newline[0] = '\0';
	return(out);
}
 
/* Used only by the simulator loader to translate logical addresses int ophysical.
   If loadcode() is called with valid virtphy_transl pointer to a table of
   translations then translate() performs translation otherwise phy address is
   equal to logical. */
static unsigned int translate(unsigned int laddr,int* breakpoint)
{
	int i;
 
	/* No translation (i.e. when loading kernel into simulator)
/*	printf("transl_table=%x  laddr=%x\n", transl_table, laddr);
	printf("laddr=%x\n", laddr);*/
	if (transl_table == 0)
		return laddr;
 
	/* Try to find our translation in the table. */
	for(i = 0; i < (MEMORY_LEN / PAGE_SIZE) * 16; i += 16)
		if ((laddr & ~(PAGE_SIZE - 1)) == evalsim_mem32(transl_table + i,breakpoint)) {
			setsim_mem32(transl_table + i + 8, -2);	/* Page modified */
			printf("found paddr=%x\n", evalsim_mem32(transl_table + i + 4,breakpoint) | (laddr & (PAGE_SIZE - 1)));
			return (unsigned long)evalsim_mem32(transl_table + i + 4,breakpoint) | (laddr & (unsigned long)(PAGE_SIZE - 1));
		}
 
	/* Allocate new phy page for us. */
	for(i = 0; i < (MEMORY_LEN / PAGE_SIZE) * 16; i += 16)
		if (evalsim_mem32(transl_table + i + 8,breakpoint) == 0) {
			setsim_mem32(transl_table + i, laddr & ~(PAGE_SIZE - 1)); /* VPN */
			setsim_mem32(transl_table + i + 4, (i/16) * PAGE_SIZE);	/* PPN */
			setsim_mem32(transl_table + i + 8, -2);	/* Page modified */
			printf("newly allocated ppn=%x\n", (unsigned long)evalsim_mem32(transl_table + i + 4,breakpoint));
			printf("newly allocated .ppn=%x\n", (unsigned long)transl_table + i + 4);
			printf("newly allocated ofs=%x\n", (unsigned long)(laddr & (PAGE_SIZE - 1)));
			printf("newly allocated paddr=%x\n", (unsigned long)evalsim_mem32(transl_table + i + 4,breakpoint) | (laddr & (PAGE_SIZE - 1)));
			return (unsigned long)evalsim_mem32(transl_table + i + 4,breakpoint) | (laddr & (unsigned long)(PAGE_SIZE - 1));
		}
	/* If we come this far then all phy memory is used and we can't find our page
	   nor allocate new page. */
	transl_error = 1;
 
	printf("can't translate\n", laddr);
	exit(1);
	return -1;
}
 
void adddatastr(char *str,int* breakpoint)
{
	if (str)
		str++;
	else
		return;
 
	for(; *str && *str != '\"'; str++, translate(freemem++,breakpoint))
		if (*str == '\\')
			switch (*++str) {
				case 'n': mem[translate(freemem,breakpoint)].data = '\n';
					break;
				case 't': mem[translate(freemem,breakpoint)].data = '\t';
					break;
				case 'r': mem[translate(freemem,breakpoint)].data = '\r';
					break;
				case '0': mem[translate(freemem,breakpoint)].data = '\0';
					break;
				default: break;
			}
		else
			mem[translate(freemem,breakpoint)].data = *str;
}
 
/* Modified by CZ 26/05/01 */
/* Added code for new mode operation */
void adddataword(char *item,int* breakpoint)
{
	unsigned long num;
 
	if (isdigit(*item))
		num = strtoul(item, NULL, 0);
	else
		num = eval_label(item);
 
	debug("adddataword: [0x%x] <= %x\n", translate(freemem,breakpoint), num);
	mem[translate(freemem,breakpoint)].data = (char) (num >> 24);
	mem[translate(freemem + 1,breakpoint)].data = (char) (num >> 16);
	mem[translate(freemem + 2,breakpoint)].data = (char) (num >> 8);
	mem[translate(freemem + 3,breakpoint)].data = (char) (num);
 
	if(!GlobalMode)
	  freemem += 4;
}
 
void adddatahalf(char *item,int* breakpoint)
{
	unsigned long num;
 
	if (isdigit(*item))
		num = strtoul(item, NULL, 0);
	else
		num = eval_label(item);
 
	mem[translate(freemem,breakpoint)].data = (char) (num >> 8);
	mem[translate(freemem + 1,breakpoint)].data = (char) (num);
 
	freemem += 2;
}
 
void adddatabyte(char *item,int* breakpoint)
{
	unsigned long num;
 
	if (isdigit(*item))
		num = strtoul(item, NULL, 0);
	else
		num = eval_label(item);
 
	mem[translate(freemem,breakpoint)].data = (char) (num);
 
	freemem++;
}
 
void adddataspace(char *num)
{
	freemem += atol(num);
}
 
void addlabel(char *label, unsigned long freemem,int* breakpoint)
{
	struct label_entry **tmp;
 
	debug("Adding label %s at 0x%x\n", label, translate(freemem,breakpoint));
	tmp = &mem[translate(freemem,breakpoint)].label;
	for (; *tmp; tmp = &((*tmp)->next));
	*tmp = malloc(sizeof(**tmp));
	(*tmp)->name = malloc(strlen(label)+1);
	strcpy((*tmp)->name, label);
	(*tmp)->next = NULL;
 
        return;
}
 
char null_str[1] = "\0";
 
/* Modified by CZ 26/05/01 */
/* Replaced several calls to translate(freemem) with vaddr */
/* Added new mode execution code */
/* Changed parameters so address can be passed as argument */
void addprogram(unsigned long address, unsigned long insn, int* breakpoint)
{
  char insn_first2_char[3];
  int vaddr = GlobalMode ? translate(address,breakpoint) : translate(freemem,breakpoint);
 
  debug("addprogram 1\n");
 
  *breakpoint += CheckDebugUnit(DebugStoreAddress,vaddr);  /* 22/06/01 MM*/
  *breakpoint += CheckDebugUnit(DebugStoreData,insn);
 
  setsim_mem32 (vaddr, insn);
 
  if(!GlobalMode)
    freemem += insn_len (insn_decode (insn));
}
 
/* Load big-endian COFF file. At the moment it doesn't load symbols yet. */
 
void readfile_coff(char *filename, short sections)
{
	FILE *inputfs;
	char inputbuf[4];
	unsigned long insn;
	signed long sectsize;
	COFF_AOUTHDR coffaouthdr;
	struct COFF_scnhdr coffscnhdr;
	int  len;
	char item[MAXLINE_LEN];
	char item2[MAXLINE_LEN];
	int  firstthree = 0;
	int breakpoint = 0;
 
	if (!(inputfs = fopen(filename, "r"))) {
		perror("readfile_coff");
		exit(1);
	}
 
	if (fseek(inputfs, sizeof(struct COFF_filehdr), SEEK_SET) == -1) {
		fclose(inputfs);
		perror("readfile_coff");
		exit(1);
	}
 
	if (fread(&coffaouthdr, sizeof(coffaouthdr), 1, inputfs) != 1) {
		fclose(inputfs);
		perror("readfile_coff");
		exit(1);
	}
 
	while(sections--) {
		long scnhdr_pos = sizeof(struct COFF_filehdr) + sizeof(coffaouthdr)
				+ sizeof(struct COFF_scnhdr) * firstthree;
		if (fseek(inputfs, scnhdr_pos, SEEK_SET) == -1) {
			fclose(inputfs);
			perror("readfile_coff");
			exit(1);
		}
		if (fread(&coffscnhdr, sizeof(struct COFF_scnhdr), 1, inputfs) != 1) {
			fclose(inputfs);
			perror("readfile_coff");
			exit(1);
		}
		printf("Section: %s,", coffscnhdr.s_name);
		printf(" vaddr: 0x%.8x,", COFF_LONG_H(coffscnhdr.s_vaddr));
		printf(" size: 0x%.8x,", COFF_LONG_H(coffscnhdr.s_size));
		printf(" scnptr: 0x%.8x\n", COFF_LONG_H(coffscnhdr.s_scnptr));
 
		sectsize = COFF_LONG_H(coffscnhdr.s_size);
		/* A couple of sanity checks. */
		if (translate(COFF_LONG_H(coffscnhdr.s_vaddr),&breakpoint) < MEMORY_START) {
			printf("Section %s starts out of ", coffscnhdr.s_name);
			printf("memory (at %x)\n", COFF_LONG_H(coffscnhdr.s_vaddr));
			exit(1);
		}
		if (translate(COFF_LONG_H(coffscnhdr.s_vaddr) + sectsize,&breakpoint) >
		    MEMORY_START + MEMORY_LEN) {
			printf("Section %s ends out of ", coffscnhdr.s_name);
			printf("memory.\n");
			exit(1);
		}
#if 0
		if (++firstthree == 1 && strcmp(coffscnhdr.s_name, ".text") != 0) {
			printf("First section should be .text (%s instead)\n", coffscnhdr.s_name);
			exit(1);
		}
		if (firstthree == 2 && strcmp(coffscnhdr.s_name, ".data") != 0) {
			printf("Second section should be .data (%s instead)\n", coffscnhdr.s_name);
			exit(1);
		}
		if (firstthree == 3 && strcmp(coffscnhdr.s_name, ".bss") != 0) {
			printf("Third section should be .bss (%s instead)\n", coffscnhdr.s_name);
			exit(1);
		}
#else
		++firstthree;
#endif
 
		/* loading section */
		freemem = COFF_LONG_H(coffscnhdr.s_vaddr);
		debug("Starting to load at 0x%x", freemem);
		if (fseek(inputfs, COFF_LONG_H(coffscnhdr.s_scnptr), SEEK_SET) == -1) {
			fclose(inputfs);
			perror("readfile_coff");
			exit(1);
		}
		while (sectsize > 0 && (len = fread(&inputbuf, sizeof(inputbuf), 1, inputfs))) {
			insn = COFF_LONG_H(inputbuf);
			len = insn_len (insn_decode (insn));
			if (len == 2)
			  {
			    fseek(inputfs, -2, SEEK_CUR);
			    debug("readfile_coff: %x 0x%x   ", sectsize, insn >> 16);
			  }
			else
			  debug("readfile_coff: %x 0x%x   ", sectsize, insn);
			addprogram (freemem, insn, &breakpoint);
			sectsize -= len;
		}
	}
	if (firstthree < 3) {
		printf("One or more missing sections. At least");
		printf(" three sections expected (.text, .data, .bss).\n");
		exit(1);
	}
	if (firstthree > 3) {
		printf("Warning: one or more extra sections. These");
		printf(" sections were handled as .data sections.\n");
	}
 
	fclose(inputfs);
	printf("Finished loading COFF.\n");
	return;
}
 
/* Load symbols from big-endian COFF file. */
 
void readsyms_coff(char *filename, unsigned long symptr, long syms)
{
	FILE *inputfs;
	struct COFF_syment coffsymhdr;
	int breakpoint = 0;
 
	if (!(inputfs = fopen(filename, "r"))) {
		perror("readsyms_coff");
		exit(1);
	}
 
	if (fseek(inputfs, symptr, SEEK_SET) == -1) {
		fclose(inputfs);
		perror("readsyms_coff");
		exit(1);
	}
 
	while(syms--) {
		if (fread(&coffsymhdr, COFF_SYMESZ, 1, inputfs) != 1) {
			fclose(inputfs);
			perror("readsyms_coff");
			exit(1);
		}
		debug("Symbol: %s,", coffsymhdr.e.e_name);
		debug(" val: 0x%.8x,", COFF_LONG_H(coffsymhdr.e_value));
		debug(" auxs: %c\n", coffsymhdr.e_numaux);
		if (strlen(coffsymhdr.e.e_name) && strlen(coffsymhdr.e.e_name) < 9)
			addlabel(coffsymhdr.e.e_name, COFF_LONG_H(coffsymhdr.e_value),&breakpoint);
	}
 
	fclose(inputfs);
	printf("Finished loading symbols.\n");
	return;
}
 
/* Identify file type and call appropriate readfile_X routine. It only
handles orX-coff-big executables at the moment. */
 
void identifyfile(char *filename)
{
	FILE *inputfs;
	struct COFF_filehdr coffhdr;
	size_t len;
 
	if (!(inputfs = fopen(filename, "r"))) {
		fprintf(stderr, "xx %s", filename);
		perror("identifyfile1");
		fflush(stdout);
		fflush(stderr);
		exit(1);
	}
 
	if (fread(&coffhdr, sizeof(coffhdr), 1, inputfs) == 1) {
		if (COFF_SHORT_H(coffhdr.f_magic) == 0x17a) {
		    	unsigned long opthdr_size;
			printf("COFF magic: 0x%.4x\n", COFF_SHORT_H(coffhdr.f_magic));
			printf("COFF flags: 0x%.4x\n", COFF_SHORT_H(coffhdr.f_flags));
			printf("COFF symptr: 0x%.8x\n", COFF_LONG_H(coffhdr.f_symptr));
			if ((COFF_SHORT_H(coffhdr.f_flags) & COFF_F_EXEC) != COFF_F_EXEC) {
				printf("This COFF is not an executable.\n");
				exit(1);
			}
			opthdr_size = COFF_SHORT_H(coffhdr.f_opthdr);
			if (opthdr_size != sizeof(COFF_AOUTHDR)) {
				printf("COFF optional header is missing or not recognized.\n");
				printf("COFF f_opthdr: 0x%.2x\n", opthdr_size);
				exit(1);
			}
			fclose(inputfs);
			readfile_coff(filename, COFF_SHORT_H(coffhdr.f_nscns));
			readsyms_coff(filename, COFF_LONG_H(coffhdr.f_symptr), COFF_LONG_H(coffhdr.f_nsyms));
			return;
		}
		else {
			printf("Not COFF, quiting.\n");
			fclose(inputfs);
			exit (1);
		}
	}
	else {
		printf("yy %s", filename);
		perror("identifyfile2");
	}
 
	fclose(inputfs);
 
	return;
}
 
 
/* Loads file to memory starting at address startaddr and returns freemem. */
unsigned long loadcode(char *filename, unsigned long startaddr, unsigned long virtphy_transl)
{
  int breakpoint = 0;
 
	transl_error = 0;
	transl_table = virtphy_transl;
	freemem = startaddr;
	printf("loadcode: filename %s  startaddr=%x  virtphy_transl=%x", filename, startaddr, virtphy_transl);
	identifyfile(filename);
	if (transl_error)
		return -1;
	else
		return translate(freemem,&breakpoint);
}