Subversion Repositories xulalx25soc

////////////////////////////////////////////////////////////////////////////////
//
// Filename:	sdcardscop.cpp
//
// Project:	XuLA2 board
//
// Purpose:	To read out, and decompose, the results of the wishbone scope
//		as applied to the SD-Card interaction over the SPI port.
//
//
// Creator:	Dan Gisselquist, Ph.D.
//		Gisselquist Technology, LLC
//
////////////////////////////////////////////////////////////////////////////////
//
// Copyright (C) 2015, 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.
//
// 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 "llcomms.h"
#include "usbi.h"
#include "port.h"
#include "regdefs.h"
 
#define	WBSCOPE		R_CFGSCOPE
#define	WBSCOPEDATA	R_CFGSCOPED
 
FPGA	*m_fpga;
void	closeup(int v) {
	m_fpga->kill();
	exit(0);
}
 
void	decode(DEVBUS::BUSW val) {
	int	csn, sck, mosi, miso;
	int	iwi, iws, ird, idat, odat;
	int	grant;
	int	cmd, rsp;
 
	csn  = ((val>>24)>>3)&1;
	sck  = ((val>>24)>>2)&1;
	mosi = ((val>>24)>>1)&1;
	miso = ((val>>24)   )&1;
 
	iws = (val>>30)&1;
	iwi = (val>>29)&1;	// ll_idle
	ird =  (val>>28)&1;	// ll_out_stb
 
	idat = (val>>8)&0x0ff;
	odat = (val&0x0ff);
 
	cmd = (val>>21)&0x07;
	rsp = (val>>17)&0x07;
 
	grant=(val>>20)&1;
 
	printf("%sSPI[%d,%d,%d,%d] (%d,%d) %02x %s%s [LL] %s %02x",
		(grant)?"   ":"!G-",
		csn, sck, mosi, miso,
		cmd, rsp,
		idat,
		(iws)?"-":" ",
		(iwi)?">":" ",
		(ird)?"->":"  ", odat);
}
 
int main(int argc, char **argv) {
	int	skp=0, port = FPGAPORT;
	bool	use_usb = true;
 
	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;
 
	if (use_usb)
		m_fpga = new FPGA(new USBI());
	else
		m_fpga = new FPGA(new NETCOMMS(FPGAHOST, port));
 
	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];
 
	bool	compressed = false, vector_read = true;
	DEVBUS::BUSW	addrv = 0;
 
	if (vector_read) {
		m_fpga->readz(WBSCOPEDATA, scoplen, buf);
	} else {
		for(unsigned int i=0; i<scoplen; i++)
			buf[i] = m_fpga->readio(WBSCOPEDATA);
	}
 
	if(compressed) {
		for(int i=0; i<(int)scoplen; i++) {
			if ((buf[i]>>31)&1) {
				addrv += (buf[i]&0x7fffffff);
				printf(" ** \n");
				continue;
			}
			printf("%10d %08x: ", addrv++, buf[i]);
			decode(buf[i]);
			printf("\n");
		}
	} else {
		for(int i=0; i<(int)scoplen; i++) {
			if ((i>0)&&(buf[i] == buf[i-1])&&(i<(int)(scoplen-1))) {
				if ((i>2)&&(buf[i] != buf[i-2]))
					printf(" **** ****\n");
				continue;
			} printf("%9d %08x: ", i, buf[i]);
			decode(buf[i]);
			printf("\n");
		}
	}
 
	if (m_fpga->poll()) {
		printf("FPGA was interrupted\n");
		m_fpga->clear();
	}
 
	delete[] buf;
	delete	m_fpga;
}