Subversion Repositories openarty

////////////////////////////////////////////////////////////////////////////////

//

// Filename:    eqspiscope.cpp

//

// Project:     XuLA2-LX25 SoC based upon the ZipCPU

//

// Purpose:     

//

// Creator:     Dan Gisselquist, Ph.D.

//              Gisselquist Technology, LLC

//

////////////////////////////////////////////////////////////////////////////////

//

// Copyright (C) 2015-2016, Gisselquist Technology, LLC

//

// This program is free software (firmware): 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 3 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 MERCHANTIBILITY 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.  (It's in the $(ROOT)/doc directory, run make with no

// target there if the PDF file isn't present.)  If not, see

// <http://www.gnu.org/licenses/> for a copy.

//

// License:     GPL, v3, as defined and found on www.gnu.org,

//              http://www.gnu.org/licenses/gpl.html

//

//

////////////////////////////////////////////////////////////////////////////////

//

//

#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 "port.h"

#include "regdefs.h"

#include "scopecls.h"

#define WBSCOPE         R_QSCOPE

#define WBSCOPEDATA     R_QSCOPED

FPGA    *m_fpga;

void    closeup(int v) {

        m_fpga->kill();

        exit(0);

}

class   EQSPISCOPE : public SCOPE {

        int     m_oword[2], m_iword[2], m_p;

public:

        EQSPISCOPE(FPGA *fpga, unsigned addr, bool vecread)

                : SCOPE(fpga, addr, false, false) {};

        ~EQSPISCOPE(void) {}

        virtual void    decode(DEVBUS::BUSW val) {

                int     cyc, cstb, dstb, ack, back, accepted, valid, word,

                        out, cs, sck, mod, odat, idat;

                cyc      = (val>>31)&1;

                cstb     = (val>>30)&1;

                dstb     = (val>>29)&1;

                ack      = (val>>28)&1;

                back     = (val>>27)&1;

                accepted = (val>>26)&1;

                valid    = (val>>25)&1;

                word     = (val>>18)&0x07f;

                out      = (val>>12)&0x03f;

                cs       = (val>>11)&1;

                sck      = (val>>10)&1;

                mod      = (val>> 8)&3;

                odat     = (val>> 4)&15;

                idat     = (val    )&15;

                m_p = (m_p^1)&1;

                if (mod&2) {

                        m_oword[m_p] = (m_oword[m_p]<<4)|odat;

                        m_iword[m_p] = (m_iword[m_p]<<4)|idat;

                } else {

                        m_oword[m_p] = (m_oword[m_p]<<1)|(odat&1);

                        m_iword[m_p] = (m_iword[m_p]<<1)|((idat&2)?1:0);

                }

                printf("%s%s%s%s%s%s%s %02x %02x %s%s %d %x.%d->  ->%x.%d",

                        (cyc)?"CYC ":"    ",

                        (cstb)?"CSTB":"    ",

                        (dstb)?"DSTB":"    ",

                        (ack)?"AK":"  ",

                        (back)?"+":" ",

                        (accepted)?"ACC":"   ",

                        (valid)?"V":" ",

                        word<<1, out<<2,

                        (cs)?"  ":"CS",

                        (sck)?"CK":"  ",

                        (mod), odat, (odat&1)?1:0, idat, (idat&2)?1:0);

                printf("  / %08x -> %08x", m_oword[m_p], m_iword[m_p]);

        }

};

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

        int     skp=0, port = FPGAPORT;

        bool    use_usb = false;

        skp=1;

        for(int argn=0; argn<argc-skp; argn++) {

                if (argv[argn+skp][0] == '-') {

                        if (argv[argn+skp][1] == 'u')

                                use_usb = true;

                        else if (argv[argn+skp][1] == 'p') {

                                use_usb = false;

                                if (isdigit(argv[argn+skp][2]))

                                        port = atoi(&argv[argn+skp][2]);

                        }

                        skp++; argn--;

                } else

                        argv[argn] = argv[argn+skp];

        } argc -= skp;

        FPGAOPEN(m_fpga);

        signal(SIGSTOP, closeup);

        signal(SIGHUP, closeup);

        EQSPISCOPE *scope = new EQSPISCOPE(m_fpga, WBSCOPE, false);

        if (!scope->ready()) {

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

                scope->decode_control();

        } else

                scope->read();

        delete  m_fpga;

}