URL https://opencores.org/ocsvn/openrisc_2011-10-31/openrisc_2011-10-31/trunk
Subversion Repositories openrisc_2011-10-31

[/] [openrisc/] [trunk/] [gnu-src/] [gdb-6.8/] [sim/] [erc32/] [erc32.c] - Blame information for rev 157

Details | Compare with Previous | View Log

/*
 * This file is part of SIS.
 *
 * SIS, SPARC instruction simulator V2.5 Copyright (C) 1995 Jiri Gaisler,
 * European Space Agency
 *
 * 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.
 *
 */
 
/* The control space devices */
 
#include <sys/types.h>
#include <stdio.h>
#include <termios.h>
#include <sys/fcntl.h>
#include <sys/file.h>
#include <unistd.h>
#include "sis.h"
#include "end.h"
#include "sim-config.h"
 
extern int      ctrl_c;
extern int32    sis_verbose;
extern int32    sparclite, sparclite_board;
extern int      rom8,wrp,uben;
extern char     uart_dev1[], uart_dev2[];
 
int dumbio = 0; /* normal, smart, terminal oriented IO by default */
 
/* MEC registers */
#define MEC_START       0x01f80000
#define MEC_END         0x01f80100
 
/* Memory exception waitstates */
#define MEM_EX_WS       1
 
/* ERC32 always adds one waitstate during RAM std */
#define STD_WS 1
 
#ifdef ERRINJ
extern int errmec;
#endif
 
/* The target's byte order is big-endian by default until we load a
   little-endian program.  */
 
int     current_target_byte_order = BIG_ENDIAN;
 
#define MEC_WS  0                /* Waitstates per MEC access (0 ws) */
#define MOK     0
 
/* MEC register addresses */
 
#define MEC_MCR         0x000
#define MEC_SFR         0x004
#define MEC_PWDR        0x008
#define MEC_MEMCFG      0x010
#define MEC_IOCR        0x014
#define MEC_WCR         0x018
 
#define MEC_MAR0        0x020
#define MEC_MAR1        0x024
 
#define MEC_SSA1        0x020
#define MEC_SEA1        0x024
#define MEC_SSA2        0x028
#define MEC_SEA2        0x02C
#define MEC_ISR         0x044
#define MEC_IPR         0x048
#define MEC_IMR         0x04C
#define MEC_ICR         0x050
#define MEC_IFR         0x054
#define MEC_WDOG        0x060
#define MEC_TRAPD       0x064
#define MEC_RTC_COUNTER 0x080
#define MEC_RTC_RELOAD  0x080
#define MEC_RTC_SCALER  0x084
#define MEC_GPT_COUNTER 0x088
#define MEC_GPT_RELOAD  0x088
#define MEC_GPT_SCALER  0x08C
#define MEC_TIMER_CTRL  0x098
#define MEC_SFSR        0x0A0
#define MEC_FFAR        0x0A4
#define MEC_ERSR        0x0B0
#define MEC_DBG         0x0C0
#define MEC_TCR         0x0D0
 
#define MEC_BRK         0x0C4
#define MEC_WPR         0x0C8
 
#define MEC_UARTA       0x0E0
#define MEC_UARTB       0x0E4
#define MEC_UART_CTRL   0x0E8
#define SIM_LOAD        0x0F0
 
/* Memory exception causes */
#define PROT_EXC        0x3
#define UIMP_ACC        0x4
#define MEC_ACC         0x6
#define WATCH_EXC       0xa
#define BREAK_EXC       0xb
 
/* Size of UART buffers (bytes) */
#define UARTBUF 1024
 
/* Number of simulator ticks between flushing the UARTS.         */
/* For good performance, keep above 1000                         */
#define UART_FLUSH_TIME   3000
 
/* MEC timer control register bits */
#define TCR_GACR 1
#define TCR_GACL 2
#define TCR_GASE 4
#define TCR_GASL 8
#define TCR_TCRCR 0x100
#define TCR_TCRCL 0x200
#define TCR_TCRSE 0x400
#define TCR_TCRSL 0x800
 
/* New uart defines */
#define UART_TX_TIME    1000
#define UART_RX_TIME    1000
#define UARTA_DR        0x1
#define UARTA_SRE       0x2
#define UARTA_HRE       0x4
#define UARTA_OR        0x40
#define UARTA_CLR       0x80
#define UARTB_DR        0x10000
#define UARTB_SRE       0x20000
#define UARTB_HRE       0x40000
#define UARTB_OR        0x400000
#define UARTB_CLR       0x800000
 
#define UART_DR         0x100
#define UART_TSE        0x200
#define UART_THE        0x400
 
/* MEC registers */
 
static char     fname[256];
static int32    find = 0;
static uint32   mec_ssa[2];     /* Write protection start address */
static uint32   mec_sea[2];     /* Write protection end address */
static uint32   mec_wpr[2];     /* Write protection control fields */
static uint32   mec_sfsr;
static uint32   mec_ffar;
static uint32   mec_ipr;
static uint32   mec_imr;
static uint32   mec_isr;
static uint32   mec_icr;
static uint32   mec_ifr;
static uint32   mec_mcr;        /* MEC control register */
static uint32   mec_memcfg;     /* Memory control register */
static uint32   mec_wcr;        /* MEC waitstate register */
static uint32   mec_iocr;       /* MEC IO control register */
static uint32   posted_irq;
static uint32   mec_ersr;       /* MEC error and status register */
static uint32   mec_tcr;        /* MEC test comtrol register */
 
static uint32   rtc_counter;
static uint32   rtc_reload;
static uint32   rtc_scaler;
static uint32   rtc_scaler_start;
static uint32   rtc_enabled;
static uint32   rtc_cr;
static uint32   rtc_se;
 
static uint32   gpt_counter;
static uint32   gpt_reload;
static uint32   gpt_scaler;
static uint32   gpt_scaler_start;
static uint32   gpt_enabled;
static uint32   gpt_cr;
static uint32   gpt_se;
 
static uint32   wdog_scaler;
static uint32   wdog_counter;
static uint32   wdog_rst_delay;
static uint32   wdog_rston;
 
enum wdog_type {
    init, disabled, enabled, stopped
};
 
static enum wdog_type wdog_status;
 
 
/* ROM size 1024 Kbyte */
#define ROM_SZ          0x100000
#define ROM_MASK        0x0fffff
 
/* RAM size 4 Mbyte */
#define RAM_START       0x02000000
#define RAM_END         0x02400000
#define RAM_MASK        0x003fffff
 
/* SPARClite boards all seem to have RAM at the same place. */
#define RAM_START_SLITE 0x40000000
#define RAM_END_SLITE   0x40400000
#define RAM_MASK_SLITE  0x003fffff
 
/* Memory support variables */
 
static uint32   mem_ramr_ws;    /* RAM read waitstates */
static uint32   mem_ramw_ws;    /* RAM write waitstates */
static uint32   mem_romr_ws;    /* ROM read waitstates */
static uint32   mem_romw_ws;    /* ROM write waitstates */
static uint32   mem_ramstart;   /* RAM start */
static uint32   mem_ramend;     /* RAM end */
static uint32   mem_rammask;    /* RAM address mask */
static uint32   mem_ramsz;      /* RAM size */
static uint32   mem_romsz;      /* ROM size */
static uint32   mem_accprot;    /* RAM write protection enabled */
static uint32   mem_blockprot;  /* RAM block write protection enabled */
 
