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 unsigned primary_lang; 1788af8bbeSSebastian Andrzej Siewior unsigned sub_lang; 1888af8bbeSSebastian Andrzej Siewior u16 num; 1988af8bbeSSebastian Andrzej Siewior int ret; 2088af8bbeSSebastian Andrzej Siewior 2188af8bbeSSebastian Andrzej Siewior ret = kstrtou16(name, 0, &num); 2288af8bbeSSebastian Andrzej Siewior if (ret) 2388af8bbeSSebastian Andrzej Siewior return ret; 2488af8bbeSSebastian Andrzej Siewior 2588af8bbeSSebastian Andrzej Siewior primary_lang = num & 0x3ff; 2688af8bbeSSebastian Andrzej Siewior sub_lang = num >> 10; 2788af8bbeSSebastian Andrzej Siewior 2888af8bbeSSebastian Andrzej Siewior /* simple sanity check for valid langid */ 2988af8bbeSSebastian Andrzej Siewior switch (primary_lang) { 3088af8bbeSSebastian Andrzej Siewior case 0: 3188af8bbeSSebastian Andrzej Siewior case 0x62 ... 0xfe: 3288af8bbeSSebastian Andrzej Siewior case 0x100 ... 0x3ff: 3388af8bbeSSebastian Andrzej Siewior return -EINVAL; 3488af8bbeSSebastian Andrzej Siewior } 3588af8bbeSSebastian Andrzej Siewior if (!sub_lang) 3688af8bbeSSebastian Andrzej Siewior return -EINVAL; 3788af8bbeSSebastian Andrzej Siewior 3888af8bbeSSebastian Andrzej Siewior stringtab_dev->language = num; 3988af8bbeSSebastian Andrzej Siewior return 0; 4088af8bbeSSebastian Andrzej Siewior } 4188af8bbeSSebastian Andrzej Siewior 4288af8bbeSSebastian Andrzej Siewior #define MAX_NAME_LEN 40 4388af8bbeSSebastian Andrzej Siewior #define MAX_USB_STRING_LANGS 2 4488af8bbeSSebastian Andrzej Siewior 4541ce84c8SLi Jun static const struct usb_descriptor_header *otg_desc[2]; 4641ce84c8SLi Jun 4788af8bbeSSebastian Andrzej Siewior struct gadget_info { 4888af8bbeSSebastian Andrzej Siewior struct config_group group; 4988af8bbeSSebastian Andrzej Siewior struct config_group functions_group; 5088af8bbeSSebastian Andrzej Siewior struct config_group configs_group; 5188af8bbeSSebastian Andrzej Siewior struct config_group strings_group; 5287213d38SAndrzej Pietrasiewicz struct config_group os_desc_group; 5388af8bbeSSebastian Andrzej Siewior 5488af8bbeSSebastian Andrzej Siewior struct mutex lock; 5588af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *gstrings[MAX_USB_STRING_LANGS + 1]; 5688af8bbeSSebastian Andrzej Siewior struct list_head string_list; 5788af8bbeSSebastian Andrzej Siewior struct list_head available_func; 5888af8bbeSSebastian Andrzej Siewior 5988af8bbeSSebastian Andrzej Siewior struct usb_composite_driver composite; 6088af8bbeSSebastian Andrzej Siewior struct usb_composite_dev cdev; 6187213d38SAndrzej Pietrasiewicz bool use_os_desc; 6287213d38SAndrzej Pietrasiewicz char b_vendor_code; 6387213d38SAndrzej Pietrasiewicz char qw_sign[OS_STRING_QW_SIGN_LEN]; 64*1a1c851bSPeter Chen spinlock_t spinlock; 65*1a1c851bSPeter Chen bool unbind; 6688af8bbeSSebastian Andrzej Siewior }; 6788af8bbeSSebastian Andrzej Siewior 6845b6a73fSChristoph Hellwig static inline struct gadget_info *to_gadget_info(struct config_item *item) 6945b6a73fSChristoph Hellwig { 7045b6a73fSChristoph Hellwig return container_of(to_config_group(item), struct gadget_info, group); 7145b6a73fSChristoph Hellwig } 7245b6a73fSChristoph Hellwig 7388af8bbeSSebastian Andrzej Siewior struct config_usb_cfg { 7488af8bbeSSebastian Andrzej Siewior struct config_group group; 7588af8bbeSSebastian Andrzej Siewior struct config_group strings_group; 7688af8bbeSSebastian Andrzej Siewior struct list_head string_list; 7788af8bbeSSebastian Andrzej Siewior struct usb_configuration c; 7888af8bbeSSebastian Andrzej Siewior struct list_head func_list; 7988af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *gstrings[MAX_USB_STRING_LANGS + 1]; 8088af8bbeSSebastian Andrzej Siewior }; 8188af8bbeSSebastian Andrzej Siewior 8245b6a73fSChristoph Hellwig static inline struct config_usb_cfg *to_config_usb_cfg(struct config_item *item) 8345b6a73fSChristoph Hellwig { 8445b6a73fSChristoph Hellwig return container_of(to_config_group(item), struct config_usb_cfg, 8545b6a73fSChristoph Hellwig group); 8645b6a73fSChristoph Hellwig } 8745b6a73fSChristoph Hellwig 8888af8bbeSSebastian Andrzej Siewior struct gadget_strings { 8988af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings stringtab_dev; 9088af8bbeSSebastian Andrzej Siewior struct usb_string strings[USB_GADGET_FIRST_AVAIL_IDX]; 9188af8bbeSSebastian Andrzej Siewior char *manufacturer; 9288af8bbeSSebastian Andrzej Siewior char *product; 9388af8bbeSSebastian Andrzej Siewior char *serialnumber; 9488af8bbeSSebastian Andrzej Siewior 9588af8bbeSSebastian Andrzej Siewior struct config_group group; 9688af8bbeSSebastian Andrzej Siewior struct list_head list; 9788af8bbeSSebastian Andrzej Siewior }; 9888af8bbeSSebastian Andrzej Siewior 9987213d38SAndrzej Pietrasiewicz struct os_desc { 10087213d38SAndrzej Pietrasiewicz struct config_group group; 10187213d38SAndrzej Pietrasiewicz }; 10287213d38SAndrzej Pietrasiewicz 10388af8bbeSSebastian Andrzej Siewior struct gadget_config_name { 10488af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings stringtab_dev; 10588af8bbeSSebastian Andrzej Siewior struct usb_string strings; 10688af8bbeSSebastian Andrzej Siewior char *configuration; 10788af8bbeSSebastian Andrzej Siewior 10888af8bbeSSebastian Andrzej Siewior struct config_group group; 10988af8bbeSSebastian Andrzej Siewior struct list_head list; 11088af8bbeSSebastian Andrzej Siewior }; 11188af8bbeSSebastian Andrzej Siewior 11288af8bbeSSebastian Andrzej Siewior static int usb_string_copy(const char *s, char **s_copy) 11388af8bbeSSebastian Andrzej Siewior { 11488af8bbeSSebastian Andrzej Siewior int ret; 11588af8bbeSSebastian Andrzej Siewior char *str; 11688af8bbeSSebastian Andrzej Siewior char *copy = *s_copy; 11788af8bbeSSebastian Andrzej Siewior ret = strlen(s); 11888af8bbeSSebastian Andrzej Siewior if (ret > 126) 11988af8bbeSSebastian Andrzej Siewior return -EOVERFLOW; 12088af8bbeSSebastian Andrzej Siewior 12188af8bbeSSebastian Andrzej Siewior str = kstrdup(s, GFP_KERNEL); 12288af8bbeSSebastian Andrzej Siewior if (!str) 12388af8bbeSSebastian Andrzej Siewior return -ENOMEM; 12488af8bbeSSebastian Andrzej Siewior if (str[ret - 1] == '\n') 12588af8bbeSSebastian Andrzej Siewior str[ret - 1] = '\0'; 12688af8bbeSSebastian Andrzej Siewior kfree(copy); 12788af8bbeSSebastian Andrzej Siewior *s_copy = str; 12888af8bbeSSebastian Andrzej Siewior return 0; 12988af8bbeSSebastian Andrzej Siewior } 13088af8bbeSSebastian Andrzej Siewior 13188af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_R_u8(__name) \ 13245b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##__name##_show(struct config_item *item, \ 13388af8bbeSSebastian Andrzej Siewior char *page) \ 13488af8bbeSSebastian Andrzej Siewior { \ 13545b6a73fSChristoph Hellwig return sprintf(page, "0x%02x\n", \ 13645b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.__name); \ 13788af8bbeSSebastian Andrzej Siewior } 13888af8bbeSSebastian Andrzej Siewior 13988af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_R_u16(__name) \ 14045b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##__name##_show(struct config_item *item, \ 14188af8bbeSSebastian Andrzej Siewior char *page) \ 14288af8bbeSSebastian Andrzej Siewior { \ 14345b6a73fSChristoph Hellwig return sprintf(page, "0x%04x\n", \ 14445b6a73fSChristoph Hellwig le16_to_cpup(&to_gadget_info(item)->cdev.desc.__name)); \ 14588af8bbeSSebastian Andrzej Siewior } 14688af8bbeSSebastian Andrzej Siewior 14788af8bbeSSebastian Andrzej Siewior 14888af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_W_u8(_name) \ 14945b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##_name##_store(struct config_item *item, \ 15088af8bbeSSebastian Andrzej Siewior const char *page, size_t len) \ 15188af8bbeSSebastian Andrzej Siewior { \ 15288af8bbeSSebastian Andrzej Siewior u8 val; \ 15388af8bbeSSebastian Andrzej Siewior int ret; \ 15488af8bbeSSebastian Andrzej Siewior ret = kstrtou8(page, 0, &val); \ 15588af8bbeSSebastian Andrzej Siewior if (ret) \ 15688af8bbeSSebastian Andrzej Siewior return ret; \ 15745b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc._name = val; \ 15888af8bbeSSebastian Andrzej Siewior return len; \ 15988af8bbeSSebastian Andrzej Siewior } 16088af8bbeSSebastian Andrzej Siewior 16188af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_W_u16(_name) \ 16245b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##_name##_store(struct config_item *item, \ 16388af8bbeSSebastian Andrzej Siewior const char *page, size_t len) \ 16488af8bbeSSebastian Andrzej Siewior { \ 16588af8bbeSSebastian Andrzej Siewior u16 val; \ 16688af8bbeSSebastian Andrzej Siewior int ret; \ 16788af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &val); \ 16888af8bbeSSebastian Andrzej Siewior if (ret) \ 16988af8bbeSSebastian Andrzej Siewior return ret; \ 17045b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc._name = cpu_to_le16p(&val); \ 17188af8bbeSSebastian Andrzej Siewior return len; \ 17288af8bbeSSebastian Andrzej Siewior } 17388af8bbeSSebastian Andrzej Siewior 17488af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_RW(_name, _type) \ 17588af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_##_type(_name) \ 17688af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_W_##_type(_name) 17788af8bbeSSebastian Andrzej Siewior 17888af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_u16(bcdUSB); 17988af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceClass, u8); 18088af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceSubClass, u8); 18188af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceProtocol, u8); 18288af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bMaxPacketSize0, u8); 18388af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(idVendor, u16); 18488af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(idProduct, u16); 18588af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_u16(bcdDevice); 18688af8bbeSSebastian Andrzej Siewior 18788af8bbeSSebastian Andrzej Siewior static ssize_t is_valid_bcd(u16 bcd_val) 18888af8bbeSSebastian Andrzej Siewior { 18988af8bbeSSebastian Andrzej Siewior if ((bcd_val & 0xf) > 9) 19088af8bbeSSebastian Andrzej Siewior return -EINVAL; 19188af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 4) & 0xf) > 9) 19288af8bbeSSebastian Andrzej Siewior return -EINVAL; 19388af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 8) & 0xf) > 9) 19488af8bbeSSebastian Andrzej Siewior return -EINVAL; 19588af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 12) & 0xf) > 9) 19688af8bbeSSebastian Andrzej Siewior return -EINVAL; 19788af8bbeSSebastian Andrzej Siewior return 0; 19888af8bbeSSebastian Andrzej Siewior } 19988af8bbeSSebastian Andrzej Siewior 20045b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_bcdDevice_store(struct config_item *item, 20188af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 20288af8bbeSSebastian Andrzej Siewior { 20388af8bbeSSebastian Andrzej Siewior u16 bcdDevice; 20488af8bbeSSebastian Andrzej Siewior int ret; 20588af8bbeSSebastian Andrzej Siewior 20688af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &bcdDevice); 20788af8bbeSSebastian Andrzej Siewior if (ret) 20888af8bbeSSebastian Andrzej Siewior return ret; 20988af8bbeSSebastian Andrzej Siewior ret = is_valid_bcd(bcdDevice); 21088af8bbeSSebastian Andrzej Siewior if (ret) 21188af8bbeSSebastian Andrzej Siewior return ret; 21288af8bbeSSebastian Andrzej Siewior 21345b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.bcdDevice = cpu_to_le16(bcdDevice); 21488af8bbeSSebastian Andrzej Siewior return len; 21588af8bbeSSebastian Andrzej Siewior } 21688af8bbeSSebastian Andrzej Siewior 21745b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_bcdUSB_store(struct config_item *item, 21888af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 21988af8bbeSSebastian Andrzej Siewior { 22088af8bbeSSebastian Andrzej Siewior u16 bcdUSB; 22188af8bbeSSebastian Andrzej Siewior int ret; 22288af8bbeSSebastian Andrzej Siewior 22388af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &bcdUSB); 22488af8bbeSSebastian Andrzej Siewior if (ret) 22588af8bbeSSebastian Andrzej Siewior return ret; 22688af8bbeSSebastian Andrzej Siewior ret = is_valid_bcd(bcdUSB); 22788af8bbeSSebastian Andrzej Siewior if (ret) 22888af8bbeSSebastian Andrzej Siewior return ret; 22988af8bbeSSebastian Andrzej Siewior 23045b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.bcdUSB = cpu_to_le16(bcdUSB); 23188af8bbeSSebastian Andrzej Siewior return len; 23288af8bbeSSebastian Andrzej Siewior } 23388af8bbeSSebastian Andrzej Siewior 23445b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_UDC_show(struct config_item *item, char *page) 23588af8bbeSSebastian Andrzej Siewior { 236afdaadc3SRuslan Bilovol char *udc_name = to_gadget_info(item)->composite.gadget_driver.udc_name; 237afdaadc3SRuslan Bilovol 238afdaadc3SRuslan Bilovol return sprintf(page, "%s\n", udc_name ?: ""); 23988af8bbeSSebastian Andrzej Siewior } 24088af8bbeSSebastian Andrzej Siewior 24188af8bbeSSebastian Andrzej Siewior static int unregister_gadget(struct gadget_info *gi) 24288af8bbeSSebastian Andrzej Siewior { 24388af8bbeSSebastian Andrzej Siewior int ret; 24488af8bbeSSebastian Andrzej Siewior 245afdaadc3SRuslan Bilovol if (!gi->composite.gadget_driver.udc_name) 24688af8bbeSSebastian Andrzej Siewior return -ENODEV; 24788af8bbeSSebastian Andrzej Siewior 24888af8bbeSSebastian Andrzej Siewior ret = usb_gadget_unregister_driver(&gi->composite.gadget_driver); 24988af8bbeSSebastian Andrzej Siewior if (ret) 25088af8bbeSSebastian Andrzej Siewior return ret; 251afdaadc3SRuslan Bilovol kfree(gi->composite.gadget_driver.udc_name); 252afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = NULL; 25388af8bbeSSebastian Andrzej Siewior return 0; 25488af8bbeSSebastian Andrzej Siewior } 25588af8bbeSSebastian Andrzej Siewior 25645b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_UDC_store(struct config_item *item, 25788af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 25888af8bbeSSebastian Andrzej Siewior { 25945b6a73fSChristoph Hellwig struct gadget_info *gi = to_gadget_info(item); 26088af8bbeSSebastian Andrzej Siewior char *name; 26188af8bbeSSebastian Andrzej Siewior int ret; 26288af8bbeSSebastian Andrzej Siewior 26388af8bbeSSebastian Andrzej Siewior name = kstrdup(page, GFP_KERNEL); 26488af8bbeSSebastian Andrzej Siewior if (!name) 26588af8bbeSSebastian Andrzej Siewior return -ENOMEM; 26688af8bbeSSebastian Andrzej Siewior if (name[len - 1] == '\n') 26788af8bbeSSebastian Andrzej Siewior name[len - 1] = '\0'; 26888af8bbeSSebastian Andrzej Siewior 26988af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 27088af8bbeSSebastian Andrzej Siewior 27188af8bbeSSebastian Andrzej Siewior if (!strlen(name)) { 27288af8bbeSSebastian Andrzej Siewior ret = unregister_gadget(gi); 27388af8bbeSSebastian Andrzej Siewior if (ret) 27488af8bbeSSebastian Andrzej Siewior goto err; 27538355b2aSJohn Keeping kfree(name); 27688af8bbeSSebastian Andrzej Siewior } else { 277afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name) { 27888af8bbeSSebastian Andrzej Siewior ret = -EBUSY; 27988af8bbeSSebastian Andrzej Siewior goto err; 28088af8bbeSSebastian Andrzej Siewior } 281afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = name; 282afdaadc3SRuslan Bilovol ret = usb_gadget_probe_driver(&gi->composite.gadget_driver); 283afdaadc3SRuslan Bilovol if (ret) { 284afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = NULL; 28588af8bbeSSebastian Andrzej Siewior goto err; 286afdaadc3SRuslan Bilovol } 28788af8bbeSSebastian Andrzej Siewior } 28888af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 28988af8bbeSSebastian Andrzej Siewior return len; 29088af8bbeSSebastian Andrzej Siewior err: 29188af8bbeSSebastian Andrzej Siewior kfree(name); 29288af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 29388af8bbeSSebastian Andrzej Siewior return ret; 29488af8bbeSSebastian Andrzej Siewior } 29588af8bbeSSebastian Andrzej Siewior 29645b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceClass); 29745b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceSubClass); 29845b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceProtocol); 29945b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bMaxPacketSize0); 30045b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, idVendor); 30145b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, idProduct); 30245b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bcdDevice); 30345b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bcdUSB); 30445b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, UDC); 30588af8bbeSSebastian Andrzej Siewior 30688af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_root_attrs[] = { 30745b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceClass, 30845b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceSubClass, 30945b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceProtocol, 31045b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bMaxPacketSize0, 31145b6a73fSChristoph Hellwig &gadget_dev_desc_attr_idVendor, 31245b6a73fSChristoph Hellwig &gadget_dev_desc_attr_idProduct, 31345b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bcdDevice, 31445b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bcdUSB, 31545b6a73fSChristoph Hellwig &gadget_dev_desc_attr_UDC, 31688af8bbeSSebastian Andrzej Siewior NULL, 31788af8bbeSSebastian Andrzej Siewior }; 31888af8bbeSSebastian Andrzej Siewior 31988af8bbeSSebastian Andrzej Siewior static inline struct gadget_strings *to_gadget_strings(struct config_item *item) 32088af8bbeSSebastian Andrzej Siewior { 32188af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item), struct gadget_strings, 32288af8bbeSSebastian Andrzej Siewior group); 32388af8bbeSSebastian Andrzej Siewior } 32488af8bbeSSebastian Andrzej Siewior 32588af8bbeSSebastian Andrzej Siewior static inline struct gadget_config_name *to_gadget_config_name( 32688af8bbeSSebastian Andrzej Siewior struct config_item *item) 32788af8bbeSSebastian Andrzej Siewior { 32888af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item), struct gadget_config_name, 32988af8bbeSSebastian Andrzej Siewior group); 33088af8bbeSSebastian Andrzej Siewior } 33188af8bbeSSebastian Andrzej Siewior 33288af8bbeSSebastian Andrzej Siewior static inline struct usb_function_instance *to_usb_function_instance( 33388af8bbeSSebastian Andrzej Siewior struct config_item *item) 33488af8bbeSSebastian Andrzej Siewior { 33588af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item), 33688af8bbeSSebastian Andrzej Siewior struct usb_function_instance, group); 33788af8bbeSSebastian Andrzej Siewior } 33888af8bbeSSebastian Andrzej Siewior 33988af8bbeSSebastian Andrzej Siewior static void gadget_info_attr_release(struct config_item *item) 34088af8bbeSSebastian Andrzej Siewior { 34188af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = to_gadget_info(item); 34288af8bbeSSebastian Andrzej Siewior 34388af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->cdev.configs)); 34488af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->string_list)); 34588af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->available_func)); 34688af8bbeSSebastian Andrzej Siewior kfree(gi->composite.gadget_driver.function); 34788af8bbeSSebastian Andrzej Siewior kfree(gi); 34888af8bbeSSebastian Andrzej Siewior } 34988af8bbeSSebastian Andrzej Siewior 35088af8bbeSSebastian Andrzej Siewior static struct configfs_item_operations gadget_root_item_ops = { 35188af8bbeSSebastian Andrzej Siewior .release = gadget_info_attr_release, 35288af8bbeSSebastian Andrzej Siewior }; 35388af8bbeSSebastian Andrzej Siewior 35488af8bbeSSebastian Andrzej Siewior static void gadget_config_attr_release(struct config_item *item) 35588af8bbeSSebastian Andrzej Siewior { 35688af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(item); 35788af8bbeSSebastian Andrzej Siewior 35888af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&cfg->c.functions)); 35988af8bbeSSebastian Andrzej Siewior list_del(&cfg->c.list); 36088af8bbeSSebastian Andrzej Siewior kfree(cfg->c.label); 36188af8bbeSSebastian Andrzej Siewior kfree(cfg); 36288af8bbeSSebastian Andrzej Siewior } 36388af8bbeSSebastian Andrzej Siewior 36488af8bbeSSebastian Andrzej Siewior static int config_usb_cfg_link( 36588af8bbeSSebastian Andrzej Siewior struct config_item *usb_cfg_ci, 36688af8bbeSSebastian Andrzej Siewior struct config_item *usb_func_ci) 36788af8bbeSSebastian Andrzej Siewior { 36888af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(usb_cfg_ci); 36988af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev = cfg->c.cdev; 37088af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = container_of(cdev, struct gadget_info, cdev); 37188af8bbeSSebastian Andrzej Siewior 37288af8bbeSSebastian Andrzej Siewior struct config_group *group = to_config_group(usb_func_ci); 37388af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi = container_of(group, 37488af8bbeSSebastian Andrzej Siewior struct usb_function_instance, group); 37588af8bbeSSebastian Andrzej Siewior struct usb_function_instance *a_fi; 37688af8bbeSSebastian Andrzej Siewior struct usb_function *f; 37788af8bbeSSebastian Andrzej Siewior int ret; 37888af8bbeSSebastian Andrzej Siewior 37988af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 38088af8bbeSSebastian Andrzej Siewior /* 38188af8bbeSSebastian Andrzej Siewior * Make sure this function is from within our _this_ gadget and not 38288af8bbeSSebastian Andrzej Siewior * from another gadget or a random directory. 38388af8bbeSSebastian Andrzej Siewior * Also a function instance can only be linked once. 38488af8bbeSSebastian Andrzej Siewior */ 38588af8bbeSSebastian Andrzej Siewior list_for_each_entry(a_fi, &gi->available_func, cfs_list) { 38688af8bbeSSebastian Andrzej Siewior if (a_fi == fi) 38788af8bbeSSebastian Andrzej Siewior break; 38888af8bbeSSebastian Andrzej Siewior } 38988af8bbeSSebastian Andrzej Siewior if (a_fi != fi) { 39088af8bbeSSebastian Andrzej Siewior ret = -EINVAL; 39188af8bbeSSebastian Andrzej Siewior goto out; 39288af8bbeSSebastian Andrzej Siewior } 39388af8bbeSSebastian Andrzej Siewior 39488af8bbeSSebastian Andrzej Siewior list_for_each_entry(f, &cfg->func_list, list) { 39588af8bbeSSebastian Andrzej Siewior if (f->fi == fi) { 39688af8bbeSSebastian Andrzej Siewior ret = -EEXIST; 39788af8bbeSSebastian Andrzej Siewior goto out; 39888af8bbeSSebastian Andrzej Siewior } 39988af8bbeSSebastian Andrzej Siewior } 40088af8bbeSSebastian Andrzej Siewior 40188af8bbeSSebastian Andrzej Siewior f = usb_get_function(fi); 40288af8bbeSSebastian Andrzej Siewior if (IS_ERR(f)) { 40388af8bbeSSebastian Andrzej Siewior ret = PTR_ERR(f); 40488af8bbeSSebastian Andrzej Siewior goto out; 40588af8bbeSSebastian Andrzej Siewior } 40688af8bbeSSebastian Andrzej Siewior 40788af8bbeSSebastian Andrzej Siewior /* stash the function until we bind it to the gadget */ 40888af8bbeSSebastian Andrzej Siewior list_add_tail(&f->list, &cfg->func_list); 40988af8bbeSSebastian Andrzej Siewior ret = 0; 41088af8bbeSSebastian Andrzej Siewior out: 41188af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 41288af8bbeSSebastian Andrzej Siewior return ret; 41388af8bbeSSebastian Andrzej Siewior } 41488af8bbeSSebastian Andrzej Siewior 415e16769d4SAndrzej Pietrasiewicz static void config_usb_cfg_unlink( 41688af8bbeSSebastian Andrzej Siewior struct config_item *usb_cfg_ci, 41788af8bbeSSebastian Andrzej Siewior struct config_item *usb_func_ci) 41888af8bbeSSebastian Andrzej Siewior { 41988af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(usb_cfg_ci); 42088af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev = cfg->c.cdev; 42188af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = container_of(cdev, struct gadget_info, cdev); 42288af8bbeSSebastian Andrzej Siewior 42388af8bbeSSebastian Andrzej Siewior struct config_group *group = to_config_group(usb_func_ci); 42488af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi = container_of(group, 42588af8bbeSSebastian Andrzej Siewior struct usb_function_instance, group); 42688af8bbeSSebastian Andrzej Siewior struct usb_function *f; 42788af8bbeSSebastian Andrzej Siewior 42888af8bbeSSebastian Andrzej Siewior /* 42988af8bbeSSebastian Andrzej Siewior * ideally I would like to forbid to unlink functions while a gadget is 43088af8bbeSSebastian Andrzej Siewior * bound to an UDC. Since this isn't possible at the moment, we simply 43188af8bbeSSebastian Andrzej Siewior * force an unbind, the function is available here and then we can 43288af8bbeSSebastian Andrzej Siewior * remove the function. 43388af8bbeSSebastian Andrzej Siewior */ 43488af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 435afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name) 43688af8bbeSSebastian Andrzej Siewior unregister_gadget(gi); 437afdaadc3SRuslan Bilovol WARN_ON(gi->composite.gadget_driver.udc_name); 43888af8bbeSSebastian Andrzej Siewior 43988af8bbeSSebastian Andrzej Siewior list_for_each_entry(f, &cfg->func_list, list) { 44088af8bbeSSebastian Andrzej Siewior if (f->fi == fi) { 44188af8bbeSSebastian Andrzej Siewior list_del(&f->list); 44288af8bbeSSebastian Andrzej Siewior usb_put_function(f); 44388af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 444e16769d4SAndrzej Pietrasiewicz return; 44588af8bbeSSebastian Andrzej Siewior } 44688af8bbeSSebastian Andrzej Siewior } 44788af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 44875bfe23aSDavid Rientjes WARN(1, "Unable to locate function to unbind\n"); 44988af8bbeSSebastian Andrzej Siewior } 45088af8bbeSSebastian Andrzej Siewior 45188af8bbeSSebastian Andrzej Siewior static struct configfs_item_operations gadget_config_item_ops = { 45288af8bbeSSebastian Andrzej Siewior .release = gadget_config_attr_release, 45388af8bbeSSebastian Andrzej Siewior .allow_link = config_usb_cfg_link, 45488af8bbeSSebastian Andrzej Siewior .drop_link = config_usb_cfg_unlink, 45588af8bbeSSebastian Andrzej Siewior }; 45688af8bbeSSebastian Andrzej Siewior 45788af8bbeSSebastian Andrzej Siewior 45845b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_MaxPower_show(struct config_item *item, 45988af8bbeSSebastian Andrzej Siewior char *page) 46088af8bbeSSebastian Andrzej Siewior { 46145b6a73fSChristoph Hellwig return sprintf(page, "%u\n", to_config_usb_cfg(item)->c.MaxPower); 46288af8bbeSSebastian Andrzej Siewior } 46388af8bbeSSebastian Andrzej Siewior 46445b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_MaxPower_store(struct config_item *item, 46588af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 46688af8bbeSSebastian Andrzej Siewior { 46788af8bbeSSebastian Andrzej Siewior u16 val; 46888af8bbeSSebastian Andrzej Siewior int ret; 46988af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &val); 47088af8bbeSSebastian Andrzej Siewior if (ret) 47188af8bbeSSebastian Andrzej Siewior return ret; 47288af8bbeSSebastian Andrzej Siewior if (DIV_ROUND_UP(val, 8) > 0xff) 47388af8bbeSSebastian Andrzej Siewior return -ERANGE; 47445b6a73fSChristoph Hellwig to_config_usb_cfg(item)->c.MaxPower = val; 47588af8bbeSSebastian Andrzej Siewior return len; 47688af8bbeSSebastian Andrzej Siewior } 47788af8bbeSSebastian Andrzej Siewior 47845b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_bmAttributes_show(struct config_item *item, 47988af8bbeSSebastian Andrzej Siewior char *page) 48088af8bbeSSebastian Andrzej Siewior { 48145b6a73fSChristoph Hellwig return sprintf(page, "0x%02x\n", 48245b6a73fSChristoph Hellwig to_config_usb_cfg(item)->c.bmAttributes); 48388af8bbeSSebastian Andrzej Siewior } 48488af8bbeSSebastian Andrzej Siewior 48545b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_bmAttributes_store(struct config_item *item, 48688af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 48788af8bbeSSebastian Andrzej Siewior { 48888af8bbeSSebastian Andrzej Siewior u8 val; 48988af8bbeSSebastian Andrzej Siewior int ret; 49088af8bbeSSebastian Andrzej Siewior ret = kstrtou8(page, 0, &val); 49188af8bbeSSebastian Andrzej Siewior if (ret) 49288af8bbeSSebastian Andrzej Siewior return ret; 49388af8bbeSSebastian Andrzej Siewior if (!(val & USB_CONFIG_ATT_ONE)) 49488af8bbeSSebastian Andrzej Siewior return -EINVAL; 49588af8bbeSSebastian Andrzej Siewior if (val & ~(USB_CONFIG_ATT_ONE | USB_CONFIG_ATT_SELFPOWER | 49688af8bbeSSebastian Andrzej Siewior USB_CONFIG_ATT_WAKEUP)) 49788af8bbeSSebastian Andrzej Siewior return -EINVAL; 49845b6a73fSChristoph Hellwig to_config_usb_cfg(item)->c.bmAttributes = val; 49988af8bbeSSebastian Andrzej Siewior return len; 50088af8bbeSSebastian Andrzej Siewior } 50188af8bbeSSebastian Andrzej Siewior 50245b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_config_desc_, MaxPower); 50345b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_config_desc_, bmAttributes); 50488af8bbeSSebastian Andrzej Siewior 50588af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_config_attrs[] = { 50645b6a73fSChristoph Hellwig &gadget_config_desc_attr_MaxPower, 50745b6a73fSChristoph Hellwig &gadget_config_desc_attr_bmAttributes, 50888af8bbeSSebastian Andrzej Siewior NULL, 50988af8bbeSSebastian Andrzej Siewior }; 51088af8bbeSSebastian Andrzej Siewior 5114ad01412SBhumika Goyal static const struct config_item_type gadget_config_type = { 51288af8bbeSSebastian Andrzej Siewior .ct_item_ops = &gadget_config_item_ops, 51388af8bbeSSebastian Andrzej Siewior .ct_attrs = gadget_config_attrs, 51488af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 51588af8bbeSSebastian Andrzej Siewior }; 51688af8bbeSSebastian Andrzej Siewior 5174ad01412SBhumika Goyal static const struct config_item_type gadget_root_type = { 51888af8bbeSSebastian Andrzej Siewior .ct_item_ops = &gadget_root_item_ops, 51988af8bbeSSebastian Andrzej Siewior .ct_attrs = gadget_root_attrs, 52088af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 52188af8bbeSSebastian Andrzej Siewior }; 52288af8bbeSSebastian Andrzej Siewior 52388af8bbeSSebastian Andrzej Siewior static void composite_init_dev(struct usb_composite_dev *cdev) 52488af8bbeSSebastian Andrzej Siewior { 52588af8bbeSSebastian Andrzej Siewior spin_lock_init(&cdev->lock); 52688af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cdev->configs); 52788af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cdev->gstrings); 52888af8bbeSSebastian Andrzej Siewior } 52988af8bbeSSebastian Andrzej Siewior 53088af8bbeSSebastian Andrzej Siewior static struct config_group *function_make( 53188af8bbeSSebastian Andrzej Siewior struct config_group *group, 53288af8bbeSSebastian Andrzej Siewior const char *name) 53388af8bbeSSebastian Andrzej Siewior { 53488af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 53588af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi; 53688af8bbeSSebastian Andrzej Siewior char buf[MAX_NAME_LEN]; 53788af8bbeSSebastian Andrzej Siewior char *func_name; 53888af8bbeSSebastian Andrzej Siewior char *instance_name; 53988af8bbeSSebastian Andrzej Siewior int ret; 54088af8bbeSSebastian Andrzej Siewior 54188af8bbeSSebastian Andrzej Siewior ret = snprintf(buf, MAX_NAME_LEN, "%s", name); 54288af8bbeSSebastian Andrzej Siewior if (ret >= MAX_NAME_LEN) 54388af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENAMETOOLONG); 54488af8bbeSSebastian Andrzej Siewior 54588af8bbeSSebastian Andrzej Siewior func_name = buf; 54688af8bbeSSebastian Andrzej Siewior instance_name = strchr(func_name, '.'); 54788af8bbeSSebastian Andrzej Siewior if (!instance_name) { 54888af8bbeSSebastian Andrzej Siewior pr_err("Unable to locate . in FUNC.INSTANCE\n"); 54988af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL); 55088af8bbeSSebastian Andrzej Siewior } 55188af8bbeSSebastian Andrzej Siewior *instance_name = '\0'; 55288af8bbeSSebastian Andrzej Siewior instance_name++; 55388af8bbeSSebastian Andrzej Siewior 55488af8bbeSSebastian Andrzej Siewior fi = usb_get_function_instance(func_name); 55588af8bbeSSebastian Andrzej Siewior if (IS_ERR(fi)) 556a3469411SDuan Jiong return ERR_CAST(fi); 55788af8bbeSSebastian Andrzej Siewior 5583958b792SNicolas Iooss ret = config_item_set_name(&fi->group.cg_item, "%s", name); 55988af8bbeSSebastian Andrzej Siewior if (ret) { 56088af8bbeSSebastian Andrzej Siewior usb_put_function_instance(fi); 56188af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret); 56288af8bbeSSebastian Andrzej Siewior } 5631933861dSAndrzej Pietrasiewicz if (fi->set_inst_name) { 5641933861dSAndrzej Pietrasiewicz ret = fi->set_inst_name(fi, instance_name); 5651933861dSAndrzej Pietrasiewicz if (ret) { 5661933861dSAndrzej Pietrasiewicz usb_put_function_instance(fi); 5671933861dSAndrzej Pietrasiewicz return ERR_PTR(ret); 5681933861dSAndrzej Pietrasiewicz } 5691933861dSAndrzej Pietrasiewicz } 57088af8bbeSSebastian Andrzej Siewior 57188af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, functions_group); 57288af8bbeSSebastian Andrzej Siewior 57388af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 57488af8bbeSSebastian Andrzej Siewior list_add_tail(&fi->cfs_list, &gi->available_func); 57588af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 57688af8bbeSSebastian Andrzej Siewior return &fi->group; 57788af8bbeSSebastian Andrzej Siewior } 57888af8bbeSSebastian Andrzej Siewior 57988af8bbeSSebastian Andrzej Siewior static void function_drop( 58088af8bbeSSebastian Andrzej Siewior struct config_group *group, 58188af8bbeSSebastian Andrzej Siewior struct config_item *item) 58288af8bbeSSebastian Andrzej Siewior { 58388af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi = to_usb_function_instance(item); 58488af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 58588af8bbeSSebastian Andrzej Siewior 58688af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, functions_group); 58788af8bbeSSebastian Andrzej Siewior 58888af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 58988af8bbeSSebastian Andrzej Siewior list_del(&fi->cfs_list); 59088af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 59188af8bbeSSebastian Andrzej Siewior config_item_put(item); 59288af8bbeSSebastian Andrzej Siewior } 59388af8bbeSSebastian Andrzej Siewior 59488af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations functions_ops = { 59588af8bbeSSebastian Andrzej Siewior .make_group = &function_make, 59688af8bbeSSebastian Andrzej Siewior .drop_item = &function_drop, 59788af8bbeSSebastian Andrzej Siewior }; 59888af8bbeSSebastian Andrzej Siewior 5994ad01412SBhumika Goyal static const struct config_item_type functions_type = { 60088af8bbeSSebastian Andrzej Siewior .ct_group_ops = &functions_ops, 60188af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 60288af8bbeSSebastian Andrzej Siewior }; 60388af8bbeSSebastian Andrzej Siewior 60488af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_config_name, configuration); 60588af8bbeSSebastian Andrzej Siewior 60688af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_config_name_langid_attrs[] = { 60745b6a73fSChristoph Hellwig &gadget_config_name_attr_configuration, 60888af8bbeSSebastian Andrzej Siewior NULL, 60988af8bbeSSebastian Andrzej Siewior }; 61088af8bbeSSebastian Andrzej Siewior 61188af8bbeSSebastian Andrzej Siewior static void gadget_config_name_attr_release(struct config_item *item) 61288af8bbeSSebastian Andrzej Siewior { 61388af8bbeSSebastian Andrzej Siewior struct gadget_config_name *cn = to_gadget_config_name(item); 61488af8bbeSSebastian Andrzej Siewior 61588af8bbeSSebastian Andrzej Siewior kfree(cn->configuration); 61688af8bbeSSebastian Andrzej Siewior 61788af8bbeSSebastian Andrzej Siewior list_del(&cn->list); 61888af8bbeSSebastian Andrzej Siewior kfree(cn); 61988af8bbeSSebastian Andrzej Siewior } 62088af8bbeSSebastian Andrzej Siewior 62188af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRING_RW_OPS(gadget_config_name); 62288af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRINGS_LANG(gadget_config_name, config_usb_cfg); 62388af8bbeSSebastian Andrzej Siewior 62488af8bbeSSebastian Andrzej Siewior static struct config_group *config_desc_make( 62588af8bbeSSebastian Andrzej Siewior struct config_group *group, 62688af8bbeSSebastian Andrzej Siewior const char *name) 62788af8bbeSSebastian Andrzej Siewior { 62888af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 62988af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 63088af8bbeSSebastian Andrzej Siewior char buf[MAX_NAME_LEN]; 63188af8bbeSSebastian Andrzej Siewior char *num_str; 63288af8bbeSSebastian Andrzej Siewior u8 num; 63388af8bbeSSebastian Andrzej Siewior int ret; 63488af8bbeSSebastian Andrzej Siewior 63588af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, configs_group); 63688af8bbeSSebastian Andrzej Siewior ret = snprintf(buf, MAX_NAME_LEN, "%s", name); 63788af8bbeSSebastian Andrzej Siewior if (ret >= MAX_NAME_LEN) 63888af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENAMETOOLONG); 63988af8bbeSSebastian Andrzej Siewior 64088af8bbeSSebastian Andrzej Siewior num_str = strchr(buf, '.'); 64188af8bbeSSebastian Andrzej Siewior if (!num_str) { 64288af8bbeSSebastian Andrzej Siewior pr_err("Unable to locate . in name.bConfigurationValue\n"); 64388af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL); 64488af8bbeSSebastian Andrzej Siewior } 64588af8bbeSSebastian Andrzej Siewior 64688af8bbeSSebastian Andrzej Siewior *num_str = '\0'; 64788af8bbeSSebastian Andrzej Siewior num_str++; 64888af8bbeSSebastian Andrzej Siewior 64988af8bbeSSebastian Andrzej Siewior if (!strlen(buf)) 65088af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL); 65188af8bbeSSebastian Andrzej Siewior 65288af8bbeSSebastian Andrzej Siewior ret = kstrtou8(num_str, 0, &num); 65388af8bbeSSebastian Andrzej Siewior if (ret) 65488af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret); 65588af8bbeSSebastian Andrzej Siewior 65688af8bbeSSebastian Andrzej Siewior cfg = kzalloc(sizeof(*cfg), GFP_KERNEL); 65788af8bbeSSebastian Andrzej Siewior if (!cfg) 65888af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM); 65988af8bbeSSebastian Andrzej Siewior cfg->c.label = kstrdup(buf, GFP_KERNEL); 66088af8bbeSSebastian Andrzej Siewior if (!cfg->c.label) { 66188af8bbeSSebastian Andrzej Siewior ret = -ENOMEM; 66288af8bbeSSebastian Andrzej Siewior goto err; 66388af8bbeSSebastian Andrzej Siewior } 66488af8bbeSSebastian Andrzej Siewior cfg->c.bConfigurationValue = num; 66588af8bbeSSebastian Andrzej Siewior cfg->c.MaxPower = CONFIG_USB_GADGET_VBUS_DRAW; 66688af8bbeSSebastian Andrzej Siewior cfg->c.bmAttributes = USB_CONFIG_ATT_ONE; 66788af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cfg->string_list); 66888af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cfg->func_list); 66988af8bbeSSebastian Andrzej Siewior 67088af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&cfg->group, name, 67188af8bbeSSebastian Andrzej Siewior &gadget_config_type); 6721ae1602dSChristoph Hellwig 67388af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&cfg->strings_group, "strings", 67488af8bbeSSebastian Andrzej Siewior &gadget_config_name_strings_type); 6751ae1602dSChristoph Hellwig configfs_add_default_group(&cfg->strings_group, &cfg->group); 67688af8bbeSSebastian Andrzej Siewior 67788af8bbeSSebastian Andrzej Siewior ret = usb_add_config_only(&gi->cdev, &cfg->c); 67888af8bbeSSebastian Andrzej Siewior if (ret) 67988af8bbeSSebastian Andrzej Siewior goto err; 68088af8bbeSSebastian Andrzej Siewior 68188af8bbeSSebastian Andrzej Siewior return &cfg->group; 68288af8bbeSSebastian Andrzej Siewior err: 68388af8bbeSSebastian Andrzej Siewior kfree(cfg->c.label); 68488af8bbeSSebastian Andrzej Siewior kfree(cfg); 68588af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret); 68688af8bbeSSebastian Andrzej Siewior } 68788af8bbeSSebastian Andrzej Siewior 68888af8bbeSSebastian Andrzej Siewior static void config_desc_drop( 68988af8bbeSSebastian Andrzej Siewior struct config_group *group, 69088af8bbeSSebastian Andrzej Siewior struct config_item *item) 69188af8bbeSSebastian Andrzej Siewior { 69288af8bbeSSebastian Andrzej Siewior config_item_put(item); 69388af8bbeSSebastian Andrzej Siewior } 69488af8bbeSSebastian Andrzej Siewior 69588af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations config_desc_ops = { 69688af8bbeSSebastian Andrzej Siewior .make_group = &config_desc_make, 69788af8bbeSSebastian Andrzej Siewior .drop_item = &config_desc_drop, 69888af8bbeSSebastian Andrzej Siewior }; 69988af8bbeSSebastian Andrzej Siewior 7004ad01412SBhumika Goyal static const struct config_item_type config_desc_type = { 70188af8bbeSSebastian Andrzej Siewior .ct_group_ops = &config_desc_ops, 70288af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 70388af8bbeSSebastian Andrzej Siewior }; 70488af8bbeSSebastian Andrzej Siewior 70588af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_strings, manufacturer); 70688af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_strings, product); 70788af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_strings, serialnumber); 70888af8bbeSSebastian Andrzej Siewior 70988af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_strings_langid_attrs[] = { 71045b6a73fSChristoph Hellwig &gadget_strings_attr_manufacturer, 71145b6a73fSChristoph Hellwig &gadget_strings_attr_product, 71245b6a73fSChristoph Hellwig &gadget_strings_attr_serialnumber, 71388af8bbeSSebastian Andrzej Siewior NULL, 71488af8bbeSSebastian Andrzej Siewior }; 71588af8bbeSSebastian Andrzej Siewior 71688af8bbeSSebastian Andrzej Siewior static void gadget_strings_attr_release(struct config_item *item) 71788af8bbeSSebastian Andrzej Siewior { 71888af8bbeSSebastian Andrzej Siewior struct gadget_strings *gs = to_gadget_strings(item); 71988af8bbeSSebastian Andrzej Siewior 72088af8bbeSSebastian Andrzej Siewior kfree(gs->manufacturer); 72188af8bbeSSebastian Andrzej Siewior kfree(gs->product); 72288af8bbeSSebastian Andrzej Siewior kfree(gs->serialnumber); 72388af8bbeSSebastian Andrzej Siewior 72488af8bbeSSebastian Andrzej Siewior list_del(&gs->list); 72588af8bbeSSebastian Andrzej Siewior kfree(gs); 72688af8bbeSSebastian Andrzej Siewior } 72788af8bbeSSebastian Andrzej Siewior 72888af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRING_RW_OPS(gadget_strings); 72988af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRINGS_LANG(gadget_strings, gadget_info); 73088af8bbeSSebastian Andrzej Siewior 73187213d38SAndrzej Pietrasiewicz static inline struct os_desc *to_os_desc(struct config_item *item) 73287213d38SAndrzej Pietrasiewicz { 73387213d38SAndrzej Pietrasiewicz return container_of(to_config_group(item), struct os_desc, group); 73487213d38SAndrzej Pietrasiewicz } 73587213d38SAndrzej Pietrasiewicz 73645b6a73fSChristoph Hellwig static inline struct gadget_info *os_desc_item_to_gadget_info( 73745b6a73fSChristoph Hellwig struct config_item *item) 73887213d38SAndrzej Pietrasiewicz { 73945b6a73fSChristoph Hellwig return to_gadget_info(to_os_desc(item)->group.cg_item.ci_parent); 74087213d38SAndrzej Pietrasiewicz } 74187213d38SAndrzej Pietrasiewicz 74245b6a73fSChristoph Hellwig static ssize_t os_desc_use_show(struct config_item *item, char *page) 74345b6a73fSChristoph Hellwig { 744e800e8cbSStefan Agner return sprintf(page, "%d\n", 74545b6a73fSChristoph Hellwig os_desc_item_to_gadget_info(item)->use_os_desc); 74645b6a73fSChristoph Hellwig } 74745b6a73fSChristoph Hellwig 74845b6a73fSChristoph Hellwig static ssize_t os_desc_use_store(struct config_item *item, const char *page, 74987213d38SAndrzej Pietrasiewicz size_t len) 75087213d38SAndrzej Pietrasiewicz { 75145b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 75287213d38SAndrzej Pietrasiewicz int ret; 75387213d38SAndrzej Pietrasiewicz bool use; 75487213d38SAndrzej Pietrasiewicz 75587213d38SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 75687213d38SAndrzej Pietrasiewicz ret = strtobool(page, &use); 75787213d38SAndrzej Pietrasiewicz if (!ret) { 75887213d38SAndrzej Pietrasiewicz gi->use_os_desc = use; 75987213d38SAndrzej Pietrasiewicz ret = len; 76087213d38SAndrzej Pietrasiewicz } 76187213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 76287213d38SAndrzej Pietrasiewicz 76387213d38SAndrzej Pietrasiewicz return ret; 76487213d38SAndrzej Pietrasiewicz } 76587213d38SAndrzej Pietrasiewicz 76645b6a73fSChristoph Hellwig static ssize_t os_desc_b_vendor_code_show(struct config_item *item, char *page) 76787213d38SAndrzej Pietrasiewicz { 768e800e8cbSStefan Agner return sprintf(page, "0x%02x\n", 76945b6a73fSChristoph Hellwig os_desc_item_to_gadget_info(item)->b_vendor_code); 77087213d38SAndrzej Pietrasiewicz } 77187213d38SAndrzej Pietrasiewicz 77245b6a73fSChristoph Hellwig static ssize_t os_desc_b_vendor_code_store(struct config_item *item, 77387213d38SAndrzej Pietrasiewicz const char *page, size_t len) 77487213d38SAndrzej Pietrasiewicz { 77545b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 77687213d38SAndrzej Pietrasiewicz int ret; 77787213d38SAndrzej Pietrasiewicz u8 b_vendor_code; 77887213d38SAndrzej Pietrasiewicz 77987213d38SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 78087213d38SAndrzej Pietrasiewicz ret = kstrtou8(page, 0, &b_vendor_code); 78187213d38SAndrzej Pietrasiewicz if (!ret) { 78287213d38SAndrzej Pietrasiewicz gi->b_vendor_code = b_vendor_code; 78387213d38SAndrzej Pietrasiewicz ret = len; 78487213d38SAndrzej Pietrasiewicz } 78587213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 78687213d38SAndrzej Pietrasiewicz 78787213d38SAndrzej Pietrasiewicz return ret; 78887213d38SAndrzej Pietrasiewicz } 78987213d38SAndrzej Pietrasiewicz 79045b6a73fSChristoph Hellwig static ssize_t os_desc_qw_sign_show(struct config_item *item, char *page) 79187213d38SAndrzej Pietrasiewicz { 79245b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 79376180d71SStefan Agner int res; 79487213d38SAndrzej Pietrasiewicz 79576180d71SStefan Agner res = utf16s_to_utf8s((wchar_t *) gi->qw_sign, OS_STRING_QW_SIGN_LEN, 79676180d71SStefan Agner UTF16_LITTLE_ENDIAN, page, PAGE_SIZE - 1); 79776180d71SStefan Agner page[res++] = '\n'; 79876180d71SStefan Agner 79976180d71SStefan Agner return res; 80087213d38SAndrzej Pietrasiewicz } 80187213d38SAndrzej Pietrasiewicz 80245b6a73fSChristoph Hellwig static ssize_t os_desc_qw_sign_store(struct config_item *item, const char *page, 80387213d38SAndrzej Pietrasiewicz size_t len) 80487213d38SAndrzej Pietrasiewicz { 80545b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 80687213d38SAndrzej Pietrasiewicz int res, l; 80787213d38SAndrzej Pietrasiewicz 80887213d38SAndrzej Pietrasiewicz l = min((int)len, OS_STRING_QW_SIGN_LEN >> 1); 80987213d38SAndrzej Pietrasiewicz if (page[l - 1] == '\n') 81087213d38SAndrzej Pietrasiewicz --l; 81187213d38SAndrzej Pietrasiewicz 81287213d38SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 81387213d38SAndrzej Pietrasiewicz res = utf8s_to_utf16s(page, l, 81487213d38SAndrzej Pietrasiewicz UTF16_LITTLE_ENDIAN, (wchar_t *) gi->qw_sign, 81587213d38SAndrzej Pietrasiewicz OS_STRING_QW_SIGN_LEN); 81687213d38SAndrzej Pietrasiewicz if (res > 0) 81787213d38SAndrzej Pietrasiewicz res = len; 81887213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 81987213d38SAndrzej Pietrasiewicz 82087213d38SAndrzej Pietrasiewicz return res; 82187213d38SAndrzej Pietrasiewicz } 82287213d38SAndrzej Pietrasiewicz 82345b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, use); 82445b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, b_vendor_code); 82545b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, qw_sign); 82687213d38SAndrzej Pietrasiewicz 82787213d38SAndrzej Pietrasiewicz static struct configfs_attribute *os_desc_attrs[] = { 82845b6a73fSChristoph Hellwig &os_desc_attr_use, 82945b6a73fSChristoph Hellwig &os_desc_attr_b_vendor_code, 83045b6a73fSChristoph Hellwig &os_desc_attr_qw_sign, 83187213d38SAndrzej Pietrasiewicz NULL, 83287213d38SAndrzej Pietrasiewicz }; 83387213d38SAndrzej Pietrasiewicz 83487213d38SAndrzej Pietrasiewicz static void os_desc_attr_release(struct config_item *item) 83587213d38SAndrzej Pietrasiewicz { 83687213d38SAndrzej Pietrasiewicz struct os_desc *os_desc = to_os_desc(item); 83787213d38SAndrzej Pietrasiewicz kfree(os_desc); 83887213d38SAndrzej Pietrasiewicz } 83987213d38SAndrzej Pietrasiewicz 840da424314SAndrzej Pietrasiewicz static int os_desc_link(struct config_item *os_desc_ci, 841da424314SAndrzej Pietrasiewicz struct config_item *usb_cfg_ci) 842da424314SAndrzej Pietrasiewicz { 843da424314SAndrzej Pietrasiewicz struct gadget_info *gi = container_of(to_config_group(os_desc_ci), 844da424314SAndrzej Pietrasiewicz struct gadget_info, os_desc_group); 845da424314SAndrzej Pietrasiewicz struct usb_composite_dev *cdev = &gi->cdev; 846da424314SAndrzej Pietrasiewicz struct config_usb_cfg *c_target = 847da424314SAndrzej Pietrasiewicz container_of(to_config_group(usb_cfg_ci), 848da424314SAndrzej Pietrasiewicz struct config_usb_cfg, group); 849da424314SAndrzej Pietrasiewicz struct usb_configuration *c; 850da424314SAndrzej Pietrasiewicz int ret; 851da424314SAndrzej Pietrasiewicz 852da424314SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 853da424314SAndrzej Pietrasiewicz list_for_each_entry(c, &cdev->configs, list) { 854da424314SAndrzej Pietrasiewicz if (c == &c_target->c) 855da424314SAndrzej Pietrasiewicz break; 856da424314SAndrzej Pietrasiewicz } 857da424314SAndrzej Pietrasiewicz if (c != &c_target->c) { 858da424314SAndrzej Pietrasiewicz ret = -EINVAL; 859da424314SAndrzej Pietrasiewicz goto out; 860da424314SAndrzej Pietrasiewicz } 861da424314SAndrzej Pietrasiewicz 862da424314SAndrzej Pietrasiewicz if (cdev->os_desc_config) { 863da424314SAndrzej Pietrasiewicz ret = -EBUSY; 864da424314SAndrzej Pietrasiewicz goto out; 865da424314SAndrzej Pietrasiewicz } 866da424314SAndrzej Pietrasiewicz 867da424314SAndrzej Pietrasiewicz cdev->os_desc_config = &c_target->c; 868da424314SAndrzej Pietrasiewicz ret = 0; 869da424314SAndrzej Pietrasiewicz 870da424314SAndrzej Pietrasiewicz out: 871da424314SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 872da424314SAndrzej Pietrasiewicz return ret; 873da424314SAndrzej Pietrasiewicz } 874da424314SAndrzej Pietrasiewicz 875e16769d4SAndrzej Pietrasiewicz static void os_desc_unlink(struct config_item *os_desc_ci, 876da424314SAndrzej Pietrasiewicz struct config_item *usb_cfg_ci) 877da424314SAndrzej Pietrasiewicz { 878da424314SAndrzej Pietrasiewicz struct gadget_info *gi = container_of(to_config_group(os_desc_ci), 879da424314SAndrzej Pietrasiewicz struct gadget_info, os_desc_group); 880da424314SAndrzej Pietrasiewicz struct usb_composite_dev *cdev = &gi->cdev; 881da424314SAndrzej Pietrasiewicz 882da424314SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 883afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name) 884da424314SAndrzej Pietrasiewicz unregister_gadget(gi); 885da424314SAndrzej Pietrasiewicz cdev->os_desc_config = NULL; 886afdaadc3SRuslan Bilovol WARN_ON(gi->composite.gadget_driver.udc_name); 887da424314SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 888da424314SAndrzej Pietrasiewicz } 889da424314SAndrzej Pietrasiewicz 89087213d38SAndrzej Pietrasiewicz static struct configfs_item_operations os_desc_ops = { 89187213d38SAndrzej Pietrasiewicz .release = os_desc_attr_release, 892da424314SAndrzej Pietrasiewicz .allow_link = os_desc_link, 893da424314SAndrzej Pietrasiewicz .drop_link = os_desc_unlink, 89487213d38SAndrzej Pietrasiewicz }; 89587213d38SAndrzej Pietrasiewicz 89687213d38SAndrzej Pietrasiewicz static struct config_item_type os_desc_type = { 89787213d38SAndrzej Pietrasiewicz .ct_item_ops = &os_desc_ops, 89887213d38SAndrzej Pietrasiewicz .ct_attrs = os_desc_attrs, 89987213d38SAndrzej Pietrasiewicz .ct_owner = THIS_MODULE, 90087213d38SAndrzej Pietrasiewicz }; 90187213d38SAndrzej Pietrasiewicz 9027419485fSAndrzej Pietrasiewicz static inline struct usb_os_desc_ext_prop 9037419485fSAndrzej Pietrasiewicz *to_usb_os_desc_ext_prop(struct config_item *item) 9047419485fSAndrzej Pietrasiewicz { 9057419485fSAndrzej Pietrasiewicz return container_of(item, struct usb_os_desc_ext_prop, item); 9067419485fSAndrzej Pietrasiewicz } 9077419485fSAndrzej Pietrasiewicz 90845b6a73fSChristoph Hellwig static ssize_t ext_prop_type_show(struct config_item *item, char *page) 9097419485fSAndrzej Pietrasiewicz { 910e800e8cbSStefan Agner return sprintf(page, "%d\n", to_usb_os_desc_ext_prop(item)->type); 9117419485fSAndrzej Pietrasiewicz } 9127419485fSAndrzej Pietrasiewicz 91345b6a73fSChristoph Hellwig static ssize_t ext_prop_type_store(struct config_item *item, 9147419485fSAndrzej Pietrasiewicz const char *page, size_t len) 9157419485fSAndrzej Pietrasiewicz { 91645b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 9177419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(ext_prop->item.ci_parent); 9187419485fSAndrzej Pietrasiewicz u8 type; 9197419485fSAndrzej Pietrasiewicz int ret; 9207419485fSAndrzej Pietrasiewicz 9217419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 9227419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 9237419485fSAndrzej Pietrasiewicz ret = kstrtou8(page, 0, &type); 9247419485fSAndrzej Pietrasiewicz if (ret) 9257419485fSAndrzej Pietrasiewicz goto end; 9267419485fSAndrzej Pietrasiewicz if (type < USB_EXT_PROP_UNICODE || type > USB_EXT_PROP_UNICODE_MULTI) { 9277419485fSAndrzej Pietrasiewicz ret = -EINVAL; 9287419485fSAndrzej Pietrasiewicz goto end; 9297419485fSAndrzej Pietrasiewicz } 9307419485fSAndrzej Pietrasiewicz 9317419485fSAndrzej Pietrasiewicz if ((ext_prop->type == USB_EXT_PROP_BINARY || 9327419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_LE32 || 9337419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_BE32) && 9347419485fSAndrzej Pietrasiewicz (type == USB_EXT_PROP_UNICODE || 9357419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_UNICODE_ENV || 9367419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_UNICODE_LINK)) 9377419485fSAndrzej Pietrasiewicz ext_prop->data_len <<= 1; 9387419485fSAndrzej Pietrasiewicz else if ((ext_prop->type == USB_EXT_PROP_UNICODE || 9397419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV || 9407419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) && 9417419485fSAndrzej Pietrasiewicz (type == USB_EXT_PROP_BINARY || 9427419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_LE32 || 9437419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_BE32)) 9447419485fSAndrzej Pietrasiewicz ext_prop->data_len >>= 1; 9457419485fSAndrzej Pietrasiewicz ext_prop->type = type; 9467419485fSAndrzej Pietrasiewicz ret = len; 9477419485fSAndrzej Pietrasiewicz 9487419485fSAndrzej Pietrasiewicz end: 9497419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 9507419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 9517419485fSAndrzej Pietrasiewicz return ret; 9527419485fSAndrzej Pietrasiewicz } 9537419485fSAndrzej Pietrasiewicz 95445b6a73fSChristoph Hellwig static ssize_t ext_prop_data_show(struct config_item *item, char *page) 9557419485fSAndrzej Pietrasiewicz { 95645b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 9577419485fSAndrzej Pietrasiewicz int len = ext_prop->data_len; 9587419485fSAndrzej Pietrasiewicz 9597419485fSAndrzej Pietrasiewicz if (ext_prop->type == USB_EXT_PROP_UNICODE || 9607419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV || 9617419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) 9627419485fSAndrzej Pietrasiewicz len >>= 1; 9637419485fSAndrzej Pietrasiewicz memcpy(page, ext_prop->data, len); 9647419485fSAndrzej Pietrasiewicz 9657419485fSAndrzej Pietrasiewicz return len; 9667419485fSAndrzej Pietrasiewicz } 9677419485fSAndrzej Pietrasiewicz 96845b6a73fSChristoph Hellwig static ssize_t ext_prop_data_store(struct config_item *item, 9697419485fSAndrzej Pietrasiewicz const char *page, size_t len) 9707419485fSAndrzej Pietrasiewicz { 97145b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 9727419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(ext_prop->item.ci_parent); 9737419485fSAndrzej Pietrasiewicz char *new_data; 9747419485fSAndrzej Pietrasiewicz size_t ret_len = len; 9757419485fSAndrzej Pietrasiewicz 9767419485fSAndrzej Pietrasiewicz if (page[len - 1] == '\n' || page[len - 1] == '\0') 9777419485fSAndrzej Pietrasiewicz --len; 97858b949e0SBenoit Taine new_data = kmemdup(page, len, GFP_KERNEL); 9797419485fSAndrzej Pietrasiewicz if (!new_data) 9807419485fSAndrzej Pietrasiewicz return -ENOMEM; 9817419485fSAndrzej Pietrasiewicz 9827419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 9837419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 9847419485fSAndrzej Pietrasiewicz kfree(ext_prop->data); 9857419485fSAndrzej Pietrasiewicz ext_prop->data = new_data; 9867419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= ext_prop->data_len; 9877419485fSAndrzej Pietrasiewicz ext_prop->data_len = len; 9887419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->data_len; 9897419485fSAndrzej Pietrasiewicz if (ext_prop->type == USB_EXT_PROP_UNICODE || 9907419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV || 9917419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) { 9927419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= ext_prop->data_len; 9937419485fSAndrzej Pietrasiewicz ext_prop->data_len <<= 1; 9947419485fSAndrzej Pietrasiewicz ext_prop->data_len += 2; 9957419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->data_len; 9967419485fSAndrzej Pietrasiewicz } 9977419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 9987419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 9997419485fSAndrzej Pietrasiewicz return ret_len; 10007419485fSAndrzej Pietrasiewicz } 10017419485fSAndrzej Pietrasiewicz 100245b6a73fSChristoph Hellwig CONFIGFS_ATTR(ext_prop_, type); 100345b6a73fSChristoph Hellwig CONFIGFS_ATTR(ext_prop_, data); 10047419485fSAndrzej Pietrasiewicz 10057419485fSAndrzej Pietrasiewicz static struct configfs_attribute *ext_prop_attrs[] = { 100645b6a73fSChristoph Hellwig &ext_prop_attr_type, 100745b6a73fSChristoph Hellwig &ext_prop_attr_data, 10087419485fSAndrzej Pietrasiewicz NULL, 10097419485fSAndrzej Pietrasiewicz }; 10107419485fSAndrzej Pietrasiewicz 10117419485fSAndrzej Pietrasiewicz static void usb_os_desc_ext_prop_release(struct config_item *item) 10127419485fSAndrzej Pietrasiewicz { 10137419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 10147419485fSAndrzej Pietrasiewicz 10157419485fSAndrzej Pietrasiewicz kfree(ext_prop); /* frees a whole chunk */ 10167419485fSAndrzej Pietrasiewicz } 10177419485fSAndrzej Pietrasiewicz 10187419485fSAndrzej Pietrasiewicz static struct configfs_item_operations ext_prop_ops = { 10197419485fSAndrzej Pietrasiewicz .release = usb_os_desc_ext_prop_release, 10207419485fSAndrzej Pietrasiewicz }; 10217419485fSAndrzej Pietrasiewicz 10227419485fSAndrzej Pietrasiewicz static struct config_item *ext_prop_make( 10237419485fSAndrzej Pietrasiewicz struct config_group *group, 10247419485fSAndrzej Pietrasiewicz const char *name) 10257419485fSAndrzej Pietrasiewicz { 10267419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop; 10277419485fSAndrzej Pietrasiewicz struct config_item_type *ext_prop_type; 10287419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc; 10297419485fSAndrzej Pietrasiewicz char *vlabuf; 10307419485fSAndrzej Pietrasiewicz 10317419485fSAndrzej Pietrasiewicz vla_group(data_chunk); 10327419485fSAndrzej Pietrasiewicz vla_item(data_chunk, struct usb_os_desc_ext_prop, ext_prop, 1); 10337419485fSAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, ext_prop_type, 1); 10347419485fSAndrzej Pietrasiewicz 10357419485fSAndrzej Pietrasiewicz vlabuf = kzalloc(vla_group_size(data_chunk), GFP_KERNEL); 10367419485fSAndrzej Pietrasiewicz if (!vlabuf) 10377419485fSAndrzej Pietrasiewicz return ERR_PTR(-ENOMEM); 10387419485fSAndrzej Pietrasiewicz 10397419485fSAndrzej Pietrasiewicz ext_prop = vla_ptr(vlabuf, data_chunk, ext_prop); 10407419485fSAndrzej Pietrasiewicz ext_prop_type = vla_ptr(vlabuf, data_chunk, ext_prop_type); 10417419485fSAndrzej Pietrasiewicz 10427419485fSAndrzej Pietrasiewicz desc = container_of(group, struct usb_os_desc, group); 10437419485fSAndrzej Pietrasiewicz ext_prop_type->ct_item_ops = &ext_prop_ops; 10447419485fSAndrzej Pietrasiewicz ext_prop_type->ct_attrs = ext_prop_attrs; 10457419485fSAndrzej Pietrasiewicz ext_prop_type->ct_owner = desc->owner; 10467419485fSAndrzej Pietrasiewicz 10477419485fSAndrzej Pietrasiewicz config_item_init_type_name(&ext_prop->item, name, ext_prop_type); 10487419485fSAndrzej Pietrasiewicz 10497419485fSAndrzej Pietrasiewicz ext_prop->name = kstrdup(name, GFP_KERNEL); 10507419485fSAndrzej Pietrasiewicz if (!ext_prop->name) { 10517419485fSAndrzej Pietrasiewicz kfree(vlabuf); 10527419485fSAndrzej Pietrasiewicz return ERR_PTR(-ENOMEM); 10537419485fSAndrzej Pietrasiewicz } 10547419485fSAndrzej Pietrasiewicz desc->ext_prop_len += 14; 10557419485fSAndrzej Pietrasiewicz ext_prop->name_len = 2 * strlen(ext_prop->name) + 2; 10567419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10577419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 10587419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->name_len; 10597419485fSAndrzej Pietrasiewicz list_add_tail(&ext_prop->entry, &desc->ext_prop); 10607419485fSAndrzej Pietrasiewicz ++desc->ext_prop_count; 10617419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10627419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 10637419485fSAndrzej Pietrasiewicz 10647419485fSAndrzej Pietrasiewicz return &ext_prop->item; 10657419485fSAndrzej Pietrasiewicz } 10667419485fSAndrzej Pietrasiewicz 10677419485fSAndrzej Pietrasiewicz static void ext_prop_drop(struct config_group *group, struct config_item *item) 10687419485fSAndrzej Pietrasiewicz { 10697419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 10707419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(&group->cg_item); 10717419485fSAndrzej Pietrasiewicz 10727419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10737419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 10747419485fSAndrzej Pietrasiewicz list_del(&ext_prop->entry); 10757419485fSAndrzej Pietrasiewicz --desc->ext_prop_count; 10767419485fSAndrzej Pietrasiewicz kfree(ext_prop->name); 10777419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= (ext_prop->name_len + ext_prop->data_len + 14); 10787419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10797419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 10807419485fSAndrzej Pietrasiewicz config_item_put(item); 10817419485fSAndrzej Pietrasiewicz } 10827419485fSAndrzej Pietrasiewicz 10837419485fSAndrzej Pietrasiewicz static struct configfs_group_operations interf_grp_ops = { 10847419485fSAndrzej Pietrasiewicz .make_item = &ext_prop_make, 10857419485fSAndrzej Pietrasiewicz .drop_item = &ext_prop_drop, 10867419485fSAndrzej Pietrasiewicz }; 10877419485fSAndrzej Pietrasiewicz 108845b6a73fSChristoph Hellwig static ssize_t interf_grp_compatible_id_show(struct config_item *item, 1089da424314SAndrzej Pietrasiewicz char *page) 1090da424314SAndrzej Pietrasiewicz { 109145b6a73fSChristoph Hellwig memcpy(page, to_usb_os_desc(item)->ext_compat_id, 8); 1092da424314SAndrzej Pietrasiewicz return 8; 1093da424314SAndrzej Pietrasiewicz } 1094da424314SAndrzej Pietrasiewicz 109545b6a73fSChristoph Hellwig static ssize_t interf_grp_compatible_id_store(struct config_item *item, 1096da424314SAndrzej Pietrasiewicz const char *page, size_t len) 1097da424314SAndrzej Pietrasiewicz { 109845b6a73fSChristoph Hellwig struct usb_os_desc *desc = to_usb_os_desc(item); 1099da424314SAndrzej Pietrasiewicz int l; 1100da424314SAndrzej Pietrasiewicz 1101da424314SAndrzej Pietrasiewicz l = min_t(int, 8, len); 1102da424314SAndrzej Pietrasiewicz if (page[l - 1] == '\n') 1103da424314SAndrzej Pietrasiewicz --l; 1104da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1105da424314SAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 1106da424314SAndrzej Pietrasiewicz memcpy(desc->ext_compat_id, page, l); 1107da424314SAndrzej Pietrasiewicz 1108da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1109da424314SAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 1110da424314SAndrzej Pietrasiewicz 1111da424314SAndrzej Pietrasiewicz return len; 1112da424314SAndrzej Pietrasiewicz } 1113da424314SAndrzej Pietrasiewicz 111445b6a73fSChristoph Hellwig static ssize_t interf_grp_sub_compatible_id_show(struct config_item *item, 1115da424314SAndrzej Pietrasiewicz char *page) 1116da424314SAndrzej Pietrasiewicz { 111745b6a73fSChristoph Hellwig memcpy(page, to_usb_os_desc(item)->ext_compat_id + 8, 8); 1118da424314SAndrzej Pietrasiewicz return 8; 1119da424314SAndrzej Pietrasiewicz } 1120da424314SAndrzej Pietrasiewicz 112145b6a73fSChristoph Hellwig static ssize_t interf_grp_sub_compatible_id_store(struct config_item *item, 1122da424314SAndrzej Pietrasiewicz const char *page, size_t len) 1123da424314SAndrzej Pietrasiewicz { 112445b6a73fSChristoph Hellwig struct usb_os_desc *desc = to_usb_os_desc(item); 1125da424314SAndrzej Pietrasiewicz int l; 1126da424314SAndrzej Pietrasiewicz 1127da424314SAndrzej Pietrasiewicz l = min_t(int, 8, len); 1128da424314SAndrzej Pietrasiewicz if (page[l - 1] == '\n') 1129da424314SAndrzej Pietrasiewicz --l; 1130da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1131da424314SAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 1132da424314SAndrzej Pietrasiewicz memcpy(desc->ext_compat_id + 8, page, l); 1133da424314SAndrzej Pietrasiewicz 1134da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1135da424314SAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 1136da424314SAndrzej Pietrasiewicz 1137da424314SAndrzej Pietrasiewicz return len; 1138da424314SAndrzej Pietrasiewicz } 1139da424314SAndrzej Pietrasiewicz 114045b6a73fSChristoph Hellwig CONFIGFS_ATTR(interf_grp_, compatible_id); 114145b6a73fSChristoph Hellwig CONFIGFS_ATTR(interf_grp_, sub_compatible_id); 1142da424314SAndrzej Pietrasiewicz 1143da424314SAndrzej Pietrasiewicz static struct configfs_attribute *interf_grp_attrs[] = { 114445b6a73fSChristoph Hellwig &interf_grp_attr_compatible_id, 114545b6a73fSChristoph Hellwig &interf_grp_attr_sub_compatible_id, 1146da424314SAndrzej Pietrasiewicz NULL 1147da424314SAndrzej Pietrasiewicz }; 1148da424314SAndrzej Pietrasiewicz 1149ff74745eSAndrew Gabbasov struct config_group *usb_os_desc_prepare_interf_dir( 1150ff74745eSAndrew Gabbasov struct config_group *parent, 1151da424314SAndrzej Pietrasiewicz int n_interf, 1152da424314SAndrzej Pietrasiewicz struct usb_os_desc **desc, 115314574b54SAndrzej Pietrasiewicz char **names, 1154da424314SAndrzej Pietrasiewicz struct module *owner) 1155da424314SAndrzej Pietrasiewicz { 11561ae1602dSChristoph Hellwig struct config_group *os_desc_group; 1157da424314SAndrzej Pietrasiewicz struct config_item_type *os_desc_type, *interface_type; 1158da424314SAndrzej Pietrasiewicz 1159da424314SAndrzej Pietrasiewicz vla_group(data_chunk); 1160da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_group, os_desc_group, 1); 1161da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, os_desc_type, 1); 1162da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, interface_type, 1); 1163da424314SAndrzej Pietrasiewicz 1164da424314SAndrzej Pietrasiewicz char *vlabuf = kzalloc(vla_group_size(data_chunk), GFP_KERNEL); 1165da424314SAndrzej Pietrasiewicz if (!vlabuf) 1166ff74745eSAndrew Gabbasov return ERR_PTR(-ENOMEM); 1167da424314SAndrzej Pietrasiewicz 1168da424314SAndrzej Pietrasiewicz os_desc_group = vla_ptr(vlabuf, data_chunk, os_desc_group); 1169da424314SAndrzej Pietrasiewicz os_desc_type = vla_ptr(vlabuf, data_chunk, os_desc_type); 1170da424314SAndrzej Pietrasiewicz interface_type = vla_ptr(vlabuf, data_chunk, interface_type); 1171da424314SAndrzej Pietrasiewicz 1172da424314SAndrzej Pietrasiewicz os_desc_type->ct_owner = owner; 1173da424314SAndrzej Pietrasiewicz config_group_init_type_name(os_desc_group, "os_desc", os_desc_type); 11741ae1602dSChristoph Hellwig configfs_add_default_group(os_desc_group, parent); 1175da424314SAndrzej Pietrasiewicz 11767419485fSAndrzej Pietrasiewicz interface_type->ct_group_ops = &interf_grp_ops; 1177da424314SAndrzej Pietrasiewicz interface_type->ct_attrs = interf_grp_attrs; 1178da424314SAndrzej Pietrasiewicz interface_type->ct_owner = owner; 1179da424314SAndrzej Pietrasiewicz 1180da424314SAndrzej Pietrasiewicz while (n_interf--) { 1181da424314SAndrzej Pietrasiewicz struct usb_os_desc *d; 1182da424314SAndrzej Pietrasiewicz 1183da424314SAndrzej Pietrasiewicz d = desc[n_interf]; 11847419485fSAndrzej Pietrasiewicz d->owner = owner; 1185da424314SAndrzej Pietrasiewicz config_group_init_type_name(&d->group, "", interface_type); 118614574b54SAndrzej Pietrasiewicz config_item_set_name(&d->group.cg_item, "interface.%s", 118714574b54SAndrzej Pietrasiewicz names[n_interf]); 11881ae1602dSChristoph Hellwig configfs_add_default_group(&d->group, os_desc_group); 1189da424314SAndrzej Pietrasiewicz } 1190da424314SAndrzej Pietrasiewicz 1191ff74745eSAndrew Gabbasov return os_desc_group; 1192da424314SAndrzej Pietrasiewicz } 1193da424314SAndrzej Pietrasiewicz EXPORT_SYMBOL(usb_os_desc_prepare_interf_dir); 1194da424314SAndrzej Pietrasiewicz 119588af8bbeSSebastian Andrzej Siewior static int configfs_do_nothing(struct usb_composite_dev *cdev) 119688af8bbeSSebastian Andrzej Siewior { 119775bfe23aSDavid Rientjes WARN_ON(1); 119888af8bbeSSebastian Andrzej Siewior return -EINVAL; 119988af8bbeSSebastian Andrzej Siewior } 120088af8bbeSSebastian Andrzej Siewior 120188af8bbeSSebastian Andrzej Siewior int composite_dev_prepare(struct usb_composite_driver *composite, 120288af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *dev); 120388af8bbeSSebastian Andrzej Siewior 1204da424314SAndrzej Pietrasiewicz int composite_os_desc_req_prepare(struct usb_composite_dev *cdev, 1205da424314SAndrzej Pietrasiewicz struct usb_ep *ep0); 1206da424314SAndrzej Pietrasiewicz 120788af8bbeSSebastian Andrzej Siewior static void purge_configs_funcs(struct gadget_info *gi) 120888af8bbeSSebastian Andrzej Siewior { 120988af8bbeSSebastian Andrzej Siewior struct usb_configuration *c; 121088af8bbeSSebastian Andrzej Siewior 121188af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) { 121288af8bbeSSebastian Andrzej Siewior struct usb_function *f, *tmp; 121388af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 121488af8bbeSSebastian Andrzej Siewior 121588af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c); 121688af8bbeSSebastian Andrzej Siewior 121788af8bbeSSebastian Andrzej Siewior list_for_each_entry_safe(f, tmp, &c->functions, list) { 121888af8bbeSSebastian Andrzej Siewior 121988af8bbeSSebastian Andrzej Siewior list_move_tail(&f->list, &cfg->func_list); 122088af8bbeSSebastian Andrzej Siewior if (f->unbind) { 1221da7b895dSRomain Izard dev_dbg(&gi->cdev.gadget->dev, 1222a08f5dbfSRomain Izard "unbind function '%s'/%p\n", 1223a08f5dbfSRomain Izard f->name, f); 122488af8bbeSSebastian Andrzej Siewior f->unbind(c, f); 122588af8bbeSSebastian Andrzej Siewior } 122688af8bbeSSebastian Andrzej Siewior } 122788af8bbeSSebastian Andrzej Siewior c->next_interface_id = 0; 1228903124feSKrzysztof Opasiak memset(c->interface, 0, sizeof(c->interface)); 1229554eead5SJohn Youn c->superspeed_plus = 0; 123088af8bbeSSebastian Andrzej Siewior c->superspeed = 0; 123188af8bbeSSebastian Andrzej Siewior c->highspeed = 0; 123288af8bbeSSebastian Andrzej Siewior c->fullspeed = 0; 123388af8bbeSSebastian Andrzej Siewior } 123488af8bbeSSebastian Andrzej Siewior } 123588af8bbeSSebastian Andrzej Siewior 123688af8bbeSSebastian Andrzej Siewior static int configfs_composite_bind(struct usb_gadget *gadget, 123788af8bbeSSebastian Andrzej Siewior struct usb_gadget_driver *gdriver) 123888af8bbeSSebastian Andrzej Siewior { 123988af8bbeSSebastian Andrzej Siewior struct usb_composite_driver *composite = to_cdriver(gdriver); 124088af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = container_of(composite, 124188af8bbeSSebastian Andrzej Siewior struct gadget_info, composite); 124288af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev = &gi->cdev; 124388af8bbeSSebastian Andrzej Siewior struct usb_configuration *c; 124488af8bbeSSebastian Andrzej Siewior struct usb_string *s; 124588af8bbeSSebastian Andrzej Siewior unsigned i; 124688af8bbeSSebastian Andrzej Siewior int ret; 124788af8bbeSSebastian Andrzej Siewior 124888af8bbeSSebastian Andrzej Siewior /* the gi->lock is hold by the caller */ 1249*1a1c851bSPeter Chen gi->unbind = 0; 125088af8bbeSSebastian Andrzej Siewior cdev->gadget = gadget; 125188af8bbeSSebastian Andrzej Siewior set_gadget_data(gadget, cdev); 125288af8bbeSSebastian Andrzej Siewior ret = composite_dev_prepare(composite, cdev); 125388af8bbeSSebastian Andrzej Siewior if (ret) 125488af8bbeSSebastian Andrzej Siewior return ret; 125588af8bbeSSebastian Andrzej Siewior /* and now the gadget bind */ 125688af8bbeSSebastian Andrzej Siewior ret = -EINVAL; 125788af8bbeSSebastian Andrzej Siewior 125888af8bbeSSebastian Andrzej Siewior if (list_empty(&gi->cdev.configs)) { 125988af8bbeSSebastian Andrzej Siewior pr_err("Need at least one configuration in %s.\n", 126088af8bbeSSebastian Andrzej Siewior gi->composite.name); 126188af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 126288af8bbeSSebastian Andrzej Siewior } 126388af8bbeSSebastian Andrzej Siewior 126488af8bbeSSebastian Andrzej Siewior 126588af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) { 126688af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 126788af8bbeSSebastian Andrzej Siewior 126888af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c); 126988af8bbeSSebastian Andrzej Siewior if (list_empty(&cfg->func_list)) { 127088af8bbeSSebastian Andrzej Siewior pr_err("Config %s/%d of %s needs at least one function.\n", 127188af8bbeSSebastian Andrzej Siewior c->label, c->bConfigurationValue, 127288af8bbeSSebastian Andrzej Siewior gi->composite.name); 127388af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 127488af8bbeSSebastian Andrzej Siewior } 127588af8bbeSSebastian Andrzej Siewior } 127688af8bbeSSebastian Andrzej Siewior 127788af8bbeSSebastian Andrzej Siewior /* init all strings */ 127888af8bbeSSebastian Andrzej Siewior if (!list_empty(&gi->string_list)) { 127988af8bbeSSebastian Andrzej Siewior struct gadget_strings *gs; 128088af8bbeSSebastian Andrzej Siewior 128188af8bbeSSebastian Andrzej Siewior i = 0; 128288af8bbeSSebastian Andrzej Siewior list_for_each_entry(gs, &gi->string_list, list) { 128388af8bbeSSebastian Andrzej Siewior 128488af8bbeSSebastian Andrzej Siewior gi->gstrings[i] = &gs->stringtab_dev; 128588af8bbeSSebastian Andrzej Siewior gs->stringtab_dev.strings = gs->strings; 128688af8bbeSSebastian Andrzej Siewior gs->strings[USB_GADGET_MANUFACTURER_IDX].s = 128788af8bbeSSebastian Andrzej Siewior gs->manufacturer; 128888af8bbeSSebastian Andrzej Siewior gs->strings[USB_GADGET_PRODUCT_IDX].s = gs->product; 128988af8bbeSSebastian Andrzej Siewior gs->strings[USB_GADGET_SERIAL_IDX].s = gs->serialnumber; 129088af8bbeSSebastian Andrzej Siewior i++; 129188af8bbeSSebastian Andrzej Siewior } 129288af8bbeSSebastian Andrzej Siewior gi->gstrings[i] = NULL; 129388af8bbeSSebastian Andrzej Siewior s = usb_gstrings_attach(&gi->cdev, gi->gstrings, 129488af8bbeSSebastian Andrzej Siewior USB_GADGET_FIRST_AVAIL_IDX); 1295fea77077SWei Yongjun if (IS_ERR(s)) { 1296fea77077SWei Yongjun ret = PTR_ERR(s); 129788af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 1298fea77077SWei Yongjun } 129988af8bbeSSebastian Andrzej Siewior 130088af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iManufacturer = s[USB_GADGET_MANUFACTURER_IDX].id; 130188af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iProduct = s[USB_GADGET_PRODUCT_IDX].id; 130288af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iSerialNumber = s[USB_GADGET_SERIAL_IDX].id; 130388af8bbeSSebastian Andrzej Siewior } 130488af8bbeSSebastian Andrzej Siewior 130587213d38SAndrzej Pietrasiewicz if (gi->use_os_desc) { 130687213d38SAndrzej Pietrasiewicz cdev->use_os_string = true; 130787213d38SAndrzej Pietrasiewicz cdev->b_vendor_code = gi->b_vendor_code; 130887213d38SAndrzej Pietrasiewicz memcpy(cdev->qw_sign, gi->qw_sign, OS_STRING_QW_SIGN_LEN); 130987213d38SAndrzej Pietrasiewicz } 131087213d38SAndrzej Pietrasiewicz 131141ce84c8SLi Jun if (gadget_is_otg(gadget) && !otg_desc[0]) { 131241ce84c8SLi Jun struct usb_descriptor_header *usb_desc; 131341ce84c8SLi Jun 131441ce84c8SLi Jun usb_desc = usb_otg_descriptor_alloc(gadget); 131541ce84c8SLi Jun if (!usb_desc) { 131641ce84c8SLi Jun ret = -ENOMEM; 131741ce84c8SLi Jun goto err_comp_cleanup; 131841ce84c8SLi Jun } 131941ce84c8SLi Jun usb_otg_descriptor_init(gadget, usb_desc); 132041ce84c8SLi Jun otg_desc[0] = usb_desc; 132141ce84c8SLi Jun otg_desc[1] = NULL; 132241ce84c8SLi Jun } 132341ce84c8SLi Jun 132488af8bbeSSebastian Andrzej Siewior /* Go through all configs, attach all functions */ 132588af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) { 132688af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 132788af8bbeSSebastian Andrzej Siewior struct usb_function *f; 132888af8bbeSSebastian Andrzej Siewior struct usb_function *tmp; 132988af8bbeSSebastian Andrzej Siewior struct gadget_config_name *cn; 133088af8bbeSSebastian Andrzej Siewior 133141ce84c8SLi Jun if (gadget_is_otg(gadget)) 133241ce84c8SLi Jun c->descriptors = otg_desc; 133341ce84c8SLi Jun 133488af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c); 133588af8bbeSSebastian Andrzej Siewior if (!list_empty(&cfg->string_list)) { 133688af8bbeSSebastian Andrzej Siewior i = 0; 133788af8bbeSSebastian Andrzej Siewior list_for_each_entry(cn, &cfg->string_list, list) { 133888af8bbeSSebastian Andrzej Siewior cfg->gstrings[i] = &cn->stringtab_dev; 133988af8bbeSSebastian Andrzej Siewior cn->stringtab_dev.strings = &cn->strings; 134088af8bbeSSebastian Andrzej Siewior cn->strings.s = cn->configuration; 134188af8bbeSSebastian Andrzej Siewior i++; 134288af8bbeSSebastian Andrzej Siewior } 134388af8bbeSSebastian Andrzej Siewior cfg->gstrings[i] = NULL; 134488af8bbeSSebastian Andrzej Siewior s = usb_gstrings_attach(&gi->cdev, cfg->gstrings, 1); 1345fea77077SWei Yongjun if (IS_ERR(s)) { 1346fea77077SWei Yongjun ret = PTR_ERR(s); 134788af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 1348fea77077SWei Yongjun } 134988af8bbeSSebastian Andrzej Siewior c->iConfiguration = s[0].id; 135088af8bbeSSebastian Andrzej Siewior } 135188af8bbeSSebastian Andrzej Siewior 135288af8bbeSSebastian Andrzej Siewior list_for_each_entry_safe(f, tmp, &cfg->func_list, list) { 135388af8bbeSSebastian Andrzej Siewior list_del(&f->list); 135488af8bbeSSebastian Andrzej Siewior ret = usb_add_function(c, f); 13555a68e9b5SAndrzej Pietrasiewicz if (ret) { 13565a68e9b5SAndrzej Pietrasiewicz list_add(&f->list, &cfg->func_list); 135788af8bbeSSebastian Andrzej Siewior goto err_purge_funcs; 135888af8bbeSSebastian Andrzej Siewior } 13595a68e9b5SAndrzej Pietrasiewicz } 136088af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget); 136188af8bbeSSebastian Andrzej Siewior } 1362da424314SAndrzej Pietrasiewicz if (cdev->use_os_string) { 1363da424314SAndrzej Pietrasiewicz ret = composite_os_desc_req_prepare(cdev, gadget->ep0); 1364da424314SAndrzej Pietrasiewicz if (ret) 1365da424314SAndrzej Pietrasiewicz goto err_purge_funcs; 1366da424314SAndrzej Pietrasiewicz } 1367da424314SAndrzej Pietrasiewicz 136888af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget); 136988af8bbeSSebastian Andrzej Siewior return 0; 137088af8bbeSSebastian Andrzej Siewior 137188af8bbeSSebastian Andrzej Siewior err_purge_funcs: 137288af8bbeSSebastian Andrzej Siewior purge_configs_funcs(gi); 137388af8bbeSSebastian Andrzej Siewior err_comp_cleanup: 137488af8bbeSSebastian Andrzej Siewior composite_dev_cleanup(cdev); 137588af8bbeSSebastian Andrzej Siewior return ret; 137688af8bbeSSebastian Andrzej Siewior } 137788af8bbeSSebastian Andrzej Siewior 137888af8bbeSSebastian Andrzej Siewior static void configfs_composite_unbind(struct usb_gadget *gadget) 137988af8bbeSSebastian Andrzej Siewior { 138088af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev; 138188af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 1382*1a1c851bSPeter Chen unsigned long flags; 138388af8bbeSSebastian Andrzej Siewior 138488af8bbeSSebastian Andrzej Siewior /* the gi->lock is hold by the caller */ 138588af8bbeSSebastian Andrzej Siewior 138688af8bbeSSebastian Andrzej Siewior cdev = get_gadget_data(gadget); 138788af8bbeSSebastian Andrzej Siewior gi = container_of(cdev, struct gadget_info, cdev); 1388*1a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 1389*1a1c851bSPeter Chen gi->unbind = 1; 1390*1a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 139188af8bbeSSebastian Andrzej Siewior 139241ce84c8SLi Jun kfree(otg_desc[0]); 139341ce84c8SLi Jun otg_desc[0] = NULL; 139488af8bbeSSebastian Andrzej Siewior purge_configs_funcs(gi); 139588af8bbeSSebastian Andrzej Siewior composite_dev_cleanup(cdev); 139688af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget); 1397*1a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 139888af8bbeSSebastian Andrzej Siewior cdev->gadget = NULL; 139988af8bbeSSebastian Andrzej Siewior set_gadget_data(gadget, NULL); 1400*1a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 1401*1a1c851bSPeter Chen } 1402*1a1c851bSPeter Chen 1403*1a1c851bSPeter Chen static int configfs_composite_setup(struct usb_gadget *gadget, 1404*1a1c851bSPeter Chen const struct usb_ctrlrequest *ctrl) 1405*1a1c851bSPeter Chen { 1406*1a1c851bSPeter Chen struct usb_composite_dev *cdev; 1407*1a1c851bSPeter Chen struct gadget_info *gi; 1408*1a1c851bSPeter Chen unsigned long flags; 1409*1a1c851bSPeter Chen int ret; 1410*1a1c851bSPeter Chen 1411*1a1c851bSPeter Chen cdev = get_gadget_data(gadget); 1412*1a1c851bSPeter Chen if (!cdev) 1413*1a1c851bSPeter Chen return 0; 1414*1a1c851bSPeter Chen 1415*1a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev); 1416*1a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 1417*1a1c851bSPeter Chen cdev = get_gadget_data(gadget); 1418*1a1c851bSPeter Chen if (!cdev || gi->unbind) { 1419*1a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 1420*1a1c851bSPeter Chen return 0; 1421*1a1c851bSPeter Chen } 1422*1a1c851bSPeter Chen 1423*1a1c851bSPeter Chen ret = composite_setup(gadget, ctrl); 1424*1a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 1425*1a1c851bSPeter Chen return ret; 1426*1a1c851bSPeter Chen } 1427*1a1c851bSPeter Chen 1428*1a1c851bSPeter Chen static void configfs_composite_disconnect(struct usb_gadget *gadget) 1429*1a1c851bSPeter Chen { 1430*1a1c851bSPeter Chen struct usb_composite_dev *cdev; 1431*1a1c851bSPeter Chen struct gadget_info *gi; 1432*1a1c851bSPeter Chen unsigned long flags; 1433*1a1c851bSPeter Chen 1434*1a1c851bSPeter Chen cdev = get_gadget_data(gadget); 1435*1a1c851bSPeter Chen if (!cdev) 1436*1a1c851bSPeter Chen return; 1437*1a1c851bSPeter Chen 1438*1a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev); 1439*1a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 1440*1a1c851bSPeter Chen cdev = get_gadget_data(gadget); 1441*1a1c851bSPeter Chen if (!cdev || gi->unbind) { 1442*1a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 1443*1a1c851bSPeter Chen return; 1444*1a1c851bSPeter Chen } 1445*1a1c851bSPeter Chen 1446*1a1c851bSPeter Chen composite_disconnect(gadget); 1447*1a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 1448*1a1c851bSPeter Chen } 1449*1a1c851bSPeter Chen 1450*1a1c851bSPeter Chen static void configfs_composite_suspend(struct usb_gadget *gadget) 1451*1a1c851bSPeter Chen { 1452*1a1c851bSPeter Chen struct usb_composite_dev *cdev; 1453*1a1c851bSPeter Chen struct gadget_info *gi; 1454*1a1c851bSPeter Chen unsigned long flags; 1455*1a1c851bSPeter Chen 1456*1a1c851bSPeter Chen cdev = get_gadget_data(gadget); 1457*1a1c851bSPeter Chen if (!cdev) 1458*1a1c851bSPeter Chen return; 1459*1a1c851bSPeter Chen 1460*1a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev); 1461*1a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 1462*1a1c851bSPeter Chen cdev = get_gadget_data(gadget); 1463*1a1c851bSPeter Chen if (!cdev || gi->unbind) { 1464*1a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 1465*1a1c851bSPeter Chen return; 1466*1a1c851bSPeter Chen } 1467*1a1c851bSPeter Chen 1468*1a1c851bSPeter Chen composite_suspend(gadget); 1469*1a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 1470*1a1c851bSPeter Chen } 1471*1a1c851bSPeter Chen 1472*1a1c851bSPeter Chen static void configfs_composite_resume(struct usb_gadget *gadget) 1473*1a1c851bSPeter Chen { 1474*1a1c851bSPeter Chen struct usb_composite_dev *cdev; 1475*1a1c851bSPeter Chen struct gadget_info *gi; 1476*1a1c851bSPeter Chen unsigned long flags; 1477*1a1c851bSPeter Chen 1478*1a1c851bSPeter Chen cdev = get_gadget_data(gadget); 1479*1a1c851bSPeter Chen if (!cdev) 1480*1a1c851bSPeter Chen return; 1481*1a1c851bSPeter Chen 1482*1a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev); 1483*1a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 1484*1a1c851bSPeter Chen cdev = get_gadget_data(gadget); 1485*1a1c851bSPeter Chen if (!cdev || gi->unbind) { 1486*1a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 1487*1a1c851bSPeter Chen return; 1488*1a1c851bSPeter Chen } 1489*1a1c851bSPeter Chen 1490*1a1c851bSPeter Chen composite_resume(gadget); 1491*1a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 149288af8bbeSSebastian Andrzej Siewior } 149388af8bbeSSebastian Andrzej Siewior 149488af8bbeSSebastian Andrzej Siewior static const struct usb_gadget_driver configfs_driver_template = { 149588af8bbeSSebastian Andrzej Siewior .bind = configfs_composite_bind, 149688af8bbeSSebastian Andrzej Siewior .unbind = configfs_composite_unbind, 149788af8bbeSSebastian Andrzej Siewior 1498*1a1c851bSPeter Chen .setup = configfs_composite_setup, 1499*1a1c851bSPeter Chen .reset = configfs_composite_disconnect, 1500*1a1c851bSPeter Chen .disconnect = configfs_composite_disconnect, 150188af8bbeSSebastian Andrzej Siewior 1502*1a1c851bSPeter Chen .suspend = configfs_composite_suspend, 1503*1a1c851bSPeter Chen .resume = configfs_composite_resume, 15043a571870SAndrzej Pietrasiewicz 150588af8bbeSSebastian Andrzej Siewior .max_speed = USB_SPEED_SUPER, 150688af8bbeSSebastian Andrzej Siewior .driver = { 150788af8bbeSSebastian Andrzej Siewior .owner = THIS_MODULE, 150888af8bbeSSebastian Andrzej Siewior .name = "configfs-gadget", 150988af8bbeSSebastian Andrzej Siewior }, 1510f1bddbb3SKrzysztof Opasiak .match_existing_only = 1, 151188af8bbeSSebastian Andrzej Siewior }; 151288af8bbeSSebastian Andrzej Siewior 151388af8bbeSSebastian Andrzej Siewior static struct config_group *gadgets_make( 151488af8bbeSSebastian Andrzej Siewior struct config_group *group, 151588af8bbeSSebastian Andrzej Siewior const char *name) 151688af8bbeSSebastian Andrzej Siewior { 151788af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 151888af8bbeSSebastian Andrzej Siewior 151988af8bbeSSebastian Andrzej Siewior gi = kzalloc(sizeof(*gi), GFP_KERNEL); 152088af8bbeSSebastian Andrzej Siewior if (!gi) 152188af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM); 152288af8bbeSSebastian Andrzej Siewior 15231ae1602dSChristoph Hellwig config_group_init_type_name(&gi->group, name, &gadget_root_type); 152488af8bbeSSebastian Andrzej Siewior 152588af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->functions_group, "functions", 152688af8bbeSSebastian Andrzej Siewior &functions_type); 15271ae1602dSChristoph Hellwig configfs_add_default_group(&gi->functions_group, &gi->group); 15281ae1602dSChristoph Hellwig 152988af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->configs_group, "configs", 153088af8bbeSSebastian Andrzej Siewior &config_desc_type); 15311ae1602dSChristoph Hellwig configfs_add_default_group(&gi->configs_group, &gi->group); 15321ae1602dSChristoph Hellwig 153388af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->strings_group, "strings", 153488af8bbeSSebastian Andrzej Siewior &gadget_strings_strings_type); 15351ae1602dSChristoph Hellwig configfs_add_default_group(&gi->strings_group, &gi->group); 15361ae1602dSChristoph Hellwig 153787213d38SAndrzej Pietrasiewicz config_group_init_type_name(&gi->os_desc_group, "os_desc", 153887213d38SAndrzej Pietrasiewicz &os_desc_type); 15391ae1602dSChristoph Hellwig configfs_add_default_group(&gi->os_desc_group, &gi->group); 154088af8bbeSSebastian Andrzej Siewior 154188af8bbeSSebastian Andrzej Siewior gi->composite.bind = configfs_do_nothing; 154288af8bbeSSebastian Andrzej Siewior gi->composite.unbind = configfs_do_nothing; 154388af8bbeSSebastian Andrzej Siewior gi->composite.suspend = NULL; 154488af8bbeSSebastian Andrzej Siewior gi->composite.resume = NULL; 154588af8bbeSSebastian Andrzej Siewior gi->composite.max_speed = USB_SPEED_SUPER; 154688af8bbeSSebastian Andrzej Siewior 154788af8bbeSSebastian Andrzej Siewior mutex_init(&gi->lock); 154888af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&gi->string_list); 154988af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&gi->available_func); 155088af8bbeSSebastian Andrzej Siewior 155188af8bbeSSebastian Andrzej Siewior composite_init_dev(&gi->cdev); 155288af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bLength = USB_DT_DEVICE_SIZE; 155388af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bDescriptorType = USB_DT_DEVICE; 155488af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bcdDevice = cpu_to_le16(get_default_bcdDevice()); 155588af8bbeSSebastian Andrzej Siewior 155688af8bbeSSebastian Andrzej Siewior gi->composite.gadget_driver = configfs_driver_template; 155788af8bbeSSebastian Andrzej Siewior 155888af8bbeSSebastian Andrzej Siewior gi->composite.gadget_driver.function = kstrdup(name, GFP_KERNEL); 155988af8bbeSSebastian Andrzej Siewior gi->composite.name = gi->composite.gadget_driver.function; 156088af8bbeSSebastian Andrzej Siewior 156188af8bbeSSebastian Andrzej Siewior if (!gi->composite.gadget_driver.function) 156288af8bbeSSebastian Andrzej Siewior goto err; 156388af8bbeSSebastian Andrzej Siewior 156488af8bbeSSebastian Andrzej Siewior return &gi->group; 156588af8bbeSSebastian Andrzej Siewior err: 156688af8bbeSSebastian Andrzej Siewior kfree(gi); 156788af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM); 156888af8bbeSSebastian Andrzej Siewior } 156988af8bbeSSebastian Andrzej Siewior 157088af8bbeSSebastian Andrzej Siewior static void gadgets_drop(struct config_group *group, struct config_item *item) 157188af8bbeSSebastian Andrzej Siewior { 157288af8bbeSSebastian Andrzej Siewior config_item_put(item); 157388af8bbeSSebastian Andrzej Siewior } 157488af8bbeSSebastian Andrzej Siewior 157588af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations gadgets_ops = { 157688af8bbeSSebastian Andrzej Siewior .make_group = &gadgets_make, 157788af8bbeSSebastian Andrzej Siewior .drop_item = &gadgets_drop, 157888af8bbeSSebastian Andrzej Siewior }; 157988af8bbeSSebastian Andrzej Siewior 15804ad01412SBhumika Goyal static const struct config_item_type gadgets_type = { 158188af8bbeSSebastian Andrzej Siewior .ct_group_ops = &gadgets_ops, 158288af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 158388af8bbeSSebastian Andrzej Siewior }; 158488af8bbeSSebastian Andrzej Siewior 158588af8bbeSSebastian Andrzej Siewior static struct configfs_subsystem gadget_subsys = { 158688af8bbeSSebastian Andrzej Siewior .su_group = { 158788af8bbeSSebastian Andrzej Siewior .cg_item = { 158888af8bbeSSebastian Andrzej Siewior .ci_namebuf = "usb_gadget", 158988af8bbeSSebastian Andrzej Siewior .ci_type = &gadgets_type, 159088af8bbeSSebastian Andrzej Siewior }, 159188af8bbeSSebastian Andrzej Siewior }, 159288af8bbeSSebastian Andrzej Siewior .su_mutex = __MUTEX_INITIALIZER(gadget_subsys.su_mutex), 159388af8bbeSSebastian Andrzej Siewior }; 159488af8bbeSSebastian Andrzej Siewior 1595092a4bd0SAndrzej Pietrasiewicz void unregister_gadget_item(struct config_item *item) 1596092a4bd0SAndrzej Pietrasiewicz { 1597092a4bd0SAndrzej Pietrasiewicz struct gadget_info *gi = to_gadget_info(item); 1598092a4bd0SAndrzej Pietrasiewicz 1599cee51c33SWinter Wang mutex_lock(&gi->lock); 1600092a4bd0SAndrzej Pietrasiewicz unregister_gadget(gi); 1601cee51c33SWinter Wang mutex_unlock(&gi->lock); 1602092a4bd0SAndrzej Pietrasiewicz } 16030700faafSFelipe Balbi EXPORT_SYMBOL_GPL(unregister_gadget_item); 1604092a4bd0SAndrzej Pietrasiewicz 160588af8bbeSSebastian Andrzej Siewior static int __init gadget_cfs_init(void) 160688af8bbeSSebastian Andrzej Siewior { 160788af8bbeSSebastian Andrzej Siewior int ret; 160888af8bbeSSebastian Andrzej Siewior 160988af8bbeSSebastian Andrzej Siewior config_group_init(&gadget_subsys.su_group); 161088af8bbeSSebastian Andrzej Siewior 161188af8bbeSSebastian Andrzej Siewior ret = configfs_register_subsystem(&gadget_subsys); 161288af8bbeSSebastian Andrzej Siewior return ret; 161388af8bbeSSebastian Andrzej Siewior } 161488af8bbeSSebastian Andrzej Siewior module_init(gadget_cfs_init); 161588af8bbeSSebastian Andrzej Siewior 161688af8bbeSSebastian Andrzej Siewior static void __exit gadget_cfs_exit(void) 161788af8bbeSSebastian Andrzej Siewior { 161888af8bbeSSebastian Andrzej Siewior configfs_unregister_subsystem(&gadget_subsys); 161988af8bbeSSebastian Andrzej Siewior } 162088af8bbeSSebastian Andrzej Siewior module_exit(gadget_cfs_exit); 1621