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

}