URL https://opencores.org/ocsvn/or1k/or1k/trunk

Subversion Repositories or1k

[/] [or1k/] [tags/] [nog_patch_47/] [or1ksim/] [cpu/] [or32/] [execute.c] - Blame information for rev 538

Go to most recent revision | Details | Compare with Previous | View Log


/* execute.c -- OR1K architecture dependent simulation
   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. */
 
/* Most of the OR1K simulation is done in here. */
 
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <ctype.h>
 
#include "config.h"
#include "arch.h"
#include "opcode/or32.h"
#include "branch_predict.h"
#include "abstract.h"
#include "labels.h"
#include "parse.h"
#include "execute.h"
#include "stats.h"
#include "except.h"
#include "sprs.h"
#include "sim-config.h"
#include "debug_unit.h"
 
/* General purpose registers. */
machword reg[MAX_GPRS];
 
/* Instruction queue */
struct iqueue_entry iqueue[20];
 
/* Is current insn in execution a delay insn? */
int delay_insn;
 
/* Benchmark multi issue execution */
int multissue[20];
int supercycles;
int issued_per_cycle = 4;
int hazardwait = 0;
int nops = 0;
int nop_period = 0;
int nop_maxperiod = 0;
 
/* Whether break was hit - so we can step over a break */
static int break_just_hit = 0;
 
/* freemem 'pointer' */
extern unsigned long freemem;
 
/* Completition queue */
struct iqueue_entry icomplet[20];
 
/* Program counter (and translated PC) */
unsigned long pc;
unsigned long pc_phy;
 
/* Previous program counter */
unsigned long pcprev = 0;
 
/* Temporary program counter */
unsigned long pcnext;
 
/* Delay instruction effective address register */
unsigned long pcdelay;
 
/* CCR */
int flag;
 
/* CCR (for dependency calculation) */
char ccr_flag[10] = "flag";
 
/* Cycles counts fetch stages */
int cycles;
 
/* Each cycle has counter of mem_cycles; this value is joined with cycles
   at the end of the cycle; no sim originated memory accesses should be
   performed inbetween. */
int mem_cycles;
 
/* Instructions executed */
int instructions;
 
/* Load and store stalls */
int loadcycles, storecycles;
 
/* Local data needed for execution.  */
static struct iqueue_entry *cur;
static int next_delay_insn;
static int breakpoint;
static unsigned long *op;
static int num_op;
 
/* Implementation specific.
   Get an actual value of a specific register. */
 
machword eval_reg(int regno)
{
  if (regno < MAX_GPRS) {
    if (config.cpu.raw_range) {
      int delta = (cycles - raw_stats.reg[regno]);
      if (delta < config.cpu.raw_range)
        raw_stats.range[delta]++;
    }
    debug(9, "atoi ret1\n");
    return reg[regno];
  } else {
    printf("\nABORT: read out of registers\n");
    cont_run = 0;
    return 0;
  }
}
 
/* Implementation specific.
   Set a specific register with value. */
 
void set_reg32(int regno, unsigned long value)
{
#if 0   
  if (strcmp(regstr, FRAME_REG) == 0) {
    printf("FP (%s) modified by insn at %x. ", FRAME_REG, pc);
    printf("Old:%.8lx  New:%.8lx\n", eval_reg(regno), value);
  }
 
  if (strcmp(regstr, STACK_REG) == 0) {
    printf("SP (%s) modified by insn at %x. ", STACK_REG, pc);
    printf("Old:%.8lx  New:%.8lx\n", eval_reg(regmo), value);
  }
#endif
  if (regno == 0)               /* gpr0 is always zero */
    value = 0;
 
  if (regno < MAX_GPRS) {
    reg[regno] = value;
    if (config.cpu.raw_range)
      raw_stats.reg[regno] = cycles;
  } else {
    printf("\nABORT: write out of registers\n");
    cont_run = 0;
  }
}
 
/* Does srcoperand depend on computation of dstoperand? Return
   non-zero if yes.
 
 Cycle t                 Cycle t+1
dst: irrelevant         src: immediate                  always 0
dst: reg1 direct        src: reg2 direct                0 if reg1 != reg2
dst: reg1 disp          src: reg2 direct                always 0
dst: reg1 direct        src: reg2 disp                  0 if reg1 != reg2
dst: reg1 disp          src: reg2 disp                  always 1 (store must
                                                        finish before load)
dst: flag               src: flag                       always 1
*/
 
int depend_operands(prev, next)
     struct iqueue_entry *prev;
     struct iqueue_entry *next;
{
  /* Find destination type. */
  unsigned long type = 0;
  int i = 0;
  if (or32_opcodes[prev->insn_index].flags & OR32_W_FLAG
      && or32_opcodes[next->insn_index].flags & OR32_R_FLAG)
    return 1;
 
  while (!(prev->op[i + MAX_OPERANDS] & OPTYPE_LAST))
    if (prev->op[i + MAX_OPERANDS] & OPTYPE_DST)
      {
        type = prev->op[i + MAX_OPERANDS];
        break;
      }
    else
      i++;
 
  /* We search all source operands - if we find confict => return 1 */
  i = 0;
  while (!(next->op[i + MAX_OPERANDS] & OPTYPE_LAST))
    if (!(next->op[i + MAX_OPERANDS] & OPTYPE_DST))
      {
        if (next->op[i + MAX_OPERANDS] & OPTYPE_DIS)
          if (type & OPTYPE_DIS)
            return 1;
          else if (next->op[i] == prev->op[i]
                   && (next->op[i + MAX_OPERANDS] & OPTYPE_REG))
            return 1;
        if (next->op[i] == prev->op[i]
            && (next->op[i + MAX_OPERANDS] & OPTYPE_REG)
            && (type & OPTYPE_REG))
          return 1;
        i++;
      }
    else
      i++;
  return 0;
}
 
/* Implementation specific.
   Parses and returns operands. */
 
static void
eval_operands (unsigned long insn, int insn_index, int* breakpoint)
{
  struct insn_op_struct *opd = op_start[insn_index];
  unsigned long data = 0;
  int dis = 0;
  int no = 0;
  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 (dis && (opd->type & OPTYPE_REG))
            op[no] = data + eval_reg (tmp);
          else
            op[no] = tmp;
          op[no + MAX_OPERANDS] = opd->type | (dis ? OPTYPE_DIS : 0);
          no++;
          data = 0;
          dis = 0;
        }
      if(opd->type & OPTYPE_LAST)
        return;
      opd++;
    }
  num_op = no;
}
 
/* Implementation specific.
   Evaluates source operand op_no. */
 
unsigned long eval_operand32 (int op_no, int *breakpoint)
{
  debug (9, "%i %08X\n", op_no, op[op_no + MAX_OPERANDS]);
  if (op[op_no + MAX_OPERANDS] & OPTYPE_DIS)
    return eval_mem32 (op[op_no], breakpoint);
  else if (op[op_no + MAX_OPERANDS] & OPTYPE_REG)
    return eval_reg (op[op_no]);
  else
    return op[op_no];
}
 
/* Implementation specific.
   Evaluates source operand op_no. */
 
