1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * f_ecm.c -- USB CDC Ethernet (ECM) link function driver
4  *
5  * Copyright (C) 2003-2005,2008 David Brownell
6  * Copyright (C) 2008 Nokia Corporation
7  */
8 
9 /* #define VERBOSE_DEBUG */
10 
11 #include <linux/slab.h>
12 #include <linux/kernel.h>
13 #include <linux/module.h>
14 #include <linux/device.h>
15 #include <linux/etherdevice.h>
16 
17 #include "u_ether.h"
18 #include "u_ether_configfs.h"
19 #include "u_ecm.h"
20 
21 
22 /*
23  * This function is a "CDC Ethernet Networking Control Model" (CDC ECM)
24  * Ethernet link.  The data transfer model is simple (packets sent and
25  * received over bulk endpoints using normal short packet termination),
26  * and the control model exposes various data and optional notifications.
27  *
28  * ECM is well standardized and (except for Microsoft) supported by most
29  * operating systems with USB host support.  It's the preferred interop
30  * solution for Ethernet over USB, at least for firmware based solutions.
31  * (Hardware solutions tend to be more minimalist.)  A newer and simpler
32  * "Ethernet Emulation Model" (CDC EEM) hasn't yet caught on.
33  *
34  * Note that ECM requires the use of "alternate settings" for its data
35  * interface.  This means that the set_alt() method has real work to do,
36  * and also means that a get_alt() method is required.
37  */
38 
39 
40 enum ecm_notify_state {
41 	ECM_NOTIFY_NONE,		/* don't notify */
42 	ECM_NOTIFY_CONNECT,		/* issue CONNECT next */
43 	ECM_NOTIFY_SPEED,		/* issue SPEED_CHANGE next */
44 };
45 
46 struct f_ecm {
47 	struct gether			port;
48 	u8				ctrl_id, data_id;
49 
50 	char				ethaddr[14];
51 
52 	struct usb_ep			*notify;
53 	struct usb_request		*notify_req;
54 	u8				notify_state;
55 	atomic_t			notify_count;
56 	bool				is_open;
57 
58 	/* FIXME is_open needs some irq-ish locking
59 	 * ... possibly the same as port.ioport
60 	 */
61 };
62 
63 static inline struct f_ecm *func_to_ecm(struct usb_function *f)
64 {
65 	return container_of(f, struct f_ecm, port.func);
66 }
67 
68 /* peak (theoretical) bulk transfer rate in bits-per-second */
69 static inline unsigned ecm_bitrate(struct usb_gadget *g)
70 {
71 	if (gadget_is_superspeed(g) && g->speed == USB_SPEED_SUPER)
72 		return 13 * 1024 * 8 * 1000 * 8;
73 	else if (gadget_is_dualspeed(g) && g->speed == USB_SPEED_HIGH)
74 		return 13 * 512 * 8 * 1000 * 8;
75 	else
76 		return 19 * 64 * 1 * 1000 * 8;
77 }
78 
79 /*-------------------------------------------------------------------------*/
80 
81 /*
82  * Include the status endpoint if we can, even though it's optional.
83  *
84  * Use wMaxPacketSize big enough to fit CDC_NOTIFY_SPEED_CHANGE in one
85  * packet, to simplify cancellation; and a big transfer interval, to
86  * waste less bandwidth.
87  *
88  * Some drivers (like Linux 2.4 cdc-ether!) "need" it to exist even
89  * if they ignore the connect/disconnect notifications that real aether
90  * can provide.  More advanced cdc configurations might want to support
91  * encapsulated commands (vendor-specific, using control-OUT).
92  */
93 
94 #define ECM_STATUS_INTERVAL_MS		32
95 #define ECM_STATUS_BYTECOUNT		16	/* 8 byte header + data */
96 
97 
98 /* interface descriptor: */
99 
100 static struct usb_interface_assoc_descriptor
101 ecm_iad_descriptor = {
102 	.bLength =		sizeof ecm_iad_descriptor,
103 	.bDescriptorType =	USB_DT_INTERFACE_ASSOCIATION,
104 
105 	/* .bFirstInterface =	DYNAMIC, */
106 	.bInterfaceCount =	2,	/* control + data */
107 	.bFunctionClass =	USB_CLASS_COMM,
108 	.bFunctionSubClass =	USB_CDC_SUBCLASS_ETHERNET,
109 	.bFunctionProtocol =	USB_CDC_PROTO_NONE,
110 	/* .iFunction =		DYNAMIC */
111 };
112 
113 
114 static struct usb_interface_descriptor ecm_control_intf = {
115 	.bLength =		sizeof ecm_control_intf,
116 	.bDescriptorType =	USB_DT_INTERFACE,
117 
118 	/* .bInterfaceNumber = DYNAMIC */
119 	/* status endpoint is optional; this could be patched later */
120 	.bNumEndpoints =	1,
121 	.bInterfaceClass =	USB_CLASS_COMM,
122 	.bInterfaceSubClass =	USB_CDC_SUBCLASS_ETHERNET,
123 	.bInterfaceProtocol =	USB_CDC_PROTO_NONE,
124 	/* .iInterface = DYNAMIC */
125 };
126 
127 static struct usb_cdc_header_desc ecm_header_desc = {
128 	.bLength =		sizeof ecm_header_desc,
129 	.bDescriptorType =	USB_DT_CS_INTERFACE,
130 	.bDescriptorSubType =	USB_CDC_HEADER_TYPE,
131 
132 	.bcdCDC =		cpu_to_le16(0x0110),
133 };
134 
135 static struct usb_cdc_union_desc ecm_union_desc = {
136 	.bLength =		sizeof(ecm_union_desc),
137 	.bDescriptorType =	USB_DT_CS_INTERFACE,
138 	.bDescriptorSubType =	USB_CDC_UNION_TYPE,
139 	/* .bMasterInterface0 =	DYNAMIC */
140 	/* .bSlaveInterface0 =	DYNAMIC */
141 };
142 
143 static struct usb_cdc_ether_desc ecm_desc = {
144 	.bLength =		sizeof ecm_desc,
145 	.bDescriptorType =	USB_DT_CS_INTERFACE,
146 	.bDescriptorSubType =	USB_CDC_ETHERNET_TYPE,
147 
148 	/* this descriptor actually adds value, surprise! */
149 	/* .iMACAddress = DYNAMIC */
150 	.bmEthernetStatistics =	cpu_to_le32(0), /* no statistics */
151 	.wMaxSegmentSize =	cpu_to_le16(ETH_FRAME_LEN),
152 	.wNumberMCFilters =	cpu_to_le16(0),
153 	.bNumberPowerFilters =	0,
154 };
155 
156 /* the default data interface has no endpoints ... */
157 
158 static struct usb_interface_descriptor ecm_data_nop_intf = {
159 	.bLength =		sizeof ecm_data_nop_intf,
160 	.bDescriptorType =	USB_DT_INTERFACE,
161 
162 	.bInterfaceNumber =	1,
163 	.bAlternateSetting =	0,
164 	.bNumEndpoints =	0,
165 	.bInterfaceClass =	USB_CLASS_CDC_DATA,
166 	.bInterfaceSubClass =	0,
167 	.bInterfaceProtocol =	0,
168 	/* .iInterface = DYNAMIC */
169 };
170 
171 /* ... but the "real" data interface has two bulk endpoints */
172 
173 static struct usb_interface_descriptor ecm_data_intf = {
174 	.bLength =		sizeof ecm_data_intf,
175 	.bDescriptorType =	USB_DT_INTERFACE,
176 
177 	.bInterfaceNumber =	1,
178 	.bAlternateSetting =	1,
179 	.bNumEndpoints =	2,
180 	.bInterfaceClass =	USB_CLASS_CDC_DATA,
181 	.bInterfaceSubClass =	0,
182 	.bInterfaceProtocol =	0,
183 	/* .iInterface = DYNAMIC */
184 };
185 
186 /* full speed support: */
187 
188 static struct usb_endpoint_descriptor fs_ecm_notify_desc = {
189 	.bLength =		USB_DT_ENDPOINT_SIZE,
190 	.bDescriptorType =	USB_DT_ENDPOINT,
191 
192 	.bEndpointAddress =	USB_DIR_IN,
193 	.bmAttributes =		USB_ENDPOINT_XFER_INT,
194 	.wMaxPacketSize =	cpu_to_le16(ECM_STATUS_BYTECOUNT),
195 	.bInterval =		ECM_STATUS_INTERVAL_MS,
196 };
197 
198 static struct usb_endpoint_descriptor fs_ecm_in_desc = {
199 	.bLength =		USB_DT_ENDPOINT_SIZE,
200 	.bDescriptorType =	USB_DT_ENDPOINT,
201 
202 	.bEndpointAddress =	USB_DIR_IN,
203 	.bmAttributes =		USB_ENDPOINT_XFER_BULK,
204 };
205 
206 static struct usb_endpoint_descriptor fs_ecm_out_desc = {
207 	.bLength =		USB_DT_ENDPOINT_SIZE,
208 	.bDescriptorType =	USB_DT_ENDPOINT,
209 
210 	.bEndpointAddress =	USB_DIR_OUT,
211 	.bmAttributes =		USB_ENDPOINT_XFER_BULK,
212 };
213 
214 static struct usb_descriptor_header *ecm_fs_function[] = {
215 	/* CDC ECM control descriptors */
216 	(struct usb_descriptor_header *) &ecm_iad_descriptor,
217 	(struct usb_descriptor_header *) &ecm_control_intf,
218 	(struct usb_descriptor_header *) &ecm_header_desc,
219 	(struct usb_descriptor_header *) &ecm_union_desc,
220 	(struct usb_descriptor_header *) &ecm_desc,
221 
222 	/* NOTE: status endpoint might need to be removed */
223 	(struct usb_descriptor_header *) &fs_ecm_notify_desc,
224 
225 	/* data interface, altsettings 0 and 1 */
226 	(struct usb_descriptor_header *) &ecm_data_nop_intf,
227 	(struct usb_descriptor_header *) &ecm_data_intf,
228 	(struct usb_descriptor_header *) &fs_ecm_in_desc,
229 	(struct usb_descriptor_header *) &fs_ecm_out_desc,
230 	NULL,
231 };
232 
233 /* high speed support: */
234 
235 static struct usb_endpoint_descriptor hs_ecm_notify_desc = {
236 	.bLength =		USB_DT_ENDPOINT_SIZE,
237 	.bDescriptorType =	USB_DT_ENDPOINT,
238 
239 	.bEndpointAddress =	USB_DIR_IN,
240 	.bmAttributes =		USB_ENDPOINT_XFER_INT,
241 	.wMaxPacketSize =	cpu_to_le16(ECM_STATUS_BYTECOUNT),
242 	.bInterval =		USB_MS_TO_HS_INTERVAL(ECM_STATUS_INTERVAL_MS),
243 };
244 
245 static struct usb_endpoint_descriptor hs_ecm_in_desc = {
246 	.bLength =		USB_DT_ENDPOINT_SIZE,
247 	.bDescriptorType =	USB_DT_ENDPOINT,
248 
249 	.bEndpointAddress =	USB_DIR_IN,
250 	.bmAttributes =		USB_ENDPOINT_XFER_BULK,
251 	.wMaxPacketSize =	cpu_to_le16(512),
252 };
253 
254 static struct usb_endpoint_descriptor hs_ecm_out_desc = {
255 	.bLength =		USB_DT_ENDPOINT_SIZE,
256 	.bDescriptorType =	USB_DT_ENDPOINT,
257 
258 	.bEndpointAddress =	USB_DIR_OUT,
259 	.bmAttributes =		USB_ENDPOINT_XFER_BULK,
260 	.wMaxPacketSize =	cpu_to_le16(512),
261 };
262 
263 static struct usb_descriptor_header *ecm_hs_function[] = {
264 	/* CDC ECM control descriptors */
265 	(struct usb_descriptor_header *) &ecm_iad_descriptor,
266 	(struct usb_descriptor_header *) &ecm_control_intf,
267 	(struct usb_descriptor_header *) &ecm_header_desc,
268 	(struct usb_descriptor_header *) &ecm_union_desc,
269 	(struct usb_descriptor_header *) &ecm_desc,
270 
271 	/* NOTE: status endpoint might need to be removed */
272 	(struct usb_descriptor_header *) &hs_ecm_notify_desc,
273 
274 	/* data interface, altsettings 0 and 1 */
275 	(struct usb_descriptor_header *) &ecm_data_nop_intf,
276 	(struct usb_descriptor_header *) &ecm_data_intf,
277 	(struct usb_descriptor_header *) &hs_ecm_in_desc,
278 	(struct usb_descriptor_header *) &hs_ecm_out_desc,
279 	NULL,
280 };
281 
282 /* super speed support: */
283 
284 static struct usb_endpoint_descriptor ss_ecm_notify_desc = {
285 	.bLength =		USB_DT_ENDPOINT_SIZE,
286 	.bDescriptorType =	USB_DT_ENDPOINT,
287 
288 	.bEndpointAddress =	USB_DIR_IN,
289 	.bmAttributes =		USB_ENDPOINT_XFER_INT,
290 	.wMaxPacketSize =	cpu_to_le16(ECM_STATUS_BYTECOUNT),
291 	.bInterval =		USB_MS_TO_HS_INTERVAL(ECM_STATUS_INTERVAL_MS),
292 };
293 
294 static struct usb_ss_ep_comp_descriptor ss_ecm_intr_comp_desc = {
295 	.bLength =		sizeof ss_ecm_intr_comp_desc,
296 	.bDescriptorType =	USB_DT_SS_ENDPOINT_COMP,
297 
298 	/* the following 3 values can be tweaked if necessary */
299 	/* .bMaxBurst =		0, */
300 	/* .bmAttributes =	0, */
301 	.wBytesPerInterval =	cpu_to_le16(ECM_STATUS_BYTECOUNT),
302 };
303 
304 static struct usb_endpoint_descriptor ss_ecm_in_desc = {
305 	.bLength =		USB_DT_ENDPOINT_SIZE,
306 	.bDescriptorType =	USB_DT_ENDPOINT,
307 
308 	.bEndpointAddress =	USB_DIR_IN,
309 	.bmAttributes =		USB_ENDPOINT_XFER_BULK,
310 	.wMaxPacketSize =	cpu_to_le16(1024),
311 };
312 
313 static struct usb_endpoint_descriptor ss_ecm_out_desc = {
314 	.bLength =		USB_DT_ENDPOINT_SIZE,
315 	.bDescriptorType =	USB_DT_ENDPOINT,
316 
317 	.bEndpointAddress =	USB_DIR_OUT,
318 	.bmAttributes =		USB_ENDPOINT_XFER_BULK,
319 	.wMaxPacketSize =	cpu_to_le16(1024),
320 };
321 
322 static struct usb_ss_ep_comp_descriptor ss_ecm_bulk_comp_desc = {
323 	.bLength =		sizeof ss_ecm_bulk_comp_desc,
324 	.bDescriptorType =	USB_DT_SS_ENDPOINT_COMP,
325 
326 	/* the following 2 values can be tweaked if necessary */
327 	/* .bMaxBurst =		0, */
328 	/* .bmAttributes =	0, */
329 };
330 
331 static struct usb_descriptor_header *ecm_ss_function[] = {
332 	/* CDC ECM control descriptors */
333 	(struct usb_descriptor_header *) &ecm_iad_descriptor,
334 	(struct usb_descriptor_header *) &ecm_control_intf,
335 	(struct usb_descriptor_header *) &ecm_header_desc,
336 	(struct usb_descriptor_header *) &ecm_union_desc,
337 	(struct usb_descriptor_header *) &ecm_desc,
338 
339 	/* NOTE: status endpoint might need to be removed */
340 	(struct usb_descriptor_header *) &ss_ecm_notify_desc,
341 	(struct usb_descriptor_header *) &ss_ecm_intr_comp_desc,
342 
343 	/* data interface, altsettings 0 and 1 */
344 	(struct usb_descriptor_header *) &ecm_data_nop_intf,
345 	(struct usb_descriptor_header *) &ecm_data_intf,
346 	(struct usb_descriptor_header *) &ss_ecm_in_desc,
347 	(struct usb_descriptor_header *) &ss_ecm_bulk_comp_desc,
348 	(struct usb_descriptor_header *) &ss_ecm_out_desc,
349 	(struct usb_descriptor_header *) &ss_ecm_bulk_comp_desc,
350 	NULL,
351 };
352 
353 /* string descriptors: */
354 
355 static struct usb_string ecm_string_defs[] = {
356 	[0].s = "CDC Ethernet Control Model (ECM)",
357 	[1].s = "",
358 	[2].s = "CDC Ethernet Data",
359 	[3].s = "CDC ECM",
360 	{  } /* end of list */
361 };
362 
363 static struct usb_gadget_strings ecm_string_table = {
364 	.language =		0x0409,	/* en-us */
365 	.strings =		ecm_string_defs,
366 };
367 
368 static struct usb_gadget_strings *ecm_strings[] = {
369 	&ecm_string_table,
370 	NULL,
371 };
372 
373 /*-------------------------------------------------------------------------*/
374 
375 static void ecm_do_notify(struct f_ecm *ecm)
376 {
377 	struct usb_request		*req = ecm->notify_req;
378 	struct usb_cdc_notification	*event;
379 	struct usb_composite_dev	*cdev = ecm->port.func.config->cdev;
380 	__le32				*data;
381 	int				status;
382 
383 	/* notification already in flight? */
384 	if (atomic_read(&ecm->notify_count))
385 		return;
386 
387 	event = req->buf;
388 	switch (ecm->notify_state) {
389 	case ECM_NOTIFY_NONE:
390 		return;
391 
392 	case ECM_NOTIFY_CONNECT:
393 		event->bNotificationType = USB_CDC_NOTIFY_NETWORK_CONNECTION;
394 		if (ecm->is_open)
395 			event->wValue = cpu_to_le16(1);
396 		else
397 			event->wValue = cpu_to_le16(0);
398 		event->wLength = 0;
399 		req->length = sizeof *event;
400 
401 		DBG(cdev, "notify connect %s\n",
402 				ecm->is_open ? "true" : "false");
403 		ecm->notify_state = ECM_NOTIFY_SPEED;
404 		break;
405 
406 	case ECM_NOTIFY_SPEED:
407 		event->bNotificationType = USB_CDC_NOTIFY_SPEED_CHANGE;
408 		event->wValue = cpu_to_le16(0);
409 		event->wLength = cpu_to_le16(8);
410 		req->length = ECM_STATUS_BYTECOUNT;
411 
412 		/* SPEED_CHANGE data is up/down speeds in bits/sec */
413 		data = req->buf + sizeof *event;
414 		data[0] = cpu_to_le32(ecm_bitrate(cdev->gadget));
415 		data[1] = data[0];
416 
417 		DBG(cdev, "notify speed %d\n", ecm_bitrate(cdev->gadget));
418 		ecm->notify_state = ECM_NOTIFY_NONE;
419 		break;
420 	}
421 	event->bmRequestType = 0xA1;
422 	event->wIndex = cpu_to_le16(ecm->ctrl_id);
423 
424 	atomic_inc(&ecm->notify_count);
425 	status = usb_ep_queue(ecm->notify, req, GFP_ATOMIC);
426 	if (status < 0) {
427 		atomic_dec(&ecm->notify_count);
428 		DBG(cdev, "notify --> %d\n", status);
429 	}
430 }
431 
432 static void ecm_notify(struct f_ecm *ecm)
433 {
434 	/* NOTE on most versions of Linux, host side cdc-ethernet
435 	 * won't listen for notifications until its netdevice opens.
436 	 * The first notification then sits in the FIFO for a long
437 	 * time, and the second one is queued.
438 	 */
439 	ecm->notify_state = ECM_NOTIFY_CONNECT;
440 	ecm_do_notify(ecm);
441 }
442 
443 static void ecm_notify_complete(struct usb_ep *ep, struct usb_request *req)
444 {
445 	struct f_ecm			*ecm = req->context;
446 	struct usb_composite_dev	*cdev = ecm->port.func.config->cdev;
447 	struct usb_cdc_notification	*event = req->buf;
448 
449 	switch (req->status) {
450 	case 0:
451 		/* no fault */
452 		atomic_dec(&ecm->notify_count);
453 		break;
454 	case -ECONNRESET:
455 	case -ESHUTDOWN:
456 		atomic_set(&ecm->notify_count, 0);
457 		ecm->notify_state = ECM_NOTIFY_NONE;
458 		break;
459 	default:
460 		DBG(cdev, "event %02x --> %d\n",
461 			event->bNotificationType, req->status);
462 		atomic_dec(&ecm->notify_count);
463 		break;
464 	}
465 	ecm_do_notify(ecm);
466 }
467 
468 static int ecm_setup(struct usb_function *f, const struct usb_ctrlrequest *ctrl)
469 {
470 	struct f_ecm		*ecm = func_to_ecm(f);
471 	struct usb_composite_dev *cdev = f->config->cdev;
472 	struct usb_request	*req = cdev->req;
473 	int			value = -EOPNOTSUPP;
474 	u16			w_index = le16_to_cpu(ctrl->wIndex);
475 	u16			w_value = le16_to_cpu(ctrl->wValue);
476 	u16			w_length = le16_to_cpu(ctrl->wLength);
477 
478 	/* composite driver infrastructure handles everything except
479 	 * CDC class messages; interface activation uses set_alt().
480 	 */
481 	switch ((ctrl->bRequestType << 8) | ctrl->bRequest) {
482 	case ((USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE) << 8)
483 			| USB_CDC_SET_ETHERNET_PACKET_FILTER:
484 		/* see 6.2.30: no data, wIndex = interface,
485 		 * wValue = packet filter bitmap
486 		 */
487 		if (w_length != 0 || w_index != ecm->ctrl_id)
488 			goto invalid;
489 		DBG(cdev, "packet filter %02x\n", w_value);
490 		/* REVISIT locking of cdc_filter.  This assumes the UDC
491 		 * driver won't have a concurrent packet TX irq running on
492 		 * another CPU; or that if it does, this write is atomic...
493 		 */
494 		ecm->port.cdc_filter = w_value;
495 		value = 0;
496 		break;
497 
498 	/* and optionally:
499 	 * case USB_CDC_SEND_ENCAPSULATED_COMMAND:
500 	 * case USB_CDC_GET_ENCAPSULATED_RESPONSE:
501 	 * case USB_CDC_SET_ETHERNET_MULTICAST_FILTERS:
502 	 * case USB_CDC_SET_ETHERNET_PM_PATTERN_FILTER:
503 	 * case USB_CDC_GET_ETHERNET_PM_PATTERN_FILTER:
504 	 * case USB_CDC_GET_ETHERNET_STATISTIC:
505 	 */
506 
507 	default:
508 invalid:
509 		DBG(cdev, "invalid control req%02x.%02x v%04x i%04x l%d\n",
510 			ctrl->bRequestType, ctrl->bRequest,
511 			w_value, w_index, w_length);
512 	}
513 
514 	/* respond with data transfer or status phase? */
515 	if (value >= 0) {
516 		DBG(cdev, "ecm req%02x.%02x v%04x i%04x l%d\n",
517 			ctrl->bRequestType, ctrl->bRequest,
518 			w_value, w_index, w_length);
519 		req->zero = 0;
520 		req->length = value;
521 		value = usb_ep_queue(cdev->gadget->ep0, req, GFP_ATOMIC);
522 		if (value < 0)
523 			ERROR(cdev, "ecm req %02x.%02x response err %d\n",
524 					ctrl->bRequestType, ctrl->bRequest,
525 					value);
526 	}
527 
528 	/* device either stalls (value < 0) or reports success */
529 	return value;
530 }
531 
532 
533 static int ecm_set_alt(struct usb_function *f, unsigned intf, unsigned alt)
534 {
535 	struct f_ecm		*ecm = func_to_ecm(f);
536 	struct usb_composite_dev *cdev = f->config->cdev;
537 
538 	/* Control interface has only altsetting 0 */
539 	if (intf == ecm->ctrl_id) {
540 		if (alt != 0)
541 			goto fail;
542 
543 		VDBG(cdev, "reset ecm control %d\n", intf);
544 		usb_ep_disable(ecm->notify);
545 		if (!(ecm->notify->desc)) {
546 			VDBG(cdev, "init ecm ctrl %d\n", intf);
547 			if (config_ep_by_speed(cdev->gadget, f, ecm->notify))
548 				goto fail;
549 		}
550 		usb_ep_enable(ecm->notify);
551 
552 	/* Data interface has two altsettings, 0 and 1 */
553 	} else if (intf == ecm->data_id) {
554 		if (alt > 1)
555 			goto fail;
556 
557 		if (ecm->port.in_ep->enabled) {
558 			DBG(cdev, "reset ecm\n");
559 			gether_disconnect(&ecm->port);
560 		}
561 
562 		if (!ecm->port.in_ep->desc ||
563 		    !ecm->port.out_ep->desc) {
564 			DBG(cdev, "init ecm\n");
565 			if (config_ep_by_speed(cdev->gadget, f,
566 					       ecm->port.in_ep) ||
567 			    config_ep_by_speed(cdev->gadget, f,
568 					       ecm->port.out_ep)) {
569 				ecm->port.in_ep->desc = NULL;
570 				ecm->port.out_ep->desc = NULL;
571 				goto fail;
572 			}
573 		}
574 
575 		/* CDC Ethernet only sends data in non-default altsettings.
576 		 * Changing altsettings resets filters, statistics, etc.
577 		 */
578 		if (alt == 1) {
579 			struct net_device	*net;
580 
581 			/* Enable zlps by default for ECM conformance;
582 			 * override for musb_hdrc (avoids txdma ovhead).
583 			 */
584 			ecm->port.is_zlp_ok =
585 				gadget_is_zlp_supported(cdev->gadget);
586 			ecm->port.cdc_filter = DEFAULT_FILTER;
587 			DBG(cdev, "activate ecm\n");
588 			net = gether_connect(&ecm->port);
589 			if (IS_ERR(net))
590 				return PTR_ERR(net);
591 		}
592 
593 		/* NOTE this can be a minor disagreement with the ECM spec,
594 		 * which says speed notifications will "always" follow
595 		 * connection notifications.  But we allow one connect to
596 		 * follow another (if the first is in flight), and instead
597 		 * just guarantee that a speed notification is always sent.
598 		 */
599 		ecm_notify(ecm);
600 	} else
601 		goto fail;
602 
603 	return 0;
604 fail:
605 	return -EINVAL;
606 }
607 
608 /* Because the data interface supports multiple altsettings,
609  * this ECM function *MUST* implement a get_alt() method.
610  */
611 static int ecm_get_alt(struct usb_function *f, unsigned intf)
612 {
613 	struct f_ecm		*ecm = func_to_ecm(f);
614 
615 	if (intf == ecm->ctrl_id)
616 		return 0;
617 	return ecm->port.in_ep->enabled ? 1 : 0;
618 }
619 
620 static void ecm_disable(struct usb_function *f)
621 {
622 	struct f_ecm		*ecm = func_to_ecm(f);
623 	struct usb_composite_dev *cdev = f->config->cdev;
624 
625 	DBG(cdev, "ecm deactivated\n");
626 
627 	if (ecm->port.in_ep->enabled) {
628 		gether_disconnect(&ecm->port);
629 	} else {
630 		ecm->port.in_ep->desc = NULL;
631 		ecm->port.out_ep->desc = NULL;
632 	}
633 
634 	usb_ep_disable(ecm->notify);
635 	ecm->notify->desc = NULL;
636 }
637 
638 /*-------------------------------------------------------------------------*/
639 
640 /*
641  * Callbacks let us notify the host about connect/disconnect when the
642  * net device is opened or closed.
643  *
644  * For testing, note that link states on this side include both opened
645  * and closed variants of:
646  *
647  *   - disconnected/unconfigured
648  *   - configured but inactive (data alt 0)
649  *   - configured and active (data alt 1)
650  *
651  * Each needs to be tested with unplug, rmmod, SET_CONFIGURATION, and
652  * SET_INTERFACE (altsetting).  Remember also that "configured" doesn't
653  * imply the host is actually polling the notification endpoint, and
654  * likewise that "active" doesn't imply it's actually using the data
655  * endpoints for traffic.
656  */
657 
658 static void ecm_open(struct gether *geth)
659 {
660 	struct f_ecm		*ecm = func_to_ecm(&geth->func);
661 
662 	DBG(ecm->port.func.config->cdev, "%s\n", __func__);
663 
664 	ecm->is_open = true;
665 	ecm_notify(ecm);
666 }
667 
668 static void ecm_close(struct gether *geth)
669 {
670 	struct f_ecm		*ecm = func_to_ecm(&geth->func);
671 
672 	DBG(ecm->port.func.config->cdev, "%s\n", __func__);
673 
674 	ecm->is_open = false;
675 	ecm_notify(ecm);
676 }
677 
678 /*-------------------------------------------------------------------------*/
679 
680 /* ethernet function driver setup/binding */
681 
682 static int
683 ecm_bind(struct usb_configuration *c, struct usb_function *f)
684 {
685 	struct usb_composite_dev *cdev = c->cdev;
686 	struct f_ecm		*ecm = func_to_ecm(f);
687 	struct usb_string	*us;
688 	int			status = 0;
689 	struct usb_ep		*ep;
690 
691 	struct f_ecm_opts	*ecm_opts;
692 
693 	if (!can_support_ecm(cdev->gadget))
694 		return -EINVAL;
695 
696 	ecm_opts = container_of(f->fi, struct f_ecm_opts, func_inst);
697 
698 	mutex_lock(&ecm_opts->lock);
699 
700 	gether_set_gadget(ecm_opts->net, cdev->gadget);
701 
702 	if (!ecm_opts->bound) {
703 		status = gether_register_netdev(ecm_opts->net);
704 		ecm_opts->bound = true;
705 	}
706 
707 	mutex_unlock(&ecm_opts->lock);
708 	if (status)
709 		return status;
710 
711 	ecm_string_defs[1].s = ecm->ethaddr;
712 
713 	us = usb_gstrings_attach(cdev, ecm_strings,
714 				 ARRAY_SIZE(ecm_string_defs));
715 	if (IS_ERR(us))
716 		return PTR_ERR(us);
717 	ecm_control_intf.iInterface = us[0].id;
718 	ecm_data_intf.iInterface = us[2].id;
719 	ecm_desc.iMACAddress = us[1].id;
720 	ecm_iad_descriptor.iFunction = us[3].id;
721 
722 	/* allocate instance-specific interface IDs */
723 	status = usb_interface_id(c, f);
724 	if (status < 0)
725 		goto fail;
726 	ecm->ctrl_id = status;
727 	ecm_iad_descriptor.bFirstInterface = status;
728 
729 	ecm_control_intf.bInterfaceNumber = status;
730 	ecm_union_desc.bMasterInterface0 = status;
731 
732 	status = usb_interface_id(c, f);
733 	if (status < 0)
734 		goto fail;
735 	ecm->data_id = status;
736 
737 	ecm_data_nop_intf.bInterfaceNumber = status;
738 	ecm_data_intf.bInterfaceNumber = status;
739 	ecm_union_desc.bSlaveInterface0 = status;
740 
741 	status = -ENODEV;
742 
743 	/* allocate instance-specific endpoints */
744 	ep = usb_ep_autoconfig(cdev->gadget, &fs_ecm_in_desc);
745 	if (!ep)
746 		goto fail;
747 	ecm->port.in_ep = ep;
748 
749 	ep = usb_ep_autoconfig(cdev->gadget, &fs_ecm_out_desc);
750 	if (!ep)
751 		goto fail;
752 	ecm->port.out_ep = ep;
753 
754 	/* NOTE:  a status/notification endpoint is *OPTIONAL* but we
755 	 * don't treat it that way.  It's simpler, and some newer CDC
756 	 * profiles (wireless handsets) no longer treat it as optional.
757 	 */
758 	ep = usb_ep_autoconfig(cdev->gadget, &fs_ecm_notify_desc);
759 	if (!ep)
760 		goto fail;
761 	ecm->notify = ep;
762 
763 	status = -ENOMEM;
764 
765 	/* allocate notification request and buffer */
766 	ecm->notify_req = usb_ep_alloc_request(ep, GFP_KERNEL);
767 	if (!ecm->notify_req)
768 		goto fail;
769 	ecm->notify_req->buf = kmalloc(ECM_STATUS_BYTECOUNT, GFP_KERNEL);
770 	if (!ecm->notify_req->buf)
771 		goto fail;
772 	ecm->notify_req->context = ecm;
773 	ecm->notify_req->complete = ecm_notify_complete;
774 
775 	/* support all relevant hardware speeds... we expect that when
776 	 * hardware is dual speed, all bulk-capable endpoints work at
777 	 * both speeds
778 	 */
779 	hs_ecm_in_desc.bEndpointAddress = fs_ecm_in_desc.bEndpointAddress;
780 	hs_ecm_out_desc.bEndpointAddress = fs_ecm_out_desc.bEndpointAddress;
781 	hs_ecm_notify_desc.bEndpointAddress =
782 		fs_ecm_notify_desc.bEndpointAddress;
783 
784 	ss_ecm_in_desc.bEndpointAddress = fs_ecm_in_desc.bEndpointAddress;
785 	ss_ecm_out_desc.bEndpointAddress = fs_ecm_out_desc.bEndpointAddress;
786 	ss_ecm_notify_desc.bEndpointAddress =
787 		fs_ecm_notify_desc.bEndpointAddress;
788 
789 	status = usb_assign_descriptors(f, ecm_fs_function, ecm_hs_function,
790 			ecm_ss_function, ecm_ss_function);
791 	if (status)
792 		goto fail;
793 
794 	/* NOTE:  all that is done without knowing or caring about
795 	 * the network link ... which is unavailable to this code
796 	 * until we're activated via set_alt().
797 	 */
798 
799 	ecm->port.open = ecm_open;
800 	ecm->port.close = ecm_close;
801 
802 	DBG(cdev, "CDC Ethernet: %s speed IN/%s OUT/%s NOTIFY/%s\n",
803 			gadget_is_superspeed(c->cdev->gadget) ? "super" :
804 			gadget_is_dualspeed(c->cdev->gadget) ? "dual" : "full",
805 			ecm->port.in_ep->name, ecm->port.out_ep->name,
806 			ecm->notify->name);
807 	return 0;
808 
809 fail:
810 	if (ecm->notify_req) {
811 		kfree(ecm->notify_req->buf);
812 		usb_ep_free_request(ecm->notify, ecm->notify_req);
813 	}
814 
815 	ERROR(cdev, "%s: can't bind, err %d\n", f->name, status);
816 
817 	return status;
818 }
819 
820 static inline struct f_ecm_opts *to_f_ecm_opts(struct config_item *item)
821 {
822 	return container_of(to_config_group(item), struct f_ecm_opts,
823 			    func_inst.group);
824 }
825 
826 /* f_ecm_item_ops */
827 USB_ETHERNET_CONFIGFS_ITEM(ecm);
828 
829 /* f_ecm_opts_dev_addr */
830 USB_ETHERNET_CONFIGFS_ITEM_ATTR_DEV_ADDR(ecm);
831 
832 /* f_ecm_opts_host_addr */
833 USB_ETHERNET_CONFIGFS_ITEM_ATTR_HOST_ADDR(ecm);
834 
835 /* f_ecm_opts_qmult */
836 USB_ETHERNET_CONFIGFS_ITEM_ATTR_QMULT(ecm);
837 
838 /* f_ecm_opts_ifname */
839 USB_ETHERNET_CONFIGFS_ITEM_ATTR_IFNAME(ecm);
840 
841 static struct configfs_attribute *ecm_attrs[] = {
842 	&ecm_opts_attr_dev_addr,
843 	&ecm_opts_attr_host_addr,
844 	&ecm_opts_attr_qmult,
845 	&ecm_opts_attr_ifname,
846 	NULL,
847 };
848 
849 static const struct config_item_type ecm_func_type = {
850 	.ct_item_ops	= &ecm_item_ops,
851 	.ct_attrs	= ecm_attrs,
852 	.ct_owner	= THIS_MODULE,
853 };
854 
855 static void ecm_free_inst(struct usb_function_instance *f)
856 {
857 	struct f_ecm_opts *opts;
858 
859 	opts = container_of(f, struct f_ecm_opts, func_inst);
860 	if (opts->bound)
861 		gether_cleanup(netdev_priv(opts->net));
862 	else
863 		free_netdev(opts->net);
864 	kfree(opts);
865 }
866 
867 static struct usb_function_instance *ecm_alloc_inst(void)
868 {
869 	struct f_ecm_opts *opts;
870 
871 	opts = kzalloc(sizeof(*opts), GFP_KERNEL);
872 	if (!opts)
873 		return ERR_PTR(-ENOMEM);
874 	mutex_init(&opts->lock);
875 	opts->func_inst.free_func_inst = ecm_free_inst;
876 	opts->net = gether_setup_default();
877 	if (IS_ERR(opts->net)) {
878 		struct net_device *net = opts->net;
879 		kfree(opts);
880 		return ERR_CAST(net);
881 	}
882 
883 	config_group_init_type_name(&opts->func_inst.group, "", &ecm_func_type);
884 
885 	return &opts->func_inst;
886 }
887 
888 static void ecm_suspend(struct usb_function *f)
889 {
890 	struct f_ecm *ecm = func_to_ecm(f);
891 	struct usb_composite_dev *cdev = ecm->port.func.config->cdev;
892 
893 	DBG(cdev, "ECM Suspend\n");
894 
895 	gether_suspend(&ecm->port);
896 }
897 
898 static void ecm_resume(struct usb_function *f)
899 {
900 	struct f_ecm *ecm = func_to_ecm(f);
901 	struct usb_composite_dev *cdev = ecm->port.func.config->cdev;
902 
903 	DBG(cdev, "ECM Resume\n");
904 
905 	gether_resume(&ecm->port);
906 }
907 
908 static void ecm_free(struct usb_function *f)
909 {
910 	struct f_ecm *ecm;
911 	struct f_ecm_opts *opts;
912 
913 	ecm = func_to_ecm(f);
914 	opts = container_of(f->fi, struct f_ecm_opts, func_inst);
915 	kfree(ecm);
916 	mutex_lock(&opts->lock);
917 	opts->refcnt--;
918 	mutex_unlock(&opts->lock);
919 }
920 
921 static void ecm_unbind(struct usb_configuration *c, struct usb_function *f)
922 {
923 	struct f_ecm		*ecm = func_to_ecm(f);
924 
925 	DBG(c->cdev, "ecm unbind\n");
926 
927 	usb_free_all_descriptors(f);
928 
929 	if (atomic_read(&ecm->notify_count)) {
930 		usb_ep_dequeue(ecm->notify, ecm->notify_req);
931 		atomic_set(&ecm->notify_count, 0);
932 	}
933 
934 	kfree(ecm->notify_req->buf);
935 	usb_ep_free_request(ecm->notify, ecm->notify_req);
936 }
937 
938 static struct usb_function *ecm_alloc(struct usb_function_instance *fi)
939 {
940 	struct f_ecm	*ecm;
941 	struct f_ecm_opts *opts;
942 	int status;
943 
944 	/* allocate and initialize one new instance */
945 	ecm = kzalloc(sizeof(*ecm), GFP_KERNEL);
946 	if (!ecm)
947 		return ERR_PTR(-ENOMEM);
948 
949 	opts = container_of(fi, struct f_ecm_opts, func_inst);
950 	mutex_lock(&opts->lock);
951 	opts->refcnt++;
952 
953 	/* export host's Ethernet address in CDC format */
954 	status = gether_get_host_addr_cdc(opts->net, ecm->ethaddr,
955 					  sizeof(ecm->ethaddr));
956 	if (status < 12) {
957 		kfree(ecm);
958 		mutex_unlock(&opts->lock);
959 		return ERR_PTR(-EINVAL);
960 	}
961 
962 	ecm->port.ioport = netdev_priv(opts->net);
963 	mutex_unlock(&opts->lock);
964 	ecm->port.cdc_filter = DEFAULT_FILTER;
965 
966 	ecm->port.func.name = "cdc_ethernet";
967 	/* descriptors are per-instance copies */
968 	ecm->port.func.bind = ecm_bind;
969 	ecm->port.func.unbind = ecm_unbind;
970 	ecm->port.func.set_alt = ecm_set_alt;
971 	ecm->port.func.get_alt = ecm_get_alt;
972 	ecm->port.func.setup = ecm_setup;
973 	ecm->port.func.disable = ecm_disable;
974 	ecm->port.func.free_func = ecm_free;
975 	ecm->port.func.suspend = ecm_suspend;
976 	ecm->port.func.resume = ecm_resume;
977 
978 	return &ecm->port.func;
979 }
980 
981 DECLARE_USB_FUNCTION_INIT(ecm, ecm_alloc_inst, ecm_alloc);
982 MODULE_LICENSE("GPL");
983 MODULE_AUTHOR("David Brownell");
984