//
|
//
|
//
|
//
|
// Filename: cpuscope.cpp
|
// Filename: cpuscope.cpp
|
//
|
//
|
// Project: FPGA library development (Basys-3 development board)
|
// Project: FPGA library development (Basys-3 development board)
|
//
|
//
|
// Purpose: To read out, and decompose, the results of the wishbone scope
|
// Purpose: To read out, and decompose, the results of the wishbone scope
|
// as applied to the ICAPE2 interaction.
|
// as applied to the ICAPE2 interaction.
|
//
|
//
|
// Creator: Dan Gisselquist
|
// Creator: Dan Gisselquist
|
// Gisselquist Tecnology, LLC
|
// Gisselquist Tecnology, LLC
|
//
|
//
|
// Copyright: 2015
|
// Copyright: 2015
|
//
|
//
|
//
|
//
|
#include <stdio.h>
|
#include <stdio.h>
|
#include <stdlib.h>
|
#include <stdlib.h>
|
#include <unistd.h>
|
#include <unistd.h>
|
#include <strings.h>
|
#include <strings.h>
|
#include <ctype.h>
|
#include <ctype.h>
|
#include <string.h>
|
#include <string.h>
|
#include <signal.h>
|
#include <signal.h>
|
#include <assert.h>
|
#include <assert.h>
|
|
|
#include "usbi.h"
|
#include "usbi.h"
|
#include "port.h"
|
#include "port.h"
|
#include "llcomms.h"
|
#include "llcomms.h"
|
#include "regdefs.h"
|
#include "regdefs.h"
|
|
|
#define WBSCOPE R_CPUSCOPE
|
#define WBSCOPE R_CPUSCOPE
|
#define WBSCOPEDATA R_CPUSCOPED
|
#define WBSCOPEDATA R_CPUSCOPED
|
|
|
#include "zopcodes.h"
|
#include "zopcodes.h"
|
|
|
FPGA *m_fpga;
|
FPGA *m_fpga;
|
void closeup(int v) {
|
void closeup(int v) {
|
m_fpga->kill();
|
m_fpga->kill();
|
exit(0);
|
exit(0);
|
}
|
}
|
|
|
unsigned brev(const unsigned v) {
|
unsigned brev(const unsigned v) {
|
unsigned int r, a;
|
unsigned int r, a;
|
a = v;
|
a = v;
|
r = 0;
|
r = 0;
|
for(int i=0; i<8; i++) {
|
for(int i=0; i<8; i++) {
|
r <<= 1;
|
r <<= 1;
|
r |= (a&1);
|
r |= (a&1);
|
a >>= 1;
|
a >>= 1;
|
} return r;
|
} return r;
|
}
|
}
|
|
|
unsigned wrev(const unsigned v) {
|
unsigned wrev(const unsigned v) {
|
unsigned r = brev(v&0x0ff);
|
unsigned r = brev(v&0x0ff);
|
r |= brev((v>>8)&0x0ff)<<8;
|
r |= brev((v>>8)&0x0ff)<<8;
|
return r;
|
return r;
|
}
|
}
|
|
|
int main(int argc, char **argv) {
|
int main(int argc, char **argv) {
|
FPGAOPEN(m_fpga);
|
FPGAOPEN(m_fpga);
|
|
|
signal(SIGSTOP, closeup);
|
signal(SIGSTOP, closeup);
|
signal(SIGHUP, closeup);
|
signal(SIGHUP, closeup);
|
|
|
unsigned v, lgln, scoplen;
|
unsigned v, lgln, scoplen;
|
printf("Attempting to read address %08x\n", WBSCOPE);
|
|
v = m_fpga->readio(WBSCOPE);
|
v = m_fpga->readio(WBSCOPE);
|
if (0x60000000 != (v & 0x60000000)) {
|
if (0x60000000 != (v & 0x60000000)) {
|
printf("Scope is not yet ready:\n");
|
printf("Scope is not yet ready:\n");
|
printf("\tRESET:\t\t%s\n", (v&0x80000000)?"Ongoing":"Complete");
|
printf("\tRESET:\t\t%s\n", (v&0x80000000)?"Ongoing":"Complete");
|
printf("\tSTOPPED:\t%s\n", (v&0x40000000)?"Yes":"No");
|
printf("\tSTOPPED:\t%s\n", (v&0x40000000)?"Yes":"No");
|
printf("\tTRIGGERED:\t%s\n", (v&0x20000000)?"Yes":"No");
|
printf("\tTRIGGERED:\t%s\n", (v&0x20000000)?"Yes":"No");
|
printf("\tPRIMED:\t\t%s\n", (v&0x10000000)?"Yes":"No");
|
printf("\tPRIMED:\t\t%s\n", (v&0x10000000)?"Yes":"No");
|
printf("\tMANUAL:\t\t%s\n", (v&0x08000000)?"Yes":"No");
|
printf("\tMANUAL:\t\t%s\n", (v&0x08000000)?"Yes":"No");
|
printf("\tDISABLED:\t%s\n", (v&0x04000000)?"Yes":"No");
|
printf("\tDISABLED:\t%s\n", (v&0x04000000)?"Yes":"No");
|
printf("\tZERO:\t\t%s\n", (v&0x02000000)?"Yes":"No");
|
printf("\tZERO:\t\t%s\n", (v&0x02000000)?"Yes":"No");
|
exit(0);
|
exit(0);
|
} else printf("SCOPD = %08x\n", v);
|
} else printf("SCOPD = %08x\n", v);
|
|
|
lgln = (v>>20) & 0x1f;
|
lgln = (v>>20) & 0x1f;
|
scoplen = (1<<lgln);
|
scoplen = (1<<lgln);
|
|
|
DEVBUS::BUSW *buf;
|
DEVBUS::BUSW *buf;
|
buf = new DEVBUS::BUSW[scoplen];
|
buf = new DEVBUS::BUSW[scoplen];
|
|
|
if (false) {
|
if (false) {
|
printf("Attempting vector read\n");
|
|
m_fpga->readz(WBSCOPEDATA, scoplen, buf);
|
m_fpga->readz(WBSCOPEDATA, scoplen, buf);
|
|
|
printf("Vector read complete\n");
|
|
} else {
|
} else {
|
for(unsigned int i=0; i<scoplen; i++)
|
for(unsigned int i=0; i<scoplen; i++)
|
buf[i] = m_fpga->readio(WBSCOPEDATA);
|
buf[i] = m_fpga->readio(WBSCOPEDATA);
|
}
|
}
|
|
|
for(unsigned int i=0; i<scoplen; i++) {
|
for(unsigned int i=0; i<scoplen; i++) {
|
char sbuf[64];
|
char sbuf[64];
|
|
|
if ((i>0)&&(buf[i] == buf[i-1])&&
|
if ((i>0)&&(buf[i] == buf[i-1])&&
|
(i<scoplen-1)&&(buf[i] == buf[i+1]))
|
(i<scoplen-1)&&(buf[i] == buf[i+1]))
|
continue;
|
continue;
|
printf("%6d %08x:", i, buf[i]);
|
printf("%6d %08x:", i, buf[i]);
|
|
|
unsigned addr = (buf[i]>>24)&0x0ff;
|
unsigned addr = (buf[i]>>24)&0x0ff;
|
zipi_to_string(m_fpga->readio(0x02000+addr),sbuf);
|
zipi_to_string(m_fpga->readio(0x02000+addr),sbuf);
|
printf(" %2x %-24s", (buf[i]>>24)&0x0ff, sbuf);
|
printf(" %2x %-24s", (buf[i]>>24)&0x0ff, sbuf);
|
printf(" %s%s%s%s%s %s%s%s",
|
printf(" %s%s%s%s%s %s%s%s",
|
((buf[i]>>23)&1)?"P":" ",
|
((buf[i]>>23)&1)?"P":" ",
|
((buf[i]>>22)&1)?"D":" ",
|
((buf[i]>>22)&1)?"D":" ",
|
((buf[i]>>21)&1)?"O":" ",
|
((buf[i]>>21)&1)?"O":" ",
|
((buf[i]>>20)&1)?"A":" ",
|
((buf[i]>>20)&1)?"A":" ",
|
((buf[i]>>19)&1)?"M":" ",
|
((buf[i]>>19)&1)?"M":" ",
|
((buf[i]>>18)&1)?"o":" ",
|
((buf[i]>>18)&1)?"o":" ",
|
((buf[i]>>17)&1)?"a":" ",
|
((buf[i]>>17)&1)?"a":" ",
|
((buf[i]>>16)&1)?"m":" ");
|
((buf[i]>>16)&1)?"m":" ");
|
printf(" A=%02x ", (buf[i]>>8)&0x0ff);
|
printf(" A=%02x ", (buf[i]>>8)&0x0ff);
|
printf(" %s%02x ",
|
printf(" %s%02x ",
|
(((buf[i]>>16)&3)!=0)?"W->":"(w)",
|
(((buf[i]>>16)&3)!=0)?"W->":"(w)",
|
(buf[i]&0x0ff));
|
(buf[i]&0x0ff));
|
/*
|
/*
|
printf("%s", ((buf[i]>>31)&1)?"OpV":" ");
|
printf("%s", ((buf[i]>>31)&1)?"OpV":" ");
|
printf("%s", ((buf[i]>>30)&1)?"opA":" ");
|
printf("%s", ((buf[i]>>30)&1)?"opA":" ");
|
printf("%s", ((buf[i]>>29)&1)?"AlV":" ");
|
printf("%s", ((buf[i]>>29)&1)?"AlV":" ");
|
printf("%s", ((buf[i]>>28)&1)?"AlW":" ");
|
printf("%s", ((buf[i]>>28)&1)?"AlW":" ");
|
printf("%s", ((buf[i]>>27)&1)?"opM":" ");
|
printf("%s", ((buf[i]>>27)&1)?"opM":" ");
|
printf("%s", ((buf[i]>>26)&1)?"MmV":" ");
|
printf("%s", ((buf[i]>>26)&1)?"MmV":" ");
|
if (true) {
|
if (true) {
|
int op = (buf[i]>>22)&0x0f;
|
int op = (buf[i]>>22)&0x0f;
|
switch(op) {
|
switch(op) {
|
case 0: printf("CMP "); break;
|
case 0: printf("CMP "); break;
|
case 1: printf("TST "); break;
|
case 1: printf("TST "); break;
|
case 2: printf("MOV "); break;
|
case 2: printf("MOV "); break;
|
case 3: printf("LDI "); break;
|
case 3: printf("LDI "); break;
|
case 4: printf("AUX "); break;
|
case 4: printf("AUX "); break;
|
case 5: printf("ROL "); break;
|
case 5: printf("ROL "); break;
|
case 6: printf("LOD "); break;
|
case 6: printf("LOD "); break;
|
case 7: printf("STO "); break;
|
case 7: printf("STO "); break;
|
case 8: printf("SUB "); break;
|
case 8: printf("SUB "); break;
|
case 9: printf("AND "); break;
|
case 9: printf("AND "); break;
|
case 10: printf("ADD "); break;
|
case 10: printf("ADD "); break;
|
case 11: printf(" OR "); break;
|
case 11: printf(" OR "); break;
|
case 12: printf("XOR "); break;
|
case 12: printf("XOR "); break;
|
case 13: printf("LSL "); break;
|
case 13: printf("LSL "); break;
|
case 14: printf("ASR "); break;
|
case 14: printf("ASR "); break;
|
case 15: printf("LSR "); break;
|
case 15: printf("LSR "); break;
|
default: printf("ILL "); break;
|
default: printf("ILL "); break;
|
}
|
}
|
} else
|
} else
|
printf("%x", (buf[i]>>22)&0x0f);
|
printf("%x", (buf[i]>>22)&0x0f);
|
printf(" %s", ((buf[i]>>21)&1)?"W":" ");
|
printf(" %s", ((buf[i]>>21)&1)?"W":" ");
|
if ((buf[i]>>21)&1)
|
if ((buf[i]>>21)&1)
|
printf("[%X]", ((buf[i]>>17)&0x0f));
|
printf("[%X]", ((buf[i]>>17)&0x0f));
|
else
|
else
|
printf("(%x)", ((buf[i]>>17)&0x0f));
|
printf("(%x)", ((buf[i]>>17)&0x0f));
|
printf("D[%X]", ((buf[i]>>13)&0x0f));
|
printf("D[%X]", ((buf[i]>>13)&0x0f));
|
printf(" r_opA=..%02x", (buf[i]>>7)&0x3f);
|
printf(" r_opA=..%02x", (buf[i]>>7)&0x3f);
|
printf(" opA=..%02x", (buf[i]>>1)&0x3f);
|
printf(" opA=..%02x", (buf[i]>>1)&0x3f);
|
printf(" ALU=..%d", buf[i]&1);
|
printf(" ALU=..%d", buf[i]&1);
|
*/
|
*/
|
|
|
printf("\n");
|
printf("\n");
|
}
|
}
|
|
|
if (m_fpga->poll()) {
|
if (m_fpga->poll()) {
|
printf("FPGA was interrupted\n");
|
printf("FPGA was interrupted\n");
|
m_fpga->clear();
|
m_fpga->clear();
|
m_fpga->writeio(R_ICONTROL, SCOPEN);
|
m_fpga->writeio(R_ICONTROL, SCOPEN);
|
}
|
}
|
delete m_fpga;
|
delete m_fpga;
|
}
|
}
|
|
|
|
|