unsigned long eval_operand16 (int op_no, int *breakpoint)
{
  debug (9, "%i %08X\n", op_no, op[op_no + MAX_OPERANDS]);
  if (op[op_no + MAX_OPERANDS] & OPTYPE_DIS) {
    if (op[op_no] & 0x01) {
      return 0;
    }
    return eval_mem16 (op[op_no], breakpoint);
  }
  else {
    fprintf (stderr, "Invalid operand type.\n");
    exit (1);
  }
}
 
/* Implementation specific.
   Evaluates source operand op_no. */
 
unsigned long eval_operand8 (int op_no, int *breakpoint)
{
  debug (9, "%i %08X\n", op_no, op[op_no + MAX_OPERANDS]);
  if (op[op_no + MAX_OPERANDS] & OPTYPE_DIS)
    return eval_mem8 (op[op_no], breakpoint);
  else {
    fprintf (stderr, "Invalid operand type.\n");
    exit (1);
  }
}
 
/* Implementation specific.
   Set destination operand (register direct, register indirect
   (with displacement) with value. */
 
void set_operand32(int op_no, unsigned long value, int* breakpoint)
{
  /* Mark this as destination operand.  */
  op[op_no + MAX_OPERANDS] |= OPTYPE_DST;
  if (op[op_no + MAX_OPERANDS] & OPTYPE_DIS) {
    if (op[op_no] & 0x03) {
      except_handle (EXCEPT_ALIGN, op[op_no]);
      return;
    }
    set_mem32(op[op_no], value, breakpoint);
  }
  else if (op[op_no + MAX_OPERANDS] & OPTYPE_REG) {
    set_reg32(op[op_no], value);
    value & 0x80000000 ? setsprbits (SPR_SR, SPR_SR_OV, 1) : setsprbits (SPR_SR, SPR_SR_OV, 0);
  }
  else
    {
      fprintf (stderr, "Invalid operand type.\n");
      exit (1);
    }
}
 
/* Implementation specific.
   Set destination operand (register direct, register indirect
   (with displacement) with value. */
 
void set_operand16(int op_no, unsigned long value, int* breakpoint)
{
  /* Mark this as destination operand.  */
   op[op_no + MAX_OPERANDS] |= OPTYPE_DST;
  if (op[op_no + MAX_OPERANDS] & OPTYPE_DIS) {
     if (op[op_no] & 0x01) {
      except_handle (EXCEPT_ALIGN, op[op_no]);
      return;
    }
    set_mem16(op[op_no], value, breakpoint);
  }
  else
    {
      fprintf (stderr, "Invalid operand type.\n");
      exit (1);
    }
}
 
/* Implementation specific.
   Set destination operand (register direct, register indirect
   (with displacement) with value. */
 
void set_operand8(int op_no, unsigned long value, int* breakpoint)
{
  /* Mark this as destination operand.  */
  op[op_no + MAX_OPERANDS] |= OPTYPE_DST;
  if (op[op_no + MAX_OPERANDS] & OPTYPE_DIS)
    set_mem8(op[op_no], value, breakpoint);
  else
    {
      fprintf (stderr, "Invalid operand type.\n");
      exit (1);
    }
}
 
void reset()
{
  cycles = 0;
  instructions = 0;
  supercycles = 0;
  loadcycles = 0;
  storecycles = 0;
  memset(reg, 0, sizeof(reg));
  memset(iqueue, 0, sizeof(iqueue));
  memset(icomplet, 0, sizeof(icomplet));
 
  /* Cpu configuration */
  mtspr(SPR_UPR, config.cpu.upr);
  setsprbits(SPR_VR, SPR_VR_VER, config.cpu.ver);
  setsprbits(SPR_VR, SPR_VR_REV, config.cpu.rev);
 
  pcnext = 0x0; /* MM1409: All programs should start at reset vector entry!  */
  printf ("Starting at 0x%08x\n", pcnext);
  pc = pcnext;
  pc_phy = pc;
  pcnext += 4;
  debug(1, "reset ...\n");
 
  /* MM1409: All programs should set their stack pointer!  */
  except_handle(EXCEPT_RESET, 0);
}
 
/* Modified by CZ 26/05/01 for new mode execution */
/* Fetch returns nonzero if instruction should NOT be executed.  */
inline int fetch() {
  struct mem_entry *entry;
  debug(5, "fetch()\n");
 
  if (!pending.valid)
    pc_phy = translate_vrt_to_phy_add(pc);
 
  /* Update the pc for pending exceptions */
  if(pending.valid)
    except_handle_backend(pending.type,pending.address,pending.saved);
 
  /* MM: Check for breakpoint.  This has to be done in fetch cycle,
     because of peripheria.
     MM1709: if we cannot access the memory entry, we could not set the
     breakpoint earlier, so just chech the breakpoint list.  */
  if(has_breakpoint (pc_phy) && !break_just_hit) {
    break_just_hit = 1;
    return 1; /* Breakpoint set. */
  }
  break_just_hit = 0;
 
  instructions++;
 
  pc_phy &= ~0x03;
 
#if 0
  if(pc_phy > MEMORY_START + MEMORY_LEN)
    pc_phy %= MEMORY_START + MEMORY_LEN;
#endif 
 
  /* Fetch instruction. */
  {
    unsigned int _insn;
 
    _insn = eval_insn (pc_phy, &breakpoint);
    iqueue[0].insn_addr = pc;
 
    iqueue[0].insn_index = insn_decode(_insn);
    iqueue[0].insn = _insn;
  }
 
  /* update_pc will be called after execution */
 
  return 0;
}
 
/* This code actually updates the PC value.  */
inline void update_pc()
{
  pcprev = pc; /* Store value for later */
  pc = pcnext;
  pcnext = delay_insn ? pcdelay : pcnext + 4;
  nop_period++;
}
 
inline void analysis()
{
  if (config.cpu.dependstats)
    /* Instruction waits in completition buffer until retired. */
    memcpy (&icomplet[0], &iqueue[0], sizeof (struct iqueue_entry));
 
  if (config.sim.history) {
    int i;
 
    /* History of execution */
    for (i = HISTEXEC_LEN - 1; i; i--)
      histexec[i] = histexec[i - 1];
    histexec[0] = icomplet[0].insn_addr;        /* add last insn */
  }
}
 
 
/* Execution logger.  */
inline void dump_exe_log()
{
  unsigned long i = iqueue[0].insn_addr;
 
  if (i == 0xffffffff) return;
  fprintf(runtime.sim.fexe_log, "\nEXECUTED(): %.8lx:  ", i);
  fprintf(runtime.sim.fexe_log, "%.2x%.2x", evalsim_mem8(i), evalsim_mem8(i + 1));
  fprintf(runtime.sim.fexe_log, "%.2x%.2x", evalsim_mem8(i + 2), evalsim_mem8(i + 3));
  for(i = 0; i < MAX_GPRS; i++) {
    if (i % 4 == 0)
      fprintf(runtime.sim.fexe_log, "\n");
    fprintf(runtime.sim.fexe_log, "GPR%2u: %.8lx  ", i, reg[i]);
  }
  fprintf(runtime.sim.fexe_log, "\n");
  fprintf(runtime.sim.fexe_log, "SR   : %.8lx  ", mfspr(SPR_SR));
  fprintf(runtime.sim.fexe_log, "EPCR0: %.8lx  ", mfspr(SPR_EPCR_BASE));
  fprintf(runtime.sim.fexe_log, "EEAR0: %.8lx  ", mfspr(SPR_EEAR_BASE));
  fprintf(runtime.sim.fexe_log, "ESR0 : %.8lx\n", mfspr(SPR_ESR_BASE));
}
 
