Subversion Repositories xulalx25soc

////////////////////////////////////////////////////////////////////////////////
//
// Filename:	ttybus.cpp
//
// Project:	XuLA2 board
//
// Purpose:	This is the C++ program on the command side that will interact
//		with a UART on an FPGA, to command the WISHBONE on that same
//		FPGA to ... whatever we wish to command it to do.
//
//		This code does not run on an FPGA, is not a test bench, neither
//		is it a simulator.  It is a portion of a command program
//		for commanding an FPGA.
//
//
// 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 <sys/socket.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <termios.h>
#include <netinet/in.h>
#include <netdb.h>
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <unistd.h>
#include <errno.h>
#include <arpa/inet.h> 
#include <assert.h> 
#include <strings.h> 
#include <poll.h> 
#include <ctype.h> 
 
#include "ttybus.h"
 
#define	TTYC_IDLE	'0'
#define	TTYC_BUSY	'1'
#define	TTYC_WRITE	'2'
#define	TTYC_RESET	'3'
#define	TTYC_INT	'4'
#define	TTYC_ERR	'5'
 
const	unsigned TTYBUS::MAXRDLEN = 1024;
const	unsigned TTYBUS::MAXWRLEN = 32;
 
#define	DBGPRINTF	null
// #define	DBGPRINTF	printf
void	null(...) {}
 
char	TTYBUS::charenc(const int sixbitval) {
	if (sixbitval < 10)
		return '0' + sixbitval;
	else if (sixbitval < 10+26)
		return 'A' - 10 + sixbitval;
	else if (sixbitval < 10+26+26)
		return 'a' - 10 - 26 + sixbitval;
	else if (sixbitval == 0x3e)
		return '@';
	else if (sixbitval == 0x3f)
		return '%';
 
	fprintf(stderr, "INTERNAL ERR: SIXBITVAL isn\'t!!!! sixbitval = %08x\n", sixbitval);
	assert((sixbitval & (~0x03f))==0);
	return 0;
}
 
unsigned	TTYBUS::chardec(const char b) {
	if ((b >= '0')&&(b <= '9'))
		return b-'0';
	else if ((b >= 'A')&&(b <= 'Z'))
		return b-'A'+10;
	else if ((b >= 'a')&&(b <= 'z'))
		return b-'a'+36;
	else if (b == '@')
		return 0x03e;
	else if (b == '%')
		return 0x03f;
	else
		return 0x0100; // ERR -- invalid code
}
 
int	TTYBUS::lclreadcode(char *buf, int len) {
	char	*sp, *dp;
	int	nr, ret;
 
	nr = m_dev->read(buf, len);
	m_total_nread += nr;
	ret = nr; sp = buf; dp = buf;
	for(int i=0; i<nr; i++) {
		if (chardec(*sp)&(~0x3f)) {
			ret--;	// Skip this value, not a valid codeword
			sp++;
		} else {
			*sp++ = *dp++;
		}
	} return ret;
}
 
void	TTYBUS::bufalloc(int len) {
	if ((m_buf)&&(m_buflen >= len))
		return;
	if (m_buf)
		delete[] m_buf;
	m_buflen = (len&(-0x3f))+0x40;
	m_buf = new char[m_buflen];
}
 
void	TTYBUS::encode(const int hb, const BUSW val, char *buf) {
	buf[0] = charenc( (hb<<2)|((val>>30)&0x03) );
	buf[1] = charenc( (val>>24)&0x3f);
	buf[2] = charenc( (val>>18)&0x3f);
	buf[3] = charenc( (val>>12)&0x3f);
	buf[4] = charenc( (val>> 6)&0x3f);
	buf[5] = charenc( (val    )&0x3f);
}
 
unsigned	TTYBUS::decodestr(const char *buf) {
	unsigned	r;
 
	r = chardec(buf[0]) & 0x03;
	r = (r<<6) | (chardec(buf[1]) & 0x03f);
	r = (r<<6) | (chardec(buf[2]) & 0x03f);
	r = (r<<6) | (chardec(buf[3]) & 0x03f);
	r = (r<<6) | (chardec(buf[4]) & 0x03f);
	r = (r<<6) | (chardec(buf[5]) & 0x03f);
 
	return r;
}
 
int	TTYBUS::decodehex(const char hx) {
	if ((hx >= '0')&&(hx <= '9'))
		return hx-'0';
	else if ((hx >= 'A')&&(hx <= 'Z'))
		return hx-'A'+10;
	else if ((hx >= 'a')&&(hx <= 'z'))
		return hx-'a'+10;
	else
		return 0;
}
 
