Subversion Repositories openarty

////////////////////////////////////////////////////////////////////////////////
//
// Filename: 	cpuscope.cpp
//
// Project:	OpenArty, an entirely open SoC based upon the Arty platform
//
// Purpose:	To read out, and decompose, the results of the wishbone scope
//		as applied to the ZipCPU internal operation.
//
// 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 "llcomms.h"
#include "regdefs.h"
#include "scopecls.h"
 
#define	WBSCOPE		R_CPUSCOPE
#define	WBSCOPEDATA	R_CPUSCOPED
 
#include "zopcodes.h"
 
FPGA	*m_fpga;
void	closeup(int v) {
	m_fpga->kill();
	exit(0);
}
 
const char *regstr[] = {
	"R0","R1","R2","R3","R4","R5","R6","R7","R8","R9","RA","RB","RC",
	"SP","CC","PC"
};
 
class	CPUSCOPE : public SCOPE {
public:
	CPUSCOPE(FPGA *fpga, unsigned addr, bool vecread)
		: SCOPE(fpga, addr, false, vecread) {};
	~CPUSCOPE(void) {}
	virtual	void	decode(DEVBUS::BUSW val) const {
		if (val & 0x80000000)
			printf("TRIG ");
		else
			printf("     ");
		if (true) {
		if ((val & 0x40000000)==0) {
			printf("%s <- 0x.%07x", regstr[(val>>(32-6))&0xf], val&0x03ffffff);
		} else if ((val & 0x60000000)==0x60000000) {
			uint32_t addr = val & 0x7ffffff;
			if (val&0x08000000)
				printf("MEM-W[0x........] <- 0x.%07x %s",
					addr,
					(val&0x10000000)?"(GBL)":"");
			else
				printf("MEM-R[0x.%07x] -> (Not Givn) %s",
					(addr<<2)&0x0ffffffc,
					(val&0x10000000)?"(GBL)":"");
		} else if ((val & 0x70000000)==0x40000000) {
			val &= 0x0fffffff;
			val <<= 2;
			printf("JMP 0x%08x", (val&0x0fffffff));
		} else {
			int	master, halt, brk, sleep, buserr, trap,
				ill, clri, pfv, pfi, dcdce, dcdv, dcdstall,
				opce, opvalid, oppipe, aluce, alubsy, aluwr,
				memce, memwe, membsy;
			// int	gie, aluill, aluwrf;
			master = (val>>27)&1;
			halt   = (val>>26)&1;
			brk    = (val>>25)&1;
			sleep  = (val>>24)&1;
			// gie    = (val>>23)&1;
			buserr = (val>>22)&1;
			trap   = (val>>21)&1;
			ill    = (val>>20)&1;
			clri   = (val>>19)&1;
			pfv    = (val>>18)&1;
			pfi    = (val>>17)&1;
			dcdce  = (val>>16)&1;
			dcdv   = (val>>15)&1;
			dcdstall=(val>>14)&1;
			opce   = (val>>13)&1;
			opvalid= (val>>12)&1;
			oppipe = (val>>11)&1;
			aluce  = (val>>10)&1;
			alubsy = (val>> 9)&1;
			aluwr  = (val>> 8)&1;
			// aluill = (val>> 7)&1;
			// aluwrf = (val>> 6)&1;
			memce  = (val>> 5)&1;
			memwe  = (val>> 4)&1;
			membsy = (val>> 3)&1;
			printf("FLAGS %08x", val);
			printf(" CE[%c%c%c%c]",
				(dcdce)?'D':' ',
				(opce)?'O':' ',
				(aluce)?'A':' ',
				(memce)?'M':' ');
			printf(" V[%c%c%c%c]",
				(pfv)?'P':' ',
				(dcdv)?'D':' ',
				(opvalid)?'O':' ',
				(aluwr)?'A':' ');
			if (master) printf(" MCE");
			if (halt)   printf(" I-HALT");
			if (brk)    printf(" O-BREAK");
			if (sleep)  printf(" SLP");
			if (GIE)    printf(" GIE");
			if (buserr) printf(" BE");
			if (trap)   printf(" TRAP");
			if (ill)    printf(" ILL");
			if (clri)   printf(" CLR-I");
			if (pfi)    printf(" PF-ILL");
			if (dcdstall)printf(" DCD-STALL");
			if (oppipe) printf(" OP-PIPE");
			if (alubsy) printf(" ALU-BUSY");
			if (memwe)  printf(" MEM-WE");
			if (membsy) printf(" MEM-BUSY");
			//
		}}
 
		if (false) {
			// CPU internal bus_debug
			int	mce, mwe, mbsy, mpip,
				gcyc, gstb, lcyc, lstb, we, ack, stall, err,
				pcyc, pstb, pack, pstall, perr,
				mcycg, mstbg, mcycl, mstbl, mack, mstall, merr;
 
			mce    = (val>>24)&1;
			//
			mbsy   = (val>>22)&1;
			mpip   = (val>>21)&1;
			gcyc   = (val>>20)&1;
			gstb   = (val>>19)&1;
			lcyc   = (val>>18)&1;
			lstb   = (val>>17)&1;
			we     = (val>>16)&1;
			ack    = (val>>15)&1;
			stall  = (val>>14)&1;
			err    = (val>>13)&1;
			pcyc   = (val>>12)&1;
			pstb   = (val>>11)&1;
			pack   = (val>>10)&1;
			pstall = (val>> 9)&1;
			perr   = (val>> 8)&1;
			mcycg  = (val>> 7)&1;
			mstbg  = (val>> 6)&1;
			mcycl  = (val>> 5)&1;
			mstbl  = (val>> 4)&1;
			mwe    = (val>> 3)&1;
			mack   = (val>> 2)&1;
			mstall = (val>> 1)&1;
			merr   = (val&1);
 
			printf("P[%s%s%s%s%s]",
				(pcyc)?"C":" ",
				(pstb)?"S":" ",
				(pack)?"A":" ",
				(pstall)?"S":" ",
				(perr)?"E":" ");
 
			printf("M[(%s%s)(%s%s)%s%s%s%s]",
				(mcycg)?"C":" ", (mstbg)?"S":" ",
				(mcycl)?"C":" ", (mstbl)?"S":" ",
				(mwe)?"W":"R", (mack)?"A":" ",
				(mstall)?"S":" ",
				(merr)?"E":" ");
 
			printf("O[(%s%s)(%s%s)%s%s%s%s]",
				(gcyc)?"C":" ", (gstb)?"S":" ",
				(lcyc)?"C":" ", (lstb)?"S":" ",
				(we)?"W":"R", (ack)?"A":" ",
				(stall)?"S":" ",
				(err)?"E":" ");
 
			if (mbsy) printf("M-BUSY ");
			if (mpip) printf("M-PIPE ");
			if (mce)  printf("M-CE ");
		}
	}
};
 
int main(int argc, char **argv) {
	FPGAOPEN(m_fpga);
 
	signal(SIGSTOP, closeup);
	signal(SIGHUP, closeup);
 
	CPUSCOPE *scope = new CPUSCOPE(m_fpga, WBSCOPE, true);
	if (!scope->ready()) {
		printf("Scope is not yet ready:\n");
		scope->decode_control();
		scope->decode(WBSCOPEDATA);
		printf("\n");
	} else {
		printf("Scope is ready\n");
		scope->read();
	}
	delete	m_fpga;
}