#if 0
void print_time (int cycles, char *output)
{
  int i = 0, c_ps = config.sim.clkcycle_ps;
  while (c_ps % 1000 == 0 && i < 2) {
    c_ps /= 1000;
    i++;
  }
  c_ps *= cycles;
  sprintf (output, "%i%cs", cycles, i == 0 ? 'p' : i == 1 ? 'n': 'u');
}
#endif
 
void dumpreg()
{
  int i;
  char temp[100];
 
  dumpmemory(iqueue[0].insn_addr, iqueue[0].insn_addr + 4, 1, 0);
  generate_time_pretty (temp, cycles);
  printf(" (executed) [time %s, #%i]\n", temp, instructions);
  if (config.cpu.superscalar)
    printf ("Superscalar CYCLES: %u", supercycles);
  if (config.cpu.hazards)
    printf ("  HAZARDWAIT: %u\n", hazardwait);
  else
    if (config.cpu.superscalar)
      printf ("\n");
 
  dumpmemory(pc, pc + 4, 1, 0);
  printf(" (next insn) %s", (delay_insn?"(delay insn)":""));
  for(i = 0; i < MAX_GPRS; i++) {
    if (i % 4 == 0)
      printf("\n");
    printf("GPR%.2u: %.8lx  ", i, reg[i]);
  }
  printf("flag: %u\n", flag);
}
 
/* Address calculation changed by CZ on 27/05/01 */
inline void decode_execute(struct iqueue_entry *current)
{
  next_delay_insn = 0;
  breakpoint = 0;
 
  if(DEBUG_ENABLED && CheckDebugUnit(DebugInstructionFetch, pc_phy))
    breakpoint++;
 
  cur = current;
  cur->func_unit = it_unknown;
  op = &cur->op[0];
 
  /* printf("0x%04x: Executing \"%s\"\n",pc,cur->insn); */
 
#ifndef HAS_EXECUTION
#error HAS_EXECUTION has to be defined in order to execute programs.
#endif
 
  if (cur->insn_index < 0)
    l_invalid();
  else
    {
      eval_operands (cur->insn, cur->insn_index, &breakpoint);
      or32_opcodes[cur->insn_index].exec();
    }
 
  /* Check for range exception */
  if (getsprbits (SPR_SR, SPR_SR_OV) && getsprbits (SPR_SR, SPR_SR_OVE))
    except_handle (EXCEPT_RANGE, 0);
 
  if (config.cpu.dependstats) {
    /* Dynamic, dependency stats. */
    adddstats(icomplet[0].insn_index, iqueue[0].insn_index, 1, check_depend());
 
    /* Dynamic, functional units stats. */
    addfstats(icomplet[0].func_unit, iqueue[0].func_unit, 1, check_depend());
 
    /* Dynamic, single stats. */
    addsstats(iqueue[0].insn_index, 1);
  }
 
  if (config.cpu.superscalar) {
    if ((cur->func_unit == it_branch) || (cur->func_unit == it_jump))
      storecycles += 0;
 
    if (cur->func_unit == it_store)
      storecycles += 1;
 
    if (cur->func_unit == it_load)
      loadcycles += 1;
#if 0        
    if ((icomplet[0].func_unit == it_load) && check_depend())
      loadcycles++;
#endif
 
    /* Pseudo multiple issue benchmark */
    if ((multissue[cur->func_unit] < 1) || (check_depend())
                    || (issued_per_cycle < 1)
        ) {
      int i;
      for (i = 0; i < 20; i++)
        multissue[i] = 2;
      issued_per_cycle = 2;
      supercycles++;
      if (check_depend())
        hazardwait++;
      multissue[it_unknown] = 2;
      multissue[it_shift] = 2;
      multissue[it_compare] = 1;
      multissue[it_branch] = 1;
      multissue[it_jump] = 1;
      multissue[it_extend] = 2;
      multissue[it_nop] = 2;
      multissue[it_move] = 2;
      multissue[it_movimm] = 2;
      multissue[it_arith] = 2;
      multissue[it_store] = 2;
      multissue[it_load] = 2;
    }
    multissue[cur->func_unit]--;
    issued_per_cycle--;
  }
  delay_insn = next_delay_insn;
 
  if(breakpoint)
    except_handle(EXCEPT_TRAP, 0);
}
 
/******************************************
 *    Instruction specific functions.     *
 ******************************************/
 
