Commit | Line | Data |
---|---|---|
281b064f DW |
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> | |
5a0e3ad6 | 24 | #include <linux/slab.h> |
6eb0de82 | 25 | #include <linux/module.h> |
281b064f DW |
26 | |
27 | #include "usb.h" | |
28 | #include "transport.h" | |
29 | #include "option_ms.h" | |
30 | #include "debug.h" | |
31 | ||
32 | #define ZCD_FORCE_MODEM 0x01 | |
33 | #define ZCD_ALLOW_MS 0x02 | |
34 | ||
35 | static unsigned int option_zero_cd = ZCD_FORCE_MODEM; | |
36 | module_param(option_zero_cd, uint, S_IRUGO | S_IWUSR); | |
37 | MODULE_PARM_DESC(option_zero_cd, "ZeroCD mode (1=Force Modem (default)," | |
38 | " 2=Allow CD-Rom"); | |
39 | ||
40 | #define RESPONSE_LEN 1024 | |
41 | ||
32ebbe7b | 42 | static int option_rezero(struct us_data *us) |
281b064f DW |
43 | { |
44 | const unsigned char rezero_msg[] = { | |
45 | 0x55, 0x53, 0x42, 0x43, 0x78, 0x56, 0x34, 0x12, | |
46 | 0x01, 0x00, 0x00, 0x00, 0x80, 0x00, 0x06, 0x01, | |
47 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, | |
48 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 | |
49 | }; | |
50 | char *buffer; | |
51 | int result; | |
52 | ||
191648d0 | 53 | usb_stor_dbg(us, "Option MS: %s\n", "DEVICE MODE SWITCH"); |
281b064f DW |
54 | |
55 | buffer = kzalloc(RESPONSE_LEN, GFP_KERNEL); | |
56 | if (buffer == NULL) | |
57 | return USB_STOR_TRANSPORT_ERROR; | |
58 | ||
32ebbe7b | 59 | memcpy(buffer, rezero_msg, sizeof(rezero_msg)); |
281b064f | 60 | result = usb_stor_bulk_transfer_buf(us, |
32ebbe7b JD |
61 | us->send_bulk_pipe, |
62 | buffer, sizeof(rezero_msg), NULL); | |
281b064f DW |
63 | if (result != USB_STOR_XFER_GOOD) { |
64 | result = USB_STOR_XFER_ERROR; | |
65 | goto out; | |
66 | } | |
67 | ||
68 | /* Some of the devices need to be asked for a response, but we don't | |
69 | * care what that response is. | |
70 | */ | |
32ebbe7b JD |
71 | usb_stor_bulk_transfer_buf(us, |
72 | us->recv_bulk_pipe, | |
281b064f | 73 | buffer, RESPONSE_LEN, NULL); |
32ebbe7b JD |
74 | |
75 | /* Read the CSW */ | |
76 | usb_stor_bulk_transfer_buf(us, | |
77 | us->recv_bulk_pipe, | |
78 | buffer, 13, NULL); | |
79 | ||
281b064f DW |
80 | result = USB_STOR_XFER_GOOD; |
81 | ||
82 | out: | |
83 | kfree(buffer); | |
84 | return result; | |
85 | } | |
86 | ||
32ebbe7b | 87 | static int option_inquiry(struct us_data *us) |
281b064f | 88 | { |
32ebbe7b JD |
89 | const unsigned char inquiry_msg[] = { |
90 | 0x55, 0x53, 0x42, 0x43, 0x12, 0x34, 0x56, 0x78, | |
91 | 0x24, 0x00, 0x00, 0x00, 0x80, 0x00, 0x06, 0x12, | |
92 | 0x00, 0x00, 0x00, 0x24, 0x00, 0x00, 0x00, 0x00, | |
93 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 | |
94 | }; | |
95 | char *buffer; | |
96 | int result; | |
281b064f | 97 | |
191648d0 | 98 | usb_stor_dbg(us, "Option MS: %s\n", "device inquiry for vendor name"); |
281b064f | 99 | |
32ebbe7b JD |
100 | buffer = kzalloc(0x24, GFP_KERNEL); |
101 | if (buffer == NULL) | |
102 | return USB_STOR_TRANSPORT_ERROR; | |
103 | ||
104 | memcpy(buffer, inquiry_msg, sizeof(inquiry_msg)); | |
105 | result = usb_stor_bulk_transfer_buf(us, | |
106 | us->send_bulk_pipe, | |
107 | buffer, sizeof(inquiry_msg), NULL); | |
108 | if (result != USB_STOR_XFER_GOOD) { | |
109 | result = USB_STOR_XFER_ERROR; | |
110 | goto out; | |
281b064f DW |
111 | } |
112 | ||
32ebbe7b JD |
113 | result = usb_stor_bulk_transfer_buf(us, |
114 | us->recv_bulk_pipe, | |
115 | buffer, 0x24, NULL); | |
116 | if (result != USB_STOR_XFER_GOOD) { | |
117 | result = USB_STOR_XFER_ERROR; | |
118 | goto out; | |
281b064f DW |
119 | } |
120 | ||
32ebbe7b JD |
121 | result = memcmp(buffer+8, "Option", 6); |
122 | ||
2ab2178c JM |
123 | if (result != 0) |
124 | result = memcmp(buffer+8, "ZCOPTION", 8); | |
125 | ||
32ebbe7b JD |
126 | /* Read the CSW */ |
127 | usb_stor_bulk_transfer_buf(us, | |
128 | us->recv_bulk_pipe, | |
129 | buffer, 13, NULL); | |
130 | ||
131 | out: | |
132 | kfree(buffer); | |
133 | return result; | |
134 | } | |
135 | ||
136 | ||
137 | int option_ms_init(struct us_data *us) | |
138 | { | |
139 | int result; | |
140 | ||
191648d0 | 141 | usb_stor_dbg(us, "Option MS: %s\n", "option_ms_init called"); |
32ebbe7b JD |
142 | |
143 | /* Additional test for vendor information via INQUIRY, | |
144 | * because some vendor/product IDs are ambiguous | |
145 | */ | |
146 | result = option_inquiry(us); | |
147 | if (result != 0) { | |
191648d0 JP |
148 | usb_stor_dbg(us, "Option MS: %s\n", |
149 | "vendor is not Option or not determinable, no action taken"); | |
be475d90 | 150 | return 0; |
32ebbe7b | 151 | } else |
191648d0 JP |
152 | usb_stor_dbg(us, "Option MS: %s\n", |
153 | "this is a genuine Option device, proceeding"); | |
281b064f DW |
154 | |
155 | /* Force Modem mode */ | |
156 | if (option_zero_cd == ZCD_FORCE_MODEM) { | |
191648d0 | 157 | usb_stor_dbg(us, "Option MS: %s\n", "Forcing Modem Mode"); |
32ebbe7b | 158 | result = option_rezero(us); |
281b064f | 159 | if (result != USB_STOR_XFER_GOOD) |
191648d0 JP |
160 | usb_stor_dbg(us, "Option MS: %s\n", |
161 | "Failed to switch to modem mode"); | |
281b064f DW |
162 | return -EIO; |
163 | } else if (option_zero_cd == ZCD_ALLOW_MS) { | |
164 | /* Allow Mass Storage mode (keep CD-Rom) */ | |
191648d0 JP |
165 | usb_stor_dbg(us, "Option MS: %s\n", |
166 | "Allowing Mass Storage Mode if device requests it"); | |
281b064f DW |
167 | } |
168 | ||
be475d90 | 169 | return 0; |
281b064f DW |
170 | } |
171 |