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>
6a8bc8cc1SChristophe JAILLET #include <linux/kstrtox.h>
787213d38SAndrzej Pietrasiewicz #include <linux/nls.h>
888af8bbeSSebastian Andrzej Siewior #include <linux/usb/composite.h>
988af8bbeSSebastian Andrzej Siewior #include <linux/usb/gadget_configfs.h>
1093c47394SJó Ágila Bitsch #include <linux/usb/webusb.h>
110009e99aSRashika Kheria #include "configfs.h"
12da424314SAndrzej Pietrasiewicz #include "u_f.h"
137419485fSAndrzej Pietrasiewicz #include "u_os_desc.h"
1488af8bbeSSebastian Andrzej Siewior
check_user_usb_string(const char * name,struct usb_gadget_strings * stringtab_dev)1588af8bbeSSebastian Andrzej Siewior int check_user_usb_string(const char *name,
1688af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *stringtab_dev)
1788af8bbeSSebastian Andrzej Siewior {
1888af8bbeSSebastian Andrzej Siewior u16 num;
1988af8bbeSSebastian Andrzej Siewior int ret;
2088af8bbeSSebastian Andrzej Siewior
2188af8bbeSSebastian Andrzej Siewior ret = kstrtou16(name, 0, &num);
2288af8bbeSSebastian Andrzej Siewior if (ret)
2388af8bbeSSebastian Andrzej Siewior return ret;
2488af8bbeSSebastian Andrzej Siewior
2517309a6aSTao Ren if (!usb_validate_langid(num))
2688af8bbeSSebastian Andrzej Siewior return -EINVAL;
2788af8bbeSSebastian Andrzej Siewior
2888af8bbeSSebastian Andrzej Siewior stringtab_dev->language = num;
2988af8bbeSSebastian Andrzej Siewior return 0;
3088af8bbeSSebastian Andrzej Siewior }
3188af8bbeSSebastian Andrzej Siewior
3288af8bbeSSebastian Andrzej Siewior #define MAX_NAME_LEN 40
3388af8bbeSSebastian Andrzej Siewior #define MAX_USB_STRING_LANGS 2
3488af8bbeSSebastian Andrzej Siewior
3541ce84c8SLi Jun static const struct usb_descriptor_header *otg_desc[2];
3641ce84c8SLi Jun
3788af8bbeSSebastian Andrzej Siewior struct gadget_info {
3888af8bbeSSebastian Andrzej Siewior struct config_group group;
3988af8bbeSSebastian Andrzej Siewior struct config_group functions_group;
4088af8bbeSSebastian Andrzej Siewior struct config_group configs_group;
4188af8bbeSSebastian Andrzej Siewior struct config_group strings_group;
4287213d38SAndrzej Pietrasiewicz struct config_group os_desc_group;
4393c47394SJó Ágila Bitsch struct config_group webusb_group;
4488af8bbeSSebastian Andrzej Siewior
4588af8bbeSSebastian Andrzej Siewior struct mutex lock;
4688af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *gstrings[MAX_USB_STRING_LANGS + 1];
4788af8bbeSSebastian Andrzej Siewior struct list_head string_list;
4888af8bbeSSebastian Andrzej Siewior struct list_head available_func;
4988af8bbeSSebastian Andrzej Siewior
5088af8bbeSSebastian Andrzej Siewior struct usb_composite_driver composite;
5188af8bbeSSebastian Andrzej Siewior struct usb_composite_dev cdev;
5287213d38SAndrzej Pietrasiewicz bool use_os_desc;
5387213d38SAndrzej Pietrasiewicz char b_vendor_code;
5487213d38SAndrzej Pietrasiewicz char qw_sign[OS_STRING_QW_SIGN_LEN];
5593c47394SJó Ágila Bitsch bool use_webusb;
5693c47394SJó Ágila Bitsch u16 bcd_webusb_version;
5793c47394SJó Ágila Bitsch u8 b_webusb_vendor_code;
5893c47394SJó Ágila Bitsch char landing_page[WEBUSB_URL_RAW_MAX_LENGTH];
5993c47394SJó Ágila Bitsch
601a1c851bSPeter Chen spinlock_t spinlock;
611a1c851bSPeter Chen bool unbind;
6288af8bbeSSebastian Andrzej Siewior };
6388af8bbeSSebastian Andrzej Siewior
to_gadget_info(struct config_item * item)6445b6a73fSChristoph Hellwig static inline struct gadget_info *to_gadget_info(struct config_item *item)
6545b6a73fSChristoph Hellwig {
6645b6a73fSChristoph Hellwig return container_of(to_config_group(item), struct gadget_info, group);
6745b6a73fSChristoph Hellwig }
6845b6a73fSChristoph Hellwig
6988af8bbeSSebastian Andrzej Siewior struct config_usb_cfg {
7088af8bbeSSebastian Andrzej Siewior struct config_group group;
7188af8bbeSSebastian Andrzej Siewior struct config_group strings_group;
7288af8bbeSSebastian Andrzej Siewior struct list_head string_list;
7388af8bbeSSebastian Andrzej Siewior struct usb_configuration c;
7488af8bbeSSebastian Andrzej Siewior struct list_head func_list;
7588af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings *gstrings[MAX_USB_STRING_LANGS + 1];
7688af8bbeSSebastian Andrzej Siewior };
7788af8bbeSSebastian Andrzej Siewior
to_config_usb_cfg(struct config_item * item)7845b6a73fSChristoph Hellwig static inline struct config_usb_cfg *to_config_usb_cfg(struct config_item *item)
7945b6a73fSChristoph Hellwig {
8045b6a73fSChristoph Hellwig return container_of(to_config_group(item), struct config_usb_cfg,
8145b6a73fSChristoph Hellwig group);
8245b6a73fSChristoph Hellwig }
8345b6a73fSChristoph Hellwig
cfg_to_gadget_info(struct config_usb_cfg * cfg)84260d88b7SLinyu Yuan static inline struct gadget_info *cfg_to_gadget_info(struct config_usb_cfg *cfg)
85260d88b7SLinyu Yuan {
86260d88b7SLinyu Yuan return container_of(cfg->c.cdev, struct gadget_info, cdev);
87260d88b7SLinyu Yuan }
88260d88b7SLinyu Yuan
896e2a512dSDaniel Scally struct gadget_language {
9088af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings stringtab_dev;
9188af8bbeSSebastian Andrzej Siewior struct usb_string strings[USB_GADGET_FIRST_AVAIL_IDX];
9288af8bbeSSebastian Andrzej Siewior char *manufacturer;
9388af8bbeSSebastian Andrzej Siewior char *product;
9488af8bbeSSebastian Andrzej Siewior char *serialnumber;
9588af8bbeSSebastian Andrzej Siewior
9688af8bbeSSebastian Andrzej Siewior struct config_group group;
9788af8bbeSSebastian Andrzej Siewior struct list_head list;
9815a7cf8cSDaniel Scally struct list_head gadget_strings;
9915a7cf8cSDaniel Scally unsigned int nstrings;
10088af8bbeSSebastian Andrzej Siewior };
10188af8bbeSSebastian Andrzej Siewior
10288af8bbeSSebastian Andrzej Siewior struct gadget_config_name {
10388af8bbeSSebastian Andrzej Siewior struct usb_gadget_strings stringtab_dev;
10488af8bbeSSebastian Andrzej Siewior struct usb_string strings;
10588af8bbeSSebastian Andrzej Siewior char *configuration;
10688af8bbeSSebastian Andrzej Siewior
10788af8bbeSSebastian Andrzej Siewior struct config_group group;
10888af8bbeSSebastian Andrzej Siewior struct list_head list;
10988af8bbeSSebastian Andrzej Siewior };
11088af8bbeSSebastian Andrzej Siewior
11198f153a1SJim Lin #define USB_MAX_STRING_WITH_NULL_LEN (USB_MAX_STRING_LEN+1)
11298f153a1SJim Lin
usb_string_copy(const char * s,char ** s_copy)11388af8bbeSSebastian Andrzej Siewior static int usb_string_copy(const char *s, char **s_copy)
11488af8bbeSSebastian Andrzej Siewior {
11588af8bbeSSebastian Andrzej Siewior int ret;
11688af8bbeSSebastian Andrzej Siewior char *str;
11788af8bbeSSebastian Andrzej Siewior char *copy = *s_copy;
118*6d3c721eSLee Jones
11988af8bbeSSebastian Andrzej Siewior ret = strlen(s);
12081c74628SMacpaul Lin if (ret > USB_MAX_STRING_LEN)
12188af8bbeSSebastian Andrzej Siewior return -EOVERFLOW;
122*6d3c721eSLee Jones if (ret < 1)
123*6d3c721eSLee Jones return -EINVAL;
12488af8bbeSSebastian Andrzej Siewior
12598f153a1SJim Lin if (copy) {
12698f153a1SJim Lin str = copy;
12798f153a1SJim Lin } else {
12898f153a1SJim Lin str = kmalloc(USB_MAX_STRING_WITH_NULL_LEN, GFP_KERNEL);
12988af8bbeSSebastian Andrzej Siewior if (!str)
13088af8bbeSSebastian Andrzej Siewior return -ENOMEM;
13198f153a1SJim Lin }
13298f153a1SJim Lin strcpy(str, s);
13388af8bbeSSebastian Andrzej Siewior if (str[ret - 1] == '\n')
13488af8bbeSSebastian Andrzej Siewior str[ret - 1] = '\0';
13588af8bbeSSebastian Andrzej Siewior *s_copy = str;
13688af8bbeSSebastian Andrzej Siewior return 0;
13788af8bbeSSebastian Andrzej Siewior }
13888af8bbeSSebastian Andrzej Siewior
13988af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_R_u8(__name) \
14045b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##__name##_show(struct config_item *item, \
14188af8bbeSSebastian Andrzej Siewior char *page) \
14288af8bbeSSebastian Andrzej Siewior { \
14345b6a73fSChristoph Hellwig return sprintf(page, "0x%02x\n", \
14445b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.__name); \
14588af8bbeSSebastian Andrzej Siewior }
14688af8bbeSSebastian Andrzej Siewior
14788af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_R_u16(__name) \
14845b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##__name##_show(struct config_item *item, \
14988af8bbeSSebastian Andrzej Siewior char *page) \
15088af8bbeSSebastian Andrzej Siewior { \
15145b6a73fSChristoph Hellwig return sprintf(page, "0x%04x\n", \
15245b6a73fSChristoph Hellwig le16_to_cpup(&to_gadget_info(item)->cdev.desc.__name)); \
15388af8bbeSSebastian Andrzej Siewior }
15488af8bbeSSebastian Andrzej Siewior
15588af8bbeSSebastian Andrzej Siewior
15688af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_W_u8(_name) \
15745b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##_name##_store(struct config_item *item, \
15888af8bbeSSebastian Andrzej Siewior const char *page, size_t len) \
15988af8bbeSSebastian Andrzej Siewior { \
16088af8bbeSSebastian Andrzej Siewior u8 val; \
16188af8bbeSSebastian Andrzej Siewior int ret; \
16288af8bbeSSebastian Andrzej Siewior ret = kstrtou8(page, 0, &val); \
16388af8bbeSSebastian Andrzej Siewior if (ret) \
16488af8bbeSSebastian Andrzej Siewior return ret; \
16545b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc._name = val; \
16688af8bbeSSebastian Andrzej Siewior return len; \
16788af8bbeSSebastian Andrzej Siewior }
16888af8bbeSSebastian Andrzej Siewior
16988af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_W_u16(_name) \
17045b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_##_name##_store(struct config_item *item, \
17188af8bbeSSebastian Andrzej Siewior const char *page, size_t len) \
17288af8bbeSSebastian Andrzej Siewior { \
17388af8bbeSSebastian Andrzej Siewior u16 val; \
17488af8bbeSSebastian Andrzej Siewior int ret; \
17588af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &val); \
17688af8bbeSSebastian Andrzej Siewior if (ret) \
17788af8bbeSSebastian Andrzej Siewior return ret; \
17845b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc._name = cpu_to_le16p(&val); \
17988af8bbeSSebastian Andrzej Siewior return len; \
18088af8bbeSSebastian Andrzej Siewior }
18188af8bbeSSebastian Andrzej Siewior
18288af8bbeSSebastian Andrzej Siewior #define GI_DEVICE_DESC_SIMPLE_RW(_name, _type) \
18388af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_##_type(_name) \
18488af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_W_##_type(_name)
18588af8bbeSSebastian Andrzej Siewior
18688af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_u16(bcdUSB);
18788af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceClass, u8);
18888af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceSubClass, u8);
18988af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bDeviceProtocol, u8);
19088af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(bMaxPacketSize0, u8);
19188af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(idVendor, u16);
19288af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_RW(idProduct, u16);
19388af8bbeSSebastian Andrzej Siewior GI_DEVICE_DESC_SIMPLE_R_u16(bcdDevice);
19488af8bbeSSebastian Andrzej Siewior
is_valid_bcd(u16 bcd_val)19588af8bbeSSebastian Andrzej Siewior static ssize_t is_valid_bcd(u16 bcd_val)
19688af8bbeSSebastian Andrzej Siewior {
19788af8bbeSSebastian Andrzej Siewior if ((bcd_val & 0xf) > 9)
19888af8bbeSSebastian Andrzej Siewior return -EINVAL;
19988af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 4) & 0xf) > 9)
20088af8bbeSSebastian Andrzej Siewior return -EINVAL;
20188af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 8) & 0xf) > 9)
20288af8bbeSSebastian Andrzej Siewior return -EINVAL;
20388af8bbeSSebastian Andrzej Siewior if (((bcd_val >> 12) & 0xf) > 9)
20488af8bbeSSebastian Andrzej Siewior return -EINVAL;
20588af8bbeSSebastian Andrzej Siewior return 0;
20688af8bbeSSebastian Andrzej Siewior }
20788af8bbeSSebastian Andrzej Siewior
gadget_dev_desc_bcdDevice_store(struct config_item * item,const char * page,size_t len)20845b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_bcdDevice_store(struct config_item *item,
20988af8bbeSSebastian Andrzej Siewior const char *page, size_t len)
21088af8bbeSSebastian Andrzej Siewior {
21188af8bbeSSebastian Andrzej Siewior u16 bcdDevice;
21288af8bbeSSebastian Andrzej Siewior int ret;
21388af8bbeSSebastian Andrzej Siewior
21488af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &bcdDevice);
21588af8bbeSSebastian Andrzej Siewior if (ret)
21688af8bbeSSebastian Andrzej Siewior return ret;
21788af8bbeSSebastian Andrzej Siewior ret = is_valid_bcd(bcdDevice);
21888af8bbeSSebastian Andrzej Siewior if (ret)
21988af8bbeSSebastian Andrzej Siewior return ret;
22088af8bbeSSebastian Andrzej Siewior
22145b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.bcdDevice = cpu_to_le16(bcdDevice);
22288af8bbeSSebastian Andrzej Siewior return len;
22388af8bbeSSebastian Andrzej Siewior }
22488af8bbeSSebastian Andrzej Siewior
gadget_dev_desc_bcdUSB_store(struct config_item * item,const char * page,size_t len)22545b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_bcdUSB_store(struct config_item *item,
22688af8bbeSSebastian Andrzej Siewior const char *page, size_t len)
22788af8bbeSSebastian Andrzej Siewior {
22888af8bbeSSebastian Andrzej Siewior u16 bcdUSB;
22988af8bbeSSebastian Andrzej Siewior int ret;
23088af8bbeSSebastian Andrzej Siewior
23188af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &bcdUSB);
23288af8bbeSSebastian Andrzej Siewior if (ret)
23388af8bbeSSebastian Andrzej Siewior return ret;
23488af8bbeSSebastian Andrzej Siewior ret = is_valid_bcd(bcdUSB);
23588af8bbeSSebastian Andrzej Siewior if (ret)
23688af8bbeSSebastian Andrzej Siewior return ret;
23788af8bbeSSebastian Andrzej Siewior
23845b6a73fSChristoph Hellwig to_gadget_info(item)->cdev.desc.bcdUSB = cpu_to_le16(bcdUSB);
23988af8bbeSSebastian Andrzej Siewior return len;
24088af8bbeSSebastian Andrzej Siewior }
24188af8bbeSSebastian Andrzej Siewior
gadget_dev_desc_UDC_show(struct config_item * item,char * page)24245b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_UDC_show(struct config_item *item, char *page)
24388af8bbeSSebastian Andrzej Siewior {
24464e6bbffSEddie Hung struct gadget_info *gi = to_gadget_info(item);
24564e6bbffSEddie Hung char *udc_name;
24664e6bbffSEddie Hung int ret;
247afdaadc3SRuslan Bilovol
24864e6bbffSEddie Hung mutex_lock(&gi->lock);
24964e6bbffSEddie Hung udc_name = gi->composite.gadget_driver.udc_name;
25064e6bbffSEddie Hung ret = sprintf(page, "%s\n", udc_name ?: "");
25164e6bbffSEddie Hung mutex_unlock(&gi->lock);
25264e6bbffSEddie Hung
25364e6bbffSEddie Hung return ret;
25488af8bbeSSebastian Andrzej Siewior }
25588af8bbeSSebastian Andrzej Siewior
unregister_gadget(struct gadget_info * gi)25688af8bbeSSebastian Andrzej Siewior static int unregister_gadget(struct gadget_info *gi)
25788af8bbeSSebastian Andrzej Siewior {
25888af8bbeSSebastian Andrzej Siewior int ret;
25988af8bbeSSebastian Andrzej Siewior
260afdaadc3SRuslan Bilovol if (!gi->composite.gadget_driver.udc_name)
26188af8bbeSSebastian Andrzej Siewior return -ENODEV;
26288af8bbeSSebastian Andrzej Siewior
26388af8bbeSSebastian Andrzej Siewior ret = usb_gadget_unregister_driver(&gi->composite.gadget_driver);
26488af8bbeSSebastian Andrzej Siewior if (ret)
26588af8bbeSSebastian Andrzej Siewior return ret;
266afdaadc3SRuslan Bilovol kfree(gi->composite.gadget_driver.udc_name);
267afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = NULL;
26888af8bbeSSebastian Andrzej Siewior return 0;
26988af8bbeSSebastian Andrzej Siewior }
27088af8bbeSSebastian Andrzej Siewior
gadget_dev_desc_UDC_store(struct config_item * item,const char * page,size_t len)27145b6a73fSChristoph Hellwig static ssize_t gadget_dev_desc_UDC_store(struct config_item *item,
27288af8bbeSSebastian Andrzej Siewior const char *page, size_t len)
27388af8bbeSSebastian Andrzej Siewior {
27445b6a73fSChristoph Hellwig struct gadget_info *gi = to_gadget_info(item);
27588af8bbeSSebastian Andrzej Siewior char *name;
27688af8bbeSSebastian Andrzej Siewior int ret;
27788af8bbeSSebastian Andrzej Siewior
27815753588SKyungtae Kim if (strlen(page) < len)
27915753588SKyungtae Kim return -EOVERFLOW;
28015753588SKyungtae Kim
28188af8bbeSSebastian Andrzej Siewior name = kstrdup(page, GFP_KERNEL);
28288af8bbeSSebastian Andrzej Siewior if (!name)
28388af8bbeSSebastian Andrzej Siewior return -ENOMEM;
28488af8bbeSSebastian Andrzej Siewior if (name[len - 1] == '\n')
28588af8bbeSSebastian Andrzej Siewior name[len - 1] = '\0';
28688af8bbeSSebastian Andrzej Siewior
28788af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock);
28888af8bbeSSebastian Andrzej Siewior
28988af8bbeSSebastian Andrzej Siewior if (!strlen(name)) {
29088af8bbeSSebastian Andrzej Siewior ret = unregister_gadget(gi);
29188af8bbeSSebastian Andrzej Siewior if (ret)
29288af8bbeSSebastian Andrzej Siewior goto err;
29338355b2aSJohn Keeping kfree(name);
29488af8bbeSSebastian Andrzej Siewior } else {
295afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name) {
29688af8bbeSSebastian Andrzej Siewior ret = -EBUSY;
29788af8bbeSSebastian Andrzej Siewior goto err;
29888af8bbeSSebastian Andrzej Siewior }
299afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = name;
300af1969a2SAlan Stern ret = usb_gadget_register_driver(&gi->composite.gadget_driver);
301afdaadc3SRuslan Bilovol if (ret) {
302afdaadc3SRuslan Bilovol gi->composite.gadget_driver.udc_name = NULL;
30388af8bbeSSebastian Andrzej Siewior goto err;
304afdaadc3SRuslan Bilovol }
30588af8bbeSSebastian Andrzej Siewior }
30688af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock);
30788af8bbeSSebastian Andrzej Siewior return len;
30888af8bbeSSebastian Andrzej Siewior err:
30988af8bbeSSebastian Andrzej Siewior kfree(name);
31088af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock);
31188af8bbeSSebastian Andrzej Siewior return ret;
31288af8bbeSSebastian Andrzej Siewior }
31388af8bbeSSebastian Andrzej Siewior
gadget_dev_desc_max_speed_show(struct config_item * item,char * page)314a0249703SThinh Nguyen static ssize_t gadget_dev_desc_max_speed_show(struct config_item *item,
315a0249703SThinh Nguyen char *page)
316a0249703SThinh Nguyen {
317a0249703SThinh Nguyen enum usb_device_speed speed = to_gadget_info(item)->composite.max_speed;
318a0249703SThinh Nguyen
319a0249703SThinh Nguyen return sprintf(page, "%s\n", usb_speed_string(speed));
320a0249703SThinh Nguyen }
321a0249703SThinh Nguyen
gadget_dev_desc_max_speed_store(struct config_item * item,const char * page,size_t len)322a0249703SThinh Nguyen static ssize_t gadget_dev_desc_max_speed_store(struct config_item *item,
323a0249703SThinh Nguyen const char *page, size_t len)
324a0249703SThinh Nguyen {
325a0249703SThinh Nguyen struct gadget_info *gi = to_gadget_info(item);
326a0249703SThinh Nguyen
327a0249703SThinh Nguyen mutex_lock(&gi->lock);
328a0249703SThinh Nguyen
329a0249703SThinh Nguyen /* Prevent changing of max_speed after the driver is binded */
330a0249703SThinh Nguyen if (gi->composite.gadget_driver.udc_name)
331a0249703SThinh Nguyen goto err;
332a0249703SThinh Nguyen
333a0249703SThinh Nguyen if (strncmp(page, "super-speed-plus", 16) == 0)
334a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_SUPER_PLUS;
335a0249703SThinh Nguyen else if (strncmp(page, "super-speed", 11) == 0)
336a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_SUPER;
337a0249703SThinh Nguyen else if (strncmp(page, "high-speed", 10) == 0)
338a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_HIGH;
339a0249703SThinh Nguyen else if (strncmp(page, "full-speed", 10) == 0)
340a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_FULL;
341a0249703SThinh Nguyen else if (strncmp(page, "low-speed", 9) == 0)
342a0249703SThinh Nguyen gi->composite.max_speed = USB_SPEED_LOW;
343a0249703SThinh Nguyen else
344a0249703SThinh Nguyen goto err;
345a0249703SThinh Nguyen
346a0249703SThinh Nguyen gi->composite.gadget_driver.max_speed = gi->composite.max_speed;
347a0249703SThinh Nguyen
348a0249703SThinh Nguyen mutex_unlock(&gi->lock);
349a0249703SThinh Nguyen return len;
350a0249703SThinh Nguyen err:
351a0249703SThinh Nguyen mutex_unlock(&gi->lock);
352a0249703SThinh Nguyen return -EINVAL;
353a0249703SThinh Nguyen }
354a0249703SThinh Nguyen
35545b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceClass);
35645b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceSubClass);
35745b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bDeviceProtocol);
35845b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bMaxPacketSize0);
35945b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, idVendor);
36045b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, idProduct);
36145b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bcdDevice);
36245b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, bcdUSB);
36345b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_dev_desc_, UDC);
364a0249703SThinh Nguyen CONFIGFS_ATTR(gadget_dev_desc_, max_speed);
36588af8bbeSSebastian Andrzej Siewior
36688af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_root_attrs[] = {
36745b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceClass,
36845b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceSubClass,
36945b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bDeviceProtocol,
37045b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bMaxPacketSize0,
37145b6a73fSChristoph Hellwig &gadget_dev_desc_attr_idVendor,
37245b6a73fSChristoph Hellwig &gadget_dev_desc_attr_idProduct,
37345b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bcdDevice,
37445b6a73fSChristoph Hellwig &gadget_dev_desc_attr_bcdUSB,
37545b6a73fSChristoph Hellwig &gadget_dev_desc_attr_UDC,
376a0249703SThinh Nguyen &gadget_dev_desc_attr_max_speed,
37788af8bbeSSebastian Andrzej Siewior NULL,
37888af8bbeSSebastian Andrzej Siewior };
37988af8bbeSSebastian Andrzej Siewior
to_gadget_language(struct config_item * item)3806e2a512dSDaniel Scally static inline struct gadget_language *to_gadget_language(struct config_item *item)
38188af8bbeSSebastian Andrzej Siewior {
3826e2a512dSDaniel Scally return container_of(to_config_group(item), struct gadget_language,
38388af8bbeSSebastian Andrzej Siewior group);
38488af8bbeSSebastian Andrzej Siewior }
38588af8bbeSSebastian Andrzej Siewior
to_gadget_config_name(struct config_item * item)38688af8bbeSSebastian Andrzej Siewior static inline struct gadget_config_name *to_gadget_config_name(
38788af8bbeSSebastian Andrzej Siewior struct config_item *item)
38888af8bbeSSebastian Andrzej Siewior {
38988af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item), struct gadget_config_name,
39088af8bbeSSebastian Andrzej Siewior group);
39188af8bbeSSebastian Andrzej Siewior }
39288af8bbeSSebastian Andrzej Siewior
to_usb_function_instance(struct config_item * item)39388af8bbeSSebastian Andrzej Siewior static inline struct usb_function_instance *to_usb_function_instance(
39488af8bbeSSebastian Andrzej Siewior struct config_item *item)
39588af8bbeSSebastian Andrzej Siewior {
39688af8bbeSSebastian Andrzej Siewior return container_of(to_config_group(item),
39788af8bbeSSebastian Andrzej Siewior struct usb_function_instance, group);
39888af8bbeSSebastian Andrzej Siewior }
39988af8bbeSSebastian Andrzej Siewior
gadget_info_attr_release(struct config_item * item)40088af8bbeSSebastian Andrzej Siewior static void gadget_info_attr_release(struct config_item *item)
40188af8bbeSSebastian Andrzej Siewior {
40288af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = to_gadget_info(item);
40388af8bbeSSebastian Andrzej Siewior
40488af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->cdev.configs));
40588af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->string_list));
40688af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&gi->available_func));
40788af8bbeSSebastian Andrzej Siewior kfree(gi->composite.gadget_driver.function);
4087c075538SChanh Nguyen kfree(gi->composite.gadget_driver.driver.name);
40988af8bbeSSebastian Andrzej Siewior kfree(gi);
41088af8bbeSSebastian Andrzej Siewior }
41188af8bbeSSebastian Andrzej Siewior
41288af8bbeSSebastian Andrzej Siewior static struct configfs_item_operations gadget_root_item_ops = {
41388af8bbeSSebastian Andrzej Siewior .release = gadget_info_attr_release,
41488af8bbeSSebastian Andrzej Siewior };
41588af8bbeSSebastian Andrzej Siewior
gadget_config_attr_release(struct config_item * item)41688af8bbeSSebastian Andrzej Siewior static void gadget_config_attr_release(struct config_item *item)
41788af8bbeSSebastian Andrzej Siewior {
41888af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(item);
41988af8bbeSSebastian Andrzej Siewior
42088af8bbeSSebastian Andrzej Siewior WARN_ON(!list_empty(&cfg->c.functions));
42188af8bbeSSebastian Andrzej Siewior list_del(&cfg->c.list);
42288af8bbeSSebastian Andrzej Siewior kfree(cfg->c.label);
42388af8bbeSSebastian Andrzej Siewior kfree(cfg);
42488af8bbeSSebastian Andrzej Siewior }
42588af8bbeSSebastian Andrzej Siewior
config_usb_cfg_link(struct config_item * usb_cfg_ci,struct config_item * usb_func_ci)42688af8bbeSSebastian Andrzej Siewior static int config_usb_cfg_link(
42788af8bbeSSebastian Andrzej Siewior struct config_item *usb_cfg_ci,
42888af8bbeSSebastian Andrzej Siewior struct config_item *usb_func_ci)
42988af8bbeSSebastian Andrzej Siewior {
43088af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(usb_cfg_ci);
431260d88b7SLinyu Yuan struct gadget_info *gi = cfg_to_gadget_info(cfg);
43288af8bbeSSebastian Andrzej Siewior
4335284acccSLinyu Yuan struct usb_function_instance *fi =
4345284acccSLinyu Yuan to_usb_function_instance(usb_func_ci);
43536f4c25cSJakob Koschel struct usb_function_instance *a_fi = NULL, *iter;
43688af8bbeSSebastian Andrzej Siewior struct usb_function *f;
43788af8bbeSSebastian Andrzej Siewior int ret;
43888af8bbeSSebastian Andrzej Siewior
43988af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock);
44088af8bbeSSebastian Andrzej Siewior /*
44188af8bbeSSebastian Andrzej Siewior * Make sure this function is from within our _this_ gadget and not
44288af8bbeSSebastian Andrzej Siewior * from another gadget or a random directory.
44388af8bbeSSebastian Andrzej Siewior * Also a function instance can only be linked once.
44488af8bbeSSebastian Andrzej Siewior */
44589e7252dSUdipto Goswami
44689e7252dSUdipto Goswami if (gi->composite.gadget_driver.udc_name) {
44789e7252dSUdipto Goswami ret = -EINVAL;
44889e7252dSUdipto Goswami goto out;
44989e7252dSUdipto Goswami }
45089e7252dSUdipto Goswami
45136f4c25cSJakob Koschel list_for_each_entry(iter, &gi->available_func, cfs_list) {
45236f4c25cSJakob Koschel if (iter != fi)
45336f4c25cSJakob Koschel continue;
45436f4c25cSJakob Koschel a_fi = iter;
45588af8bbeSSebastian Andrzej Siewior break;
45688af8bbeSSebastian Andrzej Siewior }
45736f4c25cSJakob Koschel if (!a_fi) {
45888af8bbeSSebastian Andrzej Siewior ret = -EINVAL;
45988af8bbeSSebastian Andrzej Siewior goto out;
46088af8bbeSSebastian Andrzej Siewior }
46188af8bbeSSebastian Andrzej Siewior
46288af8bbeSSebastian Andrzej Siewior list_for_each_entry(f, &cfg->func_list, list) {
46388af8bbeSSebastian Andrzej Siewior if (f->fi == fi) {
46488af8bbeSSebastian Andrzej Siewior ret = -EEXIST;
46588af8bbeSSebastian Andrzej Siewior goto out;
46688af8bbeSSebastian Andrzej Siewior }
46788af8bbeSSebastian Andrzej Siewior }
46888af8bbeSSebastian Andrzej Siewior
46988af8bbeSSebastian Andrzej Siewior f = usb_get_function(fi);
47088af8bbeSSebastian Andrzej Siewior if (IS_ERR(f)) {
47188af8bbeSSebastian Andrzej Siewior ret = PTR_ERR(f);
47288af8bbeSSebastian Andrzej Siewior goto out;
47388af8bbeSSebastian Andrzej Siewior }
47488af8bbeSSebastian Andrzej Siewior
47588af8bbeSSebastian Andrzej Siewior /* stash the function until we bind it to the gadget */
47688af8bbeSSebastian Andrzej Siewior list_add_tail(&f->list, &cfg->func_list);
47788af8bbeSSebastian Andrzej Siewior ret = 0;
47888af8bbeSSebastian Andrzej Siewior out:
47988af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock);
48088af8bbeSSebastian Andrzej Siewior return ret;
48188af8bbeSSebastian Andrzej Siewior }
48288af8bbeSSebastian Andrzej Siewior
config_usb_cfg_unlink(struct config_item * usb_cfg_ci,struct config_item * usb_func_ci)483e16769d4SAndrzej Pietrasiewicz static void config_usb_cfg_unlink(
48488af8bbeSSebastian Andrzej Siewior struct config_item *usb_cfg_ci,
48588af8bbeSSebastian Andrzej Siewior struct config_item *usb_func_ci)
48688af8bbeSSebastian Andrzej Siewior {
48788af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg = to_config_usb_cfg(usb_cfg_ci);
488260d88b7SLinyu Yuan struct gadget_info *gi = cfg_to_gadget_info(cfg);
48988af8bbeSSebastian Andrzej Siewior
4905284acccSLinyu Yuan struct usb_function_instance *fi =
4915284acccSLinyu Yuan to_usb_function_instance(usb_func_ci);
49288af8bbeSSebastian Andrzej Siewior struct usb_function *f;
49388af8bbeSSebastian Andrzej Siewior
49488af8bbeSSebastian Andrzej Siewior /*
49588af8bbeSSebastian Andrzej Siewior * ideally I would like to forbid to unlink functions while a gadget is
49688af8bbeSSebastian Andrzej Siewior * bound to an UDC. Since this isn't possible at the moment, we simply
49788af8bbeSSebastian Andrzej Siewior * force an unbind, the function is available here and then we can
49888af8bbeSSebastian Andrzej Siewior * remove the function.
49988af8bbeSSebastian Andrzej Siewior */
50088af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock);
501afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name)
50288af8bbeSSebastian Andrzej Siewior unregister_gadget(gi);
503afdaadc3SRuslan Bilovol WARN_ON(gi->composite.gadget_driver.udc_name);
50488af8bbeSSebastian Andrzej Siewior
50588af8bbeSSebastian Andrzej Siewior list_for_each_entry(f, &cfg->func_list, list) {
50688af8bbeSSebastian Andrzej Siewior if (f->fi == fi) {
50788af8bbeSSebastian Andrzej Siewior list_del(&f->list);
50888af8bbeSSebastian Andrzej Siewior usb_put_function(f);
50988af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock);
510e16769d4SAndrzej Pietrasiewicz return;
51188af8bbeSSebastian Andrzej Siewior }
51288af8bbeSSebastian Andrzej Siewior }
51388af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock);
51475bfe23aSDavid Rientjes WARN(1, "Unable to locate function to unbind\n");
51588af8bbeSSebastian Andrzej Siewior }
51688af8bbeSSebastian Andrzej Siewior
51788af8bbeSSebastian Andrzej Siewior static struct configfs_item_operations gadget_config_item_ops = {
51888af8bbeSSebastian Andrzej Siewior .release = gadget_config_attr_release,
51988af8bbeSSebastian Andrzej Siewior .allow_link = config_usb_cfg_link,
52088af8bbeSSebastian Andrzej Siewior .drop_link = config_usb_cfg_unlink,
52188af8bbeSSebastian Andrzej Siewior };
52288af8bbeSSebastian Andrzej Siewior
52388af8bbeSSebastian Andrzej Siewior
gadget_config_desc_MaxPower_show(struct config_item * item,char * page)52445b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_MaxPower_show(struct config_item *item,
52588af8bbeSSebastian Andrzej Siewior char *page)
52688af8bbeSSebastian Andrzej Siewior {
527c26f1c10SLinyu Yuan struct config_usb_cfg *cfg = to_config_usb_cfg(item);
528c26f1c10SLinyu Yuan
529c26f1c10SLinyu Yuan return sprintf(page, "%u\n", cfg->c.MaxPower);
53088af8bbeSSebastian Andrzej Siewior }
53188af8bbeSSebastian Andrzej Siewior
gadget_config_desc_MaxPower_store(struct config_item * item,const char * page,size_t len)53245b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_MaxPower_store(struct config_item *item,
53388af8bbeSSebastian Andrzej Siewior const char *page, size_t len)
53488af8bbeSSebastian Andrzej Siewior {
535c26f1c10SLinyu Yuan struct config_usb_cfg *cfg = to_config_usb_cfg(item);
53688af8bbeSSebastian Andrzej Siewior u16 val;
53788af8bbeSSebastian Andrzej Siewior int ret;
53888af8bbeSSebastian Andrzej Siewior ret = kstrtou16(page, 0, &val);
53988af8bbeSSebastian Andrzej Siewior if (ret)
54088af8bbeSSebastian Andrzej Siewior return ret;
54188af8bbeSSebastian Andrzej Siewior if (DIV_ROUND_UP(val, 8) > 0xff)
54288af8bbeSSebastian Andrzej Siewior return -ERANGE;
543c26f1c10SLinyu Yuan cfg->c.MaxPower = val;
54488af8bbeSSebastian Andrzej Siewior return len;
54588af8bbeSSebastian Andrzej Siewior }
54688af8bbeSSebastian Andrzej Siewior
gadget_config_desc_bmAttributes_show(struct config_item * item,char * page)54745b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_bmAttributes_show(struct config_item *item,
54888af8bbeSSebastian Andrzej Siewior char *page)
54988af8bbeSSebastian Andrzej Siewior {
550c26f1c10SLinyu Yuan struct config_usb_cfg *cfg = to_config_usb_cfg(item);
551c26f1c10SLinyu Yuan
552c26f1c10SLinyu Yuan return sprintf(page, "0x%02x\n", cfg->c.bmAttributes);
55388af8bbeSSebastian Andrzej Siewior }
55488af8bbeSSebastian Andrzej Siewior
gadget_config_desc_bmAttributes_store(struct config_item * item,const char * page,size_t len)55545b6a73fSChristoph Hellwig static ssize_t gadget_config_desc_bmAttributes_store(struct config_item *item,
55688af8bbeSSebastian Andrzej Siewior const char *page, size_t len)
55788af8bbeSSebastian Andrzej Siewior {
558c26f1c10SLinyu Yuan struct config_usb_cfg *cfg = to_config_usb_cfg(item);
55988af8bbeSSebastian Andrzej Siewior u8 val;
56088af8bbeSSebastian Andrzej Siewior int ret;
56188af8bbeSSebastian Andrzej Siewior ret = kstrtou8(page, 0, &val);
56288af8bbeSSebastian Andrzej Siewior if (ret)
56388af8bbeSSebastian Andrzej Siewior return ret;
56488af8bbeSSebastian Andrzej Siewior if (!(val & USB_CONFIG_ATT_ONE))
56588af8bbeSSebastian Andrzej Siewior return -EINVAL;
56688af8bbeSSebastian Andrzej Siewior if (val & ~(USB_CONFIG_ATT_ONE | USB_CONFIG_ATT_SELFPOWER |
56788af8bbeSSebastian Andrzej Siewior USB_CONFIG_ATT_WAKEUP))
56888af8bbeSSebastian Andrzej Siewior return -EINVAL;
569c26f1c10SLinyu Yuan cfg->c.bmAttributes = val;
57088af8bbeSSebastian Andrzej Siewior return len;
57188af8bbeSSebastian Andrzej Siewior }
57288af8bbeSSebastian Andrzej Siewior
57345b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_config_desc_, MaxPower);
57445b6a73fSChristoph Hellwig CONFIGFS_ATTR(gadget_config_desc_, bmAttributes);
57588af8bbeSSebastian Andrzej Siewior
57688af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_config_attrs[] = {
57745b6a73fSChristoph Hellwig &gadget_config_desc_attr_MaxPower,
57845b6a73fSChristoph Hellwig &gadget_config_desc_attr_bmAttributes,
57988af8bbeSSebastian Andrzej Siewior NULL,
58088af8bbeSSebastian Andrzej Siewior };
58188af8bbeSSebastian Andrzej Siewior
5824ad01412SBhumika Goyal static const struct config_item_type gadget_config_type = {
58388af8bbeSSebastian Andrzej Siewior .ct_item_ops = &gadget_config_item_ops,
58488af8bbeSSebastian Andrzej Siewior .ct_attrs = gadget_config_attrs,
58588af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE,
58688af8bbeSSebastian Andrzej Siewior };
58788af8bbeSSebastian Andrzej Siewior
5884ad01412SBhumika Goyal static const struct config_item_type gadget_root_type = {
58988af8bbeSSebastian Andrzej Siewior .ct_item_ops = &gadget_root_item_ops,
59088af8bbeSSebastian Andrzej Siewior .ct_attrs = gadget_root_attrs,
59188af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE,
59288af8bbeSSebastian Andrzej Siewior };
59388af8bbeSSebastian Andrzej Siewior
composite_init_dev(struct usb_composite_dev * cdev)59488af8bbeSSebastian Andrzej Siewior static void composite_init_dev(struct usb_composite_dev *cdev)
59588af8bbeSSebastian Andrzej Siewior {
59688af8bbeSSebastian Andrzej Siewior spin_lock_init(&cdev->lock);
59788af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cdev->configs);
59888af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cdev->gstrings);
59988af8bbeSSebastian Andrzej Siewior }
60088af8bbeSSebastian Andrzej Siewior
function_make(struct config_group * group,const char * name)60188af8bbeSSebastian Andrzej Siewior static struct config_group *function_make(
60288af8bbeSSebastian Andrzej Siewior struct config_group *group,
60388af8bbeSSebastian Andrzej Siewior const char *name)
60488af8bbeSSebastian Andrzej Siewior {
60588af8bbeSSebastian Andrzej Siewior struct gadget_info *gi;
60688af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi;
60788af8bbeSSebastian Andrzej Siewior char buf[MAX_NAME_LEN];
60888af8bbeSSebastian Andrzej Siewior char *func_name;
60988af8bbeSSebastian Andrzej Siewior char *instance_name;
61088af8bbeSSebastian Andrzej Siewior int ret;
61188af8bbeSSebastian Andrzej Siewior
6120466e7e6SLee Jones if (strlen(name) >= MAX_NAME_LEN)
61388af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENAMETOOLONG);
61488af8bbeSSebastian Andrzej Siewior
6150466e7e6SLee Jones scnprintf(buf, MAX_NAME_LEN, "%s", name);
6160466e7e6SLee Jones
61788af8bbeSSebastian Andrzej Siewior func_name = buf;
61888af8bbeSSebastian Andrzej Siewior instance_name = strchr(func_name, '.');
61988af8bbeSSebastian Andrzej Siewior if (!instance_name) {
62088af8bbeSSebastian Andrzej Siewior pr_err("Unable to locate . in FUNC.INSTANCE\n");
62188af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL);
62288af8bbeSSebastian Andrzej Siewior }
62388af8bbeSSebastian Andrzej Siewior *instance_name = '\0';
62488af8bbeSSebastian Andrzej Siewior instance_name++;
62588af8bbeSSebastian Andrzej Siewior
62688af8bbeSSebastian Andrzej Siewior fi = usb_get_function_instance(func_name);
62788af8bbeSSebastian Andrzej Siewior if (IS_ERR(fi))
628a3469411SDuan Jiong return ERR_CAST(fi);
62988af8bbeSSebastian Andrzej Siewior
6303958b792SNicolas Iooss ret = config_item_set_name(&fi->group.cg_item, "%s", name);
63188af8bbeSSebastian Andrzej Siewior if (ret) {
63288af8bbeSSebastian Andrzej Siewior usb_put_function_instance(fi);
63388af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret);
63488af8bbeSSebastian Andrzej Siewior }
6351933861dSAndrzej Pietrasiewicz if (fi->set_inst_name) {
6361933861dSAndrzej Pietrasiewicz ret = fi->set_inst_name(fi, instance_name);
6371933861dSAndrzej Pietrasiewicz if (ret) {
6381933861dSAndrzej Pietrasiewicz usb_put_function_instance(fi);
6391933861dSAndrzej Pietrasiewicz return ERR_PTR(ret);
6401933861dSAndrzej Pietrasiewicz }
6411933861dSAndrzej Pietrasiewicz }
64288af8bbeSSebastian Andrzej Siewior
64388af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, functions_group);
64488af8bbeSSebastian Andrzej Siewior
64588af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock);
64688af8bbeSSebastian Andrzej Siewior list_add_tail(&fi->cfs_list, &gi->available_func);
64788af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock);
64888af8bbeSSebastian Andrzej Siewior return &fi->group;
64988af8bbeSSebastian Andrzej Siewior }
65088af8bbeSSebastian Andrzej Siewior
function_drop(struct config_group * group,struct config_item * item)65188af8bbeSSebastian Andrzej Siewior static void function_drop(
65288af8bbeSSebastian Andrzej Siewior struct config_group *group,
65388af8bbeSSebastian Andrzej Siewior struct config_item *item)
65488af8bbeSSebastian Andrzej Siewior {
65588af8bbeSSebastian Andrzej Siewior struct usb_function_instance *fi = to_usb_function_instance(item);
65688af8bbeSSebastian Andrzej Siewior struct gadget_info *gi;
65788af8bbeSSebastian Andrzej Siewior
65888af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, functions_group);
65988af8bbeSSebastian Andrzej Siewior
66088af8bbeSSebastian Andrzej Siewior mutex_lock(&gi->lock);
66188af8bbeSSebastian Andrzej Siewior list_del(&fi->cfs_list);
66288af8bbeSSebastian Andrzej Siewior mutex_unlock(&gi->lock);
66388af8bbeSSebastian Andrzej Siewior config_item_put(item);
66488af8bbeSSebastian Andrzej Siewior }
66588af8bbeSSebastian Andrzej Siewior
66688af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations functions_ops = {
66788af8bbeSSebastian Andrzej Siewior .make_group = &function_make,
66888af8bbeSSebastian Andrzej Siewior .drop_item = &function_drop,
66988af8bbeSSebastian Andrzej Siewior };
67088af8bbeSSebastian Andrzej Siewior
6714ad01412SBhumika Goyal static const struct config_item_type functions_type = {
67288af8bbeSSebastian Andrzej Siewior .ct_group_ops = &functions_ops,
67388af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE,
67488af8bbeSSebastian Andrzej Siewior };
67588af8bbeSSebastian Andrzej Siewior
67688af8bbeSSebastian Andrzej Siewior GS_STRINGS_RW(gadget_config_name, configuration);
67788af8bbeSSebastian Andrzej Siewior
67888af8bbeSSebastian Andrzej Siewior static struct configfs_attribute *gadget_config_name_langid_attrs[] = {
67945b6a73fSChristoph Hellwig &gadget_config_name_attr_configuration,
68088af8bbeSSebastian Andrzej Siewior NULL,
68188af8bbeSSebastian Andrzej Siewior };
68288af8bbeSSebastian Andrzej Siewior
gadget_config_name_attr_release(struct config_item * item)68388af8bbeSSebastian Andrzej Siewior static void gadget_config_name_attr_release(struct config_item *item)
68488af8bbeSSebastian Andrzej Siewior {
68588af8bbeSSebastian Andrzej Siewior struct gadget_config_name *cn = to_gadget_config_name(item);
68688af8bbeSSebastian Andrzej Siewior
68788af8bbeSSebastian Andrzej Siewior kfree(cn->configuration);
68888af8bbeSSebastian Andrzej Siewior
68988af8bbeSSebastian Andrzej Siewior list_del(&cn->list);
69088af8bbeSSebastian Andrzej Siewior kfree(cn);
69188af8bbeSSebastian Andrzej Siewior }
69288af8bbeSSebastian Andrzej Siewior
69388af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRING_RW_OPS(gadget_config_name);
69488af8bbeSSebastian Andrzej Siewior USB_CONFIG_STRINGS_LANG(gadget_config_name, config_usb_cfg);
69588af8bbeSSebastian Andrzej Siewior
config_desc_make(struct config_group * group,const char * name)69688af8bbeSSebastian Andrzej Siewior static struct config_group *config_desc_make(
69788af8bbeSSebastian Andrzej Siewior struct config_group *group,
69888af8bbeSSebastian Andrzej Siewior const char *name)
69988af8bbeSSebastian Andrzej Siewior {
70088af8bbeSSebastian Andrzej Siewior struct gadget_info *gi;
70188af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg;
70288af8bbeSSebastian Andrzej Siewior char buf[MAX_NAME_LEN];
70388af8bbeSSebastian Andrzej Siewior char *num_str;
70488af8bbeSSebastian Andrzej Siewior u8 num;
70588af8bbeSSebastian Andrzej Siewior int ret;
70688af8bbeSSebastian Andrzej Siewior
70788af8bbeSSebastian Andrzej Siewior gi = container_of(group, struct gadget_info, configs_group);
7080466e7e6SLee Jones
7090466e7e6SLee Jones if (strlen(name) >= MAX_NAME_LEN)
71088af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENAMETOOLONG);
71188af8bbeSSebastian Andrzej Siewior
7120466e7e6SLee Jones scnprintf(buf, MAX_NAME_LEN, "%s", name);
7130466e7e6SLee Jones
71488af8bbeSSebastian Andrzej Siewior num_str = strchr(buf, '.');
71588af8bbeSSebastian Andrzej Siewior if (!num_str) {
71688af8bbeSSebastian Andrzej Siewior pr_err("Unable to locate . in name.bConfigurationValue\n");
71788af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL);
71888af8bbeSSebastian Andrzej Siewior }
71988af8bbeSSebastian Andrzej Siewior
72088af8bbeSSebastian Andrzej Siewior *num_str = '\0';
72188af8bbeSSebastian Andrzej Siewior num_str++;
72288af8bbeSSebastian Andrzej Siewior
72388af8bbeSSebastian Andrzej Siewior if (!strlen(buf))
72488af8bbeSSebastian Andrzej Siewior return ERR_PTR(-EINVAL);
72588af8bbeSSebastian Andrzej Siewior
72688af8bbeSSebastian Andrzej Siewior ret = kstrtou8(num_str, 0, &num);
72788af8bbeSSebastian Andrzej Siewior if (ret)
72888af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret);
72988af8bbeSSebastian Andrzej Siewior
73088af8bbeSSebastian Andrzej Siewior cfg = kzalloc(sizeof(*cfg), GFP_KERNEL);
73188af8bbeSSebastian Andrzej Siewior if (!cfg)
73288af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM);
73388af8bbeSSebastian Andrzej Siewior cfg->c.label = kstrdup(buf, GFP_KERNEL);
73488af8bbeSSebastian Andrzej Siewior if (!cfg->c.label) {
73588af8bbeSSebastian Andrzej Siewior ret = -ENOMEM;
73688af8bbeSSebastian Andrzej Siewior goto err;
73788af8bbeSSebastian Andrzej Siewior }
73888af8bbeSSebastian Andrzej Siewior cfg->c.bConfigurationValue = num;
73988af8bbeSSebastian Andrzej Siewior cfg->c.MaxPower = CONFIG_USB_GADGET_VBUS_DRAW;
74088af8bbeSSebastian Andrzej Siewior cfg->c.bmAttributes = USB_CONFIG_ATT_ONE;
74188af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cfg->string_list);
74288af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&cfg->func_list);
74388af8bbeSSebastian Andrzej Siewior
74488af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&cfg->group, name,
74588af8bbeSSebastian Andrzej Siewior &gadget_config_type);
7461ae1602dSChristoph Hellwig
74788af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&cfg->strings_group, "strings",
74888af8bbeSSebastian Andrzej Siewior &gadget_config_name_strings_type);
7491ae1602dSChristoph Hellwig configfs_add_default_group(&cfg->strings_group, &cfg->group);
75088af8bbeSSebastian Andrzej Siewior
75188af8bbeSSebastian Andrzej Siewior ret = usb_add_config_only(&gi->cdev, &cfg->c);
75288af8bbeSSebastian Andrzej Siewior if (ret)
75388af8bbeSSebastian Andrzej Siewior goto err;
75488af8bbeSSebastian Andrzej Siewior
75588af8bbeSSebastian Andrzej Siewior return &cfg->group;
75688af8bbeSSebastian Andrzej Siewior err:
75788af8bbeSSebastian Andrzej Siewior kfree(cfg->c.label);
75888af8bbeSSebastian Andrzej Siewior kfree(cfg);
75988af8bbeSSebastian Andrzej Siewior return ERR_PTR(ret);
76088af8bbeSSebastian Andrzej Siewior }
76188af8bbeSSebastian Andrzej Siewior
config_desc_drop(struct config_group * group,struct config_item * item)76288af8bbeSSebastian Andrzej Siewior static void config_desc_drop(
76388af8bbeSSebastian Andrzej Siewior struct config_group *group,
76488af8bbeSSebastian Andrzej Siewior struct config_item *item)
76588af8bbeSSebastian Andrzej Siewior {
76688af8bbeSSebastian Andrzej Siewior config_item_put(item);
76788af8bbeSSebastian Andrzej Siewior }
76888af8bbeSSebastian Andrzej Siewior
76988af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations config_desc_ops = {
77088af8bbeSSebastian Andrzej Siewior .make_group = &config_desc_make,
77188af8bbeSSebastian Andrzej Siewior .drop_item = &config_desc_drop,
77288af8bbeSSebastian Andrzej Siewior };
77388af8bbeSSebastian Andrzej Siewior
7744ad01412SBhumika Goyal static const struct config_item_type config_desc_type = {
77588af8bbeSSebastian Andrzej Siewior .ct_group_ops = &config_desc_ops,
77688af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE,
77788af8bbeSSebastian Andrzej Siewior };
77888af8bbeSSebastian Andrzej Siewior
7796e2a512dSDaniel Scally GS_STRINGS_RW(gadget_language, manufacturer);
7806e2a512dSDaniel Scally GS_STRINGS_RW(gadget_language, product);
7816e2a512dSDaniel Scally GS_STRINGS_RW(gadget_language, serialnumber);
78288af8bbeSSebastian Andrzej Siewior
7836e2a512dSDaniel Scally static struct configfs_attribute *gadget_language_langid_attrs[] = {
7846e2a512dSDaniel Scally &gadget_language_attr_manufacturer,
7856e2a512dSDaniel Scally &gadget_language_attr_product,
7866e2a512dSDaniel Scally &gadget_language_attr_serialnumber,
78788af8bbeSSebastian Andrzej Siewior NULL,
78888af8bbeSSebastian Andrzej Siewior };
78988af8bbeSSebastian Andrzej Siewior
gadget_language_attr_release(struct config_item * item)7906e2a512dSDaniel Scally static void gadget_language_attr_release(struct config_item *item)
79188af8bbeSSebastian Andrzej Siewior {
7926e2a512dSDaniel Scally struct gadget_language *gs = to_gadget_language(item);
79388af8bbeSSebastian Andrzej Siewior
79488af8bbeSSebastian Andrzej Siewior kfree(gs->manufacturer);
79588af8bbeSSebastian Andrzej Siewior kfree(gs->product);
79688af8bbeSSebastian Andrzej Siewior kfree(gs->serialnumber);
79788af8bbeSSebastian Andrzej Siewior
79888af8bbeSSebastian Andrzej Siewior list_del(&gs->list);
79988af8bbeSSebastian Andrzej Siewior kfree(gs);
80088af8bbeSSebastian Andrzej Siewior }
80188af8bbeSSebastian Andrzej Siewior
80215a7cf8cSDaniel Scally static struct configfs_item_operations gadget_language_langid_item_ops = {
80315a7cf8cSDaniel Scally .release = gadget_language_attr_release,
80415a7cf8cSDaniel Scally };
80515a7cf8cSDaniel Scally
gadget_string_id_show(struct config_item * item,char * page)80615a7cf8cSDaniel Scally static ssize_t gadget_string_id_show(struct config_item *item, char *page)
80715a7cf8cSDaniel Scally {
80815a7cf8cSDaniel Scally struct gadget_string *string = to_gadget_string(item);
80915a7cf8cSDaniel Scally int ret;
81015a7cf8cSDaniel Scally
81115a7cf8cSDaniel Scally ret = sprintf(page, "%u\n", string->usb_string.id);
81215a7cf8cSDaniel Scally return ret;
81315a7cf8cSDaniel Scally }
81415a7cf8cSDaniel Scally CONFIGFS_ATTR_RO(gadget_string_, id);
81515a7cf8cSDaniel Scally
gadget_string_s_show(struct config_item * item,char * page)81615a7cf8cSDaniel Scally static ssize_t gadget_string_s_show(struct config_item *item, char *page)
81715a7cf8cSDaniel Scally {
81815a7cf8cSDaniel Scally struct gadget_string *string = to_gadget_string(item);
81915a7cf8cSDaniel Scally int ret;
82015a7cf8cSDaniel Scally
82138168e2dSLee Jones ret = sysfs_emit(page, "%s\n", string->string);
82215a7cf8cSDaniel Scally return ret;
82315a7cf8cSDaniel Scally }
82415a7cf8cSDaniel Scally
gadget_string_s_store(struct config_item * item,const char * page,size_t len)82515a7cf8cSDaniel Scally static ssize_t gadget_string_s_store(struct config_item *item, const char *page,
82615a7cf8cSDaniel Scally size_t len)
82715a7cf8cSDaniel Scally {
82815a7cf8cSDaniel Scally struct gadget_string *string = to_gadget_string(item);
82915a7cf8cSDaniel Scally int size = min(sizeof(string->string), len + 1);
83015a7cf8cSDaniel Scally
83115a7cf8cSDaniel Scally if (len > USB_MAX_STRING_LEN)
83215a7cf8cSDaniel Scally return -EINVAL;
83315a7cf8cSDaniel Scally
8348488a831SDaniel Scally return strscpy(string->string, page, size);
83515a7cf8cSDaniel Scally }
83615a7cf8cSDaniel Scally CONFIGFS_ATTR(gadget_string_, s);
83715a7cf8cSDaniel Scally
83815a7cf8cSDaniel Scally static struct configfs_attribute *gadget_string_attrs[] = {
83915a7cf8cSDaniel Scally &gadget_string_attr_id,
84015a7cf8cSDaniel Scally &gadget_string_attr_s,
84115a7cf8cSDaniel Scally NULL,
84215a7cf8cSDaniel Scally };
84315a7cf8cSDaniel Scally
gadget_string_release(struct config_item * item)84415a7cf8cSDaniel Scally static void gadget_string_release(struct config_item *item)
84515a7cf8cSDaniel Scally {
84615a7cf8cSDaniel Scally struct gadget_string *string = to_gadget_string(item);
84715a7cf8cSDaniel Scally
84815a7cf8cSDaniel Scally kfree(string);
84915a7cf8cSDaniel Scally }
85015a7cf8cSDaniel Scally
85115a7cf8cSDaniel Scally static struct configfs_item_operations gadget_string_item_ops = {
85215a7cf8cSDaniel Scally .release = gadget_string_release,
85315a7cf8cSDaniel Scally };
85415a7cf8cSDaniel Scally
85515a7cf8cSDaniel Scally static const struct config_item_type gadget_string_type = {
85615a7cf8cSDaniel Scally .ct_item_ops = &gadget_string_item_ops,
85715a7cf8cSDaniel Scally .ct_attrs = gadget_string_attrs,
85815a7cf8cSDaniel Scally .ct_owner = THIS_MODULE,
85915a7cf8cSDaniel Scally };
86015a7cf8cSDaniel Scally
gadget_language_string_make(struct config_group * group,const char * name)86115a7cf8cSDaniel Scally static struct config_item *gadget_language_string_make(struct config_group *group,
86215a7cf8cSDaniel Scally const char *name)
86315a7cf8cSDaniel Scally {
86415a7cf8cSDaniel Scally struct gadget_language *language;
86515a7cf8cSDaniel Scally struct gadget_string *string;
86615a7cf8cSDaniel Scally
86715a7cf8cSDaniel Scally language = to_gadget_language(&group->cg_item);
86815a7cf8cSDaniel Scally
86915a7cf8cSDaniel Scally string = kzalloc(sizeof(*string), GFP_KERNEL);
87015a7cf8cSDaniel Scally if (!string)
87115a7cf8cSDaniel Scally return ERR_PTR(-ENOMEM);
87215a7cf8cSDaniel Scally
87315a7cf8cSDaniel Scally string->usb_string.id = language->nstrings++;
87415a7cf8cSDaniel Scally string->usb_string.s = string->string;
87515a7cf8cSDaniel Scally list_add_tail(&string->list, &language->gadget_strings);
87615a7cf8cSDaniel Scally
87715a7cf8cSDaniel Scally config_item_init_type_name(&string->item, name, &gadget_string_type);
87815a7cf8cSDaniel Scally
87915a7cf8cSDaniel Scally return &string->item;
88015a7cf8cSDaniel Scally }
88115a7cf8cSDaniel Scally
gadget_language_string_drop(struct config_group * group,struct config_item * item)88215a7cf8cSDaniel Scally static void gadget_language_string_drop(struct config_group *group,
88315a7cf8cSDaniel Scally struct config_item *item)
88415a7cf8cSDaniel Scally {
88515a7cf8cSDaniel Scally struct gadget_language *language;
88615a7cf8cSDaniel Scally struct gadget_string *string;
88715a7cf8cSDaniel Scally unsigned int i = USB_GADGET_FIRST_AVAIL_IDX;
88815a7cf8cSDaniel Scally
88915a7cf8cSDaniel Scally language = to_gadget_language(&group->cg_item);
89015a7cf8cSDaniel Scally string = to_gadget_string(item);
89115a7cf8cSDaniel Scally
89215a7cf8cSDaniel Scally list_del(&string->list);
89315a7cf8cSDaniel Scally language->nstrings--;
89415a7cf8cSDaniel Scally
89515a7cf8cSDaniel Scally /* Reset the ids for the language's strings to guarantee a continuous set */
89615a7cf8cSDaniel Scally list_for_each_entry(string, &language->gadget_strings, list)
89715a7cf8cSDaniel Scally string->usb_string.id = i++;
89815a7cf8cSDaniel Scally }
89915a7cf8cSDaniel Scally
90015a7cf8cSDaniel Scally static struct configfs_group_operations gadget_language_langid_group_ops = {
90115a7cf8cSDaniel Scally .make_item = gadget_language_string_make,
90215a7cf8cSDaniel Scally .drop_item = gadget_language_string_drop,
90315a7cf8cSDaniel Scally };
90415a7cf8cSDaniel Scally
90515a7cf8cSDaniel Scally static struct config_item_type gadget_language_type = {
90615a7cf8cSDaniel Scally .ct_item_ops = &gadget_language_langid_item_ops,
90715a7cf8cSDaniel Scally .ct_group_ops = &gadget_language_langid_group_ops,
90815a7cf8cSDaniel Scally .ct_attrs = gadget_language_langid_attrs,
90915a7cf8cSDaniel Scally .ct_owner = THIS_MODULE,
91015a7cf8cSDaniel Scally };
91115a7cf8cSDaniel Scally
gadget_language_make(struct config_group * group,const char * name)91215a7cf8cSDaniel Scally static struct config_group *gadget_language_make(struct config_group *group,
91315a7cf8cSDaniel Scally const char *name)
91415a7cf8cSDaniel Scally {
91515a7cf8cSDaniel Scally struct gadget_info *gi;
91615a7cf8cSDaniel Scally struct gadget_language *gs;
91715a7cf8cSDaniel Scally struct gadget_language *new;
91815a7cf8cSDaniel Scally int langs = 0;
91915a7cf8cSDaniel Scally int ret;
92015a7cf8cSDaniel Scally
92115a7cf8cSDaniel Scally new = kzalloc(sizeof(*new), GFP_KERNEL);
92215a7cf8cSDaniel Scally if (!new)
92315a7cf8cSDaniel Scally return ERR_PTR(-ENOMEM);
92415a7cf8cSDaniel Scally
92515a7cf8cSDaniel Scally ret = check_user_usb_string(name, &new->stringtab_dev);
92615a7cf8cSDaniel Scally if (ret)
92715a7cf8cSDaniel Scally goto err;
92815a7cf8cSDaniel Scally config_group_init_type_name(&new->group, name,
92915a7cf8cSDaniel Scally &gadget_language_type);
93015a7cf8cSDaniel Scally
93115a7cf8cSDaniel Scally gi = container_of(group, struct gadget_info, strings_group);
93215a7cf8cSDaniel Scally ret = -EEXIST;
93315a7cf8cSDaniel Scally list_for_each_entry(gs, &gi->string_list, list) {
93415a7cf8cSDaniel Scally if (gs->stringtab_dev.language == new->stringtab_dev.language)
93515a7cf8cSDaniel Scally goto err;
93615a7cf8cSDaniel Scally langs++;
93715a7cf8cSDaniel Scally }
93815a7cf8cSDaniel Scally ret = -EOVERFLOW;
93915a7cf8cSDaniel Scally if (langs >= MAX_USB_STRING_LANGS)
94015a7cf8cSDaniel Scally goto err;
94115a7cf8cSDaniel Scally
94215a7cf8cSDaniel Scally list_add_tail(&new->list, &gi->string_list);
94315a7cf8cSDaniel Scally INIT_LIST_HEAD(&new->gadget_strings);
94415a7cf8cSDaniel Scally
94515a7cf8cSDaniel Scally /* We have the default manufacturer, product and serialnumber strings */
94615a7cf8cSDaniel Scally new->nstrings = 3;
94715a7cf8cSDaniel Scally return &new->group;
94815a7cf8cSDaniel Scally err:
94915a7cf8cSDaniel Scally kfree(new);
95015a7cf8cSDaniel Scally return ERR_PTR(ret);
95115a7cf8cSDaniel Scally }
95215a7cf8cSDaniel Scally
gadget_language_drop(struct config_group * group,struct config_item * item)95315a7cf8cSDaniel Scally static void gadget_language_drop(struct config_group *group,
95415a7cf8cSDaniel Scally struct config_item *item)
95515a7cf8cSDaniel Scally {
95615a7cf8cSDaniel Scally config_item_put(item);
95715a7cf8cSDaniel Scally }
95815a7cf8cSDaniel Scally
95915a7cf8cSDaniel Scally static struct configfs_group_operations gadget_language_group_ops = {
96015a7cf8cSDaniel Scally .make_group = &gadget_language_make,
96115a7cf8cSDaniel Scally .drop_item = &gadget_language_drop,
96215a7cf8cSDaniel Scally };
96315a7cf8cSDaniel Scally
96415a7cf8cSDaniel Scally static struct config_item_type gadget_language_strings_type = {
96515a7cf8cSDaniel Scally .ct_group_ops = &gadget_language_group_ops,
96615a7cf8cSDaniel Scally .ct_owner = THIS_MODULE,
96715a7cf8cSDaniel Scally };
96888af8bbeSSebastian Andrzej Siewior
webusb_item_to_gadget_info(struct config_item * item)96993c47394SJó Ágila Bitsch static inline struct gadget_info *webusb_item_to_gadget_info(
97093c47394SJó Ágila Bitsch struct config_item *item)
97193c47394SJó Ágila Bitsch {
97293c47394SJó Ágila Bitsch return container_of(to_config_group(item),
97393c47394SJó Ágila Bitsch struct gadget_info, webusb_group);
97493c47394SJó Ágila Bitsch }
97593c47394SJó Ágila Bitsch
webusb_use_show(struct config_item * item,char * page)97693c47394SJó Ágila Bitsch static ssize_t webusb_use_show(struct config_item *item, char *page)
97793c47394SJó Ágila Bitsch {
97893c47394SJó Ágila Bitsch return sysfs_emit(page, "%d\n",
97993c47394SJó Ágila Bitsch webusb_item_to_gadget_info(item)->use_webusb);
98093c47394SJó Ágila Bitsch }
98193c47394SJó Ágila Bitsch
webusb_use_store(struct config_item * item,const char * page,size_t len)98293c47394SJó Ágila Bitsch static ssize_t webusb_use_store(struct config_item *item, const char *page,
98393c47394SJó Ágila Bitsch size_t len)
98493c47394SJó Ágila Bitsch {
98593c47394SJó Ágila Bitsch struct gadget_info *gi = webusb_item_to_gadget_info(item);
98693c47394SJó Ágila Bitsch int ret;
98793c47394SJó Ágila Bitsch bool use;
98893c47394SJó Ágila Bitsch
98993c47394SJó Ágila Bitsch ret = kstrtobool(page, &use);
9906f7fb48dSAndy Shevchenko if (ret)
9916f7fb48dSAndy Shevchenko return ret;
9926f7fb48dSAndy Shevchenko
9936f7fb48dSAndy Shevchenko mutex_lock(&gi->lock);
99493c47394SJó Ágila Bitsch gi->use_webusb = use;
99593c47394SJó Ágila Bitsch mutex_unlock(&gi->lock);
99693c47394SJó Ágila Bitsch
9976f7fb48dSAndy Shevchenko return len;
99893c47394SJó Ágila Bitsch }
99993c47394SJó Ágila Bitsch
webusb_bcdVersion_show(struct config_item * item,char * page)100093c47394SJó Ágila Bitsch static ssize_t webusb_bcdVersion_show(struct config_item *item, char *page)
100193c47394SJó Ágila Bitsch {
100293c47394SJó Ágila Bitsch return sysfs_emit(page, "0x%04x\n",
100393c47394SJó Ágila Bitsch webusb_item_to_gadget_info(item)->bcd_webusb_version);
100493c47394SJó Ágila Bitsch }
100593c47394SJó Ágila Bitsch
webusb_bcdVersion_store(struct config_item * item,const char * page,size_t len)100693c47394SJó Ágila Bitsch static ssize_t webusb_bcdVersion_store(struct config_item *item,
100793c47394SJó Ágila Bitsch const char *page, size_t len)
100893c47394SJó Ágila Bitsch {
100993c47394SJó Ágila Bitsch struct gadget_info *gi = webusb_item_to_gadget_info(item);
101093c47394SJó Ágila Bitsch u16 bcdVersion;
101193c47394SJó Ágila Bitsch int ret;
101293c47394SJó Ágila Bitsch
101393c47394SJó Ágila Bitsch ret = kstrtou16(page, 0, &bcdVersion);
101493c47394SJó Ágila Bitsch if (ret)
10156f7fb48dSAndy Shevchenko return ret;
10166f7fb48dSAndy Shevchenko
101793c47394SJó Ágila Bitsch ret = is_valid_bcd(bcdVersion);
101893c47394SJó Ágila Bitsch if (ret)
1019582cef43SAndy Shevchenko return ret;
102093c47394SJó Ágila Bitsch
1021582cef43SAndy Shevchenko mutex_lock(&gi->lock);
102293c47394SJó Ágila Bitsch gi->bcd_webusb_version = bcdVersion;
102393c47394SJó Ágila Bitsch mutex_unlock(&gi->lock);
102493c47394SJó Ágila Bitsch
1025582cef43SAndy Shevchenko return len;
102693c47394SJó Ágila Bitsch }
102793c47394SJó Ágila Bitsch
webusb_bVendorCode_show(struct config_item * item,char * page)102893c47394SJó Ágila Bitsch static ssize_t webusb_bVendorCode_show(struct config_item *item, char *page)
102993c47394SJó Ágila Bitsch {
103093c47394SJó Ágila Bitsch return sysfs_emit(page, "0x%02x\n",
103193c47394SJó Ágila Bitsch webusb_item_to_gadget_info(item)->b_webusb_vendor_code);
103293c47394SJó Ágila Bitsch }
103393c47394SJó Ágila Bitsch
webusb_bVendorCode_store(struct config_item * item,const char * page,size_t len)103493c47394SJó Ágila Bitsch static ssize_t webusb_bVendorCode_store(struct config_item *item,
103593c47394SJó Ágila Bitsch const char *page, size_t len)
103693c47394SJó Ágila Bitsch {
103793c47394SJó Ágila Bitsch struct gadget_info *gi = webusb_item_to_gadget_info(item);
103893c47394SJó Ágila Bitsch int ret;
103993c47394SJó Ágila Bitsch u8 b_vendor_code;
104093c47394SJó Ágila Bitsch
104193c47394SJó Ágila Bitsch ret = kstrtou8(page, 0, &b_vendor_code);
10426f7fb48dSAndy Shevchenko if (ret)
10436f7fb48dSAndy Shevchenko return ret;
10446f7fb48dSAndy Shevchenko
10456f7fb48dSAndy Shevchenko mutex_lock(&gi->lock);
104693c47394SJó Ágila Bitsch gi->b_webusb_vendor_code = b_vendor_code;
104793c47394SJó Ágila Bitsch mutex_unlock(&gi->lock);
104893c47394SJó Ágila Bitsch
10496f7fb48dSAndy Shevchenko return len;
105093c47394SJó Ágila Bitsch }
105193c47394SJó Ágila Bitsch
webusb_landingPage_show(struct config_item * item,char * page)105293c47394SJó Ágila Bitsch static ssize_t webusb_landingPage_show(struct config_item *item, char *page)
105393c47394SJó Ágila Bitsch {
105493c47394SJó Ágila Bitsch return sysfs_emit(page, "%s\n", webusb_item_to_gadget_info(item)->landing_page);
105593c47394SJó Ágila Bitsch }
105693c47394SJó Ágila Bitsch
webusb_landingPage_store(struct config_item * item,const char * page,size_t len)105793c47394SJó Ágila Bitsch static ssize_t webusb_landingPage_store(struct config_item *item, const char *page,
105893c47394SJó Ágila Bitsch size_t len)
105993c47394SJó Ágila Bitsch {
106093c47394SJó Ágila Bitsch struct gadget_info *gi = webusb_item_to_gadget_info(item);
106193c47394SJó Ágila Bitsch unsigned int bytes_to_strip = 0;
106293c47394SJó Ágila Bitsch int l = len;
106393c47394SJó Ágila Bitsch
106493c47394SJó Ágila Bitsch if (page[l - 1] == '\n') {
106593c47394SJó Ágila Bitsch --l;
106693c47394SJó Ágila Bitsch ++bytes_to_strip;
106793c47394SJó Ágila Bitsch }
106893c47394SJó Ágila Bitsch
106993c47394SJó Ágila Bitsch if (l > sizeof(gi->landing_page)) {
107093c47394SJó Ágila Bitsch pr_err("webusb: landingPage URL too long\n");
107193c47394SJó Ágila Bitsch return -EINVAL;
107293c47394SJó Ágila Bitsch }
107393c47394SJó Ágila Bitsch
107493c47394SJó Ágila Bitsch // validation
107593c47394SJó Ágila Bitsch if (strncasecmp(page, "https://", 8) == 0)
107693c47394SJó Ágila Bitsch bytes_to_strip = 8;
107793c47394SJó Ágila Bitsch else if (strncasecmp(page, "http://", 7) == 0)
107893c47394SJó Ágila Bitsch bytes_to_strip = 7;
107993c47394SJó Ágila Bitsch else
108093c47394SJó Ágila Bitsch bytes_to_strip = 0;
108193c47394SJó Ágila Bitsch
108293c47394SJó Ágila Bitsch if (l > U8_MAX - WEBUSB_URL_DESCRIPTOR_HEADER_LENGTH + bytes_to_strip) {
108393c47394SJó Ágila Bitsch pr_err("webusb: landingPage URL %d bytes too long for given URL scheme\n",
108493c47394SJó Ágila Bitsch l - U8_MAX + WEBUSB_URL_DESCRIPTOR_HEADER_LENGTH - bytes_to_strip);
108593c47394SJó Ágila Bitsch return -EINVAL;
108693c47394SJó Ágila Bitsch }
108793c47394SJó Ágila Bitsch
108893c47394SJó Ágila Bitsch mutex_lock(&gi->lock);
108993c47394SJó Ágila Bitsch // ensure 0 bytes are set, in case the new landing page is shorter then the old one.
10909c0e6fbdSAndy Shevchenko memcpy_and_pad(gi->landing_page, sizeof(gi->landing_page), page, l, 0);
109193c47394SJó Ágila Bitsch mutex_unlock(&gi->lock);
109293c47394SJó Ágila Bitsch
109393c47394SJó Ágila Bitsch return len;
109493c47394SJó Ágila Bitsch }
109593c47394SJó Ágila Bitsch
109693c47394SJó Ágila Bitsch CONFIGFS_ATTR(webusb_, use);
109793c47394SJó Ágila Bitsch CONFIGFS_ATTR(webusb_, bVendorCode);
109893c47394SJó Ágila Bitsch CONFIGFS_ATTR(webusb_, bcdVersion);
109993c47394SJó Ágila Bitsch CONFIGFS_ATTR(webusb_, landingPage);
110093c47394SJó Ágila Bitsch
110193c47394SJó Ágila Bitsch static struct configfs_attribute *webusb_attrs[] = {
110293c47394SJó Ágila Bitsch &webusb_attr_use,
110393c47394SJó Ágila Bitsch &webusb_attr_bcdVersion,
110493c47394SJó Ágila Bitsch &webusb_attr_bVendorCode,
110593c47394SJó Ágila Bitsch &webusb_attr_landingPage,
110693c47394SJó Ágila Bitsch NULL,
110793c47394SJó Ágila Bitsch };
110893c47394SJó Ágila Bitsch
110993c47394SJó Ágila Bitsch static struct config_item_type webusb_type = {
111093c47394SJó Ágila Bitsch .ct_attrs = webusb_attrs,
111193c47394SJó Ágila Bitsch .ct_owner = THIS_MODULE,
111293c47394SJó Ágila Bitsch };
111393c47394SJó Ágila Bitsch
os_desc_item_to_gadget_info(struct config_item * item)111445b6a73fSChristoph Hellwig static inline struct gadget_info *os_desc_item_to_gadget_info(
111545b6a73fSChristoph Hellwig struct config_item *item)
111687213d38SAndrzej Pietrasiewicz {
1117167a799cSLinyu Yuan return container_of(to_config_group(item),
1118167a799cSLinyu Yuan struct gadget_info, os_desc_group);
111987213d38SAndrzej Pietrasiewicz }
112087213d38SAndrzej Pietrasiewicz
os_desc_use_show(struct config_item * item,char * page)112145b6a73fSChristoph Hellwig static ssize_t os_desc_use_show(struct config_item *item, char *page)
112245b6a73fSChristoph Hellwig {
1123e800e8cbSStefan Agner return sprintf(page, "%d\n",
112445b6a73fSChristoph Hellwig os_desc_item_to_gadget_info(item)->use_os_desc);
112545b6a73fSChristoph Hellwig }
112645b6a73fSChristoph Hellwig
os_desc_use_store(struct config_item * item,const char * page,size_t len)112745b6a73fSChristoph Hellwig static ssize_t os_desc_use_store(struct config_item *item, const char *page,
112887213d38SAndrzej Pietrasiewicz size_t len)
112987213d38SAndrzej Pietrasiewicz {
113045b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item);
113187213d38SAndrzej Pietrasiewicz int ret;
113287213d38SAndrzej Pietrasiewicz bool use;
113387213d38SAndrzej Pietrasiewicz
1134a8bc8cc1SChristophe JAILLET ret = kstrtobool(page, &use);
11356f7fb48dSAndy Shevchenko if (ret)
11366f7fb48dSAndy Shevchenko return ret;
11376f7fb48dSAndy Shevchenko
11386f7fb48dSAndy Shevchenko mutex_lock(&gi->lock);
113987213d38SAndrzej Pietrasiewicz gi->use_os_desc = use;
114087213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock);
114187213d38SAndrzej Pietrasiewicz
11426f7fb48dSAndy Shevchenko return len;
114387213d38SAndrzej Pietrasiewicz }
114487213d38SAndrzej Pietrasiewicz
os_desc_b_vendor_code_show(struct config_item * item,char * page)114545b6a73fSChristoph Hellwig static ssize_t os_desc_b_vendor_code_show(struct config_item *item, char *page)
114687213d38SAndrzej Pietrasiewicz {
1147e800e8cbSStefan Agner return sprintf(page, "0x%02x\n",
114845b6a73fSChristoph Hellwig os_desc_item_to_gadget_info(item)->b_vendor_code);
114987213d38SAndrzej Pietrasiewicz }
115087213d38SAndrzej Pietrasiewicz
os_desc_b_vendor_code_store(struct config_item * item,const char * page,size_t len)115145b6a73fSChristoph Hellwig static ssize_t os_desc_b_vendor_code_store(struct config_item *item,
115287213d38SAndrzej Pietrasiewicz const char *page, size_t len)
115387213d38SAndrzej Pietrasiewicz {
115445b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item);
115587213d38SAndrzej Pietrasiewicz int ret;
115687213d38SAndrzej Pietrasiewicz u8 b_vendor_code;
115787213d38SAndrzej Pietrasiewicz
115887213d38SAndrzej Pietrasiewicz ret = kstrtou8(page, 0, &b_vendor_code);
11596f7fb48dSAndy Shevchenko if (ret)
11606f7fb48dSAndy Shevchenko return ret;
11616f7fb48dSAndy Shevchenko
11626f7fb48dSAndy Shevchenko mutex_lock(&gi->lock);
116387213d38SAndrzej Pietrasiewicz gi->b_vendor_code = b_vendor_code;
116487213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock);
116587213d38SAndrzej Pietrasiewicz
11666f7fb48dSAndy Shevchenko return len;
116787213d38SAndrzej Pietrasiewicz }
116887213d38SAndrzej Pietrasiewicz
os_desc_qw_sign_show(struct config_item * item,char * page)116945b6a73fSChristoph Hellwig static ssize_t os_desc_qw_sign_show(struct config_item *item, char *page)
117087213d38SAndrzej Pietrasiewicz {
117145b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item);
117276180d71SStefan Agner int res;
117387213d38SAndrzej Pietrasiewicz
117476180d71SStefan Agner res = utf16s_to_utf8s((wchar_t *) gi->qw_sign, OS_STRING_QW_SIGN_LEN,
117576180d71SStefan Agner UTF16_LITTLE_ENDIAN, page, PAGE_SIZE - 1);
117676180d71SStefan Agner page[res++] = '\n';
117776180d71SStefan Agner
117876180d71SStefan Agner return res;
117987213d38SAndrzej Pietrasiewicz }
118087213d38SAndrzej Pietrasiewicz
os_desc_qw_sign_store(struct config_item * item,const char * page,size_t len)118145b6a73fSChristoph Hellwig static ssize_t os_desc_qw_sign_store(struct config_item *item, const char *page,
118287213d38SAndrzej Pietrasiewicz size_t len)
118387213d38SAndrzej Pietrasiewicz {
118445b6a73fSChristoph Hellwig struct gadget_info *gi = os_desc_item_to_gadget_info(item);
118587213d38SAndrzej Pietrasiewicz int res, l;
118687213d38SAndrzej Pietrasiewicz
118787213d38SAndrzej Pietrasiewicz l = min((int)len, OS_STRING_QW_SIGN_LEN >> 1);
118887213d38SAndrzej Pietrasiewicz if (page[l - 1] == '\n')
118987213d38SAndrzej Pietrasiewicz --l;
119087213d38SAndrzej Pietrasiewicz
119187213d38SAndrzej Pietrasiewicz mutex_lock(&gi->lock);
119287213d38SAndrzej Pietrasiewicz res = utf8s_to_utf16s(page, l,
119387213d38SAndrzej Pietrasiewicz UTF16_LITTLE_ENDIAN, (wchar_t *) gi->qw_sign,
119487213d38SAndrzej Pietrasiewicz OS_STRING_QW_SIGN_LEN);
119587213d38SAndrzej Pietrasiewicz if (res > 0)
119687213d38SAndrzej Pietrasiewicz res = len;
119787213d38SAndrzej Pietrasiewicz mutex_unlock(&gi->lock);
119887213d38SAndrzej Pietrasiewicz
119987213d38SAndrzej Pietrasiewicz return res;
120087213d38SAndrzej Pietrasiewicz }
120187213d38SAndrzej Pietrasiewicz
120245b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, use);
120345b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, b_vendor_code);
120445b6a73fSChristoph Hellwig CONFIGFS_ATTR(os_desc_, qw_sign);
120587213d38SAndrzej Pietrasiewicz
120687213d38SAndrzej Pietrasiewicz static struct configfs_attribute *os_desc_attrs[] = {
120745b6a73fSChristoph Hellwig &os_desc_attr_use,
120845b6a73fSChristoph Hellwig &os_desc_attr_b_vendor_code,
120945b6a73fSChristoph Hellwig &os_desc_attr_qw_sign,
121087213d38SAndrzej Pietrasiewicz NULL,
121187213d38SAndrzej Pietrasiewicz };
121287213d38SAndrzej Pietrasiewicz
os_desc_link(struct config_item * os_desc_ci,struct config_item * usb_cfg_ci)1213da424314SAndrzej Pietrasiewicz static int os_desc_link(struct config_item *os_desc_ci,
1214da424314SAndrzej Pietrasiewicz struct config_item *usb_cfg_ci)
1215da424314SAndrzej Pietrasiewicz {
1216167a799cSLinyu Yuan struct gadget_info *gi = os_desc_item_to_gadget_info(os_desc_ci);
1217da424314SAndrzej Pietrasiewicz struct usb_composite_dev *cdev = &gi->cdev;
12185d143ec4SLinyu Yuan struct config_usb_cfg *c_target = to_config_usb_cfg(usb_cfg_ci);
121936f4c25cSJakob Koschel struct usb_configuration *c = NULL, *iter;
1220da424314SAndrzej Pietrasiewicz int ret;
1221da424314SAndrzej Pietrasiewicz
1222da424314SAndrzej Pietrasiewicz mutex_lock(&gi->lock);
122336f4c25cSJakob Koschel list_for_each_entry(iter, &cdev->configs, list) {
122436f4c25cSJakob Koschel if (iter != &c_target->c)
122536f4c25cSJakob Koschel continue;
122636f4c25cSJakob Koschel c = iter;
1227da424314SAndrzej Pietrasiewicz break;
1228da424314SAndrzej Pietrasiewicz }
122936f4c25cSJakob Koschel if (!c) {
1230da424314SAndrzej Pietrasiewicz ret = -EINVAL;
1231da424314SAndrzej Pietrasiewicz goto out;
1232da424314SAndrzej Pietrasiewicz }
1233da424314SAndrzej Pietrasiewicz
1234da424314SAndrzej Pietrasiewicz if (cdev->os_desc_config) {
1235da424314SAndrzej Pietrasiewicz ret = -EBUSY;
1236da424314SAndrzej Pietrasiewicz goto out;
1237da424314SAndrzej Pietrasiewicz }
1238da424314SAndrzej Pietrasiewicz
1239da424314SAndrzej Pietrasiewicz cdev->os_desc_config = &c_target->c;
1240da424314SAndrzej Pietrasiewicz ret = 0;
1241da424314SAndrzej Pietrasiewicz
1242da424314SAndrzej Pietrasiewicz out:
1243da424314SAndrzej Pietrasiewicz mutex_unlock(&gi->lock);
1244da424314SAndrzej Pietrasiewicz return ret;
1245da424314SAndrzej Pietrasiewicz }
1246da424314SAndrzej Pietrasiewicz
os_desc_unlink(struct config_item * os_desc_ci,struct config_item * usb_cfg_ci)1247e16769d4SAndrzej Pietrasiewicz static void os_desc_unlink(struct config_item *os_desc_ci,
1248da424314SAndrzej Pietrasiewicz struct config_item *usb_cfg_ci)
1249da424314SAndrzej Pietrasiewicz {
1250167a799cSLinyu Yuan struct gadget_info *gi = os_desc_item_to_gadget_info(os_desc_ci);
1251da424314SAndrzej Pietrasiewicz struct usb_composite_dev *cdev = &gi->cdev;
1252da424314SAndrzej Pietrasiewicz
1253da424314SAndrzej Pietrasiewicz mutex_lock(&gi->lock);
1254afdaadc3SRuslan Bilovol if (gi->composite.gadget_driver.udc_name)
1255da424314SAndrzej Pietrasiewicz unregister_gadget(gi);
1256da424314SAndrzej Pietrasiewicz cdev->os_desc_config = NULL;
1257afdaadc3SRuslan Bilovol WARN_ON(gi->composite.gadget_driver.udc_name);
1258da424314SAndrzej Pietrasiewicz mutex_unlock(&gi->lock);
1259da424314SAndrzej Pietrasiewicz }
1260da424314SAndrzej Pietrasiewicz
126187213d38SAndrzej Pietrasiewicz static struct configfs_item_operations os_desc_ops = {
1262da424314SAndrzej Pietrasiewicz .allow_link = os_desc_link,
1263da424314SAndrzej Pietrasiewicz .drop_link = os_desc_unlink,
126487213d38SAndrzej Pietrasiewicz };
126587213d38SAndrzej Pietrasiewicz
126687213d38SAndrzej Pietrasiewicz static struct config_item_type os_desc_type = {
126787213d38SAndrzej Pietrasiewicz .ct_item_ops = &os_desc_ops,
126887213d38SAndrzej Pietrasiewicz .ct_attrs = os_desc_attrs,
126987213d38SAndrzej Pietrasiewicz .ct_owner = THIS_MODULE,
127087213d38SAndrzej Pietrasiewicz };
127187213d38SAndrzej Pietrasiewicz
12727419485fSAndrzej Pietrasiewicz static inline struct usb_os_desc_ext_prop
to_usb_os_desc_ext_prop(struct config_item * item)12737419485fSAndrzej Pietrasiewicz *to_usb_os_desc_ext_prop(struct config_item *item)
12747419485fSAndrzej Pietrasiewicz {
12757419485fSAndrzej Pietrasiewicz return container_of(item, struct usb_os_desc_ext_prop, item);
12767419485fSAndrzej Pietrasiewicz }
12777419485fSAndrzej Pietrasiewicz
ext_prop_type_show(struct config_item * item,char * page)127845b6a73fSChristoph Hellwig static ssize_t ext_prop_type_show(struct config_item *item, char *page)
12797419485fSAndrzej Pietrasiewicz {
1280e800e8cbSStefan Agner return sprintf(page, "%d\n", to_usb_os_desc_ext_prop(item)->type);
12817419485fSAndrzej Pietrasiewicz }
12827419485fSAndrzej Pietrasiewicz
ext_prop_type_store(struct config_item * item,const char * page,size_t len)128345b6a73fSChristoph Hellwig static ssize_t ext_prop_type_store(struct config_item *item,
12847419485fSAndrzej Pietrasiewicz const char *page, size_t len)
12857419485fSAndrzej Pietrasiewicz {
128645b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item);
12877419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(ext_prop->item.ci_parent);
12887419485fSAndrzej Pietrasiewicz u8 type;
12897419485fSAndrzej Pietrasiewicz int ret;
12907419485fSAndrzej Pietrasiewicz
12917419485fSAndrzej Pietrasiewicz ret = kstrtou8(page, 0, &type);
12927419485fSAndrzej Pietrasiewicz if (ret)
12936f7fb48dSAndy Shevchenko return ret;
12946f7fb48dSAndy Shevchenko
12956f7fb48dSAndy Shevchenko if (type < USB_EXT_PROP_UNICODE || type > USB_EXT_PROP_UNICODE_MULTI)
12966f7fb48dSAndy Shevchenko return -EINVAL;
12976f7fb48dSAndy Shevchenko
12986f7fb48dSAndy Shevchenko if (desc->opts_mutex)
12996f7fb48dSAndy Shevchenko mutex_lock(desc->opts_mutex);
13007419485fSAndrzej Pietrasiewicz
13017419485fSAndrzej Pietrasiewicz if ((ext_prop->type == USB_EXT_PROP_BINARY ||
13027419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_LE32 ||
13037419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_BE32) &&
13047419485fSAndrzej Pietrasiewicz (type == USB_EXT_PROP_UNICODE ||
13057419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_UNICODE_ENV ||
13067419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_UNICODE_LINK))
13077419485fSAndrzej Pietrasiewicz ext_prop->data_len <<= 1;
13087419485fSAndrzej Pietrasiewicz else if ((ext_prop->type == USB_EXT_PROP_UNICODE ||
13097419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV ||
13107419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) &&
13117419485fSAndrzej Pietrasiewicz (type == USB_EXT_PROP_BINARY ||
13127419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_LE32 ||
13137419485fSAndrzej Pietrasiewicz type == USB_EXT_PROP_BE32))
13147419485fSAndrzej Pietrasiewicz ext_prop->data_len >>= 1;
13157419485fSAndrzej Pietrasiewicz ext_prop->type = type;
13167419485fSAndrzej Pietrasiewicz
13177419485fSAndrzej Pietrasiewicz if (desc->opts_mutex)
13187419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex);
13196f7fb48dSAndy Shevchenko return len;
13207419485fSAndrzej Pietrasiewicz }
13217419485fSAndrzej Pietrasiewicz
ext_prop_data_show(struct config_item * item,char * page)132245b6a73fSChristoph Hellwig static ssize_t ext_prop_data_show(struct config_item *item, char *page)
13237419485fSAndrzej Pietrasiewicz {
132445b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item);
13257419485fSAndrzej Pietrasiewicz int len = ext_prop->data_len;
13267419485fSAndrzej Pietrasiewicz
13277419485fSAndrzej Pietrasiewicz if (ext_prop->type == USB_EXT_PROP_UNICODE ||
13287419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV ||
13297419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK)
13307419485fSAndrzej Pietrasiewicz len >>= 1;
13317419485fSAndrzej Pietrasiewicz memcpy(page, ext_prop->data, len);
13327419485fSAndrzej Pietrasiewicz
13337419485fSAndrzej Pietrasiewicz return len;
13347419485fSAndrzej Pietrasiewicz }
13357419485fSAndrzej Pietrasiewicz
ext_prop_data_store(struct config_item * item,const char * page,size_t len)133645b6a73fSChristoph Hellwig static ssize_t ext_prop_data_store(struct config_item *item,
13377419485fSAndrzej Pietrasiewicz const char *page, size_t len)
13387419485fSAndrzej Pietrasiewicz {
133945b6a73fSChristoph Hellwig struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item);
13407419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(ext_prop->item.ci_parent);
13417419485fSAndrzej Pietrasiewicz char *new_data;
13427419485fSAndrzej Pietrasiewicz size_t ret_len = len;
13437419485fSAndrzej Pietrasiewicz
13447419485fSAndrzej Pietrasiewicz if (page[len - 1] == '\n' || page[len - 1] == '\0')
13457419485fSAndrzej Pietrasiewicz --len;
134658b949e0SBenoit Taine new_data = kmemdup(page, len, GFP_KERNEL);
13477419485fSAndrzej Pietrasiewicz if (!new_data)
13487419485fSAndrzej Pietrasiewicz return -ENOMEM;
13497419485fSAndrzej Pietrasiewicz
13507419485fSAndrzej Pietrasiewicz if (desc->opts_mutex)
13517419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex);
13527419485fSAndrzej Pietrasiewicz kfree(ext_prop->data);
13537419485fSAndrzej Pietrasiewicz ext_prop->data = new_data;
13547419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= ext_prop->data_len;
13557419485fSAndrzej Pietrasiewicz ext_prop->data_len = len;
13567419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->data_len;
13577419485fSAndrzej Pietrasiewicz if (ext_prop->type == USB_EXT_PROP_UNICODE ||
13587419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_ENV ||
13597419485fSAndrzej Pietrasiewicz ext_prop->type == USB_EXT_PROP_UNICODE_LINK) {
13607419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= ext_prop->data_len;
13617419485fSAndrzej Pietrasiewicz ext_prop->data_len <<= 1;
13627419485fSAndrzej Pietrasiewicz ext_prop->data_len += 2;
13637419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->data_len;
13647419485fSAndrzej Pietrasiewicz }
13657419485fSAndrzej Pietrasiewicz if (desc->opts_mutex)
13667419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex);
13677419485fSAndrzej Pietrasiewicz return ret_len;
13687419485fSAndrzej Pietrasiewicz }
13697419485fSAndrzej Pietrasiewicz
137045b6a73fSChristoph Hellwig CONFIGFS_ATTR(ext_prop_, type);
137145b6a73fSChristoph Hellwig CONFIGFS_ATTR(ext_prop_, data);
13727419485fSAndrzej Pietrasiewicz
13737419485fSAndrzej Pietrasiewicz static struct configfs_attribute *ext_prop_attrs[] = {
137445b6a73fSChristoph Hellwig &ext_prop_attr_type,
137545b6a73fSChristoph Hellwig &ext_prop_attr_data,
13767419485fSAndrzej Pietrasiewicz NULL,
13777419485fSAndrzej Pietrasiewicz };
13787419485fSAndrzej Pietrasiewicz
usb_os_desc_ext_prop_release(struct config_item * item)13797419485fSAndrzej Pietrasiewicz static void usb_os_desc_ext_prop_release(struct config_item *item)
13807419485fSAndrzej Pietrasiewicz {
13817419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item);
13827419485fSAndrzej Pietrasiewicz
13837419485fSAndrzej Pietrasiewicz kfree(ext_prop); /* frees a whole chunk */
13847419485fSAndrzej Pietrasiewicz }
13857419485fSAndrzej Pietrasiewicz
13867419485fSAndrzej Pietrasiewicz static struct configfs_item_operations ext_prop_ops = {
13877419485fSAndrzej Pietrasiewicz .release = usb_os_desc_ext_prop_release,
13887419485fSAndrzej Pietrasiewicz };
13897419485fSAndrzej Pietrasiewicz
ext_prop_make(struct config_group * group,const char * name)13907419485fSAndrzej Pietrasiewicz static struct config_item *ext_prop_make(
13917419485fSAndrzej Pietrasiewicz struct config_group *group,
13927419485fSAndrzej Pietrasiewicz const char *name)
13937419485fSAndrzej Pietrasiewicz {
13947419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop;
13957419485fSAndrzej Pietrasiewicz struct config_item_type *ext_prop_type;
13967419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc;
13977419485fSAndrzej Pietrasiewicz char *vlabuf;
13987419485fSAndrzej Pietrasiewicz
13997419485fSAndrzej Pietrasiewicz vla_group(data_chunk);
14007419485fSAndrzej Pietrasiewicz vla_item(data_chunk, struct usb_os_desc_ext_prop, ext_prop, 1);
14017419485fSAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, ext_prop_type, 1);
14027419485fSAndrzej Pietrasiewicz
14037419485fSAndrzej Pietrasiewicz vlabuf = kzalloc(vla_group_size(data_chunk), GFP_KERNEL);
14047419485fSAndrzej Pietrasiewicz if (!vlabuf)
14057419485fSAndrzej Pietrasiewicz return ERR_PTR(-ENOMEM);
14067419485fSAndrzej Pietrasiewicz
14077419485fSAndrzej Pietrasiewicz ext_prop = vla_ptr(vlabuf, data_chunk, ext_prop);
14087419485fSAndrzej Pietrasiewicz ext_prop_type = vla_ptr(vlabuf, data_chunk, ext_prop_type);
14097419485fSAndrzej Pietrasiewicz
14107419485fSAndrzej Pietrasiewicz desc = container_of(group, struct usb_os_desc, group);
14117419485fSAndrzej Pietrasiewicz ext_prop_type->ct_item_ops = &ext_prop_ops;
14127419485fSAndrzej Pietrasiewicz ext_prop_type->ct_attrs = ext_prop_attrs;
14137419485fSAndrzej Pietrasiewicz ext_prop_type->ct_owner = desc->owner;
14147419485fSAndrzej Pietrasiewicz
14157419485fSAndrzej Pietrasiewicz config_item_init_type_name(&ext_prop->item, name, ext_prop_type);
14167419485fSAndrzej Pietrasiewicz
14177419485fSAndrzej Pietrasiewicz ext_prop->name = kstrdup(name, GFP_KERNEL);
14187419485fSAndrzej Pietrasiewicz if (!ext_prop->name) {
14197419485fSAndrzej Pietrasiewicz kfree(vlabuf);
14207419485fSAndrzej Pietrasiewicz return ERR_PTR(-ENOMEM);
14217419485fSAndrzej Pietrasiewicz }
14227419485fSAndrzej Pietrasiewicz desc->ext_prop_len += 14;
14237419485fSAndrzej Pietrasiewicz ext_prop->name_len = 2 * strlen(ext_prop->name) + 2;
14247419485fSAndrzej Pietrasiewicz if (desc->opts_mutex)
14257419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex);
14267419485fSAndrzej Pietrasiewicz desc->ext_prop_len += ext_prop->name_len;
14277419485fSAndrzej Pietrasiewicz list_add_tail(&ext_prop->entry, &desc->ext_prop);
14287419485fSAndrzej Pietrasiewicz ++desc->ext_prop_count;
14297419485fSAndrzej Pietrasiewicz if (desc->opts_mutex)
14307419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex);
14317419485fSAndrzej Pietrasiewicz
14327419485fSAndrzej Pietrasiewicz return &ext_prop->item;
14337419485fSAndrzej Pietrasiewicz }
14347419485fSAndrzej Pietrasiewicz
ext_prop_drop(struct config_group * group,struct config_item * item)14357419485fSAndrzej Pietrasiewicz static void ext_prop_drop(struct config_group *group, struct config_item *item)
14367419485fSAndrzej Pietrasiewicz {
14377419485fSAndrzej Pietrasiewicz struct usb_os_desc_ext_prop *ext_prop = to_usb_os_desc_ext_prop(item);
14387419485fSAndrzej Pietrasiewicz struct usb_os_desc *desc = to_usb_os_desc(&group->cg_item);
14397419485fSAndrzej Pietrasiewicz
14407419485fSAndrzej Pietrasiewicz if (desc->opts_mutex)
14417419485fSAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex);
14427419485fSAndrzej Pietrasiewicz list_del(&ext_prop->entry);
14437419485fSAndrzej Pietrasiewicz --desc->ext_prop_count;
14447419485fSAndrzej Pietrasiewicz kfree(ext_prop->name);
14457419485fSAndrzej Pietrasiewicz desc->ext_prop_len -= (ext_prop->name_len + ext_prop->data_len + 14);
14467419485fSAndrzej Pietrasiewicz if (desc->opts_mutex)
14477419485fSAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex);
14487419485fSAndrzej Pietrasiewicz config_item_put(item);
14497419485fSAndrzej Pietrasiewicz }
14507419485fSAndrzej Pietrasiewicz
14517419485fSAndrzej Pietrasiewicz static struct configfs_group_operations interf_grp_ops = {
14527419485fSAndrzej Pietrasiewicz .make_item = &ext_prop_make,
14537419485fSAndrzej Pietrasiewicz .drop_item = &ext_prop_drop,
14547419485fSAndrzej Pietrasiewicz };
14557419485fSAndrzej Pietrasiewicz
interf_grp_compatible_id_show(struct config_item * item,char * page)145645b6a73fSChristoph Hellwig static ssize_t interf_grp_compatible_id_show(struct config_item *item,
1457da424314SAndrzej Pietrasiewicz char *page)
1458da424314SAndrzej Pietrasiewicz {
145945b6a73fSChristoph Hellwig memcpy(page, to_usb_os_desc(item)->ext_compat_id, 8);
1460da424314SAndrzej Pietrasiewicz return 8;
1461da424314SAndrzej Pietrasiewicz }
1462da424314SAndrzej Pietrasiewicz
interf_grp_compatible_id_store(struct config_item * item,const char * page,size_t len)146345b6a73fSChristoph Hellwig static ssize_t interf_grp_compatible_id_store(struct config_item *item,
1464da424314SAndrzej Pietrasiewicz const char *page, size_t len)
1465da424314SAndrzej Pietrasiewicz {
146645b6a73fSChristoph Hellwig struct usb_os_desc *desc = to_usb_os_desc(item);
1467da424314SAndrzej Pietrasiewicz int l;
1468da424314SAndrzej Pietrasiewicz
1469da424314SAndrzej Pietrasiewicz l = min_t(int, 8, len);
1470da424314SAndrzej Pietrasiewicz if (page[l - 1] == '\n')
1471da424314SAndrzej Pietrasiewicz --l;
1472da424314SAndrzej Pietrasiewicz if (desc->opts_mutex)
1473da424314SAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex);
1474da424314SAndrzej Pietrasiewicz memcpy(desc->ext_compat_id, page, l);
1475da424314SAndrzej Pietrasiewicz
1476da424314SAndrzej Pietrasiewicz if (desc->opts_mutex)
1477da424314SAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex);
1478da424314SAndrzej Pietrasiewicz
1479da424314SAndrzej Pietrasiewicz return len;
1480da424314SAndrzej Pietrasiewicz }
1481da424314SAndrzej Pietrasiewicz
interf_grp_sub_compatible_id_show(struct config_item * item,char * page)148245b6a73fSChristoph Hellwig static ssize_t interf_grp_sub_compatible_id_show(struct config_item *item,
1483da424314SAndrzej Pietrasiewicz char *page)
1484da424314SAndrzej Pietrasiewicz {
148545b6a73fSChristoph Hellwig memcpy(page, to_usb_os_desc(item)->ext_compat_id + 8, 8);
1486da424314SAndrzej Pietrasiewicz return 8;
1487da424314SAndrzej Pietrasiewicz }
1488da424314SAndrzej Pietrasiewicz
interf_grp_sub_compatible_id_store(struct config_item * item,const char * page,size_t len)148945b6a73fSChristoph Hellwig static ssize_t interf_grp_sub_compatible_id_store(struct config_item *item,
1490da424314SAndrzej Pietrasiewicz const char *page, size_t len)
1491da424314SAndrzej Pietrasiewicz {
149245b6a73fSChristoph Hellwig struct usb_os_desc *desc = to_usb_os_desc(item);
1493da424314SAndrzej Pietrasiewicz int l;
1494da424314SAndrzej Pietrasiewicz
1495da424314SAndrzej Pietrasiewicz l = min_t(int, 8, len);
1496da424314SAndrzej Pietrasiewicz if (page[l - 1] == '\n')
1497da424314SAndrzej Pietrasiewicz --l;
1498da424314SAndrzej Pietrasiewicz if (desc->opts_mutex)
1499da424314SAndrzej Pietrasiewicz mutex_lock(desc->opts_mutex);
1500da424314SAndrzej Pietrasiewicz memcpy(desc->ext_compat_id + 8, page, l);
1501da424314SAndrzej Pietrasiewicz
1502da424314SAndrzej Pietrasiewicz if (desc->opts_mutex)
1503da424314SAndrzej Pietrasiewicz mutex_unlock(desc->opts_mutex);
1504da424314SAndrzej Pietrasiewicz
1505da424314SAndrzej Pietrasiewicz return len;
1506da424314SAndrzej Pietrasiewicz }
1507da424314SAndrzej Pietrasiewicz
150845b6a73fSChristoph Hellwig CONFIGFS_ATTR(interf_grp_, compatible_id);
150945b6a73fSChristoph Hellwig CONFIGFS_ATTR(interf_grp_, sub_compatible_id);
1510da424314SAndrzej Pietrasiewicz
1511da424314SAndrzej Pietrasiewicz static struct configfs_attribute *interf_grp_attrs[] = {
151245b6a73fSChristoph Hellwig &interf_grp_attr_compatible_id,
151345b6a73fSChristoph Hellwig &interf_grp_attr_sub_compatible_id,
1514da424314SAndrzej Pietrasiewicz NULL
1515da424314SAndrzej Pietrasiewicz };
1516da424314SAndrzej Pietrasiewicz
usb_os_desc_prepare_interf_dir(struct config_group * parent,int n_interf,struct usb_os_desc ** desc,char ** names,struct module * owner)1517ff74745eSAndrew Gabbasov struct config_group *usb_os_desc_prepare_interf_dir(
1518ff74745eSAndrew Gabbasov struct config_group *parent,
1519da424314SAndrzej Pietrasiewicz int n_interf,
1520da424314SAndrzej Pietrasiewicz struct usb_os_desc **desc,
152114574b54SAndrzej Pietrasiewicz char **names,
1522da424314SAndrzej Pietrasiewicz struct module *owner)
1523da424314SAndrzej Pietrasiewicz {
15241ae1602dSChristoph Hellwig struct config_group *os_desc_group;
1525da424314SAndrzej Pietrasiewicz struct config_item_type *os_desc_type, *interface_type;
1526da424314SAndrzej Pietrasiewicz
1527da424314SAndrzej Pietrasiewicz vla_group(data_chunk);
1528da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_group, os_desc_group, 1);
1529da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, os_desc_type, 1);
1530da424314SAndrzej Pietrasiewicz vla_item(data_chunk, struct config_item_type, interface_type, 1);
1531da424314SAndrzej Pietrasiewicz
1532da424314SAndrzej Pietrasiewicz char *vlabuf = kzalloc(vla_group_size(data_chunk), GFP_KERNEL);
1533da424314SAndrzej Pietrasiewicz if (!vlabuf)
1534ff74745eSAndrew Gabbasov return ERR_PTR(-ENOMEM);
1535da424314SAndrzej Pietrasiewicz
1536da424314SAndrzej Pietrasiewicz os_desc_group = vla_ptr(vlabuf, data_chunk, os_desc_group);
1537da424314SAndrzej Pietrasiewicz os_desc_type = vla_ptr(vlabuf, data_chunk, os_desc_type);
1538da424314SAndrzej Pietrasiewicz interface_type = vla_ptr(vlabuf, data_chunk, interface_type);
1539da424314SAndrzej Pietrasiewicz
1540da424314SAndrzej Pietrasiewicz os_desc_type->ct_owner = owner;
1541da424314SAndrzej Pietrasiewicz config_group_init_type_name(os_desc_group, "os_desc", os_desc_type);
15421ae1602dSChristoph Hellwig configfs_add_default_group(os_desc_group, parent);
1543da424314SAndrzej Pietrasiewicz
15447419485fSAndrzej Pietrasiewicz interface_type->ct_group_ops = &interf_grp_ops;
1545da424314SAndrzej Pietrasiewicz interface_type->ct_attrs = interf_grp_attrs;
1546da424314SAndrzej Pietrasiewicz interface_type->ct_owner = owner;
1547da424314SAndrzej Pietrasiewicz
1548da424314SAndrzej Pietrasiewicz while (n_interf--) {
1549da424314SAndrzej Pietrasiewicz struct usb_os_desc *d;
1550da424314SAndrzej Pietrasiewicz
1551da424314SAndrzej Pietrasiewicz d = desc[n_interf];
15527419485fSAndrzej Pietrasiewicz d->owner = owner;
1553da424314SAndrzej Pietrasiewicz config_group_init_type_name(&d->group, "", interface_type);
155414574b54SAndrzej Pietrasiewicz config_item_set_name(&d->group.cg_item, "interface.%s",
155514574b54SAndrzej Pietrasiewicz names[n_interf]);
15561ae1602dSChristoph Hellwig configfs_add_default_group(&d->group, os_desc_group);
1557da424314SAndrzej Pietrasiewicz }
1558da424314SAndrzej Pietrasiewicz
1559ff74745eSAndrew Gabbasov return os_desc_group;
1560da424314SAndrzej Pietrasiewicz }
1561da424314SAndrzej Pietrasiewicz EXPORT_SYMBOL(usb_os_desc_prepare_interf_dir);
1562da424314SAndrzej Pietrasiewicz
configfs_do_nothing(struct usb_composite_dev * cdev)156388af8bbeSSebastian Andrzej Siewior static int configfs_do_nothing(struct usb_composite_dev *cdev)
156488af8bbeSSebastian Andrzej Siewior {
156575bfe23aSDavid Rientjes WARN_ON(1);
156688af8bbeSSebastian Andrzej Siewior return -EINVAL;
156788af8bbeSSebastian Andrzej Siewior }
156888af8bbeSSebastian Andrzej Siewior
156988af8bbeSSebastian Andrzej Siewior int composite_dev_prepare(struct usb_composite_driver *composite,
157088af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *dev);
157188af8bbeSSebastian Andrzej Siewior
1572da424314SAndrzej Pietrasiewicz int composite_os_desc_req_prepare(struct usb_composite_dev *cdev,
1573da424314SAndrzej Pietrasiewicz struct usb_ep *ep0);
1574da424314SAndrzej Pietrasiewicz
purge_configs_funcs(struct gadget_info * gi)157588af8bbeSSebastian Andrzej Siewior static void purge_configs_funcs(struct gadget_info *gi)
157688af8bbeSSebastian Andrzej Siewior {
157788af8bbeSSebastian Andrzej Siewior struct usb_configuration *c;
157888af8bbeSSebastian Andrzej Siewior
157988af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) {
158088af8bbeSSebastian Andrzej Siewior struct usb_function *f, *tmp;
158188af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg;
158288af8bbeSSebastian Andrzej Siewior
158388af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c);
158488af8bbeSSebastian Andrzej Siewior
15856cd0fe91SChandana Kishori Chiluveru list_for_each_entry_safe_reverse(f, tmp, &c->functions, list) {
158688af8bbeSSebastian Andrzej Siewior
15876cd0fe91SChandana Kishori Chiluveru list_move(&f->list, &cfg->func_list);
158888af8bbeSSebastian Andrzej Siewior if (f->unbind) {
1589da7b895dSRomain Izard dev_dbg(&gi->cdev.gadget->dev,
1590a08f5dbfSRomain Izard "unbind function '%s'/%p\n",
1591a08f5dbfSRomain Izard f->name, f);
159288af8bbeSSebastian Andrzej Siewior f->unbind(c, f);
159388af8bbeSSebastian Andrzej Siewior }
159488af8bbeSSebastian Andrzej Siewior }
159588af8bbeSSebastian Andrzej Siewior c->next_interface_id = 0;
1596903124feSKrzysztof Opasiak memset(c->interface, 0, sizeof(c->interface));
1597554eead5SJohn Youn c->superspeed_plus = 0;
159888af8bbeSSebastian Andrzej Siewior c->superspeed = 0;
159988af8bbeSSebastian Andrzej Siewior c->highspeed = 0;
160088af8bbeSSebastian Andrzej Siewior c->fullspeed = 0;
160188af8bbeSSebastian Andrzej Siewior }
160288af8bbeSSebastian Andrzej Siewior }
160388af8bbeSSebastian Andrzej Siewior
1604c0335632SDaniel Scally static struct usb_string *
configfs_attach_gadget_strings(struct gadget_info * gi)1605c0335632SDaniel Scally configfs_attach_gadget_strings(struct gadget_info *gi)
1606c0335632SDaniel Scally {
1607c0335632SDaniel Scally struct usb_gadget_strings **gadget_strings;
1608c0335632SDaniel Scally struct gadget_language *language;
1609c0335632SDaniel Scally struct gadget_string *string;
1610c0335632SDaniel Scally unsigned int nlangs = 0;
1611c0335632SDaniel Scally struct list_head *iter;
1612c0335632SDaniel Scally struct usb_string *us;
1613c0335632SDaniel Scally unsigned int i = 0;
1614c0335632SDaniel Scally int nstrings = -1;
1615c0335632SDaniel Scally unsigned int j;
1616c0335632SDaniel Scally
1617c0335632SDaniel Scally list_for_each(iter, &gi->string_list)
1618c0335632SDaniel Scally nlangs++;
1619c0335632SDaniel Scally
1620c0335632SDaniel Scally /* Bail out early if no languages are configured */
1621c0335632SDaniel Scally if (!nlangs)
1622c0335632SDaniel Scally return NULL;
1623c0335632SDaniel Scally
1624c0335632SDaniel Scally gadget_strings = kcalloc(nlangs + 1, /* including NULL terminator */
1625c0335632SDaniel Scally sizeof(struct usb_gadget_strings *), GFP_KERNEL);
1626c0335632SDaniel Scally if (!gadget_strings)
1627c0335632SDaniel Scally return ERR_PTR(-ENOMEM);
1628c0335632SDaniel Scally
1629c0335632SDaniel Scally list_for_each_entry(language, &gi->string_list, list) {
1630c0335632SDaniel Scally struct usb_string *stringtab;
1631c0335632SDaniel Scally
1632c0335632SDaniel Scally if (nstrings == -1) {
1633c0335632SDaniel Scally nstrings = language->nstrings;
1634c0335632SDaniel Scally } else if (nstrings != language->nstrings) {
1635c0335632SDaniel Scally pr_err("languages must contain the same number of strings\n");
1636c0335632SDaniel Scally us = ERR_PTR(-EINVAL);
1637c0335632SDaniel Scally goto cleanup;
1638c0335632SDaniel Scally }
1639c0335632SDaniel Scally
1640c0335632SDaniel Scally stringtab = kcalloc(language->nstrings + 1, sizeof(struct usb_string),
1641c0335632SDaniel Scally GFP_KERNEL);
1642c0335632SDaniel Scally if (!stringtab) {
1643c0335632SDaniel Scally us = ERR_PTR(-ENOMEM);
1644c0335632SDaniel Scally goto cleanup;
1645c0335632SDaniel Scally }
1646c0335632SDaniel Scally
1647c0335632SDaniel Scally stringtab[USB_GADGET_MANUFACTURER_IDX].id = USB_GADGET_MANUFACTURER_IDX;
1648c0335632SDaniel Scally stringtab[USB_GADGET_MANUFACTURER_IDX].s = language->manufacturer;
1649c0335632SDaniel Scally stringtab[USB_GADGET_PRODUCT_IDX].id = USB_GADGET_PRODUCT_IDX;
1650c0335632SDaniel Scally stringtab[USB_GADGET_PRODUCT_IDX].s = language->product;
1651c0335632SDaniel Scally stringtab[USB_GADGET_SERIAL_IDX].id = USB_GADGET_SERIAL_IDX;
1652c0335632SDaniel Scally stringtab[USB_GADGET_SERIAL_IDX].s = language->serialnumber;
1653c0335632SDaniel Scally
1654c0335632SDaniel Scally j = USB_GADGET_FIRST_AVAIL_IDX;
1655c0335632SDaniel Scally list_for_each_entry(string, &language->gadget_strings, list) {
1656c0335632SDaniel Scally memcpy(&stringtab[j], &string->usb_string, sizeof(struct usb_string));
1657c0335632SDaniel Scally j++;
1658c0335632SDaniel Scally }
1659c0335632SDaniel Scally
1660c0335632SDaniel Scally language->stringtab_dev.strings = stringtab;
1661c0335632SDaniel Scally gadget_strings[i] = &language->stringtab_dev;
1662c0335632SDaniel Scally i++;
1663c0335632SDaniel Scally }
1664c0335632SDaniel Scally
1665c0335632SDaniel Scally us = usb_gstrings_attach(&gi->cdev, gadget_strings, nstrings);
1666c0335632SDaniel Scally
1667c0335632SDaniel Scally cleanup:
1668c0335632SDaniel Scally list_for_each_entry(language, &gi->string_list, list) {
1669c0335632SDaniel Scally kfree(language->stringtab_dev.strings);
1670c0335632SDaniel Scally language->stringtab_dev.strings = NULL;
1671c0335632SDaniel Scally }
1672c0335632SDaniel Scally
1673c0335632SDaniel Scally kfree(gadget_strings);
1674c0335632SDaniel Scally
1675c0335632SDaniel Scally return us;
1676c0335632SDaniel Scally }
1677c0335632SDaniel Scally
configfs_composite_bind(struct usb_gadget * gadget,struct usb_gadget_driver * gdriver)167888af8bbeSSebastian Andrzej Siewior static int configfs_composite_bind(struct usb_gadget *gadget,
167988af8bbeSSebastian Andrzej Siewior struct usb_gadget_driver *gdriver)
168088af8bbeSSebastian Andrzej Siewior {
168188af8bbeSSebastian Andrzej Siewior struct usb_composite_driver *composite = to_cdriver(gdriver);
168288af8bbeSSebastian Andrzej Siewior struct gadget_info *gi = container_of(composite,
168388af8bbeSSebastian Andrzej Siewior struct gadget_info, composite);
168488af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev = &gi->cdev;
168588af8bbeSSebastian Andrzej Siewior struct usb_configuration *c;
168688af8bbeSSebastian Andrzej Siewior struct usb_string *s;
168788af8bbeSSebastian Andrzej Siewior unsigned i;
168888af8bbeSSebastian Andrzej Siewior int ret;
168988af8bbeSSebastian Andrzej Siewior
169088af8bbeSSebastian Andrzej Siewior /* the gi->lock is hold by the caller */
16911a1c851bSPeter Chen gi->unbind = 0;
169288af8bbeSSebastian Andrzej Siewior cdev->gadget = gadget;
169388af8bbeSSebastian Andrzej Siewior set_gadget_data(gadget, cdev);
169488af8bbeSSebastian Andrzej Siewior ret = composite_dev_prepare(composite, cdev);
169588af8bbeSSebastian Andrzej Siewior if (ret)
169688af8bbeSSebastian Andrzej Siewior return ret;
169788af8bbeSSebastian Andrzej Siewior /* and now the gadget bind */
169888af8bbeSSebastian Andrzej Siewior ret = -EINVAL;
169988af8bbeSSebastian Andrzej Siewior
170088af8bbeSSebastian Andrzej Siewior if (list_empty(&gi->cdev.configs)) {
170188af8bbeSSebastian Andrzej Siewior pr_err("Need at least one configuration in %s.\n",
170288af8bbeSSebastian Andrzej Siewior gi->composite.name);
170388af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup;
170488af8bbeSSebastian Andrzej Siewior }
170588af8bbeSSebastian Andrzej Siewior
170688af8bbeSSebastian Andrzej Siewior
170788af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) {
170888af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg;
170988af8bbeSSebastian Andrzej Siewior
171088af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c);
171188af8bbeSSebastian Andrzej Siewior if (list_empty(&cfg->func_list)) {
171288af8bbeSSebastian Andrzej Siewior pr_err("Config %s/%d of %s needs at least one function.\n",
171388af8bbeSSebastian Andrzej Siewior c->label, c->bConfigurationValue,
171488af8bbeSSebastian Andrzej Siewior gi->composite.name);
171588af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup;
171688af8bbeSSebastian Andrzej Siewior }
171788af8bbeSSebastian Andrzej Siewior }
171888af8bbeSSebastian Andrzej Siewior
171988af8bbeSSebastian Andrzej Siewior /* init all strings */
172088af8bbeSSebastian Andrzej Siewior if (!list_empty(&gi->string_list)) {
1721c0335632SDaniel Scally s = configfs_attach_gadget_strings(gi);
1722fea77077SWei Yongjun if (IS_ERR(s)) {
1723fea77077SWei Yongjun ret = PTR_ERR(s);
172488af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup;
1725fea77077SWei Yongjun }
172688af8bbeSSebastian Andrzej Siewior
172788af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iManufacturer = s[USB_GADGET_MANUFACTURER_IDX].id;
172888af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iProduct = s[USB_GADGET_PRODUCT_IDX].id;
172988af8bbeSSebastian Andrzej Siewior gi->cdev.desc.iSerialNumber = s[USB_GADGET_SERIAL_IDX].id;
1730c0335632SDaniel Scally
1731c0335632SDaniel Scally gi->cdev.usb_strings = s;
173288af8bbeSSebastian Andrzej Siewior }
173388af8bbeSSebastian Andrzej Siewior
173493c47394SJó Ágila Bitsch if (gi->use_webusb) {
173593c47394SJó Ágila Bitsch cdev->use_webusb = true;
173693c47394SJó Ágila Bitsch cdev->bcd_webusb_version = gi->bcd_webusb_version;
173793c47394SJó Ágila Bitsch cdev->b_webusb_vendor_code = gi->b_webusb_vendor_code;
173893c47394SJó Ágila Bitsch memcpy(cdev->landing_page, gi->landing_page, WEBUSB_URL_RAW_MAX_LENGTH);
173993c47394SJó Ágila Bitsch }
174093c47394SJó Ágila Bitsch
174187213d38SAndrzej Pietrasiewicz if (gi->use_os_desc) {
174287213d38SAndrzej Pietrasiewicz cdev->use_os_string = true;
174387213d38SAndrzej Pietrasiewicz cdev->b_vendor_code = gi->b_vendor_code;
174487213d38SAndrzej Pietrasiewicz memcpy(cdev->qw_sign, gi->qw_sign, OS_STRING_QW_SIGN_LEN);
174587213d38SAndrzej Pietrasiewicz }
174687213d38SAndrzej Pietrasiewicz
174741ce84c8SLi Jun if (gadget_is_otg(gadget) && !otg_desc[0]) {
174841ce84c8SLi Jun struct usb_descriptor_header *usb_desc;
174941ce84c8SLi Jun
175041ce84c8SLi Jun usb_desc = usb_otg_descriptor_alloc(gadget);
175141ce84c8SLi Jun if (!usb_desc) {
175241ce84c8SLi Jun ret = -ENOMEM;
175341ce84c8SLi Jun goto err_comp_cleanup;
175441ce84c8SLi Jun }
175541ce84c8SLi Jun usb_otg_descriptor_init(gadget, usb_desc);
175641ce84c8SLi Jun otg_desc[0] = usb_desc;
175741ce84c8SLi Jun otg_desc[1] = NULL;
175841ce84c8SLi Jun }
175941ce84c8SLi Jun
176088af8bbeSSebastian Andrzej Siewior /* Go through all configs, attach all functions */
176188af8bbeSSebastian Andrzej Siewior list_for_each_entry(c, &gi->cdev.configs, list) {
176288af8bbeSSebastian Andrzej Siewior struct config_usb_cfg *cfg;
176388af8bbeSSebastian Andrzej Siewior struct usb_function *f;
176488af8bbeSSebastian Andrzej Siewior struct usb_function *tmp;
176588af8bbeSSebastian Andrzej Siewior struct gadget_config_name *cn;
176688af8bbeSSebastian Andrzej Siewior
176741ce84c8SLi Jun if (gadget_is_otg(gadget))
176841ce84c8SLi Jun c->descriptors = otg_desc;
176941ce84c8SLi Jun
1770b93c2a68SElson Roy Serrao /* Properly configure the bmAttributes wakeup bit */
1771b93c2a68SElson Roy Serrao check_remote_wakeup_config(gadget, c);
1772b93c2a68SElson Roy Serrao
177388af8bbeSSebastian Andrzej Siewior cfg = container_of(c, struct config_usb_cfg, c);
177488af8bbeSSebastian Andrzej Siewior if (!list_empty(&cfg->string_list)) {
177588af8bbeSSebastian Andrzej Siewior i = 0;
177688af8bbeSSebastian Andrzej Siewior list_for_each_entry(cn, &cfg->string_list, list) {
177788af8bbeSSebastian Andrzej Siewior cfg->gstrings[i] = &cn->stringtab_dev;
177888af8bbeSSebastian Andrzej Siewior cn->stringtab_dev.strings = &cn->strings;
177988af8bbeSSebastian Andrzej Siewior cn->strings.s = cn->configuration;
178088af8bbeSSebastian Andrzej Siewior i++;
178188af8bbeSSebastian Andrzej Siewior }
178288af8bbeSSebastian Andrzej Siewior cfg->gstrings[i] = NULL;
178388af8bbeSSebastian Andrzej Siewior s = usb_gstrings_attach(&gi->cdev, cfg->gstrings, 1);
1784fea77077SWei Yongjun if (IS_ERR(s)) {
1785fea77077SWei Yongjun ret = PTR_ERR(s);
178688af8bbeSSebastian Andrzej Siewior goto err_comp_cleanup;
1787fea77077SWei Yongjun }
178888af8bbeSSebastian Andrzej Siewior c->iConfiguration = s[0].id;
178988af8bbeSSebastian Andrzej Siewior }
179088af8bbeSSebastian Andrzej Siewior
179188af8bbeSSebastian Andrzej Siewior list_for_each_entry_safe(f, tmp, &cfg->func_list, list) {
179288af8bbeSSebastian Andrzej Siewior list_del(&f->list);
179388af8bbeSSebastian Andrzej Siewior ret = usb_add_function(c, f);
17945a68e9b5SAndrzej Pietrasiewicz if (ret) {
17955a68e9b5SAndrzej Pietrasiewicz list_add(&f->list, &cfg->func_list);
179688af8bbeSSebastian Andrzej Siewior goto err_purge_funcs;
179788af8bbeSSebastian Andrzej Siewior }
17985a68e9b5SAndrzej Pietrasiewicz }
17997adf9e3aSWesley Cheng ret = usb_gadget_check_config(cdev->gadget);
18007adf9e3aSWesley Cheng if (ret)
18017adf9e3aSWesley Cheng goto err_purge_funcs;
18027adf9e3aSWesley Cheng
180388af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget);
180488af8bbeSSebastian Andrzej Siewior }
1805da424314SAndrzej Pietrasiewicz if (cdev->use_os_string) {
1806da424314SAndrzej Pietrasiewicz ret = composite_os_desc_req_prepare(cdev, gadget->ep0);
1807da424314SAndrzej Pietrasiewicz if (ret)
1808da424314SAndrzej Pietrasiewicz goto err_purge_funcs;
1809da424314SAndrzej Pietrasiewicz }
1810da424314SAndrzej Pietrasiewicz
181188af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget);
181288af8bbeSSebastian Andrzej Siewior return 0;
181388af8bbeSSebastian Andrzej Siewior
181488af8bbeSSebastian Andrzej Siewior err_purge_funcs:
181588af8bbeSSebastian Andrzej Siewior purge_configs_funcs(gi);
181688af8bbeSSebastian Andrzej Siewior err_comp_cleanup:
181788af8bbeSSebastian Andrzej Siewior composite_dev_cleanup(cdev);
181888af8bbeSSebastian Andrzej Siewior return ret;
181988af8bbeSSebastian Andrzej Siewior }
182088af8bbeSSebastian Andrzej Siewior
configfs_composite_unbind(struct usb_gadget * gadget)182188af8bbeSSebastian Andrzej Siewior static void configfs_composite_unbind(struct usb_gadget *gadget)
182288af8bbeSSebastian Andrzej Siewior {
182388af8bbeSSebastian Andrzej Siewior struct usb_composite_dev *cdev;
182488af8bbeSSebastian Andrzej Siewior struct gadget_info *gi;
18251a1c851bSPeter Chen unsigned long flags;
182688af8bbeSSebastian Andrzej Siewior
182788af8bbeSSebastian Andrzej Siewior /* the gi->lock is hold by the caller */
182888af8bbeSSebastian Andrzej Siewior
182988af8bbeSSebastian Andrzej Siewior cdev = get_gadget_data(gadget);
183088af8bbeSSebastian Andrzej Siewior gi = container_of(cdev, struct gadget_info, cdev);
18311a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags);
18321a1c851bSPeter Chen gi->unbind = 1;
18331a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags);
183488af8bbeSSebastian Andrzej Siewior
183541ce84c8SLi Jun kfree(otg_desc[0]);
183641ce84c8SLi Jun otg_desc[0] = NULL;
183788af8bbeSSebastian Andrzej Siewior purge_configs_funcs(gi);
183888af8bbeSSebastian Andrzej Siewior composite_dev_cleanup(cdev);
183988af8bbeSSebastian Andrzej Siewior usb_ep_autoconfig_reset(cdev->gadget);
18401a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags);
184188af8bbeSSebastian Andrzej Siewior cdev->gadget = NULL;
1842bf95c4d4SVijayavardhan Vennapusa cdev->deactivations = 0;
1843bf95c4d4SVijayavardhan Vennapusa gadget->deactivated = false;
184488af8bbeSSebastian Andrzej Siewior set_gadget_data(gadget, NULL);
18451a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags);
18461a1c851bSPeter Chen }
18471a1c851bSPeter Chen
configfs_composite_setup(struct usb_gadget * gadget,const struct usb_ctrlrequest * ctrl)18481a1c851bSPeter Chen static int configfs_composite_setup(struct usb_gadget *gadget,
18491a1c851bSPeter Chen const struct usb_ctrlrequest *ctrl)
18501a1c851bSPeter Chen {
18511a1c851bSPeter Chen struct usb_composite_dev *cdev;
18521a1c851bSPeter Chen struct gadget_info *gi;
18531a1c851bSPeter Chen unsigned long flags;
18541a1c851bSPeter Chen int ret;
18551a1c851bSPeter Chen
18561a1c851bSPeter Chen cdev = get_gadget_data(gadget);
18571a1c851bSPeter Chen if (!cdev)
18581a1c851bSPeter Chen return 0;
18591a1c851bSPeter Chen
18601a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev);
18611a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags);
18621a1c851bSPeter Chen cdev = get_gadget_data(gadget);
18631a1c851bSPeter Chen if (!cdev || gi->unbind) {
18641a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags);
18651a1c851bSPeter Chen return 0;
18661a1c851bSPeter Chen }
18671a1c851bSPeter Chen
18681a1c851bSPeter Chen ret = composite_setup(gadget, ctrl);
18691a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags);
18701a1c851bSPeter Chen return ret;
18711a1c851bSPeter Chen }
18721a1c851bSPeter Chen
configfs_composite_disconnect(struct usb_gadget * gadget)18731a1c851bSPeter Chen static void configfs_composite_disconnect(struct usb_gadget *gadget)
18741a1c851bSPeter Chen {
18751a1c851bSPeter Chen struct usb_composite_dev *cdev;
18761a1c851bSPeter Chen struct gadget_info *gi;
18771a1c851bSPeter Chen unsigned long flags;
18781a1c851bSPeter Chen
18791a1c851bSPeter Chen cdev = get_gadget_data(gadget);
18801a1c851bSPeter Chen if (!cdev)
18811a1c851bSPeter Chen return;
18821a1c851bSPeter Chen
18831a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev);
18841a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags);
18851a1c851bSPeter Chen cdev = get_gadget_data(gadget);
18861a1c851bSPeter Chen if (!cdev || gi->unbind) {
18871a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags);
18881a1c851bSPeter Chen return;
18891a1c851bSPeter Chen }
18901a1c851bSPeter Chen
18911a1c851bSPeter Chen composite_disconnect(gadget);
18921a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags);
18931a1c851bSPeter Chen }
18941a1c851bSPeter Chen
configfs_composite_reset(struct usb_gadget * gadget)18954d7aae9fSWesley Cheng static void configfs_composite_reset(struct usb_gadget *gadget)
18964d7aae9fSWesley Cheng {
18974d7aae9fSWesley Cheng struct usb_composite_dev *cdev;
18984d7aae9fSWesley Cheng struct gadget_info *gi;
18994d7aae9fSWesley Cheng unsigned long flags;
19004d7aae9fSWesley Cheng
19014d7aae9fSWesley Cheng cdev = get_gadget_data(gadget);
19024d7aae9fSWesley Cheng if (!cdev)
19034d7aae9fSWesley Cheng return;
19044d7aae9fSWesley Cheng
19054d7aae9fSWesley Cheng gi = container_of(cdev, struct gadget_info, cdev);
19064d7aae9fSWesley Cheng spin_lock_irqsave(&gi->spinlock, flags);
19074d7aae9fSWesley Cheng cdev = get_gadget_data(gadget);
19084d7aae9fSWesley Cheng if (!cdev || gi->unbind) {
19094d7aae9fSWesley Cheng spin_unlock_irqrestore(&gi->spinlock, flags);
19104d7aae9fSWesley Cheng return;
19114d7aae9fSWesley Cheng }
19124d7aae9fSWesley Cheng
19134d7aae9fSWesley Cheng composite_reset(gadget);
19144d7aae9fSWesley Cheng spin_unlock_irqrestore(&gi->spinlock, flags);
19154d7aae9fSWesley Cheng }
19164d7aae9fSWesley Cheng
configfs_composite_suspend(struct usb_gadget * gadget)19171a1c851bSPeter Chen static void configfs_composite_suspend(struct usb_gadget *gadget)
19181a1c851bSPeter Chen {
19191a1c851bSPeter Chen struct usb_composite_dev *cdev;
19201a1c851bSPeter Chen struct gadget_info *gi;
19211a1c851bSPeter Chen unsigned long flags;
19221a1c851bSPeter Chen
19231a1c851bSPeter Chen cdev = get_gadget_data(gadget);
19241a1c851bSPeter Chen if (!cdev)
19251a1c851bSPeter Chen return;
19261a1c851bSPeter Chen
19271a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev);
19281a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags);
19291a1c851bSPeter Chen cdev = get_gadget_data(gadget);
19301a1c851bSPeter Chen if (!cdev || gi->unbind) {
19311a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags);
19321a1c851bSPeter Chen return;
19331a1c851bSPeter Chen }
19341a1c851bSPeter Chen
19351a1c851bSPeter Chen composite_suspend(gadget);
19361a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags);
19371a1c851bSPeter Chen }
19381a1c851bSPeter Chen
configfs_composite_resume(struct usb_gadget * gadget)19391a1c851bSPeter Chen static void configfs_composite_resume(struct usb_gadget *gadget)
19401a1c851bSPeter Chen {
19411a1c851bSPeter Chen struct usb_composite_dev *cdev;
19421a1c851bSPeter Chen struct gadget_info *gi;
19431a1c851bSPeter Chen unsigned long flags;
19441a1c851bSPeter Chen
19451a1c851bSPeter Chen cdev = get_gadget_data(gadget);
19461a1c851bSPeter Chen if (!cdev)
19471a1c851bSPeter Chen return;
19481a1c851bSPeter Chen
19491a1c851bSPeter Chen gi = container_of(cdev, struct gadget_info, cdev);
19501a1c851bSPeter Chen spin_lock_irqsave(&gi->spinlock, flags);
19511a1c851bSPeter Chen cdev = get_gadget_data(gadget);
19521a1c851bSPeter Chen if (!cdev || gi->unbind) {
19531a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags);
19541a1c851bSPeter Chen return;
19551a1c851bSPeter Chen }
19561a1c851bSPeter Chen
19571a1c851bSPeter Chen composite_resume(gadget);
19581a1c851bSPeter Chen spin_unlock_irqrestore(&gi->spinlock, flags);
195988af8bbeSSebastian Andrzej Siewior }
196088af8bbeSSebastian Andrzej Siewior
196188af8bbeSSebastian Andrzej Siewior static const struct usb_gadget_driver configfs_driver_template = {
196288af8bbeSSebastian Andrzej Siewior .bind = configfs_composite_bind,
196388af8bbeSSebastian Andrzej Siewior .unbind = configfs_composite_unbind,
196488af8bbeSSebastian Andrzej Siewior
19651a1c851bSPeter Chen .setup = configfs_composite_setup,
19664d7aae9fSWesley Cheng .reset = configfs_composite_reset,
19671a1c851bSPeter Chen .disconnect = configfs_composite_disconnect,
196888af8bbeSSebastian Andrzej Siewior
19691a1c851bSPeter Chen .suspend = configfs_composite_suspend,
19701a1c851bSPeter Chen .resume = configfs_composite_resume,
19713a571870SAndrzej Pietrasiewicz
1972e2459108Staehyun.cho .max_speed = USB_SPEED_SUPER_PLUS,
197388af8bbeSSebastian Andrzej Siewior .driver = {
197488af8bbeSSebastian Andrzej Siewior .owner = THIS_MODULE,
197588af8bbeSSebastian Andrzej Siewior },
1976f1bddbb3SKrzysztof Opasiak .match_existing_only = 1,
197788af8bbeSSebastian Andrzej Siewior };
197888af8bbeSSebastian Andrzej Siewior
gadgets_make(struct config_group * group,const char * name)197988af8bbeSSebastian Andrzej Siewior static struct config_group *gadgets_make(
198088af8bbeSSebastian Andrzej Siewior struct config_group *group,
198188af8bbeSSebastian Andrzej Siewior const char *name)
198288af8bbeSSebastian Andrzej Siewior {
198388af8bbeSSebastian Andrzej Siewior struct gadget_info *gi;
198488af8bbeSSebastian Andrzej Siewior
198588af8bbeSSebastian Andrzej Siewior gi = kzalloc(sizeof(*gi), GFP_KERNEL);
198688af8bbeSSebastian Andrzej Siewior if (!gi)
198788af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM);
198888af8bbeSSebastian Andrzej Siewior
19891ae1602dSChristoph Hellwig config_group_init_type_name(&gi->group, name, &gadget_root_type);
199088af8bbeSSebastian Andrzej Siewior
199188af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->functions_group, "functions",
199288af8bbeSSebastian Andrzej Siewior &functions_type);
19931ae1602dSChristoph Hellwig configfs_add_default_group(&gi->functions_group, &gi->group);
19941ae1602dSChristoph Hellwig
199588af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->configs_group, "configs",
199688af8bbeSSebastian Andrzej Siewior &config_desc_type);
19971ae1602dSChristoph Hellwig configfs_add_default_group(&gi->configs_group, &gi->group);
19981ae1602dSChristoph Hellwig
199988af8bbeSSebastian Andrzej Siewior config_group_init_type_name(&gi->strings_group, "strings",
20006e2a512dSDaniel Scally &gadget_language_strings_type);
20011ae1602dSChristoph Hellwig configfs_add_default_group(&gi->strings_group, &gi->group);
20021ae1602dSChristoph Hellwig
200387213d38SAndrzej Pietrasiewicz config_group_init_type_name(&gi->os_desc_group, "os_desc",
200487213d38SAndrzej Pietrasiewicz &os_desc_type);
20051ae1602dSChristoph Hellwig configfs_add_default_group(&gi->os_desc_group, &gi->group);
200688af8bbeSSebastian Andrzej Siewior
200793c47394SJó Ágila Bitsch config_group_init_type_name(&gi->webusb_group, "webusb",
200893c47394SJó Ágila Bitsch &webusb_type);
200993c47394SJó Ágila Bitsch configfs_add_default_group(&gi->webusb_group, &gi->group);
201093c47394SJó Ágila Bitsch
201188af8bbeSSebastian Andrzej Siewior gi->composite.bind = configfs_do_nothing;
201288af8bbeSSebastian Andrzej Siewior gi->composite.unbind = configfs_do_nothing;
201388af8bbeSSebastian Andrzej Siewior gi->composite.suspend = NULL;
201488af8bbeSSebastian Andrzej Siewior gi->composite.resume = NULL;
2015e2459108Staehyun.cho gi->composite.max_speed = USB_SPEED_SUPER_PLUS;
201688af8bbeSSebastian Andrzej Siewior
2017093edc2bSWei Yongjun spin_lock_init(&gi->spinlock);
201888af8bbeSSebastian Andrzej Siewior mutex_init(&gi->lock);
201988af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&gi->string_list);
202088af8bbeSSebastian Andrzej Siewior INIT_LIST_HEAD(&gi->available_func);
202188af8bbeSSebastian Andrzej Siewior
202288af8bbeSSebastian Andrzej Siewior composite_init_dev(&gi->cdev);
202388af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bLength = USB_DT_DEVICE_SIZE;
202488af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bDescriptorType = USB_DT_DEVICE;
202588af8bbeSSebastian Andrzej Siewior gi->cdev.desc.bcdDevice = cpu_to_le16(get_default_bcdDevice());
202688af8bbeSSebastian Andrzej Siewior
202788af8bbeSSebastian Andrzej Siewior gi->composite.gadget_driver = configfs_driver_template;
202888af8bbeSSebastian Andrzej Siewior
20297c075538SChanh Nguyen gi->composite.gadget_driver.driver.name = kasprintf(GFP_KERNEL,
20307c075538SChanh Nguyen "configfs-gadget.%s", name);
20317c075538SChanh Nguyen if (!gi->composite.gadget_driver.driver.name)
20327c075538SChanh Nguyen goto err;
20337c075538SChanh Nguyen
203488af8bbeSSebastian Andrzej Siewior gi->composite.gadget_driver.function = kstrdup(name, GFP_KERNEL);
203588af8bbeSSebastian Andrzej Siewior gi->composite.name = gi->composite.gadget_driver.function;
203688af8bbeSSebastian Andrzej Siewior
203788af8bbeSSebastian Andrzej Siewior if (!gi->composite.gadget_driver.function)
20387c075538SChanh Nguyen goto out_free_driver_name;
203988af8bbeSSebastian Andrzej Siewior
204088af8bbeSSebastian Andrzej Siewior return &gi->group;
20417c075538SChanh Nguyen
20427c075538SChanh Nguyen out_free_driver_name:
20437c075538SChanh Nguyen kfree(gi->composite.gadget_driver.driver.name);
204488af8bbeSSebastian Andrzej Siewior err:
204588af8bbeSSebastian Andrzej Siewior kfree(gi);
204688af8bbeSSebastian Andrzej Siewior return ERR_PTR(-ENOMEM);
204788af8bbeSSebastian Andrzej Siewior }
204888af8bbeSSebastian Andrzej Siewior
gadgets_drop(struct config_group * group,struct config_item * item)204988af8bbeSSebastian Andrzej Siewior static void gadgets_drop(struct config_group *group, struct config_item *item)
205088af8bbeSSebastian Andrzej Siewior {
205188af8bbeSSebastian Andrzej Siewior config_item_put(item);
205288af8bbeSSebastian Andrzej Siewior }
205388af8bbeSSebastian Andrzej Siewior
205488af8bbeSSebastian Andrzej Siewior static struct configfs_group_operations gadgets_ops = {
205588af8bbeSSebastian Andrzej Siewior .make_group = &gadgets_make,
205688af8bbeSSebastian Andrzej Siewior .drop_item = &gadgets_drop,
205788af8bbeSSebastian Andrzej Siewior };
205888af8bbeSSebastian Andrzej Siewior
20594ad01412SBhumika Goyal static const struct config_item_type gadgets_type = {
206088af8bbeSSebastian Andrzej Siewior .ct_group_ops = &gadgets_ops,
206188af8bbeSSebastian Andrzej Siewior .ct_owner = THIS_MODULE,
206288af8bbeSSebastian Andrzej Siewior };
206388af8bbeSSebastian Andrzej Siewior
206488af8bbeSSebastian Andrzej Siewior static struct configfs_subsystem gadget_subsys = {
206588af8bbeSSebastian Andrzej Siewior .su_group = {
206688af8bbeSSebastian Andrzej Siewior .cg_item = {
206788af8bbeSSebastian Andrzej Siewior .ci_namebuf = "usb_gadget",
206888af8bbeSSebastian Andrzej Siewior .ci_type = &gadgets_type,
206988af8bbeSSebastian Andrzej Siewior },
207088af8bbeSSebastian Andrzej Siewior },
207188af8bbeSSebastian Andrzej Siewior .su_mutex = __MUTEX_INITIALIZER(gadget_subsys.su_mutex),
207288af8bbeSSebastian Andrzej Siewior };
207388af8bbeSSebastian Andrzej Siewior
unregister_gadget_item(struct config_item * item)2074092a4bd0SAndrzej Pietrasiewicz void unregister_gadget_item(struct config_item *item)
2075092a4bd0SAndrzej Pietrasiewicz {
2076092a4bd0SAndrzej Pietrasiewicz struct gadget_info *gi = to_gadget_info(item);
2077092a4bd0SAndrzej Pietrasiewicz
2078cee51c33SWinter Wang mutex_lock(&gi->lock);
2079092a4bd0SAndrzej Pietrasiewicz unregister_gadget(gi);
2080cee51c33SWinter Wang mutex_unlock(&gi->lock);
2081092a4bd0SAndrzej Pietrasiewicz }
20820700faafSFelipe Balbi EXPORT_SYMBOL_GPL(unregister_gadget_item);
2083092a4bd0SAndrzej Pietrasiewicz
gadget_cfs_init(void)208488af8bbeSSebastian Andrzej Siewior static int __init gadget_cfs_init(void)
208588af8bbeSSebastian Andrzej Siewior {
208688af8bbeSSebastian Andrzej Siewior int ret;
208788af8bbeSSebastian Andrzej Siewior
208888af8bbeSSebastian Andrzej Siewior config_group_init(&gadget_subsys.su_group);
208988af8bbeSSebastian Andrzej Siewior
209088af8bbeSSebastian Andrzej Siewior ret = configfs_register_subsystem(&gadget_subsys);
209188af8bbeSSebastian Andrzej Siewior return ret;
209288af8bbeSSebastian Andrzej Siewior }
209388af8bbeSSebastian Andrzej Siewior module_init(gadget_cfs_init);
209488af8bbeSSebastian Andrzej Siewior
gadget_cfs_exit(void)209588af8bbeSSebastian Andrzej Siewior static void __exit gadget_cfs_exit(void)
209688af8bbeSSebastian Andrzej Siewior {
209788af8bbeSSebastian Andrzej Siewior configfs_unregister_subsystem(&gadget_subsys);
209888af8bbeSSebastian Andrzej Siewior }
209988af8bbeSSebastian Andrzej Siewior module_exit(gadget_cfs_exit);
2100