Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * ether.c -- Ethernet gadget driver, with CDC and non-CDC options |
| 3 | * |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 4 | * Copyright (C) 2003-2005,2008 David Brownell |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5 | * Copyright (C) 2003-2004 Robert Schwebel, Benedikt Spranger |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 6 | * Copyright (C) 2008 Nokia Corporation |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 7 | * |
| 8 | * This program is free software; you can redistribute it and/or modify |
| 9 | * it under the terms of the GNU General Public License as published by |
| 10 | * the Free Software Foundation; either version 2 of the License, or |
| 11 | * (at your option) any later version. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 12 | */ |
| 13 | |
David Brownell | 0cf4f2d | 2007-08-02 00:00:38 -0700 | [diff] [blame] | 14 | /* #define VERBOSE_DEBUG */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 15 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | #include <linux/kernel.h> |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 17 | #include <linux/netdevice.h> |
Michal Nazarewicz | 396cda9 | 2009-11-30 10:55:40 +0100 | [diff] [blame] | 18 | |
| 19 | #if defined USB_ETH_RNDIS |
| 20 | # undef USB_ETH_RNDIS |
| 21 | #endif |
| 22 | #ifdef CONFIG_USB_ETH_RNDIS |
| 23 | # define USB_ETH_RNDIS y |
| 24 | #endif |
| 25 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 26 | #include "u_ether.h" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 27 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 28 | |
| 29 | /* |
| 30 | * Ethernet gadget driver -- with CDC and non-CDC options |
| 31 | * Builds on hardware support for a full duplex link. |
| 32 | * |
| 33 | * CDC Ethernet is the standard USB solution for sending Ethernet frames |
| 34 | * using USB. Real hardware tends to use the same framing protocol but look |
| 35 | * different for control features. This driver strongly prefers to use |
| 36 | * this USB-IF standard as its open-systems interoperability solution; |
| 37 | * most host side USB stacks (except from Microsoft) support it. |
| 38 | * |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 39 | * This is sometimes called "CDC ECM" (Ethernet Control Model) to support |
| 40 | * TLA-soup. "CDC ACM" (Abstract Control Model) is for modems, and a new |
| 41 | * "CDC EEM" (Ethernet Emulation Model) is starting to spread. |
| 42 | * |
| 43 | * There's some hardware that can't talk CDC ECM. We make that hardware |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 44 | * implement a "minimalist" vendor-agnostic CDC core: same framing, but |
David Brownell | 11d5489 | 2006-12-11 15:59:04 -0800 | [diff] [blame] | 45 | * link-level setup only requires activating the configuration. Only the |
| 46 | * endpoint descriptors, and product/vendor IDs, are relevant; no control |
| 47 | * operations are available. Linux supports it, but other host operating |
| 48 | * systems may not. (This is a subset of CDC Ethernet.) |
| 49 | * |
| 50 | * It turns out that if you add a few descriptors to that "CDC Subset", |
| 51 | * (Windows) host side drivers from MCCI can treat it as one submode of |
| 52 | * a proprietary scheme called "SAFE" ... without needing to know about |
| 53 | * specific product/vendor IDs. So we do that, making it easier to use |
| 54 | * those MS-Windows drivers. Those added descriptors make it resemble a |
| 55 | * CDC MDLM device, but they don't change device behavior at all. (See |
| 56 | * MCCI Engineering report 950198 "SAFE Networking Functions".) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 57 | * |
| 58 | * A third option is also in use. Rather than CDC Ethernet, or something |
| 59 | * simpler, Microsoft pushes their own approach: RNDIS. The published |
| 60 | * RNDIS specs are ambiguous and appear to be incomplete, and are also |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 61 | * needlessly complex. They borrow more from CDC ACM than CDC ECM. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 62 | */ |
| 63 | |
| 64 | #define DRIVER_DESC "Ethernet Gadget" |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 65 | #define DRIVER_VERSION "Memorial Day 2008" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 66 | |
Michal Nazarewicz | 396cda9 | 2009-11-30 10:55:40 +0100 | [diff] [blame] | 67 | #ifdef USB_ETH_RNDIS |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 68 | #define PREFIX "RNDIS/" |
| 69 | #else |
| 70 | #define PREFIX "" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 71 | #endif |
| 72 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 73 | /* |
| 74 | * This driver aims for interoperability by using CDC ECM unless |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 75 | * |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 76 | * can_support_ecm() |
| 77 | * |
| 78 | * returns false, in which case it supports the CDC Subset. By default, |
| 79 | * that returns true; most hardware has no problems with CDC ECM, that's |
| 80 | * a good default. Previous versions of this driver had no default; this |
| 81 | * version changes that, removing overhead for new controller support. |
| 82 | * |
| 83 | * IF YOUR HARDWARE CAN'T SUPPORT CDC ECM, UPDATE THAT ROUTINE! |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 84 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 85 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 86 | static inline bool has_rndis(void) |
| 87 | { |
Michal Nazarewicz | 396cda9 | 2009-11-30 10:55:40 +0100 | [diff] [blame] | 88 | #ifdef USB_ETH_RNDIS |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 89 | return true; |
| 90 | #else |
| 91 | return false; |
| 92 | #endif |
| 93 | } |
| 94 | |
Andrzej Pietrasiewicz | cbbd14a | 2013-05-24 10:23:02 +0200 | [diff] [blame] | 95 | #include <linux/module.h> |
| 96 | |
Andrzej Pietrasiewicz | 9c62ce8 | 2013-05-28 09:15:46 +0200 | [diff] [blame] | 97 | #include "u_ecm.h" |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 98 | #include "u_gether.h" |
Michal Nazarewicz | 396cda9 | 2009-11-30 10:55:40 +0100 | [diff] [blame] | 99 | #ifdef USB_ETH_RNDIS |
Andrzej Pietrasiewicz | 9bd4a10 | 2013-05-28 09:15:58 +0200 | [diff] [blame] | 100 | #include "u_rndis.h" |
Andrzej Pietrasiewicz | cbbd14a | 2013-05-24 10:23:02 +0200 | [diff] [blame] | 101 | #include "rndis.h" |
Andrzej Pietrasiewicz | 9bd4a10 | 2013-05-28 09:15:58 +0200 | [diff] [blame] | 102 | #else |
| 103 | #define rndis_borrow_net(...) do {} while (0) |
David Brownell | 33376c1 | 2008-08-18 17:45:07 -0700 | [diff] [blame] | 104 | #endif |
Andrzej Pietrasiewicz | 94b5573 | 2013-05-28 09:15:48 +0200 | [diff] [blame] | 105 | #include "u_eem.h" |
David Brownell | 33376c1 | 2008-08-18 17:45:07 -0700 | [diff] [blame] | 106 | |
| 107 | /*-------------------------------------------------------------------------*/ |
Sebastian Andrzej Siewior | 7d16e8d | 2012-09-10 15:01:53 +0200 | [diff] [blame] | 108 | USB_GADGET_COMPOSITE_OPTIONS(); |
David Brownell | 33376c1 | 2008-08-18 17:45:07 -0700 | [diff] [blame] | 109 | |
Andrzej Pietrasiewicz | f1a1823 | 2013-05-23 09:22:03 +0200 | [diff] [blame] | 110 | USB_ETHERNET_MODULE_PARAMETERS(); |
| 111 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 112 | /* DO NOT REUSE THESE IDs with a protocol-incompatible driver!! Ever!! |
| 113 | * Instead: allocate your own, using normal USB-IF procedures. |
| 114 | */ |
| 115 | |
| 116 | /* Thanks to NetChip Technologies for donating this product ID. |
| 117 | * It's for devices with only CDC Ethernet configurations. |
| 118 | */ |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 119 | #define CDC_VENDOR_NUM 0x0525 /* NetChip */ |
| 120 | #define CDC_PRODUCT_NUM 0xa4a1 /* Linux-USB Ethernet Gadget */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 121 | |
| 122 | /* For hardware that can't talk CDC, we use the same vendor ID that |
| 123 | * ARM Linux has used for ethernet-over-usb, both with sa1100 and |
| 124 | * with pxa250. We're protocol-compatible, if the host-side drivers |
| 125 | * use the endpoint descriptors. bcdDevice (version) is nonzero, so |
| 126 | * drivers that need to hard-wire endpoint numbers have a hook. |
| 127 | * |
| 128 | * The protocol is a minimal subset of CDC Ether, which works on any bulk |
| 129 | * hardware that's not deeply broken ... even on hardware that can't talk |
| 130 | * RNDIS (like SA-1100, with no interrupt endpoint, or anything that |
| 131 | * doesn't handle control-OUT). |
| 132 | */ |
| 133 | #define SIMPLE_VENDOR_NUM 0x049f |
| 134 | #define SIMPLE_PRODUCT_NUM 0x505a |
| 135 | |
| 136 | /* For hardware that can talk RNDIS and either of the above protocols, |
| 137 | * use this ID ... the windows INF files will know it. Unless it's |
| 138 | * used with CDC Ethernet, Linux 2.4 hosts will need updates to choose |
| 139 | * the non-RNDIS configuration. |
| 140 | */ |
| 141 | #define RNDIS_VENDOR_NUM 0x0525 /* NetChip */ |
| 142 | #define RNDIS_PRODUCT_NUM 0xa4a2 /* Ethernet/RNDIS Gadget */ |
| 143 | |
Brian Niebuhr | 9b39e9d | 2009-08-14 10:04:22 -0500 | [diff] [blame] | 144 | /* For EEM gadgets */ |
Brian Niebuhr | 4238ef5 | 2009-10-14 12:04:33 -0500 | [diff] [blame] | 145 | #define EEM_VENDOR_NUM 0x1d6b /* Linux Foundation */ |
| 146 | #define EEM_PRODUCT_NUM 0x0102 /* EEM Gadget */ |
Brian Niebuhr | 9b39e9d | 2009-08-14 10:04:22 -0500 | [diff] [blame] | 147 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 148 | /*-------------------------------------------------------------------------*/ |
| 149 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 150 | static struct usb_device_descriptor device_desc = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 151 | .bLength = sizeof device_desc, |
| 152 | .bDescriptorType = USB_DT_DEVICE, |
| 153 | |
Harvey Harrison | 551509d | 2009-02-11 14:11:36 -0800 | [diff] [blame] | 154 | .bcdUSB = cpu_to_le16 (0x0200), |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 155 | |
| 156 | .bDeviceClass = USB_CLASS_COMM, |
| 157 | .bDeviceSubClass = 0, |
| 158 | .bDeviceProtocol = 0, |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 159 | /* .bMaxPacketSize0 = f(hardware) */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 160 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 161 | /* Vendor and product id defaults change according to what configs |
| 162 | * we support. (As does bNumConfigurations.) These values can |
| 163 | * also be overridden by module parameters. |
| 164 | */ |
Harvey Harrison | 551509d | 2009-02-11 14:11:36 -0800 | [diff] [blame] | 165 | .idVendor = cpu_to_le16 (CDC_VENDOR_NUM), |
| 166 | .idProduct = cpu_to_le16 (CDC_PRODUCT_NUM), |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 167 | /* .bcdDevice = f(hardware) */ |
| 168 | /* .iManufacturer = DYNAMIC */ |
| 169 | /* .iProduct = DYNAMIC */ |
| 170 | /* NO SERIAL NUMBER */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 171 | .bNumConfigurations = 1, |
| 172 | }; |
| 173 | |
Li Jun | 9b95236e | 2015-07-09 15:18:49 +0800 | [diff] [blame] | 174 | static const struct usb_descriptor_header *otg_desc[2]; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 175 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 176 | static struct usb_string strings_dev[] = { |
Sebastian Andrzej Siewior | cc2683c | 2012-09-10 15:01:58 +0200 | [diff] [blame] | 177 | [USB_GADGET_MANUFACTURER_IDX].s = "", |
Sebastian Andrzej Siewior | 276e2e4 | 2012-09-06 20:11:21 +0200 | [diff] [blame] | 178 | [USB_GADGET_PRODUCT_IDX].s = PREFIX DRIVER_DESC, |
| 179 | [USB_GADGET_SERIAL_IDX].s = "", |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 180 | { } /* end of list */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 181 | }; |
| 182 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 183 | static struct usb_gadget_strings stringtab_dev = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 184 | .language = 0x0409, /* en-us */ |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 185 | .strings = strings_dev, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 186 | }; |
| 187 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 188 | static struct usb_gadget_strings *dev_strings[] = { |
| 189 | &stringtab_dev, |
| 190 | NULL, |
| 191 | }; |
| 192 | |
Andrzej Pietrasiewicz | 9c62ce8 | 2013-05-28 09:15:46 +0200 | [diff] [blame] | 193 | static struct usb_function_instance *fi_ecm; |
| 194 | static struct usb_function *f_ecm; |
| 195 | |
Andrzej Pietrasiewicz | 94b5573 | 2013-05-28 09:15:48 +0200 | [diff] [blame] | 196 | static struct usb_function_instance *fi_eem; |
| 197 | static struct usb_function *f_eem; |
| 198 | |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 199 | static struct usb_function_instance *fi_geth; |
| 200 | static struct usb_function *f_geth; |
| 201 | |
Andrzej Pietrasiewicz | 9bd4a10 | 2013-05-28 09:15:58 +0200 | [diff] [blame] | 202 | static struct usb_function_instance *fi_rndis; |
| 203 | static struct usb_function *f_rndis; |
| 204 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 205 | /*-------------------------------------------------------------------------*/ |
| 206 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 207 | /* |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 208 | * We may not have an RNDIS configuration, but if we do it needs to be |
| 209 | * the first one present. That's to make Microsoft's drivers happy, |
| 210 | * and to follow DOCSIS 1.0 (cable modem standard). |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 211 | */ |
Arnd Bergmann | c94e289 | 2015-04-11 00:14:21 +0200 | [diff] [blame] | 212 | static int rndis_do_config(struct usb_configuration *c) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 213 | { |
Andrzej Pietrasiewicz | 9bd4a10 | 2013-05-28 09:15:58 +0200 | [diff] [blame] | 214 | int status; |
| 215 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 216 | /* FIXME alloc iConfiguration string, set it in c->strings */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 217 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 218 | if (gadget_is_otg(c->cdev->gadget)) { |
| 219 | c->descriptors = otg_desc; |
| 220 | c->bmAttributes |= USB_CONFIG_ATT_WAKEUP; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 221 | } |
| 222 | |
Andrzej Pietrasiewicz | 9bd4a10 | 2013-05-28 09:15:58 +0200 | [diff] [blame] | 223 | f_rndis = usb_get_function(fi_rndis); |
| 224 | if (IS_ERR(f_rndis)) |
| 225 | return PTR_ERR(f_rndis); |
| 226 | |
| 227 | status = usb_add_function(c, f_rndis); |
| 228 | if (status < 0) |
| 229 | usb_put_function(f_rndis); |
| 230 | |
| 231 | return status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 232 | } |
| 233 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 234 | static struct usb_configuration rndis_config_driver = { |
| 235 | .label = "RNDIS", |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 236 | .bConfigurationValue = 2, |
| 237 | /* .iConfiguration = DYNAMIC */ |
| 238 | .bmAttributes = USB_CONFIG_ATT_SELFPOWER, |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 239 | }; |
| 240 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 241 | /*-------------------------------------------------------------------------*/ |
| 242 | |
Robert P. J. Day | c9188ad | 2009-12-28 06:31:08 -0500 | [diff] [blame] | 243 | #ifdef CONFIG_USB_ETH_EEM |
Rusty Russell | 90ab5ee | 2012-01-13 09:32:20 +1030 | [diff] [blame] | 244 | static bool use_eem = 1; |
Brian Niebuhr | 9b39e9d | 2009-08-14 10:04:22 -0500 | [diff] [blame] | 245 | #else |
Rusty Russell | 90ab5ee | 2012-01-13 09:32:20 +1030 | [diff] [blame] | 246 | static bool use_eem; |
Brian Niebuhr | 9b39e9d | 2009-08-14 10:04:22 -0500 | [diff] [blame] | 247 | #endif |
| 248 | module_param(use_eem, bool, 0); |
| 249 | MODULE_PARM_DESC(use_eem, "use CDC EEM mode"); |
| 250 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 251 | /* |
Brian Niebuhr | 9b39e9d | 2009-08-14 10:04:22 -0500 | [diff] [blame] | 252 | * We _always_ have an ECM, CDC Subset, or EEM configuration. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 253 | */ |
Arnd Bergmann | c94e289 | 2015-04-11 00:14:21 +0200 | [diff] [blame] | 254 | static int eth_do_config(struct usb_configuration *c) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 255 | { |
Andrzej Pietrasiewicz | 9c62ce8 | 2013-05-28 09:15:46 +0200 | [diff] [blame] | 256 | int status = 0; |
| 257 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 258 | /* FIXME alloc iConfiguration string, set it in c->strings */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 259 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 260 | if (gadget_is_otg(c->cdev->gadget)) { |
| 261 | c->descriptors = otg_desc; |
| 262 | c->bmAttributes |= USB_CONFIG_ATT_WAKEUP; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 263 | } |
| 264 | |
Andrzej Pietrasiewicz | 94b5573 | 2013-05-28 09:15:48 +0200 | [diff] [blame] | 265 | if (use_eem) { |
| 266 | f_eem = usb_get_function(fi_eem); |
| 267 | if (IS_ERR(f_eem)) |
| 268 | return PTR_ERR(f_eem); |
| 269 | |
| 270 | status = usb_add_function(c, f_eem); |
| 271 | if (status < 0) |
| 272 | usb_put_function(f_eem); |
| 273 | |
| 274 | return status; |
| 275 | } else if (can_support_ecm(c->cdev->gadget)) { |
Andrzej Pietrasiewicz | 9c62ce8 | 2013-05-28 09:15:46 +0200 | [diff] [blame] | 276 | f_ecm = usb_get_function(fi_ecm); |
| 277 | if (IS_ERR(f_ecm)) |
| 278 | return PTR_ERR(f_ecm); |
| 279 | |
| 280 | status = usb_add_function(c, f_ecm); |
| 281 | if (status < 0) |
| 282 | usb_put_function(f_ecm); |
| 283 | |
| 284 | return status; |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 285 | } else { |
| 286 | f_geth = usb_get_function(fi_geth); |
| 287 | if (IS_ERR(f_geth)) |
| 288 | return PTR_ERR(f_geth); |
| 289 | |
| 290 | status = usb_add_function(c, f_geth); |
| 291 | if (status < 0) |
| 292 | usb_put_function(f_geth); |
| 293 | |
| 294 | return status; |
| 295 | } |
Andrzej Pietrasiewicz | 9c62ce8 | 2013-05-28 09:15:46 +0200 | [diff] [blame] | 296 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 297 | } |
| 298 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 299 | static struct usb_configuration eth_config_driver = { |
| 300 | /* .label = f(hardware) */ |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 301 | .bConfigurationValue = 1, |
| 302 | /* .iConfiguration = DYNAMIC */ |
| 303 | .bmAttributes = USB_CONFIG_ATT_SELFPOWER, |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 304 | }; |
| 305 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 306 | /*-------------------------------------------------------------------------*/ |
| 307 | |
Arnd Bergmann | c94e289 | 2015-04-11 00:14:21 +0200 | [diff] [blame] | 308 | static int eth_bind(struct usb_composite_dev *cdev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 309 | { |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 310 | struct usb_gadget *gadget = cdev->gadget; |
Andrzej Pietrasiewicz | 94b5573 | 2013-05-28 09:15:48 +0200 | [diff] [blame] | 311 | struct f_eem_opts *eem_opts = NULL; |
Andrzej Pietrasiewicz | 9c62ce8 | 2013-05-28 09:15:46 +0200 | [diff] [blame] | 312 | struct f_ecm_opts *ecm_opts = NULL; |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 313 | struct f_gether_opts *geth_opts = NULL; |
| 314 | struct net_device *net; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 315 | int status; |
David Brownell | 7e27f18 | 2006-06-13 09:54:40 -0700 | [diff] [blame] | 316 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 317 | /* set up main config label and device descriptor */ |
Brian Niebuhr | 9b39e9d | 2009-08-14 10:04:22 -0500 | [diff] [blame] | 318 | if (use_eem) { |
| 319 | /* EEM */ |
Andrzej Pietrasiewicz | 94b5573 | 2013-05-28 09:15:48 +0200 | [diff] [blame] | 320 | fi_eem = usb_get_function_instance("eem"); |
| 321 | if (IS_ERR(fi_eem)) |
| 322 | return PTR_ERR(fi_eem); |
| 323 | |
| 324 | eem_opts = container_of(fi_eem, struct f_eem_opts, func_inst); |
| 325 | |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 326 | net = eem_opts->net; |
Andrzej Pietrasiewicz | 94b5573 | 2013-05-28 09:15:48 +0200 | [diff] [blame] | 327 | |
Brian Niebuhr | 9b39e9d | 2009-08-14 10:04:22 -0500 | [diff] [blame] | 328 | eth_config_driver.label = "CDC Ethernet (EEM)"; |
| 329 | device_desc.idVendor = cpu_to_le16(EEM_VENDOR_NUM); |
| 330 | device_desc.idProduct = cpu_to_le16(EEM_PRODUCT_NUM); |
Andrzej Pietrasiewicz | 9c62ce8 | 2013-05-28 09:15:46 +0200 | [diff] [blame] | 331 | } else if (can_support_ecm(gadget)) { |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 332 | /* ECM */ |
Andrzej Pietrasiewicz | 9c62ce8 | 2013-05-28 09:15:46 +0200 | [diff] [blame] | 333 | |
| 334 | fi_ecm = usb_get_function_instance("ecm"); |
| 335 | if (IS_ERR(fi_ecm)) |
| 336 | return PTR_ERR(fi_ecm); |
| 337 | |
| 338 | ecm_opts = container_of(fi_ecm, struct f_ecm_opts, func_inst); |
| 339 | |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 340 | net = ecm_opts->net; |
Andrzej Pietrasiewicz | 9c62ce8 | 2013-05-28 09:15:46 +0200 | [diff] [blame] | 341 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 342 | eth_config_driver.label = "CDC Ethernet (ECM)"; |
| 343 | } else { |
| 344 | /* CDC Subset */ |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 345 | |
| 346 | fi_geth = usb_get_function_instance("geth"); |
| 347 | if (IS_ERR(fi_geth)) |
| 348 | return PTR_ERR(fi_geth); |
| 349 | |
| 350 | geth_opts = container_of(fi_geth, struct f_gether_opts, |
| 351 | func_inst); |
| 352 | |
| 353 | net = geth_opts->net; |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 354 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 355 | eth_config_driver.label = "CDC Subset/SAFE"; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 356 | |
David Brownell | 4e19f22 | 2009-06-19 03:09:04 -0700 | [diff] [blame] | 357 | device_desc.idVendor = cpu_to_le16(SIMPLE_VENDOR_NUM); |
| 358 | device_desc.idProduct = cpu_to_le16(SIMPLE_PRODUCT_NUM); |
| 359 | if (!has_rndis()) |
| 360 | device_desc.bDeviceClass = USB_CLASS_VENDOR_SPEC; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 361 | } |
| 362 | |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 363 | gether_set_qmult(net, qmult); |
| 364 | if (!gether_set_host_addr(net, host_addr)) |
| 365 | pr_info("using host ethernet address: %s", host_addr); |
| 366 | if (!gether_set_dev_addr(net, dev_addr)) |
| 367 | pr_info("using self ethernet address: %s", dev_addr); |
| 368 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 369 | if (has_rndis()) { |
| 370 | /* RNDIS plus ECM-or-Subset */ |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 371 | gether_set_gadget(net, cdev->gadget); |
| 372 | status = gether_register_netdev(net); |
| 373 | if (status) |
| 374 | goto fail; |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 375 | |
| 376 | if (use_eem) |
Andrzej Pietrasiewicz | 94b5573 | 2013-05-28 09:15:48 +0200 | [diff] [blame] | 377 | eem_opts->bound = true; |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 378 | else if (can_support_ecm(gadget)) |
Andrzej Pietrasiewicz | 9c62ce8 | 2013-05-28 09:15:46 +0200 | [diff] [blame] | 379 | ecm_opts->bound = true; |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 380 | else |
| 381 | geth_opts->bound = true; |
Andrzej Pietrasiewicz | 9c62ce8 | 2013-05-28 09:15:46 +0200 | [diff] [blame] | 382 | |
Andrzej Pietrasiewicz | 9bd4a10 | 2013-05-28 09:15:58 +0200 | [diff] [blame] | 383 | fi_rndis = usb_get_function_instance("rndis"); |
| 384 | if (IS_ERR(fi_rndis)) { |
| 385 | status = PTR_ERR(fi_rndis); |
| 386 | goto fail; |
| 387 | } |
| 388 | |
| 389 | rndis_borrow_net(fi_rndis, net); |
| 390 | |
David Brownell | 4e19f22 | 2009-06-19 03:09:04 -0700 | [diff] [blame] | 391 | device_desc.idVendor = cpu_to_le16(RNDIS_VENDOR_NUM); |
| 392 | device_desc.idProduct = cpu_to_le16(RNDIS_PRODUCT_NUM); |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 393 | device_desc.bNumConfigurations = 2; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 394 | } |
| 395 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 396 | /* Allocate string descriptor numbers ... note that string |
| 397 | * contents can be overridden by the composite_dev glue. |
| 398 | */ |
| 399 | |
Sebastian Andrzej Siewior | e1f15cc | 2012-09-06 20:11:16 +0200 | [diff] [blame] | 400 | status = usb_string_ids_tab(cdev, strings_dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 401 | if (status < 0) |
Andrzej Pietrasiewicz | 9bd4a10 | 2013-05-28 09:15:58 +0200 | [diff] [blame] | 402 | goto fail1; |
Sebastian Andrzej Siewior | 276e2e4 | 2012-09-06 20:11:21 +0200 | [diff] [blame] | 403 | device_desc.iManufacturer = strings_dev[USB_GADGET_MANUFACTURER_IDX].id; |
| 404 | device_desc.iProduct = strings_dev[USB_GADGET_PRODUCT_IDX].id; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 405 | |
Li Jun | 9b95236e | 2015-07-09 15:18:49 +0800 | [diff] [blame] | 406 | if (gadget_is_otg(gadget) && !otg_desc[0]) { |
| 407 | struct usb_descriptor_header *usb_desc; |
| 408 | |
| 409 | usb_desc = usb_otg_descriptor_alloc(gadget); |
| 410 | if (!usb_desc) |
| 411 | goto fail1; |
| 412 | usb_otg_descriptor_init(gadget, usb_desc); |
| 413 | otg_desc[0] = usb_desc; |
| 414 | otg_desc[1] = NULL; |
| 415 | } |
| 416 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 417 | /* register our configuration(s); RNDIS first, if it's used */ |
| 418 | if (has_rndis()) { |
Uwe Kleine-König | c9bfff9 | 2010-08-12 17:43:55 +0200 | [diff] [blame] | 419 | status = usb_add_config(cdev, &rndis_config_driver, |
| 420 | rndis_do_config); |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 421 | if (status < 0) |
Li Jun | 9b95236e | 2015-07-09 15:18:49 +0800 | [diff] [blame] | 422 | goto fail2; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 423 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 424 | |
Uwe Kleine-König | c9bfff9 | 2010-08-12 17:43:55 +0200 | [diff] [blame] | 425 | status = usb_add_config(cdev, ð_config_driver, eth_do_config); |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 426 | if (status < 0) |
Li Jun | 9b95236e | 2015-07-09 15:18:49 +0800 | [diff] [blame] | 427 | goto fail2; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 428 | |
Sebastian Andrzej Siewior | 7d16e8d | 2012-09-10 15:01:53 +0200 | [diff] [blame] | 429 | usb_composite_overwrite_options(cdev, &coverwrite); |
David Brownell | 33376c1 | 2008-08-18 17:45:07 -0700 | [diff] [blame] | 430 | dev_info(&gadget->dev, "%s, version: " DRIVER_VERSION "\n", |
| 431 | DRIVER_DESC); |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 432 | |
| 433 | return 0; |
| 434 | |
Li Jun | 9b95236e | 2015-07-09 15:18:49 +0800 | [diff] [blame] | 435 | fail2: |
| 436 | kfree(otg_desc[0]); |
| 437 | otg_desc[0] = NULL; |
Andrzej Pietrasiewicz | 9bd4a10 | 2013-05-28 09:15:58 +0200 | [diff] [blame] | 438 | fail1: |
| 439 | if (has_rndis()) |
| 440 | usb_put_function_instance(fi_rndis); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 441 | fail: |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 442 | if (use_eem) |
Andrzej Pietrasiewicz | 94b5573 | 2013-05-28 09:15:48 +0200 | [diff] [blame] | 443 | usb_put_function_instance(fi_eem); |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 444 | else if (can_support_ecm(gadget)) |
Andrzej Pietrasiewicz | 9c62ce8 | 2013-05-28 09:15:46 +0200 | [diff] [blame] | 445 | usb_put_function_instance(fi_ecm); |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 446 | else |
| 447 | usb_put_function_instance(fi_geth); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 448 | return status; |
| 449 | } |
| 450 | |
Arnd Bergmann | c94e289 | 2015-04-11 00:14:21 +0200 | [diff] [blame] | 451 | static int eth_unbind(struct usb_composite_dev *cdev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 452 | { |
Andrzej Pietrasiewicz | 23a113a | 2013-07-24 12:47:46 +0200 | [diff] [blame] | 453 | if (has_rndis()) { |
| 454 | usb_put_function(f_rndis); |
Andrzej Pietrasiewicz | 9bd4a10 | 2013-05-28 09:15:58 +0200 | [diff] [blame] | 455 | usb_put_function_instance(fi_rndis); |
Andrzej Pietrasiewicz | 23a113a | 2013-07-24 12:47:46 +0200 | [diff] [blame] | 456 | } |
| 457 | if (use_eem) { |
| 458 | usb_put_function(f_eem); |
Andrzej Pietrasiewicz | 94b5573 | 2013-05-28 09:15:48 +0200 | [diff] [blame] | 459 | usb_put_function_instance(fi_eem); |
Andrzej Pietrasiewicz | 23a113a | 2013-07-24 12:47:46 +0200 | [diff] [blame] | 460 | } else if (can_support_ecm(cdev->gadget)) { |
| 461 | usb_put_function(f_ecm); |
Andrzej Pietrasiewicz | 9c62ce8 | 2013-05-28 09:15:46 +0200 | [diff] [blame] | 462 | usb_put_function_instance(fi_ecm); |
Andrzej Pietrasiewicz | 23a113a | 2013-07-24 12:47:46 +0200 | [diff] [blame] | 463 | } else { |
| 464 | usb_put_function(f_geth); |
Andrzej Pietrasiewicz | 8af5232 | 2013-05-28 09:15:54 +0200 | [diff] [blame] | 465 | usb_put_function_instance(fi_geth); |
Andrzej Pietrasiewicz | 23a113a | 2013-07-24 12:47:46 +0200 | [diff] [blame] | 466 | } |
Li Jun | 9b95236e | 2015-07-09 15:18:49 +0800 | [diff] [blame] | 467 | kfree(otg_desc[0]); |
| 468 | otg_desc[0] = NULL; |
| 469 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 470 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 471 | } |
| 472 | |
Arnd Bergmann | c94e289 | 2015-04-11 00:14:21 +0200 | [diff] [blame] | 473 | static struct usb_composite_driver eth_driver = { |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 474 | .name = "g_ether", |
| 475 | .dev = &device_desc, |
| 476 | .strings = dev_strings, |
Paul Zimmerman | 04617db | 2011-06-27 14:13:18 -0700 | [diff] [blame] | 477 | .max_speed = USB_SPEED_SUPER, |
Sebastian Andrzej Siewior | 03e42bd | 2012-09-06 20:11:04 +0200 | [diff] [blame] | 478 | .bind = eth_bind, |
Arnd Bergmann | c94e289 | 2015-04-11 00:14:21 +0200 | [diff] [blame] | 479 | .unbind = eth_unbind, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 480 | }; |
| 481 | |
Tobias Klauser | 909346a | 2014-07-09 18:09:56 +0200 | [diff] [blame] | 482 | module_usb_composite_driver(eth_driver); |
| 483 | |
David Brownell | 0391c82 | 2008-06-19 18:20:11 -0700 | [diff] [blame] | 484 | MODULE_DESCRIPTION(PREFIX DRIVER_DESC); |
| 485 | MODULE_AUTHOR("David Brownell, Benedikt Spanger"); |
| 486 | MODULE_LICENSE("GPL"); |