void	TTYBUS::writeio(const BUSW a, const BUSW v) {
 
	writev(a, 0, 1, &v);
	m_lastaddr = a; m_addr_set = true;
}
 
void	TTYBUS::writev(const BUSW a, const int p, const int len, const BUSW *buf) {
	char	*ptr;
 
	// Allocate a buffer of six bytes per word, one for addr, plus
	// six more
	bufalloc((len+2)*6);
 
	DBGPRINTF("WRITEV(%08x,%d,#%d,0x%08x ...)\n", a, p, len, buf[0]);
	// Encode the address
	ptr = encode_address(a);
	m_lastaddr = a; m_addr_set = true;
 
	for(int i=0; i<len; i++) {
		BUSW	val = buf[i];
 
		int	caddr = 0;
		// Let's try compression
		for(int i=1; i<256; i++) {
			unsigned	tstaddr;
			tstaddr = (m_wraddr - i) & 0x0ff;
			if ((!m_wrloaded)&&(tstaddr > (unsigned)m_wraddr))
				break;
			if (m_writetbl[tstaddr] == val) {
				caddr = ( m_wraddr- tstaddr ) & 0x0ff;
				break;
			}
		}
 
		if (caddr != 0)
			DBGPRINTF("WR[%08x] = %08x (= TBL[%4x] <= %4x)\n", m_lastaddr, val, caddr, m_wraddr);
		else
			DBGPRINTF("WR[%08x] = %08x\n", m_lastaddr, val);
 
		if (caddr != 0) {
			*ptr++ = charenc( (((caddr>>6)&0x03)<<1) + (p?1:0) + 0x010);
			*ptr++ = charenc(    caddr    &0x3f    );
 
		} else {
			// For testing, let's start just doing this the hard way
			*ptr++ = charenc( (((val>>30)&0x03)<<1) + (p?1:0) + 0x018);
			*ptr++ = charenc( (val>>24)&0x3f);
			*ptr++ = charenc( (val>>18)&0x3f);
			*ptr++ = charenc( (val>>12)&0x3f);
			*ptr++ = charenc( (val>> 6)&0x3f);
			*ptr++ = charenc( (val    )&0x3f);
 
			m_writetbl[m_wraddr++] = val;
			m_wraddr &= 0x0ff;
			if (m_wraddr == 0) {
				m_wrloaded = true;
			}
		}
 
		if (p == 1) m_lastaddr++;
	}
	// *ptr++ = charenc(0x2e);
	*ptr++ = '\n'; *ptr = '\0';
	m_dev->write(m_buf, ptr-m_buf);
 
	DBGPRINTF(">> %s\n", m_buf);
	DBGPRINTF("WR: LAST ADDRESS LEFT AT %08x\n", m_lastaddr);
}
 
void	TTYBUS::writez(const BUSW a, const int len, const BUSW *buf) {
	int	ln = len;
	const TTYBUS::BUSW *bptr = buf;
	TTYBUS::BUSW addr = a;
 
	while((unsigned)ln > MAXWRLEN) {
		writev(addr, 0, MAXWRLEN, bptr);
		bptr += MAXWRLEN;
		ln   -= MAXWRLEN;
		// addr += MAXWRLEN;
	} if ((unsigned)ln > 0)
		writev(addr, 0, ln, bptr);
}
 
void	TTYBUS::writei(const BUSW a, const int len, const BUSW *buf) {
	int	ln = len;
	const TTYBUS::BUSW *bptr = buf;
	TTYBUS::BUSW addr = a;
 
	while((unsigned)ln > MAXWRLEN) {
		writev(addr, 1, MAXWRLEN, bptr);
		bptr += MAXWRLEN;
		ln   -= MAXWRLEN;
		addr += MAXWRLEN;
	} if ((unsigned)ln > 0)
		writev(addr, 1, ln, bptr);
}
 
TTYBUS::BUSW	TTYBUS::readio(const TTYBUS::BUSW a) {
	BUSW	v;
 
	// I/O reads are now the same as vector reads, but with a vector length
	// of one.
	try {
		readv(a, 0, 1, &v);
	} catch(BUSERR b) {
		throw BUSERR(a);
	}
 
	if (m_lastaddr != a) {
		DBGPRINTF("LAST-ADDR MIS-MATCH: (RCVD) %08x != %08x (XPECTED)\n", m_lastaddr, a);
		m_addr_set = false;
 
		exit(-3);
	}
 
	return v;
}
 
