2 * acm_ms.c -- Composite driver, with ACM and mass storage support
4 * Copyright (C) 2008 David Brownell
5 * Copyright (C) 2008 Nokia Corporation
6 * Author: David Brownell
7 * Modified: Klaus Schwarzkopf <schwarzkopf@sensortherm.de>
9 * Heavily based on multi.c and cdc2.c
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; either version 2 of the License, or
14 * (at your option) any later version.
17 #include <linux/kernel.h>
18 #include <linux/module.h>
22 #define DRIVER_DESC "Composite Gadget (ACM + MS)"
23 #define DRIVER_VERSION "2011/10/10"
25 /*-------------------------------------------------------------------------*/
28 * DO NOT REUSE THESE IDs with a protocol-incompatible driver!! Ever!!
29 * Instead: allocate your own, using normal USB-IF procedures.
31 #define ACM_MS_VENDOR_NUM 0x1d6b /* Linux Foundation */
32 #define ACM_MS_PRODUCT_NUM 0x0106 /* Composite Gadget: ACM + MS*/
34 #include "f_mass_storage.h"
36 /*-------------------------------------------------------------------------*/
37 USB_GADGET_COMPOSITE_OPTIONS();
39 static struct usb_device_descriptor device_desc = {
40 .bLength = sizeof device_desc,
41 .bDescriptorType = USB_DT_DEVICE,
43 .bcdUSB = cpu_to_le16(0x0200),
45 .bDeviceClass = USB_CLASS_MISC /* 0xEF */,
49 /* .bMaxPacketSize0 = f(hardware) */
51 /* Vendor and product id can be overridden by module parameters. */
52 .idVendor = cpu_to_le16(ACM_MS_VENDOR_NUM),
53 .idProduct = cpu_to_le16(ACM_MS_PRODUCT_NUM),
54 /* .bcdDevice = f(hardware) */
55 /* .iManufacturer = DYNAMIC */
56 /* .iProduct = DYNAMIC */
57 /* NO SERIAL NUMBER */
58 /*.bNumConfigurations = DYNAMIC*/
61 static struct usb_otg_descriptor otg_descriptor = {
62 .bLength = sizeof otg_descriptor,
63 .bDescriptorType = USB_DT_OTG,
66 * REVISIT SRP-only hardware is possible, although
67 * it would not be called "OTG" ...
69 .bmAttributes = USB_OTG_SRP | USB_OTG_HNP,
72 static const struct usb_descriptor_header *otg_desc[] = {
73 (struct usb_descriptor_header *) &otg_descriptor,
77 /* string IDs are assigned dynamically */
78 static struct usb_string strings_dev[] = {
79 [USB_GADGET_MANUFACTURER_IDX].s = "",
80 [USB_GADGET_PRODUCT_IDX].s = DRIVER_DESC,
81 [USB_GADGET_SERIAL_IDX].s = "",
85 static struct usb_gadget_strings stringtab_dev = {
86 .language = 0x0409, /* en-us */
87 .strings = strings_dev,
90 static struct usb_gadget_strings *dev_strings[] = {
95 /****************************** Configurations ******************************/
97 static struct fsg_module_parameters fsg_mod_data = { .stall = 1 };
98 #ifdef CONFIG_USB_GADGET_DEBUG_FILES
100 static unsigned int fsg_num_buffers = CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS;
105 * Number of buffers we will use.
106 * 2 is usually enough for good buffering pipeline
108 #define fsg_num_buffers CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS
110 #endif /* CONFIG_USB_GADGET_DEBUG_FILES */
112 FSG_MODULE_PARAMETERS(/* no prefix */, fsg_mod_data);
114 /*-------------------------------------------------------------------------*/
115 static struct usb_function *f_acm;
116 static struct usb_function_instance *f_acm_inst;
118 static struct usb_function_instance *fi_msg;
119 static struct usb_function *f_msg;
122 * We _always_ have both ACM and mass storage functions.
124 static int acm_ms_do_config(struct usb_configuration *c)
126 struct fsg_opts *opts;
129 if (gadget_is_otg(c->cdev->gadget)) {
130 c->descriptors = otg_desc;
131 c->bmAttributes |= USB_CONFIG_ATT_WAKEUP;
134 opts = fsg_opts_from_func_inst(fi_msg);
136 f_acm = usb_get_function(f_acm_inst);
138 return PTR_ERR(f_acm);
140 f_msg = usb_get_function(fi_msg);
142 status = PTR_ERR(f_msg);
146 status = usb_add_function(c, f_acm);
150 status = fsg_common_run_thread(opts->common);
154 status = usb_add_function(c, f_msg);
160 usb_remove_function(c, f_acm);
162 usb_put_function(f_msg);
164 usb_put_function(f_acm);
168 static struct usb_configuration acm_ms_config_driver = {
169 .label = DRIVER_DESC,
170 .bConfigurationValue = 1,
171 /* .iConfiguration = DYNAMIC */
172 .bmAttributes = USB_CONFIG_ATT_SELFPOWER,
175 /*-------------------------------------------------------------------------*/
177 static int acm_ms_bind(struct usb_composite_dev *cdev)
179 struct usb_gadget *gadget = cdev->gadget;
180 struct fsg_opts *opts;
181 struct fsg_config config;
184 f_acm_inst = usb_get_function_instance("acm");
185 if (IS_ERR(f_acm_inst))
186 return PTR_ERR(f_acm_inst);
188 fi_msg = usb_get_function_instance("mass_storage");
189 if (IS_ERR(fi_msg)) {
190 status = PTR_ERR(fi_msg);
194 /* set up mass storage function */
195 fsg_config_from_params(&config, &fsg_mod_data, fsg_num_buffers);
196 opts = fsg_opts_from_func_inst(fi_msg);
198 opts->no_configfs = true;
199 status = fsg_common_set_num_buffers(opts->common, fsg_num_buffers);
203 status = fsg_common_set_nluns(opts->common, config.nluns);
207 status = fsg_common_set_cdev(opts->common, cdev, config.can_stall);
211 fsg_common_set_sysfs(opts->common, true);
212 status = fsg_common_create_luns(opts->common, &config);
216 fsg_common_set_inquiry_string(opts->common, config.vendor_name,
217 config.product_name);
219 * Allocate string descriptor numbers ... note that string
220 * contents can be overridden by the composite_dev glue.
222 status = usb_string_ids_tab(cdev, strings_dev);
224 goto fail_string_ids;
225 device_desc.iManufacturer = strings_dev[USB_GADGET_MANUFACTURER_IDX].id;
226 device_desc.iProduct = strings_dev[USB_GADGET_PRODUCT_IDX].id;
228 /* register our configuration */
229 status = usb_add_config(cdev, &acm_ms_config_driver, acm_ms_do_config);
231 goto fail_string_ids;
233 usb_composite_overwrite_options(cdev, &coverwrite);
234 dev_info(&gadget->dev, "%s, version: " DRIVER_VERSION "\n",
240 fsg_common_remove_luns(opts->common);
242 fsg_common_free_luns(opts->common);
244 fsg_common_free_buffers(opts->common);
246 usb_put_function_instance(fi_msg);
248 usb_put_function_instance(f_acm_inst);
252 static int acm_ms_unbind(struct usb_composite_dev *cdev)
254 usb_put_function(f_msg);
255 usb_put_function_instance(fi_msg);
256 usb_put_function(f_acm);
257 usb_put_function_instance(f_acm_inst);
261 static struct usb_composite_driver acm_ms_driver = {
264 .max_speed = USB_SPEED_SUPER,
265 .strings = dev_strings,
267 .unbind = acm_ms_unbind,
270 module_usb_composite_driver(acm_ms_driver);
272 MODULE_DESCRIPTION(DRIVER_DESC);
273 MODULE_AUTHOR("Klaus Schwarzkopf <schwarzkopf@sensortherm.de>");
274 MODULE_LICENSE("GPL v2");