forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
262 lines
6.5 KiB
262 lines
6.5 KiB
// SPDX-License-Identifier: GPL-2.0+ |
|
/* |
|
* acm_ms.c -- Composite driver, with ACM and mass storage support |
|
* |
|
* Copyright (C) 2008 David Brownell |
|
* Copyright (C) 2008 Nokia Corporation |
|
* Author: David Brownell |
|
* Modified: Klaus Schwarzkopf <[email protected]> |
|
* |
|
* Heavily based on multi.c and cdc2.c |
|
*/ |
|
|
|
#include <linux/kernel.h> |
|
#include <linux/module.h> |
|
|
|
#include "u_serial.h" |
|
|
|
#define DRIVER_DESC "Composite Gadget (ACM + MS)" |
|
#define DRIVER_VERSION "2011/10/10" |
|
|
|
/*-------------------------------------------------------------------------*/ |
|
|
|
/* |
|
* DO NOT REUSE THESE IDs with a protocol-incompatible driver!! Ever!! |
|
* Instead: allocate your own, using normal USB-IF procedures. |
|
*/ |
|
#define ACM_MS_VENDOR_NUM 0x1d6b /* Linux Foundation */ |
|
#define ACM_MS_PRODUCT_NUM 0x0106 /* Composite Gadget: ACM + MS*/ |
|
|
|
#include "f_mass_storage.h" |
|
|
|
/*-------------------------------------------------------------------------*/ |
|
USB_GADGET_COMPOSITE_OPTIONS(); |
|
|
|
static struct usb_device_descriptor device_desc = { |
|
.bLength = sizeof device_desc, |
|
.bDescriptorType = USB_DT_DEVICE, |
|
|
|
/* .bcdUSB = DYNAMIC */ |
|
|
|
.bDeviceClass = USB_CLASS_MISC /* 0xEF */, |
|
.bDeviceSubClass = 2, |
|
.bDeviceProtocol = 1, |
|
|
|
/* .bMaxPacketSize0 = f(hardware) */ |
|
|
|
/* Vendor and product id can be overridden by module parameters. */ |
|
.idVendor = cpu_to_le16(ACM_MS_VENDOR_NUM), |
|
.idProduct = cpu_to_le16(ACM_MS_PRODUCT_NUM), |
|
/* .bcdDevice = f(hardware) */ |
|
/* .iManufacturer = DYNAMIC */ |
|
/* .iProduct = DYNAMIC */ |
|
/* NO SERIAL NUMBER */ |
|
/*.bNumConfigurations = DYNAMIC*/ |
|
}; |
|
|
|
static const struct usb_descriptor_header *otg_desc[2]; |
|
|
|
/* string IDs are assigned dynamically */ |
|
static struct usb_string strings_dev[] = { |
|
[USB_GADGET_MANUFACTURER_IDX].s = "", |
|
[USB_GADGET_PRODUCT_IDX].s = DRIVER_DESC, |
|
[USB_GADGET_SERIAL_IDX].s = "", |
|
{ } /* end of list */ |
|
}; |
|
|
|
static struct usb_gadget_strings stringtab_dev = { |
|
.language = 0x0409, /* en-us */ |
|
.strings = strings_dev, |
|
}; |
|
|
|
static struct usb_gadget_strings *dev_strings[] = { |
|
&stringtab_dev, |
|
NULL, |
|
}; |
|
|
|
/****************************** Configurations ******************************/ |
|
|
|
static struct fsg_module_parameters fsg_mod_data = { .stall = 1 }; |
|
#ifdef CONFIG_USB_GADGET_DEBUG_FILES |
|
|
|
static unsigned int fsg_num_buffers = CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS; |
|
|
|
#else |
|
|
|
/* |
|
* Number of buffers we will use. |
|
* 2 is usually enough for good buffering pipeline |
|
*/ |
|
#define fsg_num_buffers CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS |
|
|
|
#endif /* CONFIG_USB_GADGET_DEBUG_FILES */ |
|
|
|
FSG_MODULE_PARAMETERS(/* no prefix */, fsg_mod_data); |
|
|
|
/*-------------------------------------------------------------------------*/ |
|
static struct usb_function *f_acm; |
|
static struct usb_function_instance *f_acm_inst; |
|
|
|
static struct usb_function_instance *fi_msg; |
|
static struct usb_function *f_msg; |
|
|
|
/* |
|
* We _always_ have both ACM and mass storage functions. |
|
*/ |
|
static int acm_ms_do_config(struct usb_configuration *c) |
|
{ |
|
int status; |
|
|
|
if (gadget_is_otg(c->cdev->gadget)) { |
|
c->descriptors = otg_desc; |
|
c->bmAttributes |= USB_CONFIG_ATT_WAKEUP; |
|
} |
|
|
|
f_acm = usb_get_function(f_acm_inst); |
|
if (IS_ERR(f_acm)) |
|
return PTR_ERR(f_acm); |
|
|
|
f_msg = usb_get_function(fi_msg); |
|
if (IS_ERR(f_msg)) { |
|
status = PTR_ERR(f_msg); |
|
goto put_acm; |
|
} |
|
|
|
status = usb_add_function(c, f_acm); |
|
if (status < 0) |
|
goto put_msg; |
|
|
|
status = usb_add_function(c, f_msg); |
|
if (status) |
|
goto remove_acm; |
|
|
|
return 0; |
|
remove_acm: |
|
usb_remove_function(c, f_acm); |
|
put_msg: |
|
usb_put_function(f_msg); |
|
put_acm: |
|
usb_put_function(f_acm); |
|
return status; |
|
} |
|
|
|
static struct usb_configuration acm_ms_config_driver = { |
|
.label = DRIVER_DESC, |
|
.bConfigurationValue = 1, |
|
/* .iConfiguration = DYNAMIC */ |
|
.bmAttributes = USB_CONFIG_ATT_SELFPOWER, |
|
}; |
|
|
|
/*-------------------------------------------------------------------------*/ |
|
|
|
static int acm_ms_bind(struct usb_composite_dev *cdev) |
|
{ |
|
struct usb_gadget *gadget = cdev->gadget; |
|
struct fsg_opts *opts; |
|
struct fsg_config config; |
|
int status; |
|
|
|
f_acm_inst = usb_get_function_instance("acm"); |
|
if (IS_ERR(f_acm_inst)) |
|
return PTR_ERR(f_acm_inst); |
|
|
|
fi_msg = usb_get_function_instance("mass_storage"); |
|
if (IS_ERR(fi_msg)) { |
|
status = PTR_ERR(fi_msg); |
|
goto fail_get_msg; |
|
} |
|
|
|
/* set up mass storage function */ |
|
fsg_config_from_params(&config, &fsg_mod_data, fsg_num_buffers); |
|
opts = fsg_opts_from_func_inst(fi_msg); |
|
|
|
opts->no_configfs = true; |
|
status = fsg_common_set_num_buffers(opts->common, fsg_num_buffers); |
|
if (status) |
|
goto fail; |
|
|
|
status = fsg_common_set_cdev(opts->common, cdev, config.can_stall); |
|
if (status) |
|
goto fail_set_cdev; |
|
|
|
fsg_common_set_sysfs(opts->common, true); |
|
status = fsg_common_create_luns(opts->common, &config); |
|
if (status) |
|
goto fail_set_cdev; |
|
|
|
fsg_common_set_inquiry_string(opts->common, config.vendor_name, |
|
config.product_name); |
|
/* |
|
* Allocate string descriptor numbers ... note that string |
|
* contents can be overridden by the composite_dev glue. |
|
*/ |
|
status = usb_string_ids_tab(cdev, strings_dev); |
|
if (status < 0) |
|
goto fail_string_ids; |
|
device_desc.iManufacturer = strings_dev[USB_GADGET_MANUFACTURER_IDX].id; |
|
device_desc.iProduct = strings_dev[USB_GADGET_PRODUCT_IDX].id; |
|
|
|
if (gadget_is_otg(gadget) && !otg_desc[0]) { |
|
struct usb_descriptor_header *usb_desc; |
|
|
|
usb_desc = usb_otg_descriptor_alloc(gadget); |
|
if (!usb_desc) { |
|
status = -ENOMEM; |
|
goto fail_string_ids; |
|
} |
|
usb_otg_descriptor_init(gadget, usb_desc); |
|
otg_desc[0] = usb_desc; |
|
otg_desc[1] = NULL; |
|
} |
|
|
|
/* register our configuration */ |
|
status = usb_add_config(cdev, &acm_ms_config_driver, acm_ms_do_config); |
|
if (status < 0) |
|
goto fail_otg_desc; |
|
|
|
usb_composite_overwrite_options(cdev, &coverwrite); |
|
dev_info(&gadget->dev, "%s, version: " DRIVER_VERSION "\n", |
|
DRIVER_DESC); |
|
return 0; |
|
|
|
/* error recovery */ |
|
fail_otg_desc: |
|
kfree(otg_desc[0]); |
|
otg_desc[0] = NULL; |
|
fail_string_ids: |
|
fsg_common_remove_luns(opts->common); |
|
fail_set_cdev: |
|
fsg_common_free_buffers(opts->common); |
|
fail: |
|
usb_put_function_instance(fi_msg); |
|
fail_get_msg: |
|
usb_put_function_instance(f_acm_inst); |
|
return status; |
|
} |
|
|
|
static int acm_ms_unbind(struct usb_composite_dev *cdev) |
|
{ |
|
usb_put_function(f_msg); |
|
usb_put_function_instance(fi_msg); |
|
usb_put_function(f_acm); |
|
usb_put_function_instance(f_acm_inst); |
|
kfree(otg_desc[0]); |
|
otg_desc[0] = NULL; |
|
|
|
return 0; |
|
} |
|
|
|
static struct usb_composite_driver acm_ms_driver = { |
|
.name = "g_acm_ms", |
|
.dev = &device_desc, |
|
.max_speed = USB_SPEED_SUPER, |
|
.strings = dev_strings, |
|
.bind = acm_ms_bind, |
|
.unbind = acm_ms_unbind, |
|
}; |
|
|
|
module_usb_composite_driver(acm_ms_driver); |
|
|
|
MODULE_DESCRIPTION(DRIVER_DESC); |
|
MODULE_AUTHOR("Klaus Schwarzkopf <[email protected]>"); |
|
MODULE_LICENSE("GPL v2");
|
|
|