static unsigned char    romb[ROM_SZ];
static unsigned char    ramb[RAM_END - RAM_START];
 
 
/* UART support variables */
 
static int32    fd1, fd2;       /* file descriptor for input file */
static int32    Ucontrol;       /* UART status register */
static unsigned char aq[UARTBUF], bq[UARTBUF];
static int32    anum, aind = 0;
static int32    bnum, bind = 0;
static char     wbufa[UARTBUF], wbufb[UARTBUF];
static unsigned wnuma;
static unsigned wnumb;
static FILE    *f1in, *f1out, *f2in, *f2out;
static struct termios ioc1, ioc2, iocold1, iocold2;
static int      f1open = 0, f2open = 0;
 
static char     uarta_sreg, uarta_hreg, uartb_sreg, uartb_hreg;
static uint32   uart_stat_reg;
static uint32   uarta_data, uartb_data;
 
#ifdef ERA
int era = 0;
int erareg;
#endif
 
/* Forward declarations */
 
static void     decode_ersr PARAMS ((void));
#ifdef ERRINJ
static void     iucomperr PARAMS ((void));
#endif
static void     mecparerror PARAMS ((void));
static void     decode_memcfg PARAMS ((void));
static void     decode_wcr PARAMS ((void));
static void     decode_mcr PARAMS ((void));
static void     close_port PARAMS ((void));
static void     mec_reset PARAMS ((void));
static void     mec_intack PARAMS ((int32 level));
static void     chk_irq PARAMS ((void));
static void     mec_irq PARAMS ((int32 level));
static void     set_sfsr PARAMS ((uint32 fault, uint32 addr,
                                  uint32 asi, uint32 read));
static int32    mec_read PARAMS ((uint32 addr, uint32 asi, uint32 *data));
static int      mec_write PARAMS ((uint32 addr, uint32 data));
static void     port_init PARAMS ((void));
static uint32   read_uart PARAMS ((uint32 addr));
static void     write_uart PARAMS ((uint32 addr, uint32 data));
static void     flush_uart PARAMS ((void));
static void     uarta_tx PARAMS ((void));
static void     uartb_tx PARAMS ((void));
static void     uart_rx PARAMS ((caddr_t arg));
static void     uart_intr PARAMS ((caddr_t arg));
static void     uart_irq_start PARAMS ((void));
static void     wdog_intr PARAMS ((caddr_t arg));
static void     wdog_start PARAMS ((void));
static void     rtc_intr PARAMS ((caddr_t arg));
static void     rtc_start PARAMS ((void));
static uint32   rtc_counter_read PARAMS ((void));
static void     rtc_scaler_set PARAMS ((uint32 val));
static void     rtc_reload_set PARAMS ((uint32 val));
static void     gpt_intr PARAMS ((caddr_t arg));
static void     gpt_start PARAMS ((void));
static uint32   gpt_counter_read PARAMS ((void));
static void     gpt_scaler_set PARAMS ((uint32 val));
static void     gpt_reload_set PARAMS ((uint32 val));
static void     timer_ctrl PARAMS ((uint32 val));
static unsigned char *
                get_mem_ptr PARAMS ((uint32 addr, uint32 size));
 
static void     fetch_bytes PARAMS ((int asi, unsigned char *mem,
                                     uint32 *data, int sz));
 
static void     store_bytes PARAMS ((unsigned char *mem, uint32 *data, int sz));
 
extern int      ext_irl;
 
 
/* One-time init */
 
void
init_sim()
{
    port_init();
}
 
/* Power-on reset init */
 
void
reset()
{
    mec_reset();
    uart_irq_start();
    wdog_start();
}
 
static void
decode_ersr()
{
    if (mec_ersr & 0x01) {
        if (!(mec_mcr & 0x20)) {
            if (mec_mcr & 0x40) {
                sys_reset();
                mec_ersr = 0x8000;
                if (sis_verbose)
                    printf("Error manager reset - IU in error mode\n");
            } else {
                sys_halt();
                mec_ersr |= 0x2000;
                if (sis_verbose)
                    printf("Error manager halt - IU in error mode\n");
            }
        } else
            mec_irq(1);
    }
    if (mec_ersr & 0x04) {
        if (!(mec_mcr & 0x200)) {
            if (mec_mcr & 0x400) {
                sys_reset();
                mec_ersr = 0x8000;
                if (sis_verbose)
                    printf("Error manager reset - IU comparison error\n");
            } else {
                sys_halt();
                mec_ersr |= 0x2000;
                if (sis_verbose)
                    printf("Error manager halt - IU comparison error\n");
            }
        } else
            mec_irq(1);
    }
    if (mec_ersr & 0x20) {
        if (!(mec_mcr & 0x2000)) {
            if (mec_mcr & 0x4000) {
                sys_reset();
                mec_ersr = 0x8000;
                if (sis_verbose)
                    printf("Error manager reset - MEC hardware error\n");
            } else {
                sys_halt();
                mec_ersr |= 0x2000;
                if (sis_verbose)
                    printf("Error manager halt - MEC hardware error\n");
            }
        } else
            mec_irq(1);
    }
}
 
#ifdef ERRINJ
static void
iucomperr()
{
    mec_ersr |= 0x04;
    decode_ersr();
}
#endif
 
static void
mecparerror()
{
    mec_ersr |= 0x20;
    decode_ersr();
}
 
 
/* IU error mode manager */
 
void
error_mode(pc)
    uint32          pc;
{
 
    mec_ersr |= 0x1;
    decode_ersr();
}
 
 
/* Check memory settings */
 
static void
decode_memcfg()
{
    if (rom8) mec_memcfg &= ~0x20000;
    else mec_memcfg |= 0x20000;
 
    mem_ramsz = (256 * 1024) << ((mec_memcfg >> 10) & 7);
    mem_romsz = (128 * 1024) << ((mec_memcfg >> 18) & 7);
 
    if (sparclite_board) {
        mem_ramstart = RAM_START_SLITE;
        mem_ramend = RAM_END_SLITE;
        mem_rammask = RAM_MASK_SLITE;
    }
    else {
        mem_ramstart = RAM_START;
        mem_ramend = RAM_END;
        mem_rammask = RAM_MASK;
    }
    if (sis_verbose)
        printf("RAM start: 0x%x, RAM size: %d K, ROM size: %d K\n",
               mem_ramstart, mem_ramsz >> 10, mem_romsz >> 10);
}
 
static void
decode_wcr()
{
    mem_ramr_ws = mec_wcr & 3;
    mem_ramw_ws = (mec_wcr >> 2) & 3;
    mem_romr_ws = (mec_wcr >> 4) & 0x0f;
    if (rom8) {
        if (mem_romr_ws > 0 )  mem_romr_ws--;
        mem_romr_ws = 5 + (4*mem_romr_ws);
    }
    mem_romw_ws = (mec_wcr >> 8) & 0x0f;
    if (sis_verbose)
        printf("Waitstates = RAM read: %d, RAM write: %d, ROM read: %d, ROM write: %d\n",
               mem_ramr_ws, mem_ramw_ws, mem_romr_ws, mem_romw_ws);
}
 