void l_add() {
  signed long temp1;
  signed char temp4;
 
  cur->func_unit = it_arith;
  temp1 = (signed long)eval_operand32(2, &breakpoint)+(signed long)eval_operand32(1, &breakpoint);
  set_operand32(0, temp1, &breakpoint);
 
  temp4 = temp1;
  if (temp4 == temp1)
    mstats.byteadd++;
}
void l_sw() {
  cur->func_unit = it_store;
  set_operand32(0, eval_operand32(1, &breakpoint), &breakpoint);
}
void l_sb() {
  cur->func_unit = it_store;
  set_operand8(0, eval_operand32(1, &breakpoint), &breakpoint);
}
void l_sh() {
  cur->func_unit = it_store;
  set_operand16(0, eval_operand32(1, &breakpoint), &breakpoint);
}
void l_lwz() {
  unsigned long val;
  cur->func_unit = it_load;
  val = eval_operand32(1, &breakpoint);
  /* If eval opreand produced exception don't set anything */
  if (pending.valid == 1)
    return;
  set_operand32(0, val, &breakpoint);
}
void l_lbs() {
  signed char val;
  cur->func_unit = it_load;
  val = eval_operand8(1, &breakpoint);
  /* If eval opreand produced exception don't set anything */
  if (pending.valid == 1)
    return;
  set_operand32(0, val, &breakpoint);
}
void l_lbz() {
  unsigned char val;
  cur->func_unit = it_load;
  val = eval_operand8(1, &breakpoint);
  /* If eval opreand produced exception don't set anything */
  if (pending.valid == 1)
    return;
  set_operand32(0, val, &breakpoint);
}
void l_lhs() {
  signed short val;
  cur->func_unit = it_load;
  val = eval_operand16(1, &breakpoint);
  /* If eval opreand produced exception don't set anything */
  if (pending.valid == 1)
    return;
  set_operand32(0, val, &breakpoint);
}
void l_lhz() {
  unsigned short val;
  cur->func_unit = it_load;
  val = eval_operand16(1, &breakpoint);
  /* If eval opreand produced exception don't set anything */
  if (pending.valid == 1)
    return;
  set_operand32(0, val, &breakpoint);
}
void l_movhi() {
  cur->func_unit = it_movimm;
  set_operand32(0, eval_operand32(1, &breakpoint) << 16, &breakpoint);
}
void l_and() {
  cur->func_unit = it_arith;
  set_operand32(0, eval_operand32(1, &breakpoint) & (unsigned)eval_operand32(2, &breakpoint), &breakpoint);
}
void l_or() {
  cur->func_unit = it_arith;
  set_operand32(0, eval_operand32(1, &breakpoint) | (unsigned)eval_operand32(2, &breakpoint), &breakpoint);
}
void l_xor() {
  cur->func_unit = it_arith;
  set_operand32(0, eval_operand32(1, &breakpoint) ^ (signed)eval_operand32(2, &breakpoint), &breakpoint);
}
void l_sub() {
  cur->func_unit = it_arith;
  set_operand32(0, (signed long)eval_operand32(1, &breakpoint) - (signed long)eval_operand32(2, &breakpoint), &breakpoint);
}
/*int mcount = 0;*/
void l_mul() {
  signed long temp3, temp2, temp1;
 
  cur->func_unit = it_arith;
  set_operand32(0, (signed long)eval_operand32(1, &breakpoint) * (signed long)eval_operand32(2, &breakpoint), &breakpoint);
  /*if (!(mcount++ & 1023)) {
    printf ("[%i]\n",mcount);
    }*/
}
void l_div() {
  signed long temp3, temp2, temp1;
 
  cur->func_unit = it_arith;
  temp3 = eval_operand32(2, &breakpoint);
  temp2 = eval_operand32(1, &breakpoint);
  if (temp3)
    temp1 = temp2 / temp3;
  else {
    except_handle(EXCEPT_ILLEGAL, iqueue[0].insn_addr);
    return;
  }
  set_operand32(0, temp1, &breakpoint);
}
void l_divu() {
  unsigned long temp3, temp2, temp1;
 
  cur->func_unit = it_arith;
  temp3 = eval_operand32(2, &breakpoint);
  temp2 = eval_operand32(1, &breakpoint);
  temp1 = temp2 / temp3;
  /* cycles += 16; */
  set_operand32(0, temp1, &breakpoint);
}
void l_sll() {
  int sign = 1;
  cur->func_unit = it_shift;
  if ((signed)eval_operand32(1, &breakpoint) < 0)
    sign = -1;
  /* cycles += 2; */
  set_operand32(0, eval_operand32(1, &breakpoint) << eval_operand32(2, &breakpoint), &breakpoint);
}
void l_sra() {
  unsigned long sign = 0;
  cur->func_unit = it_shift;
 
  if ((signed)eval_operand32(1, &breakpoint) < 0)
    sign = -1;
  /* cycles += 2; */
  set_operand32(0, (signed)eval_operand32(1, &breakpoint) >> eval_operand32(2, &breakpoint), &breakpoint);
}
void l_srl() {
  cur->func_unit = it_shift;
  /* cycles += 2; */
  set_operand32(0, eval_operand32(1, &breakpoint) >> eval_operand32(2, &breakpoint), &breakpoint);
}
void l_bf() {
  if (config.cpu.bpb) {
    int fwd = (eval_operand32(0, &breakpoint) >= pc) ? 1 : 0;
    cur->func_unit = it_branch;
    mstats.bf[flag][fwd]++;
    bpb_update(cur->insn_addr, flag);
  }
  if (flag) {
    debug(5, "\nl.bf relative: pc=%x pcnext=%x\n", pc, pcnext);
    pcdelay = pc + (signed)eval_operand32(0, &breakpoint) * 4;
    btic_update(pcnext);
    next_delay_insn = 1;
  } else {
    btic_update(pc);
  }
}
void l_bnf() {
  if (config.cpu.bpb) {
    int fwd = (eval_operand32(0, &breakpoint) >= pc) ? 1 : 0;
    cur->func_unit = it_branch;
    mstats.bnf[!flag][fwd]++;
    bpb_update(cur->insn_addr, flag == 0);
  }
  if (flag == 0) {
    debug(5, "\nl.bnf relative: pc=%x pcnext=%x\n", pc, pcnext);
    pcdelay = pc + (signed)eval_operand32(0, &breakpoint) * 4;
    btic_update(pcnext);
    next_delay_insn = 1;
  } else {
    btic_update(pc);
  }
}
void l_j() {
  debug(5, "\nl.j relative: pc=%x pcnext=%x\n", pc, pcnext);
  pcdelay = pc + (signed)eval_operand32(0, &breakpoint) * 4;
  cur->func_unit = it_jump;
  next_delay_insn = 1;
}
void l_jal() {
  debug(5, "\nl.jal relative: pc=%x pcnext=%x\n", pc, pcnext);
  pcdelay = pc + (signed)eval_operand32(0, &breakpoint) * 4;
 
  cur->func_unit = it_jump;
  set_reg32(LINK_REGNO, pc + 8);
  next_delay_insn = 1;
  if (config.sim.profile) {
    struct mem_entry *entry;
    struct label_entry *tmp;
    if (verify_memoryarea(pcdelay) && (tmp = get_label (pcdelay)))
      fprintf (runtime.sim.fprof, "+%08X %08X %08X %s\n", cycles, pc + 8, pcdelay, tmp->name);
    else
      fprintf (runtime.sim.fprof, "+%08X %08X %08X @%08X\n", cycles, pc + 8, pcdelay, pcdelay);
  }
}
void l_jalr() {
  cur->func_unit = it_jump;
  pcdelay = eval_operand32(0, &breakpoint);
  set_reg32(LINK_REGNO, pc + 8);
  next_delay_insn = 1;
}
void l_jr() {
  cur->func_unit = it_jump;
  pcdelay = eval_operand32(0, &breakpoint);
  next_delay_insn = 1;
  if (config.sim.profile)
    fprintf (runtime.sim.fprof, "-%08X %08X\n", cycles, pcdelay);
}
void l_rfe() {
  cur->func_unit = it_exception;
  pcnext = mfspr(SPR_EPCR_BASE);
  mtspr(SPR_SR, mfspr(SPR_ESR_BASE));
}
void l_nop() {
  unsigned long stackaddr;
  int k = eval_operand32(0, &breakpoint);
  cur->func_unit = it_nop;
  if (nop_period > nop_maxperiod)
    nop_maxperiod = nop_period;
  nop_period = 0;
  nops++;
  switch (k) {
    case NOP_NOP:
      break;
    case NOP_EXIT:
      printf("exit(%d)\n", eval_reg (3));
      if (config.debug.gdb_enabled)
        set_stall_state (1);
      else
        cont_run = 0;
      break;
    case NOP_PRINTF:
      stackaddr = eval_reg(4);
      simprintf(stackaddr, eval_reg(3));
      debug(5, "simprintf %x\n", stackaddr);
      break;
    case NOP_REPORT:
      printf("report(0x%x);\n", eval_reg(3));
    default:
      if (k >= NOP_REPORT_FIRST && k <= NOP_REPORT_LAST)
      printf("report %i (0x%x);\n", k - NOP_REPORT_FIRST, eval_reg(3));
      break;
  }
}
void l_sfeq() {
  cur->func_unit = it_compare;
  flag = eval_operand32(0, &breakpoint) == eval_operand32(1, &breakpoint);
  setsprbits(SPR_SR, SPR_SR_F, flag);
}
void l_sfne() {
  cur->func_unit = it_compare;
  flag = eval_operand32(0, &breakpoint) != eval_operand32(1, &breakpoint);
  setsprbits(SPR_SR, SPR_SR_F, flag);
}
void l_sfgts() {
  cur->func_unit = it_compare;
  flag = (signed)eval_operand32(0, &breakpoint) > (signed)eval_operand32(1, &breakpoint);
  setsprbits(SPR_SR, SPR_SR_F, flag);
}
void l_sfges() {
  cur->func_unit = it_compare;
  flag = (signed)eval_operand32(0, &breakpoint) >= (signed)eval_operand32(1, &breakpoint);
  setsprbits(SPR_SR, SPR_SR_F, flag);
}
void l_sflts() {
  cur->func_unit = it_compare;
  flag = (signed)eval_operand32(0, &breakpoint) < (signed)eval_operand32(1, &breakpoint);
  setsprbits(SPR_SR, SPR_SR_F, flag);
}
void l_sfles() {
  cur->func_unit = it_compare;
  flag = (signed)eval_operand32(0, &breakpoint) <= (signed)eval_operand32(1, &breakpoint);
  setsprbits(SPR_SR, SPR_SR_F, flag);
}
void l_sfgtu() {
  cur->func_unit = it_compare;
  flag = (unsigned)eval_operand32(0, &breakpoint) > (unsigned)eval_operand32(1, &breakpoint);
  setsprbits(SPR_SR, SPR_SR_F, flag);
}
void l_sfgeu() {
  cur->func_unit = it_compare;
  flag = (unsigned)eval_operand32(0, &breakpoint) >= (unsigned) eval_operand32(1, &breakpoint);
  setsprbits(SPR_SR, SPR_SR_F, flag);
}
void l_sfltu() {
  cur->func_unit = it_compare;
  flag = (unsigned)eval_operand32(0, &breakpoint) < (unsigned)eval_operand32(1, &breakpoint);
  setsprbits(SPR_SR, SPR_SR_F, flag);
}
void l_sfleu() {
  cur->func_unit = it_compare;
  flag = (unsigned)eval_operand32(0, &breakpoint) <= (unsigned)eval_operand32(1, &breakpoint);
  setsprbits(SPR_SR, SPR_SR_F, flag);
}
void l_mtspr() {
  cur->func_unit = it_move;
  if (mfspr(SPR_SR) & SPR_SR_SUPV)
    mtspr(eval_operand32(0, &breakpoint) + eval_operand32(2, &breakpoint), eval_operand32(1, &breakpoint));
  else {
    printf("WARNING: trying to write SPR while SR[SUPV] is cleared.\n");
    cont_run = 0;
  }
}
void l_mfspr() {
  cur->func_unit = it_move;
  if (mfspr(SPR_SR) & SPR_SR_SUPV)
    set_operand32(0, mfspr(eval_operand32(1, &breakpoint) + eval_operand32(2, &breakpoint)), &breakpoint);
  else {
    set_operand32(0, 0, &breakpoint);
    printf("WARNING: trying to read SPR while SR[SUPV] is cleared.\n");
    cont_run = 0;
  }
}
void l_sys() {
  except_handle(EXCEPT_SYSCALL, 0);
}
 
