Subversion Repositories xulalx25soc

//

//

// Filename:    cpuscope.cpp

//

// Project:     FPGA library development (Basys-3 development board)

//

// Purpose:     To read out, and decompose, the results of the wishbone scope

//              as applied to the ICAPE2 interaction.

//

// Creator:     Dan Gisselquist

//              Gisselquist Tecnology, LLC

//

// Copyright:   2015

//

//

#include <stdio.h>

#include <stdlib.h>

#include <unistd.h>

#include <strings.h>

#include <ctype.h>

#include <string.h>

#include <signal.h>

#include <assert.h>

#include "usbi.h"

#include "port.h"

#include "llcomms.h"

#include "regdefs.h"

#define WBSCOPE         R_CPUSCOPE

#define WBSCOPEDATA     R_CPUSCOPED

#include "zopcodes.h"

FPGA    *m_fpga;

void    closeup(int v) {

        m_fpga->kill();

        exit(0);

}

unsigned brev(const unsigned v) {

        unsigned int r, a;

        a = v;

        r = 0;

        for(int i=0; i<8; i++) {

                r <<= 1;

                r |= (a&1);

                a >>= 1;

        } return r;

}

unsigned wrev(const unsigned v) {

        unsigned r = brev(v&0x0ff);

        r |= brev((v>>8)&0x0ff)<<8;

        return r;

}

int main(int argc, char **argv) {

        FPGAOPEN(m_fpga);

        signal(SIGSTOP, closeup);

        signal(SIGHUP, closeup);

        unsigned        v, lgln, scoplen;

        v = m_fpga->readio(WBSCOPE);

        if (0x60000000 != (v & 0x60000000)) {

                printf("Scope is not yet ready:\n");

                printf("\tRESET:\t\t%s\n", (v&0x80000000)?"Ongoing":"Complete");

                printf("\tSTOPPED:\t%s\n", (v&0x40000000)?"Yes":"No");

                printf("\tTRIGGERED:\t%s\n", (v&0x20000000)?"Yes":"No");

                printf("\tPRIMED:\t\t%s\n", (v&0x10000000)?"Yes":"No");

                printf("\tMANUAL:\t\t%s\n", (v&0x08000000)?"Yes":"No");

                printf("\tDISABLED:\t%s\n", (v&0x04000000)?"Yes":"No");

                printf("\tZERO:\t\t%s\n", (v&0x02000000)?"Yes":"No");

                exit(0);

        } else printf("SCOPD = %08x\n", v);

        lgln = (v>>20) & 0x1f;

        scoplen = (1<<lgln);

        DEVBUS::BUSW    *buf;

        buf = new DEVBUS::BUSW[scoplen];

        if (false) {

                m_fpga->readz(WBSCOPEDATA, scoplen, buf);

        } else {

                for(unsigned int i=0; i<scoplen; i++)

                        buf[i] = m_fpga->readio(WBSCOPEDATA);

        }

        for(unsigned int i=0; i<scoplen; i++) {

                char    sbuf[64];

                if ((i>0)&&(buf[i] == buf[i-1])&&

                                (i<scoplen-1)&&(buf[i] == buf[i+1]))

                        continue;

                printf("%6d %08x:", i, buf[i]);

                unsigned addr = (buf[i]>>24)&0x0ff;

                zipi_to_string(m_fpga->readio(0x02000+addr),sbuf);

                printf(" %2x %-24s", (buf[i]>>24)&0x0ff, sbuf);

                printf(" %s%s%s%s%s %s%s%s",

                        ((buf[i]>>23)&1)?"P":" ",

                        ((buf[i]>>22)&1)?"D":" ",

                        ((buf[i]>>21)&1)?"O":" ",

                        ((buf[i]>>20)&1)?"A":" ",

                        ((buf[i]>>19)&1)?"M":" ",

                        ((buf[i]>>18)&1)?"o":" ",

                        ((buf[i]>>17)&1)?"a":" ",

                        ((buf[i]>>16)&1)?"m":" ");

                printf(" A=%02x ", (buf[i]>>8)&0x0ff);

                printf(" %s%02x ",

                        (((buf[i]>>16)&3)!=0)?"W->":"(w)",

                        (buf[i]&0x0ff));

                /*

                printf("%s", ((buf[i]>>31)&1)?"OpV":"   ");

                printf("%s", ((buf[i]>>30)&1)?"opA":"   ");

                printf("%s", ((buf[i]>>29)&1)?"AlV":"   ");

                printf("%s", ((buf[i]>>28)&1)?"AlW":"   ");

                printf("%s", ((buf[i]>>27)&1)?"opM":"   ");

                printf("%s", ((buf[i]>>26)&1)?"MmV":"   ");

                if (true) {

                        int     op = (buf[i]>>22)&0x0f;

                        switch(op) {

                        case  0: printf("CMP "); break;

                        case  1: printf("TST "); break;

                        case  2: printf("MOV "); break;

                        case  3: printf("LDI "); break;

                        case  4: printf("AUX "); break;

                        case  5: printf("ROL "); break;

                        case  6: printf("LOD "); break;

                        case  7: printf("STO "); break;

                        case  8: printf("SUB "); break;

                        case  9: printf("AND "); break;

                        case 10: printf("ADD "); break;

                        case 11: printf(" OR "); break;

                        case 12: printf("XOR "); break;

                        case 13: printf("LSL "); break;

                        case 14: printf("ASR "); break;

                        case 15: printf("LSR "); break;

                        default: printf("ILL "); break;

                        }

                } else

                        printf("%x", (buf[i]>>22)&0x0f);

                printf(" %s", ((buf[i]>>21)&1)?"W":" ");

                if ((buf[i]>>21)&1)

                        printf("[%X]", ((buf[i]>>17)&0x0f));

                else

                        printf("(%x)", ((buf[i]>>17)&0x0f));

                printf("D[%X]", ((buf[i]>>13)&0x0f));

                printf(" r_opA=..%02x", (buf[i]>>7)&0x3f);

                printf(" opA=..%02x", (buf[i]>>1)&0x3f);

                printf(" ALU=..%d", buf[i]&1);

                */

                printf("\n");

        }

        if (m_fpga->poll()) {

                printf("FPGA was interrupted\n");

                m_fpga->clear();

                m_fpga->writeio(R_ICONTROL, SCOPEN);

        }

        delete  m_fpga;

}