static void
decode_mcr()
{
    mem_accprot = (mec_wpr[0] | mec_wpr[1]);
    mem_blockprot = (mec_mcr >> 3) & 1;
    if (sis_verbose && mem_accprot)
        printf("Memory block write protection enabled\n");
    if (mec_mcr & 0x08000) {
        mec_ersr |= 0x20;
        decode_ersr();
    }
    if (sis_verbose && (mec_mcr & 2))
        printf("Software reset enabled\n");
    if (sis_verbose && (mec_mcr & 1))
        printf("Power-down mode enabled\n");
}
 
/* Flush ports when simulator stops */
 
void
sim_halt()
{
#ifdef FAST_UART
    flush_uart();
#endif
}
 
int
sim_stop(SIM_DESC sd)
{
  ctrl_c = 1;
  return 1;
}
 
static void
close_port()
{
    if (f1open && f1in != stdin)
        fclose(f1in);
    if (f2open && f2in != stdin)
        fclose(f2in);
}
 
void
exit_sim()
{
    close_port();
}
 
static void
mec_reset()
{
    int             i;
 
    find = 0;
    for (i = 0; i < 2; i++)
        mec_ssa[i] = mec_sea[i] = mec_wpr[i] = 0;
    mec_mcr = 0x01350014;
    mec_iocr = 0;
    mec_sfsr = 0x078;
    mec_ffar = 0;
    mec_ipr = 0;
    mec_imr = 0x7ffe;
    mec_isr = 0;
    mec_icr = 0;
    mec_ifr = 0;
    mec_memcfg = 0x10000;
    mec_wcr = -1;
    mec_ersr = 0;                /* MEC error and status register */
    mec_tcr = 0;         /* MEC test comtrol register */
 
    decode_memcfg();
    decode_wcr();
    decode_mcr();
 
    posted_irq = 0;
    wnuma = wnumb = 0;
    anum = aind = bnum = bind = 0;
 
    uart_stat_reg = UARTA_SRE | UARTA_HRE | UARTB_SRE | UARTB_HRE;
    uarta_data = uartb_data = UART_THE | UART_TSE;
 
    rtc_counter = 0xffffffff;
    rtc_reload = 0xffffffff;
    rtc_scaler = 0xff;
    rtc_enabled = 0;
    rtc_cr = 0;
    rtc_se = 0;
 
    gpt_counter = 0xffffffff;
    gpt_reload = 0xffffffff;
    gpt_scaler = 0xffff;
    gpt_enabled = 0;
    gpt_cr = 0;
    gpt_se = 0;
 
    wdog_scaler = 255;
    wdog_rst_delay = 255;
    wdog_counter = 0xffff;
    wdog_rston = 0;
    wdog_status = init;
 
#ifdef ERA
    erareg = 0;
#endif
 
}
 
 
 
static void
mec_intack(level)
    int32           level;
{
    int             irq_test;
 
    if (sis_verbose)
        printf("interrupt %d acknowledged\n", level);
    irq_test = mec_tcr & 0x80000;
    if ((irq_test) && (mec_ifr & (1 << level)))
        mec_ifr &= ~(1 << level);
    else
        mec_ipr &= ~(1 << level);
   chk_irq();
}
 
static void
chk_irq()
{
    int32           i;
    uint32          itmp;
    int             old_irl;
 
    old_irl = ext_irl;
    if (mec_tcr & 0x80000) itmp = mec_ifr;
    else itmp  = 0;
    itmp = ((mec_ipr | itmp) & ~mec_imr) & 0x0fffe;
    ext_irl = 0;
    if (itmp != 0) {
        for (i = 15; i > 0; i--) {
            if (((itmp >> i) & 1) != 0) {
                if ((sis_verbose) && (i > old_irl))
                    printf("IU irl: %d\n", i);
                ext_irl = i;
                set_int(i, mec_intack, i);
                break;
            }
        }
    }
}
 
static void
mec_irq(level)
    int32           level;
{
    mec_ipr |= (1 << level);
    chk_irq();
}
 
static void
set_sfsr(fault, addr, asi, read)
    uint32          fault;
    uint32          addr;
    uint32          asi;
    uint32          read;
{
    if ((asi == 0xa) || (asi == 0xb)) {
        mec_ffar = addr;
        mec_sfsr = (fault << 3) | (!read << 15);
        mec_sfsr |= ((mec_sfsr & 1) ^ 1) | (mec_sfsr & 1);
        switch (asi) {
        case 0xa:
            mec_sfsr |= 0x0004;
            break;
        case 0xb:
            mec_sfsr |= 0x1004;
            break;
        }
    }
}
 
static int32
mec_read(addr, asi, data)
    uint32          addr;
    uint32          asi;
    uint32         *data;
{
 
    switch (addr & 0x0ff) {
 
    case MEC_MCR:               /* 0x00 */
        *data = mec_mcr;
        break;
 
    case MEC_MEMCFG:            /* 0x10 */
        *data = mec_memcfg;
        break;
 
    case MEC_IOCR:
        *data = mec_iocr;       /* 0x14 */
        break;
 
    case MEC_SSA1:              /* 0x20 */
        *data = mec_ssa[0] | (mec_wpr[0] << 23);
        break;
    case MEC_SEA1:              /* 0x24 */
        *data = mec_sea[0];
        break;
    case MEC_SSA2:              /* 0x28 */
        *data = mec_ssa[1] | (mec_wpr[1] << 23);
        break;
    case MEC_SEA2:              /* 0x2c */
        *data = mec_sea[1];
        break;
 
    case MEC_ISR:               /* 0x44 */
        *data = mec_isr;
        break;
 
    case MEC_IPR:               /* 0x48 */
        *data = mec_ipr;
        break;
 
    case MEC_IMR:               /* 0x4c */
        *data = mec_imr;
        break;
 
    case MEC_IFR:               /* 0x54 */
        *data = mec_ifr;
        break;
 
    case MEC_RTC_COUNTER:       /* 0x80 */
        *data = rtc_counter_read();
        break;
    case MEC_RTC_SCALER:        /* 0x84 */
        if (rtc_enabled)
            *data = rtc_scaler - (now() - rtc_scaler_start);
        else
            *data = rtc_scaler;
        break;
 
    case MEC_GPT_COUNTER:       /* 0x88 */
        *data = gpt_counter_read();
        break;
 
    case MEC_GPT_SCALER:        /* 0x8c */
        if (rtc_enabled)
            *data = gpt_scaler - (now() - gpt_scaler_start);
        else
            *data = gpt_scaler;
        break;
 
 
    case MEC_SFSR:              /* 0xA0 */
        *data = mec_sfsr;
        break;
 
    case MEC_FFAR:              /* 0xA4 */
        *data = mec_ffar;
        break;
 
    case SIM_LOAD:
        fname[find] = 0;
        if (find == 0)
            strcpy(fname, "simload");
        find = bfd_load(fname);
        if (find == -1)
            *data = 0;
        else
            *data = 1;
        find = 0;
        break;
 
    case MEC_ERSR:              /* 0xB0 */
        *data = mec_ersr;
        break;
 
    case MEC_TCR:               /* 0xD0 */
        *data = mec_tcr;
        break;
 
    case MEC_UARTA:             /* 0xE0 */
    case MEC_UARTB:             /* 0xE4 */
        if (asi != 0xb) {
            set_sfsr(MEC_ACC, addr, asi, 1);
            return (1);
        }
        *data = read_uart(addr);
        break;
 
    case MEC_UART_CTRL:         /* 0xE8 */
 
        *data = read_uart(addr);
        break;
 
    default:
        set_sfsr(MEC_ACC, addr, asi, 1);
        return (1);
        break;
    }
    return (MOK);
}
 
