Commit | Line | Data |
---|---|---|
f176a5d8 MN |
1 | /* |
2 | * multi.c -- Multifunction Composite driver | |
3 | * | |
4 | * Copyright (C) 2008 David Brownell | |
5 | * Copyright (C) 2008 Nokia Corporation | |
6 | * Copyright (C) 2009 Samsung Electronics | |
54b8360f | 7 | * Author: Michal Nazarewicz (mina86@mina86.com) |
f176a5d8 MN |
8 | * |
9 | * This program is free software; you can redistribute it and/or modify | |
10 | * it under the terms of the GNU General Public License as published by | |
11 | * the Free Software Foundation; either version 2 of the License, or | |
12 | * (at your option) any later version. | |
f176a5d8 MN |
13 | */ |
14 | ||
15 | ||
16 | #include <linux/kernel.h> | |
279cc49a | 17 | #include <linux/module.h> |
f176a5d8 | 18 | |
396cda90 MN |
19 | #if defined USB_ETH_RNDIS |
20 | # undef USB_ETH_RNDIS | |
21 | #endif | |
dbe4a99d | 22 | #ifdef CONFIG_USB_G_MULTI_RNDIS |
396cda90 | 23 | # define USB_ETH_RNDIS y |
f176a5d8 MN |
24 | #endif |
25 | ||
26 | ||
27 | #define DRIVER_DESC "Multifunction Composite Gadget" | |
f176a5d8 | 28 | |
279cc49a MN |
29 | MODULE_DESCRIPTION(DRIVER_DESC); |
30 | MODULE_AUTHOR("Michal Nazarewicz"); | |
31 | MODULE_LICENSE("GPL"); | |
f176a5d8 | 32 | |
f176a5d8 | 33 | |
279cc49a | 34 | /***************************** All the files... *****************************/ |
f176a5d8 MN |
35 | |
36 | /* | |
37 | * kbuild is not very cooperative with respect to linking separately | |
38 | * compiled library objects into one module. So for now we won't use | |
39 | * separate compilation ... ensuring init/exit sections work to shrink | |
40 | * the runtime footprint, and giving us at least some parts of what | |
41 | * a "gcc --combine ... part1.c part2.c part3.c ... " build would. | |
42 | */ | |
279cc49a MN |
43 | #include "f_mass_storage.c" |
44 | ||
f176a5d8 MN |
45 | #include "u_serial.c" |
46 | #include "f_acm.c" | |
47 | ||
48 | #include "f_ecm.c" | |
49 | #include "f_subset.c" | |
396cda90 | 50 | #ifdef USB_ETH_RNDIS |
f176a5d8 MN |
51 | # include "f_rndis.c" |
52 | # include "rndis.c" | |
53 | #endif | |
54 | #include "u_ether.c" | |
55 | ||
7d16e8d3 | 56 | USB_GADGET_COMPOSITE_OPTIONS(); |
279cc49a MN |
57 | |
58 | /***************************** Device Descriptor ****************************/ | |
59 | ||
1c6529e9 MN |
60 | #define MULTI_VENDOR_NUM 0x1d6b /* Linux Foundation */ |
61 | #define MULTI_PRODUCT_NUM 0x0104 /* Multifunction Composite Gadget */ | |
279cc49a MN |
62 | |
63 | ||
64 | enum { | |
65 | __MULTI_NO_CONFIG, | |
66 | #ifdef CONFIG_USB_G_MULTI_RNDIS | |
67 | MULTI_RNDIS_CONFIG_NUM, | |
68 | #endif | |
69 | #ifdef CONFIG_USB_G_MULTI_CDC | |
70 | MULTI_CDC_CONFIG_NUM, | |
71 | #endif | |
72 | }; | |
73 | ||
f176a5d8 MN |
74 | |
75 | static struct usb_device_descriptor device_desc = { | |
76 | .bLength = sizeof device_desc, | |
77 | .bDescriptorType = USB_DT_DEVICE, | |
78 | ||
79 | .bcdUSB = cpu_to_le16(0x0200), | |
80 | ||
279cc49a | 81 | .bDeviceClass = USB_CLASS_MISC /* 0xEF */, |
f176a5d8 MN |
82 | .bDeviceSubClass = 2, |
83 | .bDeviceProtocol = 1, | |
f176a5d8 MN |
84 | |
85 | /* Vendor and product id can be overridden by module parameters. */ | |
86 | .idVendor = cpu_to_le16(MULTI_VENDOR_NUM), | |
87 | .idProduct = cpu_to_le16(MULTI_PRODUCT_NUM), | |
f176a5d8 MN |
88 | }; |
89 | ||
f176a5d8 MN |
90 | |
91 | static const struct usb_descriptor_header *otg_desc[] = { | |
279cc49a MN |
92 | (struct usb_descriptor_header *) &(struct usb_otg_descriptor){ |
93 | .bLength = sizeof(struct usb_otg_descriptor), | |
94 | .bDescriptorType = USB_DT_OTG, | |
95 | ||
96 | /* | |
97 | * REVISIT SRP-only hardware is possible, although | |
98 | * it would not be called "OTG" ... | |
99 | */ | |
100 | .bmAttributes = USB_OTG_SRP | USB_OTG_HNP, | |
101 | }, | |
f176a5d8 MN |
102 | NULL, |
103 | }; | |
104 | ||
105 | ||
279cc49a | 106 | enum { |
276e2e4f | 107 | MULTI_STRING_RNDIS_CONFIG_IDX = USB_GADGET_FIRST_AVAIL_IDX, |
279cc49a | 108 | MULTI_STRING_CDC_CONFIG_IDX, |
279cc49a | 109 | }; |
f176a5d8 | 110 | |
f176a5d8 | 111 | static struct usb_string strings_dev[] = { |
276e2e4f | 112 | [USB_GADGET_MANUFACTURER_IDX].s = "", |
d33f74fc | 113 | [USB_GADGET_PRODUCT_IDX].s = DRIVER_DESC, |
276e2e4f | 114 | [USB_GADGET_SERIAL_IDX].s = "", |
279cc49a | 115 | [MULTI_STRING_RNDIS_CONFIG_IDX].s = "Multifunction with RNDIS", |
279cc49a | 116 | [MULTI_STRING_CDC_CONFIG_IDX].s = "Multifunction with CDC ECM", |
f176a5d8 MN |
117 | { } /* end of list */ |
118 | }; | |
119 | ||
f176a5d8 | 120 | static struct usb_gadget_strings *dev_strings[] = { |
279cc49a MN |
121 | &(struct usb_gadget_strings){ |
122 | .language = 0x0409, /* en-us */ | |
123 | .strings = strings_dev, | |
124 | }, | |
f176a5d8 MN |
125 | NULL, |
126 | }; | |
127 | ||
f176a5d8 MN |
128 | |
129 | ||
130 | ||
131 | /****************************** Configurations ******************************/ | |
132 | ||
279cc49a MN |
133 | static struct fsg_module_parameters fsg_mod_data = { .stall = 1 }; |
134 | FSG_MODULE_PARAMETERS(/* no prefix */, fsg_mod_data); | |
135 | ||
136 | static struct fsg_common fsg_common; | |
137 | ||
138 | static u8 hostaddr[ETH_ALEN]; | |
f176a5d8 | 139 | |
f176a5d8 | 140 | |
279cc49a | 141 | /********** RNDIS **********/ |
f176a5d8 | 142 | |
396cda90 | 143 | #ifdef USB_ETH_RNDIS |
f176a5d8 | 144 | |
c9bfff9c | 145 | static __init int rndis_do_config(struct usb_configuration *c) |
f176a5d8 MN |
146 | { |
147 | int ret; | |
148 | ||
149 | if (gadget_is_otg(c->cdev->gadget)) { | |
150 | c->descriptors = otg_desc; | |
151 | c->bmAttributes |= USB_CONFIG_ATT_WAKEUP; | |
152 | } | |
153 | ||
154 | ret = rndis_bind_config(c, hostaddr); | |
155 | if (ret < 0) | |
156 | return ret; | |
157 | ||
158 | ret = acm_bind_config(c, 0); | |
159 | if (ret < 0) | |
160 | return ret; | |
161 | ||
279cc49a | 162 | ret = fsg_bind_config(c->cdev, c, &fsg_common); |
f176a5d8 MN |
163 | if (ret < 0) |
164 | return ret; | |
165 | ||
166 | return 0; | |
167 | } | |
168 | ||
279cc49a MN |
169 | static int rndis_config_register(struct usb_composite_dev *cdev) |
170 | { | |
171 | static struct usb_configuration config = { | |
279cc49a MN |
172 | .bConfigurationValue = MULTI_RNDIS_CONFIG_NUM, |
173 | .bmAttributes = USB_CONFIG_ATT_SELFPOWER, | |
174 | }; | |
175 | ||
176 | config.label = strings_dev[MULTI_STRING_RNDIS_CONFIG_IDX].s; | |
177 | config.iConfiguration = strings_dev[MULTI_STRING_RNDIS_CONFIG_IDX].id; | |
178 | ||
c9bfff9c | 179 | return usb_add_config(cdev, &config, rndis_do_config); |
279cc49a MN |
180 | } |
181 | ||
182 | #else | |
183 | ||
184 | static int rndis_config_register(struct usb_composite_dev *cdev) | |
185 | { | |
186 | return 0; | |
187 | } | |
f176a5d8 MN |
188 | |
189 | #endif | |
190 | ||
279cc49a MN |
191 | |
192 | /********** CDC ECM **********/ | |
193 | ||
f176a5d8 MN |
194 | #ifdef CONFIG_USB_G_MULTI_CDC |
195 | ||
c9bfff9c | 196 | static __init int cdc_do_config(struct usb_configuration *c) |
f176a5d8 MN |
197 | { |
198 | int ret; | |
199 | ||
200 | if (gadget_is_otg(c->cdev->gadget)) { | |
201 | c->descriptors = otg_desc; | |
202 | c->bmAttributes |= USB_CONFIG_ATT_WAKEUP; | |
203 | } | |
204 | ||
205 | ret = ecm_bind_config(c, hostaddr); | |
206 | if (ret < 0) | |
207 | return ret; | |
208 | ||
209 | ret = acm_bind_config(c, 0); | |
210 | if (ret < 0) | |
211 | return ret; | |
212 | ||
279cc49a | 213 | ret = fsg_bind_config(c->cdev, c, &fsg_common); |
f176a5d8 MN |
214 | if (ret < 0) |
215 | return ret; | |
f176a5d8 MN |
216 | |
217 | return 0; | |
218 | } | |
219 | ||
279cc49a MN |
220 | static int cdc_config_register(struct usb_composite_dev *cdev) |
221 | { | |
222 | static struct usb_configuration config = { | |
279cc49a MN |
223 | .bConfigurationValue = MULTI_CDC_CONFIG_NUM, |
224 | .bmAttributes = USB_CONFIG_ATT_SELFPOWER, | |
225 | }; | |
226 | ||
227 | config.label = strings_dev[MULTI_STRING_CDC_CONFIG_IDX].s; | |
228 | config.iConfiguration = strings_dev[MULTI_STRING_CDC_CONFIG_IDX].id; | |
229 | ||
c9bfff9c | 230 | return usb_add_config(cdev, &config, cdc_do_config); |
279cc49a MN |
231 | } |
232 | ||
233 | #else | |
234 | ||
235 | static int cdc_config_register(struct usb_composite_dev *cdev) | |
236 | { | |
237 | return 0; | |
238 | } | |
f176a5d8 MN |
239 | |
240 | #endif | |
241 | ||
242 | ||
243 | ||
244 | /****************************** Gadget Bind ******************************/ | |
245 | ||
246 | ||
279cc49a | 247 | static int __ref multi_bind(struct usb_composite_dev *cdev) |
f176a5d8 MN |
248 | { |
249 | struct usb_gadget *gadget = cdev->gadget; | |
250 | int status, gcnum; | |
251 | ||
252 | if (!can_support_ecm(cdev->gadget)) { | |
253 | dev_err(&gadget->dev, "controller '%s' not usable\n", | |
254 | gadget->name); | |
255 | return -EINVAL; | |
256 | } | |
257 | ||
258 | /* set up network link layer */ | |
259 | status = gether_setup(cdev->gadget, hostaddr); | |
260 | if (status < 0) | |
261 | return status; | |
262 | ||
263 | /* set up serial link layer */ | |
264 | status = gserial_setup(cdev->gadget, 1); | |
265 | if (status < 0) | |
266 | goto fail0; | |
267 | ||
268 | /* set up mass storage function */ | |
279cc49a MN |
269 | { |
270 | void *retp; | |
271 | retp = fsg_common_from_params(&fsg_common, cdev, &fsg_mod_data); | |
272 | if (IS_ERR(retp)) { | |
273 | status = PTR_ERR(retp); | |
274 | goto fail1; | |
275 | } | |
f176a5d8 MN |
276 | } |
277 | ||
279cc49a | 278 | /* set bcdDevice */ |
f176a5d8 | 279 | gcnum = usb_gadget_controller_number(gadget); |
279cc49a | 280 | if (gcnum >= 0) { |
f176a5d8 | 281 | device_desc.bcdDevice = cpu_to_le16(0x0300 | gcnum); |
279cc49a MN |
282 | } else { |
283 | WARNING(cdev, "controller '%s' not recognized\n", gadget->name); | |
f176a5d8 MN |
284 | device_desc.bcdDevice = cpu_to_le16(0x0300 | 0x0099); |
285 | } | |
286 | ||
a99d8a45 | 287 | /* allocate string IDs */ |
279cc49a MN |
288 | status = usb_string_ids_tab(cdev, strings_dev); |
289 | if (unlikely(status < 0)) | |
f176a5d8 | 290 | goto fail2; |
d33f74fc | 291 | device_desc.iProduct = strings_dev[USB_GADGET_PRODUCT_IDX].id; |
f176a5d8 | 292 | |
279cc49a MN |
293 | /* register configurations */ |
294 | status = rndis_config_register(cdev); | |
295 | if (unlikely(status < 0)) | |
f176a5d8 | 296 | goto fail2; |
f176a5d8 | 297 | |
279cc49a MN |
298 | status = cdc_config_register(cdev); |
299 | if (unlikely(status < 0)) | |
f176a5d8 | 300 | goto fail2; |
7d16e8d3 | 301 | usb_composite_overwrite_options(cdev, &coverwrite); |
f176a5d8 | 302 | |
279cc49a MN |
303 | /* we're done */ |
304 | dev_info(&gadget->dev, DRIVER_DESC "\n"); | |
305 | fsg_common_put(&fsg_common); | |
f176a5d8 MN |
306 | return 0; |
307 | ||
279cc49a MN |
308 | |
309 | /* error recovery */ | |
f176a5d8 | 310 | fail2: |
279cc49a | 311 | fsg_common_put(&fsg_common); |
f176a5d8 MN |
312 | fail1: |
313 | gserial_cleanup(); | |
314 | fail0: | |
315 | gether_cleanup(); | |
316 | return status; | |
317 | } | |
318 | ||
319 | static int __exit multi_unbind(struct usb_composite_dev *cdev) | |
320 | { | |
321 | gserial_cleanup(); | |
322 | gether_cleanup(); | |
323 | return 0; | |
324 | } | |
325 | ||
326 | ||
327 | /****************************** Some noise ******************************/ | |
328 | ||
329 | ||
c2ec75c2 | 330 | static __refdata struct usb_composite_driver multi_driver = { |
f176a5d8 MN |
331 | .name = "g_multi", |
332 | .dev = &device_desc, | |
333 | .strings = dev_strings, | |
35a0e0bf | 334 | .max_speed = USB_SPEED_HIGH, |
03e42bd5 | 335 | .bind = multi_bind, |
f176a5d8 | 336 | .unbind = __exit_p(multi_unbind), |
a99d8a45 | 337 | .needs_serial = 1, |
f176a5d8 MN |
338 | }; |
339 | ||
f176a5d8 | 340 | |
279cc49a | 341 | static int __init multi_init(void) |
f176a5d8 | 342 | { |
03e42bd5 | 343 | return usb_composite_probe(&multi_driver); |
f176a5d8 | 344 | } |
279cc49a | 345 | module_init(multi_init); |
f176a5d8 | 346 | |
279cc49a | 347 | static void __exit multi_exit(void) |
f176a5d8 MN |
348 | { |
349 | usb_composite_unregister(&multi_driver); | |
350 | } | |
279cc49a | 351 | module_exit(multi_exit); |