220 lines
7.3 KiB
C
Executable File
220 lines
7.3 KiB
C
Executable File
/*******************************************************************************
|
|
' Author: Dave Hein
|
|
' Version 0.21
|
|
' Copyright (c) 2010, 2011
|
|
' See end of file for terms of use.
|
|
'******************************************************************************/
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include "interp.h"
|
|
#include "spinsim.h"
|
|
|
|
#define ADDR_MASK 0xfffff
|
|
|
|
extern char *hubram;
|
|
extern int32_t memsize;
|
|
extern int32_t loopcount;
|
|
extern int32_t cycleaccurate;
|
|
extern int32_t pin_val;
|
|
|
|
extern FILE *tracefile;
|
|
|
|
void Disassemble2(int instruct, int pc, char *debugstr, int *errflag);
|
|
|
|
void StartPasmCog2(PasmVarsT *pasmvars, int32_t par, int32_t addr, int32_t cogid, int32_t hubexec)
|
|
{
|
|
int32_t i;
|
|
|
|
//printf("\nStartPasmCog2: %8.8x, %8.8x, %d, %d\n", par, addr, cogid, hubexec);
|
|
par &= ADDR_MASK;
|
|
addr &= ADDR_MASK;
|
|
pasmvars->waitflag = 0;
|
|
pasmvars->cflag = 0;
|
|
pasmvars->zflag = 0;
|
|
pasmvars->cogid = cogid;
|
|
pasmvars->state = 5;
|
|
pasmvars->ptra = par;
|
|
pasmvars->ptrb = addr;
|
|
pasmvars->ptrx = 0;
|
|
pasmvars->ptry = 0;
|
|
pasmvars->inda = 0x1f2;
|
|
pasmvars->indatop = 0;
|
|
pasmvars->indabot = 0;
|
|
pasmvars->indb = 0x1f3;
|
|
pasmvars->indbtop = 0;
|
|
pasmvars->indbbot = 0;
|
|
pasmvars->repcnt = 0;
|
|
pasmvars->repbot = 0;
|
|
pasmvars->reptop = 0;
|
|
pasmvars->repforever = 0;
|
|
pasmvars->instruct1 = 0;
|
|
pasmvars->instruct2 = 0;
|
|
pasmvars->instruct3 = 0;
|
|
pasmvars->instruct4 = 0;
|
|
pasmvars->pc1 = INVALIDATE_INSTR;
|
|
pasmvars->pc2 = INVALIDATE_INSTR;
|
|
pasmvars->pc3 = INVALIDATE_INSTR;
|
|
pasmvars->pc4 = INVALIDATE_INSTR;
|
|
pasmvars->retptr = 0;
|
|
pasmvars->acca = 0;
|
|
pasmvars->accb = 0;
|
|
pasmvars->cordic_count = 0;
|
|
pasmvars->cordic_depth = 0;
|
|
pasmvars->qxposted = 0;
|
|
pasmvars->qyposted = 0;
|
|
pasmvars->breakpnt = -1;
|
|
pasmvars->augsflag = 0;
|
|
pasmvars->augsvalue = 0;
|
|
pasmvars->augdflag = 0;
|
|
pasmvars->augdvalue = 0;
|
|
pasmvars->altsflag = 0;
|
|
pasmvars->altsvalue = 0;
|
|
pasmvars->altdflag = 0;
|
|
pasmvars->altdvalue = 0;
|
|
pasmvars->altrflag = 0;
|
|
pasmvars->altrvalue = 0;
|
|
pasmvars->altiflag = 0;
|
|
pasmvars->altivalue = 0;
|
|
pasmvars->prefetch = 0;
|
|
pasmvars->serina.mode = 0;
|
|
pasmvars->serinb.mode = 0;
|
|
pasmvars->serouta.mode = 0;
|
|
pasmvars->seroutb.mode = 0;
|
|
pasmvars->phase = 0;
|
|
pasmvars->rwrep = 0;
|
|
pasmvars->str_fifo_work_flag = 0;
|
|
pasmvars->str_fifo_addr0 = 0;
|
|
pasmvars->str_fifo_addr1 = 0;
|
|
pasmvars->str_fifo_head_addr = 0;
|
|
pasmvars->str_fifo_tail_addr = 0;
|
|
pasmvars->str_fifo_rindex = 0;
|
|
pasmvars->str_fifo_windex = 0;
|
|
pasmvars->str_fifo_mode = 0;
|
|
pasmvars->str_fifo_buffer[0] = 0;
|
|
pasmvars->cntreg1 = 0;
|
|
pasmvars->cntreg2 = 0;
|
|
pasmvars->cntreg3 = 0;
|
|
pasmvars->intflags = 0;
|
|
pasmvars->intstate = 0;
|
|
pasmvars->qreg = 0;
|
|
pasmvars->memflag = 0;
|
|
pasmvars->intenable1 = 0;
|
|
pasmvars->intenable2 = 0;
|
|
pasmvars->intenable3 = 0;
|
|
pasmvars->pinpatmode = 0;
|
|
pasmvars->pinpatmask = 0;
|
|
pasmvars->pinpattern = 0;
|
|
pasmvars->pinedge = 0;
|
|
pasmvars->lockedge = 0;
|
|
pasmvars->rdl_mask = 0;
|
|
pasmvars->wrl_mask = 0;
|
|
|
|
if (!hubexec)
|
|
{
|
|
for (i = 0; i < 0x1f4; i++)
|
|
{
|
|
pasmvars->mem[i] = LONG(addr);
|
|
addr += 4;
|
|
}
|
|
pasmvars->pc = 0;
|
|
}
|
|
else
|
|
pasmvars->pc = addr;
|
|
for (i = 0x1f4; i < 512; i++) pasmvars->mem[i] = 0;
|
|
}
|
|
|
|
void DebugPasmInstruction2(PasmVarsT *pasmvars)
|
|
{
|
|
int32_t i;
|
|
int32_t cflag = pasmvars->cflag;
|
|
int32_t zflag = pasmvars->zflag;
|
|
int32_t instruct, pc, cond, xflag;
|
|
char opstr[20];
|
|
char *xstr[12] = {" ", "X", "I", "H", "C", "P", "W", "F", "w", "E", "?", "S"};
|
|
|
|
// Fetch the instruction
|
|
pc = pasmvars->pc2;
|
|
instruct = pasmvars->instruct2;
|
|
cond = (instruct >> 28) & 15;
|
|
if (cond == 0 && instruct != 0) cond = 15;
|
|
xflag = ((cond >> ((cflag << 1) | zflag)) & 1);
|
|
xflag ^= 1;
|
|
|
|
// Check if the instruction is invalidated in the pipeline
|
|
if (pc & INVALIDATE_INSTR)
|
|
{
|
|
pc &= ~INVALIDATE_INSTR;
|
|
xflag = 2;
|
|
}
|
|
|
|
if (pasmvars->waitflag && pasmvars->waitmode == WAIT_CACHE) xflag = 4;
|
|
else if (xflag == 4) xflag = 5;
|
|
|
|
if (pasmvars->waitflag)
|
|
{
|
|
if (pasmvars->waitmode == WAIT_CACHE)
|
|
xflag = 4;
|
|
else if (pasmvars->waitmode == WAIT_CNT)
|
|
xflag = 6;
|
|
else if (pasmvars->waitmode == WAIT_PIN)
|
|
xflag = 5;
|
|
else if (pasmvars->waitmode == WAIT_HUB)
|
|
xflag = 3;
|
|
else if (pasmvars->waitmode == WAIT_FLAG)
|
|
xflag = 8;
|
|
else if (pasmvars->waitmode == WAIT_CORDIC)
|
|
xflag = 9;
|
|
else
|
|
xflag = 10;
|
|
}
|
|
else if (pasmvars->phase == 0)
|
|
xflag = 7;
|
|
else if (pasmvars->skip_mask & 1)
|
|
xflag = 11;
|
|
|
|
i = strlen(opstr);
|
|
while (i < 7) opstr[i++] = ' ';
|
|
opstr[i] = 0;
|
|
|
|
// Check for NOP
|
|
if (!instruct)
|
|
{
|
|
cond = 15;
|
|
if (xflag == 1) xflag = 0;
|
|
strcpy(opstr, "nop ");
|
|
}
|
|
|
|
if (pasmvars->printflag - 2 < xflag && xflag != 0)
|
|
{
|
|
pasmvars->printflag = 0;
|
|
return;
|
|
}
|
|
|
|
{
|
|
int errflag;
|
|
char debugstr[100];
|
|
|
|
Disassemble2(instruct, pc, debugstr, &errflag);
|
|
fprintf(tracefile, "Cog %2d: %8.8x ", pasmvars->cogid, loopcount);
|
|
fprintf(tracefile, "%4.4x %8.8x %s %s", pc,
|
|
instruct, xstr[xflag], debugstr);
|
|
}
|
|
}
|
|
/*
|
|
+------------------------------------------------------------------------------------------------------------------------------+
|
|
| TERMS OF USE: MIT License |
|
|
+------------------------------------------------------------------------------------------------------------------------------+
|
|
|Permission is hereby granted, free of charge, to any person obtaining a copy of this software and associated documentation |
|
|
|files (the "Software"), to deal in the Software without restriction, including without limitation the rights to use, copy, |
|
|
|modify, merge, publish, distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the Software|
|
|
|is furnished to do so, subject to the following conditions: |
|
|
| |
|
|
|The above copyright notice and this permission notice shall be included in all copies or substantial portions of the Software.|
|
|
| |
|
|
|THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE |
|
|
|WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR |
|
|
|COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, |
|
|
|ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
|
|
+------------------------------------------------------------------------------------------------------------------------------+
|
|
*/
|