15b2fc499SJeff Garzik /* 25b2fc499SJeff Garzik * USB Network driver infrastructure 35b2fc499SJeff Garzik * Copyright (C) 2000-2005 by David Brownell 45b2fc499SJeff Garzik * Copyright (C) 2003-2005 David Hollis <dhollis@davehollis.com> 55b2fc499SJeff Garzik * 65b2fc499SJeff Garzik * This program is free software; you can redistribute it and/or modify 75b2fc499SJeff Garzik * it under the terms of the GNU General Public License as published by 85b2fc499SJeff Garzik * the Free Software Foundation; either version 2 of the License, or 95b2fc499SJeff Garzik * (at your option) any later version. 105b2fc499SJeff Garzik * 115b2fc499SJeff Garzik * This program is distributed in the hope that it will be useful, 125b2fc499SJeff Garzik * but WITHOUT ANY WARRANTY; without even the implied warranty of 135b2fc499SJeff Garzik * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 145b2fc499SJeff Garzik * GNU General Public License for more details. 155b2fc499SJeff Garzik * 165b2fc499SJeff Garzik * You should have received a copy of the GNU General Public License 175b2fc499SJeff Garzik * along with this program; if not, write to the Free Software 185b2fc499SJeff Garzik * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 195b2fc499SJeff Garzik */ 205b2fc499SJeff Garzik 215b2fc499SJeff Garzik /* 225b2fc499SJeff Garzik * This is a generic "USB networking" framework that works with several 235b2fc499SJeff Garzik * kinds of full and high speed networking devices: host-to-host cables, 245b2fc499SJeff Garzik * smart usb peripherals, and actual Ethernet adapters. 255b2fc499SJeff Garzik * 265b2fc499SJeff Garzik * These devices usually differ in terms of control protocols (if they 275b2fc499SJeff Garzik * even have one!) and sometimes they define new framing to wrap or batch 285b2fc499SJeff Garzik * Ethernet packets. Otherwise, they talk to USB pretty much the same, 295b2fc499SJeff Garzik * so interface (un)binding, endpoint I/O queues, fault handling, and other 305b2fc499SJeff Garzik * issues can usefully be addressed by this framework. 315b2fc499SJeff Garzik */ 325b2fc499SJeff Garzik 335b2fc499SJeff Garzik // #define DEBUG // error path messages, extra info 345b2fc499SJeff Garzik // #define VERBOSE // more; success messages 355b2fc499SJeff Garzik 365b2fc499SJeff Garzik #include <linux/module.h> 375b2fc499SJeff Garzik #include <linux/init.h> 385b2fc499SJeff Garzik #include <linux/netdevice.h> 395b2fc499SJeff Garzik #include <linux/etherdevice.h> 4003ad032bSPeter Holik #include <linux/ctype.h> 415b2fc499SJeff Garzik #include <linux/ethtool.h> 425b2fc499SJeff Garzik #include <linux/workqueue.h> 435b2fc499SJeff Garzik #include <linux/mii.h> 445b2fc499SJeff Garzik #include <linux/usb.h> 453692e94fSJussi Kivilinna #include <linux/usb/usbnet.h> 465a0e3ad6STejun Heo #include <linux/slab.h> 47fd1f170dSAndy Shevchenko #include <linux/kernel.h> 48b0786b43SMing Lei #include <linux/pm_runtime.h> 495b2fc499SJeff Garzik 505b2fc499SJeff Garzik #define DRIVER_VERSION "22-Aug-2005" 515b2fc499SJeff Garzik 525b2fc499SJeff Garzik 535b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 545b2fc499SJeff Garzik 555b2fc499SJeff Garzik /* 565b2fc499SJeff Garzik * Nineteen USB 1.1 max size bulk transactions per frame (ms), max. 575b2fc499SJeff Garzik * Several dozen bytes of IPv4 data can fit in two such transactions. 585b2fc499SJeff Garzik * One maximum size Ethernet packet takes twenty four of them. 595b2fc499SJeff Garzik * For high speed, each frame comfortably fits almost 36 max size 605b2fc499SJeff Garzik * Ethernet packets (so queues should be bigger). 615b2fc499SJeff Garzik * 625b2fc499SJeff Garzik * REVISIT qlens should be members of 'struct usbnet'; the goal is to 635b2fc499SJeff Garzik * let the USB host controller be busy for 5msec or more before an irq 645b2fc499SJeff Garzik * is required, under load. Jumbograms change the equation. 655b2fc499SJeff Garzik */ 665b2fc499SJeff Garzik #define RX_MAX_QUEUE_MEMORY (60 * 1518) 675b2fc499SJeff Garzik #define RX_QLEN(dev) (((dev)->udev->speed == USB_SPEED_HIGH) ? \ 685b2fc499SJeff Garzik (RX_MAX_QUEUE_MEMORY/(dev)->rx_urb_size) : 4) 695b2fc499SJeff Garzik #define TX_QLEN(dev) (((dev)->udev->speed == USB_SPEED_HIGH) ? \ 705b2fc499SJeff Garzik (RX_MAX_QUEUE_MEMORY/(dev)->hard_mtu) : 4) 715b2fc499SJeff Garzik 725b2fc499SJeff Garzik // reawaken network queue this soon after stopping; else watchdog barks 735b2fc499SJeff Garzik #define TX_TIMEOUT_JIFFIES (5*HZ) 745b2fc499SJeff Garzik 755b2fc499SJeff Garzik // throttle rx/tx briefly after some faults, so khubd might disconnect() 765b2fc499SJeff Garzik // us (it polls at HZ/4 usually) before we report too many false errors. 775b2fc499SJeff Garzik #define THROTTLE_JIFFIES (HZ/8) 785b2fc499SJeff Garzik 795b2fc499SJeff Garzik // between wakeups 805b2fc499SJeff Garzik #define UNLINK_TIMEOUT_MS 3 815b2fc499SJeff Garzik 825b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 835b2fc499SJeff Garzik 845b2fc499SJeff Garzik // randomly generated ethernet address 855b2fc499SJeff Garzik static u8 node_id [ETH_ALEN]; 865b2fc499SJeff Garzik 875b2fc499SJeff Garzik static const char driver_name [] = "usbnet"; 885b2fc499SJeff Garzik 895b2fc499SJeff Garzik /* use ethtool to change the level for any given device */ 905b2fc499SJeff Garzik static int msg_level = -1; 915b2fc499SJeff Garzik module_param (msg_level, int, 0); 925b2fc499SJeff Garzik MODULE_PARM_DESC (msg_level, "Override default message level"); 935b2fc499SJeff Garzik 945b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 955b2fc499SJeff Garzik 965b2fc499SJeff Garzik /* handles CDC Ethernet and many other network "bulk data" interfaces */ 975b2fc499SJeff Garzik int usbnet_get_endpoints(struct usbnet *dev, struct usb_interface *intf) 985b2fc499SJeff Garzik { 995b2fc499SJeff Garzik int tmp; 1005b2fc499SJeff Garzik struct usb_host_interface *alt = NULL; 1015b2fc499SJeff Garzik struct usb_host_endpoint *in = NULL, *out = NULL; 1025b2fc499SJeff Garzik struct usb_host_endpoint *status = NULL; 1035b2fc499SJeff Garzik 1045b2fc499SJeff Garzik for (tmp = 0; tmp < intf->num_altsetting; tmp++) { 1055b2fc499SJeff Garzik unsigned ep; 1065b2fc499SJeff Garzik 1075b2fc499SJeff Garzik in = out = status = NULL; 1085b2fc499SJeff Garzik alt = intf->altsetting + tmp; 1095b2fc499SJeff Garzik 1105b2fc499SJeff Garzik /* take the first altsetting with in-bulk + out-bulk; 1115b2fc499SJeff Garzik * remember any status endpoint, just in case; 11270f23fd6SJustin P. Mattock * ignore other endpoints and altsettings. 1135b2fc499SJeff Garzik */ 1145b2fc499SJeff Garzik for (ep = 0; ep < alt->desc.bNumEndpoints; ep++) { 1155b2fc499SJeff Garzik struct usb_host_endpoint *e; 1165b2fc499SJeff Garzik int intr = 0; 1175b2fc499SJeff Garzik 1185b2fc499SJeff Garzik e = alt->endpoint + ep; 1195b2fc499SJeff Garzik switch (e->desc.bmAttributes) { 1205b2fc499SJeff Garzik case USB_ENDPOINT_XFER_INT: 1215b2fc499SJeff Garzik if (!usb_endpoint_dir_in(&e->desc)) 1225b2fc499SJeff Garzik continue; 1235b2fc499SJeff Garzik intr = 1; 1245b2fc499SJeff Garzik /* FALLTHROUGH */ 1255b2fc499SJeff Garzik case USB_ENDPOINT_XFER_BULK: 1265b2fc499SJeff Garzik break; 1275b2fc499SJeff Garzik default: 1285b2fc499SJeff Garzik continue; 1295b2fc499SJeff Garzik } 1305b2fc499SJeff Garzik if (usb_endpoint_dir_in(&e->desc)) { 1315b2fc499SJeff Garzik if (!intr && !in) 1325b2fc499SJeff Garzik in = e; 1335b2fc499SJeff Garzik else if (intr && !status) 1345b2fc499SJeff Garzik status = e; 1355b2fc499SJeff Garzik } else { 1365b2fc499SJeff Garzik if (!out) 1375b2fc499SJeff Garzik out = e; 1385b2fc499SJeff Garzik } 1395b2fc499SJeff Garzik } 1405b2fc499SJeff Garzik if (in && out) 1415b2fc499SJeff Garzik break; 1425b2fc499SJeff Garzik } 1435b2fc499SJeff Garzik if (!alt || !in || !out) 1445b2fc499SJeff Garzik return -EINVAL; 1455b2fc499SJeff Garzik 1468e95a202SJoe Perches if (alt->desc.bAlternateSetting != 0 || 1478e95a202SJoe Perches !(dev->driver_info->flags & FLAG_NO_SETINT)) { 1485b2fc499SJeff Garzik tmp = usb_set_interface (dev->udev, alt->desc.bInterfaceNumber, 1495b2fc499SJeff Garzik alt->desc.bAlternateSetting); 1505b2fc499SJeff Garzik if (tmp < 0) 1515b2fc499SJeff Garzik return tmp; 1525b2fc499SJeff Garzik } 1535b2fc499SJeff Garzik 1545b2fc499SJeff Garzik dev->in = usb_rcvbulkpipe (dev->udev, 1555b2fc499SJeff Garzik in->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK); 1565b2fc499SJeff Garzik dev->out = usb_sndbulkpipe (dev->udev, 1575b2fc499SJeff Garzik out->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK); 1585b2fc499SJeff Garzik dev->status = status; 1595b2fc499SJeff Garzik return 0; 1605b2fc499SJeff Garzik } 1615b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_endpoints); 1625b2fc499SJeff Garzik 16303ad032bSPeter Holik int usbnet_get_ethernet_addr(struct usbnet *dev, int iMACAddress) 16403ad032bSPeter Holik { 16503ad032bSPeter Holik int tmp, i; 16603ad032bSPeter Holik unsigned char buf [13]; 16703ad032bSPeter Holik 16803ad032bSPeter Holik tmp = usb_string(dev->udev, iMACAddress, buf, sizeof buf); 16903ad032bSPeter Holik if (tmp != 12) { 17003ad032bSPeter Holik dev_dbg(&dev->udev->dev, 17103ad032bSPeter Holik "bad MAC string %d fetch, %d\n", iMACAddress, tmp); 17203ad032bSPeter Holik if (tmp >= 0) 17303ad032bSPeter Holik tmp = -EINVAL; 17403ad032bSPeter Holik return tmp; 17503ad032bSPeter Holik } 17603ad032bSPeter Holik for (i = tmp = 0; i < 6; i++, tmp += 2) 17703ad032bSPeter Holik dev->net->dev_addr [i] = 178fd1f170dSAndy Shevchenko (hex_to_bin(buf[tmp]) << 4) + hex_to_bin(buf[tmp + 1]); 17903ad032bSPeter Holik return 0; 18003ad032bSPeter Holik } 18103ad032bSPeter Holik EXPORT_SYMBOL_GPL(usbnet_get_ethernet_addr); 18203ad032bSPeter Holik 18324ead299Stom.leiming@gmail.com static void intr_complete (struct urb *urb) 18424ead299Stom.leiming@gmail.com { 18524ead299Stom.leiming@gmail.com struct usbnet *dev = urb->context; 18624ead299Stom.leiming@gmail.com int status = urb->status; 18724ead299Stom.leiming@gmail.com 18824ead299Stom.leiming@gmail.com switch (status) { 18924ead299Stom.leiming@gmail.com /* success */ 19024ead299Stom.leiming@gmail.com case 0: 19124ead299Stom.leiming@gmail.com dev->driver_info->status(dev, urb); 19224ead299Stom.leiming@gmail.com break; 19324ead299Stom.leiming@gmail.com 19424ead299Stom.leiming@gmail.com /* software-driven interface shutdown */ 19524ead299Stom.leiming@gmail.com case -ENOENT: /* urb killed */ 19624ead299Stom.leiming@gmail.com case -ESHUTDOWN: /* hardware gone */ 19724ead299Stom.leiming@gmail.com netif_dbg(dev, ifdown, dev->net, 19824ead299Stom.leiming@gmail.com "intr shutdown, code %d\n", status); 19924ead299Stom.leiming@gmail.com return; 20024ead299Stom.leiming@gmail.com 20124ead299Stom.leiming@gmail.com /* NOTE: not throttling like RX/TX, since this endpoint 20224ead299Stom.leiming@gmail.com * already polls infrequently 20324ead299Stom.leiming@gmail.com */ 20424ead299Stom.leiming@gmail.com default: 20524ead299Stom.leiming@gmail.com netdev_dbg(dev->net, "intr status %d\n", status); 20624ead299Stom.leiming@gmail.com break; 20724ead299Stom.leiming@gmail.com } 20824ead299Stom.leiming@gmail.com 20924ead299Stom.leiming@gmail.com if (!netif_running (dev->net)) 21024ead299Stom.leiming@gmail.com return; 21124ead299Stom.leiming@gmail.com 21224ead299Stom.leiming@gmail.com status = usb_submit_urb (urb, GFP_ATOMIC); 21324ead299Stom.leiming@gmail.com if (status != 0) 21424ead299Stom.leiming@gmail.com netif_err(dev, timer, dev->net, 21524ead299Stom.leiming@gmail.com "intr resubmit --> %d\n", status); 21624ead299Stom.leiming@gmail.com } 2175b2fc499SJeff Garzik 2185b2fc499SJeff Garzik static int init_status (struct usbnet *dev, struct usb_interface *intf) 2195b2fc499SJeff Garzik { 2205b2fc499SJeff Garzik char *buf = NULL; 2215b2fc499SJeff Garzik unsigned pipe = 0; 2225b2fc499SJeff Garzik unsigned maxp; 2235b2fc499SJeff Garzik unsigned period; 2245b2fc499SJeff Garzik 2255b2fc499SJeff Garzik if (!dev->driver_info->status) 2265b2fc499SJeff Garzik return 0; 2275b2fc499SJeff Garzik 2285b2fc499SJeff Garzik pipe = usb_rcvintpipe (dev->udev, 2295b2fc499SJeff Garzik dev->status->desc.bEndpointAddress 2305b2fc499SJeff Garzik & USB_ENDPOINT_NUMBER_MASK); 2315b2fc499SJeff Garzik maxp = usb_maxpacket (dev->udev, pipe, 0); 2325b2fc499SJeff Garzik 2335b2fc499SJeff Garzik /* avoid 1 msec chatter: min 8 msec poll rate */ 2345b2fc499SJeff Garzik period = max ((int) dev->status->desc.bInterval, 2355b2fc499SJeff Garzik (dev->udev->speed == USB_SPEED_HIGH) ? 7 : 3); 2365b2fc499SJeff Garzik 2375b2fc499SJeff Garzik buf = kmalloc (maxp, GFP_KERNEL); 2385b2fc499SJeff Garzik if (buf) { 2395b2fc499SJeff Garzik dev->interrupt = usb_alloc_urb (0, GFP_KERNEL); 2405b2fc499SJeff Garzik if (!dev->interrupt) { 2415b2fc499SJeff Garzik kfree (buf); 2425b2fc499SJeff Garzik return -ENOMEM; 2435b2fc499SJeff Garzik } else { 2445b2fc499SJeff Garzik usb_fill_int_urb(dev->interrupt, dev->udev, pipe, 2455b2fc499SJeff Garzik buf, maxp, intr_complete, dev, period); 246720f3d7cStom.leiming@gmail.com dev->interrupt->transfer_flags |= URB_FREE_BUFFER; 2475b2fc499SJeff Garzik dev_dbg(&intf->dev, 2485b2fc499SJeff Garzik "status ep%din, %d bytes period %d\n", 2495b2fc499SJeff Garzik usb_pipeendpoint(pipe), maxp, period); 2505b2fc499SJeff Garzik } 2515b2fc499SJeff Garzik } 2525b2fc499SJeff Garzik return 0; 2535b2fc499SJeff Garzik } 2545b2fc499SJeff Garzik 2555b2fc499SJeff Garzik /* Passes this packet up the stack, updating its accounting. 2565b2fc499SJeff Garzik * Some link protocols batch packets, so their rx_fixup paths 2575b2fc499SJeff Garzik * can return clones as well as just modify the original skb. 2585b2fc499SJeff Garzik */ 2595b2fc499SJeff Garzik void usbnet_skb_return (struct usbnet *dev, struct sk_buff *skb) 2605b2fc499SJeff Garzik { 2615b2fc499SJeff Garzik int status; 2625b2fc499SJeff Garzik 2637834ddbcSJussi Kivilinna if (test_bit(EVENT_RX_PAUSED, &dev->flags)) { 2647834ddbcSJussi Kivilinna skb_queue_tail(&dev->rxq_pause, skb); 2657834ddbcSJussi Kivilinna return; 2667834ddbcSJussi Kivilinna } 2677834ddbcSJussi Kivilinna 2685b2fc499SJeff Garzik skb->protocol = eth_type_trans (skb, dev->net); 2697963837fSHerbert Xu dev->net->stats.rx_packets++; 2707963837fSHerbert Xu dev->net->stats.rx_bytes += skb->len; 2715b2fc499SJeff Garzik 272a475f603SJoe Perches netif_dbg(dev, rx_status, dev->net, "< rx, len %zu, type 0x%x\n", 2735b2fc499SJeff Garzik skb->len + sizeof (struct ethhdr), skb->protocol); 2745b2fc499SJeff Garzik memset (skb->cb, 0, sizeof (struct skb_data)); 275f9b491ecSMichael Riesch 276f9b491ecSMichael Riesch if (skb_defer_rx_timestamp(skb)) 277f9b491ecSMichael Riesch return; 278f9b491ecSMichael Riesch 2795b2fc499SJeff Garzik status = netif_rx (skb); 280a475f603SJoe Perches if (status != NET_RX_SUCCESS) 281a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, 282a475f603SJoe Perches "netif_rx status %d\n", status); 2835b2fc499SJeff Garzik } 2845b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_skb_return); 2855b2fc499SJeff Garzik 2865b2fc499SJeff Garzik 2875b2fc499SJeff Garzik /*------------------------------------------------------------------------- 2885b2fc499SJeff Garzik * 2895b2fc499SJeff Garzik * Network Device Driver (peer link to "Host Device", from USB host) 2905b2fc499SJeff Garzik * 2915b2fc499SJeff Garzik *-------------------------------------------------------------------------*/ 2925b2fc499SJeff Garzik 293777baa47SStephen Hemminger int usbnet_change_mtu (struct net_device *net, int new_mtu) 2945b2fc499SJeff Garzik { 2955b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 2965b2fc499SJeff Garzik int ll_mtu = new_mtu + net->hard_header_len; 2975b2fc499SJeff Garzik int old_hard_mtu = dev->hard_mtu; 2985b2fc499SJeff Garzik int old_rx_urb_size = dev->rx_urb_size; 2995b2fc499SJeff Garzik 3005b2fc499SJeff Garzik if (new_mtu <= 0) 3015b2fc499SJeff Garzik return -EINVAL; 3025b2fc499SJeff Garzik // no second zero-length packet read wanted after mtu-sized packets 3035b2fc499SJeff Garzik if ((ll_mtu % dev->maxpacket) == 0) 3045b2fc499SJeff Garzik return -EDOM; 3055b2fc499SJeff Garzik net->mtu = new_mtu; 3065b2fc499SJeff Garzik 3075b2fc499SJeff Garzik dev->hard_mtu = net->mtu + net->hard_header_len; 3085b2fc499SJeff Garzik if (dev->rx_urb_size == old_hard_mtu) { 3095b2fc499SJeff Garzik dev->rx_urb_size = dev->hard_mtu; 3105b2fc499SJeff Garzik if (dev->rx_urb_size > old_rx_urb_size) 3115b2fc499SJeff Garzik usbnet_unlink_rx_urbs(dev); 3125b2fc499SJeff Garzik } 3135b2fc499SJeff Garzik 3145b2fc499SJeff Garzik return 0; 3155b2fc499SJeff Garzik } 316777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_change_mtu); 3175b2fc499SJeff Garzik 3185b6e9bcdSMing Lei /* The caller must hold list->lock */ 3195b6e9bcdSMing Lei static void __usbnet_queue_skb(struct sk_buff_head *list, 3205b6e9bcdSMing Lei struct sk_buff *newsk, enum skb_state state) 3215b6e9bcdSMing Lei { 3225b6e9bcdSMing Lei struct skb_data *entry = (struct skb_data *) newsk->cb; 3235b6e9bcdSMing Lei 3245b6e9bcdSMing Lei __skb_queue_tail(list, newsk); 3255b6e9bcdSMing Lei entry->state = state; 3265b6e9bcdSMing Lei } 3275b6e9bcdSMing Lei 3285b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 3295b2fc499SJeff Garzik 3305b2fc499SJeff Garzik /* some LK 2.4 HCDs oopsed if we freed or resubmitted urbs from 3315b2fc499SJeff Garzik * completion callbacks. 2.5 should have fixed those bugs... 3325b2fc499SJeff Garzik */ 3335b2fc499SJeff Garzik 3345b6e9bcdSMing Lei static enum skb_state defer_bh(struct usbnet *dev, struct sk_buff *skb, 3355b6e9bcdSMing Lei struct sk_buff_head *list, enum skb_state state) 3365b2fc499SJeff Garzik { 3375b2fc499SJeff Garzik unsigned long flags; 3385b6e9bcdSMing Lei enum skb_state old_state; 3395b6e9bcdSMing Lei struct skb_data *entry = (struct skb_data *) skb->cb; 3405b2fc499SJeff Garzik 3415b2fc499SJeff Garzik spin_lock_irqsave(&list->lock, flags); 3425b6e9bcdSMing Lei old_state = entry->state; 3435b6e9bcdSMing Lei entry->state = state; 3445b2fc499SJeff Garzik __skb_unlink(skb, list); 3455b2fc499SJeff Garzik spin_unlock(&list->lock); 3465b2fc499SJeff Garzik spin_lock(&dev->done.lock); 3475b2fc499SJeff Garzik __skb_queue_tail(&dev->done, skb); 3485b2fc499SJeff Garzik if (dev->done.qlen == 1) 3495b2fc499SJeff Garzik tasklet_schedule(&dev->bh); 3505b2fc499SJeff Garzik spin_unlock_irqrestore(&dev->done.lock, flags); 3515b6e9bcdSMing Lei return old_state; 3525b2fc499SJeff Garzik } 3535b2fc499SJeff Garzik 3545b2fc499SJeff Garzik /* some work can't be done in tasklets, so we use keventd 3555b2fc499SJeff Garzik * 3565b2fc499SJeff Garzik * NOTE: annoying asymmetry: if it's active, schedule_work() fails, 3575b2fc499SJeff Garzik * but tasklet_schedule() doesn't. hope the failure is rare. 3585b2fc499SJeff Garzik */ 3595b2fc499SJeff Garzik void usbnet_defer_kevent (struct usbnet *dev, int work) 3605b2fc499SJeff Garzik { 3615b2fc499SJeff Garzik set_bit (work, &dev->flags); 3625b2fc499SJeff Garzik if (!schedule_work (&dev->kevent)) 36360b86755SJoe Perches netdev_err(dev->net, "kevent %d may have been dropped\n", work); 3645b2fc499SJeff Garzik else 36560b86755SJoe Perches netdev_dbg(dev->net, "kevent %d scheduled\n", work); 3665b2fc499SJeff Garzik } 3675b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_defer_kevent); 3685b2fc499SJeff Garzik 3695b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 3705b2fc499SJeff Garzik 3715b2fc499SJeff Garzik static void rx_complete (struct urb *urb); 3725b2fc499SJeff Garzik 373dacb3975SDavid S. Miller static int rx_submit (struct usbnet *dev, struct urb *urb, gfp_t flags) 3745b2fc499SJeff Garzik { 3755b2fc499SJeff Garzik struct sk_buff *skb; 3765b2fc499SJeff Garzik struct skb_data *entry; 3775b2fc499SJeff Garzik int retval = 0; 3785b2fc499SJeff Garzik unsigned long lockflags; 3795b2fc499SJeff Garzik size_t size = dev->rx_urb_size; 3805b2fc499SJeff Garzik 3817bdd4027SEric Dumazet skb = __netdev_alloc_skb_ip_align(dev->net, size, flags); 3827bdd4027SEric Dumazet if (!skb) { 383a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, "no rx skb\n"); 3845b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_RX_MEMORY); 3855b2fc499SJeff Garzik usb_free_urb (urb); 386dacb3975SDavid S. Miller return -ENOMEM; 3875b2fc499SJeff Garzik } 3885b2fc499SJeff Garzik 3895b2fc499SJeff Garzik entry = (struct skb_data *) skb->cb; 3905b2fc499SJeff Garzik entry->urb = urb; 3915b2fc499SJeff Garzik entry->dev = dev; 3925b2fc499SJeff Garzik entry->length = 0; 3935b2fc499SJeff Garzik 3945b2fc499SJeff Garzik usb_fill_bulk_urb (urb, dev->udev, dev->in, 3955b2fc499SJeff Garzik skb->data, size, rx_complete, skb); 3965b2fc499SJeff Garzik 3975b2fc499SJeff Garzik spin_lock_irqsave (&dev->rxq.lock, lockflags); 3985b2fc499SJeff Garzik 3998e95a202SJoe Perches if (netif_running (dev->net) && 4008e95a202SJoe Perches netif_device_present (dev->net) && 40169ee472fSOliver Neukum !test_bit (EVENT_RX_HALT, &dev->flags) && 40269ee472fSOliver Neukum !test_bit (EVENT_DEV_ASLEEP, &dev->flags)) { 4035b2fc499SJeff Garzik switch (retval = usb_submit_urb (urb, GFP_ATOMIC)) { 4045b2fc499SJeff Garzik case -EPIPE: 4055b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_RX_HALT); 4065b2fc499SJeff Garzik break; 4075b2fc499SJeff Garzik case -ENOMEM: 4085b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_RX_MEMORY); 4095b2fc499SJeff Garzik break; 4105b2fc499SJeff Garzik case -ENODEV: 411a475f603SJoe Perches netif_dbg(dev, ifdown, dev->net, "device gone\n"); 4125b2fc499SJeff Garzik netif_device_detach (dev->net); 4135b2fc499SJeff Garzik break; 414dacb3975SDavid S. Miller case -EHOSTUNREACH: 415dacb3975SDavid S. Miller retval = -ENOLINK; 416dacb3975SDavid S. Miller break; 4175b2fc499SJeff Garzik default: 418a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, 419a475f603SJoe Perches "rx submit, %d\n", retval); 4205b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 4215b2fc499SJeff Garzik break; 4225b2fc499SJeff Garzik case 0: 4235b6e9bcdSMing Lei __usbnet_queue_skb(&dev->rxq, skb, rx_start); 4245b2fc499SJeff Garzik } 4255b2fc499SJeff Garzik } else { 426a475f603SJoe Perches netif_dbg(dev, ifdown, dev->net, "rx: stopped\n"); 4275b2fc499SJeff Garzik retval = -ENOLINK; 4285b2fc499SJeff Garzik } 4295b2fc499SJeff Garzik spin_unlock_irqrestore (&dev->rxq.lock, lockflags); 4305b2fc499SJeff Garzik if (retval) { 4315b2fc499SJeff Garzik dev_kfree_skb_any (skb); 4325b2fc499SJeff Garzik usb_free_urb (urb); 4335b2fc499SJeff Garzik } 434dacb3975SDavid S. Miller return retval; 4355b2fc499SJeff Garzik } 4365b2fc499SJeff Garzik 4375b2fc499SJeff Garzik 4385b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 4395b2fc499SJeff Garzik 4405b2fc499SJeff Garzik static inline void rx_process (struct usbnet *dev, struct sk_buff *skb) 4415b2fc499SJeff Garzik { 4428e95a202SJoe Perches if (dev->driver_info->rx_fixup && 4437a635ea9SAndrzej Zaborowski !dev->driver_info->rx_fixup (dev, skb)) { 4447a635ea9SAndrzej Zaborowski /* With RX_ASSEMBLE, rx_fixup() must update counters */ 4457a635ea9SAndrzej Zaborowski if (!(dev->driver_info->flags & FLAG_RX_ASSEMBLE)) 4467a635ea9SAndrzej Zaborowski dev->net->stats.rx_errors++; 4477a635ea9SAndrzej Zaborowski goto done; 4487a635ea9SAndrzej Zaborowski } 4495b2fc499SJeff Garzik // else network stack removes extra byte if we forced a short packet 4505b2fc499SJeff Garzik 451073285fdSAlexey Orishko if (skb->len) { 452073285fdSAlexey Orishko /* all data was already cloned from skb inside the driver */ 453073285fdSAlexey Orishko if (dev->driver_info->flags & FLAG_MULTI_PACKET) 454073285fdSAlexey Orishko dev_kfree_skb_any(skb); 455073285fdSAlexey Orishko else 4565b2fc499SJeff Garzik usbnet_skb_return(dev, skb); 457073285fdSAlexey Orishko return; 458073285fdSAlexey Orishko } 459073285fdSAlexey Orishko 460a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, "drop\n"); 4617963837fSHerbert Xu dev->net->stats.rx_errors++; 4627a635ea9SAndrzej Zaborowski done: 4635b2fc499SJeff Garzik skb_queue_tail(&dev->done, skb); 4645b2fc499SJeff Garzik } 4655b2fc499SJeff Garzik 4665b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 4675b2fc499SJeff Garzik 4685b2fc499SJeff Garzik static void rx_complete (struct urb *urb) 4695b2fc499SJeff Garzik { 4705b2fc499SJeff Garzik struct sk_buff *skb = (struct sk_buff *) urb->context; 4715b2fc499SJeff Garzik struct skb_data *entry = (struct skb_data *) skb->cb; 4725b2fc499SJeff Garzik struct usbnet *dev = entry->dev; 4735b2fc499SJeff Garzik int urb_status = urb->status; 4745b6e9bcdSMing Lei enum skb_state state; 4755b2fc499SJeff Garzik 4765b2fc499SJeff Garzik skb_put (skb, urb->actual_length); 4775b6e9bcdSMing Lei state = rx_done; 4785b2fc499SJeff Garzik entry->urb = NULL; 4795b2fc499SJeff Garzik 4805b2fc499SJeff Garzik switch (urb_status) { 48118ab458fSDavid Brownell /* success */ 4825b2fc499SJeff Garzik case 0: 4835b2fc499SJeff Garzik if (skb->len < dev->net->hard_header_len) { 4845b6e9bcdSMing Lei state = rx_cleanup; 4857963837fSHerbert Xu dev->net->stats.rx_errors++; 4867963837fSHerbert Xu dev->net->stats.rx_length_errors++; 487a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, 488a475f603SJoe Perches "rx length %d\n", skb->len); 4895b2fc499SJeff Garzik } 4905b2fc499SJeff Garzik break; 4915b2fc499SJeff Garzik 49218ab458fSDavid Brownell /* stalls need manual reset. this is rare ... except that 49318ab458fSDavid Brownell * when going through USB 2.0 TTs, unplug appears this way. 4943ac49a1cSJean Delvare * we avoid the highspeed version of the ETIMEDOUT/EILSEQ 49518ab458fSDavid Brownell * storm, recovering as needed. 49618ab458fSDavid Brownell */ 4975b2fc499SJeff Garzik case -EPIPE: 4987963837fSHerbert Xu dev->net->stats.rx_errors++; 4995b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_RX_HALT); 5005b2fc499SJeff Garzik // FALLTHROUGH 5015b2fc499SJeff Garzik 50218ab458fSDavid Brownell /* software-driven interface shutdown */ 50318ab458fSDavid Brownell case -ECONNRESET: /* async unlink */ 50418ab458fSDavid Brownell case -ESHUTDOWN: /* hardware gone */ 505a475f603SJoe Perches netif_dbg(dev, ifdown, dev->net, 506a475f603SJoe Perches "rx shutdown, code %d\n", urb_status); 5075b2fc499SJeff Garzik goto block; 5085b2fc499SJeff Garzik 50918ab458fSDavid Brownell /* we get controller i/o faults during khubd disconnect() delays. 51018ab458fSDavid Brownell * throttle down resubmits, to avoid log floods; just temporarily, 51118ab458fSDavid Brownell * so we still recover when the fault isn't a khubd delay. 51218ab458fSDavid Brownell */ 5135b2fc499SJeff Garzik case -EPROTO: 5145b2fc499SJeff Garzik case -ETIME: 5155b2fc499SJeff Garzik case -EILSEQ: 5167963837fSHerbert Xu dev->net->stats.rx_errors++; 5175b2fc499SJeff Garzik if (!timer_pending (&dev->delay)) { 5185b2fc499SJeff Garzik mod_timer (&dev->delay, jiffies + THROTTLE_JIFFIES); 519a475f603SJoe Perches netif_dbg(dev, link, dev->net, 520a475f603SJoe Perches "rx throttle %d\n", urb_status); 5215b2fc499SJeff Garzik } 5225b2fc499SJeff Garzik block: 5235b6e9bcdSMing Lei state = rx_cleanup; 5245b2fc499SJeff Garzik entry->urb = urb; 5255b2fc499SJeff Garzik urb = NULL; 5265b2fc499SJeff Garzik break; 5275b2fc499SJeff Garzik 52818ab458fSDavid Brownell /* data overrun ... flush fifo? */ 5295b2fc499SJeff Garzik case -EOVERFLOW: 5307963837fSHerbert Xu dev->net->stats.rx_over_errors++; 5315b2fc499SJeff Garzik // FALLTHROUGH 5325b2fc499SJeff Garzik 5335b2fc499SJeff Garzik default: 5345b6e9bcdSMing Lei state = rx_cleanup; 5357963837fSHerbert Xu dev->net->stats.rx_errors++; 536a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, "rx status %d\n", urb_status); 5375b2fc499SJeff Garzik break; 5385b2fc499SJeff Garzik } 5395b2fc499SJeff Garzik 5405b6e9bcdSMing Lei state = defer_bh(dev, skb, &dev->rxq, state); 5415b2fc499SJeff Garzik 5425b2fc499SJeff Garzik if (urb) { 5438e95a202SJoe Perches if (netif_running (dev->net) && 5445b6e9bcdSMing Lei !test_bit (EVENT_RX_HALT, &dev->flags) && 5455b6e9bcdSMing Lei state != unlink_start) { 5465b2fc499SJeff Garzik rx_submit (dev, urb, GFP_ATOMIC); 5478a783354SOliver Neukum usb_mark_last_busy(dev->udev); 5485b2fc499SJeff Garzik return; 5495b2fc499SJeff Garzik } 5505b2fc499SJeff Garzik usb_free_urb (urb); 5515b2fc499SJeff Garzik } 552a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, "no read resubmitted\n"); 5535b2fc499SJeff Garzik } 5545b2fc499SJeff Garzik 5555b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 5567834ddbcSJussi Kivilinna void usbnet_pause_rx(struct usbnet *dev) 5577834ddbcSJussi Kivilinna { 5587834ddbcSJussi Kivilinna set_bit(EVENT_RX_PAUSED, &dev->flags); 5597834ddbcSJussi Kivilinna 560a475f603SJoe Perches netif_dbg(dev, rx_status, dev->net, "paused rx queue enabled\n"); 5617834ddbcSJussi Kivilinna } 5627834ddbcSJussi Kivilinna EXPORT_SYMBOL_GPL(usbnet_pause_rx); 5637834ddbcSJussi Kivilinna 5647834ddbcSJussi Kivilinna void usbnet_resume_rx(struct usbnet *dev) 5657834ddbcSJussi Kivilinna { 5667834ddbcSJussi Kivilinna struct sk_buff *skb; 5677834ddbcSJussi Kivilinna int num = 0; 5687834ddbcSJussi Kivilinna 5697834ddbcSJussi Kivilinna clear_bit(EVENT_RX_PAUSED, &dev->flags); 5707834ddbcSJussi Kivilinna 5717834ddbcSJussi Kivilinna while ((skb = skb_dequeue(&dev->rxq_pause)) != NULL) { 5727834ddbcSJussi Kivilinna usbnet_skb_return(dev, skb); 5737834ddbcSJussi Kivilinna num++; 5747834ddbcSJussi Kivilinna } 5757834ddbcSJussi Kivilinna 5767834ddbcSJussi Kivilinna tasklet_schedule(&dev->bh); 5777834ddbcSJussi Kivilinna 578a475f603SJoe Perches netif_dbg(dev, rx_status, dev->net, 579a475f603SJoe Perches "paused rx queue disabled, %d skbs requeued\n", num); 5807834ddbcSJussi Kivilinna } 5817834ddbcSJussi Kivilinna EXPORT_SYMBOL_GPL(usbnet_resume_rx); 5827834ddbcSJussi Kivilinna 5837834ddbcSJussi Kivilinna void usbnet_purge_paused_rxq(struct usbnet *dev) 5847834ddbcSJussi Kivilinna { 5857834ddbcSJussi Kivilinna skb_queue_purge(&dev->rxq_pause); 5867834ddbcSJussi Kivilinna } 5877834ddbcSJussi Kivilinna EXPORT_SYMBOL_GPL(usbnet_purge_paused_rxq); 5887834ddbcSJussi Kivilinna 5897834ddbcSJussi Kivilinna /*-------------------------------------------------------------------------*/ 5905b2fc499SJeff Garzik 5915b2fc499SJeff Garzik // unlink pending rx/tx; completion handlers do all other cleanup 5925b2fc499SJeff Garzik 5935b2fc499SJeff Garzik static int unlink_urbs (struct usbnet *dev, struct sk_buff_head *q) 5945b2fc499SJeff Garzik { 5955b2fc499SJeff Garzik unsigned long flags; 5965b6e9bcdSMing Lei struct sk_buff *skb; 5975b2fc499SJeff Garzik int count = 0; 5985b2fc499SJeff Garzik 5995b2fc499SJeff Garzik spin_lock_irqsave (&q->lock, flags); 6005b6e9bcdSMing Lei while (!skb_queue_empty(q)) { 6015b2fc499SJeff Garzik struct skb_data *entry; 6025b2fc499SJeff Garzik struct urb *urb; 6035b2fc499SJeff Garzik int retval; 6045b2fc499SJeff Garzik 6055b6e9bcdSMing Lei skb_queue_walk(q, skb) { 6065b2fc499SJeff Garzik entry = (struct skb_data *) skb->cb; 6075b6e9bcdSMing Lei if (entry->state != unlink_start) 6085b6e9bcdSMing Lei goto found; 6095b6e9bcdSMing Lei } 6105b6e9bcdSMing Lei break; 6115b6e9bcdSMing Lei found: 6125b6e9bcdSMing Lei entry->state = unlink_start; 6135b2fc499SJeff Garzik urb = entry->urb; 6145b2fc499SJeff Garzik 6150956a8c2Stom.leiming@gmail.com /* 6160956a8c2Stom.leiming@gmail.com * Get reference count of the URB to avoid it to be 6170956a8c2Stom.leiming@gmail.com * freed during usb_unlink_urb, which may trigger 6180956a8c2Stom.leiming@gmail.com * use-after-free problem inside usb_unlink_urb since 6190956a8c2Stom.leiming@gmail.com * usb_unlink_urb is always racing with .complete 6200956a8c2Stom.leiming@gmail.com * handler(include defer_bh). 6210956a8c2Stom.leiming@gmail.com */ 6220956a8c2Stom.leiming@gmail.com usb_get_urb(urb); 6234231d47eSSebastian Siewior spin_unlock_irqrestore(&q->lock, flags); 6245b2fc499SJeff Garzik // during some PM-driven resume scenarios, 6255b2fc499SJeff Garzik // these (async) unlinks complete immediately 6265b2fc499SJeff Garzik retval = usb_unlink_urb (urb); 6275b2fc499SJeff Garzik if (retval != -EINPROGRESS && retval != 0) 62860b86755SJoe Perches netdev_dbg(dev->net, "unlink urb err, %d\n", retval); 6295b2fc499SJeff Garzik else 6305b2fc499SJeff Garzik count++; 6310956a8c2Stom.leiming@gmail.com usb_put_urb(urb); 6324231d47eSSebastian Siewior spin_lock_irqsave(&q->lock, flags); 6335b2fc499SJeff Garzik } 6345b2fc499SJeff Garzik spin_unlock_irqrestore (&q->lock, flags); 6355b2fc499SJeff Garzik return count; 6365b2fc499SJeff Garzik } 6375b2fc499SJeff Garzik 6385b2fc499SJeff Garzik // Flush all pending rx urbs 6395b2fc499SJeff Garzik // minidrivers may need to do this when the MTU changes 6405b2fc499SJeff Garzik 6415b2fc499SJeff Garzik void usbnet_unlink_rx_urbs(struct usbnet *dev) 6425b2fc499SJeff Garzik { 6435b2fc499SJeff Garzik if (netif_running(dev->net)) { 6445b2fc499SJeff Garzik (void) unlink_urbs (dev, &dev->rxq); 6455b2fc499SJeff Garzik tasklet_schedule(&dev->bh); 6465b2fc499SJeff Garzik } 6475b2fc499SJeff Garzik } 6485b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_unlink_rx_urbs); 6495b2fc499SJeff Garzik 6505b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 6515b2fc499SJeff Garzik 6525b2fc499SJeff Garzik // precondition: never called in_interrupt 65369ee472fSOliver Neukum static void usbnet_terminate_urbs(struct usbnet *dev) 65469ee472fSOliver Neukum { 65569ee472fSOliver Neukum DECLARE_WAIT_QUEUE_HEAD_ONSTACK(unlink_wakeup); 65669ee472fSOliver Neukum DECLARE_WAITQUEUE(wait, current); 65769ee472fSOliver Neukum int temp; 65869ee472fSOliver Neukum 65969ee472fSOliver Neukum /* ensure there are no more active urbs */ 66069ee472fSOliver Neukum add_wait_queue(&unlink_wakeup, &wait); 66169ee472fSOliver Neukum set_current_state(TASK_UNINTERRUPTIBLE); 66269ee472fSOliver Neukum dev->wait = &unlink_wakeup; 66369ee472fSOliver Neukum temp = unlink_urbs(dev, &dev->txq) + 66469ee472fSOliver Neukum unlink_urbs(dev, &dev->rxq); 66569ee472fSOliver Neukum 66669ee472fSOliver Neukum /* maybe wait for deletions to finish. */ 66769ee472fSOliver Neukum while (!skb_queue_empty(&dev->rxq) 66869ee472fSOliver Neukum && !skb_queue_empty(&dev->txq) 66969ee472fSOliver Neukum && !skb_queue_empty(&dev->done)) { 67066cc42a4SKulikov Vasiliy schedule_timeout(msecs_to_jiffies(UNLINK_TIMEOUT_MS)); 67169ee472fSOliver Neukum set_current_state(TASK_UNINTERRUPTIBLE); 672a475f603SJoe Perches netif_dbg(dev, ifdown, dev->net, 673a475f603SJoe Perches "waited for %d urb completions\n", temp); 67469ee472fSOliver Neukum } 67569ee472fSOliver Neukum set_current_state(TASK_RUNNING); 67669ee472fSOliver Neukum dev->wait = NULL; 67769ee472fSOliver Neukum remove_wait_queue(&unlink_wakeup, &wait); 67869ee472fSOliver Neukum } 6795b2fc499SJeff Garzik 680777baa47SStephen Hemminger int usbnet_stop (struct net_device *net) 6815b2fc499SJeff Garzik { 6825b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 683a33e9e7fSJussi Kivilinna struct driver_info *info = dev->driver_info; 684a33e9e7fSJussi Kivilinna int retval; 6855b2fc499SJeff Garzik 68675bd0cbdSMing Lei clear_bit(EVENT_DEV_OPEN, &dev->flags); 6875b2fc499SJeff Garzik netif_stop_queue (net); 6885b2fc499SJeff Garzik 689a475f603SJoe Perches netif_info(dev, ifdown, dev->net, 6908ccef431SBen Hutchings "stop stats: rx/tx %lu/%lu, errs %lu/%lu\n", 6917963837fSHerbert Xu net->stats.rx_packets, net->stats.tx_packets, 69260b86755SJoe Perches net->stats.rx_errors, net->stats.tx_errors); 6935b2fc499SJeff Garzik 694a33e9e7fSJussi Kivilinna /* allow minidriver to stop correctly (wireless devices to turn off 695a33e9e7fSJussi Kivilinna * radio etc) */ 696a33e9e7fSJussi Kivilinna if (info->stop) { 697a33e9e7fSJussi Kivilinna retval = info->stop(dev); 698a475f603SJoe Perches if (retval < 0) 699a475f603SJoe Perches netif_info(dev, ifdown, dev->net, 70060b86755SJoe Perches "stop fail (%d) usbnet usb-%s-%s, %s\n", 701a33e9e7fSJussi Kivilinna retval, 702a33e9e7fSJussi Kivilinna dev->udev->bus->bus_name, dev->udev->devpath, 703a33e9e7fSJussi Kivilinna info->description); 704a33e9e7fSJussi Kivilinna } 705a33e9e7fSJussi Kivilinna 70669ee472fSOliver Neukum if (!(info->flags & FLAG_AVOID_UNLINK_URBS)) 70769ee472fSOliver Neukum usbnet_terminate_urbs(dev); 7085b2fc499SJeff Garzik 7095b2fc499SJeff Garzik usb_kill_urb(dev->interrupt); 7105b2fc499SJeff Garzik 7117834ddbcSJussi Kivilinna usbnet_purge_paused_rxq(dev); 7127834ddbcSJussi Kivilinna 7135b2fc499SJeff Garzik /* deferred work (task, timer, softirq) must also stop. 7145b2fc499SJeff Garzik * can't flush_scheduled_work() until we drop rtnl (later), 7155b2fc499SJeff Garzik * else workers could deadlock; so make workers a NOP. 7165b2fc499SJeff Garzik */ 7175b2fc499SJeff Garzik dev->flags = 0; 7185b2fc499SJeff Garzik del_timer_sync (&dev->delay); 7195b2fc499SJeff Garzik tasklet_kill (&dev->bh); 72069ee472fSOliver Neukum if (info->manage_power) 72169ee472fSOliver Neukum info->manage_power(dev, 0); 72269ee472fSOliver Neukum else 723a11a6544SOliver Neukum usb_autopm_put_interface(dev->intf); 7245b2fc499SJeff Garzik 7255b2fc499SJeff Garzik return 0; 7265b2fc499SJeff Garzik } 727777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_stop); 7285b2fc499SJeff Garzik 7295b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 7305b2fc499SJeff Garzik 7315b2fc499SJeff Garzik // posts reads, and enables write queuing 7325b2fc499SJeff Garzik 7335b2fc499SJeff Garzik // precondition: never called in_interrupt 7345b2fc499SJeff Garzik 735777baa47SStephen Hemminger int usbnet_open (struct net_device *net) 7365b2fc499SJeff Garzik { 7375b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 738a11a6544SOliver Neukum int retval; 7395b2fc499SJeff Garzik struct driver_info *info = dev->driver_info; 7405b2fc499SJeff Garzik 741a11a6544SOliver Neukum if ((retval = usb_autopm_get_interface(dev->intf)) < 0) { 742a475f603SJoe Perches netif_info(dev, ifup, dev->net, 74360b86755SJoe Perches "resumption fail (%d) usbnet usb-%s-%s, %s\n", 744a11a6544SOliver Neukum retval, 74560b86755SJoe Perches dev->udev->bus->bus_name, 74660b86755SJoe Perches dev->udev->devpath, 747a11a6544SOliver Neukum info->description); 748a11a6544SOliver Neukum goto done_nopm; 749a11a6544SOliver Neukum } 750a11a6544SOliver Neukum 7515b2fc499SJeff Garzik // put into "known safe" state 7525b2fc499SJeff Garzik if (info->reset && (retval = info->reset (dev)) < 0) { 753a475f603SJoe Perches netif_info(dev, ifup, dev->net, 75460b86755SJoe Perches "open reset fail (%d) usbnet usb-%s-%s, %s\n", 7555b2fc499SJeff Garzik retval, 75660b86755SJoe Perches dev->udev->bus->bus_name, 75760b86755SJoe Perches dev->udev->devpath, 7585b2fc499SJeff Garzik info->description); 7595b2fc499SJeff Garzik goto done; 7605b2fc499SJeff Garzik } 7615b2fc499SJeff Garzik 7625b2fc499SJeff Garzik // insist peer be connected 7635b2fc499SJeff Garzik if (info->check_connect && (retval = info->check_connect (dev)) < 0) { 764a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, "can't open; %d\n", retval); 7655b2fc499SJeff Garzik goto done; 7665b2fc499SJeff Garzik } 7675b2fc499SJeff Garzik 7685b2fc499SJeff Garzik /* start any status interrupt transfer */ 7695b2fc499SJeff Garzik if (dev->interrupt) { 7705b2fc499SJeff Garzik retval = usb_submit_urb (dev->interrupt, GFP_KERNEL); 7715b2fc499SJeff Garzik if (retval < 0) { 772a475f603SJoe Perches netif_err(dev, ifup, dev->net, 773a475f603SJoe Perches "intr submit %d\n", retval); 7745b2fc499SJeff Garzik goto done; 7755b2fc499SJeff Garzik } 7765b2fc499SJeff Garzik } 7775b2fc499SJeff Garzik 77868972efaSPaul Stewart set_bit(EVENT_DEV_OPEN, &dev->flags); 7795b2fc499SJeff Garzik netif_start_queue (net); 780a475f603SJoe Perches netif_info(dev, ifup, dev->net, 781a475f603SJoe Perches "open: enable queueing (rx %d, tx %d) mtu %d %s framing\n", 78260b86755SJoe Perches (int)RX_QLEN(dev), (int)TX_QLEN(dev), 783a475f603SJoe Perches dev->net->mtu, 784a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_NC) ? "NetChip" : 785a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_GL) ? "GeneSys" : 786a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_Z) ? "Zaurus" : 787a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_RN) ? "RNDIS" : 788a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_AX) ? "ASIX" : 789a475f603SJoe Perches "simple"); 7905b2fc499SJeff Garzik 7915b2fc499SJeff Garzik // delay posting reads until we're fully open 7925b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 79369ee472fSOliver Neukum if (info->manage_power) { 79469ee472fSOliver Neukum retval = info->manage_power(dev, 1); 79569ee472fSOliver Neukum if (retval < 0) 796fb13c47bSMing Lei goto done_manage_power_error; 79769ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 79869ee472fSOliver Neukum } 799a11a6544SOliver Neukum return retval; 800a475f603SJoe Perches 801fb13c47bSMing Lei done_manage_power_error: 802fb13c47bSMing Lei clear_bit(EVENT_DEV_OPEN, &dev->flags); 8035b2fc499SJeff Garzik done: 804a11a6544SOliver Neukum usb_autopm_put_interface(dev->intf); 805a11a6544SOliver Neukum done_nopm: 8065b2fc499SJeff Garzik return retval; 8075b2fc499SJeff Garzik } 808777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_open); 8095b2fc499SJeff Garzik 8105b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 8115b2fc499SJeff Garzik 8125b2fc499SJeff Garzik /* ethtool methods; minidrivers may need to add some more, but 8135b2fc499SJeff Garzik * they'll probably want to use this base set. 8145b2fc499SJeff Garzik */ 8155b2fc499SJeff Garzik 8165b2fc499SJeff Garzik int usbnet_get_settings (struct net_device *net, struct ethtool_cmd *cmd) 8175b2fc499SJeff Garzik { 8185b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 8195b2fc499SJeff Garzik 8205b2fc499SJeff Garzik if (!dev->mii.mdio_read) 8215b2fc499SJeff Garzik return -EOPNOTSUPP; 8225b2fc499SJeff Garzik 8235b2fc499SJeff Garzik return mii_ethtool_gset(&dev->mii, cmd); 8245b2fc499SJeff Garzik } 8255b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_settings); 8265b2fc499SJeff Garzik 8275b2fc499SJeff Garzik int usbnet_set_settings (struct net_device *net, struct ethtool_cmd *cmd) 8285b2fc499SJeff Garzik { 8295b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 8305b2fc499SJeff Garzik int retval; 8315b2fc499SJeff Garzik 8325b2fc499SJeff Garzik if (!dev->mii.mdio_write) 8335b2fc499SJeff Garzik return -EOPNOTSUPP; 8345b2fc499SJeff Garzik 8355b2fc499SJeff Garzik retval = mii_ethtool_sset(&dev->mii, cmd); 8365b2fc499SJeff Garzik 8375b2fc499SJeff Garzik /* link speed/duplex might have changed */ 8385b2fc499SJeff Garzik if (dev->driver_info->link_reset) 8395b2fc499SJeff Garzik dev->driver_info->link_reset(dev); 8405b2fc499SJeff Garzik 8415b2fc499SJeff Garzik return retval; 8425b2fc499SJeff Garzik 8435b2fc499SJeff Garzik } 8445b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_set_settings); 8455b2fc499SJeff Garzik 8465b2fc499SJeff Garzik u32 usbnet_get_link (struct net_device *net) 8475b2fc499SJeff Garzik { 8485b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 8495b2fc499SJeff Garzik 8505b2fc499SJeff Garzik /* If a check_connect is defined, return its result */ 8515b2fc499SJeff Garzik if (dev->driver_info->check_connect) 8525b2fc499SJeff Garzik return dev->driver_info->check_connect (dev) == 0; 8535b2fc499SJeff Garzik 8545b2fc499SJeff Garzik /* if the device has mii operations, use those */ 8555b2fc499SJeff Garzik if (dev->mii.mdio_read) 8565b2fc499SJeff Garzik return mii_link_ok(&dev->mii); 8575b2fc499SJeff Garzik 85805ffb3e2SBjørn Mork /* Otherwise, dtrt for drivers calling netif_carrier_{on,off} */ 85905ffb3e2SBjørn Mork return ethtool_op_get_link(net); 8605b2fc499SJeff Garzik } 8615b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_link); 8625b2fc499SJeff Garzik 8635b2fc499SJeff Garzik int usbnet_nway_reset(struct net_device *net) 8645b2fc499SJeff Garzik { 8655b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 8665b2fc499SJeff Garzik 8675b2fc499SJeff Garzik if (!dev->mii.mdio_write) 8685b2fc499SJeff Garzik return -EOPNOTSUPP; 8695b2fc499SJeff Garzik 8705b2fc499SJeff Garzik return mii_nway_restart(&dev->mii); 8715b2fc499SJeff Garzik } 8725b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_nway_reset); 8735b2fc499SJeff Garzik 8745b2fc499SJeff Garzik void usbnet_get_drvinfo (struct net_device *net, struct ethtool_drvinfo *info) 8755b2fc499SJeff Garzik { 8765b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 8775b2fc499SJeff Garzik 87886a2f415SPhil Sutter strlcpy (info->driver, dev->driver_name, sizeof info->driver); 87986a2f415SPhil Sutter strlcpy (info->version, DRIVER_VERSION, sizeof info->version); 88086a2f415SPhil Sutter strlcpy (info->fw_version, dev->driver_info->description, 8815b2fc499SJeff Garzik sizeof info->fw_version); 8825b2fc499SJeff Garzik usb_make_path (dev->udev, info->bus_info, sizeof info->bus_info); 8835b2fc499SJeff Garzik } 8845b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_drvinfo); 8855b2fc499SJeff Garzik 8865b2fc499SJeff Garzik u32 usbnet_get_msglevel (struct net_device *net) 8875b2fc499SJeff Garzik { 8885b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 8895b2fc499SJeff Garzik 8905b2fc499SJeff Garzik return dev->msg_enable; 8915b2fc499SJeff Garzik } 8925b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_msglevel); 8935b2fc499SJeff Garzik 8945b2fc499SJeff Garzik void usbnet_set_msglevel (struct net_device *net, u32 level) 8955b2fc499SJeff Garzik { 8965b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 8975b2fc499SJeff Garzik 8985b2fc499SJeff Garzik dev->msg_enable = level; 8995b2fc499SJeff Garzik } 9005b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_set_msglevel); 9015b2fc499SJeff Garzik 9025b2fc499SJeff Garzik /* drivers may override default ethtool_ops in their bind() routine */ 9030fc0b732SStephen Hemminger static const struct ethtool_ops usbnet_ethtool_ops = { 9045b2fc499SJeff Garzik .get_settings = usbnet_get_settings, 9055b2fc499SJeff Garzik .set_settings = usbnet_set_settings, 9065b2fc499SJeff Garzik .get_link = usbnet_get_link, 9075b2fc499SJeff Garzik .nway_reset = usbnet_nway_reset, 9085b2fc499SJeff Garzik .get_drvinfo = usbnet_get_drvinfo, 9095b2fc499SJeff Garzik .get_msglevel = usbnet_get_msglevel, 9105b2fc499SJeff Garzik .set_msglevel = usbnet_set_msglevel, 911123edb18SRichard Cochran .get_ts_info = ethtool_op_get_ts_info, 9125b2fc499SJeff Garzik }; 9135b2fc499SJeff Garzik 9145b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 9155b2fc499SJeff Garzik 9165b2fc499SJeff Garzik /* work that cannot be done in interrupt context uses keventd. 9175b2fc499SJeff Garzik * 9185b2fc499SJeff Garzik * NOTE: with 2.5 we could do more of this using completion callbacks, 9195b2fc499SJeff Garzik * especially now that control transfers can be queued. 9205b2fc499SJeff Garzik */ 9215b2fc499SJeff Garzik static void 9225b2fc499SJeff Garzik kevent (struct work_struct *work) 9235b2fc499SJeff Garzik { 9245b2fc499SJeff Garzik struct usbnet *dev = 9255b2fc499SJeff Garzik container_of(work, struct usbnet, kevent); 9265b2fc499SJeff Garzik int status; 9275b2fc499SJeff Garzik 9285b2fc499SJeff Garzik /* usb_clear_halt() needs a thread context */ 9295b2fc499SJeff Garzik if (test_bit (EVENT_TX_HALT, &dev->flags)) { 9305b2fc499SJeff Garzik unlink_urbs (dev, &dev->txq); 93169ee472fSOliver Neukum status = usb_autopm_get_interface(dev->intf); 93269ee472fSOliver Neukum if (status < 0) 93369ee472fSOliver Neukum goto fail_pipe; 9345b2fc499SJeff Garzik status = usb_clear_halt (dev->udev, dev->out); 93569ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 9368e95a202SJoe Perches if (status < 0 && 9378e95a202SJoe Perches status != -EPIPE && 9388e95a202SJoe Perches status != -ESHUTDOWN) { 9395b2fc499SJeff Garzik if (netif_msg_tx_err (dev)) 94069ee472fSOliver Neukum fail_pipe: 94160b86755SJoe Perches netdev_err(dev->net, "can't clear tx halt, status %d\n", 9425b2fc499SJeff Garzik status); 9435b2fc499SJeff Garzik } else { 9445b2fc499SJeff Garzik clear_bit (EVENT_TX_HALT, &dev->flags); 9455b2fc499SJeff Garzik if (status != -ESHUTDOWN) 9465b2fc499SJeff Garzik netif_wake_queue (dev->net); 9475b2fc499SJeff Garzik } 9485b2fc499SJeff Garzik } 9495b2fc499SJeff Garzik if (test_bit (EVENT_RX_HALT, &dev->flags)) { 9505b2fc499SJeff Garzik unlink_urbs (dev, &dev->rxq); 95169ee472fSOliver Neukum status = usb_autopm_get_interface(dev->intf); 95269ee472fSOliver Neukum if (status < 0) 95369ee472fSOliver Neukum goto fail_halt; 9545b2fc499SJeff Garzik status = usb_clear_halt (dev->udev, dev->in); 95569ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 9568e95a202SJoe Perches if (status < 0 && 9578e95a202SJoe Perches status != -EPIPE && 9588e95a202SJoe Perches status != -ESHUTDOWN) { 9595b2fc499SJeff Garzik if (netif_msg_rx_err (dev)) 96069ee472fSOliver Neukum fail_halt: 96160b86755SJoe Perches netdev_err(dev->net, "can't clear rx halt, status %d\n", 9625b2fc499SJeff Garzik status); 9635b2fc499SJeff Garzik } else { 9645b2fc499SJeff Garzik clear_bit (EVENT_RX_HALT, &dev->flags); 9655b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 9665b2fc499SJeff Garzik } 9675b2fc499SJeff Garzik } 9685b2fc499SJeff Garzik 9695b2fc499SJeff Garzik /* tasklet could resubmit itself forever if memory is tight */ 9705b2fc499SJeff Garzik if (test_bit (EVENT_RX_MEMORY, &dev->flags)) { 9715b2fc499SJeff Garzik struct urb *urb = NULL; 972dacb3975SDavid S. Miller int resched = 1; 9735b2fc499SJeff Garzik 9745b2fc499SJeff Garzik if (netif_running (dev->net)) 9755b2fc499SJeff Garzik urb = usb_alloc_urb (0, GFP_KERNEL); 9765b2fc499SJeff Garzik else 9775b2fc499SJeff Garzik clear_bit (EVENT_RX_MEMORY, &dev->flags); 9785b2fc499SJeff Garzik if (urb != NULL) { 9795b2fc499SJeff Garzik clear_bit (EVENT_RX_MEMORY, &dev->flags); 98069ee472fSOliver Neukum status = usb_autopm_get_interface(dev->intf); 981ab60707fSJesper Juhl if (status < 0) { 982ab60707fSJesper Juhl usb_free_urb(urb); 98369ee472fSOliver Neukum goto fail_lowmem; 984ab60707fSJesper Juhl } 985dacb3975SDavid S. Miller if (rx_submit (dev, urb, GFP_KERNEL) == -ENOLINK) 986dacb3975SDavid S. Miller resched = 0; 98769ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 98869ee472fSOliver Neukum fail_lowmem: 989dacb3975SDavid S. Miller if (resched) 9905b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 9915b2fc499SJeff Garzik } 9925b2fc499SJeff Garzik } 9935b2fc499SJeff Garzik 9945b2fc499SJeff Garzik if (test_bit (EVENT_LINK_RESET, &dev->flags)) { 9955b2fc499SJeff Garzik struct driver_info *info = dev->driver_info; 9965b2fc499SJeff Garzik int retval = 0; 9975b2fc499SJeff Garzik 9985b2fc499SJeff Garzik clear_bit (EVENT_LINK_RESET, &dev->flags); 99969ee472fSOliver Neukum status = usb_autopm_get_interface(dev->intf); 100069ee472fSOliver Neukum if (status < 0) 100169ee472fSOliver Neukum goto skip_reset; 10025b2fc499SJeff Garzik if(info->link_reset && (retval = info->link_reset(dev)) < 0) { 100369ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 100469ee472fSOliver Neukum skip_reset: 100560b86755SJoe Perches netdev_info(dev->net, "link reset failed (%d) usbnet usb-%s-%s, %s\n", 10065b2fc499SJeff Garzik retval, 100760b86755SJoe Perches dev->udev->bus->bus_name, 100860b86755SJoe Perches dev->udev->devpath, 10095b2fc499SJeff Garzik info->description); 101069ee472fSOliver Neukum } else { 101169ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 10125b2fc499SJeff Garzik } 10135b2fc499SJeff Garzik } 10145b2fc499SJeff Garzik 10155b2fc499SJeff Garzik if (dev->flags) 101660b86755SJoe Perches netdev_dbg(dev->net, "kevent done, flags = 0x%lx\n", dev->flags); 10175b2fc499SJeff Garzik } 10185b2fc499SJeff Garzik 10195b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 10205b2fc499SJeff Garzik 10215b2fc499SJeff Garzik static void tx_complete (struct urb *urb) 10225b2fc499SJeff Garzik { 10235b2fc499SJeff Garzik struct sk_buff *skb = (struct sk_buff *) urb->context; 10245b2fc499SJeff Garzik struct skb_data *entry = (struct skb_data *) skb->cb; 10255b2fc499SJeff Garzik struct usbnet *dev = entry->dev; 10265b2fc499SJeff Garzik 10275b2fc499SJeff Garzik if (urb->status == 0) { 1028073285fdSAlexey Orishko if (!(dev->driver_info->flags & FLAG_MULTI_PACKET)) 10297963837fSHerbert Xu dev->net->stats.tx_packets++; 10307963837fSHerbert Xu dev->net->stats.tx_bytes += entry->length; 10315b2fc499SJeff Garzik } else { 10327963837fSHerbert Xu dev->net->stats.tx_errors++; 10335b2fc499SJeff Garzik 10345b2fc499SJeff Garzik switch (urb->status) { 10355b2fc499SJeff Garzik case -EPIPE: 10365b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_TX_HALT); 10375b2fc499SJeff Garzik break; 10385b2fc499SJeff Garzik 10395b2fc499SJeff Garzik /* software-driven interface shutdown */ 10405b2fc499SJeff Garzik case -ECONNRESET: // async unlink 10415b2fc499SJeff Garzik case -ESHUTDOWN: // hardware gone 10425b2fc499SJeff Garzik break; 10435b2fc499SJeff Garzik 10445b2fc499SJeff Garzik // like rx, tx gets controller i/o faults during khubd delays 10455b2fc499SJeff Garzik // and so it uses the same throttling mechanism. 10465b2fc499SJeff Garzik case -EPROTO: 10475b2fc499SJeff Garzik case -ETIME: 10485b2fc499SJeff Garzik case -EILSEQ: 104969ee472fSOliver Neukum usb_mark_last_busy(dev->udev); 10505b2fc499SJeff Garzik if (!timer_pending (&dev->delay)) { 10515b2fc499SJeff Garzik mod_timer (&dev->delay, 10525b2fc499SJeff Garzik jiffies + THROTTLE_JIFFIES); 1053a475f603SJoe Perches netif_dbg(dev, link, dev->net, 1054a475f603SJoe Perches "tx throttle %d\n", urb->status); 10555b2fc499SJeff Garzik } 10565b2fc499SJeff Garzik netif_stop_queue (dev->net); 10575b2fc499SJeff Garzik break; 10585b2fc499SJeff Garzik default: 1059a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, 1060a475f603SJoe Perches "tx err %d\n", entry->urb->status); 10615b2fc499SJeff Garzik break; 10625b2fc499SJeff Garzik } 10635b2fc499SJeff Garzik } 10645b2fc499SJeff Garzik 106569ee472fSOliver Neukum usb_autopm_put_interface_async(dev->intf); 10665b6e9bcdSMing Lei (void) defer_bh(dev, skb, &dev->txq, tx_done); 10675b2fc499SJeff Garzik } 10685b2fc499SJeff Garzik 10695b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 10705b2fc499SJeff Garzik 1071777baa47SStephen Hemminger void usbnet_tx_timeout (struct net_device *net) 10725b2fc499SJeff Garzik { 10735b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 10745b2fc499SJeff Garzik 10755b2fc499SJeff Garzik unlink_urbs (dev, &dev->txq); 10765b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 10775b2fc499SJeff Garzik 10785b2fc499SJeff Garzik // FIXME: device recovery -- reset? 10795b2fc499SJeff Garzik } 1080777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_tx_timeout); 10815b2fc499SJeff Garzik 10825b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 10835b2fc499SJeff Garzik 108425a79c41SStephen Hemminger netdev_tx_t usbnet_start_xmit (struct sk_buff *skb, 108525a79c41SStephen Hemminger struct net_device *net) 10865b2fc499SJeff Garzik { 10875b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 10885b2fc499SJeff Garzik int length; 10895b2fc499SJeff Garzik struct urb *urb = NULL; 10905b2fc499SJeff Garzik struct skb_data *entry; 10915b2fc499SJeff Garzik struct driver_info *info = dev->driver_info; 10925b2fc499SJeff Garzik unsigned long flags; 109325a79c41SStephen Hemminger int retval; 10945b2fc499SJeff Garzik 109523ba0799SKonstantin Khlebnikov if (skb) 1096f9b491ecSMichael Riesch skb_tx_timestamp(skb); 1097f9b491ecSMichael Riesch 10985b2fc499SJeff Garzik // some devices want funky USB-level framing, for 10995b2fc499SJeff Garzik // win32 driver (usually) and/or hardware quirks 11005b2fc499SJeff Garzik if (info->tx_fixup) { 11015b2fc499SJeff Garzik skb = info->tx_fixup (dev, skb, GFP_ATOMIC); 11025b2fc499SJeff Garzik if (!skb) { 1103073285fdSAlexey Orishko if (netif_msg_tx_err(dev)) { 1104a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, "can't tx_fixup skb\n"); 11055b2fc499SJeff Garzik goto drop; 1106073285fdSAlexey Orishko } else { 1107073285fdSAlexey Orishko /* cdc_ncm collected packet; waits for more */ 1108073285fdSAlexey Orishko goto not_drop; 1109073285fdSAlexey Orishko } 11105b2fc499SJeff Garzik } 11115b2fc499SJeff Garzik } 11125b2fc499SJeff Garzik length = skb->len; 11135b2fc499SJeff Garzik 11145b2fc499SJeff Garzik if (!(urb = usb_alloc_urb (0, GFP_ATOMIC))) { 1115a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, "no urb\n"); 11165b2fc499SJeff Garzik goto drop; 11175b2fc499SJeff Garzik } 11185b2fc499SJeff Garzik 11195b2fc499SJeff Garzik entry = (struct skb_data *) skb->cb; 11205b2fc499SJeff Garzik entry->urb = urb; 11215b2fc499SJeff Garzik entry->dev = dev; 11225b2fc499SJeff Garzik entry->length = length; 11235b2fc499SJeff Garzik 11245b2fc499SJeff Garzik usb_fill_bulk_urb (urb, dev->udev, dev->out, 11255b2fc499SJeff Garzik skb->data, skb->len, tx_complete, skb); 11265b2fc499SJeff Garzik 11275b2fc499SJeff Garzik /* don't assume the hardware handles USB_ZERO_PACKET 11285b2fc499SJeff Garzik * NOTE: strictly conforming cdc-ether devices should expect 11295b2fc499SJeff Garzik * the ZLP here, but ignore the one-byte packet. 1130073285fdSAlexey Orishko * NOTE2: CDC NCM specification is different from CDC ECM when 1131073285fdSAlexey Orishko * handling ZLP/short packets, so cdc_ncm driver will make short 1132073285fdSAlexey Orishko * packet itself if needed. 11335b2fc499SJeff Garzik */ 1134b4d562e3SElina Pasheva if (length % dev->maxpacket == 0) { 1135b4d562e3SElina Pasheva if (!(info->flags & FLAG_SEND_ZLP)) { 1136073285fdSAlexey Orishko if (!(info->flags & FLAG_MULTI_PACKET)) { 11375b2fc499SJeff Garzik urb->transfer_buffer_length++; 11383e323f3eSPeter Korsgaard if (skb_tailroom(skb)) { 11393e323f3eSPeter Korsgaard skb->data[skb->len] = 0; 11403e323f3eSPeter Korsgaard __skb_put(skb, 1); 11413e323f3eSPeter Korsgaard } 1142073285fdSAlexey Orishko } 1143b4d562e3SElina Pasheva } else 1144b4d562e3SElina Pasheva urb->transfer_flags |= URB_ZERO_PACKET; 11453e323f3eSPeter Korsgaard } 11465b2fc499SJeff Garzik 11475b2fc499SJeff Garzik spin_lock_irqsave(&dev->txq.lock, flags); 114869ee472fSOliver Neukum retval = usb_autopm_get_interface_async(dev->intf); 114969ee472fSOliver Neukum if (retval < 0) { 115069ee472fSOliver Neukum spin_unlock_irqrestore(&dev->txq.lock, flags); 115169ee472fSOliver Neukum goto drop; 115269ee472fSOliver Neukum } 115369ee472fSOliver Neukum 115469ee472fSOliver Neukum #ifdef CONFIG_PM 115569ee472fSOliver Neukum /* if this triggers the device is still a sleep */ 115669ee472fSOliver Neukum if (test_bit(EVENT_DEV_ASLEEP, &dev->flags)) { 115769ee472fSOliver Neukum /* transmission will be done in resume */ 115869ee472fSOliver Neukum usb_anchor_urb(urb, &dev->deferred); 115969ee472fSOliver Neukum /* no use to process more packets */ 116069ee472fSOliver Neukum netif_stop_queue(net); 116169ee472fSOliver Neukum spin_unlock_irqrestore(&dev->txq.lock, flags); 116260b86755SJoe Perches netdev_dbg(dev->net, "Delaying transmission for resumption\n"); 116369ee472fSOliver Neukum goto deferred; 116469ee472fSOliver Neukum } 116569ee472fSOliver Neukum #endif 11665b2fc499SJeff Garzik 11675b2fc499SJeff Garzik switch ((retval = usb_submit_urb (urb, GFP_ATOMIC))) { 11685b2fc499SJeff Garzik case -EPIPE: 11695b2fc499SJeff Garzik netif_stop_queue (net); 11705b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_TX_HALT); 117169ee472fSOliver Neukum usb_autopm_put_interface_async(dev->intf); 11725b2fc499SJeff Garzik break; 11735b2fc499SJeff Garzik default: 117469ee472fSOliver Neukum usb_autopm_put_interface_async(dev->intf); 1175a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, 1176a475f603SJoe Perches "tx: submit urb err %d\n", retval); 11775b2fc499SJeff Garzik break; 11785b2fc499SJeff Garzik case 0: 11795b2fc499SJeff Garzik net->trans_start = jiffies; 11805b6e9bcdSMing Lei __usbnet_queue_skb(&dev->txq, skb, tx_start); 11815b2fc499SJeff Garzik if (dev->txq.qlen >= TX_QLEN (dev)) 11825b2fc499SJeff Garzik netif_stop_queue (net); 11835b2fc499SJeff Garzik } 11845b2fc499SJeff Garzik spin_unlock_irqrestore (&dev->txq.lock, flags); 11855b2fc499SJeff Garzik 11865b2fc499SJeff Garzik if (retval) { 1187a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, "drop, code %d\n", retval); 11885b2fc499SJeff Garzik drop: 11897963837fSHerbert Xu dev->net->stats.tx_dropped++; 1190073285fdSAlexey Orishko not_drop: 11915b2fc499SJeff Garzik if (skb) 11925b2fc499SJeff Garzik dev_kfree_skb_any (skb); 11935b2fc499SJeff Garzik usb_free_urb (urb); 1194a475f603SJoe Perches } else 1195a475f603SJoe Perches netif_dbg(dev, tx_queued, dev->net, 1196a475f603SJoe Perches "> tx, len %d, type 0x%x\n", length, skb->protocol); 119769ee472fSOliver Neukum #ifdef CONFIG_PM 119869ee472fSOliver Neukum deferred: 119969ee472fSOliver Neukum #endif 120025a79c41SStephen Hemminger return NETDEV_TX_OK; 12015b2fc499SJeff Garzik } 1202777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_start_xmit); 12035b2fc499SJeff Garzik 120485e87870SBjørn Mork static int rx_alloc_submit(struct usbnet *dev, gfp_t flags) 120565841fd5SMing Lei { 120665841fd5SMing Lei struct urb *urb; 120765841fd5SMing Lei int i; 120885e87870SBjørn Mork int ret = 0; 120965841fd5SMing Lei 121065841fd5SMing Lei /* don't refill the queue all at once */ 121165841fd5SMing Lei for (i = 0; i < 10 && dev->rxq.qlen < RX_QLEN(dev); i++) { 121265841fd5SMing Lei urb = usb_alloc_urb(0, flags); 121365841fd5SMing Lei if (urb != NULL) { 121485e87870SBjørn Mork ret = rx_submit(dev, urb, flags); 121585e87870SBjørn Mork if (ret) 121685e87870SBjørn Mork goto err; 121785e87870SBjørn Mork } else { 121885e87870SBjørn Mork ret = -ENOMEM; 121985e87870SBjørn Mork goto err; 122065841fd5SMing Lei } 122165841fd5SMing Lei } 122285e87870SBjørn Mork err: 122385e87870SBjørn Mork return ret; 122465841fd5SMing Lei } 122565841fd5SMing Lei 12265b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 12275b2fc499SJeff Garzik 12285b2fc499SJeff Garzik // tasklet (work deferred from completions, in_irq) or timer 12295b2fc499SJeff Garzik 12305b2fc499SJeff Garzik static void usbnet_bh (unsigned long param) 12315b2fc499SJeff Garzik { 12325b2fc499SJeff Garzik struct usbnet *dev = (struct usbnet *) param; 12335b2fc499SJeff Garzik struct sk_buff *skb; 12345b2fc499SJeff Garzik struct skb_data *entry; 12355b2fc499SJeff Garzik 12365b2fc499SJeff Garzik while ((skb = skb_dequeue (&dev->done))) { 12375b2fc499SJeff Garzik entry = (struct skb_data *) skb->cb; 12385b2fc499SJeff Garzik switch (entry->state) { 12395b2fc499SJeff Garzik case rx_done: 12405b2fc499SJeff Garzik entry->state = rx_cleanup; 12415b2fc499SJeff Garzik rx_process (dev, skb); 12425b2fc499SJeff Garzik continue; 12435b2fc499SJeff Garzik case tx_done: 12445b2fc499SJeff Garzik case rx_cleanup: 12455b2fc499SJeff Garzik usb_free_urb (entry->urb); 12465b2fc499SJeff Garzik dev_kfree_skb (skb); 12475b2fc499SJeff Garzik continue; 12485b2fc499SJeff Garzik default: 124960b86755SJoe Perches netdev_dbg(dev->net, "bogus skb state %d\n", entry->state); 12505b2fc499SJeff Garzik } 12515b2fc499SJeff Garzik } 12525b2fc499SJeff Garzik 12535b2fc499SJeff Garzik // waiting for all pending urbs to complete? 12545b2fc499SJeff Garzik if (dev->wait) { 12555b2fc499SJeff Garzik if ((dev->txq.qlen + dev->rxq.qlen + dev->done.qlen) == 0) { 12565b2fc499SJeff Garzik wake_up (dev->wait); 12575b2fc499SJeff Garzik } 12585b2fc499SJeff Garzik 12595b2fc499SJeff Garzik // or are we maybe short a few urbs? 12608e95a202SJoe Perches } else if (netif_running (dev->net) && 12618e95a202SJoe Perches netif_device_present (dev->net) && 12628e95a202SJoe Perches !timer_pending (&dev->delay) && 12638e95a202SJoe Perches !test_bit (EVENT_RX_HALT, &dev->flags)) { 12645b2fc499SJeff Garzik int temp = dev->rxq.qlen; 12655b2fc499SJeff Garzik 126665841fd5SMing Lei if (temp < RX_QLEN(dev)) { 126785e87870SBjørn Mork if (rx_alloc_submit(dev, GFP_ATOMIC) == -ENOLINK) 126885e87870SBjørn Mork return; 1269a475f603SJoe Perches if (temp != dev->rxq.qlen) 1270a475f603SJoe Perches netif_dbg(dev, link, dev->net, 1271a475f603SJoe Perches "rxqlen %d --> %d\n", 12725b2fc499SJeff Garzik temp, dev->rxq.qlen); 127365841fd5SMing Lei if (dev->rxq.qlen < RX_QLEN(dev)) 12745b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 12755b2fc499SJeff Garzik } 12765b2fc499SJeff Garzik if (dev->txq.qlen < TX_QLEN (dev)) 12775b2fc499SJeff Garzik netif_wake_queue (dev->net); 12785b2fc499SJeff Garzik } 12795b2fc499SJeff Garzik } 12805b2fc499SJeff Garzik 12815b2fc499SJeff Garzik 12825b2fc499SJeff Garzik /*------------------------------------------------------------------------- 12835b2fc499SJeff Garzik * 12845b2fc499SJeff Garzik * USB Device Driver support 12855b2fc499SJeff Garzik * 12865b2fc499SJeff Garzik *-------------------------------------------------------------------------*/ 12875b2fc499SJeff Garzik 12885b2fc499SJeff Garzik // precondition: never called in_interrupt 12895b2fc499SJeff Garzik 12905b2fc499SJeff Garzik void usbnet_disconnect (struct usb_interface *intf) 12915b2fc499SJeff Garzik { 12925b2fc499SJeff Garzik struct usbnet *dev; 12935b2fc499SJeff Garzik struct usb_device *xdev; 12945b2fc499SJeff Garzik struct net_device *net; 12955b2fc499SJeff Garzik 12965b2fc499SJeff Garzik dev = usb_get_intfdata(intf); 12975b2fc499SJeff Garzik usb_set_intfdata(intf, NULL); 12985b2fc499SJeff Garzik if (!dev) 12995b2fc499SJeff Garzik return; 13005b2fc499SJeff Garzik 13015b2fc499SJeff Garzik xdev = interface_to_usbdev (intf); 13025b2fc499SJeff Garzik 1303a475f603SJoe Perches netif_info(dev, probe, dev->net, "unregister '%s' usb-%s-%s, %s\n", 13045b2fc499SJeff Garzik intf->dev.driver->name, 13055b2fc499SJeff Garzik xdev->bus->bus_name, xdev->devpath, 13065b2fc499SJeff Garzik dev->driver_info->description); 13075b2fc499SJeff Garzik 13085b2fc499SJeff Garzik net = dev->net; 13095b2fc499SJeff Garzik unregister_netdev (net); 13105b2fc499SJeff Garzik 131123f333a2STejun Heo cancel_work_sync(&dev->kevent); 13125b2fc499SJeff Garzik 13135b2fc499SJeff Garzik if (dev->driver_info->unbind) 13145b2fc499SJeff Garzik dev->driver_info->unbind (dev, intf); 13155b2fc499SJeff Garzik 131668972efaSPaul Stewart usb_kill_urb(dev->interrupt); 131768972efaSPaul Stewart usb_free_urb(dev->interrupt); 131868972efaSPaul Stewart 13195b2fc499SJeff Garzik free_netdev(net); 13205b2fc499SJeff Garzik } 13215b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_disconnect); 13225b2fc499SJeff Garzik 1323777baa47SStephen Hemminger static const struct net_device_ops usbnet_netdev_ops = { 1324777baa47SStephen Hemminger .ndo_open = usbnet_open, 1325777baa47SStephen Hemminger .ndo_stop = usbnet_stop, 1326777baa47SStephen Hemminger .ndo_start_xmit = usbnet_start_xmit, 1327777baa47SStephen Hemminger .ndo_tx_timeout = usbnet_tx_timeout, 1328777baa47SStephen Hemminger .ndo_change_mtu = usbnet_change_mtu, 1329777baa47SStephen Hemminger .ndo_set_mac_address = eth_mac_addr, 1330777baa47SStephen Hemminger .ndo_validate_addr = eth_validate_addr, 1331777baa47SStephen Hemminger }; 13325b2fc499SJeff Garzik 13335b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 13345b2fc499SJeff Garzik 13355b2fc499SJeff Garzik // precondition: never called in_interrupt 13365b2fc499SJeff Garzik 1337225794f8SMarcel Holtmann static struct device_type wlan_type = { 1338225794f8SMarcel Holtmann .name = "wlan", 1339225794f8SMarcel Holtmann }; 1340225794f8SMarcel Holtmann 1341225794f8SMarcel Holtmann static struct device_type wwan_type = { 1342225794f8SMarcel Holtmann .name = "wwan", 1343225794f8SMarcel Holtmann }; 1344225794f8SMarcel Holtmann 13455b2fc499SJeff Garzik int 13465b2fc499SJeff Garzik usbnet_probe (struct usb_interface *udev, const struct usb_device_id *prod) 13475b2fc499SJeff Garzik { 13485b2fc499SJeff Garzik struct usbnet *dev; 13495b2fc499SJeff Garzik struct net_device *net; 13505b2fc499SJeff Garzik struct usb_host_interface *interface; 13515b2fc499SJeff Garzik struct driver_info *info; 13525b2fc499SJeff Garzik struct usb_device *xdev; 13535b2fc499SJeff Garzik int status; 13545b2fc499SJeff Garzik const char *name; 1355b0786b43SMing Lei struct usb_driver *driver = to_usb_driver(udev->dev.driver); 1356b0786b43SMing Lei 1357b0786b43SMing Lei /* usbnet already took usb runtime pm, so have to enable the feature 1358b0786b43SMing Lei * for usb interface, otherwise usb_autopm_get_interface may return 1359b0786b43SMing Lei * failure if USB_SUSPEND(RUNTIME_PM) is enabled. 1360b0786b43SMing Lei */ 1361b0786b43SMing Lei if (!driver->supports_autosuspend) { 1362b0786b43SMing Lei driver->supports_autosuspend = 1; 1363b0786b43SMing Lei pm_runtime_enable(&udev->dev); 1364b0786b43SMing Lei } 13655b2fc499SJeff Garzik 13665b2fc499SJeff Garzik name = udev->dev.driver->name; 13675b2fc499SJeff Garzik info = (struct driver_info *) prod->driver_info; 13685b2fc499SJeff Garzik if (!info) { 13695b2fc499SJeff Garzik dev_dbg (&udev->dev, "blacklisted by %s\n", name); 13705b2fc499SJeff Garzik return -ENODEV; 13715b2fc499SJeff Garzik } 13725b2fc499SJeff Garzik xdev = interface_to_usbdev (udev); 13735b2fc499SJeff Garzik interface = udev->cur_altsetting; 13745b2fc499SJeff Garzik 13755b2fc499SJeff Garzik status = -ENOMEM; 13765b2fc499SJeff Garzik 13775b2fc499SJeff Garzik // set up our own records 13785b2fc499SJeff Garzik net = alloc_etherdev(sizeof(*dev)); 137941de8d4cSJoe Perches if (!net) 13805b2fc499SJeff Garzik goto out; 13815b2fc499SJeff Garzik 13820dacca73SBen Hutchings /* netdev_printk() needs this so do it as early as possible */ 13830dacca73SBen Hutchings SET_NETDEV_DEV(net, &udev->dev); 13840dacca73SBen Hutchings 13855b2fc499SJeff Garzik dev = netdev_priv(net); 13865b2fc499SJeff Garzik dev->udev = xdev; 1387a11a6544SOliver Neukum dev->intf = udev; 13885b2fc499SJeff Garzik dev->driver_info = info; 13895b2fc499SJeff Garzik dev->driver_name = name; 13905b2fc499SJeff Garzik dev->msg_enable = netif_msg_init (msg_level, NETIF_MSG_DRV 13915b2fc499SJeff Garzik | NETIF_MSG_PROBE | NETIF_MSG_LINK); 13925b2fc499SJeff Garzik skb_queue_head_init (&dev->rxq); 13935b2fc499SJeff Garzik skb_queue_head_init (&dev->txq); 13945b2fc499SJeff Garzik skb_queue_head_init (&dev->done); 13957834ddbcSJussi Kivilinna skb_queue_head_init(&dev->rxq_pause); 13965b2fc499SJeff Garzik dev->bh.func = usbnet_bh; 13975b2fc499SJeff Garzik dev->bh.data = (unsigned long) dev; 13985b2fc499SJeff Garzik INIT_WORK (&dev->kevent, kevent); 139969ee472fSOliver Neukum init_usb_anchor(&dev->deferred); 14005b2fc499SJeff Garzik dev->delay.function = usbnet_bh; 14015b2fc499SJeff Garzik dev->delay.data = (unsigned long) dev; 14025b2fc499SJeff Garzik init_timer (&dev->delay); 14035b2fc499SJeff Garzik mutex_init (&dev->phy_mutex); 14045b2fc499SJeff Garzik 14055b2fc499SJeff Garzik dev->net = net; 14065b2fc499SJeff Garzik strcpy (net->name, "usb%d"); 14075b2fc499SJeff Garzik memcpy (net->dev_addr, node_id, sizeof node_id); 14085b2fc499SJeff Garzik 14095b2fc499SJeff Garzik /* rx and tx sides can use different message sizes; 14105b2fc499SJeff Garzik * bind() should set rx_urb_size in that case. 14115b2fc499SJeff Garzik */ 14125b2fc499SJeff Garzik dev->hard_mtu = net->mtu + net->hard_header_len; 14135b2fc499SJeff Garzik #if 0 14145b2fc499SJeff Garzik // dma_supported() is deeply broken on almost all architectures 14155b2fc499SJeff Garzik // possible with some EHCI controllers 14166a35528aSYang Hongyang if (dma_supported (&udev->dev, DMA_BIT_MASK(64))) 14175b2fc499SJeff Garzik net->features |= NETIF_F_HIGHDMA; 14185b2fc499SJeff Garzik #endif 14195b2fc499SJeff Garzik 1420777baa47SStephen Hemminger net->netdev_ops = &usbnet_netdev_ops; 1421777baa47SStephen Hemminger net->watchdog_timeo = TX_TIMEOUT_JIFFIES; 14225b2fc499SJeff Garzik net->ethtool_ops = &usbnet_ethtool_ops; 14235b2fc499SJeff Garzik 14245b2fc499SJeff Garzik // allow device-specific bind/init procedures 14255b2fc499SJeff Garzik // NOTE net->name still not usable ... 14265b2fc499SJeff Garzik if (info->bind) { 14275b2fc499SJeff Garzik status = info->bind (dev, udev); 14285b2fc499SJeff Garzik if (status < 0) 14295b2fc499SJeff Garzik goto out1; 14305b2fc499SJeff Garzik 14315b2fc499SJeff Garzik // heuristic: "usb%d" for links we know are two-host, 14325b2fc499SJeff Garzik // else "eth%d" when there's reasonable doubt. userspace 14335b2fc499SJeff Garzik // can rename the link if it knows better. 14348e95a202SJoe Perches if ((dev->driver_info->flags & FLAG_ETHER) != 0 && 1435c261344dSArnd Bergmann ((dev->driver_info->flags & FLAG_POINTTOPOINT) == 0 || 1436c261344dSArnd Bergmann (net->dev_addr [0] & 0x02) == 0)) 14375b2fc499SJeff Garzik strcpy (net->name, "eth%d"); 14386e3bbcc5SJussi Kivilinna /* WLAN devices should always be named "wlan%d" */ 14396e3bbcc5SJussi Kivilinna if ((dev->driver_info->flags & FLAG_WLAN) != 0) 14406e3bbcc5SJussi Kivilinna strcpy(net->name, "wlan%d"); 1441e1e499eeSMarcel Holtmann /* WWAN devices should always be named "wwan%d" */ 1442e1e499eeSMarcel Holtmann if ((dev->driver_info->flags & FLAG_WWAN) != 0) 1443e1e499eeSMarcel Holtmann strcpy(net->name, "wwan%d"); 14445b2fc499SJeff Garzik 14455b2fc499SJeff Garzik /* maybe the remote can't receive an Ethernet MTU */ 14465b2fc499SJeff Garzik if (net->mtu > (dev->hard_mtu - net->hard_header_len)) 14475b2fc499SJeff Garzik net->mtu = dev->hard_mtu - net->hard_header_len; 14485b2fc499SJeff Garzik } else if (!info->in || !info->out) 14495b2fc499SJeff Garzik status = usbnet_get_endpoints (dev, udev); 14505b2fc499SJeff Garzik else { 14515b2fc499SJeff Garzik dev->in = usb_rcvbulkpipe (xdev, info->in); 14525b2fc499SJeff Garzik dev->out = usb_sndbulkpipe (xdev, info->out); 14535b2fc499SJeff Garzik if (!(info->flags & FLAG_NO_SETINT)) 14545b2fc499SJeff Garzik status = usb_set_interface (xdev, 14555b2fc499SJeff Garzik interface->desc.bInterfaceNumber, 14565b2fc499SJeff Garzik interface->desc.bAlternateSetting); 14575b2fc499SJeff Garzik else 14585b2fc499SJeff Garzik status = 0; 14595b2fc499SJeff Garzik 14605b2fc499SJeff Garzik } 14619514bfe5SPeter Korsgaard if (status >= 0 && dev->status) 14625b2fc499SJeff Garzik status = init_status (dev, udev); 14635b2fc499SJeff Garzik if (status < 0) 14645b2fc499SJeff Garzik goto out3; 14655b2fc499SJeff Garzik 14665b2fc499SJeff Garzik if (!dev->rx_urb_size) 14675b2fc499SJeff Garzik dev->rx_urb_size = dev->hard_mtu; 14685b2fc499SJeff Garzik dev->maxpacket = usb_maxpacket (dev->udev, dev->out, 1); 14695b2fc499SJeff Garzik 1470225794f8SMarcel Holtmann if ((dev->driver_info->flags & FLAG_WLAN) != 0) 1471225794f8SMarcel Holtmann SET_NETDEV_DEVTYPE(net, &wlan_type); 1472225794f8SMarcel Holtmann if ((dev->driver_info->flags & FLAG_WWAN) != 0) 1473225794f8SMarcel Holtmann SET_NETDEV_DEVTYPE(net, &wwan_type); 1474225794f8SMarcel Holtmann 14755b2fc499SJeff Garzik status = register_netdev (net); 14765b2fc499SJeff Garzik if (status) 1477a4723848Stom.leiming@gmail.com goto out4; 1478a475f603SJoe Perches netif_info(dev, probe, dev->net, 1479a475f603SJoe Perches "register '%s' at usb-%s-%s, %s, %pM\n", 14805b2fc499SJeff Garzik udev->dev.driver->name, 14815b2fc499SJeff Garzik xdev->bus->bus_name, xdev->devpath, 14825b2fc499SJeff Garzik dev->driver_info->description, 1483e174961cSJohannes Berg net->dev_addr); 14845b2fc499SJeff Garzik 14855b2fc499SJeff Garzik // ok, it's ready to go. 14865b2fc499SJeff Garzik usb_set_intfdata (udev, dev); 14875b2fc499SJeff Garzik 14885b2fc499SJeff Garzik netif_device_attach (net); 14895b2fc499SJeff Garzik 149037e8273cSBen Hutchings if (dev->driver_info->flags & FLAG_LINK_INTR) 149137e8273cSBen Hutchings netif_carrier_off(net); 149237e8273cSBen Hutchings 14935b2fc499SJeff Garzik return 0; 14945b2fc499SJeff Garzik 1495a4723848Stom.leiming@gmail.com out4: 1496a4723848Stom.leiming@gmail.com usb_free_urb(dev->interrupt); 14975b2fc499SJeff Garzik out3: 14985b2fc499SJeff Garzik if (info->unbind) 14995b2fc499SJeff Garzik info->unbind (dev, udev); 15005b2fc499SJeff Garzik out1: 15015b2fc499SJeff Garzik free_netdev(net); 15025b2fc499SJeff Garzik out: 15035b2fc499SJeff Garzik return status; 15045b2fc499SJeff Garzik } 15055b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_probe); 15065b2fc499SJeff Garzik 15075b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 15085b2fc499SJeff Garzik 150936433127SOliver Neukum /* 151036433127SOliver Neukum * suspend the whole driver as soon as the first interface is suspended 151136433127SOliver Neukum * resume only when the last interface is resumed 15125b2fc499SJeff Garzik */ 15135b2fc499SJeff Garzik 15145b2fc499SJeff Garzik int usbnet_suspend (struct usb_interface *intf, pm_message_t message) 15155b2fc499SJeff Garzik { 15165b2fc499SJeff Garzik struct usbnet *dev = usb_get_intfdata(intf); 15175b2fc499SJeff Garzik 151836433127SOliver Neukum if (!dev->suspend_count++) { 151969ee472fSOliver Neukum spin_lock_irq(&dev->txq.lock); 152069ee472fSOliver Neukum /* don't autosuspend while transmitting */ 15215b1b0b81SAlan Stern if (dev->txq.qlen && PMSG_IS_AUTO(message)) { 15225eeb3132SMing Lei dev->suspend_count--; 152369ee472fSOliver Neukum spin_unlock_irq(&dev->txq.lock); 152469ee472fSOliver Neukum return -EBUSY; 152569ee472fSOliver Neukum } else { 152669ee472fSOliver Neukum set_bit(EVENT_DEV_ASLEEP, &dev->flags); 152769ee472fSOliver Neukum spin_unlock_irq(&dev->txq.lock); 152869ee472fSOliver Neukum } 1529a11a6544SOliver Neukum /* 1530a11a6544SOliver Neukum * accelerate emptying of the rx and queues, to avoid 15315b2fc499SJeff Garzik * having everything error out. 15325b2fc499SJeff Garzik */ 15335b2fc499SJeff Garzik netif_device_detach (dev->net); 153469ee472fSOliver Neukum usbnet_terminate_urbs(dev); 153569ee472fSOliver Neukum usb_kill_urb(dev->interrupt); 153669ee472fSOliver Neukum 1537a11a6544SOliver Neukum /* 1538a11a6544SOliver Neukum * reattach so runtime management can use and 1539a11a6544SOliver Neukum * wake the device 1540a11a6544SOliver Neukum */ 1541a11a6544SOliver Neukum netif_device_attach (dev->net); 154236433127SOliver Neukum } 15435b2fc499SJeff Garzik return 0; 15445b2fc499SJeff Garzik } 15455b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_suspend); 15465b2fc499SJeff Garzik 15475b2fc499SJeff Garzik int usbnet_resume (struct usb_interface *intf) 15485b2fc499SJeff Garzik { 15495b2fc499SJeff Garzik struct usbnet *dev = usb_get_intfdata(intf); 155069ee472fSOliver Neukum struct sk_buff *skb; 155169ee472fSOliver Neukum struct urb *res; 155269ee472fSOliver Neukum int retval; 15535b2fc499SJeff Garzik 155469ee472fSOliver Neukum if (!--dev->suspend_count) { 155568972efaSPaul Stewart /* resume interrupt URBs */ 155668972efaSPaul Stewart if (dev->interrupt && test_bit(EVENT_DEV_OPEN, &dev->flags)) 155768972efaSPaul Stewart usb_submit_urb(dev->interrupt, GFP_NOIO); 155868972efaSPaul Stewart 155969ee472fSOliver Neukum spin_lock_irq(&dev->txq.lock); 156069ee472fSOliver Neukum while ((res = usb_get_from_anchor(&dev->deferred))) { 156169ee472fSOliver Neukum 156269ee472fSOliver Neukum skb = (struct sk_buff *)res->context; 156369ee472fSOliver Neukum retval = usb_submit_urb(res, GFP_ATOMIC); 156469ee472fSOliver Neukum if (retval < 0) { 156569ee472fSOliver Neukum dev_kfree_skb_any(skb); 156669ee472fSOliver Neukum usb_free_urb(res); 156769ee472fSOliver Neukum usb_autopm_put_interface_async(dev->intf); 156869ee472fSOliver Neukum } else { 156969ee472fSOliver Neukum dev->net->trans_start = jiffies; 157069ee472fSOliver Neukum __skb_queue_tail(&dev->txq, skb); 157169ee472fSOliver Neukum } 157269ee472fSOliver Neukum } 157369ee472fSOliver Neukum 157469ee472fSOliver Neukum smp_mb(); 157569ee472fSOliver Neukum clear_bit(EVENT_DEV_ASLEEP, &dev->flags); 157669ee472fSOliver Neukum spin_unlock_irq(&dev->txq.lock); 157775bd0cbdSMing Lei 157875bd0cbdSMing Lei if (test_bit(EVENT_DEV_OPEN, &dev->flags)) { 157965841fd5SMing Lei /* handle remote wakeup ASAP */ 158065841fd5SMing Lei if (!dev->wait && 158165841fd5SMing Lei netif_device_present(dev->net) && 158265841fd5SMing Lei !timer_pending(&dev->delay) && 158365841fd5SMing Lei !test_bit(EVENT_RX_HALT, &dev->flags)) 1584ab6f148dSOliver Neukum rx_alloc_submit(dev, GFP_NOIO); 158565841fd5SMing Lei 158669ee472fSOliver Neukum if (!(dev->txq.qlen >= TX_QLEN(dev))) 15871aa9bc5bSAlexey Orishko netif_tx_wake_all_queues(dev->net); 15885b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 158969ee472fSOliver Neukum } 159075bd0cbdSMing Lei } 15915d9d01a3SOliver Neukum 15925d9d01a3SOliver Neukum if (test_and_clear_bit(EVENT_DEVICE_REPORT_IDLE, &dev->flags)) 15935d9d01a3SOliver Neukum usb_autopm_get_interface_no_resume(intf); 15945d9d01a3SOliver Neukum 15955b2fc499SJeff Garzik return 0; 15965b2fc499SJeff Garzik } 15975b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_resume); 15985b2fc499SJeff Garzik 15995d9d01a3SOliver Neukum /* 16005d9d01a3SOliver Neukum * Either a subdriver implements manage_power, then it is assumed to always 16015d9d01a3SOliver Neukum * be ready to be suspended or it reports the readiness to be suspended 16025d9d01a3SOliver Neukum * explicitly 16035d9d01a3SOliver Neukum */ 16045d9d01a3SOliver Neukum void usbnet_device_suggests_idle(struct usbnet *dev) 16055d9d01a3SOliver Neukum { 16065d9d01a3SOliver Neukum if (!test_and_set_bit(EVENT_DEVICE_REPORT_IDLE, &dev->flags)) { 16075d9d01a3SOliver Neukum dev->intf->needs_remote_wakeup = 1; 16085d9d01a3SOliver Neukum usb_autopm_put_interface_async(dev->intf); 16095d9d01a3SOliver Neukum } 16105d9d01a3SOliver Neukum } 16115d9d01a3SOliver Neukum EXPORT_SYMBOL(usbnet_device_suggests_idle); 16125b2fc499SJeff Garzik 16135b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 16140547fad2SMing Lei static int __usbnet_read_cmd(struct usbnet *dev, u8 cmd, u8 reqtype, 1615877bd862SMing Lei u16 value, u16 index, void *data, u16 size) 1616877bd862SMing Lei { 1617877bd862SMing Lei void *buf = NULL; 1618877bd862SMing Lei int err = -ENOMEM; 1619877bd862SMing Lei 1620877bd862SMing Lei netdev_dbg(dev->net, "usbnet_read_cmd cmd=0x%02x reqtype=%02x" 1621877bd862SMing Lei " value=0x%04x index=0x%04x size=%d\n", 1622877bd862SMing Lei cmd, reqtype, value, index, size); 1623877bd862SMing Lei 1624877bd862SMing Lei if (data) { 1625877bd862SMing Lei buf = kmalloc(size, GFP_KERNEL); 1626877bd862SMing Lei if (!buf) 1627877bd862SMing Lei goto out; 1628877bd862SMing Lei } 1629877bd862SMing Lei 1630877bd862SMing Lei err = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0), 1631877bd862SMing Lei cmd, reqtype, value, index, buf, size, 1632877bd862SMing Lei USB_CTRL_GET_TIMEOUT); 1633877bd862SMing Lei if (err > 0 && err <= size) 1634877bd862SMing Lei memcpy(data, buf, err); 1635877bd862SMing Lei kfree(buf); 1636877bd862SMing Lei out: 1637877bd862SMing Lei return err; 1638877bd862SMing Lei } 1639877bd862SMing Lei 16400547fad2SMing Lei static int __usbnet_write_cmd(struct usbnet *dev, u8 cmd, u8 reqtype, 16410547fad2SMing Lei u16 value, u16 index, const void *data, 16420547fad2SMing Lei u16 size) 1643877bd862SMing Lei { 1644877bd862SMing Lei void *buf = NULL; 1645877bd862SMing Lei int err = -ENOMEM; 1646877bd862SMing Lei 1647877bd862SMing Lei netdev_dbg(dev->net, "usbnet_write_cmd cmd=0x%02x reqtype=%02x" 1648877bd862SMing Lei " value=0x%04x index=0x%04x size=%d\n", 1649877bd862SMing Lei cmd, reqtype, value, index, size); 1650877bd862SMing Lei 1651877bd862SMing Lei if (data) { 1652877bd862SMing Lei buf = kmemdup(data, size, GFP_KERNEL); 1653877bd862SMing Lei if (!buf) 1654877bd862SMing Lei goto out; 1655877bd862SMing Lei } 1656877bd862SMing Lei 1657877bd862SMing Lei err = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0), 1658877bd862SMing Lei cmd, reqtype, value, index, buf, size, 1659877bd862SMing Lei USB_CTRL_SET_TIMEOUT); 1660877bd862SMing Lei kfree(buf); 1661877bd862SMing Lei 1662877bd862SMing Lei out: 1663877bd862SMing Lei return err; 1664877bd862SMing Lei } 16650547fad2SMing Lei 16660547fad2SMing Lei /* 16670547fad2SMing Lei * The function can't be called inside suspend/resume callback, 16680547fad2SMing Lei * otherwise deadlock will be caused. 16690547fad2SMing Lei */ 16700547fad2SMing Lei int usbnet_read_cmd(struct usbnet *dev, u8 cmd, u8 reqtype, 16710547fad2SMing Lei u16 value, u16 index, void *data, u16 size) 16720547fad2SMing Lei { 1673*6f0a0986SMing Lei int ret; 1674*6f0a0986SMing Lei 1675*6f0a0986SMing Lei if (usb_autopm_get_interface(dev->intf) < 0) 1676*6f0a0986SMing Lei return -ENODEV; 1677*6f0a0986SMing Lei ret = __usbnet_read_cmd(dev, cmd, reqtype, value, index, 16780547fad2SMing Lei data, size); 1679*6f0a0986SMing Lei usb_autopm_put_interface(dev->intf); 1680*6f0a0986SMing Lei return ret; 16810547fad2SMing Lei } 16820547fad2SMing Lei EXPORT_SYMBOL_GPL(usbnet_read_cmd); 16830547fad2SMing Lei 16840547fad2SMing Lei /* 16850547fad2SMing Lei * The function can't be called inside suspend/resume callback, 16860547fad2SMing Lei * otherwise deadlock will be caused. 16870547fad2SMing Lei */ 16880547fad2SMing Lei int usbnet_write_cmd(struct usbnet *dev, u8 cmd, u8 reqtype, 16890547fad2SMing Lei u16 value, u16 index, const void *data, u16 size) 16900547fad2SMing Lei { 1691*6f0a0986SMing Lei int ret; 1692*6f0a0986SMing Lei 1693*6f0a0986SMing Lei if (usb_autopm_get_interface(dev->intf) < 0) 1694*6f0a0986SMing Lei return -ENODEV; 1695*6f0a0986SMing Lei ret = __usbnet_write_cmd(dev, cmd, reqtype, value, index, 16960547fad2SMing Lei data, size); 1697*6f0a0986SMing Lei usb_autopm_put_interface(dev->intf); 1698*6f0a0986SMing Lei return ret; 16990547fad2SMing Lei } 1700877bd862SMing Lei EXPORT_SYMBOL_GPL(usbnet_write_cmd); 1701877bd862SMing Lei 17020547fad2SMing Lei /* 17030547fad2SMing Lei * The function can be called inside suspend/resume callback safely 17040547fad2SMing Lei * and should only be called by suspend/resume callback generally. 17050547fad2SMing Lei */ 17060547fad2SMing Lei int usbnet_read_cmd_nopm(struct usbnet *dev, u8 cmd, u8 reqtype, 17070547fad2SMing Lei u16 value, u16 index, void *data, u16 size) 17080547fad2SMing Lei { 17090547fad2SMing Lei return __usbnet_read_cmd(dev, cmd, reqtype, value, index, 17100547fad2SMing Lei data, size); 17110547fad2SMing Lei } 17120547fad2SMing Lei EXPORT_SYMBOL_GPL(usbnet_read_cmd_nopm); 17130547fad2SMing Lei 17140547fad2SMing Lei /* 17150547fad2SMing Lei * The function can be called inside suspend/resume callback safely 17160547fad2SMing Lei * and should only be called by suspend/resume callback generally. 17170547fad2SMing Lei */ 17180547fad2SMing Lei int usbnet_write_cmd_nopm(struct usbnet *dev, u8 cmd, u8 reqtype, 17190547fad2SMing Lei u16 value, u16 index, const void *data, 17200547fad2SMing Lei u16 size) 17210547fad2SMing Lei { 17220547fad2SMing Lei return __usbnet_write_cmd(dev, cmd, reqtype, value, index, 17230547fad2SMing Lei data, size); 17240547fad2SMing Lei } 17250547fad2SMing Lei EXPORT_SYMBOL_GPL(usbnet_write_cmd_nopm); 17260547fad2SMing Lei 1727877bd862SMing Lei static void usbnet_async_cmd_cb(struct urb *urb) 1728877bd862SMing Lei { 1729877bd862SMing Lei struct usb_ctrlrequest *req = (struct usb_ctrlrequest *)urb->context; 1730877bd862SMing Lei int status = urb->status; 1731877bd862SMing Lei 1732877bd862SMing Lei if (status < 0) 1733877bd862SMing Lei dev_dbg(&urb->dev->dev, "%s failed with %d", 1734877bd862SMing Lei __func__, status); 1735877bd862SMing Lei 1736877bd862SMing Lei kfree(req); 1737877bd862SMing Lei usb_free_urb(urb); 1738877bd862SMing Lei } 1739877bd862SMing Lei 17400547fad2SMing Lei /* 17410547fad2SMing Lei * The caller must make sure that device can't be put into suspend 17420547fad2SMing Lei * state until the control URB completes. 17430547fad2SMing Lei */ 1744877bd862SMing Lei int usbnet_write_cmd_async(struct usbnet *dev, u8 cmd, u8 reqtype, 1745877bd862SMing Lei u16 value, u16 index, const void *data, u16 size) 1746877bd862SMing Lei { 1747877bd862SMing Lei struct usb_ctrlrequest *req = NULL; 1748877bd862SMing Lei struct urb *urb; 1749877bd862SMing Lei int err = -ENOMEM; 1750877bd862SMing Lei void *buf = NULL; 1751877bd862SMing Lei 1752877bd862SMing Lei netdev_dbg(dev->net, "usbnet_write_cmd cmd=0x%02x reqtype=%02x" 1753877bd862SMing Lei " value=0x%04x index=0x%04x size=%d\n", 1754877bd862SMing Lei cmd, reqtype, value, index, size); 1755877bd862SMing Lei 1756877bd862SMing Lei urb = usb_alloc_urb(0, GFP_ATOMIC); 1757877bd862SMing Lei if (!urb) { 1758877bd862SMing Lei netdev_err(dev->net, "Error allocating URB in" 1759877bd862SMing Lei " %s!\n", __func__); 1760877bd862SMing Lei goto fail; 1761877bd862SMing Lei } 1762877bd862SMing Lei 1763877bd862SMing Lei if (data) { 1764877bd862SMing Lei buf = kmemdup(data, size, GFP_ATOMIC); 1765877bd862SMing Lei if (!buf) { 1766877bd862SMing Lei netdev_err(dev->net, "Error allocating buffer" 1767877bd862SMing Lei " in %s!\n", __func__); 1768877bd862SMing Lei goto fail_free; 1769877bd862SMing Lei } 1770877bd862SMing Lei } 1771877bd862SMing Lei 1772877bd862SMing Lei req = kmalloc(sizeof(struct usb_ctrlrequest), GFP_ATOMIC); 1773877bd862SMing Lei if (!req) { 1774877bd862SMing Lei netdev_err(dev->net, "Failed to allocate memory for %s\n", 1775877bd862SMing Lei __func__); 1776877bd862SMing Lei goto fail_free_buf; 1777877bd862SMing Lei } 1778877bd862SMing Lei 1779877bd862SMing Lei req->bRequestType = reqtype; 1780877bd862SMing Lei req->bRequest = cmd; 1781877bd862SMing Lei req->wValue = cpu_to_le16(value); 1782877bd862SMing Lei req->wIndex = cpu_to_le16(index); 1783877bd862SMing Lei req->wLength = cpu_to_le16(size); 1784877bd862SMing Lei 1785877bd862SMing Lei usb_fill_control_urb(urb, dev->udev, 1786877bd862SMing Lei usb_sndctrlpipe(dev->udev, 0), 1787877bd862SMing Lei (void *)req, buf, size, 1788877bd862SMing Lei usbnet_async_cmd_cb, req); 1789877bd862SMing Lei urb->transfer_flags |= URB_FREE_BUFFER; 1790877bd862SMing Lei 1791877bd862SMing Lei err = usb_submit_urb(urb, GFP_ATOMIC); 1792877bd862SMing Lei if (err < 0) { 1793877bd862SMing Lei netdev_err(dev->net, "Error submitting the control" 1794877bd862SMing Lei " message: status=%d\n", err); 1795877bd862SMing Lei goto fail_free; 1796877bd862SMing Lei } 1797877bd862SMing Lei return 0; 1798877bd862SMing Lei 1799877bd862SMing Lei fail_free_buf: 1800877bd862SMing Lei kfree(buf); 1801877bd862SMing Lei fail_free: 1802877bd862SMing Lei kfree(req); 1803877bd862SMing Lei usb_free_urb(urb); 1804877bd862SMing Lei fail: 1805877bd862SMing Lei return err; 1806877bd862SMing Lei 1807877bd862SMing Lei } 1808877bd862SMing Lei EXPORT_SYMBOL_GPL(usbnet_write_cmd_async); 1809877bd862SMing Lei /*-------------------------------------------------------------------------*/ 18105b2fc499SJeff Garzik 18115b2fc499SJeff Garzik static int __init usbnet_init(void) 18125b2fc499SJeff Garzik { 1813c582a950SThiago Farina /* Compiler should optimize this out. */ 1814c582a950SThiago Farina BUILD_BUG_ON( 1815c582a950SThiago Farina FIELD_SIZEOF(struct sk_buff, cb) < sizeof(struct skb_data)); 18165b2fc499SJeff Garzik 1817c7e12eadSJoe Perches eth_random_addr(node_id); 18185b2fc499SJeff Garzik return 0; 18195b2fc499SJeff Garzik } 18205b2fc499SJeff Garzik module_init(usbnet_init); 18215b2fc499SJeff Garzik 18225b2fc499SJeff Garzik static void __exit usbnet_exit(void) 18235b2fc499SJeff Garzik { 18245b2fc499SJeff Garzik } 18255b2fc499SJeff Garzik module_exit(usbnet_exit); 18265b2fc499SJeff Garzik 18275b2fc499SJeff Garzik MODULE_AUTHOR("David Brownell"); 18285b2fc499SJeff Garzik MODULE_DESCRIPTION("USB network driver framework"); 18295b2fc499SJeff Garzik MODULE_LICENSE("GPL"); 1830