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