2 * u_ether.c -- Ethernet-over-USB link layer utilities for Gadget stack
4 * Copyright (C) 2003-2005,2008 David Brownell
5 * Copyright (C) 2003-2004 Robert Schwebel, Benedikt Spranger
6 * Copyright (C) 2008 Nokia Corporation
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.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
23 /* #define VERBOSE_DEBUG */
25 #include <linux/kernel.h>
26 #include <linux/gfp.h>
27 #include <linux/device.h>
28 #include <linux/ctype.h>
29 #include <linux/etherdevice.h>
30 #include <linux/ethtool.h>
36 * This component encapsulates the Ethernet link glue needed to provide
37 * one (!) network link through the USB gadget stack, normally "usb0".
39 * The control and data models are handled by the function driver which
40 * connects to this code; such as CDC Ethernet (ECM or EEM),
41 * "CDC Subset", or RNDIS. That includes all descriptor and endpoint
44 * Link level addressing is handled by this component using module
45 * parameters; if no such parameters are provided, random link level
46 * addresses are used. Each end of the link uses one address. The
47 * host end address is exported in various ways, and is often recorded
48 * in configuration databases.
50 * The driver which assembles each configuration using such a link is
51 * responsible for ensuring that each configuration includes at most one
52 * instance of is network link. (The network layer provides ways for
53 * this single "physical" link to be used by multiple virtual links.)
56 #define UETH__VERSION "29-May-2008"
59 /* lock is held while accessing port_usb
60 * or updating its backlink port_usb->ioport
63 struct gether
*port_usb
;
65 struct net_device
*net
;
66 struct usb_gadget
*gadget
;
68 spinlock_t req_lock
; /* guard {rx,tx}_reqs */
69 struct list_head tx_reqs
, rx_reqs
;
72 struct sk_buff_head rx_frames
;
75 struct sk_buff
*(*wrap
)(struct gether
*, struct sk_buff
*skb
);
76 int (*unwrap
)(struct gether
*,
78 struct sk_buff_head
*list
);
80 struct work_struct work
;
83 #define WORK_RX_MEMORY 0
86 u8 host_mac
[ETH_ALEN
];
89 /*-------------------------------------------------------------------------*/
91 #define RX_EXTRA 20 /* bytes guarding against rx overflows */
93 #define DEFAULT_QLEN 2 /* double buffering by default */
96 #ifdef CONFIG_USB_GADGET_DUALSPEED
98 static unsigned qmult
= 5;
99 module_param(qmult
, uint
, S_IRUGO
|S_IWUSR
);
100 MODULE_PARM_DESC(qmult
, "queue length multiplier at high speed");
102 #else /* full speed (low speed doesn't do bulk) */
106 /* for dual-speed hardware, use deeper queues at highspeed */
107 static inline int qlen(struct usb_gadget
*gadget
)
109 if (gadget_is_dualspeed(gadget
) && gadget
->speed
== USB_SPEED_HIGH
)
110 return qmult
* DEFAULT_QLEN
;
115 /*-------------------------------------------------------------------------*/
117 /* REVISIT there must be a better way than having two sets
126 #define xprintk(d, level, fmt, args...) \
127 printk(level "%s: " fmt , (d)->net->name , ## args)
131 #define DBG(dev, fmt, args...) \
132 xprintk(dev , KERN_DEBUG , fmt , ## args)
134 #define DBG(dev, fmt, args...) \
141 #define VDBG(dev, fmt, args...) \
145 #define ERROR(dev, fmt, args...) \
146 xprintk(dev , KERN_ERR , fmt , ## args)
147 #define INFO(dev, fmt, args...) \
148 xprintk(dev , KERN_INFO , fmt , ## args)
150 /*-------------------------------------------------------------------------*/
152 /* NETWORK DRIVER HOOKUP (to the layer above this driver) */
154 static int ueth_change_mtu(struct net_device
*net
, int new_mtu
)
156 struct eth_dev
*dev
= netdev_priv(net
);
160 /* don't change MTU on "live" link (peer won't know) */
161 spin_lock_irqsave(&dev
->lock
, flags
);
164 else if (new_mtu
<= ETH_HLEN
|| new_mtu
> ETH_FRAME_LEN
)
168 spin_unlock_irqrestore(&dev
->lock
, flags
);
173 static void eth_get_drvinfo(struct net_device
*net
, struct ethtool_drvinfo
*p
)
175 struct eth_dev
*dev
= netdev_priv(net
);
177 strlcpy(p
->driver
, "g_ether", sizeof p
->driver
);
178 strlcpy(p
->version
, UETH__VERSION
, sizeof p
->version
);
179 strlcpy(p
->fw_version
, dev
->gadget
->name
, sizeof p
->fw_version
);
180 strlcpy(p
->bus_info
, dev_name(&dev
->gadget
->dev
), sizeof p
->bus_info
);
183 /* REVISIT can also support:
184 * - WOL (by tracking suspends and issuing remote wakeup)
185 * - msglevel (implies updated messaging)
186 * - ... probably more ethtool ops
189 static const struct ethtool_ops ops
= {
190 .get_drvinfo
= eth_get_drvinfo
,
191 .get_link
= ethtool_op_get_link
,
194 static void defer_kevent(struct eth_dev
*dev
, int flag
)
196 if (test_and_set_bit(flag
, &dev
->todo
))
198 if (!schedule_work(&dev
->work
))
199 ERROR(dev
, "kevent %d may have been dropped\n", flag
);
201 DBG(dev
, "kevent %d scheduled\n", flag
);
204 static void rx_complete(struct usb_ep
*ep
, struct usb_request
*req
);
207 rx_submit(struct eth_dev
*dev
, struct usb_request
*req
, gfp_t gfp_flags
)
210 int retval
= -ENOMEM
;
215 spin_lock_irqsave(&dev
->lock
, flags
);
217 out
= dev
->port_usb
->out_ep
;
220 spin_unlock_irqrestore(&dev
->lock
, flags
);
226 /* Padding up to RX_EXTRA handles minor disagreements with host.
227 * Normally we use the USB "terminate on short read" convention;
228 * so allow up to (N*maxpacket), since that memory is normally
229 * already allocated. Some hardware doesn't deal well with short
230 * reads (e.g. DMA must be N*maxpacket), so for now don't trim a
231 * byte off the end (to force hardware errors on overflow).
233 * RNDIS uses internal framing, and explicitly allows senders to
234 * pad to end-of-packet. That's potentially nice for speed, but
235 * means receivers can't recover lost synch on their own (because
236 * new packets don't only start after a short RX).
238 size
+= sizeof(struct ethhdr
) + dev
->net
->mtu
+ RX_EXTRA
;
239 size
+= dev
->port_usb
->header_len
;
240 size
+= out
->maxpacket
- 1;
241 size
-= size
% out
->maxpacket
;
243 skb
= alloc_skb(size
+ NET_IP_ALIGN
, gfp_flags
);
245 DBG(dev
, "no rx skb\n");
249 /* Some platforms perform better when IP packets are aligned,
250 * but on at least one, checksumming fails otherwise. Note:
251 * RNDIS headers involve variable numbers of LE32 values.
253 skb_reserve(skb
, NET_IP_ALIGN
);
255 req
->buf
= skb
->data
;
257 req
->complete
= rx_complete
;
260 retval
= usb_ep_queue(out
, req
, gfp_flags
);
261 if (retval
== -ENOMEM
)
263 defer_kevent(dev
, WORK_RX_MEMORY
);
265 DBG(dev
, "rx submit --> %d\n", retval
);
267 dev_kfree_skb_any(skb
);
268 spin_lock_irqsave(&dev
->req_lock
, flags
);
269 list_add(&req
->list
, &dev
->rx_reqs
);
270 spin_unlock_irqrestore(&dev
->req_lock
, flags
);
275 static void rx_complete(struct usb_ep
*ep
, struct usb_request
*req
)
277 struct sk_buff
*skb
= req
->context
, *skb2
;
278 struct eth_dev
*dev
= ep
->driver_data
;
279 int status
= req
->status
;
283 /* normal completion */
285 skb_put(skb
, req
->actual
);
290 spin_lock_irqsave(&dev
->lock
, flags
);
292 status
= dev
->unwrap(dev
->port_usb
,
296 dev_kfree_skb_any(skb
);
299 spin_unlock_irqrestore(&dev
->lock
, flags
);
301 skb_queue_tail(&dev
->rx_frames
, skb
);
305 skb2
= skb_dequeue(&dev
->rx_frames
);
308 || ETH_HLEN
> skb2
->len
309 || skb2
->len
> ETH_FRAME_LEN
) {
310 dev
->net
->stats
.rx_errors
++;
311 dev
->net
->stats
.rx_length_errors
++;
312 DBG(dev
, "rx length %d\n", skb2
->len
);
313 dev_kfree_skb_any(skb2
);
316 skb2
->protocol
= eth_type_trans(skb2
, dev
->net
);
317 dev
->net
->stats
.rx_packets
++;
318 dev
->net
->stats
.rx_bytes
+= skb2
->len
;
320 /* no buffer copies needed, unless hardware can't
323 status
= netif_rx(skb2
);
325 skb2
= skb_dequeue(&dev
->rx_frames
);
329 /* software-driven interface shutdown */
330 case -ECONNRESET
: /* unlink */
331 case -ESHUTDOWN
: /* disconnect etc */
332 VDBG(dev
, "rx shutdown, code %d\n", status
);
335 /* for hardware automagic (such as pxa) */
336 case -ECONNABORTED
: /* endpoint reset */
337 DBG(dev
, "rx %s reset\n", ep
->name
);
338 defer_kevent(dev
, WORK_RX_MEMORY
);
340 dev_kfree_skb_any(skb
);
345 dev
->net
->stats
.rx_over_errors
++;
349 dev
->net
->stats
.rx_errors
++;
350 DBG(dev
, "rx status %d\n", status
);
355 dev_kfree_skb_any(skb
);
356 if (!netif_running(dev
->net
)) {
358 spin_lock(&dev
->req_lock
);
359 list_add(&req
->list
, &dev
->rx_reqs
);
360 spin_unlock(&dev
->req_lock
);
364 rx_submit(dev
, req
, GFP_ATOMIC
);
367 static int prealloc(struct list_head
*list
, struct usb_ep
*ep
, unsigned n
)
370 struct usb_request
*req
;
375 /* queue/recycle up to N requests */
377 list_for_each_entry(req
, list
, list
) {
382 req
= usb_ep_alloc_request(ep
, GFP_ATOMIC
);
384 return list_empty(list
) ? -ENOMEM
: 0;
385 list_add(&req
->list
, list
);
392 struct list_head
*next
;
394 next
= req
->list
.next
;
395 list_del(&req
->list
);
396 usb_ep_free_request(ep
, req
);
401 req
= container_of(next
, struct usb_request
, list
);
406 static int alloc_requests(struct eth_dev
*dev
, struct gether
*link
, unsigned n
)
410 spin_lock(&dev
->req_lock
);
411 status
= prealloc(&dev
->tx_reqs
, link
->in_ep
, n
);
414 status
= prealloc(&dev
->rx_reqs
, link
->out_ep
, n
);
419 DBG(dev
, "can't alloc requests\n");
421 spin_unlock(&dev
->req_lock
);
425 static void rx_fill(struct eth_dev
*dev
, gfp_t gfp_flags
)
427 struct usb_request
*req
;
430 /* fill unused rxq slots with some skb */
431 spin_lock_irqsave(&dev
->req_lock
, flags
);
432 while (!list_empty(&dev
->rx_reqs
)) {
433 req
= container_of(dev
->rx_reqs
.next
,
434 struct usb_request
, list
);
435 list_del_init(&req
->list
);
436 spin_unlock_irqrestore(&dev
->req_lock
, flags
);
438 if (rx_submit(dev
, req
, gfp_flags
) < 0) {
439 defer_kevent(dev
, WORK_RX_MEMORY
);
443 spin_lock_irqsave(&dev
->req_lock
, flags
);
445 spin_unlock_irqrestore(&dev
->req_lock
, flags
);
448 static void eth_work(struct work_struct
*work
)
450 struct eth_dev
*dev
= container_of(work
, struct eth_dev
, work
);
452 if (test_and_clear_bit(WORK_RX_MEMORY
, &dev
->todo
)) {
453 if (netif_running(dev
->net
))
454 rx_fill(dev
, GFP_KERNEL
);
458 DBG(dev
, "work done, flags = 0x%lx\n", dev
->todo
);
461 static void tx_complete(struct usb_ep
*ep
, struct usb_request
*req
)
463 struct sk_buff
*skb
= req
->context
;
464 struct eth_dev
*dev
= ep
->driver_data
;
466 switch (req
->status
) {
468 dev
->net
->stats
.tx_errors
++;
469 VDBG(dev
, "tx err %d\n", req
->status
);
471 case -ECONNRESET
: /* unlink */
472 case -ESHUTDOWN
: /* disconnect etc */
475 dev
->net
->stats
.tx_bytes
+= skb
->len
;
477 dev
->net
->stats
.tx_packets
++;
479 spin_lock(&dev
->req_lock
);
480 list_add(&req
->list
, &dev
->tx_reqs
);
481 spin_unlock(&dev
->req_lock
);
482 dev_kfree_skb_any(skb
);
484 atomic_dec(&dev
->tx_qlen
);
485 if (netif_carrier_ok(dev
->net
))
486 netif_wake_queue(dev
->net
);
489 static inline int is_promisc(u16 cdc_filter
)
491 return cdc_filter
& USB_CDC_PACKET_TYPE_PROMISCUOUS
;
494 static netdev_tx_t
eth_start_xmit(struct sk_buff
*skb
,
495 struct net_device
*net
)
497 struct eth_dev
*dev
= netdev_priv(net
);
498 int length
= skb
->len
;
500 struct usb_request
*req
= NULL
;
505 spin_lock_irqsave(&dev
->lock
, flags
);
507 in
= dev
->port_usb
->in_ep
;
508 cdc_filter
= dev
->port_usb
->cdc_filter
;
513 spin_unlock_irqrestore(&dev
->lock
, flags
);
516 dev_kfree_skb_any(skb
);
520 /* apply outgoing CDC or RNDIS filters */
521 if (!is_promisc(cdc_filter
)) {
522 u8
*dest
= skb
->data
;
524 if (is_multicast_ether_addr(dest
)) {
527 /* ignores USB_CDC_PACKET_TYPE_MULTICAST and host
528 * SET_ETHERNET_MULTICAST_FILTERS requests
530 if (is_broadcast_ether_addr(dest
))
531 type
= USB_CDC_PACKET_TYPE_BROADCAST
;
533 type
= USB_CDC_PACKET_TYPE_ALL_MULTICAST
;
534 if (!(cdc_filter
& type
)) {
535 dev_kfree_skb_any(skb
);
539 /* ignores USB_CDC_PACKET_TYPE_DIRECTED */
542 spin_lock_irqsave(&dev
->req_lock
, flags
);
544 * this freelist can be empty if an interrupt triggered disconnect()
545 * and reconfigured the gadget (shutting down this queue) after the
546 * network stack decided to xmit but before we got the spinlock.
548 if (list_empty(&dev
->tx_reqs
)) {
549 spin_unlock_irqrestore(&dev
->req_lock
, flags
);
550 return NETDEV_TX_BUSY
;
553 req
= container_of(dev
->tx_reqs
.next
, struct usb_request
, list
);
554 list_del(&req
->list
);
556 /* temporarily stop TX queue when the freelist empties */
557 if (list_empty(&dev
->tx_reqs
))
558 netif_stop_queue(net
);
559 spin_unlock_irqrestore(&dev
->req_lock
, flags
);
561 /* no buffer copies needed, unless the network stack did it
562 * or the hardware can't use skb buffers.
563 * or there's not enough space for extra headers we need
568 spin_lock_irqsave(&dev
->lock
, flags
);
570 skb
= dev
->wrap(dev
->port_usb
, skb
);
571 spin_unlock_irqrestore(&dev
->lock
, flags
);
577 req
->buf
= skb
->data
;
579 req
->complete
= tx_complete
;
581 /* use zlp framing on tx for strict CDC-Ether conformance,
582 * though any robust network rx path ignores extra padding.
583 * and some hardware doesn't like to write zlps.
586 if (!dev
->zlp
&& (length
% in
->maxpacket
) == 0)
589 req
->length
= length
;
591 /* throttle highspeed IRQ rate back slightly */
592 if (gadget_is_dualspeed(dev
->gadget
))
593 req
->no_interrupt
= (dev
->gadget
->speed
== USB_SPEED_HIGH
)
594 ? ((atomic_read(&dev
->tx_qlen
) % qmult
) != 0)
597 retval
= usb_ep_queue(in
, req
, GFP_ATOMIC
);
600 DBG(dev
, "tx queue err %d\n", retval
);
603 net
->trans_start
= jiffies
;
604 atomic_inc(&dev
->tx_qlen
);
608 dev_kfree_skb_any(skb
);
610 dev
->net
->stats
.tx_dropped
++;
611 spin_lock_irqsave(&dev
->req_lock
, flags
);
612 if (list_empty(&dev
->tx_reqs
))
613 netif_start_queue(net
);
614 list_add(&req
->list
, &dev
->tx_reqs
);
615 spin_unlock_irqrestore(&dev
->req_lock
, flags
);
620 /*-------------------------------------------------------------------------*/
622 static void eth_start(struct eth_dev
*dev
, gfp_t gfp_flags
)
624 DBG(dev
, "%s\n", __func__
);
626 /* fill the rx queue */
627 rx_fill(dev
, gfp_flags
);
629 /* and open the tx floodgates */
630 atomic_set(&dev
->tx_qlen
, 0);
631 netif_wake_queue(dev
->net
);
634 static int eth_open(struct net_device
*net
)
636 struct eth_dev
*dev
= netdev_priv(net
);
639 DBG(dev
, "%s\n", __func__
);
640 if (netif_carrier_ok(dev
->net
))
641 eth_start(dev
, GFP_KERNEL
);
643 spin_lock_irq(&dev
->lock
);
644 link
= dev
->port_usb
;
645 if (link
&& link
->open
)
647 spin_unlock_irq(&dev
->lock
);
652 static int eth_stop(struct net_device
*net
)
654 struct eth_dev
*dev
= netdev_priv(net
);
657 VDBG(dev
, "%s\n", __func__
);
658 netif_stop_queue(net
);
660 DBG(dev
, "stop stats: rx/tx %ld/%ld, errs %ld/%ld\n",
661 dev
->net
->stats
.rx_packets
, dev
->net
->stats
.tx_packets
,
662 dev
->net
->stats
.rx_errors
, dev
->net
->stats
.tx_errors
665 /* ensure there are no more active requests */
666 spin_lock_irqsave(&dev
->lock
, flags
);
668 struct gether
*link
= dev
->port_usb
;
673 /* NOTE: we have no abort-queue primitive we could use
674 * to cancel all pending I/O. Instead, we disable then
675 * reenable the endpoints ... this idiom may leave toggle
676 * wrong, but that's a self-correcting error.
678 * REVISIT: we *COULD* just let the transfers complete at
679 * their own pace; the network stack can handle old packets.
680 * For the moment we leave this here, since it works.
682 usb_ep_disable(link
->in_ep
);
683 usb_ep_disable(link
->out_ep
);
684 if (netif_carrier_ok(net
)) {
685 DBG(dev
, "host still using in/out endpoints\n");
686 usb_ep_enable(link
->in_ep
, link
->in
);
687 usb_ep_enable(link
->out_ep
, link
->out
);
690 spin_unlock_irqrestore(&dev
->lock
, flags
);
695 /*-------------------------------------------------------------------------*/
697 /* initial value, changed by "ifconfig usb0 hw ether xx:xx:xx:xx:xx:xx" */
698 static char *dev_addr
;
699 module_param(dev_addr
, charp
, S_IRUGO
);
700 MODULE_PARM_DESC(dev_addr
, "Device Ethernet Address");
702 /* this address is invisible to ifconfig */
703 static char *host_addr
;
704 module_param(host_addr
, charp
, S_IRUGO
);
705 MODULE_PARM_DESC(host_addr
, "Host Ethernet Address");
707 static int get_ether_addr(const char *str
, u8
*dev_addr
)
712 for (i
= 0; i
< 6; i
++) {
715 if ((*str
== '.') || (*str
== ':'))
717 num
= hex_to_bin(*str
++) << 4;
718 num
|= hex_to_bin(*str
++);
721 if (is_valid_ether_addr(dev_addr
))
724 random_ether_addr(dev_addr
);
728 static struct eth_dev
*the_dev
;
730 static const struct net_device_ops eth_netdev_ops
= {
731 .ndo_open
= eth_open
,
732 .ndo_stop
= eth_stop
,
733 .ndo_start_xmit
= eth_start_xmit
,
734 .ndo_change_mtu
= ueth_change_mtu
,
735 .ndo_set_mac_address
= eth_mac_addr
,
736 .ndo_validate_addr
= eth_validate_addr
,
739 static struct device_type gadget_type
= {
744 * gether_setup - initialize one ethernet-over-usb link
745 * @g: gadget to associated with these links
746 * @ethaddr: NULL, or a buffer in which the ethernet address of the
747 * host side of the link is recorded
750 * This sets up the single network link that may be exported by a
751 * gadget driver using this framework. The link layer addresses are
752 * set up using module parameters.
754 * Returns negative errno, or zero on success
756 int gether_setup(struct usb_gadget
*g
, u8 ethaddr
[ETH_ALEN
])
759 struct net_device
*net
;
765 net
= alloc_etherdev(sizeof *dev
);
769 dev
= netdev_priv(net
);
770 spin_lock_init(&dev
->lock
);
771 spin_lock_init(&dev
->req_lock
);
772 INIT_WORK(&dev
->work
, eth_work
);
773 INIT_LIST_HEAD(&dev
->tx_reqs
);
774 INIT_LIST_HEAD(&dev
->rx_reqs
);
776 skb_queue_head_init(&dev
->rx_frames
);
778 /* network device setup */
780 strcpy(net
->name
, "usb%d");
782 if (get_ether_addr(dev_addr
, net
->dev_addr
))
784 "using random %s ethernet address\n", "self");
785 if (get_ether_addr(host_addr
, dev
->host_mac
))
787 "using random %s ethernet address\n", "host");
790 memcpy(ethaddr
, dev
->host_mac
, ETH_ALEN
);
792 net
->netdev_ops
= ð_netdev_ops
;
794 SET_ETHTOOL_OPS(net
, &ops
);
796 /* two kinds of host-initiated state changes:
797 * - iff DATA transfer is active, carrier is "on"
798 * - tx queueing enabled if open *and* carrier is "on"
800 netif_carrier_off(net
);
803 SET_NETDEV_DEV(net
, &g
->dev
);
804 SET_NETDEV_DEVTYPE(net
, &gadget_type
);
806 status
= register_netdev(net
);
808 dev_dbg(&g
->dev
, "register_netdev failed, %d\n", status
);
811 INFO(dev
, "MAC %pM\n", net
->dev_addr
);
812 INFO(dev
, "HOST MAC %pM\n", dev
->host_mac
);
821 * gether_cleanup - remove Ethernet-over-USB device
824 * This is called to free all resources allocated by @gether_setup().
826 void gether_cleanup(void)
831 unregister_netdev(the_dev
->net
);
832 free_netdev(the_dev
->net
);
834 /* assuming we used keventd, it must quiesce too */
835 flush_scheduled_work();
842 * gether_connect - notify network layer that USB link is active
843 * @link: the USB link, set up with endpoints, descriptors matching
844 * current device speed, and any framing wrapper(s) set up.
845 * Context: irqs blocked
847 * This is called to activate endpoints and let the network layer know
848 * the connection is active ("carrier detect"). It may cause the I/O
849 * queues to open and start letting network packets flow, but will in
850 * any case activate the endpoints so that they respond properly to the
853 * Verify net_device pointer returned using IS_ERR(). If it doesn't
854 * indicate some error code (negative errno), ep->driver_data values
855 * have been overwritten.
857 struct net_device
*gether_connect(struct gether
*link
)
859 struct eth_dev
*dev
= the_dev
;
863 return ERR_PTR(-EINVAL
);
865 link
->in_ep
->driver_data
= dev
;
866 result
= usb_ep_enable(link
->in_ep
, link
->in
);
868 DBG(dev
, "enable %s --> %d\n",
869 link
->in_ep
->name
, result
);
873 link
->out_ep
->driver_data
= dev
;
874 result
= usb_ep_enable(link
->out_ep
, link
->out
);
876 DBG(dev
, "enable %s --> %d\n",
877 link
->out_ep
->name
, result
);
882 result
= alloc_requests(dev
, link
, qlen(dev
->gadget
));
885 dev
->zlp
= link
->is_zlp_ok
;
886 DBG(dev
, "qlen %d\n", qlen(dev
->gadget
));
888 dev
->header_len
= link
->header_len
;
889 dev
->unwrap
= link
->unwrap
;
890 dev
->wrap
= link
->wrap
;
892 spin_lock(&dev
->lock
);
893 dev
->port_usb
= link
;
895 if (netif_running(dev
->net
)) {
902 spin_unlock(&dev
->lock
);
904 netif_carrier_on(dev
->net
);
905 if (netif_running(dev
->net
))
906 eth_start(dev
, GFP_ATOMIC
);
908 /* on error, disable any endpoints */
910 (void) usb_ep_disable(link
->out_ep
);
912 (void) usb_ep_disable(link
->in_ep
);
915 /* caller is responsible for cleanup on error */
917 return ERR_PTR(result
);
922 * gether_disconnect - notify network layer that USB link is inactive
923 * @link: the USB link, on which gether_connect() was called
924 * Context: irqs blocked
926 * This is called to deactivate endpoints and let the network layer know
927 * the connection went inactive ("no carrier").
929 * On return, the state is as if gether_connect() had never been called.
930 * The endpoints are inactive, and accordingly without active USB I/O.
931 * Pointers to endpoint descriptors and endpoint private data are nulled.
933 void gether_disconnect(struct gether
*link
)
935 struct eth_dev
*dev
= link
->ioport
;
936 struct usb_request
*req
;
942 DBG(dev
, "%s\n", __func__
);
944 netif_stop_queue(dev
->net
);
945 netif_carrier_off(dev
->net
);
947 /* disable endpoints, forcing (synchronous) completion
948 * of all pending i/o. then free the request objects
949 * and forget about the endpoints.
951 usb_ep_disable(link
->in_ep
);
952 spin_lock(&dev
->req_lock
);
953 while (!list_empty(&dev
->tx_reqs
)) {
954 req
= container_of(dev
->tx_reqs
.next
,
955 struct usb_request
, list
);
956 list_del(&req
->list
);
958 spin_unlock(&dev
->req_lock
);
959 usb_ep_free_request(link
->in_ep
, req
);
960 spin_lock(&dev
->req_lock
);
962 spin_unlock(&dev
->req_lock
);
963 link
->in_ep
->driver_data
= NULL
;
966 usb_ep_disable(link
->out_ep
);
967 spin_lock(&dev
->req_lock
);
968 while (!list_empty(&dev
->rx_reqs
)) {
969 req
= container_of(dev
->rx_reqs
.next
,
970 struct usb_request
, list
);
971 list_del(&req
->list
);
973 spin_unlock(&dev
->req_lock
);
974 usb_ep_free_request(link
->out_ep
, req
);
975 spin_lock(&dev
->req_lock
);
977 spin_unlock(&dev
->req_lock
);
978 link
->out_ep
->driver_data
= NULL
;
981 /* finish forgetting about this USB link episode */
986 spin_lock(&dev
->lock
);
987 dev
->port_usb
= NULL
;
989 spin_unlock(&dev
->lock
);