188af8bbeSSebastian Andrzej Siewior #include <linux/configfs.h> 288af8bbeSSebastian Andrzej Siewior #include <linux/module.h> 388af8bbeSSebastian Andrzej Siewior #include <linux/slab.h> 488af8bbeSSebastian Andrzej Siewior #include <linux/device.h> 587213d38SAndrzej Pietrasiewicz #include <linux/nls.h> 688af8bbeSSebastian Andrzej Siewior #include <linux/usb/composite.h> 788af8bbeSSebastian Andrzej Siewior #include <linux/usb/gadget_configfs.h> 80009e99aSRashika Kheria #include "configfs.h" 9da424314SAndrzej Pietrasiewicz #include "u_f.h" 107419485fSAndrzej Pietrasiewicz #include "u_os_desc.h" 1188af8bbeSSebastian Andrzej Siewior 1288af8bbeSSebastian Andrzej Siewior int check_user_usb_string(const char *name, 1388af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *stringtab_dev) 1488af8bbeSSebastian Andrzej Siewior { 1588af8bbeSSebastian Andrzej Siewior unsigned primary_lang; 1688af8bbeSSebastian Andrzej Siewior unsigned sub_lang; 1788af8bbeSSebastian Andrzej Siewior u16 num; 1888af8bbeSSebastian Andrzej Siewior int ret; 1988af8bbeSSebastian Andrzej Siewior 2088af8bbeSSebastian Andrzej Siewior ret = kstrtou16(name, 0, &num); 2188af8bbeSSebastian Andrzej Siewior if (ret) 2288af8bbeSSebastian Andrzej Siewior return ret; 2388af8bbeSSebastian Andrzej Siewior 2488af8bbeSSebastian Andrzej Siewior primary_lang = num & 0x3ff; 2588af8bbeSSebastian Andrzej Siewior sub_lang = num >> 10; 2688af8bbeSSebastian Andrzej Siewior 2788af8bbeSSebastian Andrzej Siewior /* simple sanity check for valid langid */ 2888af8bbeSSebastian Andrzej Siewior switch (primary_lang) { 2988af8bbeSSebastian Andrzej Siewior case 0: 3088af8bbeSSebastian Andrzej Siewior case 0x62 ... 0xfe: 3188af8bbeSSebastian Andrzej Siewior case 0x100 ... 0x3ff: 3288af8bbeSSebastian Andrzej Siewior return -EINVAL; 3388af8bbeSSebastian Andrzej Siewior } 3488af8bbeSSebastian Andrzej Siewior if (!sub_lang) 3588af8bbeSSebastian Andrzej Siewior return -EINVAL; 3688af8bbeSSebastian Andrzej Siewior 3788af8bbeSSebastian Andrzej Siewior stringtab_dev->language = num; 3888af8bbeSSebastian Andrzej Siewior return 0; 3988af8bbeSSebastian Andrzej Siewior } 4088af8bbeSSebastian Andrzej Siewior 4188af8bbeSSebastian Andrzej Siewior #define MAX_NAME_LEN 40 4288af8bbeSSebastian Andrzej Siewior #define MAX_USB_STRING_LANGS 2 4388af8bbeSSebastian Andrzej Siewior 4441ce84c8SLi Jun static const struct usb_descriptor_header *otg_desc[2]; 4541ce84c8SLi Jun 4688af8bbeSSebastian Andrzej Siewior struct gadget_info { 4788af8bbeSSebastian Andrzej Siewior struct config_group group; 4888af8bbeSSebastian Andrzej Siewior struct config_group functions_group; 4988af8bbeSSebastian Andrzej Siewior struct config_group configs_group; 5088af8bbeSSebastian Andrzej Siewior struct config_group strings_group; 5187213d38SAndrzej Pietrasiewicz struct config_group os_desc_group; 5288af8bbeSSebastian Andrzej Siewior 5388af8bbeSSebastian Andrzej Siewior struct mutex lock; 5488af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *gstrings[MAX_USB_STRING_LANGS + 1]; 5588af8bbeSSebastian Andrzej Siewior struct list_head string_list; 5688af8bbeSSebastian Andrzej Siewior struct list_head available_func; 5788af8bbeSSebastian Andrzej Siewior 5888af8bbeSSebastian Andrzej Siewior struct usb_composite_driver composite; 5988af8bbeSSebastian Andrzej Siewior struct usb_composite_dev cdev; 6087213d38SAndrzej Pietrasiewicz bool use_os_desc; 6187213d38SAndrzej Pietrasiewicz char b_vendor_code; 6287213d38SAndrzej Pietrasiewicz char qw_sign[OS_STRING_QW_SIGN_LEN]; 6388af8bbeSSebastian Andrzej Siewior }; 6488af8bbeSSebastian Andrzej Siewior 6545b6a73fSChristoph Hellwig static inline struct gadget_info *to_gadget_info(struct config_item *item) 6645b6a73fSChristoph Hellwig { 6745b6a73fSChristoph Hellwig return container_of(to_config_group(item), struct gadget_info, group); 6845b6a73fSChristoph Hellwig } 6945b6a73fSChristoph Hellwig 7088af8bbeSSebastian Andrzej Siewior struct config_usb_cfg { 7188af8bbeSSebastian Andrzej Siewior struct config_group group; 7288af8bbeSSebastian Andrzej Siewior struct config_group strings_group; 7388af8bbeSSebastian Andrzej Siewior struct list_head string_list; 7488af8bbeSSebastian Andrzej Siewior struct usb_configuration c; 7588af8bbeSSebastian Andrzej Siewior struct list_head func_list; 7688af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *gstrings[MAX_USB_STRING_LANGS + 1]; 7788af8bbeSSebastian Andrzej Siewior }; 7888af8bbeSSebastian Andrzej Siewior 7945b6a73fSChristoph Hellwig static inline struct config_usb_cfg *to_config_usb_cfg(struct config_item *item) 8045b6a73fSChristoph Hellwig { 8145b6a73fSChristoph Hellwig return container_of(to_config_group(item), struct config_usb_cfg, 8245b6a73fSChristoph Hellwig group); 8345b6a73fSChristoph Hellwig } 8445b6a73fSChristoph Hellwig 8588af8bbeSSebastian Andrzej Siewior struct gadget_strings { 8688af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings stringtab_dev; 8788af8bbeSSebastian Andrzej Siewior struct usb_string strings[USB_GADGET_FIRST_AVAIL_IDX]; 8888af8bbeSSebastian Andrzej Siewior char *manufacturer; 8988af8bbeSSebastian Andrzej Siewior char *product; 9088af8bbeSSebastian Andrzej Siewior char *serialnumber; 9188af8bbeSSebastian Andrzej Siewior 9288af8bbeSSebastian Andrzej Siewior struct config_group group; 9388af8bbeSSebastian Andrzej Siewior struct list_head list; 9488af8bbeSSebastian Andrzej Siewior }; 9588af8bbeSSebastian Andrzej Siewior 9687213d38SAndrzej Pietrasiewicz struct os_desc { 9787213d38SAndrzej Pietrasiewicz struct config_group group; 9887213d38SAndrzej Pietrasiewicz }; 9987213d38SAndrzej Pietrasiewicz 10088af8bbeSSebastian Andrzej Siewior struct gadget_config_name { 10188af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings stringtab_dev; 10288af8bbeSSebastian Andrzej Siewior struct usb_string strings; 10388af8bbeSSebastian Andrzej Siewior char *configuration; 10488af8bbeSSebastian Andrzej Siewior 10588af8bbeSSebastian Andrzej Siewior struct config_group group; 10688af8bbeSSebastian Andrzej Siewior struct list_head list; 10788af8bbeSSebastian Andrzej Siewior }; 10888af8bbeSSebastian Andrzej Siewior 10988af8bbeSSebastian Andrzej Siewior static int usb_string_copy(const char *s, char **s_copy) 11088af8bbeSSebastian Andrzej Siewior { 11188af8bbeSSebastian Andrzej Siewior int ret; 11288af8bbeSSebastian Andrzej Siewior char *str; 11388af8bbeSSebastian Andrzej Siewior char *copy = *s_copy; 11488af8bbeSSebastian Andrzej Siewior ret = strlen(s); 11588af8bbeSSebastian Andrzej Siewior if (ret > 126) 11688af8bbeSSebastian Andrzej Siewior return -EOVERFLOW; 11788af8bbeSSebastian Andrzej Siewior 11888af8bbeSSebastian Andrzej Siewior str = kstrdup(s, GFP_KERNEL); 11988af8bbeSSebastian Andrzej Siewior if (!str) 12088af8bbeSSebastian Andrzej Siewior return -ENOMEM; 12188af8bbeSSebastian Andrzej Siewior if (str[ret - 1] == '\n') 12288af8bbeSSebastian Andrzej Siewior str[ret - 1] = '\0'; 12388af8bbeSSebastian Andrzej Siewior kfree(copy); 12488af8bbeSSebastian Andrzej Siewior *s_copy = str; 12588af8bbeSSebastian Andrzej Siewior return 0; 12688af8bbeSSebastian Andrzej Siewior } 12788af8bbeSSebastian Andrzej Siewior 12888af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_R_u8(__name) \ 12945b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##__name##_show(struct config_item *item, \ 13088af8bbeSSebastian Andrzej Siewior char *page) \ 13188af8bbeSSebastian Andrzej Siewior { \ 13245b6a73fSChristoph Hellwig return sprintf(page, "0x%02x\n", \ 13345b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.__name); \ 13488af8bbeSSebastian Andrzej Siewior } 13588af8bbeSSebastian Andrzej Siewior 13688af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_R_u16(__name) \ 13745b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##__name##_show(struct config_item *item, \ 13888af8bbeSSebastian Andrzej Siewior char *page) \ 13988af8bbeSSebastian Andrzej Siewior { \ 14045b6a73fSChristoph Hellwig return sprintf(page, "0x%04x\n", \ 14145b6a73fSChristoph Hellwig le16_to_cpup(&to_gadget_info(item)->cdev.desc.__name)); \ 14288af8bbeSSebastian Andrzej Siewior } 14388af8bbeSSebastian Andrzej Siewior 14488af8bbeSSebastian Andrzej Siewior 14588af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_W_u8(_name) \ 14645b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##_name##_store(struct config_item *item, \ 14788af8bbeSSebastian Andrzej Siewior const char *page, size_t len) \ 14888af8bbeSSebastian Andrzej Siewior { \ 14988af8bbeSSebastian Andrzej Siewior u8 val; \ 15088af8bbeSSebastian Andrzej Siewior int ret; \ 15188af8bbeSSebastian Andrzej Siewior ret = kstrtou8(page, 0, &val); \ 15288af8bbeSSebastian Andrzej Siewior if (ret) \ 15388af8bbeSSebastian Andrzej Siewior return ret; \ 15445b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc._name = val; \ 15588af8bbeSSebastian Andrzej Siewior return len; \ 15688af8bbeSSebastian Andrzej Siewior } 15788af8bbeSSebastian Andrzej Siewior 15888af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_W_u16(_name) \ 15945b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##_name##_store(struct config_item *item, \ 16088af8bbeSSebastian Andrzej Siewior const char *page, size_t len) \ 16188af8bbeSSebastian Andrzej Siewior { \ 16288af8bbeSSebastian Andrzej Siewior u16 val; \ 16388af8bbeSSebastian Andrzej Siewior int ret; \ 16488af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &val); \ 16588af8bbeSSebastian Andrzej Siewior if (ret) \ 16688af8bbeSSebastian Andrzej Siewior return ret; \ 16745b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc._name = cpu_to_le16p(&val); \ 16888af8bbeSSebastian Andrzej Siewior return len; \ 16988af8bbeSSebastian Andrzej Siewior } 17088af8bbeSSebastian Andrzej Siewior 17188af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_RW(_name, _type) \ 17288af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_##_type(_name) \ 17388af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_W_##_type(_name) 17488af8bbeSSebastian Andrzej Siewior 17588af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_u16(bcdUSB); 17688af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceClass, u8); 17788af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceSubClass, u8); 17888af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceProtocol, u8); 17988af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bMaxPacketSize0, u8); 18088af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(idVendor, u16); 18188af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(idProduct, u16); 18288af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_u16(bcdDevice); 18388af8bbeSSebastian Andrzej Siewior 18488af8bbeSSebastian Andrzej Siewior static ssize_t is_valid_bcd(u16 bcd_val) 18588af8bbeSSebastian Andrzej Siewior { 18688af8bbeSSebastian Andrzej Siewior if ((bcd_val & 0xf) > 9) 18788af8bbeSSebastian Andrzej Siewior return -EINVAL; 18888af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 4) & 0xf) > 9) 18988af8bbeSSebastian Andrzej Siewior return -EINVAL; 19088af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 8) & 0xf) > 9) 19188af8bbeSSebastian Andrzej Siewior return -EINVAL; 19288af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 12) & 0xf) > 9) 19388af8bbeSSebastian Andrzej Siewior return -EINVAL; 19488af8bbeSSebastian Andrzej Siewior return 0; 19588af8bbeSSebastian Andrzej Siewior } 19688af8bbeSSebastian Andrzej Siewior 19745b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_bcdDevice_store(struct config_item *item, 19888af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 19988af8bbeSSebastian Andrzej Siewior { 20088af8bbeSSebastian Andrzej Siewior u16 bcdDevice; 20188af8bbeSSebastian Andrzej Siewior int ret; 20288af8bbeSSebastian Andrzej Siewior 20388af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &bcdDevice); 20488af8bbeSSebastian Andrzej Siewior if (ret) 20588af8bbeSSebastian Andrzej Siewior return ret; 20688af8bbeSSebastian Andrzej Siewior ret = is_valid_bcd(bcdDevice); 20788af8bbeSSebastian Andrzej Siewior if (ret) 20888af8bbeSSebastian Andrzej Siewior return ret; 20988af8bbeSSebastian Andrzej Siewior 21045b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.bcdDevice = cpu_to_le16(bcdDevice); 21188af8bbeSSebastian Andrzej Siewior return len; 21288af8bbeSSebastian Andrzej Siewior } 21388af8bbeSSebastian Andrzej Siewior 21445b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_bcdUSB_store(struct config_item *item, 21588af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 21688af8bbeSSebastian Andrzej Siewior { 21788af8bbeSSebastian Andrzej Siewior u16 bcdUSB; 21888af8bbeSSebastian Andrzej Siewior int ret; 21988af8bbeSSebastian Andrzej Siewior 22088af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &bcdUSB); 22188af8bbeSSebastian Andrzej Siewior if (ret) 22288af8bbeSSebastian Andrzej Siewior return ret; 22388af8bbeSSebastian Andrzej Siewior ret = is_valid_bcd(bcdUSB); 22488af8bbeSSebastian Andrzej Siewior if (ret) 22588af8bbeSSebastian Andrzej Siewior return ret; 22688af8bbeSSebastian Andrzej Siewior 22745b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.bcdUSB = cpu_to_le16(bcdUSB); 22888af8bbeSSebastian Andrzej Siewior return len; 22988af8bbeSSebastian Andrzej Siewior } 23088af8bbeSSebastian Andrzej Siewior 23145b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_UDC_show(struct config_item *item, char *page) 23288af8bbeSSebastian Andrzej Siewior { 233afdaadc3SRuslan Bilovol char *udc_name = to_gadget_info(item)->composite.gadget_driver.udc_name; 234afdaadc3SRuslan Bilovol 235afdaadc3SRuslan Bilovol return sprintf(page, "%s\n", udc_name ?: ""); 23688af8bbeSSebastian Andrzej Siewior } 23788af8bbeSSebastian Andrzej Siewior 23888af8bbeSSebastian Andrzej Siewior static int unregister_gadget(struct gadget_info *gi) 23988af8bbeSSebastian Andrzej Siewior { 24088af8bbeSSebastian Andrzej Siewior int ret; 24188af8bbeSSebastian Andrzej Siewior 242afdaadc3SRuslan Bilovol if (!gi->composite.gadget_driver.udc_name) 24388af8bbeSSebastian Andrzej Siewior return -ENODEV; 24488af8bbeSSebastian Andrzej Siewior 24588af8bbeSSebastian Andrzej Siewior ret = usb_gadget_unregister_driver(&gi->composite.gadget_driver); 24688af8bbeSSebastian Andrzej Siewior if (ret) 24788af8bbeSSebastian Andrzej Siewior return ret; 248afdaadc3SRuslan Bilovol kfree(gi->composite.gadget_driver.udc_name); 249afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = NULL; 25088af8bbeSSebastian Andrzej Siewior return 0; 25188af8bbeSSebastian Andrzej Siewior } 25288af8bbeSSebastian Andrzej Siewior 25345b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_UDC_store(struct config_item *item, 25488af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 25588af8bbeSSebastian Andrzej Siewior { 25645b6a73fSChristoph Hellwig struct gadget_info *gi = to_gadget_info(item); 25788af8bbeSSebastian Andrzej Siewior char *name; 25888af8bbeSSebastian Andrzej Siewior int ret; 25988af8bbeSSebastian Andrzej Siewior 26088af8bbeSSebastian Andrzej Siewior name = kstrdup(page, GFP_KERNEL); 26188af8bbeSSebastian Andrzej Siewior if (!name) 26288af8bbeSSebastian Andrzej Siewior return -ENOMEM; 26388af8bbeSSebastian Andrzej Siewior if (name[len - 1] == '\n') 26488af8bbeSSebastian Andrzej Siewior name[len - 1] = '\0'; 26588af8bbeSSebastian Andrzej Siewior 26688af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 26788af8bbeSSebastian Andrzej Siewior 26888af8bbeSSebastian Andrzej Siewior if (!strlen(name)) { 26988af8bbeSSebastian Andrzej Siewior ret = unregister_gadget(gi); 27088af8bbeSSebastian Andrzej Siewior if (ret) 27188af8bbeSSebastian Andrzej Siewior goto err; 27288af8bbeSSebastian Andrzej Siewior } else { 273afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name) { 27488af8bbeSSebastian Andrzej Siewior ret = -EBUSY; 27588af8bbeSSebastian Andrzej Siewior goto err; 27688af8bbeSSebastian Andrzej Siewior } 277afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = name; 278afdaadc3SRuslan Bilovol ret = usb_gadget_probe_driver(&gi->composite.gadget_driver); 279afdaadc3SRuslan Bilovol if (ret) { 280afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = NULL; 28188af8bbeSSebastian Andrzej Siewior goto err; 282afdaadc3SRuslan Bilovol } 28388af8bbeSSebastian Andrzej Siewior } 28488af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 28588af8bbeSSebastian Andrzej Siewior return len; 28688af8bbeSSebastian Andrzej Siewior err: 28788af8bbeSSebastian Andrzej Siewior kfree(name); 28888af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 28988af8bbeSSebastian Andrzej Siewior return ret; 29088af8bbeSSebastian Andrzej Siewior } 29188af8bbeSSebastian Andrzej Siewior 29245b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceClass); 29345b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceSubClass); 29445b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceProtocol); 29545b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bMaxPacketSize0); 29645b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, idVendor); 29745b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, idProduct); 29845b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bcdDevice); 29945b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bcdUSB); 30045b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, UDC); 30188af8bbeSSebastian Andrzej Siewior 30288af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_root_attrs[] = { 30345b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceClass, 30445b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceSubClass, 30545b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceProtocol, 30645b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bMaxPacketSize0, 30745b6a73fSChristoph Hellwig &gadget_dev_desc_attr_idVendor, 30845b6a73fSChristoph Hellwig &gadget_dev_desc_attr_idProduct, 30945b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bcdDevice, 31045b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bcdUSB, 31145b6a73fSChristoph Hellwig &gadget_dev_desc_attr_UDC, 31288af8bbeSSebastian Andrzej Siewior NULL, 31388af8bbeSSebastian Andrzej Siewior }; 31488af8bbeSSebastian Andrzej Siewior 31588af8bbeSSebastian Andrzej Siewior static inline struct gadget_strings *to_gadget_strings(struct config_item *item) 31688af8bbeSSebastian Andrzej Siewior { 31788af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item), struct gadget_strings, 31888af8bbeSSebastian Andrzej Siewior group); 31988af8bbeSSebastian Andrzej Siewior } 32088af8bbeSSebastian Andrzej Siewior 32188af8bbeSSebastian Andrzej Siewior static inline struct gadget_config_name *to_gadget_config_name( 32288af8bbeSSebastian Andrzej Siewior struct config_item *item) 32388af8bbeSSebastian Andrzej Siewior { 32488af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item), struct gadget_config_name, 32588af8bbeSSebastian Andrzej Siewior group); 32688af8bbeSSebastian Andrzej Siewior } 32788af8bbeSSebastian Andrzej Siewior 32888af8bbeSSebastian Andrzej Siewior static inline struct usb_function_instance *to_usb_function_instance( 32988af8bbeSSebastian Andrzej Siewior struct config_item *item) 33088af8bbeSSebastian Andrzej Siewior { 33188af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item), 33288af8bbeSSebastian Andrzej Siewior struct usb_function_instance, group); 33388af8bbeSSebastian Andrzej Siewior } 33488af8bbeSSebastian Andrzej Siewior 33588af8bbeSSebastian Andrzej Siewior static void gadget_info_attr_release(struct config_item *item) 33688af8bbeSSebastian Andrzej Siewior { 33788af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = to_gadget_info(item); 33888af8bbeSSebastian Andrzej Siewior 33988af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->cdev.configs)); 34088af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->string_list)); 34188af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->available_func)); 34288af8bbeSSebastian Andrzej Siewior kfree(gi->composite.gadget_driver.function); 34388af8bbeSSebastian Andrzej Siewior kfree(gi); 34488af8bbeSSebastian Andrzej Siewior } 34588af8bbeSSebastian Andrzej Siewior 34688af8bbeSSebastian Andrzej Siewior static struct configfs_item_operations gadget_root_item_ops = { 34788af8bbeSSebastian Andrzej Siewior .release = gadget_info_attr_release, 34888af8bbeSSebastian Andrzej Siewior }; 34988af8bbeSSebastian Andrzej Siewior 35088af8bbeSSebastian Andrzej Siewior static void gadget_config_attr_release(struct config_item *item) 35188af8bbeSSebastian Andrzej Siewior { 35288af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(item); 35388af8bbeSSebastian Andrzej Siewior 35488af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&cfg->c.functions)); 35588af8bbeSSebastian Andrzej Siewior list_del(&cfg->c.list); 35688af8bbeSSebastian Andrzej Siewior kfree(cfg->c.label); 35788af8bbeSSebastian Andrzej Siewior kfree(cfg); 35888af8bbeSSebastian Andrzej Siewior } 35988af8bbeSSebastian Andrzej Siewior 36088af8bbeSSebastian Andrzej Siewior static int config_usb_cfg_link( 36188af8bbeSSebastian Andrzej Siewior struct config_item *usb_cfg_ci, 36288af8bbeSSebastian Andrzej Siewior struct config_item *usb_func_ci) 36388af8bbeSSebastian Andrzej Siewior { 36488af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(usb_cfg_ci); 36588af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev = cfg->c.cdev; 36688af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = container_of(cdev, struct gadget_info, cdev); 36788af8bbeSSebastian Andrzej Siewior 36888af8bbeSSebastian Andrzej Siewior struct config_group *group = to_config_group(usb_func_ci); 36988af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi = container_of(group, 37088af8bbeSSebastian Andrzej Siewior struct usb_function_instance, group); 37188af8bbeSSebastian Andrzej Siewior struct usb_function_instance *a_fi; 37288af8bbeSSebastian Andrzej Siewior struct usb_function *f; 37388af8bbeSSebastian Andrzej Siewior int ret; 37488af8bbeSSebastian Andrzej Siewior 37588af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 37688af8bbeSSebastian Andrzej Siewior /* 37788af8bbeSSebastian Andrzej Siewior * Make sure this function is from within our _this_ gadget and not 37888af8bbeSSebastian Andrzej Siewior * from another gadget or a random directory. 37988af8bbeSSebastian Andrzej Siewior * Also a function instance can only be linked once. 38088af8bbeSSebastian Andrzej Siewior */ 38188af8bbeSSebastian Andrzej Siewior list_for_each_entry(a_fi, &gi->available_func, cfs_list) { 38288af8bbeSSebastian Andrzej Siewior if (a_fi == fi) 38388af8bbeSSebastian Andrzej Siewior break; 38488af8bbeSSebastian Andrzej Siewior } 38588af8bbeSSebastian Andrzej Siewior if (a_fi != fi) { 38688af8bbeSSebastian Andrzej Siewior ret = -EINVAL; 38788af8bbeSSebastian Andrzej Siewior goto out; 38888af8bbeSSebastian Andrzej Siewior } 38988af8bbeSSebastian Andrzej Siewior 39088af8bbeSSebastian Andrzej Siewior list_for_each_entry(f, &cfg->func_list, list) { 39188af8bbeSSebastian Andrzej Siewior if (f->fi == fi) { 39288af8bbeSSebastian Andrzej Siewior ret = -EEXIST; 39388af8bbeSSebastian Andrzej Siewior goto out; 39488af8bbeSSebastian Andrzej Siewior } 39588af8bbeSSebastian Andrzej Siewior } 39688af8bbeSSebastian Andrzej Siewior 39788af8bbeSSebastian Andrzej Siewior f = usb_get_function(fi); 39888af8bbeSSebastian Andrzej Siewior if (IS_ERR(f)) { 39988af8bbeSSebastian Andrzej Siewior ret = PTR_ERR(f); 40088af8bbeSSebastian Andrzej Siewior goto out; 40188af8bbeSSebastian Andrzej Siewior } 40288af8bbeSSebastian Andrzej Siewior 40388af8bbeSSebastian Andrzej Siewior /* stash the function until we bind it to the gadget */ 40488af8bbeSSebastian Andrzej Siewior list_add_tail(&f->list, &cfg->func_list); 40588af8bbeSSebastian Andrzej Siewior ret = 0; 40688af8bbeSSebastian Andrzej Siewior out: 40788af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 40888af8bbeSSebastian Andrzej Siewior return ret; 40988af8bbeSSebastian Andrzej Siewior } 41088af8bbeSSebastian Andrzej Siewior 411*e16769d4SAndrzej Pietrasiewicz static void config_usb_cfg_unlink( 41288af8bbeSSebastian Andrzej Siewior struct config_item *usb_cfg_ci, 41388af8bbeSSebastian Andrzej Siewior struct config_item *usb_func_ci) 41488af8bbeSSebastian Andrzej Siewior { 41588af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(usb_cfg_ci); 41688af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev = cfg->c.cdev; 41788af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = container_of(cdev, struct gadget_info, cdev); 41888af8bbeSSebastian Andrzej Siewior 41988af8bbeSSebastian Andrzej Siewior struct config_group *group = to_config_group(usb_func_ci); 42088af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi = container_of(group, 42188af8bbeSSebastian Andrzej Siewior struct usb_function_instance, group); 42288af8bbeSSebastian Andrzej Siewior struct usb_function *f; 42388af8bbeSSebastian Andrzej Siewior 42488af8bbeSSebastian Andrzej Siewior /* 42588af8bbeSSebastian Andrzej Siewior * ideally I would like to forbid to unlink functions while a gadget is 42688af8bbeSSebastian Andrzej Siewior * bound to an UDC. Since this isn't possible at the moment, we simply 42788af8bbeSSebastian Andrzej Siewior * force an unbind, the function is available here and then we can 42888af8bbeSSebastian Andrzej Siewior * remove the function. 42988af8bbeSSebastian Andrzej Siewior */ 43088af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 431afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name) 43288af8bbeSSebastian Andrzej Siewior unregister_gadget(gi); 433afdaadc3SRuslan Bilovol WARN_ON(gi->composite.gadget_driver.udc_name); 43488af8bbeSSebastian Andrzej Siewior 43588af8bbeSSebastian Andrzej Siewior list_for_each_entry(f, &cfg->func_list, list) { 43688af8bbeSSebastian Andrzej Siewior if (f->fi == fi) { 43788af8bbeSSebastian Andrzej Siewior list_del(&f->list); 43888af8bbeSSebastian Andrzej Siewior usb_put_function(f); 43988af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 440*e16769d4SAndrzej Pietrasiewicz return; 44188af8bbeSSebastian Andrzej Siewior } 44288af8bbeSSebastian Andrzej Siewior } 44388af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 44475bfe23aSDavid Rientjes WARN(1, "Unable to locate function to unbind\n"); 44588af8bbeSSebastian Andrzej Siewior } 44688af8bbeSSebastian Andrzej Siewior 44788af8bbeSSebastian Andrzej Siewior static struct configfs_item_operations gadget_config_item_ops = { 44888af8bbeSSebastian Andrzej Siewior .release = gadget_config_attr_release, 44988af8bbeSSebastian Andrzej Siewior .allow_link = config_usb_cfg_link, 45088af8bbeSSebastian Andrzej Siewior .drop_link = config_usb_cfg_unlink, 45188af8bbeSSebastian Andrzej Siewior }; 45288af8bbeSSebastian Andrzej Siewior 45388af8bbeSSebastian Andrzej Siewior 45445b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_MaxPower_show(struct config_item *item, 45588af8bbeSSebastian Andrzej Siewior char *page) 45688af8bbeSSebastian Andrzej Siewior { 45745b6a73fSChristoph Hellwig return sprintf(page, "%u\n", to_config_usb_cfg(item)->c.MaxPower); 45888af8bbeSSebastian Andrzej Siewior } 45988af8bbeSSebastian Andrzej Siewior 46045b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_MaxPower_store(struct config_item *item, 46188af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 46288af8bbeSSebastian Andrzej Siewior { 46388af8bbeSSebastian Andrzej Siewior u16 val; 46488af8bbeSSebastian Andrzej Siewior int ret; 46588af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &val); 46688af8bbeSSebastian Andrzej Siewior if (ret) 46788af8bbeSSebastian Andrzej Siewior return ret; 46888af8bbeSSebastian Andrzej Siewior if (DIV_ROUND_UP(val, 8) > 0xff) 46988af8bbeSSebastian Andrzej Siewior return -ERANGE; 47045b6a73fSChristoph Hellwig to_config_usb_cfg(item)->c.MaxPower = val; 47188af8bbeSSebastian Andrzej Siewior return len; 47288af8bbeSSebastian Andrzej Siewior } 47388af8bbeSSebastian Andrzej Siewior 47445b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_bmAttributes_show(struct config_item *item, 47588af8bbeSSebastian Andrzej Siewior char *page) 47688af8bbeSSebastian Andrzej Siewior { 47745b6a73fSChristoph Hellwig return sprintf(page, "0x%02x\n", 47845b6a73fSChristoph Hellwig to_config_usb_cfg(item)->c.bmAttributes); 47988af8bbeSSebastian Andrzej Siewior } 48088af8bbeSSebastian Andrzej Siewior 48145b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_bmAttributes_store(struct config_item *item, 48288af8bbeSSebastian Andrzej Siewior const char *page, size_t len) 48388af8bbeSSebastian Andrzej Siewior { 48488af8bbeSSebastian Andrzej Siewior u8 val; 48588af8bbeSSebastian Andrzej Siewior int ret; 48688af8bbeSSebastian Andrzej Siewior ret = kstrtou8(page, 0, &val); 48788af8bbeSSebastian Andrzej Siewior if (ret) 48888af8bbeSSebastian Andrzej Siewior return ret; 48988af8bbeSSebastian Andrzej Siewior if (!(val & USB_CONFIG_ATT_ONE)) 49088af8bbeSSebastian Andrzej Siewior return -EINVAL; 49188af8bbeSSebastian Andrzej Siewior if (val & ~(USB_CONFIG_ATT_ONE | USB_CONFIG_ATT_SELFPOWER | 49288af8bbeSSebastian Andrzej Siewior USB_CONFIG_ATT_WAKEUP)) 49388af8bbeSSebastian Andrzej Siewior return -EINVAL; 49445b6a73fSChristoph Hellwig to_config_usb_cfg(item)->c.bmAttributes = val; 49588af8bbeSSebastian Andrzej Siewior return len; 49688af8bbeSSebastian Andrzej Siewior } 49788af8bbeSSebastian Andrzej Siewior 49845b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_config_desc_, MaxPower); 49945b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_config_desc_, bmAttributes); 50088af8bbeSSebastian Andrzej Siewior 50188af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_config_attrs[] = { 50245b6a73fSChristoph Hellwig &gadget_config_desc_attr_MaxPower, 50345b6a73fSChristoph Hellwig &gadget_config_desc_attr_bmAttributes, 50488af8bbeSSebastian Andrzej Siewior NULL, 50588af8bbeSSebastian Andrzej Siewior }; 50688af8bbeSSebastian Andrzej Siewior 50788af8bbeSSebastian Andrzej Siewior static struct config_item_type gadget_config_type = { 50888af8bbeSSebastian Andrzej Siewior .ct_item_ops = &gadget_config_item_ops, 50988af8bbeSSebastian Andrzej Siewior .ct_attrs = gadget_config_attrs, 51088af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 51188af8bbeSSebastian Andrzej Siewior }; 51288af8bbeSSebastian Andrzej Siewior 51388af8bbeSSebastian Andrzej Siewior static struct config_item_type gadget_root_type = { 51488af8bbeSSebastian Andrzej Siewior .ct_item_ops = &gadget_root_item_ops, 51588af8bbeSSebastian Andrzej Siewior .ct_attrs = gadget_root_attrs, 51688af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 51788af8bbeSSebastian Andrzej Siewior }; 51888af8bbeSSebastian Andrzej Siewior 51988af8bbeSSebastian Andrzej Siewior static void composite_init_dev(struct usb_composite_dev *cdev) 52088af8bbeSSebastian Andrzej Siewior { 52188af8bbeSSebastian Andrzej Siewior spin_lock_init(&cdev->lock); 52288af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cdev->configs); 52388af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cdev->gstrings); 52488af8bbeSSebastian Andrzej Siewior } 52588af8bbeSSebastian Andrzej Siewior 52688af8bbeSSebastian Andrzej Siewior static struct config_group *function_make( 52788af8bbeSSebastian Andrzej Siewior struct config_group *group, 52888af8bbeSSebastian Andrzej Siewior const char *name) 52988af8bbeSSebastian Andrzej Siewior { 53088af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 53188af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi; 53288af8bbeSSebastian Andrzej Siewior char buf[MAX_NAME_LEN]; 53388af8bbeSSebastian Andrzej Siewior char *func_name; 53488af8bbeSSebastian Andrzej Siewior char *instance_name; 53588af8bbeSSebastian Andrzej Siewior int ret; 53688af8bbeSSebastian Andrzej Siewior 53788af8bbeSSebastian Andrzej Siewior ret = snprintf(buf, MAX_NAME_LEN, "%s", name); 53888af8bbeSSebastian Andrzej Siewior if (ret >= MAX_NAME_LEN) 53988af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENAMETOOLONG); 54088af8bbeSSebastian Andrzej Siewior 54188af8bbeSSebastian Andrzej Siewior func_name = buf; 54288af8bbeSSebastian Andrzej Siewior instance_name = strchr(func_name, '.'); 54388af8bbeSSebastian Andrzej Siewior if (!instance_name) { 54488af8bbeSSebastian Andrzej Siewior pr_err("Unable to locate . in FUNC.INSTANCE\n"); 54588af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL); 54688af8bbeSSebastian Andrzej Siewior } 54788af8bbeSSebastian Andrzej Siewior *instance_name = '\0'; 54888af8bbeSSebastian Andrzej Siewior instance_name++; 54988af8bbeSSebastian Andrzej Siewior 55088af8bbeSSebastian Andrzej Siewior fi = usb_get_function_instance(func_name); 55188af8bbeSSebastian Andrzej Siewior if (IS_ERR(fi)) 552a3469411SDuan Jiong return ERR_CAST(fi); 55388af8bbeSSebastian Andrzej Siewior 5543958b792SNicolas Iooss ret = config_item_set_name(&fi->group.cg_item, "%s", name); 55588af8bbeSSebastian Andrzej Siewior if (ret) { 55688af8bbeSSebastian Andrzej Siewior usb_put_function_instance(fi); 55788af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret); 55888af8bbeSSebastian Andrzej Siewior } 5591933861dSAndrzej Pietrasiewicz if (fi->set_inst_name) { 5601933861dSAndrzej Pietrasiewicz ret = fi->set_inst_name(fi, instance_name); 5611933861dSAndrzej Pietrasiewicz if (ret) { 5621933861dSAndrzej Pietrasiewicz usb_put_function_instance(fi); 5631933861dSAndrzej Pietrasiewicz return ERR_PTR(ret); 5641933861dSAndrzej Pietrasiewicz } 5651933861dSAndrzej Pietrasiewicz } 56688af8bbeSSebastian Andrzej Siewior 56788af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, functions_group); 56888af8bbeSSebastian Andrzej Siewior 56988af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 57088af8bbeSSebastian Andrzej Siewior list_add_tail(&fi->cfs_list, &gi->available_func); 57188af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 57288af8bbeSSebastian Andrzej Siewior return &fi->group; 57388af8bbeSSebastian Andrzej Siewior } 57488af8bbeSSebastian Andrzej Siewior 57588af8bbeSSebastian Andrzej Siewior static void function_drop( 57688af8bbeSSebastian Andrzej Siewior struct config_group *group, 57788af8bbeSSebastian Andrzej Siewior struct config_item *item) 57888af8bbeSSebastian Andrzej Siewior { 57988af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi = to_usb_function_instance(item); 58088af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 58188af8bbeSSebastian Andrzej Siewior 58288af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, functions_group); 58388af8bbeSSebastian Andrzej Siewior 58488af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock); 58588af8bbeSSebastian Andrzej Siewior list_del(&fi->cfs_list); 58688af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock); 58788af8bbeSSebastian Andrzej Siewior config_item_put(item); 58888af8bbeSSebastian Andrzej Siewior } 58988af8bbeSSebastian Andrzej Siewior 59088af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations functions_ops = { 59188af8bbeSSebastian Andrzej Siewior .make_group = &function_make, 59288af8bbeSSebastian Andrzej Siewior .drop_item = &function_drop, 59388af8bbeSSebastian Andrzej Siewior }; 59488af8bbeSSebastian Andrzej Siewior 59588af8bbeSSebastian Andrzej Siewior static struct config_item_type functions_type = { 59688af8bbeSSebastian Andrzej Siewior .ct_group_ops = &functions_ops, 59788af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 59888af8bbeSSebastian Andrzej Siewior }; 59988af8bbeSSebastian Andrzej Siewior 60088af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_config_name, configuration); 60188af8bbeSSebastian Andrzej Siewior 60288af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_config_name_langid_attrs[] = { 60345b6a73fSChristoph Hellwig &gadget_config_name_attr_configuration, 60488af8bbeSSebastian Andrzej Siewior NULL, 60588af8bbeSSebastian Andrzej Siewior }; 60688af8bbeSSebastian Andrzej Siewior 60788af8bbeSSebastian Andrzej Siewior static void gadget_config_name_attr_release(struct config_item *item) 60888af8bbeSSebastian Andrzej Siewior { 60988af8bbeSSebastian Andrzej Siewior struct gadget_config_name *cn = to_gadget_config_name(item); 61088af8bbeSSebastian Andrzej Siewior 61188af8bbeSSebastian Andrzej Siewior kfree(cn->configuration); 61288af8bbeSSebastian Andrzej Siewior 61388af8bbeSSebastian Andrzej Siewior list_del(&cn->list); 61488af8bbeSSebastian Andrzej Siewior kfree(cn); 61588af8bbeSSebastian Andrzej Siewior } 61688af8bbeSSebastian Andrzej Siewior 61788af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRING_RW_OPS(gadget_config_name); 61888af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRINGS_LANG(gadget_config_name, config_usb_cfg); 61988af8bbeSSebastian Andrzej Siewior 62088af8bbeSSebastian Andrzej Siewior static struct config_group *config_desc_make( 62188af8bbeSSebastian Andrzej Siewior struct config_group *group, 62288af8bbeSSebastian Andrzej Siewior const char *name) 62388af8bbeSSebastian Andrzej Siewior { 62488af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 62588af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 62688af8bbeSSebastian Andrzej Siewior char buf[MAX_NAME_LEN]; 62788af8bbeSSebastian Andrzej Siewior char *num_str; 62888af8bbeSSebastian Andrzej Siewior u8 num; 62988af8bbeSSebastian Andrzej Siewior int ret; 63088af8bbeSSebastian Andrzej Siewior 63188af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, configs_group); 63288af8bbeSSebastian Andrzej Siewior ret = snprintf(buf, MAX_NAME_LEN, "%s", name); 63388af8bbeSSebastian Andrzej Siewior if (ret >= MAX_NAME_LEN) 63488af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENAMETOOLONG); 63588af8bbeSSebastian Andrzej Siewior 63688af8bbeSSebastian Andrzej Siewior num_str = strchr(buf, '.'); 63788af8bbeSSebastian Andrzej Siewior if (!num_str) { 63888af8bbeSSebastian Andrzej Siewior pr_err("Unable to locate . in name.bConfigurationValue\n"); 63988af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL); 64088af8bbeSSebastian Andrzej Siewior } 64188af8bbeSSebastian Andrzej Siewior 64288af8bbeSSebastian Andrzej Siewior *num_str = '\0'; 64388af8bbeSSebastian Andrzej Siewior num_str++; 64488af8bbeSSebastian Andrzej Siewior 64588af8bbeSSebastian Andrzej Siewior if (!strlen(buf)) 64688af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL); 64788af8bbeSSebastian Andrzej Siewior 64888af8bbeSSebastian Andrzej Siewior ret = kstrtou8(num_str, 0, &num); 64988af8bbeSSebastian Andrzej Siewior if (ret) 65088af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret); 65188af8bbeSSebastian Andrzej Siewior 65288af8bbeSSebastian Andrzej Siewior cfg = kzalloc(sizeof(*cfg), GFP_KERNEL); 65388af8bbeSSebastian Andrzej Siewior if (!cfg) 65488af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM); 65588af8bbeSSebastian Andrzej Siewior cfg->c.label = kstrdup(buf, GFP_KERNEL); 65688af8bbeSSebastian Andrzej Siewior if (!cfg->c.label) { 65788af8bbeSSebastian Andrzej Siewior ret = -ENOMEM; 65888af8bbeSSebastian Andrzej Siewior goto err; 65988af8bbeSSebastian Andrzej Siewior } 66088af8bbeSSebastian Andrzej Siewior cfg->c.bConfigurationValue = num; 66188af8bbeSSebastian Andrzej Siewior cfg->c.MaxPower = CONFIG_USB_GADGET_VBUS_DRAW; 66288af8bbeSSebastian Andrzej Siewior cfg->c.bmAttributes = USB_CONFIG_ATT_ONE; 66388af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cfg->string_list); 66488af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cfg->func_list); 66588af8bbeSSebastian Andrzej Siewior 66688af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&cfg->group, name, 66788af8bbeSSebastian Andrzej Siewior &gadget_config_type); 6681ae1602dSChristoph Hellwig 66988af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&cfg->strings_group, "strings", 67088af8bbeSSebastian Andrzej Siewior &gadget_config_name_strings_type); 6711ae1602dSChristoph Hellwig configfs_add_default_group(&cfg->strings_group, &cfg->group); 67288af8bbeSSebastian Andrzej Siewior 67388af8bbeSSebastian Andrzej Siewior ret = usb_add_config_only(&gi->cdev, &cfg->c); 67488af8bbeSSebastian Andrzej Siewior if (ret) 67588af8bbeSSebastian Andrzej Siewior goto err; 67688af8bbeSSebastian Andrzej Siewior 67788af8bbeSSebastian Andrzej Siewior return &cfg->group; 67888af8bbeSSebastian Andrzej Siewior err: 67988af8bbeSSebastian Andrzej Siewior kfree(cfg->c.label); 68088af8bbeSSebastian Andrzej Siewior kfree(cfg); 68188af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret); 68288af8bbeSSebastian Andrzej Siewior } 68388af8bbeSSebastian Andrzej Siewior 68488af8bbeSSebastian Andrzej Siewior static void config_desc_drop( 68588af8bbeSSebastian Andrzej Siewior struct config_group *group, 68688af8bbeSSebastian Andrzej Siewior struct config_item *item) 68788af8bbeSSebastian Andrzej Siewior { 68888af8bbeSSebastian Andrzej Siewior config_item_put(item); 68988af8bbeSSebastian Andrzej Siewior } 69088af8bbeSSebastian Andrzej Siewior 69188af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations config_desc_ops = { 69288af8bbeSSebastian Andrzej Siewior .make_group = &config_desc_make, 69388af8bbeSSebastian Andrzej Siewior .drop_item = &config_desc_drop, 69488af8bbeSSebastian Andrzej Siewior }; 69588af8bbeSSebastian Andrzej Siewior 69688af8bbeSSebastian Andrzej Siewior static struct config_item_type config_desc_type = { 69788af8bbeSSebastian Andrzej Siewior .ct_group_ops = &config_desc_ops, 69888af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 69988af8bbeSSebastian Andrzej Siewior }; 70088af8bbeSSebastian Andrzej Siewior 70188af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_strings, manufacturer); 70288af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_strings, product); 70388af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_strings, serialnumber); 70488af8bbeSSebastian Andrzej Siewior 70588af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_strings_langid_attrs[] = { 70645b6a73fSChristoph Hellwig &gadget_strings_attr_manufacturer, 70745b6a73fSChristoph Hellwig &gadget_strings_attr_product, 70845b6a73fSChristoph Hellwig &gadget_strings_attr_serialnumber, 70988af8bbeSSebastian Andrzej Siewior NULL, 71088af8bbeSSebastian Andrzej Siewior }; 71188af8bbeSSebastian Andrzej Siewior 71288af8bbeSSebastian Andrzej Siewior static void gadget_strings_attr_release(struct config_item *item) 71388af8bbeSSebastian Andrzej Siewior { 71488af8bbeSSebastian Andrzej Siewior struct gadget_strings *gs = to_gadget_strings(item); 71588af8bbeSSebastian Andrzej Siewior 71688af8bbeSSebastian Andrzej Siewior kfree(gs->manufacturer); 71788af8bbeSSebastian Andrzej Siewior kfree(gs->product); 71888af8bbeSSebastian Andrzej Siewior kfree(gs->serialnumber); 71988af8bbeSSebastian Andrzej Siewior 72088af8bbeSSebastian Andrzej Siewior list_del(&gs->list); 72188af8bbeSSebastian Andrzej Siewior kfree(gs); 72288af8bbeSSebastian Andrzej Siewior } 72388af8bbeSSebastian Andrzej Siewior 72488af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRING_RW_OPS(gadget_strings); 72588af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRINGS_LANG(gadget_strings, gadget_info); 72688af8bbeSSebastian Andrzej Siewior 72787213d38SAndrzej Pietrasiewicz static inline struct os_desc *to_os_desc(struct config_item *item) 72887213d38SAndrzej Pietrasiewicz { 72987213d38SAndrzej Pietrasiewicz return container_of(to_config_group(item), struct os_desc, group); 73087213d38SAndrzej Pietrasiewicz } 73187213d38SAndrzej Pietrasiewicz 73245b6a73fSChristoph Hellwig static inline struct gadget_info *os_desc_item_to_gadget_info( 73345b6a73fSChristoph Hellwig struct config_item *item) 73487213d38SAndrzej Pietrasiewicz { 73545b6a73fSChristoph Hellwig return to_gadget_info(to_os_desc(item)->group.cg_item.ci_parent); 73687213d38SAndrzej Pietrasiewicz } 73787213d38SAndrzej Pietrasiewicz 73845b6a73fSChristoph Hellwig static ssize_t os_desc_use_show(struct config_item *item, char *page) 73945b6a73fSChristoph Hellwig { 74045b6a73fSChristoph Hellwig return sprintf(page, "%d", 74145b6a73fSChristoph Hellwig os_desc_item_to_gadget_info(item)->use_os_desc); 74245b6a73fSChristoph Hellwig } 74345b6a73fSChristoph Hellwig 74445b6a73fSChristoph Hellwig static ssize_t os_desc_use_store(struct config_item *item, const char *page, 74587213d38SAndrzej Pietrasiewicz size_t len) 74687213d38SAndrzej Pietrasiewicz { 74745b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 74887213d38SAndrzej Pietrasiewicz int ret; 74987213d38SAndrzej Pietrasiewicz bool use; 75087213d38SAndrzej Pietrasiewicz 75187213d38SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 75287213d38SAndrzej Pietrasiewicz ret = strtobool(page, &use); 75387213d38SAndrzej Pietrasiewicz if (!ret) { 75487213d38SAndrzej Pietrasiewicz gi->use_os_desc = use; 75587213d38SAndrzej Pietrasiewicz ret = len; 75687213d38SAndrzej Pietrasiewicz } 75787213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 75887213d38SAndrzej Pietrasiewicz 75987213d38SAndrzej Pietrasiewicz return ret; 76087213d38SAndrzej Pietrasiewicz } 76187213d38SAndrzej Pietrasiewicz 76245b6a73fSChristoph Hellwig static ssize_t os_desc_b_vendor_code_show(struct config_item *item, char *page) 76387213d38SAndrzej Pietrasiewicz { 76445b6a73fSChristoph Hellwig return sprintf(page, "%d", 76545b6a73fSChristoph Hellwig os_desc_item_to_gadget_info(item)->b_vendor_code); 76687213d38SAndrzej Pietrasiewicz } 76787213d38SAndrzej Pietrasiewicz 76845b6a73fSChristoph Hellwig static ssize_t os_desc_b_vendor_code_store(struct config_item *item, 76987213d38SAndrzej Pietrasiewicz const char *page, size_t len) 77087213d38SAndrzej Pietrasiewicz { 77145b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 77287213d38SAndrzej Pietrasiewicz int ret; 77387213d38SAndrzej Pietrasiewicz u8 b_vendor_code; 77487213d38SAndrzej Pietrasiewicz 77587213d38SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 77687213d38SAndrzej Pietrasiewicz ret = kstrtou8(page, 0, &b_vendor_code); 77787213d38SAndrzej Pietrasiewicz if (!ret) { 77887213d38SAndrzej Pietrasiewicz gi->b_vendor_code = b_vendor_code; 77987213d38SAndrzej Pietrasiewicz ret = len; 78087213d38SAndrzej Pietrasiewicz } 78187213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 78287213d38SAndrzej Pietrasiewicz 78387213d38SAndrzej Pietrasiewicz return ret; 78487213d38SAndrzej Pietrasiewicz } 78587213d38SAndrzej Pietrasiewicz 78645b6a73fSChristoph Hellwig static ssize_t os_desc_qw_sign_show(struct config_item *item, char *page) 78787213d38SAndrzej Pietrasiewicz { 78845b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 78987213d38SAndrzej Pietrasiewicz 79087213d38SAndrzej Pietrasiewicz memcpy(page, gi->qw_sign, OS_STRING_QW_SIGN_LEN); 79187213d38SAndrzej Pietrasiewicz return OS_STRING_QW_SIGN_LEN; 79287213d38SAndrzej Pietrasiewicz } 79387213d38SAndrzej Pietrasiewicz 79445b6a73fSChristoph Hellwig static ssize_t os_desc_qw_sign_store(struct config_item *item, const char *page, 79587213d38SAndrzej Pietrasiewicz size_t len) 79687213d38SAndrzej Pietrasiewicz { 79745b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item); 79887213d38SAndrzej Pietrasiewicz int res, l; 79987213d38SAndrzej Pietrasiewicz 80087213d38SAndrzej Pietrasiewicz l = min((int)len, OS_STRING_QW_SIGN_LEN >> 1); 80187213d38SAndrzej Pietrasiewicz if (page[l - 1] == '\n') 80287213d38SAndrzej Pietrasiewicz --l; 80387213d38SAndrzej Pietrasiewicz 80487213d38SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 80587213d38SAndrzej Pietrasiewicz res = utf8s_to_utf16s(page, l, 80687213d38SAndrzej Pietrasiewicz UTF16_LITTLE_ENDIAN, (wchar_t *) gi->qw_sign, 80787213d38SAndrzej Pietrasiewicz OS_STRING_QW_SIGN_LEN); 80887213d38SAndrzej Pietrasiewicz if (res > 0) 80987213d38SAndrzej Pietrasiewicz res = len; 81087213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 81187213d38SAndrzej Pietrasiewicz 81287213d38SAndrzej Pietrasiewicz return res; 81387213d38SAndrzej Pietrasiewicz } 81487213d38SAndrzej Pietrasiewicz 81545b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, use); 81645b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, b_vendor_code); 81745b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, qw_sign); 81887213d38SAndrzej Pietrasiewicz 81987213d38SAndrzej Pietrasiewicz static struct configfs_attribute *os_desc_attrs[] = { 82045b6a73fSChristoph Hellwig &os_desc_attr_use, 82145b6a73fSChristoph Hellwig &os_desc_attr_b_vendor_code, 82245b6a73fSChristoph Hellwig &os_desc_attr_qw_sign, 82387213d38SAndrzej Pietrasiewicz NULL, 82487213d38SAndrzej Pietrasiewicz }; 82587213d38SAndrzej Pietrasiewicz 82687213d38SAndrzej Pietrasiewicz static void os_desc_attr_release(struct config_item *item) 82787213d38SAndrzej Pietrasiewicz { 82887213d38SAndrzej Pietrasiewicz struct os_desc *os_desc = to_os_desc(item); 82987213d38SAndrzej Pietrasiewicz kfree(os_desc); 83087213d38SAndrzej Pietrasiewicz } 83187213d38SAndrzej Pietrasiewicz 832da424314SAndrzej Pietrasiewicz static int os_desc_link(struct config_item *os_desc_ci, 833da424314SAndrzej Pietrasiewicz struct config_item *usb_cfg_ci) 834da424314SAndrzej Pietrasiewicz { 835da424314SAndrzej Pietrasiewicz struct gadget_info *gi = container_of(to_config_group(os_desc_ci), 836da424314SAndrzej Pietrasiewicz struct gadget_info, os_desc_group); 837da424314SAndrzej Pietrasiewicz struct usb_composite_dev *cdev = &gi->cdev; 838da424314SAndrzej Pietrasiewicz struct config_usb_cfg *c_target = 839da424314SAndrzej Pietrasiewicz container_of(to_config_group(usb_cfg_ci), 840da424314SAndrzej Pietrasiewicz struct config_usb_cfg, group); 841da424314SAndrzej Pietrasiewicz struct usb_configuration *c; 842da424314SAndrzej Pietrasiewicz int ret; 843da424314SAndrzej Pietrasiewicz 844da424314SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 845da424314SAndrzej Pietrasiewicz list_for_each_entry(c, &cdev->configs, list) { 846da424314SAndrzej Pietrasiewicz if (c == &c_target->c) 847da424314SAndrzej Pietrasiewicz break; 848da424314SAndrzej Pietrasiewicz } 849da424314SAndrzej Pietrasiewicz if (c != &c_target->c) { 850da424314SAndrzej Pietrasiewicz ret = -EINVAL; 851da424314SAndrzej Pietrasiewicz goto out; 852da424314SAndrzej Pietrasiewicz } 853da424314SAndrzej Pietrasiewicz 854da424314SAndrzej Pietrasiewicz if (cdev->os_desc_config) { 855da424314SAndrzej Pietrasiewicz ret = -EBUSY; 856da424314SAndrzej Pietrasiewicz goto out; 857da424314SAndrzej Pietrasiewicz } 858da424314SAndrzej Pietrasiewicz 859da424314SAndrzej Pietrasiewicz cdev->os_desc_config = &c_target->c; 860da424314SAndrzej Pietrasiewicz ret = 0; 861da424314SAndrzej Pietrasiewicz 862da424314SAndrzej Pietrasiewicz out: 863da424314SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 864da424314SAndrzej Pietrasiewicz return ret; 865da424314SAndrzej Pietrasiewicz } 866da424314SAndrzej Pietrasiewicz 867*e16769d4SAndrzej Pietrasiewicz static void os_desc_unlink(struct config_item *os_desc_ci, 868da424314SAndrzej Pietrasiewicz struct config_item *usb_cfg_ci) 869da424314SAndrzej Pietrasiewicz { 870da424314SAndrzej Pietrasiewicz struct gadget_info *gi = container_of(to_config_group(os_desc_ci), 871da424314SAndrzej Pietrasiewicz struct gadget_info, os_desc_group); 872da424314SAndrzej Pietrasiewicz struct usb_composite_dev *cdev = &gi->cdev; 873da424314SAndrzej Pietrasiewicz 874da424314SAndrzej Pietrasiewicz mutex_lock(&gi->lock); 875afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name) 876da424314SAndrzej Pietrasiewicz unregister_gadget(gi); 877da424314SAndrzej Pietrasiewicz cdev->os_desc_config = NULL; 878afdaadc3SRuslan Bilovol WARN_ON(gi->composite.gadget_driver.udc_name); 879da424314SAndrzej Pietrasiewicz mutex_unlock(&gi->lock); 880da424314SAndrzej Pietrasiewicz } 881da424314SAndrzej Pietrasiewicz 88287213d38SAndrzej Pietrasiewicz static struct configfs_item_operations os_desc_ops = { 88387213d38SAndrzej Pietrasiewicz .release = os_desc_attr_release, 884da424314SAndrzej Pietrasiewicz .allow_link = os_desc_link, 885da424314SAndrzej Pietrasiewicz .drop_link = os_desc_unlink, 88687213d38SAndrzej Pietrasiewicz }; 88787213d38SAndrzej Pietrasiewicz 88887213d38SAndrzej Pietrasiewicz static struct config_item_type os_desc_type = { 88987213d38SAndrzej Pietrasiewicz .ct_item_ops = &os_desc_ops, 89087213d38SAndrzej Pietrasiewicz .ct_attrs = os_desc_attrs, 89187213d38SAndrzej Pietrasiewicz .ct_owner = THIS_MODULE, 89287213d38SAndrzej Pietrasiewicz }; 89387213d38SAndrzej Pietrasiewicz 8947419485fSAndrzej Pietrasiewicz static inline struct usb_os_desc_ext_prop 8957419485fSAndrzej Pietrasiewicz *to_usb_os_desc_ext_prop(struct config_item *item) 8967419485fSAndrzej Pietrasiewicz { 8977419485fSAndrzej Pietrasiewicz return container_of(item, struct usb_os_desc_ext_prop, item); 8987419485fSAndrzej Pietrasiewicz } 8997419485fSAndrzej Pietrasiewicz 90045b6a73fSChristoph Hellwig static ssize_t ext_prop_type_show(struct config_item *item, char *page) 9017419485fSAndrzej Pietrasiewicz { 90245b6a73fSChristoph Hellwig return sprintf(page, "%d", to_usb_os_desc_ext_prop(item)->type); 9037419485fSAndrzej Pietrasiewicz } 9047419485fSAndrzej Pietrasiewicz 90545b6a73fSChristoph Hellwig static ssize_t ext_prop_type_store(struct config_item *item, 9067419485fSAndrzej Pietrasiewicz const char *page, size_t len) 9077419485fSAndrzej Pietrasiewicz { 90845b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 9097419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(ext_prop->item.ci_parent); 9107419485fSAndrzej Pietrasiewicz u8 type; 9117419485fSAndrzej Pietrasiewicz int ret; 9127419485fSAndrzej Pietrasiewicz 9137419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 9147419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 9157419485fSAndrzej Pietrasiewicz ret = kstrtou8(page, 0, &type); 9167419485fSAndrzej Pietrasiewicz if (ret) 9177419485fSAndrzej Pietrasiewicz goto end; 9187419485fSAndrzej Pietrasiewicz if (type < USB_EXT_PROP_UNICODE || type > USB_EXT_PROP_UNICODE_MULTI) { 9197419485fSAndrzej Pietrasiewicz ret = -EINVAL; 9207419485fSAndrzej Pietrasiewicz goto end; 9217419485fSAndrzej Pietrasiewicz } 9227419485fSAndrzej Pietrasiewicz 9237419485fSAndrzej Pietrasiewicz if ((ext_prop->type == USB_EXT_PROP_BINARY || 9247419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_LE32 || 9257419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_BE32) && 9267419485fSAndrzej Pietrasiewicz (type == USB_EXT_PROP_UNICODE || 9277419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_UNICODE_ENV || 9287419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_UNICODE_LINK)) 9297419485fSAndrzej Pietrasiewicz ext_prop->data_len <<= 1; 9307419485fSAndrzej Pietrasiewicz else if ((ext_prop->type == USB_EXT_PROP_UNICODE || 9317419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV || 9327419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) && 9337419485fSAndrzej Pietrasiewicz (type == USB_EXT_PROP_BINARY || 9347419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_LE32 || 9357419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_BE32)) 9367419485fSAndrzej Pietrasiewicz ext_prop->data_len >>= 1; 9377419485fSAndrzej Pietrasiewicz ext_prop->type = type; 9387419485fSAndrzej Pietrasiewicz ret = len; 9397419485fSAndrzej Pietrasiewicz 9407419485fSAndrzej Pietrasiewicz end: 9417419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 9427419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 9437419485fSAndrzej Pietrasiewicz return ret; 9447419485fSAndrzej Pietrasiewicz } 9457419485fSAndrzej Pietrasiewicz 94645b6a73fSChristoph Hellwig static ssize_t ext_prop_data_show(struct config_item *item, char *page) 9477419485fSAndrzej Pietrasiewicz { 94845b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 9497419485fSAndrzej Pietrasiewicz int len = ext_prop->data_len; 9507419485fSAndrzej Pietrasiewicz 9517419485fSAndrzej Pietrasiewicz if (ext_prop->type == USB_EXT_PROP_UNICODE || 9527419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV || 9537419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) 9547419485fSAndrzej Pietrasiewicz len >>= 1; 9557419485fSAndrzej Pietrasiewicz memcpy(page, ext_prop->data, len); 9567419485fSAndrzej Pietrasiewicz 9577419485fSAndrzej Pietrasiewicz return len; 9587419485fSAndrzej Pietrasiewicz } 9597419485fSAndrzej Pietrasiewicz 96045b6a73fSChristoph Hellwig static ssize_t ext_prop_data_store(struct config_item *item, 9617419485fSAndrzej Pietrasiewicz const char *page, size_t len) 9627419485fSAndrzej Pietrasiewicz { 96345b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 9647419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(ext_prop->item.ci_parent); 9657419485fSAndrzej Pietrasiewicz char *new_data; 9667419485fSAndrzej Pietrasiewicz size_t ret_len = len; 9677419485fSAndrzej Pietrasiewicz 9687419485fSAndrzej Pietrasiewicz if (page[len - 1] == '\n' || page[len - 1] == '\0') 9697419485fSAndrzej Pietrasiewicz --len; 97058b949e0SBenoit Taine new_data = kmemdup(page, len, GFP_KERNEL); 9717419485fSAndrzej Pietrasiewicz if (!new_data) 9727419485fSAndrzej Pietrasiewicz return -ENOMEM; 9737419485fSAndrzej Pietrasiewicz 9747419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 9757419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 9767419485fSAndrzej Pietrasiewicz kfree(ext_prop->data); 9777419485fSAndrzej Pietrasiewicz ext_prop->data = new_data; 9787419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= ext_prop->data_len; 9797419485fSAndrzej Pietrasiewicz ext_prop->data_len = len; 9807419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->data_len; 9817419485fSAndrzej Pietrasiewicz if (ext_prop->type == USB_EXT_PROP_UNICODE || 9827419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV || 9837419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) { 9847419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= ext_prop->data_len; 9857419485fSAndrzej Pietrasiewicz ext_prop->data_len <<= 1; 9867419485fSAndrzej Pietrasiewicz ext_prop->data_len += 2; 9877419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->data_len; 9887419485fSAndrzej Pietrasiewicz } 9897419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 9907419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 9917419485fSAndrzej Pietrasiewicz return ret_len; 9927419485fSAndrzej Pietrasiewicz } 9937419485fSAndrzej Pietrasiewicz 99445b6a73fSChristoph Hellwig CONFIGFS_ATTR(ext_prop_, type); 99545b6a73fSChristoph Hellwig CONFIGFS_ATTR(ext_prop_, data); 9967419485fSAndrzej Pietrasiewicz 9977419485fSAndrzej Pietrasiewicz static struct configfs_attribute *ext_prop_attrs[] = { 99845b6a73fSChristoph Hellwig &ext_prop_attr_type, 99945b6a73fSChristoph Hellwig &ext_prop_attr_data, 10007419485fSAndrzej Pietrasiewicz NULL, 10017419485fSAndrzej Pietrasiewicz }; 10027419485fSAndrzej Pietrasiewicz 10037419485fSAndrzej Pietrasiewicz static void usb_os_desc_ext_prop_release(struct config_item *item) 10047419485fSAndrzej Pietrasiewicz { 10057419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 10067419485fSAndrzej Pietrasiewicz 10077419485fSAndrzej Pietrasiewicz kfree(ext_prop); /* frees a whole chunk */ 10087419485fSAndrzej Pietrasiewicz } 10097419485fSAndrzej Pietrasiewicz 10107419485fSAndrzej Pietrasiewicz static struct configfs_item_operations ext_prop_ops = { 10117419485fSAndrzej Pietrasiewicz .release = usb_os_desc_ext_prop_release, 10127419485fSAndrzej Pietrasiewicz }; 10137419485fSAndrzej Pietrasiewicz 10147419485fSAndrzej Pietrasiewicz static struct config_item *ext_prop_make( 10157419485fSAndrzej Pietrasiewicz struct config_group *group, 10167419485fSAndrzej Pietrasiewicz const char *name) 10177419485fSAndrzej Pietrasiewicz { 10187419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop; 10197419485fSAndrzej Pietrasiewicz struct config_item_type *ext_prop_type; 10207419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc; 10217419485fSAndrzej Pietrasiewicz char *vlabuf; 10227419485fSAndrzej Pietrasiewicz 10237419485fSAndrzej Pietrasiewicz vla_group(data_chunk); 10247419485fSAndrzej Pietrasiewicz vla_item(data_chunk, struct usb_os_desc_ext_prop, ext_prop, 1); 10257419485fSAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, ext_prop_type, 1); 10267419485fSAndrzej Pietrasiewicz 10277419485fSAndrzej Pietrasiewicz vlabuf = kzalloc(vla_group_size(data_chunk), GFP_KERNEL); 10287419485fSAndrzej Pietrasiewicz if (!vlabuf) 10297419485fSAndrzej Pietrasiewicz return ERR_PTR(-ENOMEM); 10307419485fSAndrzej Pietrasiewicz 10317419485fSAndrzej Pietrasiewicz ext_prop = vla_ptr(vlabuf, data_chunk, ext_prop); 10327419485fSAndrzej Pietrasiewicz ext_prop_type = vla_ptr(vlabuf, data_chunk, ext_prop_type); 10337419485fSAndrzej Pietrasiewicz 10347419485fSAndrzej Pietrasiewicz desc = container_of(group, struct usb_os_desc, group); 10357419485fSAndrzej Pietrasiewicz ext_prop_type->ct_item_ops = &ext_prop_ops; 10367419485fSAndrzej Pietrasiewicz ext_prop_type->ct_attrs = ext_prop_attrs; 10377419485fSAndrzej Pietrasiewicz ext_prop_type->ct_owner = desc->owner; 10387419485fSAndrzej Pietrasiewicz 10397419485fSAndrzej Pietrasiewicz config_item_init_type_name(&ext_prop->item, name, ext_prop_type); 10407419485fSAndrzej Pietrasiewicz 10417419485fSAndrzej Pietrasiewicz ext_prop->name = kstrdup(name, GFP_KERNEL); 10427419485fSAndrzej Pietrasiewicz if (!ext_prop->name) { 10437419485fSAndrzej Pietrasiewicz kfree(vlabuf); 10447419485fSAndrzej Pietrasiewicz return ERR_PTR(-ENOMEM); 10457419485fSAndrzej Pietrasiewicz } 10467419485fSAndrzej Pietrasiewicz desc->ext_prop_len += 14; 10477419485fSAndrzej Pietrasiewicz ext_prop->name_len = 2 * strlen(ext_prop->name) + 2; 10487419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10497419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 10507419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->name_len; 10517419485fSAndrzej Pietrasiewicz list_add_tail(&ext_prop->entry, &desc->ext_prop); 10527419485fSAndrzej Pietrasiewicz ++desc->ext_prop_count; 10537419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10547419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 10557419485fSAndrzej Pietrasiewicz 10567419485fSAndrzej Pietrasiewicz return &ext_prop->item; 10577419485fSAndrzej Pietrasiewicz } 10587419485fSAndrzej Pietrasiewicz 10597419485fSAndrzej Pietrasiewicz static void ext_prop_drop(struct config_group *group, struct config_item *item) 10607419485fSAndrzej Pietrasiewicz { 10617419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item); 10627419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(&group->cg_item); 10637419485fSAndrzej Pietrasiewicz 10647419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10657419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 10667419485fSAndrzej Pietrasiewicz list_del(&ext_prop->entry); 10677419485fSAndrzej Pietrasiewicz --desc->ext_prop_count; 10687419485fSAndrzej Pietrasiewicz kfree(ext_prop->name); 10697419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= (ext_prop->name_len + ext_prop->data_len + 14); 10707419485fSAndrzej Pietrasiewicz if (desc->opts_mutex) 10717419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 10727419485fSAndrzej Pietrasiewicz config_item_put(item); 10737419485fSAndrzej Pietrasiewicz } 10747419485fSAndrzej Pietrasiewicz 10757419485fSAndrzej Pietrasiewicz static struct configfs_group_operations interf_grp_ops = { 10767419485fSAndrzej Pietrasiewicz .make_item = &ext_prop_make, 10777419485fSAndrzej Pietrasiewicz .drop_item = &ext_prop_drop, 10787419485fSAndrzej Pietrasiewicz }; 10797419485fSAndrzej Pietrasiewicz 108045b6a73fSChristoph Hellwig static ssize_t interf_grp_compatible_id_show(struct config_item *item, 1081da424314SAndrzej Pietrasiewicz char *page) 1082da424314SAndrzej Pietrasiewicz { 108345b6a73fSChristoph Hellwig memcpy(page, to_usb_os_desc(item)->ext_compat_id, 8); 1084da424314SAndrzej Pietrasiewicz return 8; 1085da424314SAndrzej Pietrasiewicz } 1086da424314SAndrzej Pietrasiewicz 108745b6a73fSChristoph Hellwig static ssize_t interf_grp_compatible_id_store(struct config_item *item, 1088da424314SAndrzej Pietrasiewicz const char *page, size_t len) 1089da424314SAndrzej Pietrasiewicz { 109045b6a73fSChristoph Hellwig struct usb_os_desc *desc = to_usb_os_desc(item); 1091da424314SAndrzej Pietrasiewicz int l; 1092da424314SAndrzej Pietrasiewicz 1093da424314SAndrzej Pietrasiewicz l = min_t(int, 8, len); 1094da424314SAndrzej Pietrasiewicz if (page[l - 1] == '\n') 1095da424314SAndrzej Pietrasiewicz --l; 1096da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1097da424314SAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 1098da424314SAndrzej Pietrasiewicz memcpy(desc->ext_compat_id, page, l); 1099da424314SAndrzej Pietrasiewicz 1100da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1101da424314SAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 1102da424314SAndrzej Pietrasiewicz 1103da424314SAndrzej Pietrasiewicz return len; 1104da424314SAndrzej Pietrasiewicz } 1105da424314SAndrzej Pietrasiewicz 110645b6a73fSChristoph Hellwig static ssize_t interf_grp_sub_compatible_id_show(struct config_item *item, 1107da424314SAndrzej Pietrasiewicz char *page) 1108da424314SAndrzej Pietrasiewicz { 110945b6a73fSChristoph Hellwig memcpy(page, to_usb_os_desc(item)->ext_compat_id + 8, 8); 1110da424314SAndrzej Pietrasiewicz return 8; 1111da424314SAndrzej Pietrasiewicz } 1112da424314SAndrzej Pietrasiewicz 111345b6a73fSChristoph Hellwig static ssize_t interf_grp_sub_compatible_id_store(struct config_item *item, 1114da424314SAndrzej Pietrasiewicz const char *page, size_t len) 1115da424314SAndrzej Pietrasiewicz { 111645b6a73fSChristoph Hellwig struct usb_os_desc *desc = to_usb_os_desc(item); 1117da424314SAndrzej Pietrasiewicz int l; 1118da424314SAndrzej Pietrasiewicz 1119da424314SAndrzej Pietrasiewicz l = min_t(int, 8, len); 1120da424314SAndrzej Pietrasiewicz if (page[l - 1] == '\n') 1121da424314SAndrzej Pietrasiewicz --l; 1122da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1123da424314SAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex); 1124da424314SAndrzej Pietrasiewicz memcpy(desc->ext_compat_id + 8, page, l); 1125da424314SAndrzej Pietrasiewicz 1126da424314SAndrzej Pietrasiewicz if (desc->opts_mutex) 1127da424314SAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex); 1128da424314SAndrzej Pietrasiewicz 1129da424314SAndrzej Pietrasiewicz return len; 1130da424314SAndrzej Pietrasiewicz } 1131da424314SAndrzej Pietrasiewicz 113245b6a73fSChristoph Hellwig CONFIGFS_ATTR(interf_grp_, compatible_id); 113345b6a73fSChristoph Hellwig CONFIGFS_ATTR(interf_grp_, sub_compatible_id); 1134da424314SAndrzej Pietrasiewicz 1135da424314SAndrzej Pietrasiewicz static struct configfs_attribute *interf_grp_attrs[] = { 113645b6a73fSChristoph Hellwig &interf_grp_attr_compatible_id, 113745b6a73fSChristoph Hellwig &interf_grp_attr_sub_compatible_id, 1138da424314SAndrzej Pietrasiewicz NULL 1139da424314SAndrzej Pietrasiewicz }; 1140da424314SAndrzej Pietrasiewicz 1141da424314SAndrzej Pietrasiewicz int usb_os_desc_prepare_interf_dir(struct config_group *parent, 1142da424314SAndrzej Pietrasiewicz int n_interf, 1143da424314SAndrzej Pietrasiewicz struct usb_os_desc **desc, 114414574b54SAndrzej Pietrasiewicz char **names, 1145da424314SAndrzej Pietrasiewicz struct module *owner) 1146da424314SAndrzej Pietrasiewicz { 11471ae1602dSChristoph Hellwig struct config_group *os_desc_group; 1148da424314SAndrzej Pietrasiewicz struct config_item_type *os_desc_type, *interface_type; 1149da424314SAndrzej Pietrasiewicz 1150da424314SAndrzej Pietrasiewicz vla_group(data_chunk); 1151da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_group, os_desc_group, 1); 1152da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, os_desc_type, 1); 1153da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, interface_type, 1); 1154da424314SAndrzej Pietrasiewicz 1155da424314SAndrzej Pietrasiewicz char *vlabuf = kzalloc(vla_group_size(data_chunk), GFP_KERNEL); 1156da424314SAndrzej Pietrasiewicz if (!vlabuf) 1157da424314SAndrzej Pietrasiewicz return -ENOMEM; 1158da424314SAndrzej Pietrasiewicz 1159da424314SAndrzej Pietrasiewicz os_desc_group = vla_ptr(vlabuf, data_chunk, os_desc_group); 1160da424314SAndrzej Pietrasiewicz os_desc_type = vla_ptr(vlabuf, data_chunk, os_desc_type); 1161da424314SAndrzej Pietrasiewicz interface_type = vla_ptr(vlabuf, data_chunk, interface_type); 1162da424314SAndrzej Pietrasiewicz 1163da424314SAndrzej Pietrasiewicz os_desc_type->ct_owner = owner; 1164da424314SAndrzej Pietrasiewicz config_group_init_type_name(os_desc_group, "os_desc", os_desc_type); 11651ae1602dSChristoph Hellwig configfs_add_default_group(os_desc_group, parent); 1166da424314SAndrzej Pietrasiewicz 11677419485fSAndrzej Pietrasiewicz interface_type->ct_group_ops = &interf_grp_ops; 1168da424314SAndrzej Pietrasiewicz interface_type->ct_attrs = interf_grp_attrs; 1169da424314SAndrzej Pietrasiewicz interface_type->ct_owner = owner; 1170da424314SAndrzej Pietrasiewicz 1171da424314SAndrzej Pietrasiewicz while (n_interf--) { 1172da424314SAndrzej Pietrasiewicz struct usb_os_desc *d; 1173da424314SAndrzej Pietrasiewicz 1174da424314SAndrzej Pietrasiewicz d = desc[n_interf]; 11757419485fSAndrzej Pietrasiewicz d->owner = owner; 1176da424314SAndrzej Pietrasiewicz config_group_init_type_name(&d->group, "", interface_type); 117714574b54SAndrzej Pietrasiewicz config_item_set_name(&d->group.cg_item, "interface.%s", 117814574b54SAndrzej Pietrasiewicz names[n_interf]); 11791ae1602dSChristoph Hellwig configfs_add_default_group(&d->group, os_desc_group); 1180da424314SAndrzej Pietrasiewicz } 1181da424314SAndrzej Pietrasiewicz 1182da424314SAndrzej Pietrasiewicz return 0; 1183da424314SAndrzej Pietrasiewicz } 1184da424314SAndrzej Pietrasiewicz EXPORT_SYMBOL(usb_os_desc_prepare_interf_dir); 1185da424314SAndrzej Pietrasiewicz 118688af8bbeSSebastian Andrzej Siewior static int configfs_do_nothing(struct usb_composite_dev *cdev) 118788af8bbeSSebastian Andrzej Siewior { 118875bfe23aSDavid Rientjes WARN_ON(1); 118988af8bbeSSebastian Andrzej Siewior return -EINVAL; 119088af8bbeSSebastian Andrzej Siewior } 119188af8bbeSSebastian Andrzej Siewior 119288af8bbeSSebastian Andrzej Siewior int composite_dev_prepare(struct usb_composite_driver *composite, 119388af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *dev); 119488af8bbeSSebastian Andrzej Siewior 1195da424314SAndrzej Pietrasiewicz int composite_os_desc_req_prepare(struct usb_composite_dev *cdev, 1196da424314SAndrzej Pietrasiewicz struct usb_ep *ep0); 1197da424314SAndrzej Pietrasiewicz 119888af8bbeSSebastian Andrzej Siewior static void purge_configs_funcs(struct gadget_info *gi) 119988af8bbeSSebastian Andrzej Siewior { 120088af8bbeSSebastian Andrzej Siewior struct usb_configuration *c; 120188af8bbeSSebastian Andrzej Siewior 120288af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) { 120388af8bbeSSebastian Andrzej Siewior struct usb_function *f, *tmp; 120488af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 120588af8bbeSSebastian Andrzej Siewior 120688af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c); 120788af8bbeSSebastian Andrzej Siewior 120888af8bbeSSebastian Andrzej Siewior list_for_each_entry_safe(f, tmp, &c->functions, list) { 120988af8bbeSSebastian Andrzej Siewior 121088af8bbeSSebastian Andrzej Siewior list_move_tail(&f->list, &cfg->func_list); 121188af8bbeSSebastian Andrzej Siewior if (f->unbind) { 1212da7b895dSRomain Izard dev_dbg(&gi->cdev.gadget->dev, 1213a08f5dbfSRomain Izard "unbind function '%s'/%p\n", 1214a08f5dbfSRomain Izard f->name, f); 121588af8bbeSSebastian Andrzej Siewior f->unbind(c, f); 121688af8bbeSSebastian Andrzej Siewior } 121788af8bbeSSebastian Andrzej Siewior } 121888af8bbeSSebastian Andrzej Siewior c->next_interface_id = 0; 1219903124feSKrzysztof Opasiak memset(c->interface, 0, sizeof(c->interface)); 1220554eead5SJohn Youn c->superspeed_plus = 0; 122188af8bbeSSebastian Andrzej Siewior c->superspeed = 0; 122288af8bbeSSebastian Andrzej Siewior c->highspeed = 0; 122388af8bbeSSebastian Andrzej Siewior c->fullspeed = 0; 122488af8bbeSSebastian Andrzej Siewior } 122588af8bbeSSebastian Andrzej Siewior } 122688af8bbeSSebastian Andrzej Siewior 122788af8bbeSSebastian Andrzej Siewior static int configfs_composite_bind(struct usb_gadget *gadget, 122888af8bbeSSebastian Andrzej Siewior struct usb_gadget_driver *gdriver) 122988af8bbeSSebastian Andrzej Siewior { 123088af8bbeSSebastian Andrzej Siewior struct usb_composite_driver *composite = to_cdriver(gdriver); 123188af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = container_of(composite, 123288af8bbeSSebastian Andrzej Siewior struct gadget_info, composite); 123388af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev = &gi->cdev; 123488af8bbeSSebastian Andrzej Siewior struct usb_configuration *c; 123588af8bbeSSebastian Andrzej Siewior struct usb_string *s; 123688af8bbeSSebastian Andrzej Siewior unsigned i; 123788af8bbeSSebastian Andrzej Siewior int ret; 123888af8bbeSSebastian Andrzej Siewior 123988af8bbeSSebastian Andrzej Siewior /* the gi->lock is hold by the caller */ 124088af8bbeSSebastian Andrzej Siewior cdev->gadget = gadget; 124188af8bbeSSebastian Andrzej Siewior set_gadget_data(gadget, cdev); 124288af8bbeSSebastian Andrzej Siewior ret = composite_dev_prepare(composite, cdev); 124388af8bbeSSebastian Andrzej Siewior if (ret) 124488af8bbeSSebastian Andrzej Siewior return ret; 124588af8bbeSSebastian Andrzej Siewior /* and now the gadget bind */ 124688af8bbeSSebastian Andrzej Siewior ret = -EINVAL; 124788af8bbeSSebastian Andrzej Siewior 124888af8bbeSSebastian Andrzej Siewior if (list_empty(&gi->cdev.configs)) { 124988af8bbeSSebastian Andrzej Siewior pr_err("Need at least one configuration in %s.\n", 125088af8bbeSSebastian Andrzej Siewior gi->composite.name); 125188af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 125288af8bbeSSebastian Andrzej Siewior } 125388af8bbeSSebastian Andrzej Siewior 125488af8bbeSSebastian Andrzej Siewior 125588af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) { 125688af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 125788af8bbeSSebastian Andrzej Siewior 125888af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c); 125988af8bbeSSebastian Andrzej Siewior if (list_empty(&cfg->func_list)) { 126088af8bbeSSebastian Andrzej Siewior pr_err("Config %s/%d of %s needs at least one function.\n", 126188af8bbeSSebastian Andrzej Siewior c->label, c->bConfigurationValue, 126288af8bbeSSebastian Andrzej Siewior gi->composite.name); 126388af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 126488af8bbeSSebastian Andrzej Siewior } 126588af8bbeSSebastian Andrzej Siewior } 126688af8bbeSSebastian Andrzej Siewior 126788af8bbeSSebastian Andrzej Siewior /* init all strings */ 126888af8bbeSSebastian Andrzej Siewior if (!list_empty(&gi->string_list)) { 126988af8bbeSSebastian Andrzej Siewior struct gadget_strings *gs; 127088af8bbeSSebastian Andrzej Siewior 127188af8bbeSSebastian Andrzej Siewior i = 0; 127288af8bbeSSebastian Andrzej Siewior list_for_each_entry(gs, &gi->string_list, list) { 127388af8bbeSSebastian Andrzej Siewior 127488af8bbeSSebastian Andrzej Siewior gi->gstrings[i] = &gs->stringtab_dev; 127588af8bbeSSebastian Andrzej Siewior gs->stringtab_dev.strings = gs->strings; 127688af8bbeSSebastian Andrzej Siewior gs->strings[USB_GADGET_MANUFACTURER_IDX].s = 127788af8bbeSSebastian Andrzej Siewior gs->manufacturer; 127888af8bbeSSebastian Andrzej Siewior gs->strings[USB_GADGET_PRODUCT_IDX].s = gs->product; 127988af8bbeSSebastian Andrzej Siewior gs->strings[USB_GADGET_SERIAL_IDX].s = gs->serialnumber; 128088af8bbeSSebastian Andrzej Siewior i++; 128188af8bbeSSebastian Andrzej Siewior } 128288af8bbeSSebastian Andrzej Siewior gi->gstrings[i] = NULL; 128388af8bbeSSebastian Andrzej Siewior s = usb_gstrings_attach(&gi->cdev, gi->gstrings, 128488af8bbeSSebastian Andrzej Siewior USB_GADGET_FIRST_AVAIL_IDX); 1285fea77077SWei Yongjun if (IS_ERR(s)) { 1286fea77077SWei Yongjun ret = PTR_ERR(s); 128788af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 1288fea77077SWei Yongjun } 128988af8bbeSSebastian Andrzej Siewior 129088af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iManufacturer = s[USB_GADGET_MANUFACTURER_IDX].id; 129188af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iProduct = s[USB_GADGET_PRODUCT_IDX].id; 129288af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iSerialNumber = s[USB_GADGET_SERIAL_IDX].id; 129388af8bbeSSebastian Andrzej Siewior } 129488af8bbeSSebastian Andrzej Siewior 129587213d38SAndrzej Pietrasiewicz if (gi->use_os_desc) { 129687213d38SAndrzej Pietrasiewicz cdev->use_os_string = true; 129787213d38SAndrzej Pietrasiewicz cdev->b_vendor_code = gi->b_vendor_code; 129887213d38SAndrzej Pietrasiewicz memcpy(cdev->qw_sign, gi->qw_sign, OS_STRING_QW_SIGN_LEN); 129987213d38SAndrzej Pietrasiewicz } 130087213d38SAndrzej Pietrasiewicz 130141ce84c8SLi Jun if (gadget_is_otg(gadget) && !otg_desc[0]) { 130241ce84c8SLi Jun struct usb_descriptor_header *usb_desc; 130341ce84c8SLi Jun 130441ce84c8SLi Jun usb_desc = usb_otg_descriptor_alloc(gadget); 130541ce84c8SLi Jun if (!usb_desc) { 130641ce84c8SLi Jun ret = -ENOMEM; 130741ce84c8SLi Jun goto err_comp_cleanup; 130841ce84c8SLi Jun } 130941ce84c8SLi Jun usb_otg_descriptor_init(gadget, usb_desc); 131041ce84c8SLi Jun otg_desc[0] = usb_desc; 131141ce84c8SLi Jun otg_desc[1] = NULL; 131241ce84c8SLi Jun } 131341ce84c8SLi Jun 131488af8bbeSSebastian Andrzej Siewior /* Go through all configs, attach all functions */ 131588af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) { 131688af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg; 131788af8bbeSSebastian Andrzej Siewior struct usb_function *f; 131888af8bbeSSebastian Andrzej Siewior struct usb_function *tmp; 131988af8bbeSSebastian Andrzej Siewior struct gadget_config_name *cn; 132088af8bbeSSebastian Andrzej Siewior 132141ce84c8SLi Jun if (gadget_is_otg(gadget)) 132241ce84c8SLi Jun c->descriptors = otg_desc; 132341ce84c8SLi Jun 132488af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c); 132588af8bbeSSebastian Andrzej Siewior if (!list_empty(&cfg->string_list)) { 132688af8bbeSSebastian Andrzej Siewior i = 0; 132788af8bbeSSebastian Andrzej Siewior list_for_each_entry(cn, &cfg->string_list, list) { 132888af8bbeSSebastian Andrzej Siewior cfg->gstrings[i] = &cn->stringtab_dev; 132988af8bbeSSebastian Andrzej Siewior cn->stringtab_dev.strings = &cn->strings; 133088af8bbeSSebastian Andrzej Siewior cn->strings.s = cn->configuration; 133188af8bbeSSebastian Andrzej Siewior i++; 133288af8bbeSSebastian Andrzej Siewior } 133388af8bbeSSebastian Andrzej Siewior cfg->gstrings[i] = NULL; 133488af8bbeSSebastian Andrzej Siewior s = usb_gstrings_attach(&gi->cdev, cfg->gstrings, 1); 1335fea77077SWei Yongjun if (IS_ERR(s)) { 1336fea77077SWei Yongjun ret = PTR_ERR(s); 133788af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup; 1338fea77077SWei Yongjun } 133988af8bbeSSebastian Andrzej Siewior c->iConfiguration = s[0].id; 134088af8bbeSSebastian Andrzej Siewior } 134188af8bbeSSebastian Andrzej Siewior 134288af8bbeSSebastian Andrzej Siewior list_for_each_entry_safe(f, tmp, &cfg->func_list, list) { 134388af8bbeSSebastian Andrzej Siewior list_del(&f->list); 134488af8bbeSSebastian Andrzej Siewior ret = usb_add_function(c, f); 13455a68e9b5SAndrzej Pietrasiewicz if (ret) { 13465a68e9b5SAndrzej Pietrasiewicz list_add(&f->list, &cfg->func_list); 134788af8bbeSSebastian Andrzej Siewior goto err_purge_funcs; 134888af8bbeSSebastian Andrzej Siewior } 13495a68e9b5SAndrzej Pietrasiewicz } 135088af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget); 135188af8bbeSSebastian Andrzej Siewior } 1352da424314SAndrzej Pietrasiewicz if (cdev->use_os_string) { 1353da424314SAndrzej Pietrasiewicz ret = composite_os_desc_req_prepare(cdev, gadget->ep0); 1354da424314SAndrzej Pietrasiewicz if (ret) 1355da424314SAndrzej Pietrasiewicz goto err_purge_funcs; 1356da424314SAndrzej Pietrasiewicz } 1357da424314SAndrzej Pietrasiewicz 135888af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget); 135988af8bbeSSebastian Andrzej Siewior return 0; 136088af8bbeSSebastian Andrzej Siewior 136188af8bbeSSebastian Andrzej Siewior err_purge_funcs: 136288af8bbeSSebastian Andrzej Siewior purge_configs_funcs(gi); 136388af8bbeSSebastian Andrzej Siewior err_comp_cleanup: 136488af8bbeSSebastian Andrzej Siewior composite_dev_cleanup(cdev); 136588af8bbeSSebastian Andrzej Siewior return ret; 136688af8bbeSSebastian Andrzej Siewior } 136788af8bbeSSebastian Andrzej Siewior 136888af8bbeSSebastian Andrzej Siewior static void configfs_composite_unbind(struct usb_gadget *gadget) 136988af8bbeSSebastian Andrzej Siewior { 137088af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev; 137188af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 137288af8bbeSSebastian Andrzej Siewior 137388af8bbeSSebastian Andrzej Siewior /* the gi->lock is hold by the caller */ 137488af8bbeSSebastian Andrzej Siewior 137588af8bbeSSebastian Andrzej Siewior cdev = get_gadget_data(gadget); 137688af8bbeSSebastian Andrzej Siewior gi = container_of(cdev, struct gadget_info, cdev); 137788af8bbeSSebastian Andrzej Siewior 137841ce84c8SLi Jun kfree(otg_desc[0]); 137941ce84c8SLi Jun otg_desc[0] = NULL; 138088af8bbeSSebastian Andrzej Siewior purge_configs_funcs(gi); 138188af8bbeSSebastian Andrzej Siewior composite_dev_cleanup(cdev); 138288af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget); 138388af8bbeSSebastian Andrzej Siewior cdev->gadget = NULL; 138488af8bbeSSebastian Andrzej Siewior set_gadget_data(gadget, NULL); 138588af8bbeSSebastian Andrzej Siewior } 138688af8bbeSSebastian Andrzej Siewior 138788af8bbeSSebastian Andrzej Siewior static const struct usb_gadget_driver configfs_driver_template = { 138888af8bbeSSebastian Andrzej Siewior .bind = configfs_composite_bind, 138988af8bbeSSebastian Andrzej Siewior .unbind = configfs_composite_unbind, 139088af8bbeSSebastian Andrzej Siewior 139188af8bbeSSebastian Andrzej Siewior .setup = composite_setup, 139202f751b4SPeter Chen .reset = composite_disconnect, 139388af8bbeSSebastian Andrzej Siewior .disconnect = composite_disconnect, 139488af8bbeSSebastian Andrzej Siewior 13953a571870SAndrzej Pietrasiewicz .suspend = composite_suspend, 13963a571870SAndrzej Pietrasiewicz .resume = composite_resume, 13973a571870SAndrzej Pietrasiewicz 139888af8bbeSSebastian Andrzej Siewior .max_speed = USB_SPEED_SUPER, 139988af8bbeSSebastian Andrzej Siewior .driver = { 140088af8bbeSSebastian Andrzej Siewior .owner = THIS_MODULE, 140188af8bbeSSebastian Andrzej Siewior .name = "configfs-gadget", 140288af8bbeSSebastian Andrzej Siewior }, 1403f1bddbb3SKrzysztof Opasiak .match_existing_only = 1, 140488af8bbeSSebastian Andrzej Siewior }; 140588af8bbeSSebastian Andrzej Siewior 140688af8bbeSSebastian Andrzej Siewior static struct config_group *gadgets_make( 140788af8bbeSSebastian Andrzej Siewior struct config_group *group, 140888af8bbeSSebastian Andrzej Siewior const char *name) 140988af8bbeSSebastian Andrzej Siewior { 141088af8bbeSSebastian Andrzej Siewior struct gadget_info *gi; 141188af8bbeSSebastian Andrzej Siewior 141288af8bbeSSebastian Andrzej Siewior gi = kzalloc(sizeof(*gi), GFP_KERNEL); 141388af8bbeSSebastian Andrzej Siewior if (!gi) 141488af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM); 141588af8bbeSSebastian Andrzej Siewior 14161ae1602dSChristoph Hellwig config_group_init_type_name(&gi->group, name, &gadget_root_type); 141788af8bbeSSebastian Andrzej Siewior 141888af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->functions_group, "functions", 141988af8bbeSSebastian Andrzej Siewior &functions_type); 14201ae1602dSChristoph Hellwig configfs_add_default_group(&gi->functions_group, &gi->group); 14211ae1602dSChristoph Hellwig 142288af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->configs_group, "configs", 142388af8bbeSSebastian Andrzej Siewior &config_desc_type); 14241ae1602dSChristoph Hellwig configfs_add_default_group(&gi->configs_group, &gi->group); 14251ae1602dSChristoph Hellwig 142688af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->strings_group, "strings", 142788af8bbeSSebastian Andrzej Siewior &gadget_strings_strings_type); 14281ae1602dSChristoph Hellwig configfs_add_default_group(&gi->strings_group, &gi->group); 14291ae1602dSChristoph Hellwig 143087213d38SAndrzej Pietrasiewicz config_group_init_type_name(&gi->os_desc_group, "os_desc", 143187213d38SAndrzej Pietrasiewicz &os_desc_type); 14321ae1602dSChristoph Hellwig configfs_add_default_group(&gi->os_desc_group, &gi->group); 143388af8bbeSSebastian Andrzej Siewior 143488af8bbeSSebastian Andrzej Siewior gi->composite.bind = configfs_do_nothing; 143588af8bbeSSebastian Andrzej Siewior gi->composite.unbind = configfs_do_nothing; 143688af8bbeSSebastian Andrzej Siewior gi->composite.suspend = NULL; 143788af8bbeSSebastian Andrzej Siewior gi->composite.resume = NULL; 143888af8bbeSSebastian Andrzej Siewior gi->composite.max_speed = USB_SPEED_SUPER; 143988af8bbeSSebastian Andrzej Siewior 144088af8bbeSSebastian Andrzej Siewior mutex_init(&gi->lock); 144188af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&gi->string_list); 144288af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&gi->available_func); 144388af8bbeSSebastian Andrzej Siewior 144488af8bbeSSebastian Andrzej Siewior composite_init_dev(&gi->cdev); 144588af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bLength = USB_DT_DEVICE_SIZE; 144688af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bDescriptorType = USB_DT_DEVICE; 144788af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bcdDevice = cpu_to_le16(get_default_bcdDevice()); 144888af8bbeSSebastian Andrzej Siewior 144988af8bbeSSebastian Andrzej Siewior gi->composite.gadget_driver = configfs_driver_template; 145088af8bbeSSebastian Andrzej Siewior 145188af8bbeSSebastian Andrzej Siewior gi->composite.gadget_driver.function = kstrdup(name, GFP_KERNEL); 145288af8bbeSSebastian Andrzej Siewior gi->composite.name = gi->composite.gadget_driver.function; 145388af8bbeSSebastian Andrzej Siewior 145488af8bbeSSebastian Andrzej Siewior if (!gi->composite.gadget_driver.function) 145588af8bbeSSebastian Andrzej Siewior goto err; 145688af8bbeSSebastian Andrzej Siewior 145788af8bbeSSebastian Andrzej Siewior return &gi->group; 145888af8bbeSSebastian Andrzej Siewior err: 145988af8bbeSSebastian Andrzej Siewior kfree(gi); 146088af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM); 146188af8bbeSSebastian Andrzej Siewior } 146288af8bbeSSebastian Andrzej Siewior 146388af8bbeSSebastian Andrzej Siewior static void gadgets_drop(struct config_group *group, struct config_item *item) 146488af8bbeSSebastian Andrzej Siewior { 146588af8bbeSSebastian Andrzej Siewior config_item_put(item); 146688af8bbeSSebastian Andrzej Siewior } 146788af8bbeSSebastian Andrzej Siewior 146888af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations gadgets_ops = { 146988af8bbeSSebastian Andrzej Siewior .make_group = &gadgets_make, 147088af8bbeSSebastian Andrzej Siewior .drop_item = &gadgets_drop, 147188af8bbeSSebastian Andrzej Siewior }; 147288af8bbeSSebastian Andrzej Siewior 147388af8bbeSSebastian Andrzej Siewior static struct config_item_type gadgets_type = { 147488af8bbeSSebastian Andrzej Siewior .ct_group_ops = &gadgets_ops, 147588af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE, 147688af8bbeSSebastian Andrzej Siewior }; 147788af8bbeSSebastian Andrzej Siewior 147888af8bbeSSebastian Andrzej Siewior static struct configfs_subsystem gadget_subsys = { 147988af8bbeSSebastian Andrzej Siewior .su_group = { 148088af8bbeSSebastian Andrzej Siewior .cg_item = { 148188af8bbeSSebastian Andrzej Siewior .ci_namebuf = "usb_gadget", 148288af8bbeSSebastian Andrzej Siewior .ci_type = &gadgets_type, 148388af8bbeSSebastian Andrzej Siewior }, 148488af8bbeSSebastian Andrzej Siewior }, 148588af8bbeSSebastian Andrzej Siewior .su_mutex = __MUTEX_INITIALIZER(gadget_subsys.su_mutex), 148688af8bbeSSebastian Andrzej Siewior }; 148788af8bbeSSebastian Andrzej Siewior 1488092a4bd0SAndrzej Pietrasiewicz void unregister_gadget_item(struct config_item *item) 1489092a4bd0SAndrzej Pietrasiewicz { 1490092a4bd0SAndrzej Pietrasiewicz struct gadget_info *gi = to_gadget_info(item); 1491092a4bd0SAndrzej Pietrasiewicz 1492cee51c33SWinter Wang mutex_lock(&gi->lock); 1493092a4bd0SAndrzej Pietrasiewicz unregister_gadget(gi); 1494cee51c33SWinter Wang mutex_unlock(&gi->lock); 1495092a4bd0SAndrzej Pietrasiewicz } 14960700faafSFelipe Balbi EXPORT_SYMBOL_GPL(unregister_gadget_item); 1497092a4bd0SAndrzej Pietrasiewicz 149888af8bbeSSebastian Andrzej Siewior static int __init gadget_cfs_init(void) 149988af8bbeSSebastian Andrzej Siewior { 150088af8bbeSSebastian Andrzej Siewior int ret; 150188af8bbeSSebastian Andrzej Siewior 150288af8bbeSSebastian Andrzej Siewior config_group_init(&gadget_subsys.su_group); 150388af8bbeSSebastian Andrzej Siewior 150488af8bbeSSebastian Andrzej Siewior ret = configfs_register_subsystem(&gadget_subsys); 150588af8bbeSSebastian Andrzej Siewior return ret; 150688af8bbeSSebastian Andrzej Siewior } 150788af8bbeSSebastian Andrzej Siewior module_init(gadget_cfs_init); 150888af8bbeSSebastian Andrzej Siewior 150988af8bbeSSebastian Andrzej Siewior static void __exit gadget_cfs_exit(void) 151088af8bbeSSebastian Andrzej Siewior { 151188af8bbeSSebastian Andrzej Siewior configfs_unregister_subsystem(&gadget_subsys); 151288af8bbeSSebastian Andrzej Siewior } 151388af8bbeSSebastian Andrzej Siewior module_exit(gadget_cfs_exit); 1514