static int
mec_write(addr, data)
    uint32          addr;
    uint32          data;
{
    if (sis_verbose > 1)
        printf("MEC write a: %08x, d: %08x\n",addr,data);
    switch (addr & 0x0ff) {
 
    case MEC_MCR:
        mec_mcr = data;
        decode_mcr();
        if (mec_mcr & 0x08000) mecparerror();
        break;
 
    case MEC_SFR:
        if (mec_mcr & 0x2) {
            sys_reset();
            mec_ersr = 0x4000;
            if (sis_verbose)
                printf(" Software reset issued\n");
        }
        break;
 
    case MEC_IOCR:
        mec_iocr = data;
        if (mec_iocr & 0xC0C0C0C0) mecparerror();
        break;
 
    case MEC_SSA1:              /* 0x20 */
        if (data & 0xFE000000) mecparerror();
        mec_ssa[0] = data & 0x7fffff;
        mec_wpr[0] = (data >> 23) & 0x03;
        mem_accprot = mec_wpr[0] || mec_wpr[1];
        if (sis_verbose && mec_wpr[0])
            printf("Segment 1 memory protection enabled (0x02%06x - 0x02%06x)\n",
                   mec_ssa[0] << 2, mec_sea[0] << 2);
        break;
    case MEC_SEA1:              /* 0x24 */
        if (data & 0xFF800000) mecparerror();
        mec_sea[0] = data & 0x7fffff;
        break;
    case MEC_SSA2:              /* 0x28 */
        if (data & 0xFE000000) mecparerror();
        mec_ssa[1] = data & 0x7fffff;
        mec_wpr[1] = (data >> 23) & 0x03;
        mem_accprot = mec_wpr[0] || mec_wpr[1];
        if (sis_verbose && mec_wpr[1])
            printf("Segment 2 memory protection enabled (0x02%06x - 0x02%06x)\n",
                   mec_ssa[1] << 2, mec_sea[1] << 2);
        break;
    case MEC_SEA2:              /* 0x2c */
        if (data & 0xFF800000) mecparerror();
        mec_sea[1] = data & 0x7fffff;
        break;
 
    case MEC_UARTA:
    case MEC_UARTB:
        if (data & 0xFFFFFF00) mecparerror();
    case MEC_UART_CTRL:
        if (data & 0xFF00FF00) mecparerror();
        write_uart(addr, data);
        break;
 
    case MEC_GPT_RELOAD:
        gpt_reload_set(data);
        break;
 
    case MEC_GPT_SCALER:
        if (data & 0xFFFF0000) mecparerror();
        gpt_scaler_set(data);
        break;
 
    case MEC_TIMER_CTRL:
        if (data & 0xFFFFF0F0) mecparerror();
        timer_ctrl(data);
        break;
 
    case MEC_RTC_RELOAD:
        rtc_reload_set(data);
        break;
 
    case MEC_RTC_SCALER:
        if (data & 0xFFFFFF00) mecparerror();
        rtc_scaler_set(data);
        break;
 
    case MEC_SFSR:              /* 0xA0 */
        if (data & 0xFFFF0880) mecparerror();
        mec_sfsr = 0x78;
        break;
 
    case MEC_ISR:
        if (data & 0xFFFFE000) mecparerror();
        mec_isr = data;
        break;
 
    case MEC_IMR:               /* 0x4c */
 
        if (data & 0xFFFF8001) mecparerror();
        mec_imr = data & 0x7ffe;
        chk_irq();
        break;
 
    case MEC_ICR:               /* 0x50 */
 
        if (data & 0xFFFF0001) mecparerror();
        mec_ipr &= ~data & 0x0fffe;
        chk_irq();
        break;
 
    case MEC_IFR:               /* 0x54 */
 
        if (mec_tcr & 0x080000) {
            if (data & 0xFFFF0001) mecparerror();
            mec_ifr = data & 0xfffe;
            chk_irq();
        }
        break;
    case SIM_LOAD:
        fname[find++] = (char) data;
        break;
 
 
    case MEC_MEMCFG:            /* 0x10 */
        if (data & 0xC0E08000) mecparerror();
        mec_memcfg = data;
        decode_memcfg();
        if (mec_memcfg & 0xc0e08000)
            mecparerror();
        break;
 
    case MEC_WCR:               /* 0x18 */
        mec_wcr = data;
        decode_wcr();
        break;
 
    case MEC_ERSR:              /* 0xB0 */
        if (mec_tcr & 0x100000)
            if (data & 0xFFFFEFC0) mecparerror();
            mec_ersr = data & 0x103f;
        break;
 
    case MEC_TCR:               /* 0xD0 */
        if (data & 0xFFE1FFC0) mecparerror();
        mec_tcr = data & 0x1e003f;
        break;
 
    case MEC_WDOG:              /* 0x60 */
        wdog_scaler = (data >> 16) & 0x0ff;
        wdog_counter = data & 0x0ffff;
        wdog_rst_delay = data >> 24;
        wdog_rston = 0;
        if (wdog_status == stopped)
            wdog_start();
        wdog_status = enabled;
        break;
 
    case MEC_TRAPD:             /* 0x64 */
        if (wdog_status == init) {
            wdog_status = disabled;
            if (sis_verbose)
                printf("Watchdog disabled\n");
        }
        break;
 
    case MEC_PWDR:
        if (mec_mcr & 1)
            wait_for_irq();
        break;
 
    default:
        set_sfsr(MEC_ACC, addr, 0xb, 0);
        return (1);
        break;
    }
    return (MOK);
}
 
 
/* MEC UARTS */
 
static int      ifd1 = -1, ifd2 = -1, ofd1 = -1, ofd2 = -1;
 
void
init_stdio()
{
    if (dumbio)
        return; /* do nothing */
    if (!ifd1)
        tcsetattr(0, TCSANOW, &ioc1);
    if (!ifd2)
        tcsetattr(0, TCSANOW, &ioc2);
}
 
void
restore_stdio()
{
    if (dumbio)
        return; /* do nothing */
    if (!ifd1)
        tcsetattr(0, TCSANOW, &iocold1);
    if (!ifd2)
        tcsetattr(0, TCSANOW, &iocold2);
}
 
