15fd54aceSGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0 288af8bbeSSebastian Andrzej Siewior #include <linux/configfs.h> 388af8bbeSSebastian Andrzej Siewior #include <linux/module.h> 488af8bbeSSebastian Andrzej Siewior #include <linux/slab.h> 588af8bbeSSebastian Andrzej Siewior #include <linux/device.h> 687213d38SAndrzej Pietrasiewicz #include <linux/nls.h> 788af8bbeSSebastian Andrzej Siewior #include <linux/usb/composite.h> 888af8bbeSSebastian Andrzej Siewior #include <linux/usb/gadget_configfs.h> 90009e99aSRashika Kheria #include "configfs.h" 10da424314SAndrzej Pietrasiewicz #include "u_f.h" 117419485fSAndrzej Pietrasiewicz #include "u_os_desc.h" 1288af8bbeSSebastian Andrzej Siewior 1388af8bbeSSebastian Andrzej Siewior int check_user_usb_string(const char *name, 1488af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *stringtab_dev) 1588af8bbeSSebastian Andrzej Siewior { 1688af8bbeSSebastian Andrzej Siewior u16 num; 1788af8bbeSSebastian Andrzej Siewior int ret; 1888af8bbeSSebastian Andrzej Siewior 1988af8bbeSSebastian Andrzej Siewior ret = kstrtou16(name, 0, &num); 2088af8bbeSSebastian Andrzej Siewior if (ret) 2188af8bbeSSebastian Andrzej Siewior return ret; 2288af8bbeSSebastian Andrzej Siewior 2317309a6aSTao Ren if (!usb_validate_langid(num)) 2488af8bbeSSebastian Andrzej Siewior return -EINVAL; 2588af8bbeSSebastian Andrzej Siewior 2688af8bbeSSebastian Andrzej Siewior stringtab_dev->language = num; 2788af8bbeSSebastian Andrzej Siewior return 0; 2888af8bbeSSebastian Andrzej Siewior } 2988af8bbeSSebastian Andrzej Siewior 3088af8bbeSSebastian Andrzej Siewior #define MAX_NAME_LEN 40 3188af8bbeSSebastian Andrzej Siewior #define MAX_USB_STRING_LANGS 2 3288af8bbeSSebastian Andrzej Siewior 3341ce84c8SLi Jun static const struct usb_descriptor_header *otg_desc[2]; 3441ce84c8SLi Jun 3588af8bbeSSebastian Andrzej Siewior struct gadget_info { 3688af8bbeSSebastian Andrzej Siewior struct config_group group; 3788af8bbeSSebastian Andrzej Siewior struct config_group functions_group; 3888af8bbeSSebastian Andrzej Siewior struct config_group configs_group; 3988af8bbeSSebastian Andrzej Siewior struct config_group strings_group; 4087213d38SAndrzej Pietrasiewicz struct config_group os_desc_group; 4188af8bbeSSebastian Andrzej Siewior 4288af8bbeSSebastian Andrzej Siewior struct mutex lock; 4388af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *gstrings[MAX_USB_STRING_LANGS + 1]; 4488af8bbeSSebastian Andrzej Siewior struct list_head string_list; 4588af8bbeSSebastian Andrzej Siewior struct list_head available_func; 4688af8bbeSSebastian Andrzej Siewior 4788af8bbeSSebastian Andrzej Siewior struct usb_composite_driver composite; 4888af8bbeSSebastian Andrzej Siewior struct usb_composite_dev cdev; 4987213d38SAndrzej Pietrasiewicz bool use_os_desc; 5087213d38SAndrzej Pietrasiewicz char b_vendor_code; 5187213d38SAndrzej Pietrasiewicz char qw_sign[OS_STRING_QW_SIGN_LEN]; 521a1c851bSPeter Chen spinlock_t spinlock; 531a1c851bSPeter Chen bool unbind; 5488af8bbeSSebastian Andrzej Siewior }; 5588af8bbeSSebastian Andrzej Siewior 5645b6a73fSChristoph Hellwig static inline struct gadget_info *to_gadget_info(struct config_item *item) 5745b6a73fSChristoph Hellwig { 5845b6a73fSChristoph Hellwig return container_of(to_config_group(item), struct gadget_info, group); 5945b6a73fSChristoph Hellwig } 6045b6a73fSChristoph Hellwig 6188af8bbeSSebastian Andrzej Siewior struct config_usb_cfg { 6288af8bbeSSebastian Andrzej Siewior struct config_group group; 6388af8bbeSSebastian Andrzej Siewior struct config_group strings_group; 6488af8bbeSSebastian Andrzej Siewior struct list_head string_list; 6588af8bbeSSebastian Andrzej Siewior struct usb_configuration c; 6688af8bbeSSebastian Andrzej Siewior struct list_head func_list; 6788af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *gstrings[MAX_USB_STRING_LANGS + 1]; 6888af8bbeSSebastian Andrzej Siewior }; 6988af8bbeSSebastian Andrzej Siewior 7045b6a73fSChristoph Hellwig static inline struct config_usb_cfg *to_config_usb_cfg(struct config_item *item) 7145b6a73fSChristoph Hellwig { 7245b6a73fSChristoph Hellwig return container_of(to_config_group(item), struct config_usb_cfg, 7345b6a73fSChristoph Hellwig group); 7445b6a73fSChristoph Hellwig } 7545b6a73fSChristoph Hellwig 76260d88b7SLinyu Yuan static inline struct gadget_info *cfg_to_gadget_info(struct config_usb_cfg *cfg) 77260d88b7SLinyu Yuan { 78260d88b7SLinyu Yuan return container_of(cfg->c.cdev, struct gadget_info, cdev); 79260d88b7SLinyu Yuan } 80260d88b7SLinyu Yuan 8188af8bbeSSebastian Andrzej Siewior struct gadget_strings { 8288af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings stringtab_dev; 8388af8bbeSSebastian Andrzej Siewior struct usb_string strings[USB_GADGET_FIRST_AVAIL_IDX]; 8488af8bbeSSebastian Andrzej Siewior char *manufacturer; 8588af8bbeSSebastian Andrzej Siewior char *product; 8688af8bbeSSebastian Andrzej Siewior char *serialnumber; 8788af8bbeSSebastian Andrzej Siewior 8888af8bbeSSebastian Andrzej Siewior struct config_group group; 8988af8bbeSSebastian Andrzej Siewior struct list_head list; 9088af8bbeSSebastian Andrzej Siewior }; 9188af8bbeSSebastian Andrzej Siewior 9288af8bbeSSebastian Andrzej Siewior struct gadget_config_name { 9388af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings stringtab_dev; 9488af8bbeSSebastian Andrzej Siewior struct usb_string strings; 9588af8bbeSSebastian Andrzej Siewior char *configuration; 9688af8bbeSSebastian Andrzej Siewior 9788af8bbeSSebastian Andrzej Siewior struct config_group group; 9888af8bbeSSebastian Andrzej Siewior struct list_head list; 9988af8bbeSSebastian Andrzej Siewior }; 10088af8bbeSSebastian Andrzej Siewior 10198f153a1SJim Lin #define USB_MAX_STRING_WITH_NULL_LEN (USB_MAX_STRING_LEN+1) 10298f153a1SJim Lin 10388af8bbeSSebastian Andrzej Siewior static int usb_string_copy(const char *s, char **s_copy) 10488af8bbeSSebastian Andrzej Siewior { 10588af8bbeSSebastian Andrzej Siewior int ret; 10688af8bbeSSebastian Andrzej Siewior char *str; 10788af8bbeSSebastian Andrzej Siewior char *copy = *s_copy; 10888af8bbeSSebastian Andrzej Siewior ret = strlen(s); 10981c74628SMacpaul Lin if (ret > USB_MAX_STRING_LEN) 11088af8bbeSSebastian Andrzej Siewior return -EOVERFLOW; 11188af8bbeSSebastian Andrzej Siewior 11298f153a1SJim Lin if (copy) { 11398f153a1SJim Lin str = copy; 11498f153a1SJim Lin } else { 11598f153a1SJim Lin str = kmalloc(USB_MAX_STRING_WITH_NULL_LEN, GFP_KERNEL); 11688af8bbeSSebastian Andrzej Siewior if (!str) 11788af8bbeSSebastian Andrzej Siewior return -ENOMEM; 11898f153a1SJim Lin } 11998f153a1SJim Lin strcpy(str, s); 12088af8bbeSSebastian Andrzej Siewior if (str[ret - 1] == '\n') 12188af8bbeSSebastian Andrzej Siewior str[ret - 1] = '\0'; 12288af8bbeSSebastian Andrzej Siewior *s_copy = str; 12388af8bbeSSebastian Andrzej Siewior return 0; 12488af8bbeSSebastian Andrzej Siewior } 12588af8bbeSSebastian Andrzej Siewior 12688af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_R_u8(__name) \ 12745b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##__name##_show(struct config_item *item, \ 12888af8bbeSSebastian Andrzej Siewior char *page) \ 12988af8bbeSSebastian Andrzej Siewior { \ 13045b6a73fSChristoph Hellwig return sprintf(page, "0x%02x\n", \ 13145b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.__name); \ 13288af8bbeSSebastian Andrzej Siewior } 13388af8bbeSSebastian Andrzej Siewior 13488af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_R_u16(__name) \ 13545b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##__name##_show(struct config_item *item, \ 13688af8bbeSSebastian Andrzej Siewior char *page) \ 13788af8bbeSSebastian Andrzej Siewior { \ 13845b6a73fSChristoph Hellwig return sprintf(page, "0x%04x\n", \ 13945b6a73fSChristoph Hellwig le16_to_cpup(&to_gadget_info(item)->cdev.desc.__name)); \ 14088af8bbeSSebastian Andrzej Siewior } 14188af8bbeSSebastian Andrzej Siewior 14288af8bbeSSebastian Andrzej Siewior 14388af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_W_u8(_name) \ 14445b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##_name##_store(struct config_item *item, \ 14588af8bbeSSebastian Andrzej Siewior const char *page, size_t len) \ 14688af8bbeSSebastian Andrzej Siewior { \ 14788af8bbeSSebastian Andrzej Siewior u8 val; \ 14888af8bbeSSebastian Andrzej Siewior int ret; \ 14988af8bbeSSebastian Andrzej Siewior ret = kstrtou8(page, 0, &val); \ 15088af8bbeSSebastian Andrzej Siewior if (ret) \ 15188af8bbeSSebastian Andrzej Siewior return ret; \ 15245b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc._name = val; \ 15388af8bbeSSebastian Andrzej Siewior return len; \ 15488af8bbeSSebastian Andrzej Siewior } 15588af8bbeSSebastian Andrzej Siewior 15688af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_W_u16(_name) \ 15745b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##_name##_store(struct config_item *item, \ 15888af8bbeSSebastian Andrzej Siewior const char *page, size_t len) \ 15988af8bbeSSebastian Andrzej Siewior { \ 16088af8bbeSSebastian Andrzej Siewior u16 val; \ 16188af8bbeSSebastian Andrzej Siewior int ret; \ 16288af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &val); \ 16388af8bbeSSebastian Andrzej Siewior if (ret) \ 16488af8bbeSSebastian Andrzej Siewior return ret; \ 16545b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc._name = cpu_to_le16p(&val); \ 16688af8bbeSSebastian Andrzej Siewior return len; \ 16788af8bbeSSebastian Andrzej Siewior } 16888af8bbeSSebastian Andrzej Siewior 16988af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_RW(_name, _type) \ 17088af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_##_type(_name) \ 17188af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_W_##_type(_name) 17288af8bbeSSebastian Andrzej Siewior 17388af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_u16(bcdUSB); 17488af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceClass, u8); 17588af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceSubClass, u8); 17688af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceProtocol, u8); 17788af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bMaxPacketSize0, u8); 17888af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(idVendor, u16); 17988af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(idProduct, u16); 18088af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_u16(bcdDevice); 18188af8bbeSSebastian Andrzej Siewior 18288af8bbeSSebastian Andrzej Siewior static ssize_t is_valid_bcd(u16 bcd_val) 18388af8bbeSSebastian Andrzej Siewior { 18488af8bbeSSebastian Andrzej Siewior if ((bcd_val & 0xf) > 9) 18588af8bbeSSebastian Andrzej Siewior return -EINVAL; 18688af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 4) & 0xf) > 9) 18788af8bbeSSebastian Andrzej Siewior return -EINVAL; 18888af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 8) & 0xf) > 9) 18988af8bbeSSebastian Andrzej Siewior return -EINVAL; 19088af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 12) & 0xf) > 9) 19188af8bbeSSebastian Andrzej Siewior return -EINVAL; 19288af8bbeSSebastian Andrzej Siewior return 0; 19388af8bbeSSebastian Andrzej Siewior } 19488af8bbeSSebastian Andrzej Siewior 19545b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_bcdDevice_store(struct config_item *item, 19688af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 19788af8bbeSSebastian Andrzej Siewior { 19888af8bbeSSebastian Andrzej Siewior u16 bcdDevice; 19988af8bbeSSebastian Andrzej Siewior int ret; 20088af8bbeSSebastian Andrzej Siewior 20188af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &bcdDevice); 20288af8bbeSSebastian Andrzej Siewior if (ret) 20388af8bbeSSebastian Andrzej Siewior return ret; 20488af8bbeSSebastian Andrzej Siewior ret = is_valid_bcd(bcdDevice); 20588af8bbeSSebastian Andrzej Siewior if (ret) 20688af8bbeSSebastian Andrzej Siewior return ret; 20788af8bbeSSebastian Andrzej Siewior 20845b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.bcdDevice = cpu_to_le16(bcdDevice); 20988af8bbeSSebastian Andrzej Siewior return len; 21088af8bbeSSebastian Andrzej Siewior } 21188af8bbeSSebastian Andrzej Siewior 21245b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_bcdUSB_store(struct config_item *item, 21388af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 21488af8bbeSSebastian Andrzej Siewior { 21588af8bbeSSebastian Andrzej Siewior u16 bcdUSB; 21688af8bbeSSebastian Andrzej Siewior int ret; 21788af8bbeSSebastian Andrzej Siewior 21888af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &bcdUSB); 21988af8bbeSSebastian Andrzej Siewior if (ret) 22088af8bbeSSebastian Andrzej Siewior return ret; 22188af8bbeSSebastian Andrzej Siewior ret = is_valid_bcd(bcdUSB); 22288af8bbeSSebastian Andrzej Siewior if (ret) 22388af8bbeSSebastian Andrzej Siewior return ret; 22488af8bbeSSebastian Andrzej Siewior 22545b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.bcdUSB = cpu_to_le16(bcdUSB); 22688af8bbeSSebastian Andrzej Siewior return len; 22788af8bbeSSebastian Andrzej Siewior } 22888af8bbeSSebastian Andrzej Siewior 22945b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_UDC_show(struct config_item *item, char *page) 23088af8bbeSSebastian Andrzej Siewior { 23164e6bbffSEddie Hung struct gadget_info *gi = to_gadget_info(item); 23264e6bbffSEddie Hung char *udc_name; 23364e6bbffSEddie Hung int ret; 234afdaadc3SRuslan Bilovol 23564e6bbffSEddie Hung mutex_lock(&gi->lock); 23664e6bbffSEddie Hung udc_name = gi->composite.gadget_driver.udc_name; 23764e6bbffSEddie Hung ret = sprintf(page, "%s\n", udc_name ?: ""); 23864e6bbffSEddie Hung mutex_unlock(&gi->lock); 23964e6bbffSEddie Hung 24064e6bbffSEddie Hung return ret; 24188af8bbeSSebastian Andrzej Siewior } 24288af8bbeSSebastian Andrzej Siewior 24388af8bbeSSebastian Andrzej Siewior static int unregister_gadget(struct gadget_info *gi) 24488af8bbeSSebastian Andrzej Siewior { 24588af8bbeSSebastian Andrzej Siewior int ret; 24688af8bbeSSebastian Andrzej Siewior 247afdaadc3SRuslan Bilovol if (!gi->composite.gadget_driver.udc_name) 24888af8bbeSSebastian Andrzej Siewior return -ENODEV; 24988af8bbeSSebastian Andrzej Siewior 25088af8bbeSSebastian Andrzej Siewior ret = usb_gadget_unregister_driver(&gi->composite.gadget_driver); 25188af8bbeSSebastian Andrzej Siewior if (ret) 25288af8bbeSSebastian Andrzej Siewior return ret; 253afdaadc3SRuslan Bilovol kfree(gi->composite.gadget_driver.udc_name); 254afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = NULL; 25588af8bbeSSebastian Andrzej Siewior return 0; 25688af8bbeSSebastian Andrzej Siewior } 25788af8bbeSSebastian Andrzej Siewior 25845b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_UDC_store(struct config_item *item, 25988af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 26088af8bbeSSebastian Andrzej Siewior { 26145b6a73fSChristoph Hellwig struct gadget_info *gi = to_gadget_info(item); 26288af8bbeSSebastian Andrzej Siewior char *name; 26388af8bbeSSebastian Andrzej Siewior int ret; 26488af8bbeSSebastian Andrzej Siewior 26515753588SKyungtae Kim if (strlen(page) < len) 26615753588SKyungtae Kim return -EOVERFLOW; 26715753588SKyungtae Kim 26888af8bbeSSebastian Andrzej Siewior name = kstrdup(page, GFP_KERNEL); 26988af8bbeSSebastian Andrzej Siewior if (!name) 27088af8bbeSSebastian Andrzej Siewior return -ENOMEM; 27188af8bbeSSebastian Andrzej Siewior if (name[len - 1] == '\n') 27288af8bbeSSebastian Andrzej Siewior name[len - 1] = '\0'; 27388af8bbeSSebastian Andrzej Siewior 27488af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 27588af8bbeSSebastian Andrzej Siewior 27688af8bbeSSebastian Andrzej Siewior if (!strlen(name)) { 27788af8bbeSSebastian Andrzej Siewior ret = unregister_gadget(gi); 27888af8bbeSSebastian Andrzej Siewior if (ret) 27988af8bbeSSebastian Andrzej Siewior goto err; 28038355b2aSJohn Keeping kfree(name); 28188af8bbeSSebastian Andrzej Siewior } else { 282afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name) { 28388af8bbeSSebastian Andrzej Siewior ret = -EBUSY; 28488af8bbeSSebastian Andrzej Siewior goto err; 28588af8bbeSSebastian Andrzej Siewior } 286afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = name; 287afdaadc3SRuslan Bilovol ret = usb_gadget_probe_driver(&gi->composite.gadget_driver); 288afdaadc3SRuslan Bilovol if (ret) { 289afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = NULL; 29088af8bbeSSebastian Andrzej Siewior goto err; 291afdaadc3SRuslan Bilovol } 29288af8bbeSSebastian Andrzej Siewior } 29388af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 29488af8bbeSSebastian Andrzej Siewior return len; 29588af8bbeSSebastian Andrzej Siewior err: 29688af8bbeSSebastian Andrzej Siewior kfree(name); 29788af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 29888af8bbeSSebastian Andrzej Siewior return ret; 29988af8bbeSSebastian Andrzej Siewior } 30088af8bbeSSebastian Andrzej Siewior 301a0249703SThinh Nguyen static ssize_t gadget_dev_desc_max_speed_show(struct config_item *item, 302a0249703SThinh Nguyen char *page) 303a0249703SThinh Nguyen { 304a0249703SThinh Nguyen enum usb_device_speed speed = to_gadget_info(item)->composite.max_speed; 305a0249703SThinh Nguyen 306a0249703SThinh Nguyen return sprintf(page, "%s\n", usb_speed_string(speed)); 307a0249703SThinh Nguyen } 308a0249703SThinh Nguyen 309a0249703SThinh Nguyen static ssize_t gadget_dev_desc_max_speed_store(struct config_item *item, 310a0249703SThinh Nguyen const char *page, size_t len) 311a0249703SThinh Nguyen { 312a0249703SThinh Nguyen struct gadget_info *gi = to_gadget_info(item); 313a0249703SThinh Nguyen 314a0249703SThinh Nguyen mutex_lock(&gi->lock); 315a0249703SThinh Nguyen 316a0249703SThinh Nguyen /* Prevent changing of max_speed after the driver is binded */ 317a0249703SThinh Nguyen if (gi->composite.gadget_driver.udc_name) 318a0249703SThinh Nguyen goto err; 319a0249703SThinh Nguyen 320a0249703SThinh Nguyen if (strncmp(page, "super-speed-plus", 16) == 0) 321a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_SUPER_PLUS; 322a0249703SThinh Nguyen else if (strncmp(page, "super-speed", 11) == 0) 323a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_SUPER; 324a0249703SThinh Nguyen else if (strncmp(page, "high-speed", 10) == 0) 325a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_HIGH; 326a0249703SThinh Nguyen else if (strncmp(page, "full-speed", 10) == 0) 327a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_FULL; 328a0249703SThinh Nguyen else if (strncmp(page, "low-speed", 9) == 0) 329a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_LOW; 330a0249703SThinh Nguyen else 331a0249703SThinh Nguyen goto err; 332a0249703SThinh Nguyen 333a0249703SThinh Nguyen gi->composite.gadget_driver.max_speed = gi->composite.max_speed; 334a0249703SThinh Nguyen 335a0249703SThinh Nguyen mutex_unlock(&gi->lock); 336a0249703SThinh Nguyen return len; 337a0249703SThinh Nguyen err: 338a0249703SThinh Nguyen mutex_unlock(&gi->lock); 339a0249703SThinh Nguyen return -EINVAL; 340a0249703SThinh Nguyen } 341a0249703SThinh Nguyen 34245b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceClass); 34345b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceSubClass); 34445b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceProtocol); 34545b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bMaxPacketSize0); 34645b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, idVendor); 34745b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, idProduct); 34845b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bcdDevice); 34945b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bcdUSB); 35045b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, UDC); 351a0249703SThinh Nguyen CONFIGFS_ATTR(gadget_dev_desc_, max_speed); 35288af8bbeSSebastian Andrzej Siewior 35388af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_root_attrs[] = { 35445b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceClass, 35545b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceSubClass, 35645b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceProtocol, 35745b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bMaxPacketSize0, 35845b6a73fSChristoph Hellwig &gadget_dev_desc_attr_idVendor, 35945b6a73fSChristoph Hellwig &gadget_dev_desc_attr_idProduct, 36045b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bcdDevice, 36145b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bcdUSB, 36245b6a73fSChristoph Hellwig &gadget_dev_desc_attr_UDC, 363a0249703SThinh Nguyen &gadget_dev_desc_attr_max_speed, 36488af8bbeSSebastian Andrzej Siewior NULL, 36588af8bbeSSebastian Andrzej Siewior }; 36688af8bbeSSebastian Andrzej Siewior 36788af8bbeSSebastian Andrzej Siewior static inline struct gadget_strings *to_gadget_strings(struct config_item *item) 36888af8bbeSSebastian Andrzej Siewior { 36988af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item), struct gadget_strings, 37088af8bbeSSebastian Andrzej Siewior group); 37188af8bbeSSebastian Andrzej Siewior } 37288af8bbeSSebastian Andrzej Siewior 37388af8bbeSSebastian Andrzej Siewior static inline struct gadget_config_name *to_gadget_config_name( 37488af8bbeSSebastian Andrzej Siewior struct config_item *item) 37588af8bbeSSebastian Andrzej Siewior { 37688af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item), struct gadget_config_name, 37788af8bbeSSebastian Andrzej Siewior group); 37888af8bbeSSebastian Andrzej Siewior } 37988af8bbeSSebastian Andrzej Siewior 38088af8bbeSSebastian Andrzej Siewior static inline struct usb_function_instance *to_usb_function_instance( 38188af8bbeSSebastian Andrzej Siewior struct config_item *item) 38288af8bbeSSebastian Andrzej Siewior { 38388af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item), 38488af8bbeSSebastian Andrzej Siewior struct usb_function_instance, group); 38588af8bbeSSebastian Andrzej Siewior } 38688af8bbeSSebastian Andrzej Siewior 38788af8bbeSSebastian Andrzej Siewior static void gadget_info_attr_release(struct config_item *item) 38888af8bbeSSebastian Andrzej Siewior { 38988af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = to_gadget_info(item); 39088af8bbeSSebastian Andrzej Siewior 39188af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->cdev.configs)); 39288af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->string_list)); 39388af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->available_func)); 39488af8bbeSSebastian Andrzej Siewior kfree(gi->composite.gadget_driver.function); 39588af8bbeSSebastian Andrzej Siewior kfree(gi); 39688af8bbeSSebastian Andrzej Siewior } 39788af8bbeSSebastian Andrzej Siewior 39888af8bbeSSebastian Andrzej Siewior static struct configfs_item_operations gadget_root_item_ops = { 39988af8bbeSSebastian Andrzej Siewior .release = gadget_info_attr_release, 40088af8bbeSSebastian Andrzej Siewior }; 40188af8bbeSSebastian Andrzej Siewior 40288af8bbeSSebastian Andrzej Siewior static void gadget_config_attr_release(struct config_item *item) 40388af8bbeSSebastian Andrzej Siewior { 40488af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(item); 40588af8bbeSSebastian Andrzej Siewior 40688af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&cfg->c.functions)); 40788af8bbeSSebastian Andrzej Siewior list_del(&cfg->c.list); 40888af8bbeSSebastian Andrzej Siewior kfree(cfg->c.label); 40988af8bbeSSebastian Andrzej Siewior kfree(cfg); 41088af8bbeSSebastian Andrzej Siewior } 41188af8bbeSSebastian Andrzej Siewior 41288af8bbeSSebastian Andrzej Siewior static int config_usb_cfg_link( 41388af8bbeSSebastian Andrzej Siewior struct config_item *usb_cfg_ci, 41488af8bbeSSebastian Andrzej Siewior struct config_item *usb_func_ci) 41588af8bbeSSebastian Andrzej Siewior { 41688af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(usb_cfg_ci); 417260d88b7SLinyu Yuan struct gadget_info *gi = cfg_to_gadget_info(cfg); 41888af8bbeSSebastian Andrzej Siewior 4195284acccSLinyu Yuan struct usb_function_instance *fi = 4205284acccSLinyu Yuan to_usb_function_instance(usb_func_ci); 421*36f4c25cSJakob Koschel struct usb_function_instance *a_fi = NULL, *iter; 42288af8bbeSSebastian Andrzej Siewior struct usb_function *f; 42388af8bbeSSebastian Andrzej Siewior int ret; 42488af8bbeSSebastian Andrzej Siewior 42588af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 42688af8bbeSSebastian Andrzej Siewior /* 42788af8bbeSSebastian Andrzej Siewior * Make sure this function is from within our _this_ gadget and not 42888af8bbeSSebastian Andrzej Siewior * from another gadget or a random directory. 42988af8bbeSSebastian Andrzej Siewior * Also a function instance can only be linked once. 43088af8bbeSSebastian Andrzej Siewior */ 431*36f4c25cSJakob Koschel list_for_each_entry(iter, &gi->available_func, cfs_list) { 432*36f4c25cSJakob Koschel if (iter != fi) 433*36f4c25cSJakob Koschel continue; 434*36f4c25cSJakob Koschel a_fi = iter; 43588af8bbeSSebastian Andrzej Siewior break; 43688af8bbeSSebastian Andrzej Siewior } 437*36f4c25cSJakob Koschel if (!a_fi) { 43888af8bbeSSebastian Andrzej Siewior ret = -EINVAL; 43988af8bbeSSebastian Andrzej Siewior goto out; 44088af8bbeSSebastian Andrzej Siewior } 44188af8bbeSSebastian Andrzej Siewior 44288af8bbeSSebastian Andrzej Siewior list_for_each_entry(f, &cfg->func_list, list) { 44388af8bbeSSebastian Andrzej Siewior if (f->fi == fi) { 44488af8bbeSSebastian Andrzej Siewior ret = -EEXIST; 44588af8bbeSSebastian Andrzej Siewior goto out; 44688af8bbeSSebastian Andrzej Siewior } 44788af8bbeSSebastian Andrzej Siewior } 44888af8bbeSSebastian Andrzej Siewior 44988af8bbeSSebastian Andrzej Siewior f = usb_get_function(fi); 45088af8bbeSSebastian Andrzej Siewior if (IS_ERR(f)) { 45188af8bbeSSebastian Andrzej Siewior ret = PTR_ERR(f); 45288af8bbeSSebastian Andrzej Siewior goto out; 45388af8bbeSSebastian Andrzej Siewior } 45488af8bbeSSebastian Andrzej Siewior 45588af8bbeSSebastian Andrzej Siewior /* stash the function until we bind it to the gadget */ 45688af8bbeSSebastian Andrzej Siewior list_add_tail(&f->list, &cfg->func_list); 45788af8bbeSSebastian Andrzej Siewior ret = 0; 45888af8bbeSSebastian Andrzej Siewior out: 45988af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 46088af8bbeSSebastian Andrzej Siewior return ret; 46188af8bbeSSebastian Andrzej Siewior } 46288af8bbeSSebastian Andrzej Siewior 463e16769d4SAndrzej Pietrasiewicz static void config_usb_cfg_unlink( 46488af8bbeSSebastian Andrzej Siewior struct config_item *usb_cfg_ci, 46588af8bbeSSebastian Andrzej Siewior struct config_item *usb_func_ci) 46688af8bbeSSebastian Andrzej Siewior { 46788af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(usb_cfg_ci); 468260d88b7SLinyu Yuan struct gadget_info *gi = cfg_to_gadget_info(cfg); 46988af8bbeSSebastian Andrzej Siewior 4705284acccSLinyu Yuan struct usb_function_instance *fi = 4715284acccSLinyu Yuan to_usb_function_instance(usb_func_ci); 47288af8bbeSSebastian Andrzej Siewior struct usb_function *f; 47388af8bbeSSebastian Andrzej Siewior 47488af8bbeSSebastian Andrzej Siewior /* 47588af8bbeSSebastian Andrzej Siewior * ideally I would like to forbid to unlink functions while a gadget is 47688af8bbeSSebastian Andrzej Siewior * bound to an UDC. Since this isn't possible at the moment, we simply 47788af8bbeSSebastian Andrzej Siewior * force an unbind, the function is available here and then we can 47888af8bbeSSebastian Andrzej Siewior * remove the function. 47988af8bbeSSebastian Andrzej Siewior */ 48088af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 481afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name) 48288af8bbeSSebastian Andrzej Siewior unregister_gadget(gi); 483afdaadc3SRuslan Bilovol WARN_ON(gi->composite.gadget_driver.udc_name); 48488af8bbeSSebastian Andrzej Siewior 48588af8bbeSSebastian Andrzej Siewior list_for_each_entry(f, &cfg->func_list, list) { 48688af8bbeSSebastian Andrzej Siewior if (f->fi == fi) { 48788af8bbeSSebastian Andrzej Siewior list_del(&f->list); 48888af8bbeSSebastian Andrzej Siewior usb_put_function(f); 48988af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 490e16769d4SAndrzej Pietrasiewicz return; 49188af8bbeSSebastian Andrzej Siewior } 49288af8bbeSSebastian Andrzej Siewior } 49388af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 49475bfe23aSDavid Rientjes WARN(1, "Unable to locate function to unbind\n"); 49588af8bbeSSebastian Andrzej Siewior } 49688af8bbeSSebastian Andrzej Siewior 49788af8bbeSSebastian Andrzej Siewior static struct configfs_item_operations gadget_config_item_ops = { 49888af8bbeSSebastian Andrzej Siewior .release = gadget_config_attr_release, 49988af8bbeSSebastian Andrzej Siewior .allow_link = config_usb_cfg_link, 50088af8bbeSSebastian Andrzej Siewior .drop_link = config_usb_cfg_unlink, 50188af8bbeSSebastian Andrzej Siewior }; 50288af8bbeSSebastian Andrzej Siewior 50388af8bbeSSebastian Andrzej Siewior 50445b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_MaxPower_show(struct config_item *item, 50588af8bbeSSebastian Andrzej Siewior char *page) 50688af8bbeSSebastian Andrzej Siewior { 507c26f1c10SLinyu Yuan struct config_usb_cfg *cfg = to_config_usb_cfg(item); 508c26f1c10SLinyu Yuan 509c26f1c10SLinyu Yuan return sprintf(page, "%u\n", cfg->c.MaxPower); 51088af8bbeSSebastian Andrzej Siewior } 51188af8bbeSSebastian Andrzej Siewior 51245b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_MaxPower_store(struct config_item *item, 51388af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 51488af8bbeSSebastian Andrzej Siewior { 515c26f1c10SLinyu Yuan struct config_usb_cfg *cfg = to_config_usb_cfg(item); 51688af8bbeSSebastian Andrzej Siewior u16 val; 51788af8bbeSSebastian Andrzej Siewior int ret; 51888af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &val); 51988af8bbeSSebastian Andrzej Siewior if (ret) 52088af8bbeSSebastian Andrzej Siewior return ret; 52188af8bbeSSebastian Andrzej Siewior if (DIV_ROUND_UP(val, 8) > 0xff) 52288af8bbeSSebastian Andrzej Siewior return -ERANGE; 523c26f1c10SLinyu Yuan cfg->c.MaxPower = val; 52488af8bbeSSebastian Andrzej Siewior return len; 52588af8bbeSSebastian Andrzej Siewior } 52688af8bbeSSebastian Andrzej Siewior 52745b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_bmAttributes_show(struct config_item *item, 52888af8bbeSSebastian Andrzej Siewior char *page) 52988af8bbeSSebastian Andrzej Siewior { 530c26f1c10SLinyu Yuan struct config_usb_cfg *cfg = to_config_usb_cfg(item); 531c26f1c10SLinyu Yuan 532c26f1c10SLinyu Yuan return sprintf(page, "0x%02x\n", cfg->c.bmAttributes); 53388af8bbeSSebastian Andrzej Siewior } 53488af8bbeSSebastian Andrzej Siewior 53545b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_bmAttributes_store(struct config_item *item, 53688af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 53788af8bbeSSebastian Andrzej Siewior { 538c26f1c10SLinyu Yuan struct config_usb_cfg *cfg = to_config_usb_cfg(item); 53988af8bbeSSebastian Andrzej Siewior u8 val; 54088af8bbeSSebastian Andrzej Siewior int ret; 54188af8bbeSSebastian Andrzej Siewior ret = kstrtou8(page, 0, &val); 54288af8bbeSSebastian Andrzej Siewior if (ret) 54388af8bbeSSebastian Andrzej Siewior return ret; 54488af8bbeSSebastian Andrzej Siewior if (!(val & USB_CONFIG_ATT_ONE)) 54588af8bbeSSebastian Andrzej Siewior return -EINVAL; 54688af8bbeSSebastian Andrzej Siewior if (val & ~(USB_CONFIG_ATT_ONE | USB_CONFIG_ATT_SELFPOWER | 54788af8bbeSSebastian Andrzej Siewior USB_CONFIG_ATT_WAKEUP)) 54888af8bbeSSebastian Andrzej Siewior return -EINVAL; 549c26f1c10SLinyu Yuan cfg->c.bmAttributes = val; 55088af8bbeSSebastian Andrzej Siewior return len; 55188af8bbeSSebastian Andrzej Siewior } 55288af8bbeSSebastian Andrzej Siewior 55345b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_config_desc_, MaxPower); 55445b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_config_desc_, bmAttributes); 55588af8bbeSSebastian Andrzej Siewior 55688af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_config_attrs[] = { 55745b6a73fSChristoph Hellwig &gadget_config_desc_attr_MaxPower, 55845b6a73fSChristoph Hellwig &gadget_config_desc_attr_bmAttributes, 55988af8bbeSSebastian Andrzej Siewior NULL, 56088af8bbeSSebastian Andrzej Siewior }; 56188af8bbeSSebastian Andrzej Siewior 5624ad01412SBhumika Goyal static const struct config_item_type gadget_config_type = { 56388af8bbeSSebastian Andrzej Siewior .ct_item_ops = &gadget_config_item_ops, 56488af8bbeSSebastian Andrzej Siewior .ct_attrs = gadget_config_attrs, 56588af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 56688af8bbeSSebastian Andrzej Siewior }; 56788af8bbeSSebastian Andrzej Siewior 5684ad01412SBhumika Goyal static const struct config_item_type gadget_root_type = { 56988af8bbeSSebastian Andrzej Siewior .ct_item_ops = &gadget_root_item_ops, 57088af8bbeSSebastian Andrzej Siewior .ct_attrs = gadget_root_attrs, 57188af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 57288af8bbeSSebastian Andrzej Siewior }; 57388af8bbeSSebastian Andrzej Siewior 57488af8bbeSSebastian Andrzej Siewior static void composite_init_dev(struct usb_composite_dev *cdev) 57588af8bbeSSebastian Andrzej Siewior { 57688af8bbeSSebastian Andrzej Siewior spin_lock_init(&cdev->lock); 57788af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cdev->configs); 57888af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cdev->gstrings); 57988af8bbeSSebastian Andrzej Siewior } 58088af8bbeSSebastian Andrzej Siewior 58188af8bbeSSebastian Andrzej Siewior static struct config_group *function_make( 58288af8bbeSSebastian Andrzej Siewior struct config_group *group, 58388af8bbeSSebastian Andrzej Siewior const char *name) 58488af8bbeSSebastian Andrzej Siewior { 58588af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 58688af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi; 58788af8bbeSSebastian Andrzej Siewior char buf[MAX_NAME_LEN]; 58888af8bbeSSebastian Andrzej Siewior char *func_name; 58988af8bbeSSebastian Andrzej Siewior char *instance_name; 59088af8bbeSSebastian Andrzej Siewior int ret; 59188af8bbeSSebastian Andrzej Siewior 59288af8bbeSSebastian Andrzej Siewior ret = snprintf(buf, MAX_NAME_LEN, "%s", name); 59388af8bbeSSebastian Andrzej Siewior if (ret >= MAX_NAME_LEN) 59488af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENAMETOOLONG); 59588af8bbeSSebastian Andrzej Siewior 59688af8bbeSSebastian Andrzej Siewior func_name = buf; 59788af8bbeSSebastian Andrzej Siewior instance_name = strchr(func_name, '.'); 59888af8bbeSSebastian Andrzej Siewior if (!instance_name) { 59988af8bbeSSebastian Andrzej Siewior pr_err("Unable to locate . in FUNC.INSTANCE\n"); 60088af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL); 60188af8bbeSSebastian Andrzej Siewior } 60288af8bbeSSebastian Andrzej Siewior *instance_name = '\0'; 60388af8bbeSSebastian Andrzej Siewior instance_name++; 60488af8bbeSSebastian Andrzej Siewior 60588af8bbeSSebastian Andrzej Siewior fi = usb_get_function_instance(func_name); 60688af8bbeSSebastian Andrzej Siewior if (IS_ERR(fi)) 607a3469411SDuan Jiong return ERR_CAST(fi); 60888af8bbeSSebastian Andrzej Siewior 6093958b792SNicolas Iooss ret = config_item_set_name(&fi->group.cg_item, "%s", name); 61088af8bbeSSebastian Andrzej Siewior if (ret) { 61188af8bbeSSebastian Andrzej Siewior usb_put_function_instance(fi); 61288af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret); 61388af8bbeSSebastian Andrzej Siewior } 6141933861dSAndrzej Pietrasiewicz if (fi->set_inst_name) { 6151933861dSAndrzej Pietrasiewicz ret = fi->set_inst_name(fi, instance_name); 6161933861dSAndrzej Pietrasiewicz if (ret) { 6171933861dSAndrzej Pietrasiewicz usb_put_function_instance(fi); 6181933861dSAndrzej Pietrasiewicz return ERR_PTR(ret); 6191933861dSAndrzej Pietrasiewicz } 6201933861dSAndrzej Pietrasiewicz } 62188af8bbeSSebastian Andrzej Siewior 62288af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, functions_group); 62388af8bbeSSebastian Andrzej Siewior 62488af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 62588af8bbeSSebastian Andrzej Siewior list_add_tail(&fi->cfs_list, &gi->available_func); 62688af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 62788af8bbeSSebastian Andrzej Siewior return &fi->group; 62888af8bbeSSebastian Andrzej Siewior } 62988af8bbeSSebastian Andrzej Siewior 63088af8bbeSSebastian Andrzej Siewior static void function_drop( 63188af8bbeSSebastian Andrzej Siewior struct config_group *group, 63288af8bbeSSebastian Andrzej Siewior struct config_item *item) 63388af8bbeSSebastian Andrzej Siewior { 63488af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi = to_usb_function_instance(item); 63588af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 63688af8bbeSSebastian Andrzej Siewior 63788af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, functions_group); 63888af8bbeSSebastian Andrzej Siewior 63988af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 64088af8bbeSSebastian Andrzej Siewior list_del(&fi->cfs_list); 64188af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 64288af8bbeSSebastian Andrzej Siewior config_item_put(item); 64388af8bbeSSebastian Andrzej Siewior } 64488af8bbeSSebastian Andrzej Siewior 64588af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations functions_ops = { 64688af8bbeSSebastian Andrzej Siewior .make_group = &function_make, 64788af8bbeSSebastian Andrzej Siewior .drop_item = &function_drop, 64888af8bbeSSebastian Andrzej Siewior }; 64988af8bbeSSebastian Andrzej Siewior 6504ad01412SBhumika Goyal static const struct config_item_type functions_type = { 65188af8bbeSSebastian Andrzej Siewior .ct_group_ops = &functions_ops, 65288af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 65388af8bbeSSebastian Andrzej Siewior }; 65488af8bbeSSebastian Andrzej Siewior 65588af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_config_name, configuration); 65688af8bbeSSebastian Andrzej Siewior 65788af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_config_name_langid_attrs[] = { 65845b6a73fSChristoph Hellwig &gadget_config_name_attr_configuration, 65988af8bbeSSebastian Andrzej Siewior NULL, 66088af8bbeSSebastian Andrzej Siewior }; 66188af8bbeSSebastian Andrzej Siewior 66288af8bbeSSebastian Andrzej Siewior static void gadget_config_name_attr_release(struct config_item *item) 66388af8bbeSSebastian Andrzej Siewior { 66488af8bbeSSebastian Andrzej Siewior struct gadget_config_name *cn = to_gadget_config_name(item); 66588af8bbeSSebastian Andrzej Siewior 66688af8bbeSSebastian Andrzej Siewior kfree(cn->configuration); 66788af8bbeSSebastian Andrzej Siewior 66888af8bbeSSebastian Andrzej Siewior list_del(&cn->list); 66988af8bbeSSebastian Andrzej Siewior kfree(cn); 67088af8bbeSSebastian Andrzej Siewior } 67188af8bbeSSebastian Andrzej Siewior 67288af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRING_RW_OPS(gadget_config_name); 67388af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRINGS_LANG(gadget_config_name, config_usb_cfg); 67488af8bbeSSebastian Andrzej Siewior 67588af8bbeSSebastian Andrzej Siewior static struct config_group *config_desc_make( 67688af8bbeSSebastian Andrzej Siewior struct config_group *group, 67788af8bbeSSebastian Andrzej Siewior const char *name) 67888af8bbeSSebastian Andrzej Siewior { 67988af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 68088af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 68188af8bbeSSebastian Andrzej Siewior char buf[MAX_NAME_LEN]; 68288af8bbeSSebastian Andrzej Siewior char *num_str; 68388af8bbeSSebastian Andrzej Siewior u8 num; 68488af8bbeSSebastian Andrzej Siewior int ret; 68588af8bbeSSebastian Andrzej Siewior 68688af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, configs_group); 68788af8bbeSSebastian Andrzej Siewior ret = snprintf(buf, MAX_NAME_LEN, "%s", name); 68888af8bbeSSebastian Andrzej Siewior if (ret >= MAX_NAME_LEN) 68988af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENAMETOOLONG); 69088af8bbeSSebastian Andrzej Siewior 69188af8bbeSSebastian Andrzej Siewior num_str = strchr(buf, '.'); 69288af8bbeSSebastian Andrzej Siewior if (!num_str) { 69388af8bbeSSebastian Andrzej Siewior pr_err("Unable to locate . in name.bConfigurationValue\n"); 69488af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL); 69588af8bbeSSebastian Andrzej Siewior } 69688af8bbeSSebastian Andrzej Siewior 69788af8bbeSSebastian Andrzej Siewior *num_str = '\0'; 69888af8bbeSSebastian Andrzej Siewior num_str++; 69988af8bbeSSebastian Andrzej Siewior 70088af8bbeSSebastian Andrzej Siewior if (!strlen(buf)) 70188af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL); 70288af8bbeSSebastian Andrzej Siewior 70388af8bbeSSebastian Andrzej Siewior ret = kstrtou8(num_str, 0, &num); 70488af8bbeSSebastian Andrzej Siewior if (ret) 70588af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret); 70688af8bbeSSebastian Andrzej Siewior 70788af8bbeSSebastian Andrzej Siewior cfg = kzalloc(sizeof(*cfg), GFP_KERNEL); 70888af8bbeSSebastian Andrzej Siewior if (!cfg) 70988af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM); 71088af8bbeSSebastian Andrzej Siewior cfg->c.label = kstrdup(buf, GFP_KERNEL); 71188af8bbeSSebastian Andrzej Siewior if (!cfg->c.label) { 71288af8bbeSSebastian Andrzej Siewior ret = -ENOMEM; 71388af8bbeSSebastian Andrzej Siewior goto err; 71488af8bbeSSebastian Andrzej Siewior } 71588af8bbeSSebastian Andrzej Siewior cfg->c.bConfigurationValue = num; 71688af8bbeSSebastian Andrzej Siewior cfg->c.MaxPower = CONFIG_USB_GADGET_VBUS_DRAW; 71788af8bbeSSebastian Andrzej Siewior cfg->c.bmAttributes = USB_CONFIG_ATT_ONE; 71888af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cfg->string_list); 71988af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cfg->func_list); 72088af8bbeSSebastian Andrzej Siewior 72188af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&cfg->group, name, 72288af8bbeSSebastian Andrzej Siewior &gadget_config_type); 7231ae1602dSChristoph Hellwig 72488af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&cfg->strings_group, "strings", 72588af8bbeSSebastian Andrzej Siewior &gadget_config_name_strings_type); 7261ae1602dSChristoph Hellwig configfs_add_default_group(&cfg->strings_group, &cfg->group); 72788af8bbeSSebastian Andrzej Siewior 72888af8bbeSSebastian Andrzej Siewior ret = usb_add_config_only(&gi->cdev, &cfg->c); 72988af8bbeSSebastian Andrzej Siewior if (ret) 73088af8bbeSSebastian Andrzej Siewior goto err; 73188af8bbeSSebastian Andrzej Siewior 73288af8bbeSSebastian Andrzej Siewior return &cfg->group; 73388af8bbeSSebastian Andrzej Siewior err: 73488af8bbeSSebastian Andrzej Siewior kfree(cfg->c.label); 73588af8bbeSSebastian Andrzej Siewior kfree(cfg); 73688af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret); 73788af8bbeSSebastian Andrzej Siewior } 73888af8bbeSSebastian Andrzej Siewior 73988af8bbeSSebastian Andrzej Siewior static void config_desc_drop( 74088af8bbeSSebastian Andrzej Siewior struct config_group *group, 74188af8bbeSSebastian Andrzej Siewior struct config_item *item) 74288af8bbeSSebastian Andrzej Siewior { 74388af8bbeSSebastian Andrzej Siewior config_item_put(item); 74488af8bbeSSebastian Andrzej Siewior } 74588af8bbeSSebastian Andrzej Siewior 74688af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations config_desc_ops = { 74788af8bbeSSebastian Andrzej Siewior .make_group = &config_desc_make, 74888af8bbeSSebastian Andrzej Siewior .drop_item = &config_desc_drop, 74988af8bbeSSebastian Andrzej Siewior }; 75088af8bbeSSebastian Andrzej Siewior 7514ad01412SBhumika Goyal static const struct config_item_type config_desc_type = { 75288af8bbeSSebastian Andrzej Siewior .ct_group_ops = &config_desc_ops, 75388af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 75488af8bbeSSebastian Andrzej Siewior }; 75588af8bbeSSebastian Andrzej Siewior 75688af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_strings, manufacturer); 75788af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_strings, product); 75888af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_strings, serialnumber); 75988af8bbeSSebastian Andrzej Siewior 76088af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_strings_langid_attrs[] = { 76145b6a73fSChristoph Hellwig &gadget_strings_attr_manufacturer, 76245b6a73fSChristoph Hellwig &gadget_strings_attr_product, 76345b6a73fSChristoph Hellwig &gadget_strings_attr_serialnumber, 76488af8bbeSSebastian Andrzej Siewior NULL, 76588af8bbeSSebastian Andrzej Siewior }; 76688af8bbeSSebastian Andrzej Siewior 76788af8bbeSSebastian Andrzej Siewior static void gadget_strings_attr_release(struct config_item *item) 76888af8bbeSSebastian Andrzej Siewior { 76988af8bbeSSebastian Andrzej Siewior struct gadget_strings *gs = to_gadget_strings(item); 77088af8bbeSSebastian Andrzej Siewior 77188af8bbeSSebastian Andrzej Siewior kfree(gs->manufacturer); 77288af8bbeSSebastian Andrzej Siewior kfree(gs->product); 77388af8bbeSSebastian Andrzej Siewior kfree(gs->serialnumber); 77488af8bbeSSebastian Andrzej Siewior 77588af8bbeSSebastian Andrzej Siewior list_del(&gs->list); 77688af8bbeSSebastian Andrzej Siewior kfree(gs); 77788af8bbeSSebastian Andrzej Siewior } 77888af8bbeSSebastian Andrzej Siewior 77988af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRING_RW_OPS(gadget_strings); 78088af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRINGS_LANG(gadget_strings, gadget_info); 78188af8bbeSSebastian Andrzej Siewior 78245b6a73fSChristoph Hellwig static inline struct gadget_info *os_desc_item_to_gadget_info( 78345b6a73fSChristoph Hellwig struct config_item *item) 78487213d38SAndrzej Pietrasiewicz { 785167a799cSLinyu Yuan return container_of(to_config_group(item), 786167a799cSLinyu Yuan struct gadget_info, os_desc_group); 78787213d38SAndrzej Pietrasiewicz } 78887213d38SAndrzej Pietrasiewicz 78945b6a73fSChristoph Hellwig static ssize_t os_desc_use_show(struct config_item *item, char *page) 79045b6a73fSChristoph Hellwig { 791e800e8cbSStefan Agner return sprintf(page, "%d\n", 79245b6a73fSChristoph Hellwig os_desc_item_to_gadget_info(item)->use_os_desc); 79345b6a73fSChristoph Hellwig } 79445b6a73fSChristoph Hellwig 79545b6a73fSChristoph Hellwig static ssize_t os_desc_use_store(struct config_item *item, const char *page, 79687213d38SAndrzej Pietrasiewicz size_t len) 79787213d38SAndrzej Pietrasiewicz { 79845b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 79987213d38SAndrzej Pietrasiewicz int ret; 80087213d38SAndrzej Pietrasiewicz bool use; 80187213d38SAndrzej Pietrasiewicz 80287213d38SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 80387213d38SAndrzej Pietrasiewicz ret = strtobool(page, &use); 80487213d38SAndrzej Pietrasiewicz if (!ret) { 80587213d38SAndrzej Pietrasiewicz gi->use_os_desc = use; 80687213d38SAndrzej Pietrasiewicz ret = len; 80787213d38SAndrzej Pietrasiewicz } 80887213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 80987213d38SAndrzej Pietrasiewicz 81087213d38SAndrzej Pietrasiewicz return ret; 81187213d38SAndrzej Pietrasiewicz } 81287213d38SAndrzej Pietrasiewicz 81345b6a73fSChristoph Hellwig static ssize_t os_desc_b_vendor_code_show(struct config_item *item, char *page) 81487213d38SAndrzej Pietrasiewicz { 815e800e8cbSStefan Agner return sprintf(page, "0x%02x\n", 81645b6a73fSChristoph Hellwig os_desc_item_to_gadget_info(item)->b_vendor_code); 81787213d38SAndrzej Pietrasiewicz } 81887213d38SAndrzej Pietrasiewicz 81945b6a73fSChristoph Hellwig static ssize_t os_desc_b_vendor_code_store(struct config_item *item, 82087213d38SAndrzej Pietrasiewicz const char *page, size_t len) 82187213d38SAndrzej Pietrasiewicz { 82245b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 82387213d38SAndrzej Pietrasiewicz int ret; 82487213d38SAndrzej Pietrasiewicz u8 b_vendor_code; 82587213d38SAndrzej Pietrasiewicz 82687213d38SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 82787213d38SAndrzej Pietrasiewicz ret = kstrtou8(page, 0, &b_vendor_code); 82887213d38SAndrzej Pietrasiewicz if (!ret) { 82987213d38SAndrzej Pietrasiewicz gi->b_vendor_code = b_vendor_code; 83087213d38SAndrzej Pietrasiewicz ret = len; 83187213d38SAndrzej Pietrasiewicz } 83287213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 83387213d38SAndrzej Pietrasiewicz 83487213d38SAndrzej Pietrasiewicz return ret; 83587213d38SAndrzej Pietrasiewicz } 83687213d38SAndrzej Pietrasiewicz 83745b6a73fSChristoph Hellwig static ssize_t os_desc_qw_sign_show(struct config_item *item, char *page) 83887213d38SAndrzej Pietrasiewicz { 83945b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 84076180d71SStefan Agner int res; 84187213d38SAndrzej Pietrasiewicz 84276180d71SStefan Agner res = utf16s_to_utf8s((wchar_t *) gi->qw_sign, OS_STRING_QW_SIGN_LEN, 84376180d71SStefan Agner UTF16_LITTLE_ENDIAN, page, PAGE_SIZE - 1); 84476180d71SStefan Agner page[res++] = '\n'; 84576180d71SStefan Agner 84676180d71SStefan Agner return res; 84787213d38SAndrzej Pietrasiewicz } 84887213d38SAndrzej Pietrasiewicz 84945b6a73fSChristoph Hellwig static ssize_t os_desc_qw_sign_store(struct config_item *item, const char *page, 85087213d38SAndrzej Pietrasiewicz size_t len) 85187213d38SAndrzej Pietrasiewicz { 85245b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 85387213d38SAndrzej Pietrasiewicz int res, l; 85487213d38SAndrzej Pietrasiewicz 85587213d38SAndrzej Pietrasiewicz l = min((int)len, OS_STRING_QW_SIGN_LEN >> 1); 85687213d38SAndrzej Pietrasiewicz if (page[l - 1] == '\n') 85787213d38SAndrzej Pietrasiewicz --l; 85887213d38SAndrzej Pietrasiewicz 85987213d38SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 86087213d38SAndrzej Pietrasiewicz res = utf8s_to_utf16s(page, l, 86187213d38SAndrzej Pietrasiewicz UTF16_LITTLE_ENDIAN, (wchar_t *) gi->qw_sign, 86287213d38SAndrzej Pietrasiewicz OS_STRING_QW_SIGN_LEN); 86387213d38SAndrzej Pietrasiewicz if (res > 0) 86487213d38SAndrzej Pietrasiewicz res = len; 86587213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 86687213d38SAndrzej Pietrasiewicz 86787213d38SAndrzej Pietrasiewicz return res; 86887213d38SAndrzej Pietrasiewicz } 86987213d38SAndrzej Pietrasiewicz 87045b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, use); 87145b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, b_vendor_code); 87245b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, qw_sign); 87387213d38SAndrzej Pietrasiewicz 87487213d38SAndrzej Pietrasiewicz static struct configfs_attribute *os_desc_attrs[] = { 87545b6a73fSChristoph Hellwig &os_desc_attr_use, 87645b6a73fSChristoph Hellwig &os_desc_attr_b_vendor_code, 87745b6a73fSChristoph Hellwig &os_desc_attr_qw_sign, 87887213d38SAndrzej Pietrasiewicz NULL, 87987213d38SAndrzej Pietrasiewicz }; 88087213d38SAndrzej Pietrasiewicz 881da424314SAndrzej Pietrasiewicz static int os_desc_link(struct config_item *os_desc_ci, 882da424314SAndrzej Pietrasiewicz struct config_item *usb_cfg_ci) 883da424314SAndrzej Pietrasiewicz { 884167a799cSLinyu Yuan struct gadget_info *gi = os_desc_item_to_gadget_info(os_desc_ci); 885da424314SAndrzej Pietrasiewicz struct usb_composite_dev *cdev = &gi->cdev; 8865d143ec4SLinyu Yuan struct config_usb_cfg *c_target = to_config_usb_cfg(usb_cfg_ci); 887*36f4c25cSJakob Koschel struct usb_configuration *c = NULL, *iter; 888da424314SAndrzej Pietrasiewicz int ret; 889da424314SAndrzej Pietrasiewicz 890da424314SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 891*36f4c25cSJakob Koschel list_for_each_entry(iter, &cdev->configs, list) { 892*36f4c25cSJakob Koschel if (iter != &c_target->c) 893*36f4c25cSJakob Koschel continue; 894*36f4c25cSJakob Koschel c = iter; 895da424314SAndrzej Pietrasiewicz break; 896da424314SAndrzej Pietrasiewicz } 897*36f4c25cSJakob Koschel if (!c) { 898da424314SAndrzej Pietrasiewicz ret = -EINVAL; 899da424314SAndrzej Pietrasiewicz goto out; 900da424314SAndrzej Pietrasiewicz } 901da424314SAndrzej Pietrasiewicz 902da424314SAndrzej Pietrasiewicz if (cdev->os_desc_config) { 903da424314SAndrzej Pietrasiewicz ret = -EBUSY; 904da424314SAndrzej Pietrasiewicz goto out; 905da424314SAndrzej Pietrasiewicz } 906da424314SAndrzej Pietrasiewicz 907da424314SAndrzej Pietrasiewicz cdev->os_desc_config = &c_target->c; 908da424314SAndrzej Pietrasiewicz ret = 0; 909da424314SAndrzej Pietrasiewicz 910da424314SAndrzej Pietrasiewicz out: 911da424314SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 912da424314SAndrzej Pietrasiewicz return ret; 913da424314SAndrzej Pietrasiewicz } 914da424314SAndrzej Pietrasiewicz 915e16769d4SAndrzej Pietrasiewicz static void os_desc_unlink(struct config_item *os_desc_ci, 916da424314SAndrzej Pietrasiewicz struct config_item *usb_cfg_ci) 917da424314SAndrzej Pietrasiewicz { 918167a799cSLinyu Yuan struct gadget_info *gi = os_desc_item_to_gadget_info(os_desc_ci); 919da424314SAndrzej Pietrasiewicz struct usb_composite_dev *cdev = &gi->cdev; 920da424314SAndrzej Pietrasiewicz 921da424314SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 922afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name) 923da424314SAndrzej Pietrasiewicz unregister_gadget(gi); 924da424314SAndrzej Pietrasiewicz cdev->os_desc_config = NULL; 925afdaadc3SRuslan Bilovol WARN_ON(gi->composite.gadget_driver.udc_name); 926da424314SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 927da424314SAndrzej Pietrasiewicz } 928da424314SAndrzej Pietrasiewicz 92987213d38SAndrzej Pietrasiewicz static struct configfs_item_operations os_desc_ops = { 930da424314SAndrzej Pietrasiewicz .allow_link = os_desc_link, 931da424314SAndrzej Pietrasiewicz .drop_link = os_desc_unlink, 93287213d38SAndrzej Pietrasiewicz }; 93387213d38SAndrzej Pietrasiewicz 93487213d38SAndrzej Pietrasiewicz static struct config_item_type os_desc_type = { 93587213d38SAndrzej Pietrasiewicz .ct_item_ops = &os_desc_ops, 93687213d38SAndrzej Pietrasiewicz .ct_attrs = os_desc_attrs, 93787213d38SAndrzej Pietrasiewicz .ct_owner = THIS_MODULE, 93887213d38SAndrzej Pietrasiewicz }; 93987213d38SAndrzej Pietrasiewicz 9407419485fSAndrzej Pietrasiewicz static inline struct usb_os_desc_ext_prop 9417419485fSAndrzej Pietrasiewicz *to_usb_os_desc_ext_prop(struct config_item *item) 9427419485fSAndrzej Pietrasiewicz { 9437419485fSAndrzej Pietrasiewicz return container_of(item, struct usb_os_desc_ext_prop, item); 9447419485fSAndrzej Pietrasiewicz } 9457419485fSAndrzej Pietrasiewicz 94645b6a73fSChristoph Hellwig static ssize_t ext_prop_type_show(struct config_item *item, char *page) 9477419485fSAndrzej Pietrasiewicz { 948e800e8cbSStefan Agner return sprintf(page, "%d\n", to_usb_os_desc_ext_prop(item)->type); 9497419485fSAndrzej Pietrasiewicz } 9507419485fSAndrzej Pietrasiewicz 95145b6a73fSChristoph Hellwig static ssize_t ext_prop_type_store(struct config_item *item, 9527419485fSAndrzej Pietrasiewicz const char *page, size_t len) 9537419485fSAndrzej Pietrasiewicz { 95445b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 9557419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(ext_prop->item.ci_parent); 9567419485fSAndrzej Pietrasiewicz u8 type; 9577419485fSAndrzej Pietrasiewicz int ret; 9587419485fSAndrzej Pietrasiewicz 9597419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 9607419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 9617419485fSAndrzej Pietrasiewicz ret = kstrtou8(page, 0, &type); 9627419485fSAndrzej Pietrasiewicz if (ret) 9637419485fSAndrzej Pietrasiewicz goto end; 9647419485fSAndrzej Pietrasiewicz if (type < USB_EXT_PROP_UNICODE || type > USB_EXT_PROP_UNICODE_MULTI) { 9657419485fSAndrzej Pietrasiewicz ret = -EINVAL; 9667419485fSAndrzej Pietrasiewicz goto end; 9677419485fSAndrzej Pietrasiewicz } 9687419485fSAndrzej Pietrasiewicz 9697419485fSAndrzej Pietrasiewicz if ((ext_prop->type == USB_EXT_PROP_BINARY || 9707419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_LE32 || 9717419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_BE32) && 9727419485fSAndrzej Pietrasiewicz (type == USB_EXT_PROP_UNICODE || 9737419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_UNICODE_ENV || 9747419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_UNICODE_LINK)) 9757419485fSAndrzej Pietrasiewicz ext_prop->data_len <<= 1; 9767419485fSAndrzej Pietrasiewicz else if ((ext_prop->type == USB_EXT_PROP_UNICODE || 9777419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV || 9787419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) && 9797419485fSAndrzej Pietrasiewicz (type == USB_EXT_PROP_BINARY || 9807419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_LE32 || 9817419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_BE32)) 9827419485fSAndrzej Pietrasiewicz ext_prop->data_len >>= 1; 9837419485fSAndrzej Pietrasiewicz ext_prop->type = type; 9847419485fSAndrzej Pietrasiewicz ret = len; 9857419485fSAndrzej Pietrasiewicz 9867419485fSAndrzej Pietrasiewicz end: 9877419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 9887419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 9897419485fSAndrzej Pietrasiewicz return ret; 9907419485fSAndrzej Pietrasiewicz } 9917419485fSAndrzej Pietrasiewicz 99245b6a73fSChristoph Hellwig static ssize_t ext_prop_data_show(struct config_item *item, char *page) 9937419485fSAndrzej Pietrasiewicz { 99445b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 9957419485fSAndrzej Pietrasiewicz int len = ext_prop->data_len; 9967419485fSAndrzej Pietrasiewicz 9977419485fSAndrzej Pietrasiewicz if (ext_prop->type == USB_EXT_PROP_UNICODE || 9987419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV || 9997419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) 10007419485fSAndrzej Pietrasiewicz len >>= 1; 10017419485fSAndrzej Pietrasiewicz memcpy(page, ext_prop->data, len); 10027419485fSAndrzej Pietrasiewicz 10037419485fSAndrzej Pietrasiewicz return len; 10047419485fSAndrzej Pietrasiewicz } 10057419485fSAndrzej Pietrasiewicz 100645b6a73fSChristoph Hellwig static ssize_t ext_prop_data_store(struct config_item *item, 10077419485fSAndrzej Pietrasiewicz const char *page, size_t len) 10087419485fSAndrzej Pietrasiewicz { 100945b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 10107419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(ext_prop->item.ci_parent); 10117419485fSAndrzej Pietrasiewicz char *new_data; 10127419485fSAndrzej Pietrasiewicz size_t ret_len = len; 10137419485fSAndrzej Pietrasiewicz 10147419485fSAndrzej Pietrasiewicz if (page[len - 1] == '\n' || page[len - 1] == '\0') 10157419485fSAndrzej Pietrasiewicz --len; 101658b949e0SBenoit Taine new_data = kmemdup(page, len, GFP_KERNEL); 10177419485fSAndrzej Pietrasiewicz if (!new_data) 10187419485fSAndrzej Pietrasiewicz return -ENOMEM; 10197419485fSAndrzej Pietrasiewicz 10207419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10217419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 10227419485fSAndrzej Pietrasiewicz kfree(ext_prop->data); 10237419485fSAndrzej Pietrasiewicz ext_prop->data = new_data; 10247419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= ext_prop->data_len; 10257419485fSAndrzej Pietrasiewicz ext_prop->data_len = len; 10267419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->data_len; 10277419485fSAndrzej Pietrasiewicz if (ext_prop->type == USB_EXT_PROP_UNICODE || 10287419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV || 10297419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) { 10307419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= ext_prop->data_len; 10317419485fSAndrzej Pietrasiewicz ext_prop->data_len <<= 1; 10327419485fSAndrzej Pietrasiewicz ext_prop->data_len += 2; 10337419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->data_len; 10347419485fSAndrzej Pietrasiewicz } 10357419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10367419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 10377419485fSAndrzej Pietrasiewicz return ret_len; 10387419485fSAndrzej Pietrasiewicz } 10397419485fSAndrzej Pietrasiewicz 104045b6a73fSChristoph Hellwig CONFIGFS_ATTR(ext_prop_, type); 104145b6a73fSChristoph Hellwig CONFIGFS_ATTR(ext_prop_, data); 10427419485fSAndrzej Pietrasiewicz 10437419485fSAndrzej Pietrasiewicz static struct configfs_attribute *ext_prop_attrs[] = { 104445b6a73fSChristoph Hellwig &ext_prop_attr_type, 104545b6a73fSChristoph Hellwig &ext_prop_attr_data, 10467419485fSAndrzej Pietrasiewicz NULL, 10477419485fSAndrzej Pietrasiewicz }; 10487419485fSAndrzej Pietrasiewicz 10497419485fSAndrzej Pietrasiewicz static void usb_os_desc_ext_prop_release(struct config_item *item) 10507419485fSAndrzej Pietrasiewicz { 10517419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 10527419485fSAndrzej Pietrasiewicz 10537419485fSAndrzej Pietrasiewicz kfree(ext_prop); /* frees a whole chunk */ 10547419485fSAndrzej Pietrasiewicz } 10557419485fSAndrzej Pietrasiewicz 10567419485fSAndrzej Pietrasiewicz static struct configfs_item_operations ext_prop_ops = { 10577419485fSAndrzej Pietrasiewicz .release = usb_os_desc_ext_prop_release, 10587419485fSAndrzej Pietrasiewicz }; 10597419485fSAndrzej Pietrasiewicz 10607419485fSAndrzej Pietrasiewicz static struct config_item *ext_prop_make( 10617419485fSAndrzej Pietrasiewicz struct config_group *group, 10627419485fSAndrzej Pietrasiewicz const char *name) 10637419485fSAndrzej Pietrasiewicz { 10647419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop; 10657419485fSAndrzej Pietrasiewicz struct config_item_type *ext_prop_type; 10667419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc; 10677419485fSAndrzej Pietrasiewicz char *vlabuf; 10687419485fSAndrzej Pietrasiewicz 10697419485fSAndrzej Pietrasiewicz vla_group(data_chunk); 10707419485fSAndrzej Pietrasiewicz vla_item(data_chunk, struct usb_os_desc_ext_prop, ext_prop, 1); 10717419485fSAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, ext_prop_type, 1); 10727419485fSAndrzej Pietrasiewicz 10737419485fSAndrzej Pietrasiewicz vlabuf = kzalloc(vla_group_size(data_chunk), GFP_KERNEL); 10747419485fSAndrzej Pietrasiewicz if (!vlabuf) 10757419485fSAndrzej Pietrasiewicz return ERR_PTR(-ENOMEM); 10767419485fSAndrzej Pietrasiewicz 10777419485fSAndrzej Pietrasiewicz ext_prop = vla_ptr(vlabuf, data_chunk, ext_prop); 10787419485fSAndrzej Pietrasiewicz ext_prop_type = vla_ptr(vlabuf, data_chunk, ext_prop_type); 10797419485fSAndrzej Pietrasiewicz 10807419485fSAndrzej Pietrasiewicz desc = container_of(group, struct usb_os_desc, group); 10817419485fSAndrzej Pietrasiewicz ext_prop_type->ct_item_ops = &ext_prop_ops; 10827419485fSAndrzej Pietrasiewicz ext_prop_type->ct_attrs = ext_prop_attrs; 10837419485fSAndrzej Pietrasiewicz ext_prop_type->ct_owner = desc->owner; 10847419485fSAndrzej Pietrasiewicz 10857419485fSAndrzej Pietrasiewicz config_item_init_type_name(&ext_prop->item, name, ext_prop_type); 10867419485fSAndrzej Pietrasiewicz 10877419485fSAndrzej Pietrasiewicz ext_prop->name = kstrdup(name, GFP_KERNEL); 10887419485fSAndrzej Pietrasiewicz if (!ext_prop->name) { 10897419485fSAndrzej Pietrasiewicz kfree(vlabuf); 10907419485fSAndrzej Pietrasiewicz return ERR_PTR(-ENOMEM); 10917419485fSAndrzej Pietrasiewicz } 10927419485fSAndrzej Pietrasiewicz desc->ext_prop_len += 14; 10937419485fSAndrzej Pietrasiewicz ext_prop->name_len = 2 * strlen(ext_prop->name) + 2; 10947419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10957419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 10967419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->name_len; 10977419485fSAndrzej Pietrasiewicz list_add_tail(&ext_prop->entry, &desc->ext_prop); 10987419485fSAndrzej Pietrasiewicz ++desc->ext_prop_count; 10997419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 11007419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 11017419485fSAndrzej Pietrasiewicz 11027419485fSAndrzej Pietrasiewicz return &ext_prop->item; 11037419485fSAndrzej Pietrasiewicz } 11047419485fSAndrzej Pietrasiewicz 11057419485fSAndrzej Pietrasiewicz static void ext_prop_drop(struct config_group *group, struct config_item *item) 11067419485fSAndrzej Pietrasiewicz { 11077419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 11087419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(&group->cg_item); 11097419485fSAndrzej Pietrasiewicz 11107419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 11117419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 11127419485fSAndrzej Pietrasiewicz list_del(&ext_prop->entry); 11137419485fSAndrzej Pietrasiewicz --desc->ext_prop_count; 11147419485fSAndrzej Pietrasiewicz kfree(ext_prop->name); 11157419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= (ext_prop->name_len + ext_prop->data_len + 14); 11167419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 11177419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 11187419485fSAndrzej Pietrasiewicz config_item_put(item); 11197419485fSAndrzej Pietrasiewicz } 11207419485fSAndrzej Pietrasiewicz 11217419485fSAndrzej Pietrasiewicz static struct configfs_group_operations interf_grp_ops = { 11227419485fSAndrzej Pietrasiewicz .make_item = &ext_prop_make, 11237419485fSAndrzej Pietrasiewicz .drop_item = &ext_prop_drop, 11247419485fSAndrzej Pietrasiewicz }; 11257419485fSAndrzej Pietrasiewicz 112645b6a73fSChristoph Hellwig static ssize_t interf_grp_compatible_id_show(struct config_item *item, 1127da424314SAndrzej Pietrasiewicz char *page) 1128da424314SAndrzej Pietrasiewicz { 112945b6a73fSChristoph Hellwig memcpy(page, to_usb_os_desc(item)->ext_compat_id, 8); 1130da424314SAndrzej Pietrasiewicz return 8; 1131da424314SAndrzej Pietrasiewicz } 1132da424314SAndrzej Pietrasiewicz 113345b6a73fSChristoph Hellwig static ssize_t interf_grp_compatible_id_store(struct config_item *item, 1134da424314SAndrzej Pietrasiewicz const char *page, size_t len) 1135da424314SAndrzej Pietrasiewicz { 113645b6a73fSChristoph Hellwig struct usb_os_desc *desc = to_usb_os_desc(item); 1137da424314SAndrzej Pietrasiewicz int l; 1138da424314SAndrzej Pietrasiewicz 1139da424314SAndrzej Pietrasiewicz l = min_t(int, 8, len); 1140da424314SAndrzej Pietrasiewicz if (page[l - 1] == '\n') 1141da424314SAndrzej Pietrasiewicz --l; 1142da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1143da424314SAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 1144da424314SAndrzej Pietrasiewicz memcpy(desc->ext_compat_id, page, l); 1145da424314SAndrzej Pietrasiewicz 1146da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1147da424314SAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 1148da424314SAndrzej Pietrasiewicz 1149da424314SAndrzej Pietrasiewicz return len; 1150da424314SAndrzej Pietrasiewicz } 1151da424314SAndrzej Pietrasiewicz 115245b6a73fSChristoph Hellwig static ssize_t interf_grp_sub_compatible_id_show(struct config_item *item, 1153da424314SAndrzej Pietrasiewicz char *page) 1154da424314SAndrzej Pietrasiewicz { 115545b6a73fSChristoph Hellwig memcpy(page, to_usb_os_desc(item)->ext_compat_id + 8, 8); 1156da424314SAndrzej Pietrasiewicz return 8; 1157da424314SAndrzej Pietrasiewicz } 1158da424314SAndrzej Pietrasiewicz 115945b6a73fSChristoph Hellwig static ssize_t interf_grp_sub_compatible_id_store(struct config_item *item, 1160da424314SAndrzej Pietrasiewicz const char *page, size_t len) 1161da424314SAndrzej Pietrasiewicz { 116245b6a73fSChristoph Hellwig struct usb_os_desc *desc = to_usb_os_desc(item); 1163da424314SAndrzej Pietrasiewicz int l; 1164da424314SAndrzej Pietrasiewicz 1165da424314SAndrzej Pietrasiewicz l = min_t(int, 8, len); 1166da424314SAndrzej Pietrasiewicz if (page[l - 1] == '\n') 1167da424314SAndrzej Pietrasiewicz --l; 1168da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1169da424314SAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 1170da424314SAndrzej Pietrasiewicz memcpy(desc->ext_compat_id + 8, page, l); 1171da424314SAndrzej Pietrasiewicz 1172da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1173da424314SAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 1174da424314SAndrzej Pietrasiewicz 1175da424314SAndrzej Pietrasiewicz return len; 1176da424314SAndrzej Pietrasiewicz } 1177da424314SAndrzej Pietrasiewicz 117845b6a73fSChristoph Hellwig CONFIGFS_ATTR(interf_grp_, compatible_id); 117945b6a73fSChristoph Hellwig CONFIGFS_ATTR(interf_grp_, sub_compatible_id); 1180da424314SAndrzej Pietrasiewicz 1181da424314SAndrzej Pietrasiewicz static struct configfs_attribute *interf_grp_attrs[] = { 118245b6a73fSChristoph Hellwig &interf_grp_attr_compatible_id, 118345b6a73fSChristoph Hellwig &interf_grp_attr_sub_compatible_id, 1184da424314SAndrzej Pietrasiewicz NULL 1185da424314SAndrzej Pietrasiewicz }; 1186da424314SAndrzej Pietrasiewicz 1187ff74745eSAndrew Gabbasov struct config_group *usb_os_desc_prepare_interf_dir( 1188ff74745eSAndrew Gabbasov struct config_group *parent, 1189da424314SAndrzej Pietrasiewicz int n_interf, 1190da424314SAndrzej Pietrasiewicz struct usb_os_desc **desc, 119114574b54SAndrzej Pietrasiewicz char **names, 1192da424314SAndrzej Pietrasiewicz struct module *owner) 1193da424314SAndrzej Pietrasiewicz { 11941ae1602dSChristoph Hellwig struct config_group *os_desc_group; 1195da424314SAndrzej Pietrasiewicz struct config_item_type *os_desc_type, *interface_type; 1196da424314SAndrzej Pietrasiewicz 1197da424314SAndrzej Pietrasiewicz vla_group(data_chunk); 1198da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_group, os_desc_group, 1); 1199da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, os_desc_type, 1); 1200da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, interface_type, 1); 1201da424314SAndrzej Pietrasiewicz 1202da424314SAndrzej Pietrasiewicz char *vlabuf = kzalloc(vla_group_size(data_chunk), GFP_KERNEL); 1203da424314SAndrzej Pietrasiewicz if (!vlabuf) 1204ff74745eSAndrew Gabbasov return ERR_PTR(-ENOMEM); 1205da424314SAndrzej Pietrasiewicz 1206da424314SAndrzej Pietrasiewicz os_desc_group = vla_ptr(vlabuf, data_chunk, os_desc_group); 1207da424314SAndrzej Pietrasiewicz os_desc_type = vla_ptr(vlabuf, data_chunk, os_desc_type); 1208da424314SAndrzej Pietrasiewicz interface_type = vla_ptr(vlabuf, data_chunk, interface_type); 1209da424314SAndrzej Pietrasiewicz 1210da424314SAndrzej Pietrasiewicz os_desc_type->ct_owner = owner; 1211da424314SAndrzej Pietrasiewicz config_group_init_type_name(os_desc_group, "os_desc", os_desc_type); 12121ae1602dSChristoph Hellwig configfs_add_default_group(os_desc_group, parent); 1213da424314SAndrzej Pietrasiewicz 12147419485fSAndrzej Pietrasiewicz interface_type->ct_group_ops = &interf_grp_ops; 1215da424314SAndrzej Pietrasiewicz interface_type->ct_attrs = interf_grp_attrs; 1216da424314SAndrzej Pietrasiewicz interface_type->ct_owner = owner; 1217da424314SAndrzej Pietrasiewicz 1218da424314SAndrzej Pietrasiewicz while (n_interf--) { 1219da424314SAndrzej Pietrasiewicz struct usb_os_desc *d; 1220da424314SAndrzej Pietrasiewicz 1221da424314SAndrzej Pietrasiewicz d = desc[n_interf]; 12227419485fSAndrzej Pietrasiewicz d->owner = owner; 1223da424314SAndrzej Pietrasiewicz config_group_init_type_name(&d->group, "", interface_type); 122414574b54SAndrzej Pietrasiewicz config_item_set_name(&d->group.cg_item, "interface.%s", 122514574b54SAndrzej Pietrasiewicz names[n_interf]); 12261ae1602dSChristoph Hellwig configfs_add_default_group(&d->group, os_desc_group); 1227da424314SAndrzej Pietrasiewicz } 1228da424314SAndrzej Pietrasiewicz 1229ff74745eSAndrew Gabbasov return os_desc_group; 1230da424314SAndrzej Pietrasiewicz } 1231da424314SAndrzej Pietrasiewicz EXPORT_SYMBOL(usb_os_desc_prepare_interf_dir); 1232da424314SAndrzej Pietrasiewicz 123388af8bbeSSebastian Andrzej Siewior static int configfs_do_nothing(struct usb_composite_dev *cdev) 123488af8bbeSSebastian Andrzej Siewior { 123575bfe23aSDavid Rientjes WARN_ON(1); 123688af8bbeSSebastian Andrzej Siewior return -EINVAL; 123788af8bbeSSebastian Andrzej Siewior } 123888af8bbeSSebastian Andrzej Siewior 123988af8bbeSSebastian Andrzej Siewior int composite_dev_prepare(struct usb_composite_driver *composite, 124088af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *dev); 124188af8bbeSSebastian Andrzej Siewior 1242da424314SAndrzej Pietrasiewicz int composite_os_desc_req_prepare(struct usb_composite_dev *cdev, 1243da424314SAndrzej Pietrasiewicz struct usb_ep *ep0); 1244da424314SAndrzej Pietrasiewicz 124588af8bbeSSebastian Andrzej Siewior static void purge_configs_funcs(struct gadget_info *gi) 124688af8bbeSSebastian Andrzej Siewior { 124788af8bbeSSebastian Andrzej Siewior struct usb_configuration *c; 124888af8bbeSSebastian Andrzej Siewior 124988af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) { 125088af8bbeSSebastian Andrzej Siewior struct usb_function *f, *tmp; 125188af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 125288af8bbeSSebastian Andrzej Siewior 125388af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c); 125488af8bbeSSebastian Andrzej Siewior 12556cd0fe91SChandana Kishori Chiluveru list_for_each_entry_safe_reverse(f, tmp, &c->functions, list) { 125688af8bbeSSebastian Andrzej Siewior 12576cd0fe91SChandana Kishori Chiluveru list_move(&f->list, &cfg->func_list); 125888af8bbeSSebastian Andrzej Siewior if (f->unbind) { 1259da7b895dSRomain Izard dev_dbg(&gi->cdev.gadget->dev, 1260a08f5dbfSRomain Izard "unbind function '%s'/%p\n", 1261a08f5dbfSRomain Izard f->name, f); 126288af8bbeSSebastian Andrzej Siewior f->unbind(c, f); 126388af8bbeSSebastian Andrzej Siewior } 126488af8bbeSSebastian Andrzej Siewior } 126588af8bbeSSebastian Andrzej Siewior c->next_interface_id = 0; 1266903124feSKrzysztof Opasiak memset(c->interface, 0, sizeof(c->interface)); 1267554eead5SJohn Youn c->superspeed_plus = 0; 126888af8bbeSSebastian Andrzej Siewior c->superspeed = 0; 126988af8bbeSSebastian Andrzej Siewior c->highspeed = 0; 127088af8bbeSSebastian Andrzej Siewior c->fullspeed = 0; 127188af8bbeSSebastian Andrzej Siewior } 127288af8bbeSSebastian Andrzej Siewior } 127388af8bbeSSebastian Andrzej Siewior 127488af8bbeSSebastian Andrzej Siewior static int configfs_composite_bind(struct usb_gadget *gadget, 127588af8bbeSSebastian Andrzej Siewior struct usb_gadget_driver *gdriver) 127688af8bbeSSebastian Andrzej Siewior { 127788af8bbeSSebastian Andrzej Siewior struct usb_composite_driver *composite = to_cdriver(gdriver); 127888af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = container_of(composite, 127988af8bbeSSebastian Andrzej Siewior struct gadget_info, composite); 128088af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev = &gi->cdev; 128188af8bbeSSebastian Andrzej Siewior struct usb_configuration *c; 128288af8bbeSSebastian Andrzej Siewior struct usb_string *s; 128388af8bbeSSebastian Andrzej Siewior unsigned i; 128488af8bbeSSebastian Andrzej Siewior int ret; 128588af8bbeSSebastian Andrzej Siewior 128688af8bbeSSebastian Andrzej Siewior /* the gi->lock is hold by the caller */ 12871a1c851bSPeter Chen gi->unbind = 0; 128888af8bbeSSebastian Andrzej Siewior cdev->gadget = gadget; 128988af8bbeSSebastian Andrzej Siewior set_gadget_data(gadget, cdev); 129088af8bbeSSebastian Andrzej Siewior ret = composite_dev_prepare(composite, cdev); 129188af8bbeSSebastian Andrzej Siewior if (ret) 129288af8bbeSSebastian Andrzej Siewior return ret; 129388af8bbeSSebastian Andrzej Siewior /* and now the gadget bind */ 129488af8bbeSSebastian Andrzej Siewior ret = -EINVAL; 129588af8bbeSSebastian Andrzej Siewior 129688af8bbeSSebastian Andrzej Siewior if (list_empty(&gi->cdev.configs)) { 129788af8bbeSSebastian Andrzej Siewior pr_err("Need at least one configuration in %s.\n", 129888af8bbeSSebastian Andrzej Siewior gi->composite.name); 129988af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 130088af8bbeSSebastian Andrzej Siewior } 130188af8bbeSSebastian Andrzej Siewior 130288af8bbeSSebastian Andrzej Siewior 130388af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) { 130488af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 130588af8bbeSSebastian Andrzej Siewior 130688af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c); 130788af8bbeSSebastian Andrzej Siewior if (list_empty(&cfg->func_list)) { 130888af8bbeSSebastian Andrzej Siewior pr_err("Config %s/%d of %s needs at least one function.\n", 130988af8bbeSSebastian Andrzej Siewior c->label, c->bConfigurationValue, 131088af8bbeSSebastian Andrzej Siewior gi->composite.name); 131188af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 131288af8bbeSSebastian Andrzej Siewior } 131388af8bbeSSebastian Andrzej Siewior } 131488af8bbeSSebastian Andrzej Siewior 131588af8bbeSSebastian Andrzej Siewior /* init all strings */ 131688af8bbeSSebastian Andrzej Siewior if (!list_empty(&gi->string_list)) { 131788af8bbeSSebastian Andrzej Siewior struct gadget_strings *gs; 131888af8bbeSSebastian Andrzej Siewior 131988af8bbeSSebastian Andrzej Siewior i = 0; 132088af8bbeSSebastian Andrzej Siewior list_for_each_entry(gs, &gi->string_list, list) { 132188af8bbeSSebastian Andrzej Siewior 132288af8bbeSSebastian Andrzej Siewior gi->gstrings[i] = &gs->stringtab_dev; 132388af8bbeSSebastian Andrzej Siewior gs->stringtab_dev.strings = gs->strings; 132488af8bbeSSebastian Andrzej Siewior gs->strings[USB_GADGET_MANUFACTURER_IDX].s = 132588af8bbeSSebastian Andrzej Siewior gs->manufacturer; 132688af8bbeSSebastian Andrzej Siewior gs->strings[USB_GADGET_PRODUCT_IDX].s = gs->product; 132788af8bbeSSebastian Andrzej Siewior gs->strings[USB_GADGET_SERIAL_IDX].s = gs->serialnumber; 132888af8bbeSSebastian Andrzej Siewior i++; 132988af8bbeSSebastian Andrzej Siewior } 133088af8bbeSSebastian Andrzej Siewior gi->gstrings[i] = NULL; 133188af8bbeSSebastian Andrzej Siewior s = usb_gstrings_attach(&gi->cdev, gi->gstrings, 133288af8bbeSSebastian Andrzej Siewior USB_GADGET_FIRST_AVAIL_IDX); 1333fea77077SWei Yongjun if (IS_ERR(s)) { 1334fea77077SWei Yongjun ret = PTR_ERR(s); 133588af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 1336fea77077SWei Yongjun } 133788af8bbeSSebastian Andrzej Siewior 133888af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iManufacturer = s[USB_GADGET_MANUFACTURER_IDX].id; 133988af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iProduct = s[USB_GADGET_PRODUCT_IDX].id; 134088af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iSerialNumber = s[USB_GADGET_SERIAL_IDX].id; 134188af8bbeSSebastian Andrzej Siewior } 134288af8bbeSSebastian Andrzej Siewior 134387213d38SAndrzej Pietrasiewicz if (gi->use_os_desc) { 134487213d38SAndrzej Pietrasiewicz cdev->use_os_string = true; 134587213d38SAndrzej Pietrasiewicz cdev->b_vendor_code = gi->b_vendor_code; 134687213d38SAndrzej Pietrasiewicz memcpy(cdev->qw_sign, gi->qw_sign, OS_STRING_QW_SIGN_LEN); 134787213d38SAndrzej Pietrasiewicz } 134887213d38SAndrzej Pietrasiewicz 134941ce84c8SLi Jun if (gadget_is_otg(gadget) && !otg_desc[0]) { 135041ce84c8SLi Jun struct usb_descriptor_header *usb_desc; 135141ce84c8SLi Jun 135241ce84c8SLi Jun usb_desc = usb_otg_descriptor_alloc(gadget); 135341ce84c8SLi Jun if (!usb_desc) { 135441ce84c8SLi Jun ret = -ENOMEM; 135541ce84c8SLi Jun goto err_comp_cleanup; 135641ce84c8SLi Jun } 135741ce84c8SLi Jun usb_otg_descriptor_init(gadget, usb_desc); 135841ce84c8SLi Jun otg_desc[0] = usb_desc; 135941ce84c8SLi Jun otg_desc[1] = NULL; 136041ce84c8SLi Jun } 136141ce84c8SLi Jun 136288af8bbeSSebastian Andrzej Siewior /* Go through all configs, attach all functions */ 136388af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) { 136488af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 136588af8bbeSSebastian Andrzej Siewior struct usb_function *f; 136688af8bbeSSebastian Andrzej Siewior struct usb_function *tmp; 136788af8bbeSSebastian Andrzej Siewior struct gadget_config_name *cn; 136888af8bbeSSebastian Andrzej Siewior 136941ce84c8SLi Jun if (gadget_is_otg(gadget)) 137041ce84c8SLi Jun c->descriptors = otg_desc; 137141ce84c8SLi Jun 137288af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c); 137388af8bbeSSebastian Andrzej Siewior if (!list_empty(&cfg->string_list)) { 137488af8bbeSSebastian Andrzej Siewior i = 0; 137588af8bbeSSebastian Andrzej Siewior list_for_each_entry(cn, &cfg->string_list, list) { 137688af8bbeSSebastian Andrzej Siewior cfg->gstrings[i] = &cn->stringtab_dev; 137788af8bbeSSebastian Andrzej Siewior cn->stringtab_dev.strings = &cn->strings; 137888af8bbeSSebastian Andrzej Siewior cn->strings.s = cn->configuration; 137988af8bbeSSebastian Andrzej Siewior i++; 138088af8bbeSSebastian Andrzej Siewior } 138188af8bbeSSebastian Andrzej Siewior cfg->gstrings[i] = NULL; 138288af8bbeSSebastian Andrzej Siewior s = usb_gstrings_attach(&gi->cdev, cfg->gstrings, 1); 1383fea77077SWei Yongjun if (IS_ERR(s)) { 1384fea77077SWei Yongjun ret = PTR_ERR(s); 138588af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 1386fea77077SWei Yongjun } 138788af8bbeSSebastian Andrzej Siewior c->iConfiguration = s[0].id; 138888af8bbeSSebastian Andrzej Siewior } 138988af8bbeSSebastian Andrzej Siewior 139088af8bbeSSebastian Andrzej Siewior list_for_each_entry_safe(f, tmp, &cfg->func_list, list) { 139188af8bbeSSebastian Andrzej Siewior list_del(&f->list); 139288af8bbeSSebastian Andrzej Siewior ret = usb_add_function(c, f); 13935a68e9b5SAndrzej Pietrasiewicz if (ret) { 13945a68e9b5SAndrzej Pietrasiewicz list_add(&f->list, &cfg->func_list); 139588af8bbeSSebastian Andrzej Siewior goto err_purge_funcs; 139688af8bbeSSebastian Andrzej Siewior } 13975a68e9b5SAndrzej Pietrasiewicz } 13987adf9e3aSWesley Cheng ret = usb_gadget_check_config(cdev->gadget); 13997adf9e3aSWesley Cheng if (ret) 14007adf9e3aSWesley Cheng goto err_purge_funcs; 14017adf9e3aSWesley Cheng 140288af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget); 140388af8bbeSSebastian Andrzej Siewior } 1404da424314SAndrzej Pietrasiewicz if (cdev->use_os_string) { 1405da424314SAndrzej Pietrasiewicz ret = composite_os_desc_req_prepare(cdev, gadget->ep0); 1406da424314SAndrzej Pietrasiewicz if (ret) 1407da424314SAndrzej Pietrasiewicz goto err_purge_funcs; 1408da424314SAndrzej Pietrasiewicz } 1409da424314SAndrzej Pietrasiewicz 141088af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget); 141188af8bbeSSebastian Andrzej Siewior return 0; 141288af8bbeSSebastian Andrzej Siewior 141388af8bbeSSebastian Andrzej Siewior err_purge_funcs: 141488af8bbeSSebastian Andrzej Siewior purge_configs_funcs(gi); 141588af8bbeSSebastian Andrzej Siewior err_comp_cleanup: 141688af8bbeSSebastian Andrzej Siewior composite_dev_cleanup(cdev); 141788af8bbeSSebastian Andrzej Siewior return ret; 141888af8bbeSSebastian Andrzej Siewior } 141988af8bbeSSebastian Andrzej Siewior 142088af8bbeSSebastian Andrzej Siewior static void configfs_composite_unbind(struct usb_gadget *gadget) 142188af8bbeSSebastian Andrzej Siewior { 142288af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev; 142388af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 14241a1c851bSPeter Chen unsigned long flags; 142588af8bbeSSebastian Andrzej Siewior 142688af8bbeSSebastian Andrzej Siewior /* the gi->lock is hold by the caller */ 142788af8bbeSSebastian Andrzej Siewior 142888af8bbeSSebastian Andrzej Siewior cdev = get_gadget_data(gadget); 142988af8bbeSSebastian Andrzej Siewior gi = container_of(cdev, struct gadget_info, cdev); 14301a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 14311a1c851bSPeter Chen gi->unbind = 1; 14321a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 143388af8bbeSSebastian Andrzej Siewior 143441ce84c8SLi Jun kfree(otg_desc[0]); 143541ce84c8SLi Jun otg_desc[0] = NULL; 143688af8bbeSSebastian Andrzej Siewior purge_configs_funcs(gi); 143788af8bbeSSebastian Andrzej Siewior composite_dev_cleanup(cdev); 143888af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget); 14391a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 144088af8bbeSSebastian Andrzej Siewior cdev->gadget = NULL; 144188af8bbeSSebastian Andrzej Siewior set_gadget_data(gadget, NULL); 14421a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 14431a1c851bSPeter Chen } 14441a1c851bSPeter Chen 14451a1c851bSPeter Chen static int configfs_composite_setup(struct usb_gadget *gadget, 14461a1c851bSPeter Chen const struct usb_ctrlrequest *ctrl) 14471a1c851bSPeter Chen { 14481a1c851bSPeter Chen struct usb_composite_dev *cdev; 14491a1c851bSPeter Chen struct gadget_info *gi; 14501a1c851bSPeter Chen unsigned long flags; 14511a1c851bSPeter Chen int ret; 14521a1c851bSPeter Chen 14531a1c851bSPeter Chen cdev = get_gadget_data(gadget); 14541a1c851bSPeter Chen if (!cdev) 14551a1c851bSPeter Chen return 0; 14561a1c851bSPeter Chen 14571a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev); 14581a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 14591a1c851bSPeter Chen cdev = get_gadget_data(gadget); 14601a1c851bSPeter Chen if (!cdev || gi->unbind) { 14611a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 14621a1c851bSPeter Chen return 0; 14631a1c851bSPeter Chen } 14641a1c851bSPeter Chen 14651a1c851bSPeter Chen ret = composite_setup(gadget, ctrl); 14661a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 14671a1c851bSPeter Chen return ret; 14681a1c851bSPeter Chen } 14691a1c851bSPeter Chen 14701a1c851bSPeter Chen static void configfs_composite_disconnect(struct usb_gadget *gadget) 14711a1c851bSPeter Chen { 14721a1c851bSPeter Chen struct usb_composite_dev *cdev; 14731a1c851bSPeter Chen struct gadget_info *gi; 14741a1c851bSPeter Chen unsigned long flags; 14751a1c851bSPeter Chen 14761a1c851bSPeter Chen cdev = get_gadget_data(gadget); 14771a1c851bSPeter Chen if (!cdev) 14781a1c851bSPeter Chen return; 14791a1c851bSPeter Chen 14801a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev); 14811a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 14821a1c851bSPeter Chen cdev = get_gadget_data(gadget); 14831a1c851bSPeter Chen if (!cdev || gi->unbind) { 14841a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 14851a1c851bSPeter Chen return; 14861a1c851bSPeter Chen } 14871a1c851bSPeter Chen 14881a1c851bSPeter Chen composite_disconnect(gadget); 14891a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 14901a1c851bSPeter Chen } 14911a1c851bSPeter Chen 14924d7aae9fSWesley Cheng static void configfs_composite_reset(struct usb_gadget *gadget) 14934d7aae9fSWesley Cheng { 14944d7aae9fSWesley Cheng struct usb_composite_dev *cdev; 14954d7aae9fSWesley Cheng struct gadget_info *gi; 14964d7aae9fSWesley Cheng unsigned long flags; 14974d7aae9fSWesley Cheng 14984d7aae9fSWesley Cheng cdev = get_gadget_data(gadget); 14994d7aae9fSWesley Cheng if (!cdev) 15004d7aae9fSWesley Cheng return; 15014d7aae9fSWesley Cheng 15024d7aae9fSWesley Cheng gi = container_of(cdev, struct gadget_info, cdev); 15034d7aae9fSWesley Cheng spin_lock_irqsave(&gi->spinlock, flags); 15044d7aae9fSWesley Cheng cdev = get_gadget_data(gadget); 15054d7aae9fSWesley Cheng if (!cdev || gi->unbind) { 15064d7aae9fSWesley Cheng spin_unlock_irqrestore(&gi->spinlock, flags); 15074d7aae9fSWesley Cheng return; 15084d7aae9fSWesley Cheng } 15094d7aae9fSWesley Cheng 15104d7aae9fSWesley Cheng composite_reset(gadget); 15114d7aae9fSWesley Cheng spin_unlock_irqrestore(&gi->spinlock, flags); 15124d7aae9fSWesley Cheng } 15134d7aae9fSWesley Cheng 15141a1c851bSPeter Chen static void configfs_composite_suspend(struct usb_gadget *gadget) 15151a1c851bSPeter Chen { 15161a1c851bSPeter Chen struct usb_composite_dev *cdev; 15171a1c851bSPeter Chen struct gadget_info *gi; 15181a1c851bSPeter Chen unsigned long flags; 15191a1c851bSPeter Chen 15201a1c851bSPeter Chen cdev = get_gadget_data(gadget); 15211a1c851bSPeter Chen if (!cdev) 15221a1c851bSPeter Chen return; 15231a1c851bSPeter Chen 15241a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev); 15251a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 15261a1c851bSPeter Chen cdev = get_gadget_data(gadget); 15271a1c851bSPeter Chen if (!cdev || gi->unbind) { 15281a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 15291a1c851bSPeter Chen return; 15301a1c851bSPeter Chen } 15311a1c851bSPeter Chen 15321a1c851bSPeter Chen composite_suspend(gadget); 15331a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 15341a1c851bSPeter Chen } 15351a1c851bSPeter Chen 15361a1c851bSPeter Chen static void configfs_composite_resume(struct usb_gadget *gadget) 15371a1c851bSPeter Chen { 15381a1c851bSPeter Chen struct usb_composite_dev *cdev; 15391a1c851bSPeter Chen struct gadget_info *gi; 15401a1c851bSPeter Chen unsigned long flags; 15411a1c851bSPeter Chen 15421a1c851bSPeter Chen cdev = get_gadget_data(gadget); 15431a1c851bSPeter Chen if (!cdev) 15441a1c851bSPeter Chen return; 15451a1c851bSPeter Chen 15461a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev); 15471a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 15481a1c851bSPeter Chen cdev = get_gadget_data(gadget); 15491a1c851bSPeter Chen if (!cdev || gi->unbind) { 15501a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 15511a1c851bSPeter Chen return; 15521a1c851bSPeter Chen } 15531a1c851bSPeter Chen 15541a1c851bSPeter Chen composite_resume(gadget); 15551a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 155688af8bbeSSebastian Andrzej Siewior } 155788af8bbeSSebastian Andrzej Siewior 155888af8bbeSSebastian Andrzej Siewior static const struct usb_gadget_driver configfs_driver_template = { 155988af8bbeSSebastian Andrzej Siewior .bind = configfs_composite_bind, 156088af8bbeSSebastian Andrzej Siewior .unbind = configfs_composite_unbind, 156188af8bbeSSebastian Andrzej Siewior 15621a1c851bSPeter Chen .setup = configfs_composite_setup, 15634d7aae9fSWesley Cheng .reset = configfs_composite_reset, 15641a1c851bSPeter Chen .disconnect = configfs_composite_disconnect, 156588af8bbeSSebastian Andrzej Siewior 15661a1c851bSPeter Chen .suspend = configfs_composite_suspend, 15671a1c851bSPeter Chen .resume = configfs_composite_resume, 15683a571870SAndrzej Pietrasiewicz 1569e2459108Staehyun.cho .max_speed = USB_SPEED_SUPER_PLUS, 157088af8bbeSSebastian Andrzej Siewior .driver = { 157188af8bbeSSebastian Andrzej Siewior .owner = THIS_MODULE, 157288af8bbeSSebastian Andrzej Siewior .name = "configfs-gadget", 157388af8bbeSSebastian Andrzej Siewior }, 1574f1bddbb3SKrzysztof Opasiak .match_existing_only = 1, 157588af8bbeSSebastian Andrzej Siewior }; 157688af8bbeSSebastian Andrzej Siewior 157788af8bbeSSebastian Andrzej Siewior static struct config_group *gadgets_make( 157888af8bbeSSebastian Andrzej Siewior struct config_group *group, 157988af8bbeSSebastian Andrzej Siewior const char *name) 158088af8bbeSSebastian Andrzej Siewior { 158188af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 158288af8bbeSSebastian Andrzej Siewior 158388af8bbeSSebastian Andrzej Siewior gi = kzalloc(sizeof(*gi), GFP_KERNEL); 158488af8bbeSSebastian Andrzej Siewior if (!gi) 158588af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM); 158688af8bbeSSebastian Andrzej Siewior 15871ae1602dSChristoph Hellwig config_group_init_type_name(&gi->group, name, &gadget_root_type); 158888af8bbeSSebastian Andrzej Siewior 158988af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->functions_group, "functions", 159088af8bbeSSebastian Andrzej Siewior &functions_type); 15911ae1602dSChristoph Hellwig configfs_add_default_group(&gi->functions_group, &gi->group); 15921ae1602dSChristoph Hellwig 159388af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->configs_group, "configs", 159488af8bbeSSebastian Andrzej Siewior &config_desc_type); 15951ae1602dSChristoph Hellwig configfs_add_default_group(&gi->configs_group, &gi->group); 15961ae1602dSChristoph Hellwig 159788af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->strings_group, "strings", 159888af8bbeSSebastian Andrzej Siewior &gadget_strings_strings_type); 15991ae1602dSChristoph Hellwig configfs_add_default_group(&gi->strings_group, &gi->group); 16001ae1602dSChristoph Hellwig 160187213d38SAndrzej Pietrasiewicz config_group_init_type_name(&gi->os_desc_group, "os_desc", 160287213d38SAndrzej Pietrasiewicz &os_desc_type); 16031ae1602dSChristoph Hellwig configfs_add_default_group(&gi->os_desc_group, &gi->group); 160488af8bbeSSebastian Andrzej Siewior 160588af8bbeSSebastian Andrzej Siewior gi->composite.bind = configfs_do_nothing; 160688af8bbeSSebastian Andrzej Siewior gi->composite.unbind = configfs_do_nothing; 160788af8bbeSSebastian Andrzej Siewior gi->composite.suspend = NULL; 160888af8bbeSSebastian Andrzej Siewior gi->composite.resume = NULL; 1609e2459108Staehyun.cho gi->composite.max_speed = USB_SPEED_SUPER_PLUS; 161088af8bbeSSebastian Andrzej Siewior 1611093edc2bSWei Yongjun spin_lock_init(&gi->spinlock); 161288af8bbeSSebastian Andrzej Siewior mutex_init(&gi->lock); 161388af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&gi->string_list); 161488af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&gi->available_func); 161588af8bbeSSebastian Andrzej Siewior 161688af8bbeSSebastian Andrzej Siewior composite_init_dev(&gi->cdev); 161788af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bLength = USB_DT_DEVICE_SIZE; 161888af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bDescriptorType = USB_DT_DEVICE; 161988af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bcdDevice = cpu_to_le16(get_default_bcdDevice()); 162088af8bbeSSebastian Andrzej Siewior 162188af8bbeSSebastian Andrzej Siewior gi->composite.gadget_driver = configfs_driver_template; 162288af8bbeSSebastian Andrzej Siewior 162388af8bbeSSebastian Andrzej Siewior gi->composite.gadget_driver.function = kstrdup(name, GFP_KERNEL); 162488af8bbeSSebastian Andrzej Siewior gi->composite.name = gi->composite.gadget_driver.function; 162588af8bbeSSebastian Andrzej Siewior 162688af8bbeSSebastian Andrzej Siewior if (!gi->composite.gadget_driver.function) 162788af8bbeSSebastian Andrzej Siewior goto err; 162888af8bbeSSebastian Andrzej Siewior 162988af8bbeSSebastian Andrzej Siewior return &gi->group; 163088af8bbeSSebastian Andrzej Siewior err: 163188af8bbeSSebastian Andrzej Siewior kfree(gi); 163288af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM); 163388af8bbeSSebastian Andrzej Siewior } 163488af8bbeSSebastian Andrzej Siewior 163588af8bbeSSebastian Andrzej Siewior static void gadgets_drop(struct config_group *group, struct config_item *item) 163688af8bbeSSebastian Andrzej Siewior { 163788af8bbeSSebastian Andrzej Siewior config_item_put(item); 163888af8bbeSSebastian Andrzej Siewior } 163988af8bbeSSebastian Andrzej Siewior 164088af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations gadgets_ops = { 164188af8bbeSSebastian Andrzej Siewior .make_group = &gadgets_make, 164288af8bbeSSebastian Andrzej Siewior .drop_item = &gadgets_drop, 164388af8bbeSSebastian Andrzej Siewior }; 164488af8bbeSSebastian Andrzej Siewior 16454ad01412SBhumika Goyal static const struct config_item_type gadgets_type = { 164688af8bbeSSebastian Andrzej Siewior .ct_group_ops = &gadgets_ops, 164788af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 164888af8bbeSSebastian Andrzej Siewior }; 164988af8bbeSSebastian Andrzej Siewior 165088af8bbeSSebastian Andrzej Siewior static struct configfs_subsystem gadget_subsys = { 165188af8bbeSSebastian Andrzej Siewior .su_group = { 165288af8bbeSSebastian Andrzej Siewior .cg_item = { 165388af8bbeSSebastian Andrzej Siewior .ci_namebuf = "usb_gadget", 165488af8bbeSSebastian Andrzej Siewior .ci_type = &gadgets_type, 165588af8bbeSSebastian Andrzej Siewior }, 165688af8bbeSSebastian Andrzej Siewior }, 165788af8bbeSSebastian Andrzej Siewior .su_mutex = __MUTEX_INITIALIZER(gadget_subsys.su_mutex), 165888af8bbeSSebastian Andrzej Siewior }; 165988af8bbeSSebastian Andrzej Siewior 1660092a4bd0SAndrzej Pietrasiewicz void unregister_gadget_item(struct config_item *item) 1661092a4bd0SAndrzej Pietrasiewicz { 1662092a4bd0SAndrzej Pietrasiewicz struct gadget_info *gi = to_gadget_info(item); 1663092a4bd0SAndrzej Pietrasiewicz 1664cee51c33SWinter Wang mutex_lock(&gi->lock); 1665092a4bd0SAndrzej Pietrasiewicz unregister_gadget(gi); 1666cee51c33SWinter Wang mutex_unlock(&gi->lock); 1667092a4bd0SAndrzej Pietrasiewicz } 16680700faafSFelipe Balbi EXPORT_SYMBOL_GPL(unregister_gadget_item); 1669092a4bd0SAndrzej Pietrasiewicz 167088af8bbeSSebastian Andrzej Siewior static int __init gadget_cfs_init(void) 167188af8bbeSSebastian Andrzej Siewior { 167288af8bbeSSebastian Andrzej Siewior int ret; 167388af8bbeSSebastian Andrzej Siewior 167488af8bbeSSebastian Andrzej Siewior config_group_init(&gadget_subsys.su_group); 167588af8bbeSSebastian Andrzej Siewior 167688af8bbeSSebastian Andrzej Siewior ret = configfs_register_subsystem(&gadget_subsys); 167788af8bbeSSebastian Andrzej Siewior return ret; 167888af8bbeSSebastian Andrzej Siewior } 167988af8bbeSSebastian Andrzej Siewior module_init(gadget_cfs_init); 168088af8bbeSSebastian Andrzej Siewior 168188af8bbeSSebastian Andrzej Siewior static void __exit gadget_cfs_exit(void) 168288af8bbeSSebastian Andrzej Siewior { 168388af8bbeSSebastian Andrzej Siewior configfs_unregister_subsystem(&gadget_subsys); 168488af8bbeSSebastian Andrzej Siewior } 168588af8bbeSSebastian Andrzej Siewior module_exit(gadget_cfs_exit); 1686