jtag-mpsse

commit 9e242746d88f3bc1a0d1a549811f2619a4acfbd4
parent e6604774f02168939ed3a20ac1917ec25360fb3b
Author: Brian Swetland <swetland@frotz.net>
Date:   Sun, 27 Apr 2014 05:25:16 -0700

tool to test an i2c controller via jtag debugport

Diffstat:
M
Makefile
 | 
5
++++-
A
i2c.c
 | 
110
+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

2 files changed, 114 insertions(+), 1 deletion(-)
diff --git a/Makefile b/Makefile
@@ -2,7 +2,7 @@
 CFLAGS := -g -Wall -O2
 LIBS := -lusb-1.0
 
-all: jtag
+all: jtag i2c
 
 jtag.c: jtag.h
 jtag-mpsse.c: jtag.h
@@ -11,5 +11,8 @@ JTAG2232_OBJS := jtag.o jtag-mpsse.o
 jtag: $(JTAG2232_OBJS)
 	$(CC) -o jtag $(JTAG2232_OBJS) $(LIBS)
 
+i2c: i2c.o jtag-mpsse.o
+	$(CC) -o i2c i2c.o jtag-mpsse.o $(LIBS)
+
 clean::
 	rm -f jtag *.o
diff --git a/i2c.c b/i2c.c
@@ -0,0 +1,110 @@
+/* Copyright 2014 Brian Swetland <swetland@frotz.net>
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+
+#include "jtag.h"
+#include "zynq.h"
+
+static JTAG *jtag;
+
+void jconnect(void) {
+	if (!(jtag = jtag_open())) {
+		fprintf(stderr, "jconnect: cannot open usb jtag ifc\n");
+		exit(-1);
+	}
+	if (jtag_enumerate(jtag) <= 0) {
+		fprintf(stderr, "jconnect: cannot enumerate jtag devices\n");
+		exit(-1);
+	}
+	if (jtag_select(jtag, 0x13722093)) {
+		fprintf(stderr, "jconnect: cannot connect to ZYNQ\n");
+		exit(-1);
+	}
+
+	jtag_ir_wr(jtag, XIL_USER4);
+}
+
+u32 jrd(void) {
+	u64 u;
+	jtag_dr_io(jtag, 32, 0, &u);
+	return (u32) u;
+}
+
+u32 jwr(u32 n) {
+	u64 u;
+	u = n;
+	u |= 0x100000000ULL;
+	jtag_dr_io(jtag, 33, u, &u);
+	return (u32) u;
+}
+
+#define STA	0x0100
+#define STP	0x0200
+#define WR	0x0400
+#define RD	0x0800
+#define TIP	0x1000
+#define ACK     0x2000
+#define LOST    0x4000
+#define BUSY    0x8000
+
+/* example:  ./i2c sw:a0 w:fa sw:a1 r r r r r r p  */
+
+int main(int argc, char **argv) {
+	jconnect();
+	unsigned n,x;
+	unsigned c;
+
+	argc--;
+	argv++;
+
+	while (argc > 0) {
+		char *cmd = argv[0];
+		n = 0;
+		while (*cmd) {
+			switch(*cmd) {
+			case 's': case 'S': n |= STA; break;
+			case 'p': case 'P': n |= STP; break;
+			case 'w': case 'W': n |= WR; break;
+			case 'r': case 'R': n |= RD; break;
+			case ':':
+				cmd++;
+				n |= (strtoul(cmd, 0, 16) & 0xFF);
+				goto done;
+			default:
+				fprintf(stderr,"syntax error\n");
+				return -1;
+			}
+			cmd++;
+		}
+done:
+		jwr(n);
+		c = 1;
+		while ((x = jrd()) & TIP) c++;
+
+		fprintf(stderr, "%c%c%c%c %02x -> %02x %c%c%c (%d)\n",
+			(n&RD)?'R':'-', (n&WR)?'W':'-',
+			(n&STP)?'P':'-', (n&STA)?'S':'-',
+			n & 0xFF, x & 0xFF,
+			(x&ACK)?'A':'N', (x&LOST)?'L':'-',
+			(x&BUSY)?'B':'-', c);
+		argc--;
+		argv++;
+	}
+
+	return 0;
+}