char	*TTYBUS::encode_address(const TTYBUS::BUSW a) {
	TTYBUS::BUSW	addr = a;
	char	*ptr = m_buf;
 
	if ((m_addr_set)&&(a == m_lastaddr))
		return ptr;
 
	if (m_addr_set) {
		// Encode a difference address
		int	diffaddr = addr - m_lastaddr;
		ptr = m_buf;
		if ((diffaddr >= -32)&&(diffaddr < 32)) {
			*ptr++ = charenc(0x09);
			*ptr++ = charenc(diffaddr & 0x03f);
		} else if ((diffaddr >= -2048)&&(diffaddr < 2048)) {
			*ptr++ = charenc(0x0b);
			*ptr++ = charenc((diffaddr>>6) & 0x03f);
			*ptr++ = charenc( diffaddr     & 0x03f);
		} else if ((diffaddr >= -(1<<17))&&(diffaddr < (1<<17))) {
			*ptr++ = charenc(0x0d);
			*ptr++ = charenc((diffaddr>>12) & 0x03f);
			*ptr++ = charenc((diffaddr>> 6) & 0x03f);
			*ptr++ = charenc( diffaddr      & 0x03f);
		} else if ((diffaddr >= -(1<<23))&&(diffaddr < (1<<23))) {
			*ptr++ = charenc(0x0d);
			*ptr++ = charenc((diffaddr>>18) & 0x03f);
			*ptr++ = charenc((diffaddr>>12) & 0x03f);
			*ptr++ = charenc((diffaddr>> 6) & 0x03f);
			*ptr++ = charenc( diffaddr      & 0x03f);
		}
		*ptr = '\0';
		// DBGPRINTF("DIF-ADDR: (%ld) \'%s\'\n", ptr-m_buf, m_buf);
	}
 
	{
		// Encode an absolute (low memory) address
		// Prefer absolute address encoding over differential encoding,
		// when both encodings encode the same address, and when both
		// encode the address in the same number of words
		if ((addr <= 0x03f)&&((ptr == m_buf)||(ptr >= &m_buf[2]))) {
			ptr = m_buf;
			*ptr++ = charenc(0x08);
			*ptr++ = charenc(addr);
		} else if((addr <= 0x0fff)&&((ptr == m_buf)||(ptr >= &m_buf[3]))) {
			// DBGPRINTF("Setting ADDR.3 to %08x\n", addr);
			ptr = m_buf;
			*ptr++ = charenc(0x0a);
			*ptr++ = charenc((addr>> 6) & 0x03f);
			*ptr++ = charenc( addr      & 0x03f);
		} else if((addr <= 0x03ffff)&&((ptr == m_buf)||(ptr >= &m_buf[4]))) {
			// DBGPRINTF("Setting ADDR.4 to %08x\n", addr);
			ptr = m_buf;
			*ptr++ = charenc(0x0c);
			*ptr++ = charenc((addr>>12) & 0x03f);
			*ptr++ = charenc((addr>> 6) & 0x03f);
			*ptr++ = charenc( addr      & 0x03f);
		} else if((addr <= 0x0ffffff)&&((ptr == m_buf)||(ptr >= &m_buf[5]))) {
			// DBGPRINTF("Setting ADDR.5 to %08x\n", addr);
			ptr = m_buf;
			*ptr++ = charenc(0x0e);
			*ptr++ = charenc((addr>>18) & 0x03f);
			*ptr++ = charenc((addr>>12) & 0x03f);
			*ptr++ = charenc((addr>> 6) & 0x03f);
			*ptr++ = charenc( addr      & 0x03f);
		} else if (ptr == m_buf) { // Send our address prior to any read
			ptr = m_buf;
			encode(0, addr, ptr);
			ptr+=6;
		}
	}
 
	*ptr = '\0';
	// DBGPRINTF("ADDR-CMD: (%ld) \'%s\'\n", ptr-m_buf, m_buf);
	m_rdaddr = 0;
 
	return ptr;
}
 
char	*TTYBUS::readcmd(const int inc, const int len, char *buf) {
	char	*ptr = buf;
 
	// DBGPRINTF("READCMD: LEN = %d\n", len);
	assert(len < 520);
	assert(len > 0);
 
	if ((len < 8)||((len == 8)&&(inc))) {
		*ptr++ = charenc(0x20 + (((len-1)&0x07)<<1) + (inc?1:0));
	} else {
		*ptr++ = charenc(0x30 + (((len-8)>>5)&0x0e) + (inc?1:0));
		*ptr++ = charenc( (len-8) & 0x03f);
	}
 
	return ptr;
}
 
