#include <stdio.h>
#include <stdlib.h>
#include <inttypes.h>
+#include <string.h>
#include "usb-driver.h"
#include "parport.h"
#ifdef JTAGKEY
#endif
#include "config.h"
+#define LINELEN 1024
+
+#define PARSEERROR fprintf(stderr,"LIBUSB-DRIVER WARNING: Invalid config statement at line %d\n", line)
+
static struct parport_config pp_config[4];
static void read_config() {
int i;
static int config_read = 0;
+ FILE *cfg;
+ char buf[LINELEN];
+#ifdef JTAGKEY
+ char *pbuf;
+ unsigned short vid, pid;
+ unsigned short iface;
+ int line, len, num;
+#endif
if (config_read)
return;
pp_config[i].transfer = parport_transfer;
}
+ snprintf(buf, sizeof(buf), "%s/.libusb-driverrc", getenv("HOME"));
+
+ cfg = fopen(buf, "r");
+ if (cfg) {
#ifdef JTAGKEY
- pp_config[3].real = 0;
- pp_config[3].usb_vid = 0x0403;
- pp_config[3].usb_pid = 0xcff8;
- pp_config[3].open = jtagkey_open;
- pp_config[3].close = jtagkey_close;
- pp_config[3].transfer = jtagkey_transfer;
+ line = 0;
+ do {
+ pbuf = fgets(buf, sizeof(buf), cfg);
+ if (!pbuf)
+ break;
+
+ line++;
+
+ len = strlen(buf);
+
+ if (len > 0 && buf[len-1] == '\n') {
+ buf[len-1] = '\0';
+ len--;
+ }
+ if (len > 0 && buf[len-1] == '\r') {
+ buf[len-1] = '\0';
+ len--;
+ }
+
+ for (i = 0; i < len; i++) {
+ if (buf[i] != ' ' && buf[i] != '\t')
+ break;
+ }
+
+ if (buf[i] == '#' || buf[i] == ';' || buf[i] == '\0')
+ continue;
+
+ if (!strncasecmp(buf+i, "LPT", 3)) {
+ unsigned char equal_seen = 0;
+
+ i += 3;
+ pbuf = buf+i;
+ for (; i < len; i++) {
+ if (buf[i] == ' ' || buf[i] == '\t' || buf[i] == '=') {
+ if (buf[i] == '=')
+ equal_seen = 1;
+
+ buf[i] = '\0';
+ i++;
+ break;
+ }
+ }
+
+ if (*pbuf == '\0') {
+ PARSEERROR;
+ continue;
+ }
+
+ num = 0;
+ num = strtol(pbuf, NULL, 10);
+ if (num < 1) {
+ PARSEERROR;
+ continue;
+ }
+ num--;
+
+ for (; (i < len) && (!equal_seen) ; i++) {
+ if (buf[i] == '=') {
+ equal_seen = 1;
+ i++;
+ break;
+ } else if (buf[i] != ' ' && buf[i] != '\t') {
+ break;
+ }
+ }
+
+ if (!equal_seen) {
+ PARSEERROR;
+ continue;
+ }
+
+ for (; i < len; i++) {
+ if (buf[i] != ' ' && buf[i] != '\t')
+ break;
+ }
+
+ if (strncasecmp(buf+i, "FTDI:", 5)) {
+ PARSEERROR;
+ continue;
+ }
+
+ i += 5;
+ pbuf = buf + i;
+
+ for (; i < len; i++) {
+ if (buf[i] == ':')
+ break;
+ }
+
+ if (buf[i] != ':') {
+ PARSEERROR;
+ continue;
+ }
+
+ buf[i] = '\0';
+
+ vid = 0;
+ vid = strtol(pbuf, NULL, 16);
+ if (!vid) {
+ PARSEERROR;
+ continue;
+ }
+
+ i++;
+ pbuf = buf + i;
+
+ for (; i < len; i++) {
+ if (buf[i] == ' ' || buf[i] == '\t' || buf[i] == ':')
+ break;
+ }
+
+ pid = 0;
+ pid = strtol(pbuf, NULL, 16);
+ if (!pid) {
+ PARSEERROR;
+ continue;
+ }
+
+ iface = 0;
+ pbuf = buf + i;
+ if (pbuf[0] == ':') {
+ iface = atoi(pbuf + 1);
+ }
+
+ pp_config[num].real = 0;
+ pp_config[num].usb_vid = vid;
+ pp_config[num].usb_pid = pid;
+ pp_config[num].usb_iface = iface;
+ pp_config[num].open = jtagkey_open;
+ pp_config[num].close = jtagkey_close;
+ pp_config[num].transfer = jtagkey_transfer;
+ } else {
+ PARSEERROR;
+ }
+ } while (pbuf);
+#else
+ fprintf(stderr,"libusb-driver not compiled with FTDI2232-support, config file ignored!\n");
#endif
+ fclose(cfg);
+ }
}
struct parport_config *config_get(int num) {
return ret;
}
-/* TODO:
-int config_init_port(int num) {}
-config_get_transfer_fn(int num) {}
-*/
+unsigned short config_usb_iface(int num) {
+ unsigned short ret = 0x00;
+ int i;
+
+ read_config();
+
+ for (i=0; i<sizeof(pp_config)/sizeof(struct parport_config); i++) {
+ if (pp_config[i].num == num) {
+ ret = pp_config[i].usb_iface;
+ break;
+ }
+ }
+
+ return ret;
+}
+