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"
#include "sim-config.h"
 
#define MEMORY_LEN 0x100000000
#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;
 
 
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);
}
 
char *
stripwhite (string)
     char *string;
{
  register char *s, *t;
 
  for (s = string; whitespace (*s); s++)
    ;
 
  if (*s == 0)
    return (s);
 
  t = s + strlen (s) - 1;
  while (t > s && whitespace (*t))
    t--;
  *++t = '\0';
 
  return s;
}
 
char *
dupstr (s)
     char *s;
{
  char *r;
 
  r = (char *)malloc (strlen (s) + 1);
  strcpy (r, s);
  return (r);
}
 
/* Used only by the simulator loader to translate logical addresses into physical.
   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)) {
      setsim_mem32(transl_table + i + 8, -2); /* Page modified */
      printf("found paddr=%x\n", evalsim_mem32(transl_table + i + 4) | (laddr & (PAGE_SIZE - 1)));
      return (unsigned long)evalsim_mem32(transl_table + i + 4) | (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) == 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));
      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) | (laddr & (PAGE_SIZE - 1)));
      return (unsigned long)evalsim_mem32(transl_table + i + 4) | (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;
}
 
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 = (!runtime.sim.filename) ? translate(address,breakpoint) : translate(freemem,breakpoint);
 
  debug(9,"addprogram 1\n");
 
  setsim_mem32 (vaddr, insn);
 
  if(runtime.sim.filename)
    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(" paddr: 0x%.8x,", COFF_LONG_H(coffscnhdr.s_paddr));
    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);
#if 0
    /* 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);
    }
#endif
#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_paddr);
    debug(2,"Starting to load at 0x%x\n", 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(8,"readfile_coff: %x 0x%x   \n", sectsize, insn >> 16);
        }
      else
        debug(8,"readfile_coff: %x 0x%x   \n", 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;
  int count = 0;
  long nsyms = syms;
  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--) {
    int i, n;
    if (fread(&coffsymhdr, COFF_SYMESZ, 1, inputfs) != 1) {
      fclose(inputfs);
      perror("readsyms_coff");
      exit(1);
    }
 
    n = (unsigned char)coffsymhdr.e_numaux[0];
 
    /* check whether this symbol belongs to a section and is external symbol; ignore all others */
    if (COFF_SHORT_H(coffsymhdr.e_scnum) >= 0 && coffsymhdr.e_sclass[0] == C_EXT) {
#if 0
    /* If not important or not in text, skip. */
    if(COFF_SHORT_H(coffsymhdr.e_type) & COFF_N_TMASK & COFF_STYP_TEXT) {
#endif
 
      if (*((unsigned long *)coffsymhdr.e.e.e_zeroes)) {
        if (strlen(coffsymhdr.e.e_name) && strlen(coffsymhdr.e.e_name) < 9)
          add_label(COFF_LONG_H(coffsymhdr.e_value), coffsymhdr.e.e_name);
        debug(8, "[%i] Symbol: %s,", count++, coffsymhdr.e.e_name);
      } else {
        long fpos = ftell (inputfs);
 
        if (fseek(inputfs, symptr + nsyms * COFF_SYMESZ + COFF_LONG_H(coffsymhdr.e.e.e_offset), SEEK_SET) == 0) {
          char tmp[33], *s = &tmp[0];     
          while (s != &tmp[32])
            if ((*(s++) = fgetc(inputfs)) == 0) break;
          tmp[32] = 0;
          add_label(COFF_LONG_H(coffsymhdr.e_value), &tmp[0]);
          debug(8, "[%i] Symbol: %s,", count++, &tmp[0]);
        }
        fseek(inputfs, fpos, SEEK_SET);
      }
 
      debug(9, " val: 0x%.8x,", COFF_LONG_H(coffsymhdr.e_value));
      debug(9, " type: %x, %x, auxs: %i\n", COFF_SHORT_H(coffsymhdr.e_type), *((unsigned short *)coffsymhdr.e_type), n);
    }
 
    for (i = 0; i < n; i++)
      if (fread(&coffsymhdr, COFF_SYMESZ, 1, inputfs) != 1) {
        fclose(inputfs);
        perror("readsyms_coff3");
        exit(1);
      }
    syms -= n;
    count += n;
  }
 
  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);
}