1 /* 2 * Driver for Option High Speed Mobile Devices. 3 * 4 * (c) 2008 Dan Williams <dcbw@redhat.com> 5 * 6 * Inspiration taken from sierra_ms.c by Kevin Lloyd <klloyd@sierrawireless.com> 7 * 8 * This program is free software; you can redistribute it and/or modify 9 * it under the terms of the GNU General Public License as published by 10 * the Free Software Foundation; either version 2 of the License, or 11 * (at your option) any later version. 12 * 13 * This program is distributed in the hope that it will be useful, but 14 * WITHOUT ANY WARRANTY; without even the implied warranty of 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 16 * General Public License for more details. 17 * 18 * You should have received a copy of the GNU General Public License along 19 * with this program; if not, write to the Free Software Foundation, Inc., 20 * 675 Mass Ave, Cambridge, MA 02139, USA. 21 */ 22 23 #include <linux/usb.h> 24 25 #include "usb.h" 26 #include "transport.h" 27 #include "option_ms.h" 28 #include "debug.h" 29 30 #define ZCD_FORCE_MODEM 0x01 31 #define ZCD_ALLOW_MS 0x02 32 33 static unsigned int option_zero_cd = ZCD_FORCE_MODEM; 34 module_param(option_zero_cd, uint, S_IRUGO | S_IWUSR); 35 MODULE_PARM_DESC(option_zero_cd, "ZeroCD mode (1=Force Modem (default)," 36 " 2=Allow CD-Rom"); 37 38 #define RESPONSE_LEN 1024 39 40 static int option_rezero(struct us_data *us, int ep_in, int ep_out) 41 { 42 const unsigned char rezero_msg[] = { 43 0x55, 0x53, 0x42, 0x43, 0x78, 0x56, 0x34, 0x12, 44 0x01, 0x00, 0x00, 0x00, 0x80, 0x00, 0x06, 0x01, 45 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 46 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 47 }; 48 char *buffer; 49 int result; 50 51 US_DEBUGP("Option MS: %s", "DEVICE MODE SWITCH\n"); 52 53 buffer = kzalloc(RESPONSE_LEN, GFP_KERNEL); 54 if (buffer == NULL) 55 return USB_STOR_TRANSPORT_ERROR; 56 57 memcpy(buffer, rezero_msg, sizeof (rezero_msg)); 58 result = usb_stor_bulk_transfer_buf(us, 59 usb_sndbulkpipe(us->pusb_dev, ep_out), 60 buffer, sizeof (rezero_msg), NULL); 61 if (result != USB_STOR_XFER_GOOD) { 62 result = USB_STOR_XFER_ERROR; 63 goto out; 64 } 65 66 /* Some of the devices need to be asked for a response, but we don't 67 * care what that response is. 68 */ 69 result = usb_stor_bulk_transfer_buf(us, 70 usb_sndbulkpipe(us->pusb_dev, ep_out), 71 buffer, RESPONSE_LEN, NULL); 72 result = USB_STOR_XFER_GOOD; 73 74 out: 75 kfree(buffer); 76 return result; 77 } 78 79 int option_ms_init(struct us_data *us) 80 { 81 struct usb_device *udev; 82 struct usb_interface *intf; 83 struct usb_host_interface *iface_desc; 84 struct usb_endpoint_descriptor *endpoint = NULL; 85 u8 ep_in = 0, ep_out = 0; 86 int ep_in_size = 0, ep_out_size = 0; 87 int i, result; 88 89 udev = us->pusb_dev; 90 intf = us->pusb_intf; 91 92 /* Ensure it's really a ZeroCD device; devices that are already 93 * in modem mode return 0xFF for class, subclass, and protocol. 94 */ 95 if (udev->descriptor.bDeviceClass != 0 || 96 udev->descriptor.bDeviceSubClass != 0 || 97 udev->descriptor.bDeviceProtocol != 0 || 98 udev->actconfig->desc.bNumInterfaces == 3) 99 return USB_STOR_TRANSPORT_GOOD; 100 101 US_DEBUGP("Option MS: option_ms_init called\n"); 102 103 /* Find the right mass storage interface */ 104 iface_desc = intf->cur_altsetting; 105 if (iface_desc->desc.bInterfaceClass != 0x8 || 106 iface_desc->desc.bInterfaceSubClass != 0x6 || 107 iface_desc->desc.bInterfaceProtocol != 0x50) { 108 US_DEBUGP("Option MS: mass storage interface not found, no action " 109 "required\n"); 110 return USB_STOR_TRANSPORT_GOOD; 111 } 112 113 /* Find the mass storage bulk endpoints */ 114 for (i = 0; i < iface_desc->desc.bNumEndpoints && (!ep_in_size || !ep_out_size); ++i) { 115 endpoint = &iface_desc->endpoint[i].desc; 116 117 if (usb_endpoint_is_bulk_in(endpoint)) { 118 ep_in = usb_endpoint_num(endpoint); 119 ep_in_size = le16_to_cpu(endpoint->wMaxPacketSize); 120 } else if (usb_endpoint_is_bulk_out(endpoint)) { 121 ep_out = usb_endpoint_num(endpoint); 122 ep_out_size = le16_to_cpu(endpoint->wMaxPacketSize); 123 } 124 } 125 126 /* Can't find the mass storage endpoints */ 127 if (!ep_in_size || !ep_out_size) { 128 US_DEBUGP("Option MS: mass storage endpoints not found, no action " 129 "required\n"); 130 return USB_STOR_TRANSPORT_GOOD; 131 } 132 133 /* Force Modem mode */ 134 if (option_zero_cd == ZCD_FORCE_MODEM) { 135 US_DEBUGP("Option MS: %s", "Forcing Modem Mode\n"); 136 result = option_rezero(us, ep_in, ep_out); 137 if (result != USB_STOR_XFER_GOOD) 138 US_DEBUGP("Option MS: Failed to switch to modem mode.\n"); 139 return -EIO; 140 } else if (option_zero_cd == ZCD_ALLOW_MS) { 141 /* Allow Mass Storage mode (keep CD-Rom) */ 142 US_DEBUGP("Option MS: %s", "Allowing Mass Storage Mode if device" 143 " requests it\n"); 144 } 145 146 return USB_STOR_TRANSPORT_GOOD; 147 } 148 149