1 // SPDX-License-Identifier: GPL-2.0+
3 * f_eem.c -- USB CDC Ethernet (EEM) link function driver
5 * Copyright (C) 2003-2005,2008 David Brownell
6 * Copyright (C) 2008 Nokia Corporation
7 * Copyright (C) 2009 EF Johnson Technologies
10 #include <linux/kernel.h>
11 #include <linux/module.h>
12 #include <linux/device.h>
13 #include <linux/etherdevice.h>
14 #include <linux/crc32.h>
15 #include <linux/slab.h>
18 #include "u_ether_configfs.h"
24 * This function is a "CDC Ethernet Emulation Model" (CDC EEM)
33 static inline struct f_eem
*func_to_eem(struct usb_function
*f
)
35 return container_of(f
, struct f_eem
, port
.func
);
38 /*-------------------------------------------------------------------------*/
40 /* interface descriptor: */
42 static struct usb_interface_descriptor eem_intf
= {
43 .bLength
= sizeof eem_intf
,
44 .bDescriptorType
= USB_DT_INTERFACE
,
46 /* .bInterfaceNumber = DYNAMIC */
48 .bInterfaceClass
= USB_CLASS_COMM
,
49 .bInterfaceSubClass
= USB_CDC_SUBCLASS_EEM
,
50 .bInterfaceProtocol
= USB_CDC_PROTO_EEM
,
51 /* .iInterface = DYNAMIC */
54 /* full speed support: */
56 static struct usb_endpoint_descriptor eem_fs_in_desc
= {
57 .bLength
= USB_DT_ENDPOINT_SIZE
,
58 .bDescriptorType
= USB_DT_ENDPOINT
,
60 .bEndpointAddress
= USB_DIR_IN
,
61 .bmAttributes
= USB_ENDPOINT_XFER_BULK
,
64 static struct usb_endpoint_descriptor eem_fs_out_desc
= {
65 .bLength
= USB_DT_ENDPOINT_SIZE
,
66 .bDescriptorType
= USB_DT_ENDPOINT
,
68 .bEndpointAddress
= USB_DIR_OUT
,
69 .bmAttributes
= USB_ENDPOINT_XFER_BULK
,
72 static struct usb_descriptor_header
*eem_fs_function
[] = {
73 /* CDC EEM control descriptors */
74 (struct usb_descriptor_header
*) &eem_intf
,
75 (struct usb_descriptor_header
*) &eem_fs_in_desc
,
76 (struct usb_descriptor_header
*) &eem_fs_out_desc
,
80 /* high speed support: */
82 static struct usb_endpoint_descriptor eem_hs_in_desc
= {
83 .bLength
= USB_DT_ENDPOINT_SIZE
,
84 .bDescriptorType
= USB_DT_ENDPOINT
,
86 .bEndpointAddress
= USB_DIR_IN
,
87 .bmAttributes
= USB_ENDPOINT_XFER_BULK
,
88 .wMaxPacketSize
= cpu_to_le16(512),
91 static struct usb_endpoint_descriptor eem_hs_out_desc
= {
92 .bLength
= USB_DT_ENDPOINT_SIZE
,
93 .bDescriptorType
= USB_DT_ENDPOINT
,
95 .bEndpointAddress
= USB_DIR_OUT
,
96 .bmAttributes
= USB_ENDPOINT_XFER_BULK
,
97 .wMaxPacketSize
= cpu_to_le16(512),
100 static struct usb_descriptor_header
*eem_hs_function
[] = {
101 /* CDC EEM control descriptors */
102 (struct usb_descriptor_header
*) &eem_intf
,
103 (struct usb_descriptor_header
*) &eem_hs_in_desc
,
104 (struct usb_descriptor_header
*) &eem_hs_out_desc
,
108 /* super speed support: */
110 static struct usb_endpoint_descriptor eem_ss_in_desc
= {
111 .bLength
= USB_DT_ENDPOINT_SIZE
,
112 .bDescriptorType
= USB_DT_ENDPOINT
,
114 .bEndpointAddress
= USB_DIR_IN
,
115 .bmAttributes
= USB_ENDPOINT_XFER_BULK
,
116 .wMaxPacketSize
= cpu_to_le16(1024),
119 static struct usb_endpoint_descriptor eem_ss_out_desc
= {
120 .bLength
= USB_DT_ENDPOINT_SIZE
,
121 .bDescriptorType
= USB_DT_ENDPOINT
,
123 .bEndpointAddress
= USB_DIR_OUT
,
124 .bmAttributes
= USB_ENDPOINT_XFER_BULK
,
125 .wMaxPacketSize
= cpu_to_le16(1024),
128 static struct usb_ss_ep_comp_descriptor eem_ss_bulk_comp_desc
= {
129 .bLength
= sizeof eem_ss_bulk_comp_desc
,
130 .bDescriptorType
= USB_DT_SS_ENDPOINT_COMP
,
132 /* the following 2 values can be tweaked if necessary */
133 /* .bMaxBurst = 0, */
134 /* .bmAttributes = 0, */
137 static struct usb_descriptor_header
*eem_ss_function
[] = {
138 /* CDC EEM control descriptors */
139 (struct usb_descriptor_header
*) &eem_intf
,
140 (struct usb_descriptor_header
*) &eem_ss_in_desc
,
141 (struct usb_descriptor_header
*) &eem_ss_bulk_comp_desc
,
142 (struct usb_descriptor_header
*) &eem_ss_out_desc
,
143 (struct usb_descriptor_header
*) &eem_ss_bulk_comp_desc
,
147 /* string descriptors: */
149 static struct usb_string eem_string_defs
[] = {
150 [0].s
= "CDC Ethernet Emulation Model (EEM)",
151 { } /* end of list */
154 static struct usb_gadget_strings eem_string_table
= {
155 .language
= 0x0409, /* en-us */
156 .strings
= eem_string_defs
,
159 static struct usb_gadget_strings
*eem_strings
[] = {
164 /*-------------------------------------------------------------------------*/
166 static int eem_setup(struct usb_function
*f
, const struct usb_ctrlrequest
*ctrl
)
168 struct usb_composite_dev
*cdev
= f
->config
->cdev
;
169 int value
= -EOPNOTSUPP
;
170 u16 w_index
= le16_to_cpu(ctrl
->wIndex
);
171 u16 w_value
= le16_to_cpu(ctrl
->wValue
);
172 u16 w_length
= le16_to_cpu(ctrl
->wLength
);
174 DBG(cdev
, "invalid control req%02x.%02x v%04x i%04x l%d\n",
175 ctrl
->bRequestType
, ctrl
->bRequest
,
176 w_value
, w_index
, w_length
);
178 /* device either stalls (value < 0) or reports success */
183 static int eem_set_alt(struct usb_function
*f
, unsigned intf
, unsigned alt
)
185 struct f_eem
*eem
= func_to_eem(f
);
186 struct usb_composite_dev
*cdev
= f
->config
->cdev
;
187 struct net_device
*net
;
189 /* we know alt == 0, so this is an activation or a reset */
193 if (intf
== eem
->ctrl_id
) {
194 DBG(cdev
, "reset eem\n");
195 gether_disconnect(&eem
->port
);
197 if (!eem
->port
.in_ep
->desc
|| !eem
->port
.out_ep
->desc
) {
198 DBG(cdev
, "init eem\n");
199 if (config_ep_by_speed(cdev
->gadget
, f
,
201 config_ep_by_speed(cdev
->gadget
, f
,
203 eem
->port
.in_ep
->desc
= NULL
;
204 eem
->port
.out_ep
->desc
= NULL
;
209 /* zlps should not occur because zero-length EEM packets
210 * will be inserted in those cases where they would occur
212 eem
->port
.is_zlp_ok
= 1;
213 eem
->port
.cdc_filter
= DEFAULT_FILTER
;
214 DBG(cdev
, "activate eem\n");
215 net
= gether_connect(&eem
->port
);
226 static void eem_disable(struct usb_function
*f
)
228 struct f_eem
*eem
= func_to_eem(f
);
229 struct usb_composite_dev
*cdev
= f
->config
->cdev
;
231 DBG(cdev
, "eem deactivated\n");
233 if (eem
->port
.in_ep
->enabled
)
234 gether_disconnect(&eem
->port
);
237 /*-------------------------------------------------------------------------*/
239 /* EEM function driver setup/binding */
241 static int eem_bind(struct usb_configuration
*c
, struct usb_function
*f
)
243 struct usb_composite_dev
*cdev
= c
->cdev
;
244 struct f_eem
*eem
= func_to_eem(f
);
245 struct usb_string
*us
;
249 struct f_eem_opts
*eem_opts
;
251 eem_opts
= container_of(f
->fi
, struct f_eem_opts
, func_inst
);
253 * in drivers/usb/gadget/configfs.c:configfs_composite_bind()
254 * configurations are bound in sequence with list_for_each_entry,
255 * in each configuration its functions are bound in sequence
256 * with list_for_each_entry, so we assume no race condition
257 * with regard to eem_opts->bound access
259 if (!eem_opts
->bound
) {
260 mutex_lock(&eem_opts
->lock
);
261 gether_set_gadget(eem_opts
->net
, cdev
->gadget
);
262 status
= gether_register_netdev(eem_opts
->net
);
263 mutex_unlock(&eem_opts
->lock
);
266 eem_opts
->bound
= true;
269 us
= usb_gstrings_attach(cdev
, eem_strings
,
270 ARRAY_SIZE(eem_string_defs
));
273 eem_intf
.iInterface
= us
[0].id
;
275 /* allocate instance-specific interface IDs */
276 status
= usb_interface_id(c
, f
);
279 eem
->ctrl_id
= status
;
280 eem_intf
.bInterfaceNumber
= status
;
284 /* allocate instance-specific endpoints */
285 ep
= usb_ep_autoconfig(cdev
->gadget
, &eem_fs_in_desc
);
288 eem
->port
.in_ep
= ep
;
290 ep
= usb_ep_autoconfig(cdev
->gadget
, &eem_fs_out_desc
);
293 eem
->port
.out_ep
= ep
;
297 /* support all relevant hardware speeds... we expect that when
298 * hardware is dual speed, all bulk-capable endpoints work at
301 eem_hs_in_desc
.bEndpointAddress
= eem_fs_in_desc
.bEndpointAddress
;
302 eem_hs_out_desc
.bEndpointAddress
= eem_fs_out_desc
.bEndpointAddress
;
304 eem_ss_in_desc
.bEndpointAddress
= eem_fs_in_desc
.bEndpointAddress
;
305 eem_ss_out_desc
.bEndpointAddress
= eem_fs_out_desc
.bEndpointAddress
;
307 status
= usb_assign_descriptors(f
, eem_fs_function
, eem_hs_function
,
308 eem_ss_function
, NULL
);
312 DBG(cdev
, "CDC Ethernet (EEM): %s speed IN/%s OUT/%s\n",
313 gadget_is_superspeed(c
->cdev
->gadget
) ? "super" :
314 gadget_is_dualspeed(c
->cdev
->gadget
) ? "dual" : "full",
315 eem
->port
.in_ep
->name
, eem
->port
.out_ep
->name
);
319 ERROR(cdev
, "%s: can't bind, err %d\n", f
->name
, status
);
324 static void eem_cmd_complete(struct usb_ep
*ep
, struct usb_request
*req
)
326 struct sk_buff
*skb
= (struct sk_buff
*)req
->context
;
328 dev_kfree_skb_any(skb
);
332 * Add the EEM header and ethernet checksum.
333 * We currently do not attempt to put multiple ethernet frames
334 * into a single USB transfer
336 static struct sk_buff
*eem_wrap(struct gether
*port
, struct sk_buff
*skb
)
338 struct sk_buff
*skb2
= NULL
;
339 struct usb_ep
*in
= port
->in_ep
;
340 int headroom
, tailroom
, padlen
= 0;
347 headroom
= skb_headroom(skb
);
348 tailroom
= skb_tailroom(skb
);
350 /* When (len + EEM_HLEN + ETH_FCS_LEN) % in->maxpacket) is 0,
351 * stick two bytes of zero-length EEM packet on the end.
353 if (((len
+ EEM_HLEN
+ ETH_FCS_LEN
) % in
->maxpacket
) == 0)
356 if ((tailroom
>= (ETH_FCS_LEN
+ padlen
)) &&
357 (headroom
>= EEM_HLEN
) && !skb_cloned(skb
))
360 skb2
= skb_copy_expand(skb
, EEM_HLEN
, ETH_FCS_LEN
+ padlen
, GFP_ATOMIC
);
361 dev_kfree_skb_any(skb
);
367 /* use the "no CRC" option */
368 put_unaligned_be32(0xdeadbeef, skb_put(skb
, 4));
370 /* EEM packet header format:
371 * b0..13: length of ethernet frame
372 * b14: bmCRC (0 == sentinel CRC)
373 * b15: bmType (0 == data)
376 put_unaligned_le16(len
& 0x3FFF, skb_push(skb
, 2));
378 /* add a zero-length EEM packet, if needed */
380 put_unaligned_le16(0, skb_put(skb
, 2));
386 * Remove the EEM header. Note that there can be many EEM packets in a single
387 * USB transfer, so we need to break them out and handle them independently.
389 static int eem_unwrap(struct gether
*port
,
391 struct sk_buff_head
*list
)
393 struct usb_composite_dev
*cdev
= port
->func
.config
->cdev
;
397 struct sk_buff
*skb2
;
401 if (skb
->len
< EEM_HLEN
) {
403 DBG(cdev
, "invalid EEM header\n");
407 /* remove the EEM header */
408 header
= get_unaligned_le16(skb
->data
);
409 skb_pull(skb
, EEM_HLEN
);
411 /* EEM packet header format:
412 * b0..14: EEM type dependent (data or command)
413 * b15: bmType (0 == data, 1 == command)
415 if (header
& BIT(15)) {
416 struct usb_request
*req
= cdev
->req
;
419 /* EEM command packet format:
420 * b0..10: bmEEMCmdParam
422 * b14: reserved (must be zero)
423 * b15: bmType (1 == command)
425 if (header
& BIT(14))
428 bmEEMCmd
= (header
>> 11) & 0x7;
431 len
= header
& 0x7FF;
432 if (skb
->len
< len
) {
437 skb2
= skb_clone(skb
, GFP_ATOMIC
);
438 if (unlikely(!skb2
)) {
439 DBG(cdev
, "EEM echo response error\n");
443 put_unaligned_le16(BIT(15) | BIT(11) | len
,
445 skb_copy_bits(skb2
, 0, req
->buf
, skb2
->len
);
446 req
->length
= skb2
->len
;
447 req
->complete
= eem_cmd_complete
;
450 if (usb_ep_queue(port
->in_ep
, req
, GFP_ATOMIC
))
451 DBG(cdev
, "echo response queue fail\n");
454 case 1: /* echo response */
455 case 2: /* suspend hint */
456 case 3: /* response hint */
457 case 4: /* response complete hint */
459 default: /* reserved */
464 struct sk_buff
*skb3
;
466 /* check for zero-length EEM packet */
470 /* EEM data packet format:
471 * b0..13: length of ethernet frame
472 * b14: bmCRC (0 == sentinel, 1 == calculated)
473 * b15: bmType (0 == data)
475 len
= header
& 0x3FFF;
477 || (len
< (ETH_HLEN
+ ETH_FCS_LEN
))) {
483 if (header
& BIT(14)) {
484 crc
= get_unaligned_le32(skb
->data
+ len
487 skb
->data
, len
- ETH_FCS_LEN
);
489 crc
= get_unaligned_be32(skb
->data
+ len
494 DBG(cdev
, "invalid EEM CRC\n");
498 skb2
= skb_clone(skb
, GFP_ATOMIC
);
499 if (unlikely(!skb2
)) {
500 DBG(cdev
, "unable to unframe EEM packet\n");
503 skb_trim(skb2
, len
- ETH_FCS_LEN
);
505 skb3
= skb_copy_expand(skb2
,
509 if (unlikely(!skb3
)) {
510 dev_kfree_skb_any(skb2
);
513 dev_kfree_skb_any(skb2
);
514 skb_queue_tail(list
, skb3
);
521 dev_kfree_skb_any(skb
);
525 static inline struct f_eem_opts
*to_f_eem_opts(struct config_item
*item
)
527 return container_of(to_config_group(item
), struct f_eem_opts
,
532 USB_ETHERNET_CONFIGFS_ITEM(eem
);
534 /* f_eem_opts_dev_addr */
535 USB_ETHERNET_CONFIGFS_ITEM_ATTR_DEV_ADDR(eem
);
537 /* f_eem_opts_host_addr */
538 USB_ETHERNET_CONFIGFS_ITEM_ATTR_HOST_ADDR(eem
);
540 /* f_eem_opts_qmult */
541 USB_ETHERNET_CONFIGFS_ITEM_ATTR_QMULT(eem
);
543 /* f_eem_opts_ifname */
544 USB_ETHERNET_CONFIGFS_ITEM_ATTR_IFNAME(eem
);
546 static struct configfs_attribute
*eem_attrs
[] = {
547 &eem_opts_attr_dev_addr
,
548 &eem_opts_attr_host_addr
,
549 &eem_opts_attr_qmult
,
550 &eem_opts_attr_ifname
,
554 static const struct config_item_type eem_func_type
= {
555 .ct_item_ops
= &eem_item_ops
,
556 .ct_attrs
= eem_attrs
,
557 .ct_owner
= THIS_MODULE
,
560 static void eem_free_inst(struct usb_function_instance
*f
)
562 struct f_eem_opts
*opts
;
564 opts
= container_of(f
, struct f_eem_opts
, func_inst
);
566 gether_cleanup(netdev_priv(opts
->net
));
568 free_netdev(opts
->net
);
572 static struct usb_function_instance
*eem_alloc_inst(void)
574 struct f_eem_opts
*opts
;
576 opts
= kzalloc(sizeof(*opts
), GFP_KERNEL
);
578 return ERR_PTR(-ENOMEM
);
579 mutex_init(&opts
->lock
);
580 opts
->func_inst
.free_func_inst
= eem_free_inst
;
581 opts
->net
= gether_setup_default();
582 if (IS_ERR(opts
->net
)) {
583 struct net_device
*net
= opts
->net
;
585 return ERR_CAST(net
);
588 config_group_init_type_name(&opts
->func_inst
.group
, "", &eem_func_type
);
590 return &opts
->func_inst
;
593 static void eem_free(struct usb_function
*f
)
596 struct f_eem_opts
*opts
;
598 eem
= func_to_eem(f
);
599 opts
= container_of(f
->fi
, struct f_eem_opts
, func_inst
);
601 mutex_lock(&opts
->lock
);
603 mutex_unlock(&opts
->lock
);
606 static void eem_unbind(struct usb_configuration
*c
, struct usb_function
*f
)
608 DBG(c
->cdev
, "eem unbind\n");
610 usb_free_all_descriptors(f
);
613 static struct usb_function
*eem_alloc(struct usb_function_instance
*fi
)
616 struct f_eem_opts
*opts
;
618 /* allocate and initialize one new instance */
619 eem
= kzalloc(sizeof(*eem
), GFP_KERNEL
);
621 return ERR_PTR(-ENOMEM
);
623 opts
= container_of(fi
, struct f_eem_opts
, func_inst
);
624 mutex_lock(&opts
->lock
);
627 eem
->port
.ioport
= netdev_priv(opts
->net
);
628 mutex_unlock(&opts
->lock
);
629 eem
->port
.cdc_filter
= DEFAULT_FILTER
;
631 eem
->port
.func
.name
= "cdc_eem";
632 /* descriptors are per-instance copies */
633 eem
->port
.func
.bind
= eem_bind
;
634 eem
->port
.func
.unbind
= eem_unbind
;
635 eem
->port
.func
.set_alt
= eem_set_alt
;
636 eem
->port
.func
.setup
= eem_setup
;
637 eem
->port
.func
.disable
= eem_disable
;
638 eem
->port
.func
.free_func
= eem_free
;
639 eem
->port
.wrap
= eem_wrap
;
640 eem
->port
.unwrap
= eem_unwrap
;
641 eem
->port
.header_len
= EEM_HLEN
;
643 return &eem
->port
.func
;
646 DECLARE_USB_FUNCTION_INIT(eem
, eem_alloc_inst
, eem_alloc
);
647 MODULE_LICENSE("GPL");
648 MODULE_AUTHOR("David Brownell");