void	TTYBUS::readv(const TTYBUS::BUSW a, const int inc, const int len, TTYBUS::BUSW *buf) {
	const	int	READAHEAD = MAXRDLEN/2, READBLOCK=MAXRDLEN/2;
	int	cmdrd = 0, nread = 0;
	// TTYBUS::BUSW	addr = a;
	char	*ptr = m_buf;
 
	if (len <= 0)
		return;
	// DBGPRINTF("READV(%08x,%d,#%4d)\n", a, inc, len);
 
	ptr = encode_address(a);
	try {
	    while(cmdrd < len) {
		// ptr = m_buf;
		do {
			int	nrd = len-cmdrd;
			if (nrd > READBLOCK)
				nrd = READBLOCK;
			if (cmdrd-nread + nrd>READAHEAD+READBLOCK)
				nrd = READAHEAD+READBLOCK-(cmdrd-nread);
			ptr = readcmd(inc, nrd, ptr);
			cmdrd += nrd;
		} while((cmdrd-nread < READAHEAD+READBLOCK)&&(cmdrd< len));
 
		*ptr++ = '\n'; *ptr = '\0';
		m_dev->write(m_buf, (ptr-m_buf));
 
		while(nread<(cmdrd-READAHEAD)) {
			buf[nread++] = readword();
		} ptr = m_buf;
	    } while(nread<len) {
		buf[nread++] = readword();
	    }
	} catch(BUSERR b) {
		throw BUSERR(a+((inc)?nread:0));
	}
 
	if ((unsigned)m_lastaddr != (a+((inc)?(len):0))) {
		printf("TTYBUS::READV(a=%08x,inc=%d,len=%4x,x) ERR: (Last) %08x != %08x + %08x (Expected)\n", a, inc, len, m_lastaddr, a, (inc)?(len):0);
		sleep(1);
		assert((int)m_lastaddr == (a+(inc)?(len):0));
		exit(-3);
	}
}
 
void	TTYBUS::readi(const TTYBUS::BUSW a, const int len, TTYBUS::BUSW *buf) {
	readv(a, 1, len, buf);
}
 
void	TTYBUS::readz(const TTYBUS::BUSW a, const int len, TTYBUS::BUSW *buf) {
	readv(a, 0, len, buf);
}
 
