From 7a3f0998a0ce7470d70c1a13bc4646abafdcc236 Mon Sep 17 00:00:00 2001
From: aiju <aiju@phicode.de>
Date: Wed, 24 Dec 2014 10:21:51 +0100
Subject: added zynq kernel

---
 sys/src/9/zynq/devqspi.c | 275 +++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 275 insertions(+)
 create mode 100644 sys/src/9/zynq/devqspi.c

(limited to 'sys/src/9/zynq/devqspi.c')

diff --git a/sys/src/9/zynq/devqspi.c b/sys/src/9/zynq/devqspi.c
new file mode 100644
index 000000000..8c920d0f7
--- /dev/null
+++ b/sys/src/9/zynq/devqspi.c
@@ -0,0 +1,275 @@
+#include "u.h"
+#include "../port/lib.h"
+#include "mem.h"
+#include "dat.h"
+#include "fns.h"
+#include "io.h"
+#include "ureg.h"
+#include "../port/error.h"
+
+enum {
+	QSPIDIV = 1,
+	QSPISIZ = 1<<24,
+};
+
+enum {
+	CONF,
+	INTSTAT,
+	INTEN,
+	INTDIS,
+	INTMASK,
+	SPIEN,
+	DELAY,
+	TXD0,
+	RXD,
+	IDLE,
+	TXTHRES,
+	RXTHRES,
+	TXD1 = 0x80/4,
+	TXD2,
+	TXD3,
+	LQSPICFG = 0xA0/4,
+};
+
+enum {
+	TXFULL = 1<<3,
+	TXNFULL = 1<<2,
+	RXNEMPTY = 1<<4,
+	STARTCOM = 1<<16,
+};
+
+enum {
+	Qdir = 0,
+	Qboot,
+	Qbase,
+
+	Qmax = 16,
+};
+
+static ulong *qspi;
+static QLock qspil;
+
+static Dirtab qspidir[Qmax] = {
+	".",		{ Qdir, 0, QTDIR },	0,	0555,
+	"boot",		{ Qboot, 0},		65536,	0640,
+};
+static int nqspidir = Qbase;
+
+static ulong
+qspicmd(int n, ulong d)
+{
+	while((qspi[INTSTAT] & TXNFULL) == 0)
+		;
+	if(n == 4)
+		qspi[TXD0] = d;
+	else
+		qspi[TXD1 - 1 + n] = d;
+	qspi[CONF] |= STARTCOM;
+	while((qspi[INTSTAT] & (TXNFULL|RXNEMPTY)) != (TXNFULL|RXNEMPTY))
+		;
+	return qspi[RXD];
+}
+
+static void
+qspiinit(void)
+{
+	static int done;
+	
+	if(done)
+		return;
+	qspi = vmap(QSPI_BASE, 0x100);
+	qspi[LQSPICFG] &= ~(1<<31);
+	qspi[CONF] = 1<<31 | 1<<19 | 1<<15 | 1<<14 | 1<<10 | 3<<6 | QSPIDIV<<3 | 1;
+	qspi[SPIEN] = 1;	
+}
+
+static void
+qspisel(int sel)
+{
+	if(sel)
+		qspi[CONF] &= ~(1<<10);
+	else
+		qspi[CONF] |= 1<<10;
+}
+
+static void
+waitbusy(void)
+{
+	ulong d;
+
+	for(;;){
+		qspisel(1);
+		d = qspicmd(2, 0x05);
+		qspisel(0);
+		if((d & 1<<24) == 0)
+			break;
+		tsleep(&up->sleep, return0, nil, 1);
+	}
+}
+
+static ulong
+doread(uvlong addr, void *a, ulong n)
+{
+	ulong d, *aa, nn, ret;
+
+	if(addr >= QSPISIZ)
+		return 0;
+	if(addr + n > QSPISIZ)
+		n = QSPISIZ - addr;
+	evenaddr((uintptr) a);
+	qspisel(1);
+	qspicmd(4, 0x6B | addr << 8);
+	qspicmd(1, 0);
+	ret = n;
+	aa = a;
+	while(n > 0){
+		d = qspicmd(4, 0);
+		if(n >= 4){
+			*aa++ = d;
+			n -= 4;
+		}else{
+			memmove(aa, (char*) &d + 4 - n, n);
+			break;
+		}
+	}
+	qspisel(0);
+	return ret;
+}
+
+static ulong
+dowrite(uvlong addr, void *a, ulong n)
+{
+	ulong *aa, ret, nn;
+
+	if(addr >= QSPISIZ)
+		return 0;
+	if(addr + n > QSPISIZ)
+		n = QSPISIZ - addr;
+	evenaddr((uintptr) a);
+	ret = n;
+	aa = a;
+	while(n > 0){
+		qspisel(1);
+		qspicmd(1, 6);
+		qspisel(0);
+		qspisel(1);
+		qspicmd(4, 0x32 | addr << 8);
+		if(n > 256)
+			nn = 256;
+		else
+			nn = n;
+		n -= nn;
+		addr += nn;
+		while(nn > 0)
+			if(nn >= 4){
+				qspicmd(4, *aa++);
+				nn -= 4;
+			}else{
+				qspicmd(n, *aa);
+				break;
+			}
+		qspisel(0);
+		waitbusy();
+	}
+	return ret;
+}
+
+static void
+doerase(ulong addr)
+{
+	qspisel(1);
+	qspicmd(1, 6);
+	qspisel(0);
+	qspisel(1);
+	qspicmd(4, 0xD8 | addr << 8);
+	qspisel(0);
+	waitbusy();
+}
+
+static Walkqid*
+qspiwalk(Chan* c, Chan *nc, char** name, int nname)
+{
+	return devwalk(c, nc, name, nname, qspidir, nqspidir, devgen);
+}
+
+static int
+qspistat(Chan* c, uchar* dp, int n)
+{
+	return devstat(c, dp, n, qspidir, nqspidir, devgen);
+}
+
+static Chan*
+qspiopen(Chan* c, int omode)
+{
+	devopen(c, omode, qspidir, nqspidir, devgen);
+	if(c->qid.path == Qboot){
+		qlock(&qspil);
+		if((omode & OTRUNC) != 0)
+			doerase(0);
+	}
+	return c;
+}
+
+static void
+qspiclose(Chan* c)
+{
+	if(c->qid.path == Qboot)
+		qunlock(&qspil);
+}
+
+static long
+qspiread(Chan *c, void *a, long n, vlong offset)
+{
+	char buf[64];
+
+	switch((ulong)c->qid.path){
+	case Qdir:
+		return devdirread(c, a, n, qspidir, nqspidir, devgen);
+	case Qboot:
+		return doread(offset, a, n);
+	default:
+		error(Egreg);
+		return -1;
+	}
+}
+
+static long
+qspiwrite(Chan *c, void *a, long n, vlong offset)
+{
+	switch((ulong)c->qid.path){
+	case Qboot:
+		return dowrite(offset, a, n);
+	default:
+		error(Egreg);
+		return -1;
+	}
+}
+
+static Chan*
+qspiattach(char* spec)
+{
+	qspiinit();
+	return devattach('Q', spec);
+}
+
+Dev qspidevtab = {
+	'Q',
+	"qspi",
+	
+	devreset,
+	devinit,
+	devshutdown,
+	qspiattach,
+	qspiwalk,
+	qspistat,
+	qspiopen,
+	devcreate,
+	qspiclose,
+	qspiread,
+	devbread,
+	qspiwrite,
+	devbwrite,
+	devremove,
+	devwstat,
+};
+
-- 
cgit v1.2.3