From 5e3d963bcb6112d798f674b876b167c633ff6b59 Mon Sep 17 00:00:00 2001
From: michael <michael>
Date: Mon, 30 Apr 2007 09:23:32 +0000
Subject: [PATCH] unify parallel and jtagkey interface

---
 Makefile     |   8 +--
 config.h     |   1 +
 jtagkey.c    |  24 +++++--
 jtagkey.h    |   4 +-
 parport.c    | 168 ++++++++++++++++++++++++++++++++++++++++++++
 parport.h    |   3 +
 usb-driver.c | 193 ++++++---------------------------------------------
 7 files changed, 217 insertions(+), 184 deletions(-)
 create mode 100644 parport.c
 create mode 100644 parport.h

diff --git a/Makefile b/Makefile
index cc2de3e..21cb565 100644
--- a/Makefile
+++ b/Makefile
@@ -12,11 +12,11 @@ SOBJECTS=libusb-driver.so libusb-driver-DEBUG.so
 
 all: $(SOBJECTS)
 
-libusb-driver.so: usb-driver.c jtagkey.c config.c usb-driver.h jtagkey.h config.h Makefile
-	gcc $(CFLAGS) usb-driver.c config.c $(JTAGKEYSRC) -o $@ -ldl -lusb -lpthread $(FTDI) -shared
+libusb-driver.so: usb-driver.c parport.c jtagkey.c config.c usb-driver.h parport.h jtagkey.h config.h Makefile
+	gcc $(CFLAGS) usb-driver.c parport.c config.c $(JTAGKEYSRC) -o $@ -ldl -lusb -lpthread $(FTDI) -shared
 
-libusb-driver-DEBUG.so: usb-driver.c jtagkey.c config.c usb-driver.h jtagkey.h config.h Makefile
-	gcc -DDEBUG $(CFLAGS) usb-driver.c config.c $(JTAGKEYSRC) -o $@ -ldl -lusb -lpthread $(FTDI) -shared
+libusb-driver-DEBUG.so: usb-driver.c parport.c jtagkey.c config.c usb-driver.h parport.h jtagkey.h config.h Makefile
+	gcc -DDEBUG $(CFLAGS) usb-driver.c parport.c config.c $(JTAGKEYSRC) -o $@ -ldl -lusb -lpthread $(FTDI) -shared
 
 clean:
 	rm -f $(SOBJECTS)
diff --git a/config.h b/config.h
index 1cacd06..f238e3b 100644
--- a/config.h
+++ b/config.h
@@ -4,6 +4,7 @@ struct parport_config {
 	unsigned char real;
 	unsigned short usb_vid;
 	unsigned short usb_pid;
+	/* TODO: function pointer */
 };
 
 unsigned char config_is_real_pport(int num);
diff --git a/jtagkey.c b/jtagkey.c
index 2490b31..dec0b81 100644
--- a/jtagkey.c
+++ b/jtagkey.c
@@ -2,6 +2,7 @@
 #include <ftdi.h>
 #include <unistd.h>
 #include "usb-driver.h"
+#include "config.h"
 #include "jtagkey.h"
 
 #define USBBUFSIZE 4096
@@ -10,7 +11,7 @@ static struct ftdi_context ftdic;
 static unsigned int usb_maxlen = 0;
 static unsigned char bitbang_mode;
 
