2 * multi.c -- Multifunction Composite driver
4 * Copyright (C) 2008 David Brownell
5 * Copyright (C) 2008 Nokia Corporation
6 * Copyright (C) 2009 Samsung Electronics
7 * Author: Michal Nazarewicz (mina86@mina86.com)
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.
16 #include <linux/kernel.h>
17 #include <linux/module.h>
20 #if defined USB_ETH_RNDIS
23 #ifdef CONFIG_USB_G_MULTI_RNDIS
24 # define USB_ETH_RNDIS y
28 #define DRIVER_DESC "Multifunction Composite Gadget"
30 MODULE_DESCRIPTION(DRIVER_DESC
);
31 MODULE_AUTHOR("Michal Nazarewicz");
32 MODULE_LICENSE("GPL");
35 /***************************** All the files... *****************************/
38 * kbuild is not very cooperative with respect to linking separately
39 * compiled library objects into one module. So for now we won't use
40 * separate compilation ... ensuring init/exit sections work to shrink
41 * the runtime footprint, and giving us at least some parts of what
42 * a "gcc --combine ... part1.c part2.c part3.c ... " build would.
44 #include "f_mass_storage.c"
54 USB_GADGET_COMPOSITE_OPTIONS();
56 /***************************** Device Descriptor ****************************/
58 #define MULTI_VENDOR_NUM 0x1d6b /* Linux Foundation */
59 #define MULTI_PRODUCT_NUM 0x0104 /* Multifunction Composite Gadget */
64 #ifdef CONFIG_USB_G_MULTI_RNDIS
65 MULTI_RNDIS_CONFIG_NUM
,
67 #ifdef CONFIG_USB_G_MULTI_CDC
73 static struct usb_device_descriptor device_desc
= {
74 .bLength
= sizeof device_desc
,
75 .bDescriptorType
= USB_DT_DEVICE
,
77 .bcdUSB
= cpu_to_le16(0x0200),
79 .bDeviceClass
= USB_CLASS_MISC
/* 0xEF */,
83 /* Vendor and product id can be overridden by module parameters. */
84 .idVendor
= cpu_to_le16(MULTI_VENDOR_NUM
),
85 .idProduct
= cpu_to_le16(MULTI_PRODUCT_NUM
),
89 static const struct usb_descriptor_header
*otg_desc
[] = {
90 (struct usb_descriptor_header
*) &(struct usb_otg_descriptor
){
91 .bLength
= sizeof(struct usb_otg_descriptor
),
92 .bDescriptorType
= USB_DT_OTG
,
95 * REVISIT SRP-only hardware is possible, although
96 * it would not be called "OTG" ...
98 .bmAttributes
= USB_OTG_SRP
| USB_OTG_HNP
,
105 MULTI_STRING_RNDIS_CONFIG_IDX
= USB_GADGET_FIRST_AVAIL_IDX
,
106 MULTI_STRING_CDC_CONFIG_IDX
,
109 static struct usb_string strings_dev
[] = {
110 [USB_GADGET_MANUFACTURER_IDX
].s
= "",
111 [USB_GADGET_PRODUCT_IDX
].s
= DRIVER_DESC
,
112 [USB_GADGET_SERIAL_IDX
].s
= "",
113 [MULTI_STRING_RNDIS_CONFIG_IDX
].s
= "Multifunction with RNDIS",
114 [MULTI_STRING_CDC_CONFIG_IDX
].s
= "Multifunction with CDC ECM",
115 { } /* end of list */
118 static struct usb_gadget_strings
*dev_strings
[] = {
119 &(struct usb_gadget_strings
){
120 .language
= 0x0409, /* en-us */
121 .strings
= strings_dev
,
129 /****************************** Configurations ******************************/
131 static struct fsg_module_parameters fsg_mod_data
= { .stall
= 1 };
132 FSG_MODULE_PARAMETERS(/* no prefix */, fsg_mod_data
);
134 static struct fsg_common fsg_common
;
136 static u8 hostaddr
[ETH_ALEN
];
138 static unsigned char tty_line
;
139 static struct usb_function_instance
*fi_acm
;
141 /********** RNDIS **********/
144 static struct usb_function
*f_acm_rndis
;
146 static __init
int rndis_do_config(struct usb_configuration
*c
)
150 if (gadget_is_otg(c
->cdev
->gadget
)) {
151 c
->descriptors
= otg_desc
;
152 c
->bmAttributes
|= USB_CONFIG_ATT_WAKEUP
;
155 ret
= rndis_bind_config(c
, hostaddr
);
159 f_acm_rndis
= usb_get_function(fi_acm
);
160 if (IS_ERR(f_acm_rndis
))
163 ret
= usb_add_function(c
, f_acm_rndis
);
167 ret
= fsg_bind_config(c
->cdev
, c
, &fsg_common
);
173 usb_remove_function(c
, f_acm_rndis
);
175 usb_put_function(f_acm_rndis
);
180 static int rndis_config_register(struct usb_composite_dev
*cdev
)
182 static struct usb_configuration config
= {
183 .bConfigurationValue
= MULTI_RNDIS_CONFIG_NUM
,
184 .bmAttributes
= USB_CONFIG_ATT_SELFPOWER
,
187 config
.label
= strings_dev
[MULTI_STRING_RNDIS_CONFIG_IDX
].s
;
188 config
.iConfiguration
= strings_dev
[MULTI_STRING_RNDIS_CONFIG_IDX
].id
;
190 return usb_add_config(cdev
, &config
, rndis_do_config
);
195 static int rndis_config_register(struct usb_composite_dev
*cdev
)
203 /********** CDC ECM **********/
205 #ifdef CONFIG_USB_G_MULTI_CDC
206 static struct usb_function
*f_acm_multi
;
208 static __init
int cdc_do_config(struct usb_configuration
*c
)
212 if (gadget_is_otg(c
->cdev
->gadget
)) {
213 c
->descriptors
= otg_desc
;
214 c
->bmAttributes
|= USB_CONFIG_ATT_WAKEUP
;
217 ret
= ecm_bind_config(c
, hostaddr
);
221 /* implicit port_num is zero */
222 f_acm_multi
= usb_get_function(fi_acm
);
223 if (IS_ERR(f_acm_multi
))
226 ret
= usb_add_function(c
, f_acm_multi
);
230 ret
= fsg_bind_config(c
->cdev
, c
, &fsg_common
);
236 usb_remove_function(c
, f_acm_multi
);
238 usb_put_function(f_acm_multi
);
243 static int cdc_config_register(struct usb_composite_dev
*cdev
)
245 static struct usb_configuration config
= {
246 .bConfigurationValue
= MULTI_CDC_CONFIG_NUM
,
247 .bmAttributes
= USB_CONFIG_ATT_SELFPOWER
,
250 config
.label
= strings_dev
[MULTI_STRING_CDC_CONFIG_IDX
].s
;
251 config
.iConfiguration
= strings_dev
[MULTI_STRING_CDC_CONFIG_IDX
].id
;
253 return usb_add_config(cdev
, &config
, cdc_do_config
);
258 static int cdc_config_register(struct usb_composite_dev
*cdev
)
267 /****************************** Gadget Bind ******************************/
269 static int __ref
multi_bind(struct usb_composite_dev
*cdev
)
271 struct usb_gadget
*gadget
= cdev
->gadget
;
272 struct f_serial_opts
*opts
;
275 if (!can_support_ecm(cdev
->gadget
)) {
276 dev_err(&gadget
->dev
, "controller '%s' not usable\n",
281 /* set up network link layer */
282 status
= gether_setup(cdev
->gadget
, hostaddr
);
286 /* set up serial link layer */
287 status
= gserial_alloc_line(&tty_line
);
291 fi_acm
= usb_get_function_instance("acm");
292 if (IS_ERR(fi_acm
)) {
293 status
= PTR_ERR(fi_acm
);
297 opts
= container_of(fi_acm
, struct f_serial_opts
, func_inst
);
298 opts
->port_num
= tty_line
;
300 /* set up mass storage function */
303 retp
= fsg_common_from_params(&fsg_common
, cdev
, &fsg_mod_data
);
305 status
= PTR_ERR(retp
);
310 /* allocate string IDs */
311 status
= usb_string_ids_tab(cdev
, strings_dev
);
312 if (unlikely(status
< 0))
314 device_desc
.iProduct
= strings_dev
[USB_GADGET_PRODUCT_IDX
].id
;
316 /* register configurations */
317 status
= rndis_config_register(cdev
);
318 if (unlikely(status
< 0))
321 status
= cdc_config_register(cdev
);
322 if (unlikely(status
< 0))
324 usb_composite_overwrite_options(cdev
, &coverwrite
);
327 dev_info(&gadget
->dev
, DRIVER_DESC
"\n");
328 fsg_common_put(&fsg_common
);
334 fsg_common_put(&fsg_common
);
336 usb_put_function_instance(fi_acm
);
338 gserial_free_line(tty_line
);
344 static int __exit
multi_unbind(struct usb_composite_dev
*cdev
)
346 #ifdef CONFIG_USB_G_MULTI_CDC
347 usb_put_function(f_acm_multi
);
350 usb_put_function(f_acm_rndis
);
352 usb_put_function_instance(fi_acm
);
353 gserial_free_line(tty_line
);
359 /****************************** Some noise ******************************/
362 static __refdata
struct usb_composite_driver multi_driver
= {
365 .strings
= dev_strings
,
366 .max_speed
= USB_SPEED_HIGH
,
368 .unbind
= __exit_p(multi_unbind
),
373 static int __init
multi_init(void)
375 return usb_composite_probe(&multi_driver
);
377 module_init(multi_init
);
379 static void __exit
multi_exit(void)
381 usb_composite_unregister(&multi_driver
);
383 module_exit(multi_exit
);