From 3e670223fd5f2f0cf098c8c5ad611679a7c752c3 Mon Sep 17 00:00:00 2001 From: michael Date: Sun, 29 Apr 2007 15:18:42 +0000 Subject: [PATCH] start of configuration infrastructure --- Makefile | 8 +++--- config.c | 75 ++++++++++++++++++++++++++++++++++++++++++++++++++++ config.h | 11 ++++++++ usb-driver.c | 54 +++++++++++++++++++------------------ 4 files changed, 119 insertions(+), 29 deletions(-) create mode 100644 config.c create mode 100644 config.h diff --git a/Makefile b/Makefile index 8f1f94a..cc2de3e 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 usb-driver.h jtagkey.h Makefile - gcc $(CFLAGS) usb-driver.c $(JTAGKEYSRC) -o $@ -ldl -lusb -lpthread $(FTDI) -shared +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-DEBUG.so: usb-driver.c jtagkey.c usb-driver.h jtagkey.h Makefile - gcc -DDEBUG $(CFLAGS) usb-driver.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 clean: rm -f $(SOBJECTS) diff --git a/config.c b/config.c new file mode 100644 index 0000000..9b085d6 --- /dev/null +++ b/config.c @@ -0,0 +1,75 @@ +#include +#include +#include "config.h" + +static struct parport_config pp_config[4]; + +static void read_config() { + int i; + static int config_read = 0; + + if (config_read) + return; + + config_read = 1; + + for (i=0; i #include #include "usb-driver.h" +#include "config.h" #ifdef JTAGKEY #include "jtagkey.h" #endif @@ -349,7 +350,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.65 $"); + strcpy(version->version, "libusb-driver.so $Revision: 1.66 $"); version->versionul = 802; DPRINTF("VERSION\n"); break; @@ -380,10 +381,11 @@ int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) { ret = (*ioctl_func) (fd, request, wdioctl); #else - /* FIXME: Ugly hack which maps amontec JtagKey to 4. parallel port */ #ifdef JTAGKEY - if ((unsigned long)cr->Card.Item[0].I.IO.dwAddr == 0x30) { - ret=jtagkey_init(0x0403, 0xcff8); /* I need a config file... */ + 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) @@ -392,6 +394,7 @@ int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) { break; } #endif + if (parportfd < 0) { snprintf(ppdev, sizeof(ppdev), "/dev/parport%lu", (unsigned long)cr->Card.Item[0].I.IO.dwAddr / 0x10); @@ -708,7 +711,7 @@ int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) { #else #ifdef JTAGKEY - if (ppbase == 0x30) { + if (!config_is_real_pport(ppbase / 0x10)) { ret = jtagkey_transfer(tr, fd, request, ppbase, ecpbase, 1); break; } @@ -730,8 +733,7 @@ int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) { #else #ifdef JTAGKEY - /* FIXME: Config file and mor intelligent mapping! */ - if (ppbase == 0x30) { + if (!config_is_real_pport(ppbase / 0x10)) { ret = jtagkey_transfer(tr, fd, request, ppbase, ecpbase, num); break; } @@ -981,13 +983,26 @@ FILE *fopen(const char *path, const char *mode) { if (!func) func = (FILE* (*) (const char*, const char*)) dlsym(RTLD_NEXT, "fopen"); -#ifdef JTAGKEY - /* FIXME: Hack for parport mapping */ - if (!strcmp(path, "/proc/sys/dev/parport/parport3/base-addr")) { - ret = (*func) ("/dev/null", mode); - } else -#endif - ret = (*func) (path, mode); + for (i = 0; i < 4; i++) { + snprintf(buf, sizeof(buf), "/proc/sys/dev/parport/parport%d/base-addr", i); + if (!strcmp(path, buf)) { + DPRINTF("open base-addr of parport%d\n", i); + if (config_is_real_pport(i)) { + ret = (*func) (path, mode); + } else { + ret = (*func) ("/dev/null", mode); + } + + if (ret) { + baseaddrfp = ret; + baseaddrnum = i; + } + + return ret; + } + } + + ret = (*func) (path, mode); if (!strcmp(path, "/proc/modules")) { DPRINTF("opening /proc/modules\n"); @@ -996,17 +1011,6 @@ FILE *fopen(const char *path, const char *mode) { modules_read = 0; #endif } - - if (ret) { - for (i = 0; i < 4; i++) { - snprintf(buf, sizeof(buf), "/proc/sys/dev/parport/parport%d/base-addr", i); - if (!strcmp(path, buf)) { - DPRINTF("open base-addr of parport%d\n", i); - baseaddrfp = ret; - baseaddrnum = i; - } - } - } return ret; }