#define DO_STDIO_READ( _fd_, _buf_, _len_ )          \
             ( dumbio                                \
               ? (0) /* no bytes read, no delay */   \
               : read( _fd_, _buf_, _len_ ) )
 
 
static void
port_init()
{
 
    if (uben) {
    f2in = stdin;
    f1in = NULL;
    f2out = stdout;
    f1out = NULL;
    } else {
    f1in = stdin;
    f2in = NULL;
    f1out = stdout;
    f2out = NULL;
    }
    if (uart_dev1[0] != 0)
        if ((fd1 = open(uart_dev1, O_RDWR | O_NONBLOCK)) < 0) {
            printf("Warning, couldn't open output device %s\n", uart_dev1);
        } else {
            if (sis_verbose)
                printf("serial port A on %s\n", uart_dev1);
            f1in = f1out = fdopen(fd1, "r+");
            setbuf(f1out, NULL);
            f1open = 1;
        }
    if (f1in) ifd1 = fileno(f1in);
    if (ifd1 == 0) {
        if (sis_verbose)
            printf("serial port A on stdin/stdout\n");
        if (!dumbio) {
            tcgetattr(ifd1, &ioc1);
            iocold1 = ioc1;
            ioc1.c_lflag &= ~(ICANON | ECHO);
            ioc1.c_cc[VMIN] = 0;
            ioc1.c_cc[VTIME] = 0;
        }
        f1open = 1;
    }
 
    if (f1out) {
        ofd1 = fileno(f1out);
        if (!dumbio && ofd1 == 1) setbuf(f1out, NULL);
    }
 
    if (uart_dev2[0] != 0)
        if ((fd2 = open(uart_dev2, O_RDWR | O_NONBLOCK)) < 0) {
            printf("Warning, couldn't open output device %s\n", uart_dev2);
        } else {
            if (sis_verbose)
                printf("serial port B on %s\n", uart_dev2);
            f2in = f2out = fdopen(fd2, "r+");
            setbuf(f2out, NULL);
            f2open = 1;
        }
    if (f2in)  ifd2 = fileno(f2in);
    if (ifd2 == 0) {
        if (sis_verbose)
            printf("serial port B on stdin/stdout\n");
        if (!dumbio) {
            tcgetattr(ifd2, &ioc2);
            iocold2 = ioc2;
            ioc2.c_lflag &= ~(ICANON | ECHO);
            ioc2.c_cc[VMIN] = 0;
            ioc2.c_cc[VTIME] = 0;
        }
        f2open = 1;
    }
 
    if (f2out) {
        ofd2 = fileno(f2out);
        if (!dumbio && ofd2 == 1) setbuf(f2out, NULL);
    }
 
    wnuma = wnumb = 0;
 
}
 
static uint32
read_uart(addr)
    uint32          addr;
{
 
    unsigned        tmp;
 
    tmp = 0;
    switch (addr & 0xff) {
 
    case 0xE0:                  /* UART 1 */
#ifndef _WIN32
#ifdef FAST_UART
 
        if (aind < anum) {
            if ((aind + 1) < anum)
                mec_irq(4);
            return (0x700 | (uint32) aq[aind++]);
        } else {
            if (f1open) {
                anum = DO_STDIO_READ(ifd1, aq, UARTBUF);
            }
            if (anum > 0) {
                aind = 0;
                if ((aind + 1) < anum)
                    mec_irq(4);
                return (0x700 | (uint32) aq[aind++]);
            } else {
                return (0x600 | (uint32) aq[aind]);
            }
 
        }
#else
        tmp = uarta_data;
        uarta_data &= ~UART_DR;
        uart_stat_reg &= ~UARTA_DR;
        return tmp;
#endif
#else
        return(0);
#endif
        break;
 
    case 0xE4:                  /* UART 2 */
#ifndef _WIN32
#ifdef FAST_UART
        if (bind < bnum) {
            if ((bind + 1) < bnum)
                mec_irq(5);
            return (0x700 | (uint32) bq[bind++]);
        } else {
            if (f2open) {
                bnum = DO_STDIO_READ(ifd2, bq, UARTBUF);
            }
            if (bnum > 0) {
                bind = 0;
                if ((bind + 1) < bnum)
                    mec_irq(5);
                return (0x700 | (uint32) bq[bind++]);
            } else {
                return (0x600 | (uint32) bq[bind]);
            }
 
        }
#else
        tmp = uartb_data;
        uartb_data &= ~UART_DR;
        uart_stat_reg &= ~UARTB_DR;
        return tmp;
#endif
#else
        return(0);
#endif
        break;
 
    case 0xE8:                  /* UART status register  */
#ifndef _WIN32
#ifdef FAST_UART
 
        Ucontrol = 0;
        if (aind < anum) {
            Ucontrol |= 0x00000001;
        } else {
            if (f1open) {
                anum = DO_STDIO_READ(ifd1, aq, UARTBUF);
            }
            if (anum > 0) {
                Ucontrol |= 0x00000001;
                aind = 0;
                mec_irq(4);
            }
        }
        if (bind < bnum) {
            Ucontrol |= 0x00010000;
        } else {
            if (f2open) {
                bnum = DO_STDIO_READ(ifd2, bq, UARTBUF);
            }
            if (bnum > 0) {
                Ucontrol |= 0x00010000;
                bind = 0;
                mec_irq(5);
            }
        }
 
        Ucontrol |= 0x00060006;
        return (Ucontrol);
#else
        return (uart_stat_reg);
#endif
#else
        return(0x00060006);
#endif
        break;
    default:
        if (sis_verbose)
            printf("Read from unimplemented MEC register (%x)\n", addr);
 
    }
    return (0);
}
 
static void
write_uart(addr, data)
    uint32          addr;
    uint32          data;
{
    unsigned char   c;
 
    c = (unsigned char) data;
    switch (addr & 0xff) {
 
    case 0xE0:                  /* UART A */
#ifdef FAST_UART
        if (f1open) {
            if (wnuma < UARTBUF)
                wbufa[wnuma++] = c;
            else {
                while (wnuma)
                    wnuma -= fwrite(wbufa, 1, wnuma, f1out);
                wbufa[wnuma++] = c;
            }
        }
        mec_irq(4);
#else
        if (uart_stat_reg & UARTA_SRE) {
            uarta_sreg = c;
            uart_stat_reg &= ~UARTA_SRE;
            event(uarta_tx, 0, UART_TX_TIME);
        } else {
            uarta_hreg = c;
            uart_stat_reg &= ~UARTA_HRE;
        }
#endif
        break;
 
    case 0xE4:                  /* UART B */
#ifdef FAST_UART
        if (f2open) {
            if (wnumb < UARTBUF)
                wbufb[wnumb++] = c;
            else {
                while (wnumb)
                    wnumb -= fwrite(wbufb, 1, wnumb, f2out);
                wbufb[wnumb++] = c;
            }
        }
        mec_irq(5);
#else
        if (uart_stat_reg & UARTB_SRE) {
            uartb_sreg = c;
            uart_stat_reg &= ~UARTB_SRE;
            event(uartb_tx, 0, UART_TX_TIME);
        } else {
            uartb_hreg = c;
            uart_stat_reg &= ~UARTB_HRE;
        }
#endif
        break;
    case 0xE8:                  /* UART status register */
#ifndef FAST_UART
        if (data & UARTA_CLR) {
            uart_stat_reg &= 0xFFFF0000;
            uart_stat_reg |= UARTA_SRE | UARTA_HRE;
        }
        if (data & UARTB_CLR) {
            uart_stat_reg &= 0x0000FFFF;
            uart_stat_reg |= UARTB_SRE | UARTB_HRE;
        }
#endif
        break;
    default:
        if (sis_verbose)
            printf("Write to unimplemented MEC register (%x)\n", addr);
 
    }
}
 
