#include #include /* * kbuild is not very cooperative with respect to linking separately * compiled library objects into one module. So for now we won't use * separate compilation ... ensuring init/exit sections work to shrink * the runtime footprint, and giving us at least some parts of what * a "gcc --combine ... part1.c part2.c part3.c ... " build would. */ #include "composite.c" #include "usbstring.c" #include "config.c" #include "epautoconf.c" #if defined CONFIG_USB_FUNCTIONFS_ETH || defined CONFIG_USB_FUNCTIONFS_RNDIS # if defined USB_ETH_RNDIS # undef USB_ETH_RNDIS # endif # ifdef CONFIG_USB_FUNCTIONFS_RNDIS # define USB_ETH_RNDIS y # endif # include "f_ecm.c" # include "f_subset.c" # ifdef USB_ETH_RNDIS # include "f_rndis.c" # include "rndis.c" # endif # include "u_ether.c" static u8 gfs_hostaddr[ETH_ALEN]; #else # if !defined CONFIG_USB_FUNCTIONFS_GENERIC # define CONFIG_USB_FUNCTIONFS_GENERIC # endif # define gether_cleanup() do { } while (0) # define gether_setup(gadget, hostaddr) ((int)0) #endif #include "f_fs.c" #define DRIVER_NAME "g_ffs" #define DRIVER_DESC "USB Function Filesystem" #define DRIVER_VERSION "24 Aug 2004" MODULE_DESCRIPTION(DRIVER_DESC); MODULE_AUTHOR("Michal Nazarewicz"); MODULE_LICENSE("GPL"); static unsigned short gfs_vendor_id = 0x0525; /* XXX NetChip */ static unsigned short gfs_product_id = 0xa4ac; /* XXX */ static struct usb_device_descriptor gfs_dev_desc = { .bLength = sizeof gfs_dev_desc, .bDescriptorType = USB_DT_DEVICE, .bcdUSB = cpu_to_le16(0x0200), .bDeviceClass = USB_CLASS_PER_INTERFACE, /* Vendor and product id can be overridden by module parameters. */ /* .idVendor = cpu_to_le16(gfs_vendor_id), */ /* .idProduct = cpu_to_le16(gfs_product_id), */ /* .bcdDevice = f(hardware) */ /* .iManufacturer = DYNAMIC */ /* .iProduct = DYNAMIC */ /* NO SERIAL NUMBER */ .bNumConfigurations = 1, }; #define GFS_MODULE_PARAM_DESC(name, field) \ MODULE_PARM_DESC(name, "Value of the " #field " field of the device descriptor sent to the host. Takes effect only prior to the user-space driver registering to the FunctionFS.") module_param_named(usb_class, gfs_dev_desc.bDeviceClass, byte, 0644); GFS_MODULE_PARAM_DESC(usb_class, bDeviceClass); module_param_named(usb_subclass, gfs_dev_desc.bDeviceSubClass, byte, 0644); GFS_MODULE_PARAM_DESC(usb_subclass, bDeviceSubClass); module_param_named(usb_protocol, gfs_dev_desc.bDeviceProtocol, byte, 0644); GFS_MODULE_PARAM_DESC(usb_protocol, bDeviceProtocol); module_param_named(usb_vendor, gfs_vendor_id, ushort, 0644); GFS_MODULE_PARAM_DESC(usb_vendor, idVendor); module_param_named(usb_product, gfs_product_id, ushort, 0644); GFS_MODULE_PARAM_DESC(usb_product, idProduct); static const struct usb_descriptor_header *gfs_otg_desc[] = { (const struct usb_descriptor_header *) &(const struct usb_otg_descriptor) { .bLength = sizeof(struct usb_otg_descriptor), .bDescriptorType = USB_DT_OTG, /* REVISIT SRP-only hardware is possible, although * it would not be called "OTG" ... */ .bmAttributes = USB_OTG_SRP | USB_OTG_HNP, }, NULL }; /* string IDs are assigned dynamically */ enum { GFS_STRING_MANUFACTURER_IDX, GFS_STRING_PRODUCT_IDX, #ifdef CONFIG_USB_FUNCTIONFS_RNDIS GFS_STRING_RNDIS_CONFIG_IDX, #endif #ifdef CONFIG_USB_FUNCTIONFS_ETH GFS_STRING_ECM_CONFIG_IDX, #endif #ifdef CONFIG_USB_FUNCTIONFS_GENERIC GFS_STRING_GENERIC_CONFIG_IDX, #endif }; static char gfs_manufacturer[50]; static const char gfs_driver_desc[] = DRIVER_DESC; static const char gfs_short_name[] = DRIVER_NAME; static struct usb_string gfs_strings[] = { [GFS_STRING_MANUFACTURER_IDX].s = gfs_manufacturer, [GFS_STRING_PRODUCT_IDX].s = gfs_driver_desc, #ifdef CONFIG_USB_FUNCTIONFS_RNDIS [GFS_STRING_RNDIS_CONFIG_IDX].s = "FunctionFS + RNDIS", #endif #ifdef CONFIG_USB_FUNCTIONFS_ETH [GFS_STRING_ECM_CONFIG_IDX].s = "FunctionFS + ECM", #endif #ifdef CONFIG_USB_FUNCTIONFS_GENERIC [GFS_STRING_GENERIC_CONFIG_IDX].s = "FunctionFS", #endif { } /* end of list */ }; static struct usb_gadget_strings *gfs_dev_strings[] = { &(struct usb_gadget_strings) { .language = 0x0409, /* en-us */ .strings = gfs_strings, }, NULL, }; #ifdef CONFIG_USB_FUNCTIONFS_RNDIS static int gfs_do_rndis_config(struct usb_configuration *c); static struct usb_configuration gfs_rndis_config_driver = { .label = "FunctionFS + RNDIS", .bind = gfs_do_rndis_config, .bConfigurationValue = 1, /* .iConfiguration = DYNAMIC */ .bmAttributes = USB_CONFIG_ATT_SELFPOWER, }; # define gfs_add_rndis_config(cdev) \ usb_add_config(cdev, &gfs_rndis_config_driver) #else # define gfs_add_rndis_config(cdev) 0 #endif #ifdef CONFIG_USB_FUNCTIONFS_ETH static int gfs_do_ecm_config(struct usb_configuration *c); static struct usb_configuration gfs_ecm_config_driver = { .label = "FunctionFS + ECM", .bind = gfs_do_ecm_config, .bConfigurationValue = 1, /* .iConfiguration = DYNAMIC */ .bmAttributes = USB_CONFIG_ATT_SELFPOWER, }; # define gfs_add_ecm_config(cdev) \ usb_add_config(cdev, &gfs_ecm_config_driver) #else # define gfs_add_ecm_config(cdev) 0 #endif #ifdef CONFIG_USB_FUNCTIONFS_GENERIC static int gfs_do_generic_config(struct usb_configuration *c); static struct usb_configuration gfs_generic_config_driver = { .label = "FunctionFS", .bind = gfs_do_generic_config, .bConfigurationValue = 2, /* .iConfiguration = DYNAMIC */ .bmAttributes = USB_CONFIG_ATT_SELFPOWER, }; # define gfs_add_generic_config(cdev) \ usb_add_config(cdev, &gfs_generic_config_driver) #else # define gfs_add_generic_config(cdev) 0 #endif static int gfs_bind(struct usb_composite_dev *cdev); static int gfs_unbind(struct usb_composite_dev *cdev); static struct usb_composite_driver gfs_driver = { .name = gfs_short_name, .dev = &gfs_dev_desc, .strings = gfs_dev_strings, .bind = gfs_bind, .unbind = gfs_unbind, }; static struct ffs_data *gfs_ffs_data; static unsigned long gfs_registered; static int gfs_init(void) { ENTER(); return functionfs_init(); } module_init(gfs_init); static void gfs_exit(void) { ENTER(); if (test_and_clear_bit(0, &gfs_registered)) usb_composite_unregister(&gfs_driver); functionfs_cleanup(); } module_exit(gfs_exit); static int functionfs_ready_callback(struct ffs_data *ffs) { int ret; ENTER(); if (WARN_ON(test_and_set_bit(0, &gfs_registered))) return -EBUSY; gfs_ffs_data = ffs; ret = usb_composite_register(&gfs_driver); if (unlikely(ret < 0)) clear_bit(0, &gfs_registered); return ret; } static void functionfs_closed_callback(struct ffs_data *ffs) { ENTER(); if (test_and_clear_bit(0, &gfs_registered)) usb_composite_unregister(&gfs_driver); } static int functionfs_check_dev_callback(const char *dev_name) { return 0; } static int gfs_bind(struct usb_composite_dev *cdev) { int ret; ENTER(); if (WARN_ON(!gfs_ffs_data)) return -ENODEV; ret = gether_setup(cdev->gadget, gfs_hostaddr); if (unlikely(ret < 0)) goto error_quick; gfs_dev_desc.idVendor = cpu_to_le16(gfs_vendor_id); gfs_dev_desc.idProduct = cpu_to_le16(gfs_product_id); snprintf(gfs_manufacturer, sizeof gfs_manufacturer, "%s %s with %s", init_utsname()->sysname, init_utsname()->release, cdev->gadget->name); ret = usb_string_id(cdev); if (unlikely(ret < 0)) goto error; gfs_strings[GFS_STRING_MANUFACTURER_IDX].id = ret; gfs_dev_desc.iManufacturer = ret; ret = usb_string_id(cdev); if (unlikely(ret < 0)) goto error; gfs_strings[GFS_STRING_PRODUCT_IDX].id = ret; gfs_dev_desc.iProduct = ret; #ifdef CONFIG_USB_FUNCTIONFS_RNDIS ret = usb_string_id(cdev); if (unlikely(ret < 0)) goto error; gfs_strings[GFS_STRING_RNDIS_CONFIG_IDX].id = ret; gfs_rndis_config_driver.iConfiguration = ret; #endif #ifdef CONFIG_USB_FUNCTIONFS_ETH ret = usb_string_id(cdev); if (unlikely(ret < 0)) goto error; gfs_strings[GFS_STRING_ECM_CONFIG_IDX].id = ret; gfs_ecm_config_driver.iConfiguration = ret; #endif #ifdef CONFIG_USB_FUNCTIONFS_GENERIC ret = usb_string_id(cdev); if (unlikely(ret < 0)) goto error; gfs_strings[GFS_STRING_GENERIC_CONFIG_IDX].id = ret; gfs_generic_config_driver.iConfiguration = ret; #endif ret = functionfs_bind(gfs_ffs_data, cdev); if (unlikely(ret < 0)) goto error; ret = gfs_add_rndis_config(cdev); if (unlikely(ret < 0)) goto error_unbind; ret = gfs_add_ecm_config(cdev); if (unlikely(ret < 0)) goto error_unbind; ret = gfs_add_generic_config(cdev); if (unlikely(ret < 0)) goto error_unbind; return 0; error_unbind: functionfs_unbind(gfs_ffs_data); error: gether_cleanup(); error_quick: gfs_ffs_data = NULL; return ret; } static int gfs_unbind(struct usb_composite_dev *cdev) { ENTER(); /* We may have been called in an error recovery frem * composite_bind() after gfs_unbind() failure so we need to * check if gfs_ffs_data is not NULL since gfs_bind() handles * all error recovery itself. I'd rather we werent called * from composite on orror recovery, but what you're gonna * do...? */ if (gfs_ffs_data) { gether_cleanup(); functionfs_unbind(gfs_ffs_data); gfs_ffs_data = NULL; } return 0; } static int __gfs_do_config(struct usb_configuration *c, int (*eth)(struct usb_configuration *c, u8 *ethaddr), u8 *ethaddr) { int ret; if (WARN_ON(!gfs_ffs_data)) return -ENODEV; if (gadget_is_otg(c->cdev->gadget)) { c->descriptors = gfs_otg_desc; c->bmAttributes |= USB_CONFIG_ATT_WAKEUP; } if (eth) { ret = eth(c, ethaddr); if (unlikely(ret < 0)) return ret; } ret = functionfs_add(c->cdev, c, gfs_ffs_data); if (unlikely(ret < 0)) return ret; /* After previous do_configs there may be some invalid * pointers in c->interface array. This happens every time * a user space function with fewer interfaces than a user * space function that was run before the new one is run. The * compasit's set_config() assumes that if there is no more * then MAX_CONFIG_INTERFACES interfaces in a configuration * then there is a NULL pointer after the last interface in * c->interface array. We need to make sure this is true. */ if (c->next_interface_id < ARRAY_SIZE(c->interface)) c->interface[c->next_interface_id] = NULL; return 0; } #ifdef CONFIG_USB_FUNCTIONFS_RNDIS static int gfs_do_rndis_config(struct usb_configuration *c) { ENTER(); return __gfs_do_config(c, rndis_bind_config, gfs_hostaddr); } #endif #ifdef CONFIG_USB_FUNCTIONFS_ETH static int gfs_do_ecm_config(struct usb_configuration *c) { ENTER(); return __gfs_do_config(c, can_support_ecm(c->cdev->gadget) ? ecm_bind_config : geth_bind_config, gfs_hostaddr); } #endif #ifdef CONFIG_USB_FUNCTIONFS_GENERIC static int gfs_do_generic_config(struct usb_configuration *c) { ENTER(); return __gfs_do_config(c, NULL, NULL); } #endif