-int jtagkey_init(unsigned short vid, unsigned short pid) {
+static int jtagkey_init(unsigned short vid, unsigned short pid) {
 	int ret = 0;
 	unsigned char c;
 
@@ -68,10 +69,23 @@ int jtagkey_init(unsigned short vid, unsigned short pid) {
 	return ret;
 }
 
-void jtagkey_close() {
-	ftdi_disable_bitbang(&ftdic);
-	ftdi_usb_close(&ftdic);
-	ftdi_deinit(&ftdic);
+int jtagkey_open(int num) {
+	int ret;
+
+	ret = jtagkey_init(config_usb_vid(num), config_usb_pid(num));
+
+	if (ret >= 0)
+		ret = 0xff;
+
+	return ret;
+}
+
+void jtagkey_close(int handle) {
+	if (handle == 0xff) {
+		ftdi_disable_bitbang(&ftdic);
+		ftdi_usb_close(&ftdic);
+		ftdi_deinit(&ftdic);
+	}
 }
 
 static int jtagkey_set_bbmode(unsigned char mode) {
diff --git a/jtagkey.h b/jtagkey.h
index 59a32e2..2c13260 100644
--- a/jtagkey.h
+++ b/jtagkey.h
@@ -5,6 +5,6 @@
 #define JTAGKEY_VREF	0x20
 #define JTAGKEY_OEn	0x10
 
-int jtagkey_init(unsigned short vid, unsigned short pid);
-void jtagkey_close();
 int jtagkey_transfer(WD_TRANSFER *tr, int fd, unsigned int request, int ppbase, int ecpbase, int num);
+int jtagkey_open(int num);
+void jtagkey_close(int handle);
diff --git a/parport.c b/parport.c
new file mode 100644
index 0000000..9cf35cd
--- /dev/null
+++ b/parport.c
@@ -0,0 +1,168 @@
+#include <stdio.h>
+#include <fcntl.h>
+#include <errno.h>
+#include <string.h>
+#include <unistd.h>
+#include <inttypes.h>
+#include <sys/types.h>
+#include <sys/ioctl.h>
+#include <linux/parport.h>
+#include <linux/ppdev.h>
+#include "usb-driver.h"
+#include "parport.h"
+
+static int parportfd = -1;
+
+int pp_transfer(WD_TRANSFER *tr, int fd, unsigned int request, int ppbase, int ecpbase, int num) {
+	int ret = 0;
+	int i;
+	unsigned long port;
+	unsigned char val;
+	static unsigned char last_pp_write = 0;
+
+	for (i = 0; i < num; i++) {
+		DPRINTF("dwPort: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
+				(unsigned long)tr[i].dwPort, tr[i].cmdTrans, tr[i].dwBytes,
+				tr[i].fAutoinc, tr[i].dwOptions);
+
+		port = (unsigned long)tr[i].dwPort;
+		val = tr[i].Data.Byte;
+
+#ifdef DEBUG
+		if (tr[i].cmdTrans == 13)
+			DPRINTF("write byte: %d\n", val);
+#endif
+
+		if (parportfd < 0)
+			return ret;
+
+		if (port == ppbase + PP_DATA) {
+			DPRINTF("data port\n");
+			switch(tr[i].cmdTrans) {
+				case PP_READ:
+					ret = 0; /* We don't support reading of the data port */
+					break;
+
+				case PP_WRITE:
+					ret = ioctl(parportfd, PPWDATA, &val);
+					last_pp_write = val;
+					break;
+
+				default:
+					fprintf(stderr,"!!!Unsupported TRANSFER command: %lu!!!\n", tr[i].cmdTrans);
+					ret = -1;
+					break;
+			}
+		} else if (port == ppbase + PP_STATUS) {
+			DPRINTF("status port (last write: %d)\n", last_pp_write);
+			switch(tr[i].cmdTrans) {
+				case PP_READ:
+					ret = ioctl(parportfd, PPRSTATUS, &val);
+#ifdef FORCE_PC3_IDENT
+					val &= 0x5f;
+					if (last_pp_write & 0x40)
+						val |= 0x20;
+					else
+						val |= 0x80;
+#endif
+					break;
+
+				case PP_WRITE:
+					ret = 0; /* Status Port is readonly */
+					break;
+
+				default:
+					fprintf(stderr,"!!!Unsupported TRANSFER command: %lu!!!\n", tr[i].cmdTrans);
+					ret = -1;
+					break;
+			}
+		} else if (port == ppbase + PP_CONTROL) {
+			DPRINTF("control port\n");
+			switch(tr[i].cmdTrans) {
+				case PP_READ:
+					ret = ioctl(parportfd, PPRCONTROL, &val);
+					break;
+
+				case PP_WRITE:
+					ret = ioctl(parportfd, PPWCONTROL, &val);
+					break;
+
+				default:
+					fprintf(stderr,"!!!Unsupported TRANSFER command: %lu!!!\n", tr[i].cmdTrans);
+					ret = -1;
+					break;
+			}
+		} else if ((port == ecpbase + PP_ECP_CFGA) && ecpbase) {
+			DPRINTF("ECP_CFGA port\n");
+		} else if ((port == ecpbase + PP_ECP_CFGB) && ecpbase) {
+			DPRINTF("ECP_CFGB port\n");
+		} else if ((port == ecpbase + PP_ECP_ECR) && ecpbase) {
+			DPRINTF("ECP_ECR port\n");
+		} else {
+			DPRINTF("access to unsupported address range!\n");
+			ret = 0;
+		}
+
+		tr[i].Data.Byte = val;
+
+		DPRINTF("dwPortReturn: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
+				(unsigned long)tr[i].dwPort, tr[i].cmdTrans, tr[i].dwBytes,
+				tr[i].fAutoinc, tr[i].dwOptions);
+#ifdef DEBUG
+		if (tr[i].cmdTrans == 10)
+			DPRINTF("read byte: %d\n", tr[i].Data.Byte);
+#endif
+	}
+
+	return ret;
+}
+
+int parport_open(int num) {
+	char ppdev[32];
+
+	if (parportfd < 0) {
+		snprintf(ppdev, sizeof(ppdev), "/dev/parport%u", num);
+		DPRINTF("opening %s\n", ppdev);
+		parportfd = open(ppdev, O_RDWR|O_EXCL);
+
+		if (parportfd < 0)
+			fprintf(stderr,"Can't open %s: %s\n", ppdev, strerror(errno));
+	}
+
+	if (parportfd >= 0) {
+		int pmode;
+
+		if (ioctl(parportfd, PPCLAIM) == -1)
+			return -1;
+
+		pmode = IEEE1284_MODE_COMPAT;
+		if (ioctl(parportfd, PPNEGOT, &pmode) == -1)
+			return -1;
+
+#if 0
+		if (cr->Card.dwItems > 1 && cr->Card.Item[1].I.IO.dwAddr) {
+			DPRINTF("ECP mode requested\n");
+			ecpbase = (unsigned long)cr->Card.Item[1].I.IO.dwAddr;
+			/* TODO: Implement ECP mode */
+			pmode = IEEE1284_MODE_ECP;
+
+			if (ioctl(parportfd, PPNEGOT, &pmode) == -1) {
+				ecpbase = 0;
+				pmode = IEEE1284_MODE_COMPAT;
+				if (ioctl(parportfd, PPNEGOT, &pmode) == -1)
+					return ret;
+			}
+		}
+#endif
+	}
+
+	return parportfd;
+}
+
+void parport_close(int handle) {
+	if (parportfd == handle && parportfd >= 0) {
+		ioctl(parportfd, PPRELEASE);
+		close(parportfd);
+		parportfd = -1;
+	}
+}
diff --git a/parport.h b/parport.h
new file mode 100644
index 0000000..d4fbaa2
--- /dev/null
+++ b/parport.h
@@ -0,0 +1,3 @@
+int pp_transfer(WD_TRANSFER *tr, int fd, unsigned int request, int ppbase, int ecpbase, int num);
+int parport_open(int num);
+void parport_close(int handle);
diff --git a/usb-driver.c b/usb-driver.c
index b39c4fc..f2f8477 100644
--- a/usb-driver.c
+++ b/usb-driver.c
@@ -39,17 +39,15 @@
 #include <errno.h>
 #include <inttypes.h>
 #include <sys/ioctl.h>
-#include <linux/parport.h>
-#include <linux/ppdev.h>
 #include "usb-driver.h"
 #include "config.h"
+#include "parport.h"
 #ifdef JTAGKEY
 #include "jtagkey.h"
 #endif
 
 static int (*ioctl_func) (int, int, void *) = NULL;
 static int windrvrfd = -1;
-static int parportfd = -1;
 static unsigned long ppbase = 0;
 static unsigned long ecpbase = 0;
 FILE *modulesfp = NULL;
@@ -237,106 +235,6 @@ int usb_deviceinfo(unsigned char *buf) {
 	return len;
 }
 
-int pp_transfer(WD_TRANSFER *tr, int fd, unsigned int request) {
-	int ret = 0;
-	unsigned long port = (unsigned long)tr->dwPort;
-	unsigned char val;
-	static unsigned char last_pp_write = 0;
-
-	DPRINTF("dwPort: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
-			(unsigned long)tr->dwPort, tr->cmdTrans, tr->dwBytes,
-			tr->fAutoinc, tr->dwOptions);
-
-	val = tr->Data.Byte;
-	
-#ifdef DEBUG
-	if (tr->cmdTrans == 13)
-		DPRINTF("write byte: %d\n", val);
-#endif
-
-	if (parportfd < 0)
-		return ret;
-
-	if (port == ppbase + PP_DATA) {
-		DPRINTF("data port\n");
-		switch(tr->cmdTrans) {
-			case PP_READ:
-				ret = 0; /* We don't support reading of the data port */
-				break;
-
-			case PP_WRITE:
-				ret = ioctl(parportfd, PPWDATA, &val);
-				last_pp_write = val;
-				break;
-
-			default:
-				fprintf(stderr,"!!!Unsupported TRANSFER command: %lu!!!\n", tr->cmdTrans);
-				ret = -1;
-				break;
-		}
-	} else if (port == ppbase + PP_STATUS) {
-		DPRINTF("status port (last write: %d)\n", last_pp_write);
-		switch(tr->cmdTrans) {
-			case PP_READ:
-				ret = ioctl(parportfd, PPRSTATUS, &val);
-#ifdef FORCE_PC3_IDENT
-				val &= 0x5f;
-				if (last_pp_write & 0x40)
-					val |= 0x20;
-				else
-					val |= 0x80;
-#endif
-				break;
-
-			case PP_WRITE:
-				ret = 0; /* Status Port is readonly */
-				break;
-
-			default:
-				fprintf(stderr,"!!!Unsupported TRANSFER command: %lu!!!\n", tr->cmdTrans);
-				ret = -1;
-				break;
-		}
-	} else if (port == ppbase + PP_CONTROL) {
-		DPRINTF("control port\n");
-		switch(tr->cmdTrans) {
-			case PP_READ:
-				ret = ioctl(parportfd, PPRCONTROL, &val);
-				break;
-
-			case PP_WRITE:
-				ret = ioctl(parportfd, PPWCONTROL, &val);
-				break;
-
-			default:
-				fprintf(stderr,"!!!Unsupported TRANSFER command: %lu!!!\n", tr->cmdTrans);
-				ret = -1;
-				break;
-		}
-	} else if ((port == ecpbase + PP_ECP_CFGA) && ecpbase) {
-		DPRINTF("ECP_CFGA port\n");
-	} else if ((port == ecpbase + PP_ECP_CFGB) && ecpbase) {
-		DPRINTF("ECP_CFGB port\n");
-	} else if ((port == ecpbase + PP_ECP_ECR) && ecpbase) {
-		DPRINTF("ECP_ECR port\n");
-	} else {
-		DPRINTF("access to unsupported address range!\n");
-		ret = 0;
-	}
-
-	tr->Data.Byte = val;
-
-	DPRINTF("dwPortReturn: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
-			(unsigned long)tr->dwPort, tr->cmdTrans, tr->dwBytes,
-			tr->fAutoinc, tr->dwOptions);
-#ifdef DEBUG
-	if (tr->cmdTrans == 10)
-		DPRINTF("read byte: %d\n", tr->Data.Byte);
-#endif
-
-	return ret;
-}
-
 int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
 	struct header_struct* wdheader = (struct header_struct*)wdioctl;
 	struct version_struct *version;
@@ -350,7 +248,7 @@ int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
 	switch(request & ~(0xc0000000)) {
 		case VERSION:
 			version = (struct version_struct*)(wdheader->data);
-			strcpy(version->version, "libusb-driver.so $Revision: 1.66 $");
+			strcpy(version->version, "libusb-driver.so $Revision: 1.67 $");
 			version->versionul = 802;
 			DPRINTF("VERSION\n");
 			break;
@@ -364,7 +262,6 @@ int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
 			DPRINTF("CARD_REGISTER\n");
 			{
 				struct card_register* cr = (struct card_register*)(wdheader->data);
-				char ppdev[32];
 
 				DPRINTF("Items: %lu, Addr: 0x%lx, bytes: %lu, bar: %lu\n",
 				cr->Card.dwItems,
@@ -380,64 +277,24 @@ int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
 #ifndef NO_WINDRVR
 				ret = (*ioctl_func) (fd, request, wdioctl);
 #else
-				
-#ifdef JTAGKEY
-				if (!config_is_real_pport((unsigned long)cr->Card.Item[0].I.IO.dwAddr / 0x10)) {
-					int num = (unsigned long)cr->Card.Item[0].I.IO.dwAddr / 0x10;
-
-					ret=jtagkey_init(config_usb_vid(num), config_usb_pid(num));
-					cr->hCard = 0xff;
-					ppbase = (unsigned long)cr->Card.Item[0].I.IO.dwAddr;
-					if (ret < 0)
-						cr->hCard = 0;
 
-					break;
-				}
+#ifdef JTAGKEY
+				if (!config_is_real_pport((unsigned long)cr->Card.Item[0].I.IO.dwAddr / 0x10))
+					ret = jtagkey_open((unsigned long)cr->Card.Item[0].I.IO.dwAddr / 0x10);
+				else
 #endif
+					ret = parport_open((unsigned long)cr->Card.Item[0].I.IO.dwAddr / 0x10);
 
-				if (parportfd < 0) {
-					snprintf(ppdev, sizeof(ppdev), "/dev/parport%lu",
-							(unsigned long)cr->Card.Item[0].I.IO.dwAddr / 0x10);
-					DPRINTF("opening %s\n", ppdev);
-					parportfd = open(ppdev, O_RDWR|O_EXCL);
-
-					if (parportfd < 0)
-						fprintf(stderr,"Can't open %s: %s\n", ppdev, strerror(errno));
-				}
+				ppbase = (unsigned long)cr->Card.Item[0].I.IO.dwAddr;
 
-				if (parportfd >= 0) {
-					int pmode;
-
-					if (ioctl(parportfd, PPCLAIM) == -1)
-						return ret;
-
-					ecpbase = 0;
-					pmode = IEEE1284_MODE_COMPAT;
-					if (ioctl(parportfd, PPNEGOT, &pmode) == -1)
-						return ret;
-
-					if (cr->Card.dwItems > 1 && cr->Card.Item[1].I.IO.dwAddr) {
-						DPRINTF("ECP mode requested\n");
-						ecpbase = (unsigned long)cr->Card.Item[1].I.IO.dwAddr;
-						/* TODO: Implement ECP mode */
-#if 0
-						pmode = IEEE1284_MODE_ECP;
-
-						if (ioctl(parportfd, PPNEGOT, &pmode) == -1) {
-							ecpbase = 0;
-							pmode = IEEE1284_MODE_COMPAT;
-							if (ioctl(parportfd, PPNEGOT, &pmode) == -1)
-								return ret;
-						}
-#endif
-					}
+				if (cr->Card.dwItems > 1 && cr->Card.Item[1].I.IO.dwAddr)
+					ecpbase = (unsigned long)cr->Card.Item[1].I.IO.dwAddr;
 
-					cr->hCard = parportfd;
-				}
-
-				ppbase = (unsigned long)cr->Card.Item[0].I.IO.dwAddr;
-				if (ret < 0)
+				if (ret >= 0) {
+					cr->hCard = ret;
+				} else {
 					cr->hCard = 0;
+				}
 #endif
 				DPRINTF("hCard: %lu\n", cr->hCard);
 			}
@@ -716,7 +573,7 @@ int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
 					break;
 				}
 #endif /* JTAGKEY */
-				ret = pp_transfer(tr, fd, request);
+				ret = pp_transfer(tr, fd, request, ppbase, ecpbase, 1);
 #endif
 			}
 			break;
@@ -727,7 +584,6 @@ int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
 			{
 				WD_TRANSFER *tr = (WD_TRANSFER*)(wdheader->data);
 				unsigned long num = wdheader->size/sizeof(WD_TRANSFER);
-				int i;
 #ifndef NO_WINDRVR
 				ret = (*ioctl_func) (fd, request, wdioctl);
 #else
@@ -735,14 +591,9 @@ int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
 #ifdef JTAGKEY
 				if (!config_is_real_pport(ppbase / 0x10)) {
 					ret = jtagkey_transfer(tr, fd, request, ppbase, ecpbase, num);
-					break;
-				}
+				} else
 #endif /* JTAGKEY */
-
-				for (i = 0; i < num; i++) {
-					DPRINTF("Transfer %d:\n", i+1);
-					ret = pp_transfer(tr + i, fd, request);
-				}
+					ret = pp_transfer(tr, fd, request, ppbase, ecpbase, num);
 #endif
 			}
 			break;
@@ -804,14 +655,10 @@ int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
 #else
 #ifdef JTAGKEY
 				if (cr->hCard == 0xff)
-					jtagkey_close();
+					jtagkey_close(cr->hCard);
+				else
 #endif
-
-				if (parportfd == cr->hCard && parportfd >= 0) {
-					ioctl(parportfd, PPRELEASE);
-					close(parportfd);
-					parportfd = -1;
-				}
+					parport_close(cr->hCard);
 #endif
 			}
 			break;
-- 
2.39.5