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

/* Whether to do immediate statistics */

#define IMM_STATS 0

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;

}

#if IMM_STATS

int bcnt[33] = {0};

int bits (unsigned long val) {

  int i = 1;

  if (!val) return 0;

  while (val != 0 && val != 0xffffffff) {i++;val >>= 1;}

  return i;

}

void check_insn (unsigned long insn) {

  int insn_index = insn_decode (insn);

  struct insn_op_struct *opd = op_start[insn_index];

  unsigned long data = 0;

  int dis = 0;

  char *name;

  if (!insn || insn_index < 0) return;

  name = insn_name (insn_index);

  if (strcmp (name, "l.movhi") == 0 || strcmp (name, "l.nop") == 0 || strcmp (name, "l.sys") == 0) return;

  while (1)

    {

      unsigned long tmp = 0, nbits = 0;

      while (1)

        {

          tmp |= ((insn  >> (opd->type & OPTYPE_SHR)) & ((1 << opd->data) - 1)) << nbits;

          nbits += opd->data;

          if (opd->type & OPTYPE_OP)

            break;

          opd++;

        }

      /* Do we have to sign extend? */

      if (opd->type & OPTYPE_SIG)

        {

          int sbit = (opd->type & OPTYPE_SBIT) >> OPTYPE_SBIT_SHR;

          if (tmp & (1 << sbit))

            tmp |= 0xFFFFFFFF << sbit;

        }

      if (opd->type & OPTYPE_DIS) {

        /* We have to read register later.  */

        data += tmp;

        dis = 1;

      } else

        {

          if (!(opd->type & OPTYPE_REG) || dis) {

            if (!dis) data = tmp;

            //printf ("%08x %s\n", data, name);

            bcnt[bits(data)]++;

          }

          data = 0;

          dis = 0;

        }

      if(opd->type & OPTYPE_LAST) {

        return;

      }

      opd++;

    }

}

#endif

char null_str[1] = "\0";

/* 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);

  setsim_mem32 (vaddr, insn);

#if IMM_STATS

  check_insn (insn);

#endif

  if(runtime.sim.filename)

    freemem += insn_len (insn_decode (insn));

}

/* Load big-endian COFF file.  */

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 IMM_STATS  

  {

    int i = 0;

    for (i = 0; i < 33; i++) printf ("%i:%i\t", i, bcnt[i]);

    printf ("\n");

  }

#endif

  if (transl_error)

    return -1;

  else

    return translate(freemem,&breakpoint);

}