static void
flush_uart()
{
    while (wnuma && f1open)
        wnuma -= fwrite(wbufa, 1, wnuma, f1out);
    while (wnumb && f2open)
        wnumb -= fwrite(wbufb, 1, wnumb, f2out);
}
 
 
 
static void
uarta_tx()
{
 
    while (f1open && fwrite(&uarta_sreg, 1, 1, f1out) != 1);
    if (uart_stat_reg & UARTA_HRE) {
        uart_stat_reg |= UARTA_SRE;
    } else {
        uarta_sreg = uarta_hreg;
        uart_stat_reg |= UARTA_HRE;
        event(uarta_tx, 0, UART_TX_TIME);
    }
    mec_irq(4);
}
 
static void
uartb_tx()
{
    while (f2open && fwrite(&uartb_sreg, 1, 1, f2out) != 1);
    if (uart_stat_reg & UARTB_HRE) {
        uart_stat_reg |= UARTB_SRE;
    } else {
        uartb_sreg = uartb_hreg;
        uart_stat_reg |= UARTB_HRE;
        event(uartb_tx, 0, UART_TX_TIME);
    }
    mec_irq(5);
}
 
static void
uart_rx(arg)
    caddr_t         arg;
{
    int32           rsize;
    char            rxd;
 
 
    rsize = 0;
    if (f1open)
        rsize = DO_STDIO_READ(ifd1, &rxd, 1);
    if (rsize > 0) {
        uarta_data = UART_DR | rxd;
        if (uart_stat_reg & UARTA_HRE)
            uarta_data |= UART_THE;
        if (uart_stat_reg & UARTA_SRE)
            uarta_data |= UART_TSE;
        if (uart_stat_reg & UARTA_DR) {
            uart_stat_reg |= UARTA_OR;
            mec_irq(7);         /* UART error interrupt */
        }
        uart_stat_reg |= UARTA_DR;
        mec_irq(4);
    }
    rsize = 0;
    if (f2open)
        rsize = DO_STDIO_READ(ifd2, &rxd, 1);
    if (rsize) {
        uartb_data = UART_DR | rxd;
        if (uart_stat_reg & UARTB_HRE)
            uartb_data |= UART_THE;
        if (uart_stat_reg & UARTB_SRE)
            uartb_data |= UART_TSE;
        if (uart_stat_reg & UARTB_DR) {
            uart_stat_reg |= UARTB_OR;
            mec_irq(7);         /* UART error interrupt */
        }
        uart_stat_reg |= UARTB_DR;
        mec_irq(5);
    }
    event(uart_rx, 0, UART_RX_TIME);
}
 
static void
uart_intr(arg)
    caddr_t         arg;
{
    read_uart(0xE8);            /* Check for UART interrupts every 1000 clk */
    flush_uart();               /* Flush UART ports      */
    event(uart_intr, 0, UART_FLUSH_TIME);
}
 
 
static void
uart_irq_start()
{
#ifdef FAST_UART
    event(uart_intr, 0, UART_FLUSH_TIME);
#else
#ifndef _WIN32
    event(uart_rx, 0, UART_RX_TIME);
#endif
#endif
}
 
/* Watch-dog */
 
static void
wdog_intr(arg)
    caddr_t         arg;
{
    if (wdog_status == disabled) {
        wdog_status = stopped;
    } else {
 
        if (wdog_counter) {
            wdog_counter--;
            event(wdog_intr, 0, wdog_scaler + 1);
        } else {
            if (wdog_rston) {
                printf("Watchdog reset!\n");
                sys_reset();
                mec_ersr = 0xC000;
            } else {
                mec_irq(15);
                wdog_rston = 1;
                wdog_counter = wdog_rst_delay;
                event(wdog_intr, 0, wdog_scaler + 1);
            }
        }
    }
}
 
static void
wdog_start()
{
    event(wdog_intr, 0, wdog_scaler + 1);
    if (sis_verbose)
        printf("Watchdog started, scaler = %d, counter = %d\n",
               wdog_scaler, wdog_counter);
}
 
 
/* MEC timers */
 
 
static void
rtc_intr(arg)
    caddr_t         arg;
{
    if (rtc_counter == 0) {
 
        mec_irq(13);
        if (rtc_cr)
            rtc_counter = rtc_reload;
        else
            rtc_se = 0;
    } else
        rtc_counter -= 1;
    if (rtc_se) {
        event(rtc_intr, 0, rtc_scaler + 1);
        rtc_scaler_start = now();
        rtc_enabled = 1;
    } else {
        if (sis_verbose)
            printf("RTC stopped\n\r");
        rtc_enabled = 0;
    }
}
 
static void
rtc_start()
{
    if (sis_verbose)
        printf("RTC started (period %d)\n\r", rtc_scaler + 1);
    event(rtc_intr, 0, rtc_scaler + 1);
    rtc_scaler_start = now();
    rtc_enabled = 1;
}
 
static uint32
rtc_counter_read()
{
    return (rtc_counter);
}
 
static void
rtc_scaler_set(val)
    uint32          val;
{
    rtc_scaler = val & 0x0ff;   /* eight-bit scaler only */
}
 
static void
rtc_reload_set(val)
    uint32          val;
{
    rtc_reload = val;
}
 
static void
gpt_intr(arg)
    caddr_t         arg;
{
    if (gpt_counter == 0) {
        mec_irq(12);
        if (gpt_cr)
            gpt_counter = gpt_reload;
        else
            gpt_se = 0;
    } else
        gpt_counter -= 1;
    if (gpt_se) {
        event(gpt_intr, 0, gpt_scaler + 1);
        gpt_scaler_start = now();
        gpt_enabled = 1;
    } else {
        if (sis_verbose)
            printf("GPT stopped\n\r");
        gpt_enabled = 0;
    }
}
 
static void
gpt_start()
{
    if (sis_verbose)
        printf("GPT started (period %d)\n\r", gpt_scaler + 1);
    event(gpt_intr, 0, gpt_scaler + 1);
    gpt_scaler_start = now();
    gpt_enabled = 1;
}
 
static uint32
gpt_counter_read()
{
    return (gpt_counter);
}
 
static void
gpt_scaler_set(val)
    uint32          val;
{
    gpt_scaler = val & 0x0ffff; /* 16-bit scaler */
}
 
static void
gpt_reload_set(val)
    uint32          val;
{
    gpt_reload = val;
}
 
