X-Git-Url: http://git.zerfleddert.de/cgi-bin/gitweb.cgi/usb-driver/blobdiff_plain/c42237a305a64d46ed4fa4cf2c974abd09486be7..adb51cf1e775445a863fc2cc25dc9c6f408fbffb:/usb-driver.c

diff --git a/usb-driver.c b/usb-driver.c
index def52db..942cdc1 100644
--- a/usb-driver.c
+++ b/usb-driver.c
@@ -57,6 +57,7 @@ static struct usb_bus *busses = NULL;
 static struct usb_device *usbdevice;
 static usb_dev_handle *usb_devhandle = NULL;
 static int usbinterface = -1;
+static int usbalternate = -1;
 static unsigned long card_type;
 static int ints_enabled = 0;
 static pthread_mutex_t int_wait = PTHREAD_MUTEX_INITIALIZER;
@@ -234,6 +235,39 @@ static int usb_deviceinfo(unsigned char *buf) {
 	return len;
 }
 
+static int usb_claim(int claim) {
+	int ret = 0;
+	static int claimed = 0;
+
+	if (usbinterface < 0)
+		return -1;
+	
+	if (claim) {
+		if (claimed)
+			return 0;
+
+		ret = usb_claim_interface(usb_devhandle, usbinterface);
+		if (!ret) {
+			claimed = 1;
+			ret = usb_set_altinterface(usb_devhandle, usbalternate);
+			if (ret)
+				fprintf(stderr, "usb_set_altinterface: %d\n", ret);
+		} else {
+			fprintf(stderr, "usb_claim_interface: %d -> %d (%s)\n",
+					usbinterface, ret, usb_strerror());
+		}
+	} else {
+		if (!claimed)
+			return 0;
+
+		ret = usb_release_interface(usb_devhandle, usbinterface);
+		if (!ret)
+			claimed = 0;
+	}
+
+	return ret;
+}
+
 static int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
 	struct header_struct* wdheader = (struct header_struct*)wdioctl;
 	struct version_struct *version;
@@ -307,8 +341,10 @@ static int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
 				DPRINTF(" unique: %lu, pipe: %lu, read: %lu, options: %lx, size: %lu, timeout: %lx\n",
 				ut->dwUniqueID, ut->dwPipeNum, ut->fRead,
 				ut->dwOptions, ut->dwBufferSize, ut->dwTimeout);
-				DPRINTF("setup packet: ");
-				hexdump(ut->SetupPacket, 8);
+				if (ut->dwPipeNum == 0) {
+					DPRINTF("setup packet: ");
+					hexdump(ut->SetupPacket, 8);
+				}
 
 				if (!ut->fRead && ut->dwBufferSize)
 				{
@@ -319,6 +355,7 @@ static int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
 #ifndef NO_WINDRVR
 				ret = (*ioctl_func) (fd, request, wdioctl);
 #else
+				usb_claim(1);
 				/* http://www.jungo.com/support/documentation/windriver/802/wdusb_man_mhtml/node55.html#SECTION001213000000000000000 */
 				if (ut->dwPipeNum == 0) { /* control pipe */
 					int requesttype, request, value, index, size;
@@ -332,10 +369,10 @@ static int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
 				} else {
 					if (ut->fRead) {
 						ret = usb_bulk_read(usb_devhandle, ut->dwPipeNum, ut->pBuffer, ut->dwBufferSize, ut->dwTimeout);
-
 					} else {
 						ret = usb_bulk_write(usb_devhandle, ut->dwPipeNum, ut->pBuffer, ut->dwBufferSize, ut->dwTimeout);
 					}
+					usb_claim(0);
 				}
 
 				if (ret < 0) {
@@ -413,25 +450,18 @@ static int do_wdioctl(int fd, unsigned int request, unsigned char *wdioctl) {
 				ret = (*ioctl_func) (fd, request, wdioctl);
 #else
 				if (usbdevice) {
-					if (!usb_devhandle)
+					if (!usb_devhandle) {
 						usb_devhandle = usb_open(usbdevice);
-
-					/* FIXME: Select right interface! */
-					ret = usb_claim_interface(usb_devhandle, usbdevice->config[0].interface[usi->dwInterfaceNum].altsetting[usi->dwAlternateSetting].bInterfaceNumber);
-					if (!ret) {
-						if(!ret) {
-							usbinterface = usbdevice->config[0].interface[usi->dwInterfaceNum].altsetting[usi->dwAlternateSetting].bInterfaceNumber;
-							ret = usb_set_altinterface(usb_devhandle, usi->dwAlternateSetting);
-							if (ret)
-								fprintf(stderr, "usb_set_altinterface: %d\n", ret);
-						} else {
-							fprintf(stderr, "usb_set_configuration: %d (%s)\n", ret, usb_strerror());
+#ifndef NO_USB_RESET
+						if (usb_devhandle) {
+							usb_reset(usb_devhandle);
+							usb_devhandle = usb_open(usbdevice);
 						}
-					} else {
-						fprintf(stderr, "usb_claim_interface: %d -> %d (%s)\n",
-						usbdevice->config[0].interface[usi->dwInterfaceNum].altsetting[usi->dwAlternateSetting].bInterfaceNumber,
-						ret, usb_strerror());
+#endif
 					}
+
+					usbinterface = usbdevice->config[0].interface[usi->dwInterfaceNum].altsetting[usi->dwAlternateSetting].bInterfaceNumber;
+					usbalternate = usi->dwAlternateSetting;
 				}
 #endif
 				DPRINTF("unique: %lu, interfacenum: %lu, alternatesetting: %lu, options: %lx\n",
@@ -827,8 +857,6 @@ int close(int fd) {
 	
 	if (fd == windrvrfd && windrvrfd >= 0) {
 		DPRINTF("close windrvrfd\n");
-		if (usbinterface >= 0)
-			usb_release_interface(usb_devhandle, usbinterface);
 
 		if (usb_devhandle)
 			usb_close(usb_devhandle);