/* sprs.c -- Simulation of OR1K special-purpose registers
|
/* sprs.c -- Simulation of OR1K special-purpose registers
|
Copyright (C) 1999 Damjan Lampret, lampret@opencores.org
|
Copyright (C) 1999 Damjan Lampret, lampret@opencores.org
|
|
|
This file is part of OpenRISC 1000 Architectural Simulator.
|
This file is part of OpenRISC 1000 Architectural Simulator.
|
|
|
This program is free software; you can redistribute it and/or modify
|
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
|
it under the terms of the GNU General Public License as published by
|
the Free Software Foundation; either version 2 of the License, or
|
the Free Software Foundation; either version 2 of the License, or
|
(at your option) any later version.
|
(at your option) any later version.
|
|
|
This program is distributed in the hope that it will be useful,
|
This program is distributed in the hope that it will be useful,
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
GNU General Public License for more details.
|
GNU General Public License for more details.
|
|
|
You should have received a copy of the GNU General Public License
|
You should have received a copy of the GNU General Public License
|
along with this program; if not, write to the Free Software
|
along with this program; if not, write to the Free Software
|
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */
|
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */
|
|
|
#include <stdlib.h>
|
#include <stdlib.h>
|
#include <stdio.h>
|
#include <stdio.h>
|
#include <string.h>
|
#include <string.h>
|
#include <errno.h>
|
#include <errno.h>
|
|
|
#include "arch.h"
|
#include "arch.h"
|
#include "sprs.h"
|
#include "sprs.h"
|
#include "abstract.h"
|
#include "abstract.h"
|
|
|
extern int cont_run; /* defined in toplevel.c */
|
extern int cont_run; /* defined in toplevel.c */
|
extern int tt_stopped; /* defined in tick.c */
|
extern int tt_stopped; /* defined in tick.c */
|
extern int flag;
|
extern int flag;
|
extern int GlobalMode; /* CZ 21/06/01 */
|
|
|
|
sprword sprs[MAX_SPRS];
|
sprword sprs[MAX_SPRS];
|
|
|
int temp_disable_except = 0;
|
int temp_disable_except = 0;
|
int audio_cnt = 0;
|
int audio_cnt = 0;
|
|
|
static FILE *fo = 0;
|
static FILE *fo = 0;
|
/* Set a specific SPR with a value. */
|
/* Set a specific SPR with a value. */
|
inline void
|
inline void
|
mtspr(const int regno, const sprword value)
|
mtspr(const int regno, const sprword value)
|
{
|
{
|
int ofs = regno % MAX_SPRS_PER_GRP;
|
int ofs = regno % MAX_SPRS_PER_GRP;
|
extern unsigned long pc_phy;
|
extern unsigned long pc_phy;
|
|
|
/* MM: Register hooks. */
|
/* MM: Register hooks. */
|
switch (regno) {
|
switch (regno) {
|
case 0xFFFD:
|
case 0xFFFD:
|
fo = fopen ("audiosim.pcm", "wb+");
|
fo = fopen ("audiosim.pcm", "wb+");
|
if (!fo) printf("Cannot open audiosim.pcm\n");
|
if (!fo) printf("Cannot open audiosim.pcm\n");
|
printf("Audio opened.\n");
|
printf("Audio opened.\n");
|
return;
|
return;
|
case 0xFFFE:
|
case 0xFFFE:
|
if (!fo) printf("audiosim.pcm not opened\n");
|
if (!fo) printf("audiosim.pcm not opened\n");
|
fputc (value & 0xFF, fo);
|
fputc (value & 0xFF, fo);
|
if ((audio_cnt % 1024) == 0)
|
if ((audio_cnt % 1024) == 0)
|
printf("%i\n", audio_cnt);
|
printf("%i\n", audio_cnt);
|
audio_cnt++;
|
audio_cnt++;
|
return;
|
return;
|
case 0xFFFF:
|
case 0xFFFF:
|
fclose(fo);
|
fclose(fo);
|
printf("Audio closed.\n");
|
printf("Audio closed.\n");
|
cont_run = 0;
|
cont_run = 0;
|
return;
|
return;
|
case SPR_TTMR:
|
case SPR_TTMR:
|
/* CZ -- 04/09/01 Clear the interrupt in the PIC also... */
|
/* CZ -- 04/09/01 Clear the interrupt in the PIC also... */
|
/* If it's cleared now and it was set, then we need to fix it */
|
/* If it's cleared now and it was set, then we need to fix it */
|
if(~value & SPR_TTMR_IP & sprs[SPR_TTMR])
|
if(~value & SPR_TTMR_IP & sprs[SPR_TTMR])
|
setsprbit(SPR_PICSR, 3, 0);
|
setsprbit(SPR_PICSR, 3, 0);
|
if (value & SPR_TTMR_M == 2) break;
|
if (value & SPR_TTMR_M == 2) break;
|
case SPR_TTCR:
|
case SPR_TTCR:
|
tt_stopped = 0;
|
tt_stopped = 0;
|
break;
|
break;
|
case 0x1234:
|
case 0x1234:
|
printf("MTSPR(0x1234, %x);\n", value);
|
printf("MTSPR(0x1234, %x);\n", value);
|
break;
|
break;
|
case 0x1235:
|
case 0x1235:
|
{
|
{
|
FILE *f;
|
FILE *f;
|
if (!(f = fopen("stdout.txt", "a+")))
|
if (!(f = fopen("stdout.txt", "a+")))
|
{
|
{
|
perror(strerror(errno));
|
perror(strerror(errno));
|
return;
|
return;
|
}
|
}
|
fprintf(f, "%c", value);
|
fprintf(f, "%c", value);
|
if (fclose(f))
|
if (fclose(f))
|
perror(strerror(errno));
|
perror(strerror(errno));
|
}
|
}
|
break;
|
break;
|
case SPR_SR:
|
case SPR_SR:
|
if(value & SPR_SR_F)
|
if(value & SPR_SR_F)
|
flag = 1;
|
flag = 1;
|
else
|
else
|
flag = 0;
|
flag = 0;
|
break;
|
break;
|
case SPR_EPCR_BASE:
|
case SPR_EPCR_BASE:
|
if((value & 0xffffff00) == 0x00020600)
|
if((value & 0xffffff00) == 0x00020600)
|
{
|
{
|
printf("SIMON: EPCR = ext_int\n");
|
printf("SIMON: EPCR = ext_int\n");
|
cont_run = 0;
|
cont_run = 0;
|
}
|
}
|
break;
|
break;
|
}
|
}
|
|
|
/* CZ 21/06/01 ... the debugger wants to do this! */
|
/* CZ 21/06/01 ... the debugger wants to do this! */
|
if(GlobalMode)
|
if(GlobalMode)
|
{
|
{
|
extern unsigned long pc;
|
extern unsigned long pc;
|
extern unsigned long pcnext;
|
extern unsigned long pcnext;
|
extern int delay_insn;
|
extern int delay_insn;
|
extern unsigned long pcdelay;
|
extern unsigned long pcdelay;
|
|
|
if(regno == SPR_PC)
|
if(regno == SPR_PC)
|
{
|
{
|
sprs[SPR_PC] = value;
|
sprs[SPR_PC] = value;
|
|
|
/* The debugger has redirected us to a new address */
|
/* The debugger has redirected us to a new address */
|
/* This is usually done to reissue an instruction
|
/* This is usually done to reissue an instruction
|
which just caused a breakpoint exception. */
|
which just caused a breakpoint exception. */
|
pcnext = value;
|
pcnext = value;
|
|
|
if(!value)
|
if(!value)
|
{
|
{
|
printf("WARNING: Debugger just set us to 0!\n");
|
printf("WARNING: Debugger just set us to 0!\n");
|
}
|
}
|
|
|
/* Clear any pending delay slot jumps also */
|
/* Clear any pending delay slot jumps also */
|
delay_insn = 0;
|
delay_insn = 0;
|
pcdelay = value+4;
|
pcdelay = value+4;
|
|
|
return;
|
return;
|
}
|
}
|
}
|
}
|
|
|
/* printf("mtspr(%x, %x)\n", regno, value);
|
/* printf("mtspr(%x, %x)\n", regno, value);
|
*/ if (regno < MAX_SPRS)
|
*/ if (regno < MAX_SPRS)
|
sprs[regno] = value;
|
sprs[regno] = value;
|
else {
|
else {
|
printf("\nABORT: write out of SPR range %08X\n", regno);
|
printf("\nABORT: write out of SPR range %08X\n", regno);
|
cont_run = 0;
|
cont_run = 0;
|
}
|
}
|
}
|
}
|
|
|
/* Get a specific SPR. */
|
/* Get a specific SPR. */
|
inline sprword
|
inline sprword
|
mfspr_(const int regno)
|
mfspr_(const int regno)
|
{
|
{
|
/* CZ 21/06/01 ... the debugger wants to do this! */
|
/* CZ 21/06/01 ... the debugger wants to do this! */
|
{
|
{
|
extern unsigned long pc;
|
extern unsigned long pc;
|
|
|
if(regno == SPR_PC)
|
if(regno == SPR_PC)
|
return pc;
|
return pc;
|
}
|
}
|
|
|
/* MM: l.rfe, for example, temporarly disables
|
/* MM: l.rfe, for example, temporarly disables
|
exceptions. We will make it appear as SR bit
|
exceptions. We will make it appear as SR bit
|
is set. */
|
is set. */
|
if (regno == SPR_SR && temp_disable_except > 0)
|
if (regno == SPR_SR && temp_disable_except > 0)
|
return sprs[regno] & ~SPR_SR_EXR;
|
return sprs[regno] & ~SPR_SR_EXR;
|
/* printf("mfspr(%x)%x\n", regno, sprs[regno]); */
|
/* printf("mfspr(%x)%x\n", regno, sprs[regno]); */
|
|
|
if (regno < MAX_SPRS)
|
if (regno < MAX_SPRS)
|
return sprs[regno];
|
return sprs[regno];
|
else {
|
else {
|
printf("\nABORT: read out of SPR range %08X\n", regno);
|
printf("\nABORT: read out of SPR range %08X\n", regno);
|
cont_run = 0;
|
cont_run = 0;
|
}
|
}
|
return 0;
|
return 0;
|
}
|
}
|
|
|
/* Set a specific bit from SPR. LSB in a word is numbered zero. */
|
/* Set a specific bit from SPR. LSB in a word is numbered zero. */
|
inline void
|
inline void
|
setsprbit(const int regno, const int bitnum, const unsigned long bitvalue)
|
setsprbit(const int regno, const int bitnum, const unsigned long bitvalue)
|
{
|
{
|
sprword mask;
|
sprword mask;
|
sprword regvalue = mfspr(regno);
|
sprword regvalue = mfspr(regno);
|
|
|
mask = ~(1 << bitnum);
|
mask = ~(1 << bitnum);
|
|
|
mtspr(regno, (regvalue & mask) | ((bitvalue & 0x1) << bitnum));
|
mtspr(regno, (regvalue & mask) | ((bitvalue & 0x1) << bitnum));
|
|
|
return;
|
return;
|
}
|
}
|
|
|
/* Get a specific bit from SPR. */
|
/* Get a specific bit from SPR. */
|
inline int
|
inline int
|
getsprbit(const int regno, const int bitnum)
|
getsprbit(const int regno, const int bitnum)
|
{
|
{
|
sprword regvalue = mfspr(regno);
|
sprword regvalue = mfspr(regno);
|
|
|
return (regvalue >> bitnum) & 0x1;
|
return (regvalue >> bitnum) & 0x1;
|
}
|
}
|
|
|
/* Set specific SPR bit(s) identified by mask. */
|
/* Set specific SPR bit(s) identified by mask. */
|
inline void
|
inline void
|
setsprbits(const int regno, const unsigned long mask, const unsigned long value)
|
setsprbits(const int regno, const unsigned long mask, const unsigned long value)
|
{
|
{
|
sprword regvalue = mfspr(regno);
|
sprword regvalue = mfspr(regno);
|
sprword shifted = 0x0;
|
sprword shifted = 0x0;
|
int m, v = 0;
|
int m, v = 0;
|
|
|
/* m counts bits in valuemask */
|
/* m counts bits in valuemask */
|
/* v counts bits in value */
|
/* v counts bits in value */
|
for (m = 0; m < 32; m++)
|
for (m = 0; m < 32; m++)
|
if ((mask >> m) & 0x1) {
|
if ((mask >> m) & 0x1) {
|
shifted |= ((value >> v) & 0x1) << m;
|
shifted |= ((value >> v) & 0x1) << m;
|
v++;
|
v++;
|
}
|
}
|
|
|
/* printf("oldvalue %x setsprbits(%x, %x, %x) shifted %x", regvalue, regno, mask, value, shifted); */
|
/* printf("oldvalue %x setsprbits(%x, %x, %x) shifted %x", regvalue, regno, mask, value, shifted); */
|
mtspr(regno, (regvalue & ~mask) | shifted);
|
mtspr(regno, (regvalue & ~mask) | shifted);
|
|
|
return;
|
return;
|
}
|
}
|
|
|
/* Get specific SPR bit(s) identified by mask. */
|
/* Get specific SPR bit(s) identified by mask. */
|
inline unsigned long
|
inline unsigned long
|
getsprbits(const int regno, const unsigned long mask)
|
getsprbits(const int regno, const unsigned long mask)
|
{
|
{
|
sprword regvalue = mfspr(regno);
|
sprword regvalue = mfspr(regno);
|
sprword shifted = 0x0;
|
sprword shifted = 0x0;
|
int m, v = 0;
|
int m, v = 0;
|
|
|
/* m counts bits in valuemask */
|
/* m counts bits in valuemask */
|
/* v counts bits in regvalue */
|
/* v counts bits in regvalue */
|
for (m = 0; m < 32; m++)
|
for (m = 0; m < 32; m++)
|
if ((mask >> m) & 0x1) {
|
if ((mask >> m) & 0x1) {
|
shifted |= ((regvalue >> m) & 0x1) << v;
|
shifted |= ((regvalue >> m) & 0x1) << v;
|
v++;
|
v++;
|
}
|
}
|
|
|
return shifted;
|
return shifted;
|
}
|
}
|
|
|
/* Get specific SPR bit(s) identified by mask. */
|
/* Get specific SPR bit(s) identified by mask. */
|
inline unsigned long
|
inline unsigned long
|
testsprbits(const int regno, const unsigned long mask)
|
testsprbits(const int regno, const unsigned long mask)
|
{
|
{
|
sprword regvalue = mfspr(regno);
|
sprword regvalue = mfspr(regno);
|
return regvalue & mask;
|
return regvalue & mask;
|
}
|
}
|
|
|
/* Show status of important SPRs. */
|
/* Show status of important SPRs. */
|
void sprs_status()
|
void sprs_status()
|
{
|
{
|
printf("VR : 0x%.8x UPR : 0x%.8x\n", mfspr(SPR_VR), mfspr(SPR_UPR));
|
printf("VR : 0x%.8x UPR : 0x%.8x\n", mfspr(SPR_VR), mfspr(SPR_UPR));
|
printf("SR : 0x%.8x\n", mfspr(SPR_SR));
|
printf("SR : 0x%.8x\n", mfspr(SPR_SR));
|
printf("MACLO: 0x%.8x MACHI: 0x%.8x\n", mfspr(SPR_MACLO), mfspr(SPR_MACHI));
|
printf("MACLO: 0x%.8x MACHI: 0x%.8x\n", mfspr(SPR_MACLO), mfspr(SPR_MACHI));
|
printf("EPCR0: 0x%.8x EPCR1: 0x%.8x\n", mfspr(SPR_EPCR_BASE), mfspr(SPR_EPCR_BASE+1));
|
printf("EPCR0: 0x%.8x EPCR1: 0x%.8x\n", mfspr(SPR_EPCR_BASE), mfspr(SPR_EPCR_BASE+1));
|
printf("EEAR0: 0x%.8x EEAR1: 0x%.8x\n", mfspr(SPR_EEAR_BASE), mfspr(SPR_EEAR_BASE+1));
|
printf("EEAR0: 0x%.8x EEAR1: 0x%.8x\n", mfspr(SPR_EEAR_BASE), mfspr(SPR_EEAR_BASE+1));
|
printf("ESR0 : 0x%.8x ESR1 : 0x%.8x\n", mfspr(SPR_ESR_BASE), mfspr(SPR_ESR_BASE+1));
|
printf("ESR0 : 0x%.8x ESR1 : 0x%.8x\n", mfspr(SPR_ESR_BASE), mfspr(SPR_ESR_BASE+1));
|
}
|
}
|
|
|