static void
timer_ctrl(val)
    uint32          val;
{
 
    rtc_cr = ((val & TCR_TCRCR) != 0);
    if (val & TCR_TCRCL) {
        rtc_counter = rtc_reload;
    }
    if (val & TCR_TCRSL) {
    }
    rtc_se = ((val & TCR_TCRSE) != 0);
    if (rtc_se && (rtc_enabled == 0))
        rtc_start();
 
    gpt_cr = (val & TCR_GACR);
    if (val & TCR_GACL) {
        gpt_counter = gpt_reload;
    }
    if (val & TCR_GACL) {
    }
    gpt_se = (val & TCR_GASE) >> 2;
    if (gpt_se && (gpt_enabled == 0))
        gpt_start();
}
 
 
/* Retrieve data from target memory.  MEM points to location from which
   to read the data; DATA points to words where retrieved data will be
   stored in host byte order.  SZ contains log(2) of the number of bytes
   to retrieve, and can be 0 (1 byte), 1 (one half-word), 2 (one word),
   or 3 (two words). */
 
static void
fetch_bytes (asi, mem, data, sz)
    int             asi;
    unsigned char  *mem;
    uint32         *data;
    int             sz;
{
    if (CURRENT_TARGET_BYTE_ORDER == BIG_ENDIAN
        || asi == 8 || asi == 9) {
        switch (sz) {
        case 3:
            data[1] =  (((uint32) mem[7]) & 0xff) |
                      ((((uint32) mem[6]) & 0xff) <<  8) |
                      ((((uint32) mem[5]) & 0xff) << 16) |
                      ((((uint32) mem[4]) & 0xff) << 24);
            /* Fall through to 2 */
        case 2:
            data[0] =  (((uint32) mem[3]) & 0xff) |
                      ((((uint32) mem[2]) & 0xff) <<  8) |
                      ((((uint32) mem[1]) & 0xff) << 16) |
                      ((((uint32) mem[0]) & 0xff) << 24);
            break;
        case 1:
            data[0] =  (((uint32) mem[1]) & 0xff) |
                      ((((uint32) mem[0]) & 0xff) << 8);
            break;
        case 0:
            data[0] = mem[0] & 0xff;
            break;
 
        }
    } else {
        switch (sz) {
        case 3:
            data[1] = ((((uint32) mem[7]) & 0xff) << 24) |
                      ((((uint32) mem[6]) & 0xff) << 16) |
                      ((((uint32) mem[5]) & 0xff) <<  8) |
                       (((uint32) mem[4]) & 0xff);
            /* Fall through to 4 */
        case 2:
            data[0] = ((((uint32) mem[3]) & 0xff) << 24) |
                      ((((uint32) mem[2]) & 0xff) << 16) |
                      ((((uint32) mem[1]) & 0xff) <<  8) |
                       (((uint32) mem[0]) & 0xff);
            break;
        case 1:
            data[0] = ((((uint32) mem[1]) & 0xff) <<  8) |
                       (((uint32) mem[0]) & 0xff);
            break;
        case 0:
            data[0] = mem[0] & 0xff;
            break;
        }
    }
}
 
 
/* Store data in target byte order.  MEM points to location to store data;
   DATA points to words in host byte order to be stored.  SZ contains log(2)
   of the number of bytes to retrieve, and can be 0 (1 byte), 1 (one half-word),
   2 (one word), or 3 (two words). */
 
static void
store_bytes (mem, data, sz)
    unsigned char  *mem;
    uint32         *data;
    int             sz;
{
    if (CURRENT_TARGET_BYTE_ORDER == LITTLE_ENDIAN) {
        switch (sz) {
        case 3:
            mem[7] = (data[1] >> 24) & 0xff;
            mem[6] = (data[1] >> 16) & 0xff;
            mem[5] = (data[1] >>  8) & 0xff;
            mem[4] = data[1] & 0xff;
            /* Fall through to 2 */
        case 2:
            mem[3] = (data[0] >> 24) & 0xff;
            mem[2] = (data[0] >> 16) & 0xff;
            /* Fall through to 1 */
        case 1:
            mem[1] = (data[0] >>  8) & 0xff;
            /* Fall through to 0 */
        case 0:
            mem[0] = data[0] & 0xff;
            break;
        }
    } else {
        switch (sz) {
        case 3:
            mem[7] = data[1] & 0xff;
            mem[6] = (data[1] >>  8) & 0xff;
            mem[5] = (data[1] >> 16) & 0xff;
            mem[4] = (data[1] >> 24) & 0xff;
            /* Fall through to 2 */
        case 2:
            mem[3] = data[0] & 0xff;
            mem[2] = (data[0] >>  8) & 0xff;
            mem[1] = (data[0] >> 16) & 0xff;
            mem[0] = (data[0] >> 24) & 0xff;
            break;
        case 1:
            mem[1] = data[0] & 0xff;
            mem[0] = (data[0] >> 8) & 0xff;
            break;
        case 0:
            mem[0] = data[0] & 0xff;
            break;
 
        }
    }
}
 
 
/* Memory emulation */
 
int
memory_read(asi, addr, data, sz, ws)
    int32           asi;
    uint32          addr;
    uint32         *data;
    int32           sz;
    int32          *ws;
{
    int32           mexc;
 
#ifdef ERRINJ
    if (errmec) {
        if (sis_verbose)
            printf("Inserted MEC error %d\n",errmec);
        set_sfsr(errmec, addr, asi, 1);
        if (errmec == 5) mecparerror();
        if (errmec == 6) iucomperr();
        errmec = 0;
        return(1);
    }
#endif;
 
    if ((addr >= mem_ramstart) && (addr < (mem_ramstart + mem_ramsz))) {
        fetch_bytes (asi, &ramb[addr & mem_rammask], data, sz);
        *ws = mem_ramr_ws;
        return (0);
    } else if ((addr >= MEC_START) && (addr < MEC_END)) {
        mexc = mec_read(addr, asi, data);
        if (mexc) {
            set_sfsr(MEC_ACC, addr, asi, 1);
            *ws = MEM_EX_WS;
        } else {
            *ws = 0;
        }
        return (mexc);
 
#ifdef ERA
 
    } else if (era) {
        if ((addr < 0x100000) ||
            ((addr>= 0x80000000) && (addr < 0x80100000))) {
            fetch_bytes (asi, &romb[addr & ROM_MASK], data, sz);
            *ws = 4;
            return (0);
        } else if ((addr >= 0x10000000) &&
                   (addr < (0x10000000 + (512 << (mec_iocr & 0x0f)))) &&
                   (mec_iocr & 0x10))  {
            *data = erareg;
            return (0);
        }
 
    } else  if (addr < mem_romsz) {
            fetch_bytes (asi, &romb[addr], data, sz);
            *ws = mem_romr_ws;
            return (0);
 
#else
    } else if (addr < mem_romsz) {
        fetch_bytes (asi, &romb[addr], data, sz);
        *ws = mem_romr_ws;
        return (0);
#endif
 
    }
 
    printf("Memory exception at %x (illegal address)\n", addr);
    set_sfsr(UIMP_ACC, addr, asi, 1);
    *ws = MEM_EX_WS;
    return (1);
}
 