TTYBUS::BUSW	TTYBUS::readword(void) {
	TTYBUS::BUSW	val = 0;
	int		nr;
	unsigned	sixbits;
 
	// DBGPRINTF("READ-WORD()\n");
 
	bool	found_start = false;
	do {
		// Blocking read (for now)
		do {
			nr = lclreadcode(&m_buf[0], 1);
		} while (nr < 1);
 
		sixbits = chardec(m_buf[0]);
 
		if (sixbits&(~0x03f)) {
			// Ignore new lines, unprintables, and characters
			// not a part of our code
			;
		} else if (sixbits < 6) {
			switch(sixbits) {
			case 0:	break; // Idle -- ignore
			case 1: break; // Idle, but the bus is busy
			case 2: break; // Write acknowledgement, ignore it here
			case 3:
				m_bus_err = true;
				throw BUSERR(0);
				break;
			case 4:
				m_interrupt_flag = true;
				break;
			case 5:
				m_bus_err = true;
				throw BUSERR(0);
				break;
			}
		} else if (0x08 == (sixbits & 0x3c)) { // Set 32-bit address
			do {
				nr += lclreadcode(&m_buf[nr], 6-nr);
			} while (nr < 6);
 
			val = chardec(m_buf[0]) & 0x03;
			val = (val<<6) | (chardec(m_buf[1]) & 0x03f);
			val = (val<<6) | (chardec(m_buf[2]) & 0x03f);
			val = (val<<6) | (chardec(m_buf[3]) & 0x03f);
			val = (val<<6) | (chardec(m_buf[4]) & 0x03f);
			val = (val<<6) | (chardec(m_buf[5]) & 0x03f);
 
			m_addr_set = true;
			m_lastaddr = val;
 
			// DBGPRINTF("RCVD ADDR: 0x%08x\n", val);
		} else if (0x0c == (sixbits & 0x03c)) { // Set 32-bit address,compressed
			int nw = (sixbits & 0x03) + 2;
			do {
				nr += lclreadcode(&m_buf[nr], nw-nr);
			} while (nr < nw);
 
			if (nw == 2) {
				val = chardec(m_buf[1]);
			} else if (nw == 3) {
				val = chardec(m_buf[1]);
				val = (val<<6) | (chardec(m_buf[2]) & 0x03f);
			} else if (nw == 4) {
				val = chardec(m_buf[1]);
				val = (val<<6) | (chardec(m_buf[2]) & 0x03f);
				val = (val<<6) | (chardec(m_buf[3]) & 0x03f);
			} else { // if (nw == 5)
				val = chardec(m_buf[1]);
				val = (val<<6) | (chardec(m_buf[2]) & 0x03f);
				val = (val<<6) | (chardec(m_buf[3]) & 0x03f);
				val = (val<<6) | (chardec(m_buf[4]) & 0x03f);
			}
 
			m_addr_set = true;
			m_lastaddr = val;
			// DBGPRINTF("RCVD ADDR: 0x%08x (%d bytes)\n", val, nw+1);
		} else
			found_start = true;
	} while(!found_start);
 
	int	rdaddr;
 
	if (0x06 == (sixbits & 0x03e)) { // Tbl read, last value
		rdaddr = (m_rdaddr-1)&0x03ff;
		val = m_readtbl[rdaddr];
		m_lastaddr += (sixbits&1);
	} else if (0x10 == (sixbits & 0x030)) { // Tbl read, up to 521 into past
		int	idx;
		do {
			nr += lclreadcode(&m_buf[nr], 2-nr);
		} while (nr < 2);
 
		idx = (chardec(m_buf[0])>>1) & 0x07;
		idx = ((idx<<6) | (chardec(m_buf[1]) & 0x03f)) + 2 + 8;
		rdaddr = (m_rdaddr-idx)&0x03ff;
		val = m_readtbl[rdaddr];
		m_lastaddr += (sixbits&1);
	} else if (0x20 == (sixbits & 0x030)) { // Tbl read, 2-9 into past
		rdaddr = (m_rdaddr - (((sixbits>>1)&0x07)+2)) & 0x03ff;
		val = m_readtbl[rdaddr];
		m_lastaddr += (sixbits&1);
	} else if (0x38 == (sixbits & 0x038)) { // Raw read
		do {
			nr += lclreadcode(&m_buf[nr], 6-nr);
		} while (nr < 6);
 
		val = (chardec(m_buf[0])>>1) & 0x03;
		val = (val<<6) | (chardec(m_buf[1]) & 0x03f);
		val = (val<<6) | (chardec(m_buf[2]) & 0x03f);
		val = (val<<6) | (chardec(m_buf[3]) & 0x03f);
		val = (val<<6) | (chardec(m_buf[4]) & 0x03f);
		val = (val<<6) | (chardec(m_buf[5]) & 0x03f);
 
		m_readtbl[m_rdaddr++] = val; m_rdaddr &= 0x03ff;
		m_lastaddr += (sixbits&1);
	}
 
	return val;
}
 
void	TTYBUS::usleep(unsigned ms) {
	if (m_dev->poll(ms)) {
		int	nr;
		nr = m_dev->read(m_buf, 16);
		if (nr == 0) {
			// Connection closed, let it drop
			DBGPRINTF("Connection closed!!\n");
			m_dev->close();
			exit(-1);
		} for(int i=0; i<nr; i++) {
			if (m_buf[i] == TTYC_INT) {
				m_interrupt_flag = true;
				// DBGPRINTF("!!!!!!!!!!!!!!!!! ----- INTERRUPT!\n");
			} else if (m_buf[i] == TTYC_IDLE) {
				// DBGPRINTF("Interface is now idle\n");
			} else if (m_buf[i] == TTYC_WRITE) {
			} else if (m_buf[i] == TTYC_RESET) {
				// DBGPRINTF("Bus was RESET!\n");
			} else if (m_buf[i] == TTYC_ERR) {
				DBGPRINTF("Bus error\n");
			} else if (m_buf[i] == TTYC_BUSY) {
				// DBGPRINTF("Interface is ... busy ??\n");
			}
			// else if (m_buf[nr] == 'Q')
			// else if (m_buf[nr] == 'W')
			// else if (m_buf[nr] == '\n')
		}
	}
}
 
void	TTYBUS::wait(void) {
	if (m_interrupt_flag)
		DBGPRINTF("INTERRUPTED PRIOR TO WAIT()\n");
	do {
		usleep(200);
	} while(!m_interrupt_flag);
}
 
// TTYBUS:  3503421 ~= 3.3 MB, stopwatch = 1:18.5 seconds, vs 53.8 secs
//	If you issue two 512 word reads at once, time drops to 41.6 secs.
// PORTBUS: 6408320 ~= 6.1 MB, ... 26% improvement, 53 seconds real time