15fd54aceSGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0 288af8bbeSSebastian Andrzej Siewior #include <linux/configfs.h> 388af8bbeSSebastian Andrzej Siewior #include <linux/module.h> 488af8bbeSSebastian Andrzej Siewior #include <linux/slab.h> 588af8bbeSSebastian Andrzej Siewior #include <linux/device.h> 687213d38SAndrzej Pietrasiewicz #include <linux/nls.h> 788af8bbeSSebastian Andrzej Siewior #include <linux/usb/composite.h> 888af8bbeSSebastian Andrzej Siewior #include <linux/usb/gadget_configfs.h> 90009e99aSRashika Kheria #include "configfs.h" 10da424314SAndrzej Pietrasiewicz #include "u_f.h" 117419485fSAndrzej Pietrasiewicz #include "u_os_desc.h" 1288af8bbeSSebastian Andrzej Siewior 1388af8bbeSSebastian Andrzej Siewior int check_user_usb_string(const char *name, 1488af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *stringtab_dev) 1588af8bbeSSebastian Andrzej Siewior { 1688af8bbeSSebastian Andrzej Siewior u16 num; 1788af8bbeSSebastian Andrzej Siewior int ret; 1888af8bbeSSebastian Andrzej Siewior 1988af8bbeSSebastian Andrzej Siewior ret = kstrtou16(name, 0, &num); 2088af8bbeSSebastian Andrzej Siewior if (ret) 2188af8bbeSSebastian Andrzej Siewior return ret; 2288af8bbeSSebastian Andrzej Siewior 2317309a6aSTao Ren if (!usb_validate_langid(num)) 2488af8bbeSSebastian Andrzej Siewior return -EINVAL; 2588af8bbeSSebastian Andrzej Siewior 2688af8bbeSSebastian Andrzej Siewior stringtab_dev->language = num; 2788af8bbeSSebastian Andrzej Siewior return 0; 2888af8bbeSSebastian Andrzej Siewior } 2988af8bbeSSebastian Andrzej Siewior 3088af8bbeSSebastian Andrzej Siewior #define MAX_NAME_LEN 40 3188af8bbeSSebastian Andrzej Siewior #define MAX_USB_STRING_LANGS 2 3288af8bbeSSebastian Andrzej Siewior 3341ce84c8SLi Jun static const struct usb_descriptor_header *otg_desc[2]; 3441ce84c8SLi Jun 3588af8bbeSSebastian Andrzej Siewior struct gadget_info { 3688af8bbeSSebastian Andrzej Siewior struct config_group group; 3788af8bbeSSebastian Andrzej Siewior struct config_group functions_group; 3888af8bbeSSebastian Andrzej Siewior struct config_group configs_group; 3988af8bbeSSebastian Andrzej Siewior struct config_group strings_group; 4087213d38SAndrzej Pietrasiewicz struct config_group os_desc_group; 4188af8bbeSSebastian Andrzej Siewior 4288af8bbeSSebastian Andrzej Siewior struct mutex lock; 4388af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *gstrings[MAX_USB_STRING_LANGS + 1]; 4488af8bbeSSebastian Andrzej Siewior struct list_head string_list; 4588af8bbeSSebastian Andrzej Siewior struct list_head available_func; 4688af8bbeSSebastian Andrzej Siewior 4788af8bbeSSebastian Andrzej Siewior struct usb_composite_driver composite; 4888af8bbeSSebastian Andrzej Siewior struct usb_composite_dev cdev; 4987213d38SAndrzej Pietrasiewicz bool use_os_desc; 5087213d38SAndrzej Pietrasiewicz char b_vendor_code; 5187213d38SAndrzej Pietrasiewicz char qw_sign[OS_STRING_QW_SIGN_LEN]; 521a1c851bSPeter Chen spinlock_t spinlock; 531a1c851bSPeter Chen bool unbind; 5488af8bbeSSebastian Andrzej Siewior }; 5588af8bbeSSebastian Andrzej Siewior 5645b6a73fSChristoph Hellwig static inline struct gadget_info *to_gadget_info(struct config_item *item) 5745b6a73fSChristoph Hellwig { 5845b6a73fSChristoph Hellwig return container_of(to_config_group(item), struct gadget_info, group); 5945b6a73fSChristoph Hellwig } 6045b6a73fSChristoph Hellwig 6188af8bbeSSebastian Andrzej Siewior struct config_usb_cfg { 6288af8bbeSSebastian Andrzej Siewior struct config_group group; 6388af8bbeSSebastian Andrzej Siewior struct config_group strings_group; 6488af8bbeSSebastian Andrzej Siewior struct list_head string_list; 6588af8bbeSSebastian Andrzej Siewior struct usb_configuration c; 6688af8bbeSSebastian Andrzej Siewior struct list_head func_list; 6788af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *gstrings[MAX_USB_STRING_LANGS + 1]; 6888af8bbeSSebastian Andrzej Siewior }; 6988af8bbeSSebastian Andrzej Siewior 7045b6a73fSChristoph Hellwig static inline struct config_usb_cfg *to_config_usb_cfg(struct config_item *item) 7145b6a73fSChristoph Hellwig { 7245b6a73fSChristoph Hellwig return container_of(to_config_group(item), struct config_usb_cfg, 7345b6a73fSChristoph Hellwig group); 7445b6a73fSChristoph Hellwig } 7545b6a73fSChristoph Hellwig 7688af8bbeSSebastian Andrzej Siewior struct gadget_strings { 7788af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings stringtab_dev; 7888af8bbeSSebastian Andrzej Siewior struct usb_string strings[USB_GADGET_FIRST_AVAIL_IDX]; 7988af8bbeSSebastian Andrzej Siewior char *manufacturer; 8088af8bbeSSebastian Andrzej Siewior char *product; 8188af8bbeSSebastian Andrzej Siewior char *serialnumber; 8288af8bbeSSebastian Andrzej Siewior 8388af8bbeSSebastian Andrzej Siewior struct config_group group; 8488af8bbeSSebastian Andrzej Siewior struct list_head list; 8588af8bbeSSebastian Andrzej Siewior }; 8688af8bbeSSebastian Andrzej Siewior 8787213d38SAndrzej Pietrasiewicz struct os_desc { 8887213d38SAndrzej Pietrasiewicz struct config_group group; 8987213d38SAndrzej Pietrasiewicz }; 9087213d38SAndrzej Pietrasiewicz 9188af8bbeSSebastian Andrzej Siewior struct gadget_config_name { 9288af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings stringtab_dev; 9388af8bbeSSebastian Andrzej Siewior struct usb_string strings; 9488af8bbeSSebastian Andrzej Siewior char *configuration; 9588af8bbeSSebastian Andrzej Siewior 9688af8bbeSSebastian Andrzej Siewior struct config_group group; 9788af8bbeSSebastian Andrzej Siewior struct list_head list; 9888af8bbeSSebastian Andrzej Siewior }; 9988af8bbeSSebastian Andrzej Siewior 10088af8bbeSSebastian Andrzej Siewior static int usb_string_copy(const char *s, char **s_copy) 10188af8bbeSSebastian Andrzej Siewior { 10288af8bbeSSebastian Andrzej Siewior int ret; 10388af8bbeSSebastian Andrzej Siewior char *str; 10488af8bbeSSebastian Andrzej Siewior char *copy = *s_copy; 10588af8bbeSSebastian Andrzej Siewior ret = strlen(s); 10681c74628SMacpaul Lin if (ret > USB_MAX_STRING_LEN) 10788af8bbeSSebastian Andrzej Siewior return -EOVERFLOW; 10888af8bbeSSebastian Andrzej Siewior 10988af8bbeSSebastian Andrzej Siewior str = kstrdup(s, GFP_KERNEL); 11088af8bbeSSebastian Andrzej Siewior if (!str) 11188af8bbeSSebastian Andrzej Siewior return -ENOMEM; 11288af8bbeSSebastian Andrzej Siewior if (str[ret - 1] == '\n') 11388af8bbeSSebastian Andrzej Siewior str[ret - 1] = '\0'; 11488af8bbeSSebastian Andrzej Siewior kfree(copy); 11588af8bbeSSebastian Andrzej Siewior *s_copy = str; 11688af8bbeSSebastian Andrzej Siewior return 0; 11788af8bbeSSebastian Andrzej Siewior } 11888af8bbeSSebastian Andrzej Siewior 11988af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_R_u8(__name) \ 12045b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##__name##_show(struct config_item *item, \ 12188af8bbeSSebastian Andrzej Siewior char *page) \ 12288af8bbeSSebastian Andrzej Siewior { \ 12345b6a73fSChristoph Hellwig return sprintf(page, "0x%02x\n", \ 12445b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.__name); \ 12588af8bbeSSebastian Andrzej Siewior } 12688af8bbeSSebastian Andrzej Siewior 12788af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_R_u16(__name) \ 12845b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##__name##_show(struct config_item *item, \ 12988af8bbeSSebastian Andrzej Siewior char *page) \ 13088af8bbeSSebastian Andrzej Siewior { \ 13145b6a73fSChristoph Hellwig return sprintf(page, "0x%04x\n", \ 13245b6a73fSChristoph Hellwig le16_to_cpup(&to_gadget_info(item)->cdev.desc.__name)); \ 13388af8bbeSSebastian Andrzej Siewior } 13488af8bbeSSebastian Andrzej Siewior 13588af8bbeSSebastian Andrzej Siewior 13688af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_W_u8(_name) \ 13745b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##_name##_store(struct config_item *item, \ 13888af8bbeSSebastian Andrzej Siewior const char *page, size_t len) \ 13988af8bbeSSebastian Andrzej Siewior { \ 14088af8bbeSSebastian Andrzej Siewior u8 val; \ 14188af8bbeSSebastian Andrzej Siewior int ret; \ 14288af8bbeSSebastian Andrzej Siewior ret = kstrtou8(page, 0, &val); \ 14388af8bbeSSebastian Andrzej Siewior if (ret) \ 14488af8bbeSSebastian Andrzej Siewior return ret; \ 14545b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc._name = val; \ 14688af8bbeSSebastian Andrzej Siewior return len; \ 14788af8bbeSSebastian Andrzej Siewior } 14888af8bbeSSebastian Andrzej Siewior 14988af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_W_u16(_name) \ 15045b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##_name##_store(struct config_item *item, \ 15188af8bbeSSebastian Andrzej Siewior const char *page, size_t len) \ 15288af8bbeSSebastian Andrzej Siewior { \ 15388af8bbeSSebastian Andrzej Siewior u16 val; \ 15488af8bbeSSebastian Andrzej Siewior int ret; \ 15588af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &val); \ 15688af8bbeSSebastian Andrzej Siewior if (ret) \ 15788af8bbeSSebastian Andrzej Siewior return ret; \ 15845b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc._name = cpu_to_le16p(&val); \ 15988af8bbeSSebastian Andrzej Siewior return len; \ 16088af8bbeSSebastian Andrzej Siewior } 16188af8bbeSSebastian Andrzej Siewior 16288af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_RW(_name, _type) \ 16388af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_##_type(_name) \ 16488af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_W_##_type(_name) 16588af8bbeSSebastian Andrzej Siewior 16688af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_u16(bcdUSB); 16788af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceClass, u8); 16888af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceSubClass, u8); 16988af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceProtocol, u8); 17088af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bMaxPacketSize0, u8); 17188af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(idVendor, u16); 17288af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(idProduct, u16); 17388af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_u16(bcdDevice); 17488af8bbeSSebastian Andrzej Siewior 17588af8bbeSSebastian Andrzej Siewior static ssize_t is_valid_bcd(u16 bcd_val) 17688af8bbeSSebastian Andrzej Siewior { 17788af8bbeSSebastian Andrzej Siewior if ((bcd_val & 0xf) > 9) 17888af8bbeSSebastian Andrzej Siewior return -EINVAL; 17988af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 4) & 0xf) > 9) 18088af8bbeSSebastian Andrzej Siewior return -EINVAL; 18188af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 8) & 0xf) > 9) 18288af8bbeSSebastian Andrzej Siewior return -EINVAL; 18388af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 12) & 0xf) > 9) 18488af8bbeSSebastian Andrzej Siewior return -EINVAL; 18588af8bbeSSebastian Andrzej Siewior return 0; 18688af8bbeSSebastian Andrzej Siewior } 18788af8bbeSSebastian Andrzej Siewior 18845b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_bcdDevice_store(struct config_item *item, 18988af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 19088af8bbeSSebastian Andrzej Siewior { 19188af8bbeSSebastian Andrzej Siewior u16 bcdDevice; 19288af8bbeSSebastian Andrzej Siewior int ret; 19388af8bbeSSebastian Andrzej Siewior 19488af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &bcdDevice); 19588af8bbeSSebastian Andrzej Siewior if (ret) 19688af8bbeSSebastian Andrzej Siewior return ret; 19788af8bbeSSebastian Andrzej Siewior ret = is_valid_bcd(bcdDevice); 19888af8bbeSSebastian Andrzej Siewior if (ret) 19988af8bbeSSebastian Andrzej Siewior return ret; 20088af8bbeSSebastian Andrzej Siewior 20145b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.bcdDevice = cpu_to_le16(bcdDevice); 20288af8bbeSSebastian Andrzej Siewior return len; 20388af8bbeSSebastian Andrzej Siewior } 20488af8bbeSSebastian Andrzej Siewior 20545b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_bcdUSB_store(struct config_item *item, 20688af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 20788af8bbeSSebastian Andrzej Siewior { 20888af8bbeSSebastian Andrzej Siewior u16 bcdUSB; 20988af8bbeSSebastian Andrzej Siewior int ret; 21088af8bbeSSebastian Andrzej Siewior 21188af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &bcdUSB); 21288af8bbeSSebastian Andrzej Siewior if (ret) 21388af8bbeSSebastian Andrzej Siewior return ret; 21488af8bbeSSebastian Andrzej Siewior ret = is_valid_bcd(bcdUSB); 21588af8bbeSSebastian Andrzej Siewior if (ret) 21688af8bbeSSebastian Andrzej Siewior return ret; 21788af8bbeSSebastian Andrzej Siewior 21845b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.bcdUSB = cpu_to_le16(bcdUSB); 21988af8bbeSSebastian Andrzej Siewior return len; 22088af8bbeSSebastian Andrzej Siewior } 22188af8bbeSSebastian Andrzej Siewior 22245b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_UDC_show(struct config_item *item, char *page) 22388af8bbeSSebastian Andrzej Siewior { 224afdaadc3SRuslan Bilovol char *udc_name = to_gadget_info(item)->composite.gadget_driver.udc_name; 225afdaadc3SRuslan Bilovol 226afdaadc3SRuslan Bilovol return sprintf(page, "%s\n", udc_name ?: ""); 22788af8bbeSSebastian Andrzej Siewior } 22888af8bbeSSebastian Andrzej Siewior 22988af8bbeSSebastian Andrzej Siewior static int unregister_gadget(struct gadget_info *gi) 23088af8bbeSSebastian Andrzej Siewior { 23188af8bbeSSebastian Andrzej Siewior int ret; 23288af8bbeSSebastian Andrzej Siewior 233afdaadc3SRuslan Bilovol if (!gi->composite.gadget_driver.udc_name) 23488af8bbeSSebastian Andrzej Siewior return -ENODEV; 23588af8bbeSSebastian Andrzej Siewior 23688af8bbeSSebastian Andrzej Siewior ret = usb_gadget_unregister_driver(&gi->composite.gadget_driver); 23788af8bbeSSebastian Andrzej Siewior if (ret) 23888af8bbeSSebastian Andrzej Siewior return ret; 239afdaadc3SRuslan Bilovol kfree(gi->composite.gadget_driver.udc_name); 240afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = NULL; 24188af8bbeSSebastian Andrzej Siewior return 0; 24288af8bbeSSebastian Andrzej Siewior } 24388af8bbeSSebastian Andrzej Siewior 24445b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_UDC_store(struct config_item *item, 24588af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 24688af8bbeSSebastian Andrzej Siewior { 24745b6a73fSChristoph Hellwig struct gadget_info *gi = to_gadget_info(item); 24888af8bbeSSebastian Andrzej Siewior char *name; 24988af8bbeSSebastian Andrzej Siewior int ret; 25088af8bbeSSebastian Andrzej Siewior 25115753588SKyungtae Kim if (strlen(page) < len) 25215753588SKyungtae Kim return -EOVERFLOW; 25315753588SKyungtae Kim 25488af8bbeSSebastian Andrzej Siewior name = kstrdup(page, GFP_KERNEL); 25588af8bbeSSebastian Andrzej Siewior if (!name) 25688af8bbeSSebastian Andrzej Siewior return -ENOMEM; 25788af8bbeSSebastian Andrzej Siewior if (name[len - 1] == '\n') 25888af8bbeSSebastian Andrzej Siewior name[len - 1] = '\0'; 25988af8bbeSSebastian Andrzej Siewior 26088af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 26188af8bbeSSebastian Andrzej Siewior 26288af8bbeSSebastian Andrzej Siewior if (!strlen(name)) { 26388af8bbeSSebastian Andrzej Siewior ret = unregister_gadget(gi); 26488af8bbeSSebastian Andrzej Siewior if (ret) 26588af8bbeSSebastian Andrzej Siewior goto err; 26638355b2aSJohn Keeping kfree(name); 26788af8bbeSSebastian Andrzej Siewior } else { 268afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name) { 26988af8bbeSSebastian Andrzej Siewior ret = -EBUSY; 27088af8bbeSSebastian Andrzej Siewior goto err; 27188af8bbeSSebastian Andrzej Siewior } 272afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = name; 273afdaadc3SRuslan Bilovol ret = usb_gadget_probe_driver(&gi->composite.gadget_driver); 274afdaadc3SRuslan Bilovol if (ret) { 275afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = NULL; 27688af8bbeSSebastian Andrzej Siewior goto err; 277afdaadc3SRuslan Bilovol } 27888af8bbeSSebastian Andrzej Siewior } 27988af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 28088af8bbeSSebastian Andrzej Siewior return len; 28188af8bbeSSebastian Andrzej Siewior err: 28288af8bbeSSebastian Andrzej Siewior kfree(name); 28388af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 28488af8bbeSSebastian Andrzej Siewior return ret; 28588af8bbeSSebastian Andrzej Siewior } 28688af8bbeSSebastian Andrzej Siewior 287a0249703SThinh Nguyen static ssize_t gadget_dev_desc_max_speed_show(struct config_item *item, 288a0249703SThinh Nguyen char *page) 289a0249703SThinh Nguyen { 290a0249703SThinh Nguyen enum usb_device_speed speed = to_gadget_info(item)->composite.max_speed; 291a0249703SThinh Nguyen 292a0249703SThinh Nguyen return sprintf(page, "%s\n", usb_speed_string(speed)); 293a0249703SThinh Nguyen } 294a0249703SThinh Nguyen 295a0249703SThinh Nguyen static ssize_t gadget_dev_desc_max_speed_store(struct config_item *item, 296a0249703SThinh Nguyen const char *page, size_t len) 297a0249703SThinh Nguyen { 298a0249703SThinh Nguyen struct gadget_info *gi = to_gadget_info(item); 299a0249703SThinh Nguyen 300a0249703SThinh Nguyen mutex_lock(&gi->lock); 301a0249703SThinh Nguyen 302a0249703SThinh Nguyen /* Prevent changing of max_speed after the driver is binded */ 303a0249703SThinh Nguyen if (gi->composite.gadget_driver.udc_name) 304a0249703SThinh Nguyen goto err; 305a0249703SThinh Nguyen 306a0249703SThinh Nguyen if (strncmp(page, "super-speed-plus", 16) == 0) 307a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_SUPER_PLUS; 308a0249703SThinh Nguyen else if (strncmp(page, "super-speed", 11) == 0) 309a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_SUPER; 310a0249703SThinh Nguyen else if (strncmp(page, "high-speed", 10) == 0) 311a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_HIGH; 312a0249703SThinh Nguyen else if (strncmp(page, "full-speed", 10) == 0) 313a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_FULL; 314a0249703SThinh Nguyen else if (strncmp(page, "low-speed", 9) == 0) 315a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_LOW; 316a0249703SThinh Nguyen else 317a0249703SThinh Nguyen goto err; 318a0249703SThinh Nguyen 319a0249703SThinh Nguyen gi->composite.gadget_driver.max_speed = gi->composite.max_speed; 320a0249703SThinh Nguyen 321a0249703SThinh Nguyen mutex_unlock(&gi->lock); 322a0249703SThinh Nguyen return len; 323a0249703SThinh Nguyen err: 324a0249703SThinh Nguyen mutex_unlock(&gi->lock); 325a0249703SThinh Nguyen return -EINVAL; 326a0249703SThinh Nguyen } 327a0249703SThinh Nguyen 32845b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceClass); 32945b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceSubClass); 33045b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceProtocol); 33145b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bMaxPacketSize0); 33245b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, idVendor); 33345b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, idProduct); 33445b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bcdDevice); 33545b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bcdUSB); 33645b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, UDC); 337a0249703SThinh Nguyen CONFIGFS_ATTR(gadget_dev_desc_, max_speed); 33888af8bbeSSebastian Andrzej Siewior 33988af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_root_attrs[] = { 34045b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceClass, 34145b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceSubClass, 34245b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceProtocol, 34345b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bMaxPacketSize0, 34445b6a73fSChristoph Hellwig &gadget_dev_desc_attr_idVendor, 34545b6a73fSChristoph Hellwig &gadget_dev_desc_attr_idProduct, 34645b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bcdDevice, 34745b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bcdUSB, 34845b6a73fSChristoph Hellwig &gadget_dev_desc_attr_UDC, 349a0249703SThinh Nguyen &gadget_dev_desc_attr_max_speed, 35088af8bbeSSebastian Andrzej Siewior NULL, 35188af8bbeSSebastian Andrzej Siewior }; 35288af8bbeSSebastian Andrzej Siewior 35388af8bbeSSebastian Andrzej Siewior static inline struct gadget_strings *to_gadget_strings(struct config_item *item) 35488af8bbeSSebastian Andrzej Siewior { 35588af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item), struct gadget_strings, 35688af8bbeSSebastian Andrzej Siewior group); 35788af8bbeSSebastian Andrzej Siewior } 35888af8bbeSSebastian Andrzej Siewior 35988af8bbeSSebastian Andrzej Siewior static inline struct gadget_config_name *to_gadget_config_name( 36088af8bbeSSebastian Andrzej Siewior struct config_item *item) 36188af8bbeSSebastian Andrzej Siewior { 36288af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item), struct gadget_config_name, 36388af8bbeSSebastian Andrzej Siewior group); 36488af8bbeSSebastian Andrzej Siewior } 36588af8bbeSSebastian Andrzej Siewior 36688af8bbeSSebastian Andrzej Siewior static inline struct usb_function_instance *to_usb_function_instance( 36788af8bbeSSebastian Andrzej Siewior struct config_item *item) 36888af8bbeSSebastian Andrzej Siewior { 36988af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item), 37088af8bbeSSebastian Andrzej Siewior struct usb_function_instance, group); 37188af8bbeSSebastian Andrzej Siewior } 37288af8bbeSSebastian Andrzej Siewior 37388af8bbeSSebastian Andrzej Siewior static void gadget_info_attr_release(struct config_item *item) 37488af8bbeSSebastian Andrzej Siewior { 37588af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = to_gadget_info(item); 37688af8bbeSSebastian Andrzej Siewior 37788af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->cdev.configs)); 37888af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->string_list)); 37988af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->available_func)); 38088af8bbeSSebastian Andrzej Siewior kfree(gi->composite.gadget_driver.function); 38188af8bbeSSebastian Andrzej Siewior kfree(gi); 38288af8bbeSSebastian Andrzej Siewior } 38388af8bbeSSebastian Andrzej Siewior 38488af8bbeSSebastian Andrzej Siewior static struct configfs_item_operations gadget_root_item_ops = { 38588af8bbeSSebastian Andrzej Siewior .release = gadget_info_attr_release, 38688af8bbeSSebastian Andrzej Siewior }; 38788af8bbeSSebastian Andrzej Siewior 38888af8bbeSSebastian Andrzej Siewior static void gadget_config_attr_release(struct config_item *item) 38988af8bbeSSebastian Andrzej Siewior { 39088af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(item); 39188af8bbeSSebastian Andrzej Siewior 39288af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&cfg->c.functions)); 39388af8bbeSSebastian Andrzej Siewior list_del(&cfg->c.list); 39488af8bbeSSebastian Andrzej Siewior kfree(cfg->c.label); 39588af8bbeSSebastian Andrzej Siewior kfree(cfg); 39688af8bbeSSebastian Andrzej Siewior } 39788af8bbeSSebastian Andrzej Siewior 39888af8bbeSSebastian Andrzej Siewior static int config_usb_cfg_link( 39988af8bbeSSebastian Andrzej Siewior struct config_item *usb_cfg_ci, 40088af8bbeSSebastian Andrzej Siewior struct config_item *usb_func_ci) 40188af8bbeSSebastian Andrzej Siewior { 40288af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(usb_cfg_ci); 40388af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev = cfg->c.cdev; 40488af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = container_of(cdev, struct gadget_info, cdev); 40588af8bbeSSebastian Andrzej Siewior 40688af8bbeSSebastian Andrzej Siewior struct config_group *group = to_config_group(usb_func_ci); 40788af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi = container_of(group, 40888af8bbeSSebastian Andrzej Siewior struct usb_function_instance, group); 40988af8bbeSSebastian Andrzej Siewior struct usb_function_instance *a_fi; 41088af8bbeSSebastian Andrzej Siewior struct usb_function *f; 41188af8bbeSSebastian Andrzej Siewior int ret; 41288af8bbeSSebastian Andrzej Siewior 41388af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 41488af8bbeSSebastian Andrzej Siewior /* 41588af8bbeSSebastian Andrzej Siewior * Make sure this function is from within our _this_ gadget and not 41688af8bbeSSebastian Andrzej Siewior * from another gadget or a random directory. 41788af8bbeSSebastian Andrzej Siewior * Also a function instance can only be linked once. 41888af8bbeSSebastian Andrzej Siewior */ 41988af8bbeSSebastian Andrzej Siewior list_for_each_entry(a_fi, &gi->available_func, cfs_list) { 42088af8bbeSSebastian Andrzej Siewior if (a_fi == fi) 42188af8bbeSSebastian Andrzej Siewior break; 42288af8bbeSSebastian Andrzej Siewior } 42388af8bbeSSebastian Andrzej Siewior if (a_fi != fi) { 42488af8bbeSSebastian Andrzej Siewior ret = -EINVAL; 42588af8bbeSSebastian Andrzej Siewior goto out; 42688af8bbeSSebastian Andrzej Siewior } 42788af8bbeSSebastian Andrzej Siewior 42888af8bbeSSebastian Andrzej Siewior list_for_each_entry(f, &cfg->func_list, list) { 42988af8bbeSSebastian Andrzej Siewior if (f->fi == fi) { 43088af8bbeSSebastian Andrzej Siewior ret = -EEXIST; 43188af8bbeSSebastian Andrzej Siewior goto out; 43288af8bbeSSebastian Andrzej Siewior } 43388af8bbeSSebastian Andrzej Siewior } 43488af8bbeSSebastian Andrzej Siewior 43588af8bbeSSebastian Andrzej Siewior f = usb_get_function(fi); 43688af8bbeSSebastian Andrzej Siewior if (IS_ERR(f)) { 43788af8bbeSSebastian Andrzej Siewior ret = PTR_ERR(f); 43888af8bbeSSebastian Andrzej Siewior goto out; 43988af8bbeSSebastian Andrzej Siewior } 44088af8bbeSSebastian Andrzej Siewior 44188af8bbeSSebastian Andrzej Siewior /* stash the function until we bind it to the gadget */ 44288af8bbeSSebastian Andrzej Siewior list_add_tail(&f->list, &cfg->func_list); 44388af8bbeSSebastian Andrzej Siewior ret = 0; 44488af8bbeSSebastian Andrzej Siewior out: 44588af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 44688af8bbeSSebastian Andrzej Siewior return ret; 44788af8bbeSSebastian Andrzej Siewior } 44888af8bbeSSebastian Andrzej Siewior 449e16769d4SAndrzej Pietrasiewicz static void config_usb_cfg_unlink( 45088af8bbeSSebastian Andrzej Siewior struct config_item *usb_cfg_ci, 45188af8bbeSSebastian Andrzej Siewior struct config_item *usb_func_ci) 45288af8bbeSSebastian Andrzej Siewior { 45388af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(usb_cfg_ci); 45488af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev = cfg->c.cdev; 45588af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = container_of(cdev, struct gadget_info, cdev); 45688af8bbeSSebastian Andrzej Siewior 45788af8bbeSSebastian Andrzej Siewior struct config_group *group = to_config_group(usb_func_ci); 45888af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi = container_of(group, 45988af8bbeSSebastian Andrzej Siewior struct usb_function_instance, group); 46088af8bbeSSebastian Andrzej Siewior struct usb_function *f; 46188af8bbeSSebastian Andrzej Siewior 46288af8bbeSSebastian Andrzej Siewior /* 46388af8bbeSSebastian Andrzej Siewior * ideally I would like to forbid to unlink functions while a gadget is 46488af8bbeSSebastian Andrzej Siewior * bound to an UDC. Since this isn't possible at the moment, we simply 46588af8bbeSSebastian Andrzej Siewior * force an unbind, the function is available here and then we can 46688af8bbeSSebastian Andrzej Siewior * remove the function. 46788af8bbeSSebastian Andrzej Siewior */ 46888af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 469afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name) 47088af8bbeSSebastian Andrzej Siewior unregister_gadget(gi); 471afdaadc3SRuslan Bilovol WARN_ON(gi->composite.gadget_driver.udc_name); 47288af8bbeSSebastian Andrzej Siewior 47388af8bbeSSebastian Andrzej Siewior list_for_each_entry(f, &cfg->func_list, list) { 47488af8bbeSSebastian Andrzej Siewior if (f->fi == fi) { 47588af8bbeSSebastian Andrzej Siewior list_del(&f->list); 47688af8bbeSSebastian Andrzej Siewior usb_put_function(f); 47788af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 478e16769d4SAndrzej Pietrasiewicz return; 47988af8bbeSSebastian Andrzej Siewior } 48088af8bbeSSebastian Andrzej Siewior } 48188af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 48275bfe23aSDavid Rientjes WARN(1, "Unable to locate function to unbind\n"); 48388af8bbeSSebastian Andrzej Siewior } 48488af8bbeSSebastian Andrzej Siewior 48588af8bbeSSebastian Andrzej Siewior static struct configfs_item_operations gadget_config_item_ops = { 48688af8bbeSSebastian Andrzej Siewior .release = gadget_config_attr_release, 48788af8bbeSSebastian Andrzej Siewior .allow_link = config_usb_cfg_link, 48888af8bbeSSebastian Andrzej Siewior .drop_link = config_usb_cfg_unlink, 48988af8bbeSSebastian Andrzej Siewior }; 49088af8bbeSSebastian Andrzej Siewior 49188af8bbeSSebastian Andrzej Siewior 49245b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_MaxPower_show(struct config_item *item, 49388af8bbeSSebastian Andrzej Siewior char *page) 49488af8bbeSSebastian Andrzej Siewior { 49545b6a73fSChristoph Hellwig return sprintf(page, "%u\n", to_config_usb_cfg(item)->c.MaxPower); 49688af8bbeSSebastian Andrzej Siewior } 49788af8bbeSSebastian Andrzej Siewior 49845b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_MaxPower_store(struct config_item *item, 49988af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 50088af8bbeSSebastian Andrzej Siewior { 50188af8bbeSSebastian Andrzej Siewior u16 val; 50288af8bbeSSebastian Andrzej Siewior int ret; 50388af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &val); 50488af8bbeSSebastian Andrzej Siewior if (ret) 50588af8bbeSSebastian Andrzej Siewior return ret; 50688af8bbeSSebastian Andrzej Siewior if (DIV_ROUND_UP(val, 8) > 0xff) 50788af8bbeSSebastian Andrzej Siewior return -ERANGE; 50845b6a73fSChristoph Hellwig to_config_usb_cfg(item)->c.MaxPower = val; 50988af8bbeSSebastian Andrzej Siewior return len; 51088af8bbeSSebastian Andrzej Siewior } 51188af8bbeSSebastian Andrzej Siewior 51245b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_bmAttributes_show(struct config_item *item, 51388af8bbeSSebastian Andrzej Siewior char *page) 51488af8bbeSSebastian Andrzej Siewior { 51545b6a73fSChristoph Hellwig return sprintf(page, "0x%02x\n", 51645b6a73fSChristoph Hellwig to_config_usb_cfg(item)->c.bmAttributes); 51788af8bbeSSebastian Andrzej Siewior } 51888af8bbeSSebastian Andrzej Siewior 51945b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_bmAttributes_store(struct config_item *item, 52088af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 52188af8bbeSSebastian Andrzej Siewior { 52288af8bbeSSebastian Andrzej Siewior u8 val; 52388af8bbeSSebastian Andrzej Siewior int ret; 52488af8bbeSSebastian Andrzej Siewior ret = kstrtou8(page, 0, &val); 52588af8bbeSSebastian Andrzej Siewior if (ret) 52688af8bbeSSebastian Andrzej Siewior return ret; 52788af8bbeSSebastian Andrzej Siewior if (!(val & USB_CONFIG_ATT_ONE)) 52888af8bbeSSebastian Andrzej Siewior return -EINVAL; 52988af8bbeSSebastian Andrzej Siewior if (val & ~(USB_CONFIG_ATT_ONE | USB_CONFIG_ATT_SELFPOWER | 53088af8bbeSSebastian Andrzej Siewior USB_CONFIG_ATT_WAKEUP)) 53188af8bbeSSebastian Andrzej Siewior return -EINVAL; 53245b6a73fSChristoph Hellwig to_config_usb_cfg(item)->c.bmAttributes = val; 53388af8bbeSSebastian Andrzej Siewior return len; 53488af8bbeSSebastian Andrzej Siewior } 53588af8bbeSSebastian Andrzej Siewior 53645b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_config_desc_, MaxPower); 53745b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_config_desc_, bmAttributes); 53888af8bbeSSebastian Andrzej Siewior 53988af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_config_attrs[] = { 54045b6a73fSChristoph Hellwig &gadget_config_desc_attr_MaxPower, 54145b6a73fSChristoph Hellwig &gadget_config_desc_attr_bmAttributes, 54288af8bbeSSebastian Andrzej Siewior NULL, 54388af8bbeSSebastian Andrzej Siewior }; 54488af8bbeSSebastian Andrzej Siewior 5454ad01412SBhumika Goyal static const struct config_item_type gadget_config_type = { 54688af8bbeSSebastian Andrzej Siewior .ct_item_ops = &gadget_config_item_ops, 54788af8bbeSSebastian Andrzej Siewior .ct_attrs = gadget_config_attrs, 54888af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 54988af8bbeSSebastian Andrzej Siewior }; 55088af8bbeSSebastian Andrzej Siewior 5514ad01412SBhumika Goyal static const struct config_item_type gadget_root_type = { 55288af8bbeSSebastian Andrzej Siewior .ct_item_ops = &gadget_root_item_ops, 55388af8bbeSSebastian Andrzej Siewior .ct_attrs = gadget_root_attrs, 55488af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 55588af8bbeSSebastian Andrzej Siewior }; 55688af8bbeSSebastian Andrzej Siewior 55788af8bbeSSebastian Andrzej Siewior static void composite_init_dev(struct usb_composite_dev *cdev) 55888af8bbeSSebastian Andrzej Siewior { 55988af8bbeSSebastian Andrzej Siewior spin_lock_init(&cdev->lock); 56088af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cdev->configs); 56188af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cdev->gstrings); 56288af8bbeSSebastian Andrzej Siewior } 56388af8bbeSSebastian Andrzej Siewior 56488af8bbeSSebastian Andrzej Siewior static struct config_group *function_make( 56588af8bbeSSebastian Andrzej Siewior struct config_group *group, 56688af8bbeSSebastian Andrzej Siewior const char *name) 56788af8bbeSSebastian Andrzej Siewior { 56888af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 56988af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi; 57088af8bbeSSebastian Andrzej Siewior char buf[MAX_NAME_LEN]; 57188af8bbeSSebastian Andrzej Siewior char *func_name; 57288af8bbeSSebastian Andrzej Siewior char *instance_name; 57388af8bbeSSebastian Andrzej Siewior int ret; 57488af8bbeSSebastian Andrzej Siewior 57588af8bbeSSebastian Andrzej Siewior ret = snprintf(buf, MAX_NAME_LEN, "%s", name); 57688af8bbeSSebastian Andrzej Siewior if (ret >= MAX_NAME_LEN) 57788af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENAMETOOLONG); 57888af8bbeSSebastian Andrzej Siewior 57988af8bbeSSebastian Andrzej Siewior func_name = buf; 58088af8bbeSSebastian Andrzej Siewior instance_name = strchr(func_name, '.'); 58188af8bbeSSebastian Andrzej Siewior if (!instance_name) { 58288af8bbeSSebastian Andrzej Siewior pr_err("Unable to locate . in FUNC.INSTANCE\n"); 58388af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL); 58488af8bbeSSebastian Andrzej Siewior } 58588af8bbeSSebastian Andrzej Siewior *instance_name = '\0'; 58688af8bbeSSebastian Andrzej Siewior instance_name++; 58788af8bbeSSebastian Andrzej Siewior 58888af8bbeSSebastian Andrzej Siewior fi = usb_get_function_instance(func_name); 58988af8bbeSSebastian Andrzej Siewior if (IS_ERR(fi)) 590a3469411SDuan Jiong return ERR_CAST(fi); 59188af8bbeSSebastian Andrzej Siewior 5923958b792SNicolas Iooss ret = config_item_set_name(&fi->group.cg_item, "%s", name); 59388af8bbeSSebastian Andrzej Siewior if (ret) { 59488af8bbeSSebastian Andrzej Siewior usb_put_function_instance(fi); 59588af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret); 59688af8bbeSSebastian Andrzej Siewior } 5971933861dSAndrzej Pietrasiewicz if (fi->set_inst_name) { 5981933861dSAndrzej Pietrasiewicz ret = fi->set_inst_name(fi, instance_name); 5991933861dSAndrzej Pietrasiewicz if (ret) { 6001933861dSAndrzej Pietrasiewicz usb_put_function_instance(fi); 6011933861dSAndrzej Pietrasiewicz return ERR_PTR(ret); 6021933861dSAndrzej Pietrasiewicz } 6031933861dSAndrzej Pietrasiewicz } 60488af8bbeSSebastian Andrzej Siewior 60588af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, functions_group); 60688af8bbeSSebastian Andrzej Siewior 60788af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 60888af8bbeSSebastian Andrzej Siewior list_add_tail(&fi->cfs_list, &gi->available_func); 60988af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 61088af8bbeSSebastian Andrzej Siewior return &fi->group; 61188af8bbeSSebastian Andrzej Siewior } 61288af8bbeSSebastian Andrzej Siewior 61388af8bbeSSebastian Andrzej Siewior static void function_drop( 61488af8bbeSSebastian Andrzej Siewior struct config_group *group, 61588af8bbeSSebastian Andrzej Siewior struct config_item *item) 61688af8bbeSSebastian Andrzej Siewior { 61788af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi = to_usb_function_instance(item); 61888af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 61988af8bbeSSebastian Andrzej Siewior 62088af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, functions_group); 62188af8bbeSSebastian Andrzej Siewior 62288af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 62388af8bbeSSebastian Andrzej Siewior list_del(&fi->cfs_list); 62488af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 62588af8bbeSSebastian Andrzej Siewior config_item_put(item); 62688af8bbeSSebastian Andrzej Siewior } 62788af8bbeSSebastian Andrzej Siewior 62888af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations functions_ops = { 62988af8bbeSSebastian Andrzej Siewior .make_group = &function_make, 63088af8bbeSSebastian Andrzej Siewior .drop_item = &function_drop, 63188af8bbeSSebastian Andrzej Siewior }; 63288af8bbeSSebastian Andrzej Siewior 6334ad01412SBhumika Goyal static const struct config_item_type functions_type = { 63488af8bbeSSebastian Andrzej Siewior .ct_group_ops = &functions_ops, 63588af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 63688af8bbeSSebastian Andrzej Siewior }; 63788af8bbeSSebastian Andrzej Siewior 63888af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_config_name, configuration); 63988af8bbeSSebastian Andrzej Siewior 64088af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_config_name_langid_attrs[] = { 64145b6a73fSChristoph Hellwig &gadget_config_name_attr_configuration, 64288af8bbeSSebastian Andrzej Siewior NULL, 64388af8bbeSSebastian Andrzej Siewior }; 64488af8bbeSSebastian Andrzej Siewior 64588af8bbeSSebastian Andrzej Siewior static void gadget_config_name_attr_release(struct config_item *item) 64688af8bbeSSebastian Andrzej Siewior { 64788af8bbeSSebastian Andrzej Siewior struct gadget_config_name *cn = to_gadget_config_name(item); 64888af8bbeSSebastian Andrzej Siewior 64988af8bbeSSebastian Andrzej Siewior kfree(cn->configuration); 65088af8bbeSSebastian Andrzej Siewior 65188af8bbeSSebastian Andrzej Siewior list_del(&cn->list); 65288af8bbeSSebastian Andrzej Siewior kfree(cn); 65388af8bbeSSebastian Andrzej Siewior } 65488af8bbeSSebastian Andrzej Siewior 65588af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRING_RW_OPS(gadget_config_name); 65688af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRINGS_LANG(gadget_config_name, config_usb_cfg); 65788af8bbeSSebastian Andrzej Siewior 65888af8bbeSSebastian Andrzej Siewior static struct config_group *config_desc_make( 65988af8bbeSSebastian Andrzej Siewior struct config_group *group, 66088af8bbeSSebastian Andrzej Siewior const char *name) 66188af8bbeSSebastian Andrzej Siewior { 66288af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 66388af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 66488af8bbeSSebastian Andrzej Siewior char buf[MAX_NAME_LEN]; 66588af8bbeSSebastian Andrzej Siewior char *num_str; 66688af8bbeSSebastian Andrzej Siewior u8 num; 66788af8bbeSSebastian Andrzej Siewior int ret; 66888af8bbeSSebastian Andrzej Siewior 66988af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, configs_group); 67088af8bbeSSebastian Andrzej Siewior ret = snprintf(buf, MAX_NAME_LEN, "%s", name); 67188af8bbeSSebastian Andrzej Siewior if (ret >= MAX_NAME_LEN) 67288af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENAMETOOLONG); 67388af8bbeSSebastian Andrzej Siewior 67488af8bbeSSebastian Andrzej Siewior num_str = strchr(buf, '.'); 67588af8bbeSSebastian Andrzej Siewior if (!num_str) { 67688af8bbeSSebastian Andrzej Siewior pr_err("Unable to locate . in name.bConfigurationValue\n"); 67788af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL); 67888af8bbeSSebastian Andrzej Siewior } 67988af8bbeSSebastian Andrzej Siewior 68088af8bbeSSebastian Andrzej Siewior *num_str = '\0'; 68188af8bbeSSebastian Andrzej Siewior num_str++; 68288af8bbeSSebastian Andrzej Siewior 68388af8bbeSSebastian Andrzej Siewior if (!strlen(buf)) 68488af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL); 68588af8bbeSSebastian Andrzej Siewior 68688af8bbeSSebastian Andrzej Siewior ret = kstrtou8(num_str, 0, &num); 68788af8bbeSSebastian Andrzej Siewior if (ret) 68888af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret); 68988af8bbeSSebastian Andrzej Siewior 69088af8bbeSSebastian Andrzej Siewior cfg = kzalloc(sizeof(*cfg), GFP_KERNEL); 69188af8bbeSSebastian Andrzej Siewior if (!cfg) 69288af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM); 69388af8bbeSSebastian Andrzej Siewior cfg->c.label = kstrdup(buf, GFP_KERNEL); 69488af8bbeSSebastian Andrzej Siewior if (!cfg->c.label) { 69588af8bbeSSebastian Andrzej Siewior ret = -ENOMEM; 69688af8bbeSSebastian Andrzej Siewior goto err; 69788af8bbeSSebastian Andrzej Siewior } 69888af8bbeSSebastian Andrzej Siewior cfg->c.bConfigurationValue = num; 69988af8bbeSSebastian Andrzej Siewior cfg->c.MaxPower = CONFIG_USB_GADGET_VBUS_DRAW; 70088af8bbeSSebastian Andrzej Siewior cfg->c.bmAttributes = USB_CONFIG_ATT_ONE; 70188af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cfg->string_list); 70288af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cfg->func_list); 70388af8bbeSSebastian Andrzej Siewior 70488af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&cfg->group, name, 70588af8bbeSSebastian Andrzej Siewior &gadget_config_type); 7061ae1602dSChristoph Hellwig 70788af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&cfg->strings_group, "strings", 70888af8bbeSSebastian Andrzej Siewior &gadget_config_name_strings_type); 7091ae1602dSChristoph Hellwig configfs_add_default_group(&cfg->strings_group, &cfg->group); 71088af8bbeSSebastian Andrzej Siewior 71188af8bbeSSebastian Andrzej Siewior ret = usb_add_config_only(&gi->cdev, &cfg->c); 71288af8bbeSSebastian Andrzej Siewior if (ret) 71388af8bbeSSebastian Andrzej Siewior goto err; 71488af8bbeSSebastian Andrzej Siewior 71588af8bbeSSebastian Andrzej Siewior return &cfg->group; 71688af8bbeSSebastian Andrzej Siewior err: 71788af8bbeSSebastian Andrzej Siewior kfree(cfg->c.label); 71888af8bbeSSebastian Andrzej Siewior kfree(cfg); 71988af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret); 72088af8bbeSSebastian Andrzej Siewior } 72188af8bbeSSebastian Andrzej Siewior 72288af8bbeSSebastian Andrzej Siewior static void config_desc_drop( 72388af8bbeSSebastian Andrzej Siewior struct config_group *group, 72488af8bbeSSebastian Andrzej Siewior struct config_item *item) 72588af8bbeSSebastian Andrzej Siewior { 72688af8bbeSSebastian Andrzej Siewior config_item_put(item); 72788af8bbeSSebastian Andrzej Siewior } 72888af8bbeSSebastian Andrzej Siewior 72988af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations config_desc_ops = { 73088af8bbeSSebastian Andrzej Siewior .make_group = &config_desc_make, 73188af8bbeSSebastian Andrzej Siewior .drop_item = &config_desc_drop, 73288af8bbeSSebastian Andrzej Siewior }; 73388af8bbeSSebastian Andrzej Siewior 7344ad01412SBhumika Goyal static const struct config_item_type config_desc_type = { 73588af8bbeSSebastian Andrzej Siewior .ct_group_ops = &config_desc_ops, 73688af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 73788af8bbeSSebastian Andrzej Siewior }; 73888af8bbeSSebastian Andrzej Siewior 73988af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_strings, manufacturer); 74088af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_strings, product); 74188af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_strings, serialnumber); 74288af8bbeSSebastian Andrzej Siewior 74388af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_strings_langid_attrs[] = { 74445b6a73fSChristoph Hellwig &gadget_strings_attr_manufacturer, 74545b6a73fSChristoph Hellwig &gadget_strings_attr_product, 74645b6a73fSChristoph Hellwig &gadget_strings_attr_serialnumber, 74788af8bbeSSebastian Andrzej Siewior NULL, 74888af8bbeSSebastian Andrzej Siewior }; 74988af8bbeSSebastian Andrzej Siewior 75088af8bbeSSebastian Andrzej Siewior static void gadget_strings_attr_release(struct config_item *item) 75188af8bbeSSebastian Andrzej Siewior { 75288af8bbeSSebastian Andrzej Siewior struct gadget_strings *gs = to_gadget_strings(item); 75388af8bbeSSebastian Andrzej Siewior 75488af8bbeSSebastian Andrzej Siewior kfree(gs->manufacturer); 75588af8bbeSSebastian Andrzej Siewior kfree(gs->product); 75688af8bbeSSebastian Andrzej Siewior kfree(gs->serialnumber); 75788af8bbeSSebastian Andrzej Siewior 75888af8bbeSSebastian Andrzej Siewior list_del(&gs->list); 75988af8bbeSSebastian Andrzej Siewior kfree(gs); 76088af8bbeSSebastian Andrzej Siewior } 76188af8bbeSSebastian Andrzej Siewior 76288af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRING_RW_OPS(gadget_strings); 76388af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRINGS_LANG(gadget_strings, gadget_info); 76488af8bbeSSebastian Andrzej Siewior 76587213d38SAndrzej Pietrasiewicz static inline struct os_desc *to_os_desc(struct config_item *item) 76687213d38SAndrzej Pietrasiewicz { 76787213d38SAndrzej Pietrasiewicz return container_of(to_config_group(item), struct os_desc, group); 76887213d38SAndrzej Pietrasiewicz } 76987213d38SAndrzej Pietrasiewicz 77045b6a73fSChristoph Hellwig static inline struct gadget_info *os_desc_item_to_gadget_info( 77145b6a73fSChristoph Hellwig struct config_item *item) 77287213d38SAndrzej Pietrasiewicz { 77345b6a73fSChristoph Hellwig return to_gadget_info(to_os_desc(item)->group.cg_item.ci_parent); 77487213d38SAndrzej Pietrasiewicz } 77587213d38SAndrzej Pietrasiewicz 77645b6a73fSChristoph Hellwig static ssize_t os_desc_use_show(struct config_item *item, char *page) 77745b6a73fSChristoph Hellwig { 778e800e8cbSStefan Agner return sprintf(page, "%d\n", 77945b6a73fSChristoph Hellwig os_desc_item_to_gadget_info(item)->use_os_desc); 78045b6a73fSChristoph Hellwig } 78145b6a73fSChristoph Hellwig 78245b6a73fSChristoph Hellwig static ssize_t os_desc_use_store(struct config_item *item, const char *page, 78387213d38SAndrzej Pietrasiewicz size_t len) 78487213d38SAndrzej Pietrasiewicz { 78545b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 78687213d38SAndrzej Pietrasiewicz int ret; 78787213d38SAndrzej Pietrasiewicz bool use; 78887213d38SAndrzej Pietrasiewicz 78987213d38SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 79087213d38SAndrzej Pietrasiewicz ret = strtobool(page, &use); 79187213d38SAndrzej Pietrasiewicz if (!ret) { 79287213d38SAndrzej Pietrasiewicz gi->use_os_desc = use; 79387213d38SAndrzej Pietrasiewicz ret = len; 79487213d38SAndrzej Pietrasiewicz } 79587213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 79687213d38SAndrzej Pietrasiewicz 79787213d38SAndrzej Pietrasiewicz return ret; 79887213d38SAndrzej Pietrasiewicz } 79987213d38SAndrzej Pietrasiewicz 80045b6a73fSChristoph Hellwig static ssize_t os_desc_b_vendor_code_show(struct config_item *item, char *page) 80187213d38SAndrzej Pietrasiewicz { 802e800e8cbSStefan Agner return sprintf(page, "0x%02x\n", 80345b6a73fSChristoph Hellwig os_desc_item_to_gadget_info(item)->b_vendor_code); 80487213d38SAndrzej Pietrasiewicz } 80587213d38SAndrzej Pietrasiewicz 80645b6a73fSChristoph Hellwig static ssize_t os_desc_b_vendor_code_store(struct config_item *item, 80787213d38SAndrzej Pietrasiewicz const char *page, size_t len) 80887213d38SAndrzej Pietrasiewicz { 80945b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 81087213d38SAndrzej Pietrasiewicz int ret; 81187213d38SAndrzej Pietrasiewicz u8 b_vendor_code; 81287213d38SAndrzej Pietrasiewicz 81387213d38SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 81487213d38SAndrzej Pietrasiewicz ret = kstrtou8(page, 0, &b_vendor_code); 81587213d38SAndrzej Pietrasiewicz if (!ret) { 81687213d38SAndrzej Pietrasiewicz gi->b_vendor_code = b_vendor_code; 81787213d38SAndrzej Pietrasiewicz ret = len; 81887213d38SAndrzej Pietrasiewicz } 81987213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 82087213d38SAndrzej Pietrasiewicz 82187213d38SAndrzej Pietrasiewicz return ret; 82287213d38SAndrzej Pietrasiewicz } 82387213d38SAndrzej Pietrasiewicz 82445b6a73fSChristoph Hellwig static ssize_t os_desc_qw_sign_show(struct config_item *item, char *page) 82587213d38SAndrzej Pietrasiewicz { 82645b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 82776180d71SStefan Agner int res; 82887213d38SAndrzej Pietrasiewicz 82976180d71SStefan Agner res = utf16s_to_utf8s((wchar_t *) gi->qw_sign, OS_STRING_QW_SIGN_LEN, 83076180d71SStefan Agner UTF16_LITTLE_ENDIAN, page, PAGE_SIZE - 1); 83176180d71SStefan Agner page[res++] = '\n'; 83276180d71SStefan Agner 83376180d71SStefan Agner return res; 83487213d38SAndrzej Pietrasiewicz } 83587213d38SAndrzej Pietrasiewicz 83645b6a73fSChristoph Hellwig static ssize_t os_desc_qw_sign_store(struct config_item *item, const char *page, 83787213d38SAndrzej Pietrasiewicz size_t len) 83887213d38SAndrzej Pietrasiewicz { 83945b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 84087213d38SAndrzej Pietrasiewicz int res, l; 84187213d38SAndrzej Pietrasiewicz 84287213d38SAndrzej Pietrasiewicz l = min((int)len, OS_STRING_QW_SIGN_LEN >> 1); 84387213d38SAndrzej Pietrasiewicz if (page[l - 1] == '\n') 84487213d38SAndrzej Pietrasiewicz --l; 84587213d38SAndrzej Pietrasiewicz 84687213d38SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 84787213d38SAndrzej Pietrasiewicz res = utf8s_to_utf16s(page, l, 84887213d38SAndrzej Pietrasiewicz UTF16_LITTLE_ENDIAN, (wchar_t *) gi->qw_sign, 84987213d38SAndrzej Pietrasiewicz OS_STRING_QW_SIGN_LEN); 85087213d38SAndrzej Pietrasiewicz if (res > 0) 85187213d38SAndrzej Pietrasiewicz res = len; 85287213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 85387213d38SAndrzej Pietrasiewicz 85487213d38SAndrzej Pietrasiewicz return res; 85587213d38SAndrzej Pietrasiewicz } 85687213d38SAndrzej Pietrasiewicz 85745b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, use); 85845b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, b_vendor_code); 85945b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, qw_sign); 86087213d38SAndrzej Pietrasiewicz 86187213d38SAndrzej Pietrasiewicz static struct configfs_attribute *os_desc_attrs[] = { 86245b6a73fSChristoph Hellwig &os_desc_attr_use, 86345b6a73fSChristoph Hellwig &os_desc_attr_b_vendor_code, 86445b6a73fSChristoph Hellwig &os_desc_attr_qw_sign, 86587213d38SAndrzej Pietrasiewicz NULL, 86687213d38SAndrzej Pietrasiewicz }; 86787213d38SAndrzej Pietrasiewicz 86887213d38SAndrzej Pietrasiewicz static void os_desc_attr_release(struct config_item *item) 86987213d38SAndrzej Pietrasiewicz { 87087213d38SAndrzej Pietrasiewicz struct os_desc *os_desc = to_os_desc(item); 87187213d38SAndrzej Pietrasiewicz kfree(os_desc); 87287213d38SAndrzej Pietrasiewicz } 87387213d38SAndrzej Pietrasiewicz 874da424314SAndrzej Pietrasiewicz static int os_desc_link(struct config_item *os_desc_ci, 875da424314SAndrzej Pietrasiewicz struct config_item *usb_cfg_ci) 876da424314SAndrzej Pietrasiewicz { 877da424314SAndrzej Pietrasiewicz struct gadget_info *gi = container_of(to_config_group(os_desc_ci), 878da424314SAndrzej Pietrasiewicz struct gadget_info, os_desc_group); 879da424314SAndrzej Pietrasiewicz struct usb_composite_dev *cdev = &gi->cdev; 880da424314SAndrzej Pietrasiewicz struct config_usb_cfg *c_target = 881da424314SAndrzej Pietrasiewicz container_of(to_config_group(usb_cfg_ci), 882da424314SAndrzej Pietrasiewicz struct config_usb_cfg, group); 883da424314SAndrzej Pietrasiewicz struct usb_configuration *c; 884da424314SAndrzej Pietrasiewicz int ret; 885da424314SAndrzej Pietrasiewicz 886da424314SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 887da424314SAndrzej Pietrasiewicz list_for_each_entry(c, &cdev->configs, list) { 888da424314SAndrzej Pietrasiewicz if (c == &c_target->c) 889da424314SAndrzej Pietrasiewicz break; 890da424314SAndrzej Pietrasiewicz } 891da424314SAndrzej Pietrasiewicz if (c != &c_target->c) { 892da424314SAndrzej Pietrasiewicz ret = -EINVAL; 893da424314SAndrzej Pietrasiewicz goto out; 894da424314SAndrzej Pietrasiewicz } 895da424314SAndrzej Pietrasiewicz 896da424314SAndrzej Pietrasiewicz if (cdev->os_desc_config) { 897da424314SAndrzej Pietrasiewicz ret = -EBUSY; 898da424314SAndrzej Pietrasiewicz goto out; 899da424314SAndrzej Pietrasiewicz } 900da424314SAndrzej Pietrasiewicz 901da424314SAndrzej Pietrasiewicz cdev->os_desc_config = &c_target->c; 902da424314SAndrzej Pietrasiewicz ret = 0; 903da424314SAndrzej Pietrasiewicz 904da424314SAndrzej Pietrasiewicz out: 905da424314SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 906da424314SAndrzej Pietrasiewicz return ret; 907da424314SAndrzej Pietrasiewicz } 908da424314SAndrzej Pietrasiewicz 909e16769d4SAndrzej Pietrasiewicz static void os_desc_unlink(struct config_item *os_desc_ci, 910da424314SAndrzej Pietrasiewicz struct config_item *usb_cfg_ci) 911da424314SAndrzej Pietrasiewicz { 912da424314SAndrzej Pietrasiewicz struct gadget_info *gi = container_of(to_config_group(os_desc_ci), 913da424314SAndrzej Pietrasiewicz struct gadget_info, os_desc_group); 914da424314SAndrzej Pietrasiewicz struct usb_composite_dev *cdev = &gi->cdev; 915da424314SAndrzej Pietrasiewicz 916da424314SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 917afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name) 918da424314SAndrzej Pietrasiewicz unregister_gadget(gi); 919da424314SAndrzej Pietrasiewicz cdev->os_desc_config = NULL; 920afdaadc3SRuslan Bilovol WARN_ON(gi->composite.gadget_driver.udc_name); 921da424314SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 922da424314SAndrzej Pietrasiewicz } 923da424314SAndrzej Pietrasiewicz 92487213d38SAndrzej Pietrasiewicz static struct configfs_item_operations os_desc_ops = { 92587213d38SAndrzej Pietrasiewicz .release = os_desc_attr_release, 926da424314SAndrzej Pietrasiewicz .allow_link = os_desc_link, 927da424314SAndrzej Pietrasiewicz .drop_link = os_desc_unlink, 92887213d38SAndrzej Pietrasiewicz }; 92987213d38SAndrzej Pietrasiewicz 93087213d38SAndrzej Pietrasiewicz static struct config_item_type os_desc_type = { 93187213d38SAndrzej Pietrasiewicz .ct_item_ops = &os_desc_ops, 93287213d38SAndrzej Pietrasiewicz .ct_attrs = os_desc_attrs, 93387213d38SAndrzej Pietrasiewicz .ct_owner = THIS_MODULE, 93487213d38SAndrzej Pietrasiewicz }; 93587213d38SAndrzej Pietrasiewicz 9367419485fSAndrzej Pietrasiewicz static inline struct usb_os_desc_ext_prop 9377419485fSAndrzej Pietrasiewicz *to_usb_os_desc_ext_prop(struct config_item *item) 9387419485fSAndrzej Pietrasiewicz { 9397419485fSAndrzej Pietrasiewicz return container_of(item, struct usb_os_desc_ext_prop, item); 9407419485fSAndrzej Pietrasiewicz } 9417419485fSAndrzej Pietrasiewicz 94245b6a73fSChristoph Hellwig static ssize_t ext_prop_type_show(struct config_item *item, char *page) 9437419485fSAndrzej Pietrasiewicz { 944e800e8cbSStefan Agner return sprintf(page, "%d\n", to_usb_os_desc_ext_prop(item)->type); 9457419485fSAndrzej Pietrasiewicz } 9467419485fSAndrzej Pietrasiewicz 94745b6a73fSChristoph Hellwig static ssize_t ext_prop_type_store(struct config_item *item, 9487419485fSAndrzej Pietrasiewicz const char *page, size_t len) 9497419485fSAndrzej Pietrasiewicz { 95045b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 9517419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(ext_prop->item.ci_parent); 9527419485fSAndrzej Pietrasiewicz u8 type; 9537419485fSAndrzej Pietrasiewicz int ret; 9547419485fSAndrzej Pietrasiewicz 9557419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 9567419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 9577419485fSAndrzej Pietrasiewicz ret = kstrtou8(page, 0, &type); 9587419485fSAndrzej Pietrasiewicz if (ret) 9597419485fSAndrzej Pietrasiewicz goto end; 9607419485fSAndrzej Pietrasiewicz if (type < USB_EXT_PROP_UNICODE || type > USB_EXT_PROP_UNICODE_MULTI) { 9617419485fSAndrzej Pietrasiewicz ret = -EINVAL; 9627419485fSAndrzej Pietrasiewicz goto end; 9637419485fSAndrzej Pietrasiewicz } 9647419485fSAndrzej Pietrasiewicz 9657419485fSAndrzej Pietrasiewicz if ((ext_prop->type == USB_EXT_PROP_BINARY || 9667419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_LE32 || 9677419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_BE32) && 9687419485fSAndrzej Pietrasiewicz (type == USB_EXT_PROP_UNICODE || 9697419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_UNICODE_ENV || 9707419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_UNICODE_LINK)) 9717419485fSAndrzej Pietrasiewicz ext_prop->data_len <<= 1; 9727419485fSAndrzej Pietrasiewicz else if ((ext_prop->type == USB_EXT_PROP_UNICODE || 9737419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV || 9747419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) && 9757419485fSAndrzej Pietrasiewicz (type == USB_EXT_PROP_BINARY || 9767419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_LE32 || 9777419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_BE32)) 9787419485fSAndrzej Pietrasiewicz ext_prop->data_len >>= 1; 9797419485fSAndrzej Pietrasiewicz ext_prop->type = type; 9807419485fSAndrzej Pietrasiewicz ret = len; 9817419485fSAndrzej Pietrasiewicz 9827419485fSAndrzej Pietrasiewicz end: 9837419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 9847419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 9857419485fSAndrzej Pietrasiewicz return ret; 9867419485fSAndrzej Pietrasiewicz } 9877419485fSAndrzej Pietrasiewicz 98845b6a73fSChristoph Hellwig static ssize_t ext_prop_data_show(struct config_item *item, char *page) 9897419485fSAndrzej Pietrasiewicz { 99045b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 9917419485fSAndrzej Pietrasiewicz int len = ext_prop->data_len; 9927419485fSAndrzej Pietrasiewicz 9937419485fSAndrzej Pietrasiewicz if (ext_prop->type == USB_EXT_PROP_UNICODE || 9947419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV || 9957419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) 9967419485fSAndrzej Pietrasiewicz len >>= 1; 9977419485fSAndrzej Pietrasiewicz memcpy(page, ext_prop->data, len); 9987419485fSAndrzej Pietrasiewicz 9997419485fSAndrzej Pietrasiewicz return len; 10007419485fSAndrzej Pietrasiewicz } 10017419485fSAndrzej Pietrasiewicz 100245b6a73fSChristoph Hellwig static ssize_t ext_prop_data_store(struct config_item *item, 10037419485fSAndrzej Pietrasiewicz const char *page, size_t len) 10047419485fSAndrzej Pietrasiewicz { 100545b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 10067419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(ext_prop->item.ci_parent); 10077419485fSAndrzej Pietrasiewicz char *new_data; 10087419485fSAndrzej Pietrasiewicz size_t ret_len = len; 10097419485fSAndrzej Pietrasiewicz 10107419485fSAndrzej Pietrasiewicz if (page[len - 1] == '\n' || page[len - 1] == '\0') 10117419485fSAndrzej Pietrasiewicz --len; 101258b949e0SBenoit Taine new_data = kmemdup(page, len, GFP_KERNEL); 10137419485fSAndrzej Pietrasiewicz if (!new_data) 10147419485fSAndrzej Pietrasiewicz return -ENOMEM; 10157419485fSAndrzej Pietrasiewicz 10167419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10177419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 10187419485fSAndrzej Pietrasiewicz kfree(ext_prop->data); 10197419485fSAndrzej Pietrasiewicz ext_prop->data = new_data; 10207419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= ext_prop->data_len; 10217419485fSAndrzej Pietrasiewicz ext_prop->data_len = len; 10227419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->data_len; 10237419485fSAndrzej Pietrasiewicz if (ext_prop->type == USB_EXT_PROP_UNICODE || 10247419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV || 10257419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) { 10267419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= ext_prop->data_len; 10277419485fSAndrzej Pietrasiewicz ext_prop->data_len <<= 1; 10287419485fSAndrzej Pietrasiewicz ext_prop->data_len += 2; 10297419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->data_len; 10307419485fSAndrzej Pietrasiewicz } 10317419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10327419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 10337419485fSAndrzej Pietrasiewicz return ret_len; 10347419485fSAndrzej Pietrasiewicz } 10357419485fSAndrzej Pietrasiewicz 103645b6a73fSChristoph Hellwig CONFIGFS_ATTR(ext_prop_, type); 103745b6a73fSChristoph Hellwig CONFIGFS_ATTR(ext_prop_, data); 10387419485fSAndrzej Pietrasiewicz 10397419485fSAndrzej Pietrasiewicz static struct configfs_attribute *ext_prop_attrs[] = { 104045b6a73fSChristoph Hellwig &ext_prop_attr_type, 104145b6a73fSChristoph Hellwig &ext_prop_attr_data, 10427419485fSAndrzej Pietrasiewicz NULL, 10437419485fSAndrzej Pietrasiewicz }; 10447419485fSAndrzej Pietrasiewicz 10457419485fSAndrzej Pietrasiewicz static void usb_os_desc_ext_prop_release(struct config_item *item) 10467419485fSAndrzej Pietrasiewicz { 10477419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 10487419485fSAndrzej Pietrasiewicz 10497419485fSAndrzej Pietrasiewicz kfree(ext_prop); /* frees a whole chunk */ 10507419485fSAndrzej Pietrasiewicz } 10517419485fSAndrzej Pietrasiewicz 10527419485fSAndrzej Pietrasiewicz static struct configfs_item_operations ext_prop_ops = { 10537419485fSAndrzej Pietrasiewicz .release = usb_os_desc_ext_prop_release, 10547419485fSAndrzej Pietrasiewicz }; 10557419485fSAndrzej Pietrasiewicz 10567419485fSAndrzej Pietrasiewicz static struct config_item *ext_prop_make( 10577419485fSAndrzej Pietrasiewicz struct config_group *group, 10587419485fSAndrzej Pietrasiewicz const char *name) 10597419485fSAndrzej Pietrasiewicz { 10607419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop; 10617419485fSAndrzej Pietrasiewicz struct config_item_type *ext_prop_type; 10627419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc; 10637419485fSAndrzej Pietrasiewicz char *vlabuf; 10647419485fSAndrzej Pietrasiewicz 10657419485fSAndrzej Pietrasiewicz vla_group(data_chunk); 10667419485fSAndrzej Pietrasiewicz vla_item(data_chunk, struct usb_os_desc_ext_prop, ext_prop, 1); 10677419485fSAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, ext_prop_type, 1); 10687419485fSAndrzej Pietrasiewicz 10697419485fSAndrzej Pietrasiewicz vlabuf = kzalloc(vla_group_size(data_chunk), GFP_KERNEL); 10707419485fSAndrzej Pietrasiewicz if (!vlabuf) 10717419485fSAndrzej Pietrasiewicz return ERR_PTR(-ENOMEM); 10727419485fSAndrzej Pietrasiewicz 10737419485fSAndrzej Pietrasiewicz ext_prop = vla_ptr(vlabuf, data_chunk, ext_prop); 10747419485fSAndrzej Pietrasiewicz ext_prop_type = vla_ptr(vlabuf, data_chunk, ext_prop_type); 10757419485fSAndrzej Pietrasiewicz 10767419485fSAndrzej Pietrasiewicz desc = container_of(group, struct usb_os_desc, group); 10777419485fSAndrzej Pietrasiewicz ext_prop_type->ct_item_ops = &ext_prop_ops; 10787419485fSAndrzej Pietrasiewicz ext_prop_type->ct_attrs = ext_prop_attrs; 10797419485fSAndrzej Pietrasiewicz ext_prop_type->ct_owner = desc->owner; 10807419485fSAndrzej Pietrasiewicz 10817419485fSAndrzej Pietrasiewicz config_item_init_type_name(&ext_prop->item, name, ext_prop_type); 10827419485fSAndrzej Pietrasiewicz 10837419485fSAndrzej Pietrasiewicz ext_prop->name = kstrdup(name, GFP_KERNEL); 10847419485fSAndrzej Pietrasiewicz if (!ext_prop->name) { 10857419485fSAndrzej Pietrasiewicz kfree(vlabuf); 10867419485fSAndrzej Pietrasiewicz return ERR_PTR(-ENOMEM); 10877419485fSAndrzej Pietrasiewicz } 10887419485fSAndrzej Pietrasiewicz desc->ext_prop_len += 14; 10897419485fSAndrzej Pietrasiewicz ext_prop->name_len = 2 * strlen(ext_prop->name) + 2; 10907419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10917419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 10927419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->name_len; 10937419485fSAndrzej Pietrasiewicz list_add_tail(&ext_prop->entry, &desc->ext_prop); 10947419485fSAndrzej Pietrasiewicz ++desc->ext_prop_count; 10957419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10967419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 10977419485fSAndrzej Pietrasiewicz 10987419485fSAndrzej Pietrasiewicz return &ext_prop->item; 10997419485fSAndrzej Pietrasiewicz } 11007419485fSAndrzej Pietrasiewicz 11017419485fSAndrzej Pietrasiewicz static void ext_prop_drop(struct config_group *group, struct config_item *item) 11027419485fSAndrzej Pietrasiewicz { 11037419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 11047419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(&group->cg_item); 11057419485fSAndrzej Pietrasiewicz 11067419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 11077419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 11087419485fSAndrzej Pietrasiewicz list_del(&ext_prop->entry); 11097419485fSAndrzej Pietrasiewicz --desc->ext_prop_count; 11107419485fSAndrzej Pietrasiewicz kfree(ext_prop->name); 11117419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= (ext_prop->name_len + ext_prop->data_len + 14); 11127419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 11137419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 11147419485fSAndrzej Pietrasiewicz config_item_put(item); 11157419485fSAndrzej Pietrasiewicz } 11167419485fSAndrzej Pietrasiewicz 11177419485fSAndrzej Pietrasiewicz static struct configfs_group_operations interf_grp_ops = { 11187419485fSAndrzej Pietrasiewicz .make_item = &ext_prop_make, 11197419485fSAndrzej Pietrasiewicz .drop_item = &ext_prop_drop, 11207419485fSAndrzej Pietrasiewicz }; 11217419485fSAndrzej Pietrasiewicz 112245b6a73fSChristoph Hellwig static ssize_t interf_grp_compatible_id_show(struct config_item *item, 1123da424314SAndrzej Pietrasiewicz char *page) 1124da424314SAndrzej Pietrasiewicz { 112545b6a73fSChristoph Hellwig memcpy(page, to_usb_os_desc(item)->ext_compat_id, 8); 1126da424314SAndrzej Pietrasiewicz return 8; 1127da424314SAndrzej Pietrasiewicz } 1128da424314SAndrzej Pietrasiewicz 112945b6a73fSChristoph Hellwig static ssize_t interf_grp_compatible_id_store(struct config_item *item, 1130da424314SAndrzej Pietrasiewicz const char *page, size_t len) 1131da424314SAndrzej Pietrasiewicz { 113245b6a73fSChristoph Hellwig struct usb_os_desc *desc = to_usb_os_desc(item); 1133da424314SAndrzej Pietrasiewicz int l; 1134da424314SAndrzej Pietrasiewicz 1135da424314SAndrzej Pietrasiewicz l = min_t(int, 8, len); 1136da424314SAndrzej Pietrasiewicz if (page[l - 1] == '\n') 1137da424314SAndrzej Pietrasiewicz --l; 1138da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1139da424314SAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 1140da424314SAndrzej Pietrasiewicz memcpy(desc->ext_compat_id, page, l); 1141da424314SAndrzej Pietrasiewicz 1142da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1143da424314SAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 1144da424314SAndrzej Pietrasiewicz 1145da424314SAndrzej Pietrasiewicz return len; 1146da424314SAndrzej Pietrasiewicz } 1147da424314SAndrzej Pietrasiewicz 114845b6a73fSChristoph Hellwig static ssize_t interf_grp_sub_compatible_id_show(struct config_item *item, 1149da424314SAndrzej Pietrasiewicz char *page) 1150da424314SAndrzej Pietrasiewicz { 115145b6a73fSChristoph Hellwig memcpy(page, to_usb_os_desc(item)->ext_compat_id + 8, 8); 1152da424314SAndrzej Pietrasiewicz return 8; 1153da424314SAndrzej Pietrasiewicz } 1154da424314SAndrzej Pietrasiewicz 115545b6a73fSChristoph Hellwig static ssize_t interf_grp_sub_compatible_id_store(struct config_item *item, 1156da424314SAndrzej Pietrasiewicz const char *page, size_t len) 1157da424314SAndrzej Pietrasiewicz { 115845b6a73fSChristoph Hellwig struct usb_os_desc *desc = to_usb_os_desc(item); 1159da424314SAndrzej Pietrasiewicz int l; 1160da424314SAndrzej Pietrasiewicz 1161da424314SAndrzej Pietrasiewicz l = min_t(int, 8, len); 1162da424314SAndrzej Pietrasiewicz if (page[l - 1] == '\n') 1163da424314SAndrzej Pietrasiewicz --l; 1164da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1165da424314SAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 1166da424314SAndrzej Pietrasiewicz memcpy(desc->ext_compat_id + 8, page, l); 1167da424314SAndrzej Pietrasiewicz 1168da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1169da424314SAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 1170da424314SAndrzej Pietrasiewicz 1171da424314SAndrzej Pietrasiewicz return len; 1172da424314SAndrzej Pietrasiewicz } 1173da424314SAndrzej Pietrasiewicz 117445b6a73fSChristoph Hellwig CONFIGFS_ATTR(interf_grp_, compatible_id); 117545b6a73fSChristoph Hellwig CONFIGFS_ATTR(interf_grp_, sub_compatible_id); 1176da424314SAndrzej Pietrasiewicz 1177da424314SAndrzej Pietrasiewicz static struct configfs_attribute *interf_grp_attrs[] = { 117845b6a73fSChristoph Hellwig &interf_grp_attr_compatible_id, 117945b6a73fSChristoph Hellwig &interf_grp_attr_sub_compatible_id, 1180da424314SAndrzej Pietrasiewicz NULL 1181da424314SAndrzej Pietrasiewicz }; 1182da424314SAndrzej Pietrasiewicz 1183ff74745eSAndrew Gabbasov struct config_group *usb_os_desc_prepare_interf_dir( 1184ff74745eSAndrew Gabbasov struct config_group *parent, 1185da424314SAndrzej Pietrasiewicz int n_interf, 1186da424314SAndrzej Pietrasiewicz struct usb_os_desc **desc, 118714574b54SAndrzej Pietrasiewicz char **names, 1188da424314SAndrzej Pietrasiewicz struct module *owner) 1189da424314SAndrzej Pietrasiewicz { 11901ae1602dSChristoph Hellwig struct config_group *os_desc_group; 1191da424314SAndrzej Pietrasiewicz struct config_item_type *os_desc_type, *interface_type; 1192da424314SAndrzej Pietrasiewicz 1193da424314SAndrzej Pietrasiewicz vla_group(data_chunk); 1194da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_group, os_desc_group, 1); 1195da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, os_desc_type, 1); 1196da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, interface_type, 1); 1197da424314SAndrzej Pietrasiewicz 1198da424314SAndrzej Pietrasiewicz char *vlabuf = kzalloc(vla_group_size(data_chunk), GFP_KERNEL); 1199da424314SAndrzej Pietrasiewicz if (!vlabuf) 1200ff74745eSAndrew Gabbasov return ERR_PTR(-ENOMEM); 1201da424314SAndrzej Pietrasiewicz 1202da424314SAndrzej Pietrasiewicz os_desc_group = vla_ptr(vlabuf, data_chunk, os_desc_group); 1203da424314SAndrzej Pietrasiewicz os_desc_type = vla_ptr(vlabuf, data_chunk, os_desc_type); 1204da424314SAndrzej Pietrasiewicz interface_type = vla_ptr(vlabuf, data_chunk, interface_type); 1205da424314SAndrzej Pietrasiewicz 1206da424314SAndrzej Pietrasiewicz os_desc_type->ct_owner = owner; 1207da424314SAndrzej Pietrasiewicz config_group_init_type_name(os_desc_group, "os_desc", os_desc_type); 12081ae1602dSChristoph Hellwig configfs_add_default_group(os_desc_group, parent); 1209da424314SAndrzej Pietrasiewicz 12107419485fSAndrzej Pietrasiewicz interface_type->ct_group_ops = &interf_grp_ops; 1211da424314SAndrzej Pietrasiewicz interface_type->ct_attrs = interf_grp_attrs; 1212da424314SAndrzej Pietrasiewicz interface_type->ct_owner = owner; 1213da424314SAndrzej Pietrasiewicz 1214da424314SAndrzej Pietrasiewicz while (n_interf--) { 1215da424314SAndrzej Pietrasiewicz struct usb_os_desc *d; 1216da424314SAndrzej Pietrasiewicz 1217da424314SAndrzej Pietrasiewicz d = desc[n_interf]; 12187419485fSAndrzej Pietrasiewicz d->owner = owner; 1219da424314SAndrzej Pietrasiewicz config_group_init_type_name(&d->group, "", interface_type); 122014574b54SAndrzej Pietrasiewicz config_item_set_name(&d->group.cg_item, "interface.%s", 122114574b54SAndrzej Pietrasiewicz names[n_interf]); 12221ae1602dSChristoph Hellwig configfs_add_default_group(&d->group, os_desc_group); 1223da424314SAndrzej Pietrasiewicz } 1224da424314SAndrzej Pietrasiewicz 1225ff74745eSAndrew Gabbasov return os_desc_group; 1226da424314SAndrzej Pietrasiewicz } 1227da424314SAndrzej Pietrasiewicz EXPORT_SYMBOL(usb_os_desc_prepare_interf_dir); 1228da424314SAndrzej Pietrasiewicz 122988af8bbeSSebastian Andrzej Siewior static int configfs_do_nothing(struct usb_composite_dev *cdev) 123088af8bbeSSebastian Andrzej Siewior { 123175bfe23aSDavid Rientjes WARN_ON(1); 123288af8bbeSSebastian Andrzej Siewior return -EINVAL; 123388af8bbeSSebastian Andrzej Siewior } 123488af8bbeSSebastian Andrzej Siewior 123588af8bbeSSebastian Andrzej Siewior int composite_dev_prepare(struct usb_composite_driver *composite, 123688af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *dev); 123788af8bbeSSebastian Andrzej Siewior 1238da424314SAndrzej Pietrasiewicz int composite_os_desc_req_prepare(struct usb_composite_dev *cdev, 1239da424314SAndrzej Pietrasiewicz struct usb_ep *ep0); 1240da424314SAndrzej Pietrasiewicz 124188af8bbeSSebastian Andrzej Siewior static void purge_configs_funcs(struct gadget_info *gi) 124288af8bbeSSebastian Andrzej Siewior { 124388af8bbeSSebastian Andrzej Siewior struct usb_configuration *c; 124488af8bbeSSebastian Andrzej Siewior 124588af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) { 124688af8bbeSSebastian Andrzej Siewior struct usb_function *f, *tmp; 124788af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 124888af8bbeSSebastian Andrzej Siewior 124988af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c); 125088af8bbeSSebastian Andrzej Siewior 125188af8bbeSSebastian Andrzej Siewior list_for_each_entry_safe(f, tmp, &c->functions, list) { 125288af8bbeSSebastian Andrzej Siewior 125388af8bbeSSebastian Andrzej Siewior list_move_tail(&f->list, &cfg->func_list); 125488af8bbeSSebastian Andrzej Siewior if (f->unbind) { 1255da7b895dSRomain Izard dev_dbg(&gi->cdev.gadget->dev, 1256a08f5dbfSRomain Izard "unbind function '%s'/%p\n", 1257a08f5dbfSRomain Izard f->name, f); 125888af8bbeSSebastian Andrzej Siewior f->unbind(c, f); 125988af8bbeSSebastian Andrzej Siewior } 126088af8bbeSSebastian Andrzej Siewior } 126188af8bbeSSebastian Andrzej Siewior c->next_interface_id = 0; 1262903124feSKrzysztof Opasiak memset(c->interface, 0, sizeof(c->interface)); 1263554eead5SJohn Youn c->superspeed_plus = 0; 126488af8bbeSSebastian Andrzej Siewior c->superspeed = 0; 126588af8bbeSSebastian Andrzej Siewior c->highspeed = 0; 126688af8bbeSSebastian Andrzej Siewior c->fullspeed = 0; 126788af8bbeSSebastian Andrzej Siewior } 126888af8bbeSSebastian Andrzej Siewior } 126988af8bbeSSebastian Andrzej Siewior 127088af8bbeSSebastian Andrzej Siewior static int configfs_composite_bind(struct usb_gadget *gadget, 127188af8bbeSSebastian Andrzej Siewior struct usb_gadget_driver *gdriver) 127288af8bbeSSebastian Andrzej Siewior { 127388af8bbeSSebastian Andrzej Siewior struct usb_composite_driver *composite = to_cdriver(gdriver); 127488af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = container_of(composite, 127588af8bbeSSebastian Andrzej Siewior struct gadget_info, composite); 127688af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev = &gi->cdev; 127788af8bbeSSebastian Andrzej Siewior struct usb_configuration *c; 127888af8bbeSSebastian Andrzej Siewior struct usb_string *s; 127988af8bbeSSebastian Andrzej Siewior unsigned i; 128088af8bbeSSebastian Andrzej Siewior int ret; 128188af8bbeSSebastian Andrzej Siewior 128288af8bbeSSebastian Andrzej Siewior /* the gi->lock is hold by the caller */ 12831a1c851bSPeter Chen gi->unbind = 0; 128488af8bbeSSebastian Andrzej Siewior cdev->gadget = gadget; 128588af8bbeSSebastian Andrzej Siewior set_gadget_data(gadget, cdev); 128688af8bbeSSebastian Andrzej Siewior ret = composite_dev_prepare(composite, cdev); 128788af8bbeSSebastian Andrzej Siewior if (ret) 128888af8bbeSSebastian Andrzej Siewior return ret; 128988af8bbeSSebastian Andrzej Siewior /* and now the gadget bind */ 129088af8bbeSSebastian Andrzej Siewior ret = -EINVAL; 129188af8bbeSSebastian Andrzej Siewior 129288af8bbeSSebastian Andrzej Siewior if (list_empty(&gi->cdev.configs)) { 129388af8bbeSSebastian Andrzej Siewior pr_err("Need at least one configuration in %s.\n", 129488af8bbeSSebastian Andrzej Siewior gi->composite.name); 129588af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 129688af8bbeSSebastian Andrzej Siewior } 129788af8bbeSSebastian Andrzej Siewior 129888af8bbeSSebastian Andrzej Siewior 129988af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) { 130088af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 130188af8bbeSSebastian Andrzej Siewior 130288af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c); 130388af8bbeSSebastian Andrzej Siewior if (list_empty(&cfg->func_list)) { 130488af8bbeSSebastian Andrzej Siewior pr_err("Config %s/%d of %s needs at least one function.\n", 130588af8bbeSSebastian Andrzej Siewior c->label, c->bConfigurationValue, 130688af8bbeSSebastian Andrzej Siewior gi->composite.name); 130788af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 130888af8bbeSSebastian Andrzej Siewior } 130988af8bbeSSebastian Andrzej Siewior } 131088af8bbeSSebastian Andrzej Siewior 131188af8bbeSSebastian Andrzej Siewior /* init all strings */ 131288af8bbeSSebastian Andrzej Siewior if (!list_empty(&gi->string_list)) { 131388af8bbeSSebastian Andrzej Siewior struct gadget_strings *gs; 131488af8bbeSSebastian Andrzej Siewior 131588af8bbeSSebastian Andrzej Siewior i = 0; 131688af8bbeSSebastian Andrzej Siewior list_for_each_entry(gs, &gi->string_list, list) { 131788af8bbeSSebastian Andrzej Siewior 131888af8bbeSSebastian Andrzej Siewior gi->gstrings[i] = &gs->stringtab_dev; 131988af8bbeSSebastian Andrzej Siewior gs->stringtab_dev.strings = gs->strings; 132088af8bbeSSebastian Andrzej Siewior gs->strings[USB_GADGET_MANUFACTURER_IDX].s = 132188af8bbeSSebastian Andrzej Siewior gs->manufacturer; 132288af8bbeSSebastian Andrzej Siewior gs->strings[USB_GADGET_PRODUCT_IDX].s = gs->product; 132388af8bbeSSebastian Andrzej Siewior gs->strings[USB_GADGET_SERIAL_IDX].s = gs->serialnumber; 132488af8bbeSSebastian Andrzej Siewior i++; 132588af8bbeSSebastian Andrzej Siewior } 132688af8bbeSSebastian Andrzej Siewior gi->gstrings[i] = NULL; 132788af8bbeSSebastian Andrzej Siewior s = usb_gstrings_attach(&gi->cdev, gi->gstrings, 132888af8bbeSSebastian Andrzej Siewior USB_GADGET_FIRST_AVAIL_IDX); 1329fea77077SWei Yongjun if (IS_ERR(s)) { 1330fea77077SWei Yongjun ret = PTR_ERR(s); 133188af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 1332fea77077SWei Yongjun } 133388af8bbeSSebastian Andrzej Siewior 133488af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iManufacturer = s[USB_GADGET_MANUFACTURER_IDX].id; 133588af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iProduct = s[USB_GADGET_PRODUCT_IDX].id; 133688af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iSerialNumber = s[USB_GADGET_SERIAL_IDX].id; 133788af8bbeSSebastian Andrzej Siewior } 133888af8bbeSSebastian Andrzej Siewior 133987213d38SAndrzej Pietrasiewicz if (gi->use_os_desc) { 134087213d38SAndrzej Pietrasiewicz cdev->use_os_string = true; 134187213d38SAndrzej Pietrasiewicz cdev->b_vendor_code = gi->b_vendor_code; 134287213d38SAndrzej Pietrasiewicz memcpy(cdev->qw_sign, gi->qw_sign, OS_STRING_QW_SIGN_LEN); 134387213d38SAndrzej Pietrasiewicz } 134487213d38SAndrzej Pietrasiewicz 134541ce84c8SLi Jun if (gadget_is_otg(gadget) && !otg_desc[0]) { 134641ce84c8SLi Jun struct usb_descriptor_header *usb_desc; 134741ce84c8SLi Jun 134841ce84c8SLi Jun usb_desc = usb_otg_descriptor_alloc(gadget); 134941ce84c8SLi Jun if (!usb_desc) { 135041ce84c8SLi Jun ret = -ENOMEM; 135141ce84c8SLi Jun goto err_comp_cleanup; 135241ce84c8SLi Jun } 135341ce84c8SLi Jun usb_otg_descriptor_init(gadget, usb_desc); 135441ce84c8SLi Jun otg_desc[0] = usb_desc; 135541ce84c8SLi Jun otg_desc[1] = NULL; 135641ce84c8SLi Jun } 135741ce84c8SLi Jun 135888af8bbeSSebastian Andrzej Siewior /* Go through all configs, attach all functions */ 135988af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) { 136088af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 136188af8bbeSSebastian Andrzej Siewior struct usb_function *f; 136288af8bbeSSebastian Andrzej Siewior struct usb_function *tmp; 136388af8bbeSSebastian Andrzej Siewior struct gadget_config_name *cn; 136488af8bbeSSebastian Andrzej Siewior 136541ce84c8SLi Jun if (gadget_is_otg(gadget)) 136641ce84c8SLi Jun c->descriptors = otg_desc; 136741ce84c8SLi Jun 136888af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c); 136988af8bbeSSebastian Andrzej Siewior if (!list_empty(&cfg->string_list)) { 137088af8bbeSSebastian Andrzej Siewior i = 0; 137188af8bbeSSebastian Andrzej Siewior list_for_each_entry(cn, &cfg->string_list, list) { 137288af8bbeSSebastian Andrzej Siewior cfg->gstrings[i] = &cn->stringtab_dev; 137388af8bbeSSebastian Andrzej Siewior cn->stringtab_dev.strings = &cn->strings; 137488af8bbeSSebastian Andrzej Siewior cn->strings.s = cn->configuration; 137588af8bbeSSebastian Andrzej Siewior i++; 137688af8bbeSSebastian Andrzej Siewior } 137788af8bbeSSebastian Andrzej Siewior cfg->gstrings[i] = NULL; 137888af8bbeSSebastian Andrzej Siewior s = usb_gstrings_attach(&gi->cdev, cfg->gstrings, 1); 1379fea77077SWei Yongjun if (IS_ERR(s)) { 1380fea77077SWei Yongjun ret = PTR_ERR(s); 138188af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 1382fea77077SWei Yongjun } 138388af8bbeSSebastian Andrzej Siewior c->iConfiguration = s[0].id; 138488af8bbeSSebastian Andrzej Siewior } 138588af8bbeSSebastian Andrzej Siewior 138688af8bbeSSebastian Andrzej Siewior list_for_each_entry_safe(f, tmp, &cfg->func_list, list) { 138788af8bbeSSebastian Andrzej Siewior list_del(&f->list); 138888af8bbeSSebastian Andrzej Siewior ret = usb_add_function(c, f); 13895a68e9b5SAndrzej Pietrasiewicz if (ret) { 13905a68e9b5SAndrzej Pietrasiewicz list_add(&f->list, &cfg->func_list); 139188af8bbeSSebastian Andrzej Siewior goto err_purge_funcs; 139288af8bbeSSebastian Andrzej Siewior } 13935a68e9b5SAndrzej Pietrasiewicz } 139488af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget); 139588af8bbeSSebastian Andrzej Siewior } 1396da424314SAndrzej Pietrasiewicz if (cdev->use_os_string) { 1397da424314SAndrzej Pietrasiewicz ret = composite_os_desc_req_prepare(cdev, gadget->ep0); 1398da424314SAndrzej Pietrasiewicz if (ret) 1399da424314SAndrzej Pietrasiewicz goto err_purge_funcs; 1400da424314SAndrzej Pietrasiewicz } 1401da424314SAndrzej Pietrasiewicz 140288af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget); 140388af8bbeSSebastian Andrzej Siewior return 0; 140488af8bbeSSebastian Andrzej Siewior 140588af8bbeSSebastian Andrzej Siewior err_purge_funcs: 140688af8bbeSSebastian Andrzej Siewior purge_configs_funcs(gi); 140788af8bbeSSebastian Andrzej Siewior err_comp_cleanup: 140888af8bbeSSebastian Andrzej Siewior composite_dev_cleanup(cdev); 140988af8bbeSSebastian Andrzej Siewior return ret; 141088af8bbeSSebastian Andrzej Siewior } 141188af8bbeSSebastian Andrzej Siewior 141288af8bbeSSebastian Andrzej Siewior static void configfs_composite_unbind(struct usb_gadget *gadget) 141388af8bbeSSebastian Andrzej Siewior { 141488af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev; 141588af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 14161a1c851bSPeter Chen unsigned long flags; 141788af8bbeSSebastian Andrzej Siewior 141888af8bbeSSebastian Andrzej Siewior /* the gi->lock is hold by the caller */ 141988af8bbeSSebastian Andrzej Siewior 142088af8bbeSSebastian Andrzej Siewior cdev = get_gadget_data(gadget); 142188af8bbeSSebastian Andrzej Siewior gi = container_of(cdev, struct gadget_info, cdev); 14221a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 14231a1c851bSPeter Chen gi->unbind = 1; 14241a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 142588af8bbeSSebastian Andrzej Siewior 142641ce84c8SLi Jun kfree(otg_desc[0]); 142741ce84c8SLi Jun otg_desc[0] = NULL; 142888af8bbeSSebastian Andrzej Siewior purge_configs_funcs(gi); 142988af8bbeSSebastian Andrzej Siewior composite_dev_cleanup(cdev); 143088af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget); 14311a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 143288af8bbeSSebastian Andrzej Siewior cdev->gadget = NULL; 143388af8bbeSSebastian Andrzej Siewior set_gadget_data(gadget, NULL); 14341a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 14351a1c851bSPeter Chen } 14361a1c851bSPeter Chen 14371a1c851bSPeter Chen static int configfs_composite_setup(struct usb_gadget *gadget, 14381a1c851bSPeter Chen const struct usb_ctrlrequest *ctrl) 14391a1c851bSPeter Chen { 14401a1c851bSPeter Chen struct usb_composite_dev *cdev; 14411a1c851bSPeter Chen struct gadget_info *gi; 14421a1c851bSPeter Chen unsigned long flags; 14431a1c851bSPeter Chen int ret; 14441a1c851bSPeter Chen 14451a1c851bSPeter Chen cdev = get_gadget_data(gadget); 14461a1c851bSPeter Chen if (!cdev) 14471a1c851bSPeter Chen return 0; 14481a1c851bSPeter Chen 14491a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev); 14501a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 14511a1c851bSPeter Chen cdev = get_gadget_data(gadget); 14521a1c851bSPeter Chen if (!cdev || gi->unbind) { 14531a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 14541a1c851bSPeter Chen return 0; 14551a1c851bSPeter Chen } 14561a1c851bSPeter Chen 14571a1c851bSPeter Chen ret = composite_setup(gadget, ctrl); 14581a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 14591a1c851bSPeter Chen return ret; 14601a1c851bSPeter Chen } 14611a1c851bSPeter Chen 14621a1c851bSPeter Chen static void configfs_composite_disconnect(struct usb_gadget *gadget) 14631a1c851bSPeter Chen { 14641a1c851bSPeter Chen struct usb_composite_dev *cdev; 14651a1c851bSPeter Chen struct gadget_info *gi; 14661a1c851bSPeter Chen unsigned long flags; 14671a1c851bSPeter Chen 14681a1c851bSPeter Chen cdev = get_gadget_data(gadget); 14691a1c851bSPeter Chen if (!cdev) 14701a1c851bSPeter Chen return; 14711a1c851bSPeter Chen 14721a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev); 14731a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 14741a1c851bSPeter Chen cdev = get_gadget_data(gadget); 14751a1c851bSPeter Chen if (!cdev || gi->unbind) { 14761a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 14771a1c851bSPeter Chen return; 14781a1c851bSPeter Chen } 14791a1c851bSPeter Chen 14801a1c851bSPeter Chen composite_disconnect(gadget); 14811a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 14821a1c851bSPeter Chen } 14831a1c851bSPeter Chen 1484*4d7aae9fSWesley Cheng static void configfs_composite_reset(struct usb_gadget *gadget) 1485*4d7aae9fSWesley Cheng { 1486*4d7aae9fSWesley Cheng struct usb_composite_dev *cdev; 1487*4d7aae9fSWesley Cheng struct gadget_info *gi; 1488*4d7aae9fSWesley Cheng unsigned long flags; 1489*4d7aae9fSWesley Cheng 1490*4d7aae9fSWesley Cheng cdev = get_gadget_data(gadget); 1491*4d7aae9fSWesley Cheng if (!cdev) 1492*4d7aae9fSWesley Cheng return; 1493*4d7aae9fSWesley Cheng 1494*4d7aae9fSWesley Cheng gi = container_of(cdev, struct gadget_info, cdev); 1495*4d7aae9fSWesley Cheng spin_lock_irqsave(&gi->spinlock, flags); 1496*4d7aae9fSWesley Cheng cdev = get_gadget_data(gadget); 1497*4d7aae9fSWesley Cheng if (!cdev || gi->unbind) { 1498*4d7aae9fSWesley Cheng spin_unlock_irqrestore(&gi->spinlock, flags); 1499*4d7aae9fSWesley Cheng return; 1500*4d7aae9fSWesley Cheng } 1501*4d7aae9fSWesley Cheng 1502*4d7aae9fSWesley Cheng composite_reset(gadget); 1503*4d7aae9fSWesley Cheng spin_unlock_irqrestore(&gi->spinlock, flags); 1504*4d7aae9fSWesley Cheng } 1505*4d7aae9fSWesley Cheng 15061a1c851bSPeter Chen static void configfs_composite_suspend(struct usb_gadget *gadget) 15071a1c851bSPeter Chen { 15081a1c851bSPeter Chen struct usb_composite_dev *cdev; 15091a1c851bSPeter Chen struct gadget_info *gi; 15101a1c851bSPeter Chen unsigned long flags; 15111a1c851bSPeter Chen 15121a1c851bSPeter Chen cdev = get_gadget_data(gadget); 15131a1c851bSPeter Chen if (!cdev) 15141a1c851bSPeter Chen return; 15151a1c851bSPeter Chen 15161a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev); 15171a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 15181a1c851bSPeter Chen cdev = get_gadget_data(gadget); 15191a1c851bSPeter Chen if (!cdev || gi->unbind) { 15201a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 15211a1c851bSPeter Chen return; 15221a1c851bSPeter Chen } 15231a1c851bSPeter Chen 15241a1c851bSPeter Chen composite_suspend(gadget); 15251a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 15261a1c851bSPeter Chen } 15271a1c851bSPeter Chen 15281a1c851bSPeter Chen static void configfs_composite_resume(struct usb_gadget *gadget) 15291a1c851bSPeter Chen { 15301a1c851bSPeter Chen struct usb_composite_dev *cdev; 15311a1c851bSPeter Chen struct gadget_info *gi; 15321a1c851bSPeter Chen unsigned long flags; 15331a1c851bSPeter Chen 15341a1c851bSPeter Chen cdev = get_gadget_data(gadget); 15351a1c851bSPeter Chen if (!cdev) 15361a1c851bSPeter Chen return; 15371a1c851bSPeter Chen 15381a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev); 15391a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags); 15401a1c851bSPeter Chen cdev = get_gadget_data(gadget); 15411a1c851bSPeter Chen if (!cdev || gi->unbind) { 15421a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 15431a1c851bSPeter Chen return; 15441a1c851bSPeter Chen } 15451a1c851bSPeter Chen 15461a1c851bSPeter Chen composite_resume(gadget); 15471a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags); 154888af8bbeSSebastian Andrzej Siewior } 154988af8bbeSSebastian Andrzej Siewior 155088af8bbeSSebastian Andrzej Siewior static const struct usb_gadget_driver configfs_driver_template = { 155188af8bbeSSebastian Andrzej Siewior .bind = configfs_composite_bind, 155288af8bbeSSebastian Andrzej Siewior .unbind = configfs_composite_unbind, 155388af8bbeSSebastian Andrzej Siewior 15541a1c851bSPeter Chen .setup = configfs_composite_setup, 1555*4d7aae9fSWesley Cheng .reset = configfs_composite_reset, 15561a1c851bSPeter Chen .disconnect = configfs_composite_disconnect, 155788af8bbeSSebastian Andrzej Siewior 15581a1c851bSPeter Chen .suspend = configfs_composite_suspend, 15591a1c851bSPeter Chen .resume = configfs_composite_resume, 15603a571870SAndrzej Pietrasiewicz 156188af8bbeSSebastian Andrzej Siewior .max_speed = USB_SPEED_SUPER, 156288af8bbeSSebastian Andrzej Siewior .driver = { 156388af8bbeSSebastian Andrzej Siewior .owner = THIS_MODULE, 156488af8bbeSSebastian Andrzej Siewior .name = "configfs-gadget", 156588af8bbeSSebastian Andrzej Siewior }, 1566f1bddbb3SKrzysztof Opasiak .match_existing_only = 1, 156788af8bbeSSebastian Andrzej Siewior }; 156888af8bbeSSebastian Andrzej Siewior 156988af8bbeSSebastian Andrzej Siewior static struct config_group *gadgets_make( 157088af8bbeSSebastian Andrzej Siewior struct config_group *group, 157188af8bbeSSebastian Andrzej Siewior const char *name) 157288af8bbeSSebastian Andrzej Siewior { 157388af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 157488af8bbeSSebastian Andrzej Siewior 157588af8bbeSSebastian Andrzej Siewior gi = kzalloc(sizeof(*gi), GFP_KERNEL); 157688af8bbeSSebastian Andrzej Siewior if (!gi) 157788af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM); 157888af8bbeSSebastian Andrzej Siewior 15791ae1602dSChristoph Hellwig config_group_init_type_name(&gi->group, name, &gadget_root_type); 158088af8bbeSSebastian Andrzej Siewior 158188af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->functions_group, "functions", 158288af8bbeSSebastian Andrzej Siewior &functions_type); 15831ae1602dSChristoph Hellwig configfs_add_default_group(&gi->functions_group, &gi->group); 15841ae1602dSChristoph Hellwig 158588af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->configs_group, "configs", 158688af8bbeSSebastian Andrzej Siewior &config_desc_type); 15871ae1602dSChristoph Hellwig configfs_add_default_group(&gi->configs_group, &gi->group); 15881ae1602dSChristoph Hellwig 158988af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->strings_group, "strings", 159088af8bbeSSebastian Andrzej Siewior &gadget_strings_strings_type); 15911ae1602dSChristoph Hellwig configfs_add_default_group(&gi->strings_group, &gi->group); 15921ae1602dSChristoph Hellwig 159387213d38SAndrzej Pietrasiewicz config_group_init_type_name(&gi->os_desc_group, "os_desc", 159487213d38SAndrzej Pietrasiewicz &os_desc_type); 15951ae1602dSChristoph Hellwig configfs_add_default_group(&gi->os_desc_group, &gi->group); 159688af8bbeSSebastian Andrzej Siewior 159788af8bbeSSebastian Andrzej Siewior gi->composite.bind = configfs_do_nothing; 159888af8bbeSSebastian Andrzej Siewior gi->composite.unbind = configfs_do_nothing; 159988af8bbeSSebastian Andrzej Siewior gi->composite.suspend = NULL; 160088af8bbeSSebastian Andrzej Siewior gi->composite.resume = NULL; 160188af8bbeSSebastian Andrzej Siewior gi->composite.max_speed = USB_SPEED_SUPER; 160288af8bbeSSebastian Andrzej Siewior 1603093edc2bSWei Yongjun spin_lock_init(&gi->spinlock); 160488af8bbeSSebastian Andrzej Siewior mutex_init(&gi->lock); 160588af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&gi->string_list); 160688af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&gi->available_func); 160788af8bbeSSebastian Andrzej Siewior 160888af8bbeSSebastian Andrzej Siewior composite_init_dev(&gi->cdev); 160988af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bLength = USB_DT_DEVICE_SIZE; 161088af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bDescriptorType = USB_DT_DEVICE; 161188af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bcdDevice = cpu_to_le16(get_default_bcdDevice()); 161288af8bbeSSebastian Andrzej Siewior 161388af8bbeSSebastian Andrzej Siewior gi->composite.gadget_driver = configfs_driver_template; 161488af8bbeSSebastian Andrzej Siewior 161588af8bbeSSebastian Andrzej Siewior gi->composite.gadget_driver.function = kstrdup(name, GFP_KERNEL); 161688af8bbeSSebastian Andrzej Siewior gi->composite.name = gi->composite.gadget_driver.function; 161788af8bbeSSebastian Andrzej Siewior 161888af8bbeSSebastian Andrzej Siewior if (!gi->composite.gadget_driver.function) 161988af8bbeSSebastian Andrzej Siewior goto err; 162088af8bbeSSebastian Andrzej Siewior 162188af8bbeSSebastian Andrzej Siewior return &gi->group; 162288af8bbeSSebastian Andrzej Siewior err: 162388af8bbeSSebastian Andrzej Siewior kfree(gi); 162488af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM); 162588af8bbeSSebastian Andrzej Siewior } 162688af8bbeSSebastian Andrzej Siewior 162788af8bbeSSebastian Andrzej Siewior static void gadgets_drop(struct config_group *group, struct config_item *item) 162888af8bbeSSebastian Andrzej Siewior { 162988af8bbeSSebastian Andrzej Siewior config_item_put(item); 163088af8bbeSSebastian Andrzej Siewior } 163188af8bbeSSebastian Andrzej Siewior 163288af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations gadgets_ops = { 163388af8bbeSSebastian Andrzej Siewior .make_group = &gadgets_make, 163488af8bbeSSebastian Andrzej Siewior .drop_item = &gadgets_drop, 163588af8bbeSSebastian Andrzej Siewior }; 163688af8bbeSSebastian Andrzej Siewior 16374ad01412SBhumika Goyal static const struct config_item_type gadgets_type = { 163888af8bbeSSebastian Andrzej Siewior .ct_group_ops = &gadgets_ops, 163988af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 164088af8bbeSSebastian Andrzej Siewior }; 164188af8bbeSSebastian Andrzej Siewior 164288af8bbeSSebastian Andrzej Siewior static struct configfs_subsystem gadget_subsys = { 164388af8bbeSSebastian Andrzej Siewior .su_group = { 164488af8bbeSSebastian Andrzej Siewior .cg_item = { 164588af8bbeSSebastian Andrzej Siewior .ci_namebuf = "usb_gadget", 164688af8bbeSSebastian Andrzej Siewior .ci_type = &gadgets_type, 164788af8bbeSSebastian Andrzej Siewior }, 164888af8bbeSSebastian Andrzej Siewior }, 164988af8bbeSSebastian Andrzej Siewior .su_mutex = __MUTEX_INITIALIZER(gadget_subsys.su_mutex), 165088af8bbeSSebastian Andrzej Siewior }; 165188af8bbeSSebastian Andrzej Siewior 1652092a4bd0SAndrzej Pietrasiewicz void unregister_gadget_item(struct config_item *item) 1653092a4bd0SAndrzej Pietrasiewicz { 1654092a4bd0SAndrzej Pietrasiewicz struct gadget_info *gi = to_gadget_info(item); 1655092a4bd0SAndrzej Pietrasiewicz 1656cee51c33SWinter Wang mutex_lock(&gi->lock); 1657092a4bd0SAndrzej Pietrasiewicz unregister_gadget(gi); 1658cee51c33SWinter Wang mutex_unlock(&gi->lock); 1659092a4bd0SAndrzej Pietrasiewicz } 16600700faafSFelipe Balbi EXPORT_SYMBOL_GPL(unregister_gadget_item); 1661092a4bd0SAndrzej Pietrasiewicz 166288af8bbeSSebastian Andrzej Siewior static int __init gadget_cfs_init(void) 166388af8bbeSSebastian Andrzej Siewior { 166488af8bbeSSebastian Andrzej Siewior int ret; 166588af8bbeSSebastian Andrzej Siewior 166688af8bbeSSebastian Andrzej Siewior config_group_init(&gadget_subsys.su_group); 166788af8bbeSSebastian Andrzej Siewior 166888af8bbeSSebastian Andrzej Siewior ret = configfs_register_subsystem(&gadget_subsys); 166988af8bbeSSebastian Andrzej Siewior return ret; 167088af8bbeSSebastian Andrzej Siewior } 167188af8bbeSSebastian Andrzej Siewior module_init(gadget_cfs_init); 167288af8bbeSSebastian Andrzej Siewior 167388af8bbeSSebastian Andrzej Siewior static void __exit gadget_cfs_exit(void) 167488af8bbeSSebastian Andrzej Siewior { 167588af8bbeSSebastian Andrzej Siewior configfs_unregister_subsystem(&gadget_subsys); 167688af8bbeSSebastian Andrzej Siewior } 167788af8bbeSSebastian Andrzej Siewior module_exit(gadget_cfs_exit); 1678