diff options
Diffstat (limited to 'extras/modem-modeswitch/option.c')
| -rw-r--r-- | extras/modem-modeswitch/option.c | 131 |
1 files changed, 131 insertions, 0 deletions
diff --git a/extras/modem-modeswitch/option.c b/extras/modem-modeswitch/option.c new file mode 100644 index 0000000000..5b299fd1bf --- /dev/null +++ b/extras/modem-modeswitch/option.c @@ -0,0 +1,131 @@ +/* + * Modem mode switcher + * + * Copyright (C) 2008 Dan Williams <dcbw@redhat.com> + * Copyright (C) 2008 Peter Henn <support@option.com> + * + * Heavily based on the 'ozerocdoff' tool by Peter Henn. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details: + */ + +#include <usb.h> + +#include "utils.h" +#include "option.h" + +/* Borrowed from /usr/include/linux/usb/ch9.h */ +#define USB_ENDPOINT_XFERTYPE_MASK 0x03 /* in bmAttributes */ +#define USB_ENDPOINT_XFER_BULK 2 +#define USB_ENDPOINT_DIR_MASK 0x80 +#define USB_DIR_OUT 0 /* to device */ +#define USB_DIR_IN 0x80 /* to host */ + +struct usb_device * +option_zerocd_find (int vid, int pid) +{ + struct usb_bus *bus; + struct usb_device *dev; + + for (bus = usb_get_busses(); bus; bus = bus->next) { + for (dev = bus->devices; dev; dev = dev->next) { + if (dev->descriptor.idVendor == vid && dev->descriptor.idProduct == pid) { + debug ("Found mass storage device:"); + debug (" Endpoints: %d", dev->config[0].interface[0].altsetting[0].bNumEndpoints); + debug (" Class: 0x%X", dev->config[0].interface[0].altsetting[0].bInterfaceClass); + debug (" SubClass: 0x%X", dev->config[0].interface[0].altsetting[0].bInterfaceSubClass); + debug (" Protocol: 0x%X", dev->config[0].interface[0].altsetting[0].bInterfaceProtocol); + + if ( (dev->config[0].interface[0].altsetting[0].bNumEndpoints == 2) + && (dev->config[0].interface[0].altsetting[0].bInterfaceClass == 0x08) + && (dev->config[0].interface[0].altsetting[0].bInterfaceSubClass == 0x06) + && (dev->config[0].interface[0].altsetting[0].bInterfaceProtocol == 0x50) ) { + debug ("Found modem mass storage device '%s'", dev->filename); + return dev; + } + } + } + } + return NULL; +} + +static int +find_endpoints (struct usb_device *dev, int *in_ep, int *out_ep) +{ + int i; + + for (i = 0; i < dev->config[0].interface[0].altsetting[0].bNumEndpoints; i++) { + struct usb_endpoint_descriptor *ep = &(dev->config[0].interface[0].altsetting[0].endpoint[i]); + + if ((ep->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_BULK) { + unsigned int direction = ep->bEndpointAddress & USB_ENDPOINT_DIR_MASK; + + if (!*out_ep && (direction == USB_DIR_OUT)) + *out_ep = ep->bEndpointAddress; + else if (!*in_ep && (direction == USB_DIR_IN)) + *in_ep = ep->bEndpointAddress; + } + + if (*in_ep && *out_ep) + return 0; + } + + return -1; +} + +int +option_zerocd_switch (struct usb_dev_handle *dh, struct usb_device *dev) +{ + const char const rezero_cbw[] = { + 0x55, 0x53, 0x42, 0x43, /* bulk command signature (LE) */ + 0x78, 0x56, 0x34, 0x12, /* bulk command host tag */ + 0x01, 0x00, 0x00, 0x00, /* bulk command data transfer length (LE) */ + 0x80, /* flags: direction data-in */ + 0x00, /* LUN */ + 0x06, /* SCSI command length */ + 0x01, /* SCSI command: REZERO */ + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* filler */ + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 + }; + + int ret = -1, ep_in = 0, ep_out = 0; + char buffer[256]; + + /* Find the device's bulk in and out endpoints */ + if (find_endpoints (dev, &ep_in, &ep_out) < 0) { + debug ("%s: couldn't find correct USB endpoints.", dev->filename); + goto out; + } + + usb_clear_halt (dh, ep_out); + ret = usb_set_altinterface (dh, 0); + if (ret != 0) { + debug ("%s: couldn't set device alternate interface.", dev->filename); + goto out; + } + + /* Let the mass storage device settle */ + sleep (1); + + /* Send the modeswitch command */ + ret = usb_bulk_write (dh, ep_out, (char *) rezero_cbw, sizeof (rezero_cbw), 1000); + if (ret < 0) + return ret; + + debug ("%s: REZERO command sent.", dev->filename); + + /* Some devices need to be read from */ + ret = usb_bulk_read (dh, ep_in, buffer, sizeof (buffer), 1000); + +out: + return ret; +} + |