blob: c1c113ef950c86d9c4170cebaa47a91426cf74fa [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * ether.c -- Ethernet gadget driver, with CDC and non-CDC options
3 *
David Brownell0391c822008-06-19 18:20:11 -07004 * Copyright (C) 2003-2005,2008 David Brownell
Linus Torvalds1da177e2005-04-16 15:20:36 -07005 * Copyright (C) 2003-2004 Robert Schwebel, Benedikt Spranger
David Brownell0391c822008-06-19 18:20:11 -07006 * Copyright (C) 2008 Nokia Corporation
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 *
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 Torvalds1da177e2005-04-16 15:20:36 -070012 */
13
David Brownell0cf4f2d2007-08-02 00:00:38 -070014/* #define VERBOSE_DEBUG */
Linus Torvalds1da177e2005-04-16 15:20:36 -070015
Linus Torvalds1da177e2005-04-16 15:20:36 -070016#include <linux/kernel.h>
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +020017#include <linux/netdevice.h>
Michal Nazarewicz396cda92009-11-30 10:55:40 +010018
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 Brownell0391c822008-06-19 18:20:11 -070026#include "u_ether.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070027
Linus Torvalds1da177e2005-04-16 15:20:36 -070028
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 Brownell0391c822008-06-19 18:20:11 -070039 * 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 Torvalds1da177e2005-04-16 15:20:36 -070044 * implement a "minimalist" vendor-agnostic CDC core: same framing, but
David Brownell11d54892006-12-11 15:59:04 -080045 * 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 Torvalds1da177e2005-04-16 15:20:36 -070057 *
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 Brownell0391c822008-06-19 18:20:11 -070061 * needlessly complex. They borrow more from CDC ACM than CDC ECM.
Linus Torvalds1da177e2005-04-16 15:20:36 -070062 */
63
64#define DRIVER_DESC "Ethernet Gadget"
David Brownell0391c822008-06-19 18:20:11 -070065#define DRIVER_VERSION "Memorial Day 2008"
Linus Torvalds1da177e2005-04-16 15:20:36 -070066
Michal Nazarewicz396cda92009-11-30 10:55:40 +010067#ifdef USB_ETH_RNDIS
David Brownell0391c822008-06-19 18:20:11 -070068#define PREFIX "RNDIS/"
69#else
70#define PREFIX ""
Linus Torvalds1da177e2005-04-16 15:20:36 -070071#endif
72
David Brownell0391c822008-06-19 18:20:11 -070073/*
74 * This driver aims for interoperability by using CDC ECM unless
Linus Torvalds1da177e2005-04-16 15:20:36 -070075 *
David Brownell0391c822008-06-19 18:20:11 -070076 * 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 Torvalds1da177e2005-04-16 15:20:36 -070084 */
Linus Torvalds1da177e2005-04-16 15:20:36 -070085
David Brownell0391c822008-06-19 18:20:11 -070086static inline bool has_rndis(void)
87{
Michal Nazarewicz396cda92009-11-30 10:55:40 +010088#ifdef USB_ETH_RNDIS
David Brownell0391c822008-06-19 18:20:11 -070089 return true;
90#else
91 return false;
92#endif
93}
94
Andrzej Pietrasiewiczcbbd14a2013-05-24 10:23:02 +020095#include <linux/module.h>
96
Andrzej Pietrasiewicz9c62ce82013-05-28 09:15:46 +020097#include "u_ecm.h"
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +020098#include "u_gether.h"
Michal Nazarewicz396cda92009-11-30 10:55:40 +010099#ifdef USB_ETH_RNDIS
Andrzej Pietrasiewicz9bd4a102013-05-28 09:15:58 +0200100#include "u_rndis.h"
Andrzej Pietrasiewiczcbbd14a2013-05-24 10:23:02 +0200101#include "rndis.h"
Andrzej Pietrasiewicz9bd4a102013-05-28 09:15:58 +0200102#else
103#define rndis_borrow_net(...) do {} while (0)
David Brownell33376c12008-08-18 17:45:07 -0700104#endif
Andrzej Pietrasiewicz94b55732013-05-28 09:15:48 +0200105#include "u_eem.h"
David Brownell33376c12008-08-18 17:45:07 -0700106
107/*-------------------------------------------------------------------------*/
Sebastian Andrzej Siewior7d16e8d2012-09-10 15:01:53 +0200108USB_GADGET_COMPOSITE_OPTIONS();
David Brownell33376c12008-08-18 17:45:07 -0700109
Andrzej Pietrasiewiczf1a18232013-05-23 09:22:03 +0200110USB_ETHERNET_MODULE_PARAMETERS();
111
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112/* 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 Brownell0391c822008-06-19 18:20:11 -0700119#define CDC_VENDOR_NUM 0x0525 /* NetChip */
120#define CDC_PRODUCT_NUM 0xa4a1 /* Linux-USB Ethernet Gadget */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700121
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 Niebuhr9b39e9d2009-08-14 10:04:22 -0500144/* For EEM gadgets */
Brian Niebuhr4238ef52009-10-14 12:04:33 -0500145#define EEM_VENDOR_NUM 0x1d6b /* Linux Foundation */
146#define EEM_PRODUCT_NUM 0x0102 /* EEM Gadget */
Brian Niebuhr9b39e9d2009-08-14 10:04:22 -0500147
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148/*-------------------------------------------------------------------------*/
149
David Brownell0391c822008-06-19 18:20:11 -0700150static struct usb_device_descriptor device_desc = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700151 .bLength = sizeof device_desc,
152 .bDescriptorType = USB_DT_DEVICE,
153
Harvey Harrison551509d2009-02-11 14:11:36 -0800154 .bcdUSB = cpu_to_le16 (0x0200),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700155
156 .bDeviceClass = USB_CLASS_COMM,
157 .bDeviceSubClass = 0,
158 .bDeviceProtocol = 0,
David Brownell0391c822008-06-19 18:20:11 -0700159 /* .bMaxPacketSize0 = f(hardware) */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160
David Brownell0391c822008-06-19 18:20:11 -0700161 /* 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 Harrison551509d2009-02-11 14:11:36 -0800165 .idVendor = cpu_to_le16 (CDC_VENDOR_NUM),
166 .idProduct = cpu_to_le16 (CDC_PRODUCT_NUM),
David Brownell0391c822008-06-19 18:20:11 -0700167 /* .bcdDevice = f(hardware) */
168 /* .iManufacturer = DYNAMIC */
169 /* .iProduct = DYNAMIC */
170 /* NO SERIAL NUMBER */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171 .bNumConfigurations = 1,
172};
173
David Brownell0391c822008-06-19 18:20:11 -0700174static struct usb_otg_descriptor otg_descriptor = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700175 .bLength = sizeof otg_descriptor,
176 .bDescriptorType = USB_DT_OTG,
177
David Brownell0391c822008-06-19 18:20:11 -0700178 /* REVISIT SRP-only hardware is possible, although
179 * it would not be called "OTG" ...
180 */
181 .bmAttributes = USB_OTG_SRP | USB_OTG_HNP,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700182};
183
David Brownell0391c822008-06-19 18:20:11 -0700184static const struct usb_descriptor_header *otg_desc[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700185 (struct usb_descriptor_header *) &otg_descriptor,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186 NULL,
187};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700188
David Brownell0391c822008-06-19 18:20:11 -0700189static struct usb_string strings_dev[] = {
Sebastian Andrzej Siewiorcc2683c2012-09-10 15:01:58 +0200190 [USB_GADGET_MANUFACTURER_IDX].s = "",
Sebastian Andrzej Siewior276e2e42012-09-06 20:11:21 +0200191 [USB_GADGET_PRODUCT_IDX].s = PREFIX DRIVER_DESC,
192 [USB_GADGET_SERIAL_IDX].s = "",
David Brownell0391c822008-06-19 18:20:11 -0700193 { } /* end of list */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194};
195
David Brownell0391c822008-06-19 18:20:11 -0700196static struct usb_gadget_strings stringtab_dev = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197 .language = 0x0409, /* en-us */
David Brownell0391c822008-06-19 18:20:11 -0700198 .strings = strings_dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700199};
200
David Brownell0391c822008-06-19 18:20:11 -0700201static struct usb_gadget_strings *dev_strings[] = {
202 &stringtab_dev,
203 NULL,
204};
205
Andrzej Pietrasiewicz9c62ce82013-05-28 09:15:46 +0200206static struct usb_function_instance *fi_ecm;
207static struct usb_function *f_ecm;
208
Andrzej Pietrasiewicz94b55732013-05-28 09:15:48 +0200209static struct usb_function_instance *fi_eem;
210static struct usb_function *f_eem;
211
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200212static struct usb_function_instance *fi_geth;
213static struct usb_function *f_geth;
214
Andrzej Pietrasiewicz9bd4a102013-05-28 09:15:58 +0200215static struct usb_function_instance *fi_rndis;
216static struct usb_function *f_rndis;
217
David Brownell0391c822008-06-19 18:20:11 -0700218/*-------------------------------------------------------------------------*/
219
Linus Torvalds1da177e2005-04-16 15:20:36 -0700220/*
David Brownell0391c822008-06-19 18:20:11 -0700221 * We may not have an RNDIS configuration, but if we do it needs to be
222 * the first one present. That's to make Microsoft's drivers happy,
223 * and to follow DOCSIS 1.0 (cable modem standard).
Linus Torvalds1da177e2005-04-16 15:20:36 -0700224 */
Michal Nazarewicze12995e2010-08-12 17:43:52 +0200225static int __init rndis_do_config(struct usb_configuration *c)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700226{
Andrzej Pietrasiewicz9bd4a102013-05-28 09:15:58 +0200227 int status;
228
David Brownell0391c822008-06-19 18:20:11 -0700229 /* FIXME alloc iConfiguration string, set it in c->strings */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230
David Brownell0391c822008-06-19 18:20:11 -0700231 if (gadget_is_otg(c->cdev->gadget)) {
232 c->descriptors = otg_desc;
233 c->bmAttributes |= USB_CONFIG_ATT_WAKEUP;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234 }
235
Andrzej Pietrasiewicz9bd4a102013-05-28 09:15:58 +0200236 f_rndis = usb_get_function(fi_rndis);
237 if (IS_ERR(f_rndis))
238 return PTR_ERR(f_rndis);
239
240 status = usb_add_function(c, f_rndis);
241 if (status < 0)
242 usb_put_function(f_rndis);
243
244 return status;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245}
246
David Brownell0391c822008-06-19 18:20:11 -0700247static struct usb_configuration rndis_config_driver = {
248 .label = "RNDIS",
David Brownell0391c822008-06-19 18:20:11 -0700249 .bConfigurationValue = 2,
250 /* .iConfiguration = DYNAMIC */
251 .bmAttributes = USB_CONFIG_ATT_SELFPOWER,
David Brownell0391c822008-06-19 18:20:11 -0700252};
253
Linus Torvalds1da177e2005-04-16 15:20:36 -0700254/*-------------------------------------------------------------------------*/
255
Robert P. J. Dayc9188ad2009-12-28 06:31:08 -0500256#ifdef CONFIG_USB_ETH_EEM
Rusty Russell90ab5ee2012-01-13 09:32:20 +1030257static bool use_eem = 1;
Brian Niebuhr9b39e9d2009-08-14 10:04:22 -0500258#else
Rusty Russell90ab5ee2012-01-13 09:32:20 +1030259static bool use_eem;
Brian Niebuhr9b39e9d2009-08-14 10:04:22 -0500260#endif
261module_param(use_eem, bool, 0);
262MODULE_PARM_DESC(use_eem, "use CDC EEM mode");
263
David Brownell0391c822008-06-19 18:20:11 -0700264/*
Brian Niebuhr9b39e9d2009-08-14 10:04:22 -0500265 * We _always_ have an ECM, CDC Subset, or EEM configuration.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700266 */
Michal Nazarewicze12995e2010-08-12 17:43:52 +0200267static int __init eth_do_config(struct usb_configuration *c)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700268{
Andrzej Pietrasiewicz9c62ce82013-05-28 09:15:46 +0200269 int status = 0;
270
David Brownell0391c822008-06-19 18:20:11 -0700271 /* FIXME alloc iConfiguration string, set it in c->strings */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700272
David Brownell0391c822008-06-19 18:20:11 -0700273 if (gadget_is_otg(c->cdev->gadget)) {
274 c->descriptors = otg_desc;
275 c->bmAttributes |= USB_CONFIG_ATT_WAKEUP;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700276 }
277
Andrzej Pietrasiewicz94b55732013-05-28 09:15:48 +0200278 if (use_eem) {
279 f_eem = usb_get_function(fi_eem);
280 if (IS_ERR(f_eem))
281 return PTR_ERR(f_eem);
282
283 status = usb_add_function(c, f_eem);
284 if (status < 0)
285 usb_put_function(f_eem);
286
287 return status;
288 } else if (can_support_ecm(c->cdev->gadget)) {
Andrzej Pietrasiewicz9c62ce82013-05-28 09:15:46 +0200289 f_ecm = usb_get_function(fi_ecm);
290 if (IS_ERR(f_ecm))
291 return PTR_ERR(f_ecm);
292
293 status = usb_add_function(c, f_ecm);
294 if (status < 0)
295 usb_put_function(f_ecm);
296
297 return status;
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200298 } else {
299 f_geth = usb_get_function(fi_geth);
300 if (IS_ERR(f_geth))
301 return PTR_ERR(f_geth);
302
303 status = usb_add_function(c, f_geth);
304 if (status < 0)
305 usb_put_function(f_geth);
306
307 return status;
308 }
Andrzej Pietrasiewicz9c62ce82013-05-28 09:15:46 +0200309
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310}
311
David Brownell0391c822008-06-19 18:20:11 -0700312static struct usb_configuration eth_config_driver = {
313 /* .label = f(hardware) */
David Brownell0391c822008-06-19 18:20:11 -0700314 .bConfigurationValue = 1,
315 /* .iConfiguration = DYNAMIC */
316 .bmAttributes = USB_CONFIG_ATT_SELFPOWER,
David Brownell0391c822008-06-19 18:20:11 -0700317};
318
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319/*-------------------------------------------------------------------------*/
320
Michal Nazarewicze12995e2010-08-12 17:43:52 +0200321static int __init eth_bind(struct usb_composite_dev *cdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322{
David Brownell0391c822008-06-19 18:20:11 -0700323 struct usb_gadget *gadget = cdev->gadget;
Andrzej Pietrasiewicz94b55732013-05-28 09:15:48 +0200324 struct f_eem_opts *eem_opts = NULL;
Andrzej Pietrasiewicz9c62ce82013-05-28 09:15:46 +0200325 struct f_ecm_opts *ecm_opts = NULL;
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200326 struct f_gether_opts *geth_opts = NULL;
327 struct net_device *net;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700328 int status;
David Brownell7e27f182006-06-13 09:54:40 -0700329
David Brownell0391c822008-06-19 18:20:11 -0700330 /* set up main config label and device descriptor */
Brian Niebuhr9b39e9d2009-08-14 10:04:22 -0500331 if (use_eem) {
332 /* EEM */
Andrzej Pietrasiewicz94b55732013-05-28 09:15:48 +0200333 fi_eem = usb_get_function_instance("eem");
334 if (IS_ERR(fi_eem))
335 return PTR_ERR(fi_eem);
336
337 eem_opts = container_of(fi_eem, struct f_eem_opts, func_inst);
338
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200339 net = eem_opts->net;
Andrzej Pietrasiewicz94b55732013-05-28 09:15:48 +0200340
Brian Niebuhr9b39e9d2009-08-14 10:04:22 -0500341 eth_config_driver.label = "CDC Ethernet (EEM)";
342 device_desc.idVendor = cpu_to_le16(EEM_VENDOR_NUM);
343 device_desc.idProduct = cpu_to_le16(EEM_PRODUCT_NUM);
Andrzej Pietrasiewicz9c62ce82013-05-28 09:15:46 +0200344 } else if (can_support_ecm(gadget)) {
David Brownell0391c822008-06-19 18:20:11 -0700345 /* ECM */
Andrzej Pietrasiewicz9c62ce82013-05-28 09:15:46 +0200346
347 fi_ecm = usb_get_function_instance("ecm");
348 if (IS_ERR(fi_ecm))
349 return PTR_ERR(fi_ecm);
350
351 ecm_opts = container_of(fi_ecm, struct f_ecm_opts, func_inst);
352
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200353 net = ecm_opts->net;
Andrzej Pietrasiewicz9c62ce82013-05-28 09:15:46 +0200354
David Brownell0391c822008-06-19 18:20:11 -0700355 eth_config_driver.label = "CDC Ethernet (ECM)";
356 } else {
357 /* CDC Subset */
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200358
359 fi_geth = usb_get_function_instance("geth");
360 if (IS_ERR(fi_geth))
361 return PTR_ERR(fi_geth);
362
363 geth_opts = container_of(fi_geth, struct f_gether_opts,
364 func_inst);
365
366 net = geth_opts->net;
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200367
David Brownell0391c822008-06-19 18:20:11 -0700368 eth_config_driver.label = "CDC Subset/SAFE";
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369
David Brownell4e19f222009-06-19 03:09:04 -0700370 device_desc.idVendor = cpu_to_le16(SIMPLE_VENDOR_NUM);
371 device_desc.idProduct = cpu_to_le16(SIMPLE_PRODUCT_NUM);
372 if (!has_rndis())
373 device_desc.bDeviceClass = USB_CLASS_VENDOR_SPEC;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374 }
375
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200376 gether_set_qmult(net, qmult);
377 if (!gether_set_host_addr(net, host_addr))
378 pr_info("using host ethernet address: %s", host_addr);
379 if (!gether_set_dev_addr(net, dev_addr))
380 pr_info("using self ethernet address: %s", dev_addr);
381
David Brownell0391c822008-06-19 18:20:11 -0700382 if (has_rndis()) {
383 /* RNDIS plus ECM-or-Subset */
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200384 gether_set_gadget(net, cdev->gadget);
385 status = gether_register_netdev(net);
386 if (status)
387 goto fail;
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200388
389 if (use_eem)
Andrzej Pietrasiewicz94b55732013-05-28 09:15:48 +0200390 eem_opts->bound = true;
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200391 else if (can_support_ecm(gadget))
Andrzej Pietrasiewicz9c62ce82013-05-28 09:15:46 +0200392 ecm_opts->bound = true;
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200393 else
394 geth_opts->bound = true;
Andrzej Pietrasiewicz9c62ce82013-05-28 09:15:46 +0200395
Andrzej Pietrasiewicz9bd4a102013-05-28 09:15:58 +0200396 fi_rndis = usb_get_function_instance("rndis");
397 if (IS_ERR(fi_rndis)) {
398 status = PTR_ERR(fi_rndis);
399 goto fail;
400 }
401
402 rndis_borrow_net(fi_rndis, net);
403
David Brownell4e19f222009-06-19 03:09:04 -0700404 device_desc.idVendor = cpu_to_le16(RNDIS_VENDOR_NUM);
405 device_desc.idProduct = cpu_to_le16(RNDIS_PRODUCT_NUM);
David Brownell0391c822008-06-19 18:20:11 -0700406 device_desc.bNumConfigurations = 2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407 }
408
David Brownell0391c822008-06-19 18:20:11 -0700409 /* Allocate string descriptor numbers ... note that string
410 * contents can be overridden by the composite_dev glue.
411 */
412
Sebastian Andrzej Siewiore1f15cc2012-09-06 20:11:16 +0200413 status = usb_string_ids_tab(cdev, strings_dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700414 if (status < 0)
Andrzej Pietrasiewicz9bd4a102013-05-28 09:15:58 +0200415 goto fail1;
Sebastian Andrzej Siewior276e2e42012-09-06 20:11:21 +0200416 device_desc.iManufacturer = strings_dev[USB_GADGET_MANUFACTURER_IDX].id;
417 device_desc.iProduct = strings_dev[USB_GADGET_PRODUCT_IDX].id;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418
David Brownell0391c822008-06-19 18:20:11 -0700419 /* register our configuration(s); RNDIS first, if it's used */
420 if (has_rndis()) {
Uwe Kleine-Königc9bfff92010-08-12 17:43:55 +0200421 status = usb_add_config(cdev, &rndis_config_driver,
422 rndis_do_config);
David Brownell0391c822008-06-19 18:20:11 -0700423 if (status < 0)
Andrzej Pietrasiewicz9bd4a102013-05-28 09:15:58 +0200424 goto fail1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700425 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700426
Uwe Kleine-Königc9bfff92010-08-12 17:43:55 +0200427 status = usb_add_config(cdev, &eth_config_driver, eth_do_config);
David Brownell0391c822008-06-19 18:20:11 -0700428 if (status < 0)
Andrzej Pietrasiewicz9bd4a102013-05-28 09:15:58 +0200429 goto fail1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700430
Sebastian Andrzej Siewior7d16e8d2012-09-10 15:01:53 +0200431 usb_composite_overwrite_options(cdev, &coverwrite);
David Brownell33376c12008-08-18 17:45:07 -0700432 dev_info(&gadget->dev, "%s, version: " DRIVER_VERSION "\n",
433 DRIVER_DESC);
David Brownell0391c822008-06-19 18:20:11 -0700434
435 return 0;
436
Andrzej Pietrasiewicz9bd4a102013-05-28 09:15:58 +0200437fail1:
438 if (has_rndis())
439 usb_put_function_instance(fi_rndis);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440fail:
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200441 if (use_eem)
Andrzej Pietrasiewicz94b55732013-05-28 09:15:48 +0200442 usb_put_function_instance(fi_eem);
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200443 else if (can_support_ecm(gadget))
Andrzej Pietrasiewicz9c62ce82013-05-28 09:15:46 +0200444 usb_put_function_instance(fi_ecm);
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200445 else
446 usb_put_function_instance(fi_geth);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447 return status;
448}
449
David Brownell0391c822008-06-19 18:20:11 -0700450static int __exit eth_unbind(struct usb_composite_dev *cdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451{
Andrzej Pietrasiewicz23a113a2013-07-24 12:47:46 +0200452 if (has_rndis()) {
453 usb_put_function(f_rndis);
Andrzej Pietrasiewicz9bd4a102013-05-28 09:15:58 +0200454 usb_put_function_instance(fi_rndis);
Andrzej Pietrasiewicz23a113a2013-07-24 12:47:46 +0200455 }
456 if (use_eem) {
457 usb_put_function(f_eem);
Andrzej Pietrasiewicz94b55732013-05-28 09:15:48 +0200458 usb_put_function_instance(fi_eem);
Andrzej Pietrasiewicz23a113a2013-07-24 12:47:46 +0200459 } else if (can_support_ecm(cdev->gadget)) {
460 usb_put_function(f_ecm);
Andrzej Pietrasiewicz9c62ce82013-05-28 09:15:46 +0200461 usb_put_function_instance(fi_ecm);
Andrzej Pietrasiewicz23a113a2013-07-24 12:47:46 +0200462 } else {
463 usb_put_function(f_geth);
Andrzej Pietrasiewicz8af52322013-05-28 09:15:54 +0200464 usb_put_function_instance(fi_geth);
Andrzej Pietrasiewicz23a113a2013-07-24 12:47:46 +0200465 }
David Brownell0391c822008-06-19 18:20:11 -0700466 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700467}
468
Sebastian Andrzej Siewiorc2ec75c2012-09-06 20:11:03 +0200469static __refdata struct usb_composite_driver eth_driver = {
David Brownell0391c822008-06-19 18:20:11 -0700470 .name = "g_ether",
471 .dev = &device_desc,
472 .strings = dev_strings,
Paul Zimmerman04617db2011-06-27 14:13:18 -0700473 .max_speed = USB_SPEED_SUPER,
Sebastian Andrzej Siewior03e42bd2012-09-06 20:11:04 +0200474 .bind = eth_bind,
David Brownell0391c822008-06-19 18:20:11 -0700475 .unbind = __exit_p(eth_unbind),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700476};
477
David Brownell0391c822008-06-19 18:20:11 -0700478MODULE_DESCRIPTION(PREFIX DRIVER_DESC);
479MODULE_AUTHOR("David Brownell, Benedikt Spanger");
480MODULE_LICENSE("GPL");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481
David Brownell0391c822008-06-19 18:20:11 -0700482static int __init init(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700483{
Sebastian Andrzej Siewior03e42bd2012-09-06 20:11:04 +0200484 return usb_composite_probe(&eth_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700485}
David Brownell0391c822008-06-19 18:20:11 -0700486module_init(init);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700487
David Brownell0391c822008-06-19 18:20:11 -0700488static void __exit cleanup(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700489{
David Brownell0391c822008-06-19 18:20:11 -0700490 usb_composite_unregister(&eth_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700491}
David Brownell0391c822008-06-19 18:20:11 -0700492module_exit(cleanup);