int
memory_write(asi, addr, data, sz, ws)
    int32           asi;
    uint32          addr;
    uint32         *data;
    int32           sz;
    int32          *ws;
{
    uint32          byte_addr;
    uint32          byte_mask;
    uint32          waddr;
    uint32         *ram;
    int32           mexc;
    int             i;
    int             wphit[2];
 
#ifdef ERRINJ
    if (errmec) {
        if (sis_verbose)
            printf("Inserted MEC error %d\n",errmec);
        set_sfsr(errmec, addr, asi, 0);
        if (errmec == 5) mecparerror();
        if (errmec == 6) iucomperr();
        errmec = 0;
        return(1);
    }
#endif;
 
    if ((addr >= mem_ramstart) && (addr < (mem_ramstart + mem_ramsz))) {
        if (mem_accprot) {
 
            waddr = (addr & 0x7fffff) >> 2;
            for (i = 0; i < 2; i++)
                wphit[i] =
                    (((asi == 0xa) && (mec_wpr[i] & 1)) ||
                     ((asi == 0xb) && (mec_wpr[i] & 2))) &&
                    ((waddr >= mec_ssa[i]) && ((waddr | (sz == 3)) < mec_sea[i]));
 
            if (((mem_blockprot) && (wphit[0] || wphit[1])) ||
                ((!mem_blockprot) &&
                 !((mec_wpr[0] && wphit[0]) || (mec_wpr[1] && wphit[1]))
                 )) {
                if (sis_verbose)
                    printf("Memory access protection error at 0x%08x\n", addr);
                set_sfsr(PROT_EXC, addr, asi, 0);
                *ws = MEM_EX_WS;
                return (1);
            }
        }
 
        store_bytes (&ramb[addr & mem_rammask], data, sz);
 
        switch (sz) {
        case 0:
        case 1:
            *ws = mem_ramw_ws + 3;
            break;
        case 2:
            *ws = mem_ramw_ws;
            break;
        case 3:
            *ws = 2 * mem_ramw_ws + STD_WS;
            break;
        }
        return (0);
    } else if ((addr >= MEC_START) && (addr < MEC_END)) {
        if ((sz != 2) || (asi != 0xb)) {
            set_sfsr(MEC_ACC, addr, asi, 0);
            *ws = MEM_EX_WS;
            return (1);
        }
        mexc = mec_write(addr, *data);
        if (mexc) {
            set_sfsr(MEC_ACC, addr, asi, 0);
            *ws = MEM_EX_WS;
        } else {
            *ws = 0;
        }
        return (mexc);
 
#ifdef ERA
 
    } else if (era) {
        if ((erareg & 2) &&
        ((addr < 0x100000) || ((addr >= 0x80000000) && (addr < 0x80100000)))) {
            addr &= ROM_MASK;
            *ws = sz == 3 ? 8 : 4;
            store_bytes (&romb[addr], data, sz);
            return (0);
        } else if ((addr >= 0x10000000) &&
                   (addr < (0x10000000 + (512 << (mec_iocr & 0x0f)))) &&
                   (mec_iocr & 0x10))  {
            erareg = *data & 0x0e;
            return (0);
        }
 
    } else if ((addr < mem_romsz) && (mec_memcfg & 0x10000) && (wrp) &&
               (((mec_memcfg & 0x20000) && (sz > 1)) ||
                (!(mec_memcfg & 0x20000) && (sz == 0)))) {
 
        *ws = mem_romw_ws + 1;
        if (sz == 3)
            *ws += mem_romw_ws + STD_WS;
        store_bytes (&romb[addr], data, sz);
        return (0);
 
#else
    } else if ((addr < mem_romsz) && (mec_memcfg & 0x10000) && (wrp) &&
               (((mec_memcfg & 0x20000) && (sz > 1)) ||
                (!(mec_memcfg & 0x20000) && (sz == 0)))) {
 
        *ws = mem_romw_ws + 1;
        if (sz == 3)
            *ws += mem_romw_ws + STD_WS;
        store_bytes (&romb[addr], data, sz);
        return (0);
 
#endif
 
    }
 
    *ws = MEM_EX_WS;
    set_sfsr(UIMP_ACC, addr, asi, 0);
    return (1);
}
 
static unsigned char  *
get_mem_ptr(addr, size)
    uint32          addr;
    uint32          size;
{
    if ((addr + size) < ROM_SZ) {
        return (&romb[addr]);
    } else if ((addr >= mem_ramstart) && ((addr + size) < mem_ramend)) {
        return (&ramb[addr & mem_rammask]);
    }
 
#ifdef ERA
      else if ((era) && ((addr <0x100000) ||
        ((addr >= (unsigned) 0x80000000) && ((addr + size) < (unsigned) 0x80100000)))) {
        return (&romb[addr & ROM_MASK]);
    }
#endif
 
    return ((char *) -1);
}
 
int
sis_memory_write(addr, data, length)
    uint32          addr;
    char           *data;
    uint32          length;
{
    char           *mem;
 
    if ((mem = get_mem_ptr(addr, length)) == ((char *) -1))
        return (0);
 
    memcpy(mem, data, length);
    return (length);
}
 
int
sis_memory_read(addr, data, length)
    uint32          addr;
    char           *data;
    uint32          length;
{
    char           *mem;
 
    if ((mem = get_mem_ptr(addr, length)) == ((char *) -1))
        return (0);
 
    memcpy(data, mem, length);
    return (length);
}
Browse

Tools

Subversion Repositories openrisc_2011-10-31

[/] [openrisc/] [trunk/] [gnu-src/] [gdb-6.8/] [sim/] [erc32/] [erc32.c] - Blame information for rev 157

Line No.	Rev	Author	Line
1	24	jeremybenn	`/*`
2			`* This file is part of SIS.`
3			`*`
4			`* SIS, SPARC instruction simulator V2.5 Copyright (C) 1995 Jiri Gaisler,`
5			`* European Space Agency`
6			`*`
7			`* This program is free software; you can redistribute it and/or modify it under`
8			`* the terms of the GNU General Public License as published by the Free`
9			`* Software Foundation; either version 2 of the License, or (at your option)`
10			`* any later version.`
11			`*`
12			`* This program is distributed in the hope that it will be useful, but WITHOUT`
13			`* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or`
14			`* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for`
15			`* more details.`
16			`*`
17			`* You should have received a copy of the GNU General Public License along with`
18			`* this program; if not, write to the Free Software Foundation, Inc., 675`
19			`* Mass Ave, Cambridge, MA 02139, USA.`
20			`*`
21			`*/`
22
23			`/* The control space devices */`
24
25			`#include <sys/types.h>`
26			`#include <stdio.h>`
27			`#include <termios.h>`
28			`#include <sys/fcntl.h>`
29			`#include <sys/file.h>`
30			`#include <unistd.h>`
31			`#include "sis.h"`
32			`#include "end.h"`
33			`#include "sim-config.h"`
34
35			`extern int ctrl_c;`
36			`extern int32 sis_verbose;`
37			`extern int32 sparclite, sparclite_board;`
38			`extern int rom8,wrp,uben;`
39			`extern char uart_dev1[], uart_dev2[];`
40