void l_trap() {
  /* TODO: some SR related code here! */
  except_handle(EXCEPT_TRAP, 0);
}
 
void l_mac() {
  sprword lo, hi;
  LONGEST l;
  LONGEST x, y;
  cur->func_unit = it_mac;
  lo = mfspr (SPR_MACLO);
  hi = mfspr (SPR_MACHI);
  x = eval_operand32(0, &breakpoint);
  y = eval_operand32(1, &breakpoint);
  printf ("[%08x,%08x]\t", (unsigned long)(x), (unsigned long)(y));
  l = (ULONGEST)lo | ((LONGEST)hi << 32);
  l += (LONGEST) x * (LONGEST) y;
 
  /* This implementation is very fast - it needs only one cycle for mac.  */
  lo = ((ULONGEST)l) & 0xFFFFFFFF;
  hi = ((LONGEST)l) >> 32;
  mtspr (SPR_MACLO, lo);
  mtspr (SPR_MACHI, hi);
  printf ("(%08x,%08x)\n", hi, lo);
}
void l_msb() {
  sprword lo, hi;
  LONGEST l;
  cur->func_unit = it_mac;
  lo = mfspr (SPR_MACLO);
  hi = mfspr (SPR_MACHI);
  l = (ULONGEST)lo | ((LONGEST)hi << 32);
  l -= (LONGEST) eval_operand32(0, &breakpoint) * (LONGEST)eval_operand32(1, &breakpoint);
 
  /* This implementation is very fast - it needs only one cycle for msb.  */
  lo = ((ULONGEST)l) & 0xFFFFFFFF;
  hi = ((LONGEST)l) >> 32;
  mtspr (SPR_MACLO, lo);
  mtspr (SPR_MACHI, hi);
}
void l_macrc() {
  sprword lo, hi;
  LONGEST l;
  /* No need for synchronization here -- all MAC instructions are 1 cycle long.  */
  lo =  mfspr (SPR_MACLO);
  hi =  mfspr (SPR_MACHI);
  l = (ULONGEST) lo | ((LONGEST)hi << 32);
  l >>= 28;
  //printf ("<%08x>\n", (unsigned long)l);
  set_operand32(0, (long)l, &breakpoint);
  mtspr (SPR_MACLO, 0);
  mtspr (SPR_MACHI, 0);
}
void l_cust1() {
  /*int destr = cur->insn >> 21;
    int src1r = cur->insn >> 15;
    int src2r = cur->insn >> 9;*/
}
void l_cust2() {
}
void l_cust3() {
}
void l_cust4() {
}
void l_invalid() {
  except_handle(EXCEPT_ILLEGAL, iqueue[0].insn_addr);
}

Line No.	Rev	Author	Line
1	2	cvs	`/* execute.c -- OR1K architecture dependent simulation`
2			`Copyright (C) 1999 Damjan Lampret, lampret@opencores.org`
3
4			`This file is part of OpenRISC 1000 Architectural Simulator.`
5
6			`This program is free software; you can redistribute it and/or modify`
7			`it under the terms of the GNU General Public License as published by`
8			`the Free Software Foundation; either version 2 of the License, or`
9			`(at your option) any later version.`
10
11			`This program is distributed in the hope that it will be useful,`
12			`but WITHOUT ANY WARRANTY; without even the implied warranty of`
13			`MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the`
14			`GNU General Public License for more details.`
15
16			`You should have received a copy of the GNU General Public License`
17			`along with this program; if not, write to the Free Software`
18			`Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */`
19
20			`/* Most of the OR1K simulation is done in here. */`
21
22			`#include <stdlib.h>`
23			`#include <stdio.h>`
24			`#include <string.h>`
25			`#include <ctype.h>`
26
27	123	markom	`#include "config.h"`
28	2	cvs	`#include "arch.h"`
29	133	markom	`#include "opcode/or32.h"`
30	2	cvs	`#include "branch_predict.h"`
31			`#include "abstract.h"`
32	261	markom	`#include "labels.h"`
33	2	cvs	`#include "parse.h"`
34			`#include "execute.h"`
35			`#include "stats.h"`
36	54	lampret	`#include "except.h"`
37			`#include "sprs.h"`
38	102	lampret	`#include "sim-config.h"`
39	123	markom	`#include "debug_unit.h"`
40	2	cvs
41			`/* General purpose registers. */`
42			`machword reg[MAX_GPRS];`
43
44			`/* Instruction queue */`
45			`struct iqueue_entry iqueue[20];`
46
47	83	lampret	`/* Is current insn in execution a delay insn? */`
48			`int delay_insn;`
49
50	2	cvs	`/* Benchmark multi issue execution */`
51			`int multissue[20];`
52			`int supercycles;`
53	6	lampret	`int issued_per_cycle = 4;`
54			`int hazardwait = 0;`
55			`int nops = 0;`
56			`int nop_period = 0;`
57			`int nop_maxperiod = 0;`
58	2	cvs
59	431	markom	`/* Whether break was hit - so we can step over a break */`
60			`static int break_just_hit = 0;`
61
62	68	lampret	`/* freemem 'pointer' */`
63			`extern unsigned long freemem;`
64
65	2	cvs	`/* Completition queue */`
66	138	markom	`struct iqueue_entry icomplet[20];`
67	2	cvs
68	77	lampret	`/* Program counter (and translated PC) */`
69	2	cvs	`unsigned long pc;`
70	77	lampret	`unsigned long pc_phy;`
71	2	cvs
72	378	markom	`/* Previous program counter */`
73	479	markom	`unsigned long pcprev = 0;`
74	378	markom
75	2	cvs	`/* Temporary program counter */`
76	83	lampret	`unsigned long pcnext;`
77	2	cvs
78	123	markom	`/* Delay instruction effective address register */`
79			`unsigned long pcdelay;`
80
81	2	cvs	`/* CCR */`
82			`int flag;`
83
84			`/* CCR (for dependency calculation) */`
85			`char ccr_flag[10] = "flag";`
86
87			`/* Cycles counts fetch stages */`
88			`int cycles;`
89
90	537	markom	`/* Each cycle has counter of mem_cycles; this value is joined with cycles`
91			`at the end of the cycle; no sim originated memory accesses should be`
92			`performed inbetween. */`
93			`int mem_cycles;`
94
95	535	markom	`/* Instructions executed */`
96			`int instructions;`
97
98	6	lampret	`/* Load and store stalls */`
99			`int loadcycles, storecycles;`
100
101	138	markom	`/* Local data needed for execution. */`
102			`static struct iqueue_entry *cur;`
103			`static int next_delay_insn;`
104			`static int breakpoint;`
105			`static unsigned long *op;`
106			`static int num_op;`
107
108	2	cvs	`/* Implementation specific.`
109			`Get an actual value of a specific register. */`
110
111	138	markom	`machword eval_reg(int regno)`
112	2	cvs	`{`
113	138	markom	`if (regno < MAX_GPRS) {`
114	535	markom	`if (config.cpu.raw_range) {`
115			`int delta = (cycles - raw_stats.reg[regno]);`
116			`if (delta < config.cpu.raw_range)`
117			`raw_stats.range[delta]++;`
118			`}`
119	344	markom	`debug(9, "atoi ret1\n");`
120	138	markom	`return reg[regno];`
121			`} else {`
122	393	markom	`printf("\nABORT: read out of registers\n");`
123	138	markom	`cont_run = 0;`
124			`return 0;`
125			`}`
126	2	cvs	`}`
127
128			`/* Implementation specific.`
129			`Set a specific register with value. */`
130
131	138	markom	`void set_reg32(int regno, unsigned long value)`
132	2	cvs	`{`
133	262	markom	`#if 0`
134	138	markom	`if (strcmp(regstr, FRAME_REG) == 0) {`
135			`printf("FP (%s) modified by insn at %x. ", FRAME_REG, pc);`
136			`printf("Old:%.8lx New:%.8lx\n", eval_reg(regno), value);`
137			`}`
138
139			`if (strcmp(regstr, STACK_REG) == 0) {`
140			`printf("SP (%s) modified by insn at %x. ", STACK_REG, pc);`
141			`printf("Old:%.8lx New:%.8lx\n", eval_reg(regmo), value);`
142			`}`
143	2	cvs	`#endif`
144	262	markom	`if (regno == 0) /* gpr0 is always zero */`
145	138	markom	`value = 0;`
146
147			`if (regno < MAX_GPRS) {`
148			`reg[regno] = value;`
149	535	markom	`if (config.cpu.raw_range)`
150			`raw_stats.reg[regno] = cycles;`
151	138	markom	`} else {`
152	393	markom	`printf("\nABORT: write out of registers\n");`
153	138	markom	`cont_run = 0;`
154			`}`
155	2	cvs	`}`
156
157			`/* Does srcoperand depend on computation of dstoperand? Return`
158			`non-zero if yes.`
159
160	262	markom	`Cycle t Cycle t+1`
161			`dst: irrelevant src: immediate always 0`
162			`dst: reg1 direct src: reg2 direct 0 if reg1 != reg2`
163			`dst: reg1 disp src: reg2 direct always 0`
164			`dst: reg1 direct src: reg2 disp 0 if reg1 != reg2`
165			`dst: reg1 disp src: reg2 disp always 1 (store must`
166			`finish before load)`
167	138	markom	`dst: flag src: flag always 1`
168	2	cvs	`*/`
169
170	138	markom	`int depend_operands(prev, next)`
171			`struct iqueue_entry *prev;`
172			`struct iqueue_entry *next;`
173	2	cvs	`{`
174	138	markom	`/* Find destination type. */`
175			`unsigned long type = 0;`
176			`int i = 0;`
177			`if (or32_opcodes[prev->insn_index].flags & OR32_W_FLAG`
178			`&& or32_opcodes[next->insn_index].flags & OR32_R_FLAG)`
179			`return 1;`
180	2	cvs
181	138	markom	`while (!(prev->op[i + MAX_OPERANDS] & OPTYPE_LAST))`
182			`if (prev->op[i + MAX_OPERANDS] & OPTYPE_DST)`
183			`{`
184	262	markom	`type = prev->op[i + MAX_OPERANDS];`
185			`break;`
186	138	markom	`}`
187			`else`
188			`i++;`
189
190			`/* We search all source operands - if we find confict => return 1 */`
191			`i = 0;`
192			`while (!(next->op[i + MAX_OPERANDS] & OPTYPE_LAST))`
193			`if (!(next->op[i + MAX_OPERANDS] & OPTYPE_DST))`
194			`{`
195	262	markom	`if (next->op[i + MAX_OPERANDS] & OPTYPE_DIS)`
196			`if (type & OPTYPE_DIS)`
197			`return 1;`
198			`else if (next->op[i] == prev->op[i]`
199			`&& (next->op[i + MAX_OPERANDS] & OPTYPE_REG))`
200			`return 1;`
201			`if (next->op[i] == prev->op[i]`
202			`&& (next->op[i + MAX_OPERANDS] & OPTYPE_REG)`
203			`&& (type & OPTYPE_REG))`
204			`return 1;`
205			`i++;`
206	138	markom	`}`
207			`else`
208			`i++;`
209			`return 0;`
210			`}`
211	2	cvs
212	138	markom	`/* Implementation specific.`
213			`Parses and returns operands. */`
214	2	cvs
215	138	markom	`static void`
216			`eval_operands (unsigned long insn, int insn_index, int* breakpoint)`
217			`{`
218			`struct insn_op_struct *opd = op_start[insn_index];`
219			`unsigned long data = 0;`
220			`int dis = 0;`
221			`int no = 0;`
222			`while (1)`
223			`{`
224			`unsigned long tmp = 0, nbits = 0;`
225			`while (1)`
226	262	markom	`{`
227			`tmp \|= ((insn >> (opd->type & OPTYPE_SHR)) & ((1 << opd->data) - 1)) << nbits;`
228			`nbits += opd->data;`
229			`if (opd->type & OPTYPE_OP)`
230			`break;`
231			`opd++;`
232			`}`
233	2	cvs
234	138	markom	`/* Do we have to sign extend? */`
235			`if (opd->type & OPTYPE_SIG)`
236	262	markom	`{`
237			`int sbit = (opd->type & OPTYPE_SBIT) >> OPTYPE_SBIT_SHR;`
238			`if (tmp & (1 << sbit))`
239			`tmp \|= 0xFFFFFFFF << sbit;`
240			`}`
241	138	markom	`if (opd->type & OPTYPE_DIS) {`
242	262	markom	`/* We have to read register later. */`
243			`data += tmp;`
244			`dis = 1;`
245	138	markom	`} else`
246	262	markom	`{`
247			`if (dis && (opd->type & OPTYPE_REG))`
248			`op[no] = data + eval_reg (tmp);`
249			`else`
250			`op[no] = tmp;`
251			`op[no + MAX_OPERANDS] = opd->type \| (dis ? OPTYPE_DIS : 0);`
252			`no++;`
253			`data = 0;`
254			`dis = 0;`
255			`}`
256	138	markom	`if(opd->type & OPTYPE_LAST)`
257	262	markom	`return;`
258	138	markom	`opd++;`
259			`}`
260			`num_op = no;`
261	2	cvs	`}`
262
263			`/* Implementation specific.`
264	138	markom	`Evaluates source operand op_no. */`
265
266	221	markom	`unsigned long eval_operand32 (int op_no, int *breakpoint)`
267	2	cvs	`{`
268	344	markom	`debug (9, "%i %08X\n", op_no, op[op_no + MAX_OPERANDS]);`
269	538	markom	`if (op[op_no + MAX_OPERANDS] & OPTYPE_DIS)`
270	138	markom	`return eval_mem32 (op[op_no], breakpoint);`
271			`else if (op[op_no + MAX_OPERANDS] & OPTYPE_REG)`
272			`return eval_reg (op[op_no]);`
273			`else`
274			`return op[op_no];`
275	2	cvs	`}`
276
277			`/* Implementation specific.`
278	221	markom	`Evaluates source operand op_no. */`
279
280			`unsigned long eval_operand16 (int op_no, int *breakpoint)`
281			`{`
282	344	markom	`debug (9, "%i %08X\n", op_no, op[op_no + MAX_OPERANDS]);`
283	458	simons	`if (op[op_no + MAX_OPERANDS] & OPTYPE_DIS) {`
284			`if (op[op_no] & 0x01) {`
285			`return 0;`
286			`}`
287	221	markom	`return eval_mem16 (op[op_no], breakpoint);`
288	458	simons	`}`
289	221	markom	`else {`
290			`fprintf (stderr, "Invalid operand type.\n");`
291			`exit (1);`
292			`}`
293			`}`
294
295			`/* Implementation specific.`
296			`Evaluates source operand op_no. */`
297
298			`unsigned long eval_operand8 (int op_no, int *breakpoint)`
299			`{`
300	344	markom	`debug (9, "%i %08X\n", op_no, op[op_no + MAX_OPERANDS]);`
301	221	markom	`if (op[op_no + MAX_OPERANDS] & OPTYPE_DIS)`
302			`return eval_mem8 (op[op_no], breakpoint);`
303			`else {`
304			`fprintf (stderr, "Invalid operand type.\n");`
305			`exit (1);`
306			`}`
307			`}`
308
309			`/* Implementation specific.`
310	2	cvs	`Set destination operand (register direct, register indirect`
311			`(with displacement) with value. */`
312
313	221	markom	`void set_operand32(int op_no, unsigned long value, int* breakpoint)`
314	2	cvs	`{`
315	138	markom	`/* Mark this as destination operand. */`
316			`op[op_no + MAX_OPERANDS] \|= OPTYPE_DST;`
317	458	simons	`if (op[op_no + MAX_OPERANDS] & OPTYPE_DIS) {`
318			`if (op[op_no] & 0x03) {`
319			`except_handle (EXCEPT_ALIGN, op[op_no]);`
320	464	simons	`return;`
321	458	simons	`}`
322	138	markom	`set_mem32(op[op_no], value, breakpoint);`
323	458	simons	`}`
324			`else if (op[op_no + MAX_OPERANDS] & OPTYPE_REG) {`
325	138	markom	`set_reg32(op[op_no], value);`
326	458	simons	`value & 0x80000000 ? setsprbits (SPR_SR, SPR_SR_OV, 1) : setsprbits (SPR_SR, SPR_SR_OV, 0);`
327			`}`
328	138	markom	`else`
329			`{`
330			`fprintf (stderr, "Invalid operand type.\n");`
331			`exit (1);`
332			`}`
333	2	cvs	`}`
334
335	221	markom	`/* Implementation specific.`
336			`Set destination operand (register direct, register indirect`
337			`(with displacement) with value. */`
338
339			`void set_operand16(int op_no, unsigned long value, int* breakpoint)`
340			`{`
341			`/* Mark this as destination operand. */`
342			`op[op_no + MAX_OPERANDS] \|= OPTYPE_DST;`
343	458	simons	`if (op[op_no + MAX_OPERANDS] & OPTYPE_DIS) {`
344			`if (op[op_no] & 0x01) {`
345			`except_handle (EXCEPT_ALIGN, op[op_no]);`
346	464	simons	`return;`
347	458	simons	`}`
348	221	markom	`set_mem16(op[op_no], value, breakpoint);`
349	458	simons	`}`
350	221	markom	`else`
351			`{`
352			`fprintf (stderr, "Invalid operand type.\n");`
353			`exit (1);`
354			`}`
355			`}`
356
357			`/* Implementation specific.`
358			`Set destination operand (register direct, register indirect`
359			`(with displacement) with value. */`
360
361			`void set_operand8(int op_no, unsigned long value, int* breakpoint)`
362			`{`
363			`/* Mark this as destination operand. */`
364			`op[op_no + MAX_OPERANDS] \|= OPTYPE_DST;`
365			`if (op[op_no + MAX_OPERANDS] & OPTYPE_DIS)`
366			`set_mem8(op[op_no], value, breakpoint);`
367			`else`
368			`{`
369			`fprintf (stderr, "Invalid operand type.\n");`
370			`exit (1);`
371			`}`
372			`}`
373
374	2	cvs	`void reset()`
375			`{`
376	138	markom	`cycles = 0;`
377	535	markom	`instructions = 0;`
378	138	markom	`supercycles = 0;`
379			`loadcycles = 0;`
380			`storecycles = 0;`
381			`memset(reg, 0, sizeof(reg));`
382			`memset(iqueue, 0, sizeof(iqueue));`
383			`memset(icomplet, 0, sizeof(icomplet));`
384	263	markom
385			`/* Cpu configuration */`
386			`mtspr(SPR_UPR, config.cpu.upr);`
387			`setsprbits(SPR_VR, SPR_VR_VER, config.cpu.ver);`
388			`setsprbits(SPR_VR, SPR_VR_REV, config.cpu.rev);`
389
390	221	markom	`pcnext = 0x0; /* MM1409: All programs should start at reset vector entry! */`
391	174	markom	`printf ("Starting at 0x%08x\n", pcnext);`
392	138	markom	`pc = pcnext;`
393			`pc_phy = pc;`
394			`pcnext += 4;`
395	344	markom	`debug(1, "reset ...\n");`
396	221	markom
397			`/* MM1409: All programs should set their stack pointer! */`
398			`except_handle(EXCEPT_RESET, 0);`
399	2	cvs	`}`
400
401	123	markom	`/* Modified by CZ 26/05/01 for new mode execution */`
402			`/* Fetch returns nonzero if instruction should NOT be executed. */`
403	138	markom	`inline int fetch() {`
404	221	markom	`struct mem_entry *entry;`
405	344	markom	`debug(5, "fetch()\n");`
406	123	markom
407	464	simons	`if (!pending.valid)`
408			`pc_phy = translate_vrt_to_phy_add(pc);`
409
410	479	markom	`/* Update the pc for pending exceptions */`
411			`if(pending.valid)`
412			`except_handle_backend(pending.type,pending.address,pending.saved);`
413	142	chris
414	378	markom	`/* MM: Check for breakpoint. This has to be done in fetch cycle,`
415			`because of peripheria.`
416			`MM1709: if we cannot access the memory entry, we could not set the`
417			`breakpoint earlier, so just chech the breakpoint list. */`
418	431	markom	`if(has_breakpoint (pc_phy) && !break_just_hit) {`
419			`break_just_hit = 1;`
420	378	markom	`return 1; /* Breakpoint set. */`
421	431	markom	`}`
422			`break_just_hit = 0;`
423	123	markom
424	535	markom	`instructions++;`
425	378	markom
426	538	markom	`pc_phy &= ~0x03;`
427
428	221	markom	`#if 0`
429	378	markom	`if(pc_phy > MEMORY_START + MEMORY_LEN)`
430			`pc_phy %= MEMORY_START + MEMORY_LEN;`
431	221	markom	`#endif`
432	2	cvs
433	378	markom	`/* Fetch instruction. */`
434			`{`
435			`unsigned int _insn;`
436
437	479	markom	`_insn = eval_insn (pc_phy, &breakpoint);`
438			`iqueue[0].insn_addr = pc;`
439
440	378	markom	`iqueue[0].insn_index = insn_decode(_insn);`
441			`iqueue[0].insn = _insn;`
442			`}`
443	261	markom
444	378	markom	`/* update_pc will be called after execution */`
445	77	lampret
446	378	markom	`return 0;`
447	2	cvs	`}`
448
449	479	markom	`/* This code actually updates the PC value. */`
450	142	chris	`inline void update_pc()`
451			`{`
452	479	markom	`pcprev = pc; /* Store value for later */`
453			`pc = pcnext;`
454			`pcnext = delay_insn ? pcdelay : pcnext + 4;`
455	123	markom	`nop_period++;`
456	2	cvs	`}`
457
458	138	markom	`inline void analysis()`
459	2	cvs	`{`
460	394	markom	`if (config.cpu.dependstats)`
461	123	markom	`/* Instruction waits in completition buffer until retired. */`
462	138	markom	`memcpy (&icomplet[0], &iqueue[0], sizeof (struct iqueue_entry));`
463
464	394	markom	`if (config.sim.history) {`
465	263	markom	`int i;`
466
467	123	markom	`/* History of execution */`
468			`for (i = HISTEXEC_LEN - 1; i; i--)`
469			`histexec[i] = histexec[i - 1];`
470	262	markom	`histexec[0] = icomplet[0].insn_addr; /* add last insn */`
471	123	markom	`}`
472	2	cvs	`}`
473
474	294	markom
475			`/* Execution logger. */`
476			`inline void dump_exe_log()`
477			`{`
478	479	markom	`unsigned long i = iqueue[0].insn_addr;`
479	294	markom
480	479	markom	`if (i == 0xffffffff) return;`
481	361	markom	`fprintf(runtime.sim.fexe_log, "\nEXECUTED(): %.8lx: ", i);`
482			`fprintf(runtime.sim.fexe_log, "%.2x%.2x", evalsim_mem8(i), evalsim_mem8(i + 1));`
483			`fprintf(runtime.sim.fexe_log, "%.2x%.2x", evalsim_mem8(i + 2), evalsim_mem8(i + 3));`
484			`for(i = 0; i < MAX_GPRS; i++) {`
485			`if (i % 4 == 0)`
486			`fprintf(runtime.sim.fexe_log, "\n");`
487			`fprintf(runtime.sim.fexe_log, "GPR%2u: %.8lx ", i, reg[i]);`
488			`}`
489			`fprintf(runtime.sim.fexe_log, "\n");`
490			`fprintf(runtime.sim.fexe_log, "SR : %.8lx ", mfspr(SPR_SR));`
491			`fprintf(runtime.sim.fexe_log, "EPCR0: %.8lx ", mfspr(SPR_EPCR_BASE));`
492			`fprintf(runtime.sim.fexe_log, "EEAR0: %.8lx ", mfspr(SPR_EEAR_BASE));`
493			`fprintf(runtime.sim.fexe_log, "ESR0 : %.8lx\n", mfspr(SPR_ESR_BASE));`
494	294	markom	`}`
495
496	537	markom	`#if 0`
497	535	markom	`void print_time (int cycles, char *output)`
498			`{`
499			`int i = 0, c_ps = config.sim.clkcycle_ps;`
500			`while (c_ps % 1000 == 0 && i < 2) {`

Browse

Tools

Subversion Repositories or1k

[/] [or1k/] [tags/] [nog_patch_47/] [or1ksim/] [cpu/] [or32/] [execute.c] - Blame information for rev 538