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 * 62*a88c32aeSMing Lei * The goal is to let the USB host controller be busy for 5msec or 63*a88c32aeSMing Lei * more before an irq is required, under load. Jumbograms change 64*a88c32aeSMing Lei * the equation. 655b2fc499SJeff Garzik */ 66*a88c32aeSMing Lei #define MAX_QUEUE_MEMORY (60 * 1518) 67*a88c32aeSMing Lei #define RX_QLEN(dev) ((dev)->rx_qlen) 68*a88c32aeSMing Lei #define TX_QLEN(dev) ((dev)->tx_qlen) 695b2fc499SJeff Garzik 705b2fc499SJeff Garzik // reawaken network queue this soon after stopping; else watchdog barks 715b2fc499SJeff Garzik #define TX_TIMEOUT_JIFFIES (5*HZ) 725b2fc499SJeff Garzik 735b2fc499SJeff Garzik // throttle rx/tx briefly after some faults, so khubd might disconnect() 745b2fc499SJeff Garzik // us (it polls at HZ/4 usually) before we report too many false errors. 755b2fc499SJeff Garzik #define THROTTLE_JIFFIES (HZ/8) 765b2fc499SJeff Garzik 775b2fc499SJeff Garzik // between wakeups 785b2fc499SJeff Garzik #define UNLINK_TIMEOUT_MS 3 795b2fc499SJeff Garzik 805b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 815b2fc499SJeff Garzik 825b2fc499SJeff Garzik // randomly generated ethernet address 835b2fc499SJeff Garzik static u8 node_id [ETH_ALEN]; 845b2fc499SJeff Garzik 855b2fc499SJeff Garzik static const char driver_name [] = "usbnet"; 865b2fc499SJeff Garzik 875b2fc499SJeff Garzik /* use ethtool to change the level for any given device */ 885b2fc499SJeff Garzik static int msg_level = -1; 895b2fc499SJeff Garzik module_param (msg_level, int, 0); 905b2fc499SJeff Garzik MODULE_PARM_DESC (msg_level, "Override default message level"); 915b2fc499SJeff Garzik 925b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 935b2fc499SJeff Garzik 945b2fc499SJeff Garzik /* handles CDC Ethernet and many other network "bulk data" interfaces */ 955b2fc499SJeff Garzik int usbnet_get_endpoints(struct usbnet *dev, struct usb_interface *intf) 965b2fc499SJeff Garzik { 975b2fc499SJeff Garzik int tmp; 985b2fc499SJeff Garzik struct usb_host_interface *alt = NULL; 995b2fc499SJeff Garzik struct usb_host_endpoint *in = NULL, *out = NULL; 1005b2fc499SJeff Garzik struct usb_host_endpoint *status = NULL; 1015b2fc499SJeff Garzik 1025b2fc499SJeff Garzik for (tmp = 0; tmp < intf->num_altsetting; tmp++) { 1035b2fc499SJeff Garzik unsigned ep; 1045b2fc499SJeff Garzik 1055b2fc499SJeff Garzik in = out = status = NULL; 1065b2fc499SJeff Garzik alt = intf->altsetting + tmp; 1075b2fc499SJeff Garzik 1085b2fc499SJeff Garzik /* take the first altsetting with in-bulk + out-bulk; 1095b2fc499SJeff Garzik * remember any status endpoint, just in case; 11070f23fd6SJustin P. Mattock * ignore other endpoints and altsettings. 1115b2fc499SJeff Garzik */ 1125b2fc499SJeff Garzik for (ep = 0; ep < alt->desc.bNumEndpoints; ep++) { 1135b2fc499SJeff Garzik struct usb_host_endpoint *e; 1145b2fc499SJeff Garzik int intr = 0; 1155b2fc499SJeff Garzik 1165b2fc499SJeff Garzik e = alt->endpoint + ep; 1175b2fc499SJeff Garzik switch (e->desc.bmAttributes) { 1185b2fc499SJeff Garzik case USB_ENDPOINT_XFER_INT: 1195b2fc499SJeff Garzik if (!usb_endpoint_dir_in(&e->desc)) 1205b2fc499SJeff Garzik continue; 1215b2fc499SJeff Garzik intr = 1; 1225b2fc499SJeff Garzik /* FALLTHROUGH */ 1235b2fc499SJeff Garzik case USB_ENDPOINT_XFER_BULK: 1245b2fc499SJeff Garzik break; 1255b2fc499SJeff Garzik default: 1265b2fc499SJeff Garzik continue; 1275b2fc499SJeff Garzik } 1285b2fc499SJeff Garzik if (usb_endpoint_dir_in(&e->desc)) { 1295b2fc499SJeff Garzik if (!intr && !in) 1305b2fc499SJeff Garzik in = e; 1315b2fc499SJeff Garzik else if (intr && !status) 1325b2fc499SJeff Garzik status = e; 1335b2fc499SJeff Garzik } else { 1345b2fc499SJeff Garzik if (!out) 1355b2fc499SJeff Garzik out = e; 1365b2fc499SJeff Garzik } 1375b2fc499SJeff Garzik } 1385b2fc499SJeff Garzik if (in && out) 1395b2fc499SJeff Garzik break; 1405b2fc499SJeff Garzik } 1415b2fc499SJeff Garzik if (!alt || !in || !out) 1425b2fc499SJeff Garzik return -EINVAL; 1435b2fc499SJeff Garzik 1448e95a202SJoe Perches if (alt->desc.bAlternateSetting != 0 || 1458e95a202SJoe Perches !(dev->driver_info->flags & FLAG_NO_SETINT)) { 1465b2fc499SJeff Garzik tmp = usb_set_interface (dev->udev, alt->desc.bInterfaceNumber, 1475b2fc499SJeff Garzik alt->desc.bAlternateSetting); 1485b2fc499SJeff Garzik if (tmp < 0) 1495b2fc499SJeff Garzik return tmp; 1505b2fc499SJeff Garzik } 1515b2fc499SJeff Garzik 1525b2fc499SJeff Garzik dev->in = usb_rcvbulkpipe (dev->udev, 1535b2fc499SJeff Garzik in->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK); 1545b2fc499SJeff Garzik dev->out = usb_sndbulkpipe (dev->udev, 1555b2fc499SJeff Garzik out->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK); 1565b2fc499SJeff Garzik dev->status = status; 1575b2fc499SJeff Garzik return 0; 1585b2fc499SJeff Garzik } 1595b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_endpoints); 1605b2fc499SJeff Garzik 16103ad032bSPeter Holik int usbnet_get_ethernet_addr(struct usbnet *dev, int iMACAddress) 16203ad032bSPeter Holik { 16303ad032bSPeter Holik int tmp, i; 16403ad032bSPeter Holik unsigned char buf [13]; 16503ad032bSPeter Holik 16603ad032bSPeter Holik tmp = usb_string(dev->udev, iMACAddress, buf, sizeof buf); 16703ad032bSPeter Holik if (tmp != 12) { 16803ad032bSPeter Holik dev_dbg(&dev->udev->dev, 16903ad032bSPeter Holik "bad MAC string %d fetch, %d\n", iMACAddress, tmp); 17003ad032bSPeter Holik if (tmp >= 0) 17103ad032bSPeter Holik tmp = -EINVAL; 17203ad032bSPeter Holik return tmp; 17303ad032bSPeter Holik } 17403ad032bSPeter Holik for (i = tmp = 0; i < 6; i++, tmp += 2) 17503ad032bSPeter Holik dev->net->dev_addr [i] = 176fd1f170dSAndy Shevchenko (hex_to_bin(buf[tmp]) << 4) + hex_to_bin(buf[tmp + 1]); 17703ad032bSPeter Holik return 0; 17803ad032bSPeter Holik } 17903ad032bSPeter Holik EXPORT_SYMBOL_GPL(usbnet_get_ethernet_addr); 18003ad032bSPeter Holik 18124ead299Stom.leiming@gmail.com static void intr_complete (struct urb *urb) 18224ead299Stom.leiming@gmail.com { 18324ead299Stom.leiming@gmail.com struct usbnet *dev = urb->context; 18424ead299Stom.leiming@gmail.com int status = urb->status; 18524ead299Stom.leiming@gmail.com 18624ead299Stom.leiming@gmail.com switch (status) { 18724ead299Stom.leiming@gmail.com /* success */ 18824ead299Stom.leiming@gmail.com case 0: 18924ead299Stom.leiming@gmail.com dev->driver_info->status(dev, urb); 19024ead299Stom.leiming@gmail.com break; 19124ead299Stom.leiming@gmail.com 19224ead299Stom.leiming@gmail.com /* software-driven interface shutdown */ 19324ead299Stom.leiming@gmail.com case -ENOENT: /* urb killed */ 19424ead299Stom.leiming@gmail.com case -ESHUTDOWN: /* hardware gone */ 19524ead299Stom.leiming@gmail.com netif_dbg(dev, ifdown, dev->net, 19624ead299Stom.leiming@gmail.com "intr shutdown, code %d\n", status); 19724ead299Stom.leiming@gmail.com return; 19824ead299Stom.leiming@gmail.com 19924ead299Stom.leiming@gmail.com /* NOTE: not throttling like RX/TX, since this endpoint 20024ead299Stom.leiming@gmail.com * already polls infrequently 20124ead299Stom.leiming@gmail.com */ 20224ead299Stom.leiming@gmail.com default: 20324ead299Stom.leiming@gmail.com netdev_dbg(dev->net, "intr status %d\n", status); 20424ead299Stom.leiming@gmail.com break; 20524ead299Stom.leiming@gmail.com } 20624ead299Stom.leiming@gmail.com 20724ead299Stom.leiming@gmail.com if (!netif_running (dev->net)) 20824ead299Stom.leiming@gmail.com return; 20924ead299Stom.leiming@gmail.com 21024ead299Stom.leiming@gmail.com status = usb_submit_urb (urb, GFP_ATOMIC); 21124ead299Stom.leiming@gmail.com if (status != 0) 21224ead299Stom.leiming@gmail.com netif_err(dev, timer, dev->net, 21324ead299Stom.leiming@gmail.com "intr resubmit --> %d\n", status); 21424ead299Stom.leiming@gmail.com } 2155b2fc499SJeff Garzik 2165b2fc499SJeff Garzik static int init_status (struct usbnet *dev, struct usb_interface *intf) 2175b2fc499SJeff Garzik { 2185b2fc499SJeff Garzik char *buf = NULL; 2195b2fc499SJeff Garzik unsigned pipe = 0; 2205b2fc499SJeff Garzik unsigned maxp; 2215b2fc499SJeff Garzik unsigned period; 2225b2fc499SJeff Garzik 2235b2fc499SJeff Garzik if (!dev->driver_info->status) 2245b2fc499SJeff Garzik return 0; 2255b2fc499SJeff Garzik 2265b2fc499SJeff Garzik pipe = usb_rcvintpipe (dev->udev, 2275b2fc499SJeff Garzik dev->status->desc.bEndpointAddress 2285b2fc499SJeff Garzik & USB_ENDPOINT_NUMBER_MASK); 2295b2fc499SJeff Garzik maxp = usb_maxpacket (dev->udev, pipe, 0); 2305b2fc499SJeff Garzik 2315b2fc499SJeff Garzik /* avoid 1 msec chatter: min 8 msec poll rate */ 2325b2fc499SJeff Garzik period = max ((int) dev->status->desc.bInterval, 2335b2fc499SJeff Garzik (dev->udev->speed == USB_SPEED_HIGH) ? 7 : 3); 2345b2fc499SJeff Garzik 2355b2fc499SJeff Garzik buf = kmalloc (maxp, GFP_KERNEL); 2365b2fc499SJeff Garzik if (buf) { 2375b2fc499SJeff Garzik dev->interrupt = usb_alloc_urb (0, GFP_KERNEL); 2385b2fc499SJeff Garzik if (!dev->interrupt) { 2395b2fc499SJeff Garzik kfree (buf); 2405b2fc499SJeff Garzik return -ENOMEM; 2415b2fc499SJeff Garzik } else { 2425b2fc499SJeff Garzik usb_fill_int_urb(dev->interrupt, dev->udev, pipe, 2435b2fc499SJeff Garzik buf, maxp, intr_complete, dev, period); 244720f3d7cStom.leiming@gmail.com dev->interrupt->transfer_flags |= URB_FREE_BUFFER; 2455b2fc499SJeff Garzik dev_dbg(&intf->dev, 2465b2fc499SJeff Garzik "status ep%din, %d bytes period %d\n", 2475b2fc499SJeff Garzik usb_pipeendpoint(pipe), maxp, period); 2485b2fc499SJeff Garzik } 2495b2fc499SJeff Garzik } 2505b2fc499SJeff Garzik return 0; 2515b2fc499SJeff Garzik } 2525b2fc499SJeff Garzik 2536eecdc5fSDan Williams /* Submit the interrupt URB if not previously submitted, increasing refcount */ 2546eecdc5fSDan Williams int usbnet_status_start(struct usbnet *dev, gfp_t mem_flags) 2556eecdc5fSDan Williams { 2566eecdc5fSDan Williams int ret = 0; 2576eecdc5fSDan Williams 2586eecdc5fSDan Williams WARN_ON_ONCE(dev->interrupt == NULL); 2596eecdc5fSDan Williams if (dev->interrupt) { 2606eecdc5fSDan Williams mutex_lock(&dev->interrupt_mutex); 2616eecdc5fSDan Williams 2626eecdc5fSDan Williams if (++dev->interrupt_count == 1) 2636eecdc5fSDan Williams ret = usb_submit_urb(dev->interrupt, mem_flags); 2646eecdc5fSDan Williams 2656eecdc5fSDan Williams dev_dbg(&dev->udev->dev, "incremented interrupt URB count to %d\n", 2666eecdc5fSDan Williams dev->interrupt_count); 2676eecdc5fSDan Williams mutex_unlock(&dev->interrupt_mutex); 2686eecdc5fSDan Williams } 2696eecdc5fSDan Williams return ret; 2706eecdc5fSDan Williams } 2716eecdc5fSDan Williams EXPORT_SYMBOL_GPL(usbnet_status_start); 2726eecdc5fSDan Williams 2736eecdc5fSDan Williams /* For resume; submit interrupt URB if previously submitted */ 2746eecdc5fSDan Williams static int __usbnet_status_start_force(struct usbnet *dev, gfp_t mem_flags) 2756eecdc5fSDan Williams { 2766eecdc5fSDan Williams int ret = 0; 2776eecdc5fSDan Williams 2786eecdc5fSDan Williams mutex_lock(&dev->interrupt_mutex); 2796eecdc5fSDan Williams if (dev->interrupt_count) { 2806eecdc5fSDan Williams ret = usb_submit_urb(dev->interrupt, mem_flags); 2816eecdc5fSDan Williams dev_dbg(&dev->udev->dev, 2826eecdc5fSDan Williams "submitted interrupt URB for resume\n"); 2836eecdc5fSDan Williams } 2846eecdc5fSDan Williams mutex_unlock(&dev->interrupt_mutex); 2856eecdc5fSDan Williams return ret; 2866eecdc5fSDan Williams } 2876eecdc5fSDan Williams 2886eecdc5fSDan Williams /* Kill the interrupt URB if all submitters want it killed */ 2896eecdc5fSDan Williams void usbnet_status_stop(struct usbnet *dev) 2906eecdc5fSDan Williams { 2916eecdc5fSDan Williams if (dev->interrupt) { 2926eecdc5fSDan Williams mutex_lock(&dev->interrupt_mutex); 2936eecdc5fSDan Williams WARN_ON(dev->interrupt_count == 0); 2946eecdc5fSDan Williams 2956eecdc5fSDan Williams if (dev->interrupt_count && --dev->interrupt_count == 0) 2966eecdc5fSDan Williams usb_kill_urb(dev->interrupt); 2976eecdc5fSDan Williams 2986eecdc5fSDan Williams dev_dbg(&dev->udev->dev, 2996eecdc5fSDan Williams "decremented interrupt URB count to %d\n", 3006eecdc5fSDan Williams dev->interrupt_count); 3016eecdc5fSDan Williams mutex_unlock(&dev->interrupt_mutex); 3026eecdc5fSDan Williams } 3036eecdc5fSDan Williams } 3046eecdc5fSDan Williams EXPORT_SYMBOL_GPL(usbnet_status_stop); 3056eecdc5fSDan Williams 3066eecdc5fSDan Williams /* For suspend; always kill interrupt URB */ 3076eecdc5fSDan Williams static void __usbnet_status_stop_force(struct usbnet *dev) 3086eecdc5fSDan Williams { 3096eecdc5fSDan Williams if (dev->interrupt) { 3106eecdc5fSDan Williams mutex_lock(&dev->interrupt_mutex); 3116eecdc5fSDan Williams usb_kill_urb(dev->interrupt); 3126eecdc5fSDan Williams dev_dbg(&dev->udev->dev, "killed interrupt URB for suspend\n"); 3136eecdc5fSDan Williams mutex_unlock(&dev->interrupt_mutex); 3146eecdc5fSDan Williams } 3156eecdc5fSDan Williams } 3166eecdc5fSDan Williams 3175b2fc499SJeff Garzik /* Passes this packet up the stack, updating its accounting. 3185b2fc499SJeff Garzik * Some link protocols batch packets, so their rx_fixup paths 3195b2fc499SJeff Garzik * can return clones as well as just modify the original skb. 3205b2fc499SJeff Garzik */ 3215b2fc499SJeff Garzik void usbnet_skb_return (struct usbnet *dev, struct sk_buff *skb) 3225b2fc499SJeff Garzik { 3235b2fc499SJeff Garzik int status; 3245b2fc499SJeff Garzik 3257834ddbcSJussi Kivilinna if (test_bit(EVENT_RX_PAUSED, &dev->flags)) { 3267834ddbcSJussi Kivilinna skb_queue_tail(&dev->rxq_pause, skb); 3277834ddbcSJussi Kivilinna return; 3287834ddbcSJussi Kivilinna } 3297834ddbcSJussi Kivilinna 3305b2fc499SJeff Garzik skb->protocol = eth_type_trans (skb, dev->net); 3317963837fSHerbert Xu dev->net->stats.rx_packets++; 3327963837fSHerbert Xu dev->net->stats.rx_bytes += skb->len; 3335b2fc499SJeff Garzik 334a475f603SJoe Perches netif_dbg(dev, rx_status, dev->net, "< rx, len %zu, type 0x%x\n", 3355b2fc499SJeff Garzik skb->len + sizeof (struct ethhdr), skb->protocol); 3365b2fc499SJeff Garzik memset (skb->cb, 0, sizeof (struct skb_data)); 337f9b491ecSMichael Riesch 338f9b491ecSMichael Riesch if (skb_defer_rx_timestamp(skb)) 339f9b491ecSMichael Riesch return; 340f9b491ecSMichael Riesch 3415b2fc499SJeff Garzik status = netif_rx (skb); 342a475f603SJoe Perches if (status != NET_RX_SUCCESS) 343a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, 344a475f603SJoe Perches "netif_rx status %d\n", status); 3455b2fc499SJeff Garzik } 3465b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_skb_return); 3475b2fc499SJeff Garzik 348*a88c32aeSMing Lei /* must be called if hard_mtu or rx_urb_size changed */ 349*a88c32aeSMing Lei void usbnet_update_max_qlen(struct usbnet *dev) 350*a88c32aeSMing Lei { 351*a88c32aeSMing Lei enum usb_device_speed speed = dev->udev->speed; 352*a88c32aeSMing Lei 353*a88c32aeSMing Lei switch (speed) { 354*a88c32aeSMing Lei case USB_SPEED_HIGH: 355*a88c32aeSMing Lei dev->rx_qlen = MAX_QUEUE_MEMORY / dev->rx_urb_size; 356*a88c32aeSMing Lei dev->tx_qlen = MAX_QUEUE_MEMORY / dev->hard_mtu; 357*a88c32aeSMing Lei break; 358*a88c32aeSMing Lei default: 359*a88c32aeSMing Lei dev->rx_qlen = dev->tx_qlen = 4; 360*a88c32aeSMing Lei } 361*a88c32aeSMing Lei } 362*a88c32aeSMing Lei EXPORT_SYMBOL_GPL(usbnet_update_max_qlen); 363*a88c32aeSMing Lei 3645b2fc499SJeff Garzik 3655b2fc499SJeff Garzik /*------------------------------------------------------------------------- 3665b2fc499SJeff Garzik * 3675b2fc499SJeff Garzik * Network Device Driver (peer link to "Host Device", from USB host) 3685b2fc499SJeff Garzik * 3695b2fc499SJeff Garzik *-------------------------------------------------------------------------*/ 3705b2fc499SJeff Garzik 371777baa47SStephen Hemminger int usbnet_change_mtu (struct net_device *net, int new_mtu) 3725b2fc499SJeff Garzik { 3735b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 3745b2fc499SJeff Garzik int ll_mtu = new_mtu + net->hard_header_len; 3755b2fc499SJeff Garzik int old_hard_mtu = dev->hard_mtu; 3765b2fc499SJeff Garzik int old_rx_urb_size = dev->rx_urb_size; 3775b2fc499SJeff Garzik 3785b2fc499SJeff Garzik if (new_mtu <= 0) 3795b2fc499SJeff Garzik return -EINVAL; 3805b2fc499SJeff Garzik // no second zero-length packet read wanted after mtu-sized packets 3815b2fc499SJeff Garzik if ((ll_mtu % dev->maxpacket) == 0) 3825b2fc499SJeff Garzik return -EDOM; 3835b2fc499SJeff Garzik net->mtu = new_mtu; 3845b2fc499SJeff Garzik 3855b2fc499SJeff Garzik dev->hard_mtu = net->mtu + net->hard_header_len; 3865b2fc499SJeff Garzik if (dev->rx_urb_size == old_hard_mtu) { 3875b2fc499SJeff Garzik dev->rx_urb_size = dev->hard_mtu; 3885b2fc499SJeff Garzik if (dev->rx_urb_size > old_rx_urb_size) 3895b2fc499SJeff Garzik usbnet_unlink_rx_urbs(dev); 3905b2fc499SJeff Garzik } 3915b2fc499SJeff Garzik 392*a88c32aeSMing Lei /* max qlen depend on hard_mtu and rx_urb_size */ 393*a88c32aeSMing Lei usbnet_update_max_qlen(dev); 394*a88c32aeSMing Lei 3955b2fc499SJeff Garzik return 0; 3965b2fc499SJeff Garzik } 397777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_change_mtu); 3985b2fc499SJeff Garzik 3995b6e9bcdSMing Lei /* The caller must hold list->lock */ 4005b6e9bcdSMing Lei static void __usbnet_queue_skb(struct sk_buff_head *list, 4015b6e9bcdSMing Lei struct sk_buff *newsk, enum skb_state state) 4025b6e9bcdSMing Lei { 4035b6e9bcdSMing Lei struct skb_data *entry = (struct skb_data *) newsk->cb; 4045b6e9bcdSMing Lei 4055b6e9bcdSMing Lei __skb_queue_tail(list, newsk); 4065b6e9bcdSMing Lei entry->state = state; 4075b6e9bcdSMing Lei } 4085b6e9bcdSMing Lei 4095b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 4105b2fc499SJeff Garzik 4115b2fc499SJeff Garzik /* some LK 2.4 HCDs oopsed if we freed or resubmitted urbs from 4125b2fc499SJeff Garzik * completion callbacks. 2.5 should have fixed those bugs... 4135b2fc499SJeff Garzik */ 4145b2fc499SJeff Garzik 4155b6e9bcdSMing Lei static enum skb_state defer_bh(struct usbnet *dev, struct sk_buff *skb, 4165b6e9bcdSMing Lei struct sk_buff_head *list, enum skb_state state) 4175b2fc499SJeff Garzik { 4185b2fc499SJeff Garzik unsigned long flags; 4195b6e9bcdSMing Lei enum skb_state old_state; 4205b6e9bcdSMing Lei struct skb_data *entry = (struct skb_data *) skb->cb; 4215b2fc499SJeff Garzik 4225b2fc499SJeff Garzik spin_lock_irqsave(&list->lock, flags); 4235b6e9bcdSMing Lei old_state = entry->state; 4245b6e9bcdSMing Lei entry->state = state; 4255b2fc499SJeff Garzik __skb_unlink(skb, list); 4265b2fc499SJeff Garzik spin_unlock(&list->lock); 4275b2fc499SJeff Garzik spin_lock(&dev->done.lock); 4285b2fc499SJeff Garzik __skb_queue_tail(&dev->done, skb); 4295b2fc499SJeff Garzik if (dev->done.qlen == 1) 4305b2fc499SJeff Garzik tasklet_schedule(&dev->bh); 4315b2fc499SJeff Garzik spin_unlock_irqrestore(&dev->done.lock, flags); 4325b6e9bcdSMing Lei return old_state; 4335b2fc499SJeff Garzik } 4345b2fc499SJeff Garzik 4355b2fc499SJeff Garzik /* some work can't be done in tasklets, so we use keventd 4365b2fc499SJeff Garzik * 4375b2fc499SJeff Garzik * NOTE: annoying asymmetry: if it's active, schedule_work() fails, 4385b2fc499SJeff Garzik * but tasklet_schedule() doesn't. hope the failure is rare. 4395b2fc499SJeff Garzik */ 4405b2fc499SJeff Garzik void usbnet_defer_kevent (struct usbnet *dev, int work) 4415b2fc499SJeff Garzik { 4425b2fc499SJeff Garzik set_bit (work, &dev->flags); 4439532021dSSteve Glendinning if (!schedule_work (&dev->kevent)) { 4449532021dSSteve Glendinning if (net_ratelimit()) 44560b86755SJoe Perches netdev_err(dev->net, "kevent %d may have been dropped\n", work); 4469532021dSSteve Glendinning } else { 44760b86755SJoe Perches netdev_dbg(dev->net, "kevent %d scheduled\n", work); 4485b2fc499SJeff Garzik } 4499532021dSSteve Glendinning } 4505b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_defer_kevent); 4515b2fc499SJeff Garzik 4525b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 4535b2fc499SJeff Garzik 4545b2fc499SJeff Garzik static void rx_complete (struct urb *urb); 4555b2fc499SJeff Garzik 456dacb3975SDavid S. Miller static int rx_submit (struct usbnet *dev, struct urb *urb, gfp_t flags) 4575b2fc499SJeff Garzik { 4585b2fc499SJeff Garzik struct sk_buff *skb; 4595b2fc499SJeff Garzik struct skb_data *entry; 4605b2fc499SJeff Garzik int retval = 0; 4615b2fc499SJeff Garzik unsigned long lockflags; 4625b2fc499SJeff Garzik size_t size = dev->rx_urb_size; 4635b2fc499SJeff Garzik 46470c37bf9SBjørn Mork /* prevent rx skb allocation when error ratio is high */ 46570c37bf9SBjørn Mork if (test_bit(EVENT_RX_KILL, &dev->flags)) { 46670c37bf9SBjørn Mork usb_free_urb(urb); 46770c37bf9SBjørn Mork return -ENOLINK; 46870c37bf9SBjørn Mork } 46970c37bf9SBjørn Mork 4707bdd4027SEric Dumazet skb = __netdev_alloc_skb_ip_align(dev->net, size, flags); 4717bdd4027SEric Dumazet if (!skb) { 472a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, "no rx skb\n"); 4735b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_RX_MEMORY); 4745b2fc499SJeff Garzik usb_free_urb (urb); 475dacb3975SDavid S. Miller return -ENOMEM; 4765b2fc499SJeff Garzik } 4775b2fc499SJeff Garzik 4785b2fc499SJeff Garzik entry = (struct skb_data *) skb->cb; 4795b2fc499SJeff Garzik entry->urb = urb; 4805b2fc499SJeff Garzik entry->dev = dev; 4815b2fc499SJeff Garzik entry->length = 0; 4825b2fc499SJeff Garzik 4835b2fc499SJeff Garzik usb_fill_bulk_urb (urb, dev->udev, dev->in, 4845b2fc499SJeff Garzik skb->data, size, rx_complete, skb); 4855b2fc499SJeff Garzik 4865b2fc499SJeff Garzik spin_lock_irqsave (&dev->rxq.lock, lockflags); 4875b2fc499SJeff Garzik 4888e95a202SJoe Perches if (netif_running (dev->net) && 4898e95a202SJoe Perches netif_device_present (dev->net) && 49069ee472fSOliver Neukum !test_bit (EVENT_RX_HALT, &dev->flags) && 49169ee472fSOliver Neukum !test_bit (EVENT_DEV_ASLEEP, &dev->flags)) { 4925b2fc499SJeff Garzik switch (retval = usb_submit_urb (urb, GFP_ATOMIC)) { 4935b2fc499SJeff Garzik case -EPIPE: 4945b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_RX_HALT); 4955b2fc499SJeff Garzik break; 4965b2fc499SJeff Garzik case -ENOMEM: 4975b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_RX_MEMORY); 4985b2fc499SJeff Garzik break; 4995b2fc499SJeff Garzik case -ENODEV: 500a475f603SJoe Perches netif_dbg(dev, ifdown, dev->net, "device gone\n"); 5015b2fc499SJeff Garzik netif_device_detach (dev->net); 5025b2fc499SJeff Garzik break; 503dacb3975SDavid S. Miller case -EHOSTUNREACH: 504dacb3975SDavid S. Miller retval = -ENOLINK; 505dacb3975SDavid S. Miller break; 5065b2fc499SJeff Garzik default: 507a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, 508a475f603SJoe Perches "rx submit, %d\n", retval); 5095b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 5105b2fc499SJeff Garzik break; 5115b2fc499SJeff Garzik case 0: 5125b6e9bcdSMing Lei __usbnet_queue_skb(&dev->rxq, skb, rx_start); 5135b2fc499SJeff Garzik } 5145b2fc499SJeff Garzik } else { 515a475f603SJoe Perches netif_dbg(dev, ifdown, dev->net, "rx: stopped\n"); 5165b2fc499SJeff Garzik retval = -ENOLINK; 5175b2fc499SJeff Garzik } 5185b2fc499SJeff Garzik spin_unlock_irqrestore (&dev->rxq.lock, lockflags); 5195b2fc499SJeff Garzik if (retval) { 5205b2fc499SJeff Garzik dev_kfree_skb_any (skb); 5215b2fc499SJeff Garzik usb_free_urb (urb); 5225b2fc499SJeff Garzik } 523dacb3975SDavid S. Miller return retval; 5245b2fc499SJeff Garzik } 5255b2fc499SJeff Garzik 5265b2fc499SJeff Garzik 5275b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 5285b2fc499SJeff Garzik 5295b2fc499SJeff Garzik static inline void rx_process (struct usbnet *dev, struct sk_buff *skb) 5305b2fc499SJeff Garzik { 5318e95a202SJoe Perches if (dev->driver_info->rx_fixup && 5327a635ea9SAndrzej Zaborowski !dev->driver_info->rx_fixup (dev, skb)) { 5337a635ea9SAndrzej Zaborowski /* With RX_ASSEMBLE, rx_fixup() must update counters */ 5347a635ea9SAndrzej Zaborowski if (!(dev->driver_info->flags & FLAG_RX_ASSEMBLE)) 5357a635ea9SAndrzej Zaborowski dev->net->stats.rx_errors++; 5367a635ea9SAndrzej Zaborowski goto done; 5377a635ea9SAndrzej Zaborowski } 5385b2fc499SJeff Garzik // else network stack removes extra byte if we forced a short packet 5395b2fc499SJeff Garzik 540073285fdSAlexey Orishko if (skb->len) { 541073285fdSAlexey Orishko /* all data was already cloned from skb inside the driver */ 542073285fdSAlexey Orishko if (dev->driver_info->flags & FLAG_MULTI_PACKET) 543073285fdSAlexey Orishko dev_kfree_skb_any(skb); 544073285fdSAlexey Orishko else 5455b2fc499SJeff Garzik usbnet_skb_return(dev, skb); 546073285fdSAlexey Orishko return; 547073285fdSAlexey Orishko } 548073285fdSAlexey Orishko 549a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, "drop\n"); 5507963837fSHerbert Xu dev->net->stats.rx_errors++; 5517a635ea9SAndrzej Zaborowski done: 5525b2fc499SJeff Garzik skb_queue_tail(&dev->done, skb); 5535b2fc499SJeff Garzik } 5545b2fc499SJeff Garzik 5555b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 5565b2fc499SJeff Garzik 5575b2fc499SJeff Garzik static void rx_complete (struct urb *urb) 5585b2fc499SJeff Garzik { 5595b2fc499SJeff Garzik struct sk_buff *skb = (struct sk_buff *) urb->context; 5605b2fc499SJeff Garzik struct skb_data *entry = (struct skb_data *) skb->cb; 5615b2fc499SJeff Garzik struct usbnet *dev = entry->dev; 5625b2fc499SJeff Garzik int urb_status = urb->status; 5635b6e9bcdSMing Lei enum skb_state state; 5645b2fc499SJeff Garzik 5655b2fc499SJeff Garzik skb_put (skb, urb->actual_length); 5665b6e9bcdSMing Lei state = rx_done; 5675b2fc499SJeff Garzik entry->urb = NULL; 5685b2fc499SJeff Garzik 5695b2fc499SJeff Garzik switch (urb_status) { 57018ab458fSDavid Brownell /* success */ 5715b2fc499SJeff Garzik case 0: 5725b2fc499SJeff Garzik if (skb->len < dev->net->hard_header_len) { 5735b6e9bcdSMing Lei state = rx_cleanup; 5747963837fSHerbert Xu dev->net->stats.rx_errors++; 5757963837fSHerbert Xu dev->net->stats.rx_length_errors++; 576a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, 577a475f603SJoe Perches "rx length %d\n", skb->len); 5785b2fc499SJeff Garzik } 5795b2fc499SJeff Garzik break; 5805b2fc499SJeff Garzik 58118ab458fSDavid Brownell /* stalls need manual reset. this is rare ... except that 58218ab458fSDavid Brownell * when going through USB 2.0 TTs, unplug appears this way. 5833ac49a1cSJean Delvare * we avoid the highspeed version of the ETIMEDOUT/EILSEQ 58418ab458fSDavid Brownell * storm, recovering as needed. 58518ab458fSDavid Brownell */ 5865b2fc499SJeff Garzik case -EPIPE: 5877963837fSHerbert Xu dev->net->stats.rx_errors++; 5885b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_RX_HALT); 5895b2fc499SJeff Garzik // FALLTHROUGH 5905b2fc499SJeff Garzik 59118ab458fSDavid Brownell /* software-driven interface shutdown */ 59218ab458fSDavid Brownell case -ECONNRESET: /* async unlink */ 59318ab458fSDavid Brownell case -ESHUTDOWN: /* hardware gone */ 594a475f603SJoe Perches netif_dbg(dev, ifdown, dev->net, 595a475f603SJoe Perches "rx shutdown, code %d\n", urb_status); 5965b2fc499SJeff Garzik goto block; 5975b2fc499SJeff Garzik 59818ab458fSDavid Brownell /* we get controller i/o faults during khubd disconnect() delays. 59918ab458fSDavid Brownell * throttle down resubmits, to avoid log floods; just temporarily, 60018ab458fSDavid Brownell * so we still recover when the fault isn't a khubd delay. 60118ab458fSDavid Brownell */ 6025b2fc499SJeff Garzik case -EPROTO: 6035b2fc499SJeff Garzik case -ETIME: 6045b2fc499SJeff Garzik case -EILSEQ: 6057963837fSHerbert Xu dev->net->stats.rx_errors++; 6065b2fc499SJeff Garzik if (!timer_pending (&dev->delay)) { 6075b2fc499SJeff Garzik mod_timer (&dev->delay, jiffies + THROTTLE_JIFFIES); 608a475f603SJoe Perches netif_dbg(dev, link, dev->net, 609a475f603SJoe Perches "rx throttle %d\n", urb_status); 6105b2fc499SJeff Garzik } 6115b2fc499SJeff Garzik block: 6125b6e9bcdSMing Lei state = rx_cleanup; 6135b2fc499SJeff Garzik entry->urb = urb; 6145b2fc499SJeff Garzik urb = NULL; 6155b2fc499SJeff Garzik break; 6165b2fc499SJeff Garzik 61718ab458fSDavid Brownell /* data overrun ... flush fifo? */ 6185b2fc499SJeff Garzik case -EOVERFLOW: 6197963837fSHerbert Xu dev->net->stats.rx_over_errors++; 6205b2fc499SJeff Garzik // FALLTHROUGH 6215b2fc499SJeff Garzik 6225b2fc499SJeff Garzik default: 6235b6e9bcdSMing Lei state = rx_cleanup; 6247963837fSHerbert Xu dev->net->stats.rx_errors++; 625a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, "rx status %d\n", urb_status); 6265b2fc499SJeff Garzik break; 6275b2fc499SJeff Garzik } 6285b2fc499SJeff Garzik 62970c37bf9SBjørn Mork /* stop rx if packet error rate is high */ 63070c37bf9SBjørn Mork if (++dev->pkt_cnt > 30) { 63170c37bf9SBjørn Mork dev->pkt_cnt = 0; 63270c37bf9SBjørn Mork dev->pkt_err = 0; 63370c37bf9SBjørn Mork } else { 63470c37bf9SBjørn Mork if (state == rx_cleanup) 63570c37bf9SBjørn Mork dev->pkt_err++; 63670c37bf9SBjørn Mork if (dev->pkt_err > 20) 63770c37bf9SBjørn Mork set_bit(EVENT_RX_KILL, &dev->flags); 63870c37bf9SBjørn Mork } 63970c37bf9SBjørn Mork 6405b6e9bcdSMing Lei state = defer_bh(dev, skb, &dev->rxq, state); 6415b2fc499SJeff Garzik 6425b2fc499SJeff Garzik if (urb) { 6438e95a202SJoe Perches if (netif_running (dev->net) && 6445b6e9bcdSMing Lei !test_bit (EVENT_RX_HALT, &dev->flags) && 6455b6e9bcdSMing Lei state != unlink_start) { 6465b2fc499SJeff Garzik rx_submit (dev, urb, GFP_ATOMIC); 6478a783354SOliver Neukum usb_mark_last_busy(dev->udev); 6485b2fc499SJeff Garzik return; 6495b2fc499SJeff Garzik } 6505b2fc499SJeff Garzik usb_free_urb (urb); 6515b2fc499SJeff Garzik } 652a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, "no read resubmitted\n"); 6535b2fc499SJeff Garzik } 6545b2fc499SJeff Garzik 6555b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 6567834ddbcSJussi Kivilinna void usbnet_pause_rx(struct usbnet *dev) 6577834ddbcSJussi Kivilinna { 6587834ddbcSJussi Kivilinna set_bit(EVENT_RX_PAUSED, &dev->flags); 6597834ddbcSJussi Kivilinna 660a475f603SJoe Perches netif_dbg(dev, rx_status, dev->net, "paused rx queue enabled\n"); 6617834ddbcSJussi Kivilinna } 6627834ddbcSJussi Kivilinna EXPORT_SYMBOL_GPL(usbnet_pause_rx); 6637834ddbcSJussi Kivilinna 6647834ddbcSJussi Kivilinna void usbnet_resume_rx(struct usbnet *dev) 6657834ddbcSJussi Kivilinna { 6667834ddbcSJussi Kivilinna struct sk_buff *skb; 6677834ddbcSJussi Kivilinna int num = 0; 6687834ddbcSJussi Kivilinna 6697834ddbcSJussi Kivilinna clear_bit(EVENT_RX_PAUSED, &dev->flags); 6707834ddbcSJussi Kivilinna 6717834ddbcSJussi Kivilinna while ((skb = skb_dequeue(&dev->rxq_pause)) != NULL) { 6727834ddbcSJussi Kivilinna usbnet_skb_return(dev, skb); 6737834ddbcSJussi Kivilinna num++; 6747834ddbcSJussi Kivilinna } 6757834ddbcSJussi Kivilinna 6767834ddbcSJussi Kivilinna tasklet_schedule(&dev->bh); 6777834ddbcSJussi Kivilinna 678a475f603SJoe Perches netif_dbg(dev, rx_status, dev->net, 679a475f603SJoe Perches "paused rx queue disabled, %d skbs requeued\n", num); 6807834ddbcSJussi Kivilinna } 6817834ddbcSJussi Kivilinna EXPORT_SYMBOL_GPL(usbnet_resume_rx); 6827834ddbcSJussi Kivilinna 6837834ddbcSJussi Kivilinna void usbnet_purge_paused_rxq(struct usbnet *dev) 6847834ddbcSJussi Kivilinna { 6857834ddbcSJussi Kivilinna skb_queue_purge(&dev->rxq_pause); 6867834ddbcSJussi Kivilinna } 6877834ddbcSJussi Kivilinna EXPORT_SYMBOL_GPL(usbnet_purge_paused_rxq); 6887834ddbcSJussi Kivilinna 6897834ddbcSJussi Kivilinna /*-------------------------------------------------------------------------*/ 6905b2fc499SJeff Garzik 6915b2fc499SJeff Garzik // unlink pending rx/tx; completion handlers do all other cleanup 6925b2fc499SJeff Garzik 6935b2fc499SJeff Garzik static int unlink_urbs (struct usbnet *dev, struct sk_buff_head *q) 6945b2fc499SJeff Garzik { 6955b2fc499SJeff Garzik unsigned long flags; 6965b6e9bcdSMing Lei struct sk_buff *skb; 6975b2fc499SJeff Garzik int count = 0; 6985b2fc499SJeff Garzik 6995b2fc499SJeff Garzik spin_lock_irqsave (&q->lock, flags); 7005b6e9bcdSMing Lei while (!skb_queue_empty(q)) { 7015b2fc499SJeff Garzik struct skb_data *entry; 7025b2fc499SJeff Garzik struct urb *urb; 7035b2fc499SJeff Garzik int retval; 7045b2fc499SJeff Garzik 7055b6e9bcdSMing Lei skb_queue_walk(q, skb) { 7065b2fc499SJeff Garzik entry = (struct skb_data *) skb->cb; 7075b6e9bcdSMing Lei if (entry->state != unlink_start) 7085b6e9bcdSMing Lei goto found; 7095b6e9bcdSMing Lei } 7105b6e9bcdSMing Lei break; 7115b6e9bcdSMing Lei found: 7125b6e9bcdSMing Lei entry->state = unlink_start; 7135b2fc499SJeff Garzik urb = entry->urb; 7145b2fc499SJeff Garzik 7150956a8c2Stom.leiming@gmail.com /* 7160956a8c2Stom.leiming@gmail.com * Get reference count of the URB to avoid it to be 7170956a8c2Stom.leiming@gmail.com * freed during usb_unlink_urb, which may trigger 7180956a8c2Stom.leiming@gmail.com * use-after-free problem inside usb_unlink_urb since 7190956a8c2Stom.leiming@gmail.com * usb_unlink_urb is always racing with .complete 7200956a8c2Stom.leiming@gmail.com * handler(include defer_bh). 7210956a8c2Stom.leiming@gmail.com */ 7220956a8c2Stom.leiming@gmail.com usb_get_urb(urb); 7234231d47eSSebastian Siewior spin_unlock_irqrestore(&q->lock, flags); 7245b2fc499SJeff Garzik // during some PM-driven resume scenarios, 7255b2fc499SJeff Garzik // these (async) unlinks complete immediately 7265b2fc499SJeff Garzik retval = usb_unlink_urb (urb); 7275b2fc499SJeff Garzik if (retval != -EINPROGRESS && retval != 0) 72860b86755SJoe Perches netdev_dbg(dev->net, "unlink urb err, %d\n", retval); 7295b2fc499SJeff Garzik else 7305b2fc499SJeff Garzik count++; 7310956a8c2Stom.leiming@gmail.com usb_put_urb(urb); 7324231d47eSSebastian Siewior spin_lock_irqsave(&q->lock, flags); 7335b2fc499SJeff Garzik } 7345b2fc499SJeff Garzik spin_unlock_irqrestore (&q->lock, flags); 7355b2fc499SJeff Garzik return count; 7365b2fc499SJeff Garzik } 7375b2fc499SJeff Garzik 7385b2fc499SJeff Garzik // Flush all pending rx urbs 7395b2fc499SJeff Garzik // minidrivers may need to do this when the MTU changes 7405b2fc499SJeff Garzik 7415b2fc499SJeff Garzik void usbnet_unlink_rx_urbs(struct usbnet *dev) 7425b2fc499SJeff Garzik { 7435b2fc499SJeff Garzik if (netif_running(dev->net)) { 7445b2fc499SJeff Garzik (void) unlink_urbs (dev, &dev->rxq); 7455b2fc499SJeff Garzik tasklet_schedule(&dev->bh); 7465b2fc499SJeff Garzik } 7475b2fc499SJeff Garzik } 7485b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_unlink_rx_urbs); 7495b2fc499SJeff Garzik 7505b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 7515b2fc499SJeff Garzik 7525b2fc499SJeff Garzik // precondition: never called in_interrupt 75369ee472fSOliver Neukum static void usbnet_terminate_urbs(struct usbnet *dev) 75469ee472fSOliver Neukum { 75569ee472fSOliver Neukum DECLARE_WAIT_QUEUE_HEAD_ONSTACK(unlink_wakeup); 75669ee472fSOliver Neukum DECLARE_WAITQUEUE(wait, current); 75769ee472fSOliver Neukum int temp; 75869ee472fSOliver Neukum 75969ee472fSOliver Neukum /* ensure there are no more active urbs */ 76069ee472fSOliver Neukum add_wait_queue(&unlink_wakeup, &wait); 76169ee472fSOliver Neukum set_current_state(TASK_UNINTERRUPTIBLE); 76269ee472fSOliver Neukum dev->wait = &unlink_wakeup; 76369ee472fSOliver Neukum temp = unlink_urbs(dev, &dev->txq) + 76469ee472fSOliver Neukum unlink_urbs(dev, &dev->rxq); 76569ee472fSOliver Neukum 76669ee472fSOliver Neukum /* maybe wait for deletions to finish. */ 76769ee472fSOliver Neukum while (!skb_queue_empty(&dev->rxq) 76869ee472fSOliver Neukum && !skb_queue_empty(&dev->txq) 76969ee472fSOliver Neukum && !skb_queue_empty(&dev->done)) { 77066cc42a4SKulikov Vasiliy schedule_timeout(msecs_to_jiffies(UNLINK_TIMEOUT_MS)); 77169ee472fSOliver Neukum set_current_state(TASK_UNINTERRUPTIBLE); 772a475f603SJoe Perches netif_dbg(dev, ifdown, dev->net, 773a475f603SJoe Perches "waited for %d urb completions\n", temp); 77469ee472fSOliver Neukum } 77569ee472fSOliver Neukum set_current_state(TASK_RUNNING); 77669ee472fSOliver Neukum dev->wait = NULL; 77769ee472fSOliver Neukum remove_wait_queue(&unlink_wakeup, &wait); 77869ee472fSOliver Neukum } 7795b2fc499SJeff Garzik 780777baa47SStephen Hemminger int usbnet_stop (struct net_device *net) 7815b2fc499SJeff Garzik { 7825b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 783a33e9e7fSJussi Kivilinna struct driver_info *info = dev->driver_info; 784a33e9e7fSJussi Kivilinna int retval; 7855b2fc499SJeff Garzik 78675bd0cbdSMing Lei clear_bit(EVENT_DEV_OPEN, &dev->flags); 7875b2fc499SJeff Garzik netif_stop_queue (net); 7885b2fc499SJeff Garzik 789a475f603SJoe Perches netif_info(dev, ifdown, dev->net, 7908ccef431SBen Hutchings "stop stats: rx/tx %lu/%lu, errs %lu/%lu\n", 7917963837fSHerbert Xu net->stats.rx_packets, net->stats.tx_packets, 79260b86755SJoe Perches net->stats.rx_errors, net->stats.tx_errors); 7935b2fc499SJeff Garzik 794a33e9e7fSJussi Kivilinna /* allow minidriver to stop correctly (wireless devices to turn off 795a33e9e7fSJussi Kivilinna * radio etc) */ 796a33e9e7fSJussi Kivilinna if (info->stop) { 797a33e9e7fSJussi Kivilinna retval = info->stop(dev); 798a475f603SJoe Perches if (retval < 0) 799a475f603SJoe Perches netif_info(dev, ifdown, dev->net, 80060b86755SJoe Perches "stop fail (%d) usbnet usb-%s-%s, %s\n", 801a33e9e7fSJussi Kivilinna retval, 802a33e9e7fSJussi Kivilinna dev->udev->bus->bus_name, dev->udev->devpath, 803a33e9e7fSJussi Kivilinna info->description); 804a33e9e7fSJussi Kivilinna } 805a33e9e7fSJussi Kivilinna 80669ee472fSOliver Neukum if (!(info->flags & FLAG_AVOID_UNLINK_URBS)) 80769ee472fSOliver Neukum usbnet_terminate_urbs(dev); 8085b2fc499SJeff Garzik 8096eecdc5fSDan Williams usbnet_status_stop(dev); 8105b2fc499SJeff Garzik 8117834ddbcSJussi Kivilinna usbnet_purge_paused_rxq(dev); 8127834ddbcSJussi Kivilinna 8135b2fc499SJeff Garzik /* deferred work (task, timer, softirq) must also stop. 8145b2fc499SJeff Garzik * can't flush_scheduled_work() until we drop rtnl (later), 8155b2fc499SJeff Garzik * else workers could deadlock; so make workers a NOP. 8165b2fc499SJeff Garzik */ 8175b2fc499SJeff Garzik dev->flags = 0; 8185b2fc499SJeff Garzik del_timer_sync (&dev->delay); 8195b2fc499SJeff Garzik tasklet_kill (&dev->bh); 820a1c088e0SOliver Neukum if (info->manage_power && 821a1c088e0SOliver Neukum !test_and_clear_bit(EVENT_NO_RUNTIME_PM, &dev->flags)) 82269ee472fSOliver Neukum info->manage_power(dev, 0); 82369ee472fSOliver Neukum else 824a11a6544SOliver Neukum usb_autopm_put_interface(dev->intf); 8255b2fc499SJeff Garzik 8265b2fc499SJeff Garzik return 0; 8275b2fc499SJeff Garzik } 828777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_stop); 8295b2fc499SJeff Garzik 8305b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 8315b2fc499SJeff Garzik 8325b2fc499SJeff Garzik // posts reads, and enables write queuing 8335b2fc499SJeff Garzik 8345b2fc499SJeff Garzik // precondition: never called in_interrupt 8355b2fc499SJeff Garzik 836777baa47SStephen Hemminger int usbnet_open (struct net_device *net) 8375b2fc499SJeff Garzik { 8385b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 839a11a6544SOliver Neukum int retval; 8405b2fc499SJeff Garzik struct driver_info *info = dev->driver_info; 8415b2fc499SJeff Garzik 842a11a6544SOliver Neukum if ((retval = usb_autopm_get_interface(dev->intf)) < 0) { 843a475f603SJoe Perches netif_info(dev, ifup, dev->net, 84460b86755SJoe Perches "resumption fail (%d) usbnet usb-%s-%s, %s\n", 845a11a6544SOliver Neukum retval, 84660b86755SJoe Perches dev->udev->bus->bus_name, 84760b86755SJoe Perches dev->udev->devpath, 848a11a6544SOliver Neukum info->description); 849a11a6544SOliver Neukum goto done_nopm; 850a11a6544SOliver Neukum } 851a11a6544SOliver Neukum 8525b2fc499SJeff Garzik // put into "known safe" state 8535b2fc499SJeff Garzik if (info->reset && (retval = info->reset (dev)) < 0) { 854a475f603SJoe Perches netif_info(dev, ifup, dev->net, 85560b86755SJoe Perches "open reset fail (%d) usbnet usb-%s-%s, %s\n", 8565b2fc499SJeff Garzik retval, 85760b86755SJoe Perches dev->udev->bus->bus_name, 85860b86755SJoe Perches dev->udev->devpath, 8595b2fc499SJeff Garzik info->description); 8605b2fc499SJeff Garzik goto done; 8615b2fc499SJeff Garzik } 8625b2fc499SJeff Garzik 863*a88c32aeSMing Lei /* hard_mtu or rx_urb_size may change in reset() */ 864*a88c32aeSMing Lei usbnet_update_max_qlen(dev); 865*a88c32aeSMing Lei 8665b2fc499SJeff Garzik // insist peer be connected 8675b2fc499SJeff Garzik if (info->check_connect && (retval = info->check_connect (dev)) < 0) { 868a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, "can't open; %d\n", retval); 8695b2fc499SJeff Garzik goto done; 8705b2fc499SJeff Garzik } 8715b2fc499SJeff Garzik 8725b2fc499SJeff Garzik /* start any status interrupt transfer */ 8735b2fc499SJeff Garzik if (dev->interrupt) { 8746eecdc5fSDan Williams retval = usbnet_status_start(dev, GFP_KERNEL); 8755b2fc499SJeff Garzik if (retval < 0) { 876a475f603SJoe Perches netif_err(dev, ifup, dev->net, 877a475f603SJoe Perches "intr submit %d\n", retval); 8785b2fc499SJeff Garzik goto done; 8795b2fc499SJeff Garzik } 8805b2fc499SJeff Garzik } 8815b2fc499SJeff Garzik 88268972efaSPaul Stewart set_bit(EVENT_DEV_OPEN, &dev->flags); 8835b2fc499SJeff Garzik netif_start_queue (net); 884a475f603SJoe Perches netif_info(dev, ifup, dev->net, 885a475f603SJoe Perches "open: enable queueing (rx %d, tx %d) mtu %d %s framing\n", 88660b86755SJoe Perches (int)RX_QLEN(dev), (int)TX_QLEN(dev), 887a475f603SJoe Perches dev->net->mtu, 888a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_NC) ? "NetChip" : 889a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_GL) ? "GeneSys" : 890a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_Z) ? "Zaurus" : 891a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_RN) ? "RNDIS" : 892a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_AX) ? "ASIX" : 893a475f603SJoe Perches "simple"); 8945b2fc499SJeff Garzik 89570c37bf9SBjørn Mork /* reset rx error state */ 89670c37bf9SBjørn Mork dev->pkt_cnt = 0; 89770c37bf9SBjørn Mork dev->pkt_err = 0; 89870c37bf9SBjørn Mork clear_bit(EVENT_RX_KILL, &dev->flags); 89970c37bf9SBjørn Mork 9005b2fc499SJeff Garzik // delay posting reads until we're fully open 9015b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 90269ee472fSOliver Neukum if (info->manage_power) { 90369ee472fSOliver Neukum retval = info->manage_power(dev, 1); 904a1c088e0SOliver Neukum if (retval < 0) { 905a1c088e0SOliver Neukum retval = 0; 906a1c088e0SOliver Neukum set_bit(EVENT_NO_RUNTIME_PM, &dev->flags); 907a1c088e0SOliver Neukum } else { 90869ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 90969ee472fSOliver Neukum } 910a1c088e0SOliver Neukum } 911a11a6544SOliver Neukum return retval; 9125b2fc499SJeff Garzik done: 913a11a6544SOliver Neukum usb_autopm_put_interface(dev->intf); 914a11a6544SOliver Neukum done_nopm: 9155b2fc499SJeff Garzik return retval; 9165b2fc499SJeff Garzik } 917777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_open); 9185b2fc499SJeff Garzik 9195b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 9205b2fc499SJeff Garzik 9215b2fc499SJeff Garzik /* ethtool methods; minidrivers may need to add some more, but 9225b2fc499SJeff Garzik * they'll probably want to use this base set. 9235b2fc499SJeff Garzik */ 9245b2fc499SJeff Garzik 9255b2fc499SJeff Garzik int usbnet_get_settings (struct net_device *net, struct ethtool_cmd *cmd) 9265b2fc499SJeff Garzik { 9275b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 9285b2fc499SJeff Garzik 9295b2fc499SJeff Garzik if (!dev->mii.mdio_read) 9305b2fc499SJeff Garzik return -EOPNOTSUPP; 9315b2fc499SJeff Garzik 9325b2fc499SJeff Garzik return mii_ethtool_gset(&dev->mii, cmd); 9335b2fc499SJeff Garzik } 9345b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_settings); 9355b2fc499SJeff Garzik 9365b2fc499SJeff Garzik int usbnet_set_settings (struct net_device *net, struct ethtool_cmd *cmd) 9375b2fc499SJeff Garzik { 9385b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 9395b2fc499SJeff Garzik int retval; 9405b2fc499SJeff Garzik 9415b2fc499SJeff Garzik if (!dev->mii.mdio_write) 9425b2fc499SJeff Garzik return -EOPNOTSUPP; 9435b2fc499SJeff Garzik 9445b2fc499SJeff Garzik retval = mii_ethtool_sset(&dev->mii, cmd); 9455b2fc499SJeff Garzik 9465b2fc499SJeff Garzik /* link speed/duplex might have changed */ 9475b2fc499SJeff Garzik if (dev->driver_info->link_reset) 9485b2fc499SJeff Garzik dev->driver_info->link_reset(dev); 9495b2fc499SJeff Garzik 950*a88c32aeSMing Lei /* hard_mtu or rx_urb_size may change in link_reset() */ 951*a88c32aeSMing Lei usbnet_update_max_qlen(dev); 952*a88c32aeSMing Lei 9535b2fc499SJeff Garzik return retval; 9545b2fc499SJeff Garzik 9555b2fc499SJeff Garzik } 9565b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_set_settings); 9575b2fc499SJeff Garzik 9585b2fc499SJeff Garzik u32 usbnet_get_link (struct net_device *net) 9595b2fc499SJeff Garzik { 9605b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 9615b2fc499SJeff Garzik 9625b2fc499SJeff Garzik /* If a check_connect is defined, return its result */ 9635b2fc499SJeff Garzik if (dev->driver_info->check_connect) 9645b2fc499SJeff Garzik return dev->driver_info->check_connect (dev) == 0; 9655b2fc499SJeff Garzik 9665b2fc499SJeff Garzik /* if the device has mii operations, use those */ 9675b2fc499SJeff Garzik if (dev->mii.mdio_read) 9685b2fc499SJeff Garzik return mii_link_ok(&dev->mii); 9695b2fc499SJeff Garzik 97005ffb3e2SBjørn Mork /* Otherwise, dtrt for drivers calling netif_carrier_{on,off} */ 97105ffb3e2SBjørn Mork return ethtool_op_get_link(net); 9725b2fc499SJeff Garzik } 9735b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_link); 9745b2fc499SJeff Garzik 9755b2fc499SJeff Garzik int usbnet_nway_reset(struct net_device *net) 9765b2fc499SJeff Garzik { 9775b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 9785b2fc499SJeff Garzik 9795b2fc499SJeff Garzik if (!dev->mii.mdio_write) 9805b2fc499SJeff Garzik return -EOPNOTSUPP; 9815b2fc499SJeff Garzik 9825b2fc499SJeff Garzik return mii_nway_restart(&dev->mii); 9835b2fc499SJeff Garzik } 9845b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_nway_reset); 9855b2fc499SJeff Garzik 9865b2fc499SJeff Garzik void usbnet_get_drvinfo (struct net_device *net, struct ethtool_drvinfo *info) 9875b2fc499SJeff Garzik { 9885b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 9895b2fc499SJeff Garzik 99086a2f415SPhil Sutter strlcpy (info->driver, dev->driver_name, sizeof info->driver); 99186a2f415SPhil Sutter strlcpy (info->version, DRIVER_VERSION, sizeof info->version); 99286a2f415SPhil Sutter strlcpy (info->fw_version, dev->driver_info->description, 9935b2fc499SJeff Garzik sizeof info->fw_version); 9945b2fc499SJeff Garzik usb_make_path (dev->udev, info->bus_info, sizeof info->bus_info); 9955b2fc499SJeff Garzik } 9965b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_drvinfo); 9975b2fc499SJeff Garzik 9985b2fc499SJeff Garzik u32 usbnet_get_msglevel (struct net_device *net) 9995b2fc499SJeff Garzik { 10005b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 10015b2fc499SJeff Garzik 10025b2fc499SJeff Garzik return dev->msg_enable; 10035b2fc499SJeff Garzik } 10045b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_msglevel); 10055b2fc499SJeff Garzik 10065b2fc499SJeff Garzik void usbnet_set_msglevel (struct net_device *net, u32 level) 10075b2fc499SJeff Garzik { 10085b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 10095b2fc499SJeff Garzik 10105b2fc499SJeff Garzik dev->msg_enable = level; 10115b2fc499SJeff Garzik } 10125b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_set_msglevel); 10135b2fc499SJeff Garzik 10145b2fc499SJeff Garzik /* drivers may override default ethtool_ops in their bind() routine */ 10150fc0b732SStephen Hemminger static const struct ethtool_ops usbnet_ethtool_ops = { 10165b2fc499SJeff Garzik .get_settings = usbnet_get_settings, 10175b2fc499SJeff Garzik .set_settings = usbnet_set_settings, 10185b2fc499SJeff Garzik .get_link = usbnet_get_link, 10195b2fc499SJeff Garzik .nway_reset = usbnet_nway_reset, 10205b2fc499SJeff Garzik .get_drvinfo = usbnet_get_drvinfo, 10215b2fc499SJeff Garzik .get_msglevel = usbnet_get_msglevel, 10225b2fc499SJeff Garzik .set_msglevel = usbnet_set_msglevel, 1023123edb18SRichard Cochran .get_ts_info = ethtool_op_get_ts_info, 10245b2fc499SJeff Garzik }; 10255b2fc499SJeff Garzik 10265b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 10275b2fc499SJeff Garzik 10284b49f58fSMing Lei static void __handle_link_change(struct usbnet *dev) 10294b49f58fSMing Lei { 10304b49f58fSMing Lei if (!test_bit(EVENT_DEV_OPEN, &dev->flags)) 10314b49f58fSMing Lei return; 10324b49f58fSMing Lei 10334b49f58fSMing Lei if (!netif_carrier_ok(dev->net)) { 10344b49f58fSMing Lei /* kill URBs for reading packets to save bus bandwidth */ 10354b49f58fSMing Lei unlink_urbs(dev, &dev->rxq); 10364b49f58fSMing Lei 10374b49f58fSMing Lei /* 10384b49f58fSMing Lei * tx_timeout will unlink URBs for sending packets and 10394b49f58fSMing Lei * tx queue is stopped by netcore after link becomes off 10404b49f58fSMing Lei */ 10414b49f58fSMing Lei } else { 10424b49f58fSMing Lei /* submitting URBs for reading packets */ 10434b49f58fSMing Lei tasklet_schedule(&dev->bh); 10444b49f58fSMing Lei } 10454b49f58fSMing Lei 1046*a88c32aeSMing Lei /* hard_mtu or rx_urb_size may change during link change */ 1047*a88c32aeSMing Lei usbnet_update_max_qlen(dev); 1048*a88c32aeSMing Lei 10494b49f58fSMing Lei clear_bit(EVENT_LINK_CHANGE, &dev->flags); 10504b49f58fSMing Lei } 10514b49f58fSMing Lei 10525b2fc499SJeff Garzik /* work that cannot be done in interrupt context uses keventd. 10535b2fc499SJeff Garzik * 10545b2fc499SJeff Garzik * NOTE: with 2.5 we could do more of this using completion callbacks, 10555b2fc499SJeff Garzik * especially now that control transfers can be queued. 10565b2fc499SJeff Garzik */ 10575b2fc499SJeff Garzik static void 10585b2fc499SJeff Garzik kevent (struct work_struct *work) 10595b2fc499SJeff Garzik { 10605b2fc499SJeff Garzik struct usbnet *dev = 10615b2fc499SJeff Garzik container_of(work, struct usbnet, kevent); 10625b2fc499SJeff Garzik int status; 10635b2fc499SJeff Garzik 10645b2fc499SJeff Garzik /* usb_clear_halt() needs a thread context */ 10655b2fc499SJeff Garzik if (test_bit (EVENT_TX_HALT, &dev->flags)) { 10665b2fc499SJeff Garzik unlink_urbs (dev, &dev->txq); 106769ee472fSOliver Neukum status = usb_autopm_get_interface(dev->intf); 106869ee472fSOliver Neukum if (status < 0) 106969ee472fSOliver Neukum goto fail_pipe; 10705b2fc499SJeff Garzik status = usb_clear_halt (dev->udev, dev->out); 107169ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 10728e95a202SJoe Perches if (status < 0 && 10738e95a202SJoe Perches status != -EPIPE && 10748e95a202SJoe Perches status != -ESHUTDOWN) { 10755b2fc499SJeff Garzik if (netif_msg_tx_err (dev)) 107669ee472fSOliver Neukum fail_pipe: 107760b86755SJoe Perches netdev_err(dev->net, "can't clear tx halt, status %d\n", 10785b2fc499SJeff Garzik status); 10795b2fc499SJeff Garzik } else { 10805b2fc499SJeff Garzik clear_bit (EVENT_TX_HALT, &dev->flags); 10815b2fc499SJeff Garzik if (status != -ESHUTDOWN) 10825b2fc499SJeff Garzik netif_wake_queue (dev->net); 10835b2fc499SJeff Garzik } 10845b2fc499SJeff Garzik } 10855b2fc499SJeff Garzik if (test_bit (EVENT_RX_HALT, &dev->flags)) { 10865b2fc499SJeff Garzik unlink_urbs (dev, &dev->rxq); 108769ee472fSOliver Neukum status = usb_autopm_get_interface(dev->intf); 108869ee472fSOliver Neukum if (status < 0) 108969ee472fSOliver Neukum goto fail_halt; 10905b2fc499SJeff Garzik status = usb_clear_halt (dev->udev, dev->in); 109169ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 10928e95a202SJoe Perches if (status < 0 && 10938e95a202SJoe Perches status != -EPIPE && 10948e95a202SJoe Perches status != -ESHUTDOWN) { 10955b2fc499SJeff Garzik if (netif_msg_rx_err (dev)) 109669ee472fSOliver Neukum fail_halt: 109760b86755SJoe Perches netdev_err(dev->net, "can't clear rx halt, status %d\n", 10985b2fc499SJeff Garzik status); 10995b2fc499SJeff Garzik } else { 11005b2fc499SJeff Garzik clear_bit (EVENT_RX_HALT, &dev->flags); 11015b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 11025b2fc499SJeff Garzik } 11035b2fc499SJeff Garzik } 11045b2fc499SJeff Garzik 11055b2fc499SJeff Garzik /* tasklet could resubmit itself forever if memory is tight */ 11065b2fc499SJeff Garzik if (test_bit (EVENT_RX_MEMORY, &dev->flags)) { 11075b2fc499SJeff Garzik struct urb *urb = NULL; 1108dacb3975SDavid S. Miller int resched = 1; 11095b2fc499SJeff Garzik 11105b2fc499SJeff Garzik if (netif_running (dev->net)) 11115b2fc499SJeff Garzik urb = usb_alloc_urb (0, GFP_KERNEL); 11125b2fc499SJeff Garzik else 11135b2fc499SJeff Garzik clear_bit (EVENT_RX_MEMORY, &dev->flags); 11145b2fc499SJeff Garzik if (urb != NULL) { 11155b2fc499SJeff Garzik clear_bit (EVENT_RX_MEMORY, &dev->flags); 111669ee472fSOliver Neukum status = usb_autopm_get_interface(dev->intf); 1117ab60707fSJesper Juhl if (status < 0) { 1118ab60707fSJesper Juhl usb_free_urb(urb); 111969ee472fSOliver Neukum goto fail_lowmem; 1120ab60707fSJesper Juhl } 1121dacb3975SDavid S. Miller if (rx_submit (dev, urb, GFP_KERNEL) == -ENOLINK) 1122dacb3975SDavid S. Miller resched = 0; 112369ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 112469ee472fSOliver Neukum fail_lowmem: 1125dacb3975SDavid S. Miller if (resched) 11265b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 11275b2fc499SJeff Garzik } 11285b2fc499SJeff Garzik } 11295b2fc499SJeff Garzik 11305b2fc499SJeff Garzik if (test_bit (EVENT_LINK_RESET, &dev->flags)) { 11315b2fc499SJeff Garzik struct driver_info *info = dev->driver_info; 11325b2fc499SJeff Garzik int retval = 0; 11335b2fc499SJeff Garzik 11345b2fc499SJeff Garzik clear_bit (EVENT_LINK_RESET, &dev->flags); 113569ee472fSOliver Neukum status = usb_autopm_get_interface(dev->intf); 113669ee472fSOliver Neukum if (status < 0) 113769ee472fSOliver Neukum goto skip_reset; 11385b2fc499SJeff Garzik if(info->link_reset && (retval = info->link_reset(dev)) < 0) { 113969ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 114069ee472fSOliver Neukum skip_reset: 114160b86755SJoe Perches netdev_info(dev->net, "link reset failed (%d) usbnet usb-%s-%s, %s\n", 11425b2fc499SJeff Garzik retval, 114360b86755SJoe Perches dev->udev->bus->bus_name, 114460b86755SJoe Perches dev->udev->devpath, 11455b2fc499SJeff Garzik info->description); 114669ee472fSOliver Neukum } else { 114769ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 11485b2fc499SJeff Garzik } 11494b49f58fSMing Lei 11504b49f58fSMing Lei /* handle link change from link resetting */ 11514b49f58fSMing Lei __handle_link_change(dev); 11525b2fc499SJeff Garzik } 11535b2fc499SJeff Garzik 11544b49f58fSMing Lei if (test_bit (EVENT_LINK_CHANGE, &dev->flags)) 11554b49f58fSMing Lei __handle_link_change(dev); 11564b49f58fSMing Lei 11575b2fc499SJeff Garzik if (dev->flags) 115860b86755SJoe Perches netdev_dbg(dev->net, "kevent done, flags = 0x%lx\n", dev->flags); 11595b2fc499SJeff Garzik } 11605b2fc499SJeff Garzik 11615b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 11625b2fc499SJeff Garzik 11635b2fc499SJeff Garzik static void tx_complete (struct urb *urb) 11645b2fc499SJeff Garzik { 11655b2fc499SJeff Garzik struct sk_buff *skb = (struct sk_buff *) urb->context; 11665b2fc499SJeff Garzik struct skb_data *entry = (struct skb_data *) skb->cb; 11675b2fc499SJeff Garzik struct usbnet *dev = entry->dev; 11685b2fc499SJeff Garzik 11695b2fc499SJeff Garzik if (urb->status == 0) { 1170073285fdSAlexey Orishko if (!(dev->driver_info->flags & FLAG_MULTI_PACKET)) 11717963837fSHerbert Xu dev->net->stats.tx_packets++; 11727963837fSHerbert Xu dev->net->stats.tx_bytes += entry->length; 11735b2fc499SJeff Garzik } else { 11747963837fSHerbert Xu dev->net->stats.tx_errors++; 11755b2fc499SJeff Garzik 11765b2fc499SJeff Garzik switch (urb->status) { 11775b2fc499SJeff Garzik case -EPIPE: 11785b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_TX_HALT); 11795b2fc499SJeff Garzik break; 11805b2fc499SJeff Garzik 11815b2fc499SJeff Garzik /* software-driven interface shutdown */ 11825b2fc499SJeff Garzik case -ECONNRESET: // async unlink 11835b2fc499SJeff Garzik case -ESHUTDOWN: // hardware gone 11845b2fc499SJeff Garzik break; 11855b2fc499SJeff Garzik 11865b2fc499SJeff Garzik // like rx, tx gets controller i/o faults during khubd delays 11875b2fc499SJeff Garzik // and so it uses the same throttling mechanism. 11885b2fc499SJeff Garzik case -EPROTO: 11895b2fc499SJeff Garzik case -ETIME: 11905b2fc499SJeff Garzik case -EILSEQ: 119169ee472fSOliver Neukum usb_mark_last_busy(dev->udev); 11925b2fc499SJeff Garzik if (!timer_pending (&dev->delay)) { 11935b2fc499SJeff Garzik mod_timer (&dev->delay, 11945b2fc499SJeff Garzik jiffies + THROTTLE_JIFFIES); 1195a475f603SJoe Perches netif_dbg(dev, link, dev->net, 1196a475f603SJoe Perches "tx throttle %d\n", urb->status); 11975b2fc499SJeff Garzik } 11985b2fc499SJeff Garzik netif_stop_queue (dev->net); 11995b2fc499SJeff Garzik break; 12005b2fc499SJeff Garzik default: 1201a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, 1202a475f603SJoe Perches "tx err %d\n", entry->urb->status); 12035b2fc499SJeff Garzik break; 12045b2fc499SJeff Garzik } 12055b2fc499SJeff Garzik } 12065b2fc499SJeff Garzik 120769ee472fSOliver Neukum usb_autopm_put_interface_async(dev->intf); 12085b6e9bcdSMing Lei (void) defer_bh(dev, skb, &dev->txq, tx_done); 12095b2fc499SJeff Garzik } 12105b2fc499SJeff Garzik 12115b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 12125b2fc499SJeff Garzik 1213777baa47SStephen Hemminger void usbnet_tx_timeout (struct net_device *net) 12145b2fc499SJeff Garzik { 12155b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 12165b2fc499SJeff Garzik 12175b2fc499SJeff Garzik unlink_urbs (dev, &dev->txq); 12185b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 12195b2fc499SJeff Garzik 12205b2fc499SJeff Garzik // FIXME: device recovery -- reset? 12215b2fc499SJeff Garzik } 1222777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_tx_timeout); 12235b2fc499SJeff Garzik 12245b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 12255b2fc499SJeff Garzik 122625a79c41SStephen Hemminger netdev_tx_t usbnet_start_xmit (struct sk_buff *skb, 122725a79c41SStephen Hemminger struct net_device *net) 12285b2fc499SJeff Garzik { 12295b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 12305b2fc499SJeff Garzik int length; 12315b2fc499SJeff Garzik struct urb *urb = NULL; 12325b2fc499SJeff Garzik struct skb_data *entry; 12335b2fc499SJeff Garzik struct driver_info *info = dev->driver_info; 12345b2fc499SJeff Garzik unsigned long flags; 123525a79c41SStephen Hemminger int retval; 12365b2fc499SJeff Garzik 123723ba0799SKonstantin Khlebnikov if (skb) 1238f9b491ecSMichael Riesch skb_tx_timestamp(skb); 1239f9b491ecSMichael Riesch 12405b2fc499SJeff Garzik // some devices want funky USB-level framing, for 12415b2fc499SJeff Garzik // win32 driver (usually) and/or hardware quirks 12425b2fc499SJeff Garzik if (info->tx_fixup) { 12435b2fc499SJeff Garzik skb = info->tx_fixup (dev, skb, GFP_ATOMIC); 12445b2fc499SJeff Garzik if (!skb) { 1245bf414b36SBjørn Mork /* packet collected; minidriver waiting for more */ 1246bf414b36SBjørn Mork if (info->flags & FLAG_MULTI_PACKET) 1247bf414b36SBjørn Mork goto not_drop; 1248a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, "can't tx_fixup skb\n"); 12495b2fc499SJeff Garzik goto drop; 12505b2fc499SJeff Garzik } 12515b2fc499SJeff Garzik } 12525b2fc499SJeff Garzik length = skb->len; 12535b2fc499SJeff Garzik 12545b2fc499SJeff Garzik if (!(urb = usb_alloc_urb (0, GFP_ATOMIC))) { 1255a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, "no urb\n"); 12565b2fc499SJeff Garzik goto drop; 12575b2fc499SJeff Garzik } 12585b2fc499SJeff Garzik 12595b2fc499SJeff Garzik entry = (struct skb_data *) skb->cb; 12605b2fc499SJeff Garzik entry->urb = urb; 12615b2fc499SJeff Garzik entry->dev = dev; 12625b2fc499SJeff Garzik entry->length = length; 12635b2fc499SJeff Garzik 12645b2fc499SJeff Garzik usb_fill_bulk_urb (urb, dev->udev, dev->out, 12655b2fc499SJeff Garzik skb->data, skb->len, tx_complete, skb); 12665b2fc499SJeff Garzik 12675b2fc499SJeff Garzik /* don't assume the hardware handles USB_ZERO_PACKET 12685b2fc499SJeff Garzik * NOTE: strictly conforming cdc-ether devices should expect 12695b2fc499SJeff Garzik * the ZLP here, but ignore the one-byte packet. 1270073285fdSAlexey Orishko * NOTE2: CDC NCM specification is different from CDC ECM when 1271073285fdSAlexey Orishko * handling ZLP/short packets, so cdc_ncm driver will make short 1272073285fdSAlexey Orishko * packet itself if needed. 12735b2fc499SJeff Garzik */ 1274b4d562e3SElina Pasheva if (length % dev->maxpacket == 0) { 1275b4d562e3SElina Pasheva if (!(info->flags & FLAG_SEND_ZLP)) { 1276073285fdSAlexey Orishko if (!(info->flags & FLAG_MULTI_PACKET)) { 12775b2fc499SJeff Garzik urb->transfer_buffer_length++; 12783e323f3eSPeter Korsgaard if (skb_tailroom(skb)) { 12793e323f3eSPeter Korsgaard skb->data[skb->len] = 0; 12803e323f3eSPeter Korsgaard __skb_put(skb, 1); 12813e323f3eSPeter Korsgaard } 1282073285fdSAlexey Orishko } 1283b4d562e3SElina Pasheva } else 1284b4d562e3SElina Pasheva urb->transfer_flags |= URB_ZERO_PACKET; 12853e323f3eSPeter Korsgaard } 12865b2fc499SJeff Garzik 12875b2fc499SJeff Garzik spin_lock_irqsave(&dev->txq.lock, flags); 128869ee472fSOliver Neukum retval = usb_autopm_get_interface_async(dev->intf); 128969ee472fSOliver Neukum if (retval < 0) { 129069ee472fSOliver Neukum spin_unlock_irqrestore(&dev->txq.lock, flags); 129169ee472fSOliver Neukum goto drop; 129269ee472fSOliver Neukum } 129369ee472fSOliver Neukum 129469ee472fSOliver Neukum #ifdef CONFIG_PM 129569ee472fSOliver Neukum /* if this triggers the device is still a sleep */ 129669ee472fSOliver Neukum if (test_bit(EVENT_DEV_ASLEEP, &dev->flags)) { 129769ee472fSOliver Neukum /* transmission will be done in resume */ 129869ee472fSOliver Neukum usb_anchor_urb(urb, &dev->deferred); 129969ee472fSOliver Neukum /* no use to process more packets */ 130069ee472fSOliver Neukum netif_stop_queue(net); 130139707c2aSHemant Kumar usb_put_urb(urb); 130269ee472fSOliver Neukum spin_unlock_irqrestore(&dev->txq.lock, flags); 130360b86755SJoe Perches netdev_dbg(dev->net, "Delaying transmission for resumption\n"); 130469ee472fSOliver Neukum goto deferred; 130569ee472fSOliver Neukum } 130669ee472fSOliver Neukum #endif 13075b2fc499SJeff Garzik 13085b2fc499SJeff Garzik switch ((retval = usb_submit_urb (urb, GFP_ATOMIC))) { 13095b2fc499SJeff Garzik case -EPIPE: 13105b2fc499SJeff Garzik netif_stop_queue (net); 13115b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_TX_HALT); 131269ee472fSOliver Neukum usb_autopm_put_interface_async(dev->intf); 13135b2fc499SJeff Garzik break; 13145b2fc499SJeff Garzik default: 131569ee472fSOliver Neukum usb_autopm_put_interface_async(dev->intf); 1316a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, 1317a475f603SJoe Perches "tx: submit urb err %d\n", retval); 13185b2fc499SJeff Garzik break; 13195b2fc499SJeff Garzik case 0: 13205b2fc499SJeff Garzik net->trans_start = jiffies; 13215b6e9bcdSMing Lei __usbnet_queue_skb(&dev->txq, skb, tx_start); 13225b2fc499SJeff Garzik if (dev->txq.qlen >= TX_QLEN (dev)) 13235b2fc499SJeff Garzik netif_stop_queue (net); 13245b2fc499SJeff Garzik } 13255b2fc499SJeff Garzik spin_unlock_irqrestore (&dev->txq.lock, flags); 13265b2fc499SJeff Garzik 13275b2fc499SJeff Garzik if (retval) { 1328a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, "drop, code %d\n", retval); 13295b2fc499SJeff Garzik drop: 13307963837fSHerbert Xu dev->net->stats.tx_dropped++; 1331073285fdSAlexey Orishko not_drop: 13325b2fc499SJeff Garzik if (skb) 13335b2fc499SJeff Garzik dev_kfree_skb_any (skb); 13345b2fc499SJeff Garzik usb_free_urb (urb); 1335a475f603SJoe Perches } else 1336a475f603SJoe Perches netif_dbg(dev, tx_queued, dev->net, 1337a475f603SJoe Perches "> tx, len %d, type 0x%x\n", length, skb->protocol); 133869ee472fSOliver Neukum #ifdef CONFIG_PM 133969ee472fSOliver Neukum deferred: 134069ee472fSOliver Neukum #endif 134125a79c41SStephen Hemminger return NETDEV_TX_OK; 13425b2fc499SJeff Garzik } 1343777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_start_xmit); 13445b2fc499SJeff Garzik 134585e87870SBjørn Mork static int rx_alloc_submit(struct usbnet *dev, gfp_t flags) 134665841fd5SMing Lei { 134765841fd5SMing Lei struct urb *urb; 134865841fd5SMing Lei int i; 134985e87870SBjørn Mork int ret = 0; 135065841fd5SMing Lei 135165841fd5SMing Lei /* don't refill the queue all at once */ 135265841fd5SMing Lei for (i = 0; i < 10 && dev->rxq.qlen < RX_QLEN(dev); i++) { 135365841fd5SMing Lei urb = usb_alloc_urb(0, flags); 135465841fd5SMing Lei if (urb != NULL) { 135585e87870SBjørn Mork ret = rx_submit(dev, urb, flags); 135685e87870SBjørn Mork if (ret) 135785e87870SBjørn Mork goto err; 135885e87870SBjørn Mork } else { 135985e87870SBjørn Mork ret = -ENOMEM; 136085e87870SBjørn Mork goto err; 136165841fd5SMing Lei } 136265841fd5SMing Lei } 136385e87870SBjørn Mork err: 136485e87870SBjørn Mork return ret; 136565841fd5SMing Lei } 136665841fd5SMing Lei 13675b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 13685b2fc499SJeff Garzik 13695b2fc499SJeff Garzik // tasklet (work deferred from completions, in_irq) or timer 13705b2fc499SJeff Garzik 13715b2fc499SJeff Garzik static void usbnet_bh (unsigned long param) 13725b2fc499SJeff Garzik { 13735b2fc499SJeff Garzik struct usbnet *dev = (struct usbnet *) param; 13745b2fc499SJeff Garzik struct sk_buff *skb; 13755b2fc499SJeff Garzik struct skb_data *entry; 13765b2fc499SJeff Garzik 13775b2fc499SJeff Garzik while ((skb = skb_dequeue (&dev->done))) { 13785b2fc499SJeff Garzik entry = (struct skb_data *) skb->cb; 13795b2fc499SJeff Garzik switch (entry->state) { 13805b2fc499SJeff Garzik case rx_done: 13815b2fc499SJeff Garzik entry->state = rx_cleanup; 13825b2fc499SJeff Garzik rx_process (dev, skb); 13835b2fc499SJeff Garzik continue; 13845b2fc499SJeff Garzik case tx_done: 13855b2fc499SJeff Garzik case rx_cleanup: 13865b2fc499SJeff Garzik usb_free_urb (entry->urb); 13875b2fc499SJeff Garzik dev_kfree_skb (skb); 13885b2fc499SJeff Garzik continue; 13895b2fc499SJeff Garzik default: 139060b86755SJoe Perches netdev_dbg(dev->net, "bogus skb state %d\n", entry->state); 13915b2fc499SJeff Garzik } 13925b2fc499SJeff Garzik } 13935b2fc499SJeff Garzik 139470c37bf9SBjørn Mork /* restart RX again after disabling due to high error rate */ 139570c37bf9SBjørn Mork clear_bit(EVENT_RX_KILL, &dev->flags); 139670c37bf9SBjørn Mork 13975b2fc499SJeff Garzik // waiting for all pending urbs to complete? 13985b2fc499SJeff Garzik if (dev->wait) { 13995b2fc499SJeff Garzik if ((dev->txq.qlen + dev->rxq.qlen + dev->done.qlen) == 0) { 14005b2fc499SJeff Garzik wake_up (dev->wait); 14015b2fc499SJeff Garzik } 14025b2fc499SJeff Garzik 14035b2fc499SJeff Garzik // or are we maybe short a few urbs? 14048e95a202SJoe Perches } else if (netif_running (dev->net) && 14058e95a202SJoe Perches netif_device_present (dev->net) && 14064b49f58fSMing Lei netif_carrier_ok(dev->net) && 14078e95a202SJoe Perches !timer_pending (&dev->delay) && 14088e95a202SJoe Perches !test_bit (EVENT_RX_HALT, &dev->flags)) { 14095b2fc499SJeff Garzik int temp = dev->rxq.qlen; 14105b2fc499SJeff Garzik 141165841fd5SMing Lei if (temp < RX_QLEN(dev)) { 141285e87870SBjørn Mork if (rx_alloc_submit(dev, GFP_ATOMIC) == -ENOLINK) 141385e87870SBjørn Mork return; 1414a475f603SJoe Perches if (temp != dev->rxq.qlen) 1415a475f603SJoe Perches netif_dbg(dev, link, dev->net, 1416a475f603SJoe Perches "rxqlen %d --> %d\n", 14175b2fc499SJeff Garzik temp, dev->rxq.qlen); 141865841fd5SMing Lei if (dev->rxq.qlen < RX_QLEN(dev)) 14195b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 14205b2fc499SJeff Garzik } 14215b2fc499SJeff Garzik if (dev->txq.qlen < TX_QLEN (dev)) 14225b2fc499SJeff Garzik netif_wake_queue (dev->net); 14235b2fc499SJeff Garzik } 14245b2fc499SJeff Garzik } 14255b2fc499SJeff Garzik 14265b2fc499SJeff Garzik 14275b2fc499SJeff Garzik /*------------------------------------------------------------------------- 14285b2fc499SJeff Garzik * 14295b2fc499SJeff Garzik * USB Device Driver support 14305b2fc499SJeff Garzik * 14315b2fc499SJeff Garzik *-------------------------------------------------------------------------*/ 14325b2fc499SJeff Garzik 14335b2fc499SJeff Garzik // precondition: never called in_interrupt 14345b2fc499SJeff Garzik 14355b2fc499SJeff Garzik void usbnet_disconnect (struct usb_interface *intf) 14365b2fc499SJeff Garzik { 14375b2fc499SJeff Garzik struct usbnet *dev; 14385b2fc499SJeff Garzik struct usb_device *xdev; 14395b2fc499SJeff Garzik struct net_device *net; 14405b2fc499SJeff Garzik 14415b2fc499SJeff Garzik dev = usb_get_intfdata(intf); 14425b2fc499SJeff Garzik usb_set_intfdata(intf, NULL); 14435b2fc499SJeff Garzik if (!dev) 14445b2fc499SJeff Garzik return; 14455b2fc499SJeff Garzik 14465b2fc499SJeff Garzik xdev = interface_to_usbdev (intf); 14475b2fc499SJeff Garzik 1448a475f603SJoe Perches netif_info(dev, probe, dev->net, "unregister '%s' usb-%s-%s, %s\n", 14495b2fc499SJeff Garzik intf->dev.driver->name, 14505b2fc499SJeff Garzik xdev->bus->bus_name, xdev->devpath, 14515b2fc499SJeff Garzik dev->driver_info->description); 14525b2fc499SJeff Garzik 14535b2fc499SJeff Garzik net = dev->net; 14545b2fc499SJeff Garzik unregister_netdev (net); 14555b2fc499SJeff Garzik 145623f333a2STejun Heo cancel_work_sync(&dev->kevent); 14575b2fc499SJeff Garzik 145839707c2aSHemant Kumar usb_scuttle_anchored_urbs(&dev->deferred); 145939707c2aSHemant Kumar 14605b2fc499SJeff Garzik if (dev->driver_info->unbind) 14615b2fc499SJeff Garzik dev->driver_info->unbind (dev, intf); 14625b2fc499SJeff Garzik 146368972efaSPaul Stewart usb_kill_urb(dev->interrupt); 146468972efaSPaul Stewart usb_free_urb(dev->interrupt); 146568972efaSPaul Stewart 14665b2fc499SJeff Garzik free_netdev(net); 14675b2fc499SJeff Garzik } 14685b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_disconnect); 14695b2fc499SJeff Garzik 1470777baa47SStephen Hemminger static const struct net_device_ops usbnet_netdev_ops = { 1471777baa47SStephen Hemminger .ndo_open = usbnet_open, 1472777baa47SStephen Hemminger .ndo_stop = usbnet_stop, 1473777baa47SStephen Hemminger .ndo_start_xmit = usbnet_start_xmit, 1474777baa47SStephen Hemminger .ndo_tx_timeout = usbnet_tx_timeout, 1475777baa47SStephen Hemminger .ndo_change_mtu = usbnet_change_mtu, 1476777baa47SStephen Hemminger .ndo_set_mac_address = eth_mac_addr, 1477777baa47SStephen Hemminger .ndo_validate_addr = eth_validate_addr, 1478777baa47SStephen Hemminger }; 14795b2fc499SJeff Garzik 14805b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 14815b2fc499SJeff Garzik 14825b2fc499SJeff Garzik // precondition: never called in_interrupt 14835b2fc499SJeff Garzik 1484225794f8SMarcel Holtmann static struct device_type wlan_type = { 1485225794f8SMarcel Holtmann .name = "wlan", 1486225794f8SMarcel Holtmann }; 1487225794f8SMarcel Holtmann 1488225794f8SMarcel Holtmann static struct device_type wwan_type = { 1489225794f8SMarcel Holtmann .name = "wwan", 1490225794f8SMarcel Holtmann }; 1491225794f8SMarcel Holtmann 14925b2fc499SJeff Garzik int 14935b2fc499SJeff Garzik usbnet_probe (struct usb_interface *udev, const struct usb_device_id *prod) 14945b2fc499SJeff Garzik { 14955b2fc499SJeff Garzik struct usbnet *dev; 14965b2fc499SJeff Garzik struct net_device *net; 14975b2fc499SJeff Garzik struct usb_host_interface *interface; 14985b2fc499SJeff Garzik struct driver_info *info; 14995b2fc499SJeff Garzik struct usb_device *xdev; 15005b2fc499SJeff Garzik int status; 15015b2fc499SJeff Garzik const char *name; 1502b0786b43SMing Lei struct usb_driver *driver = to_usb_driver(udev->dev.driver); 1503b0786b43SMing Lei 1504b0786b43SMing Lei /* usbnet already took usb runtime pm, so have to enable the feature 1505b0786b43SMing Lei * for usb interface, otherwise usb_autopm_get_interface may return 150698f541c6SAlan Stern * failure if RUNTIME_PM is enabled. 1507b0786b43SMing Lei */ 1508b0786b43SMing Lei if (!driver->supports_autosuspend) { 1509b0786b43SMing Lei driver->supports_autosuspend = 1; 1510b0786b43SMing Lei pm_runtime_enable(&udev->dev); 1511b0786b43SMing Lei } 15125b2fc499SJeff Garzik 15135b2fc499SJeff Garzik name = udev->dev.driver->name; 15145b2fc499SJeff Garzik info = (struct driver_info *) prod->driver_info; 15155b2fc499SJeff Garzik if (!info) { 15165b2fc499SJeff Garzik dev_dbg (&udev->dev, "blacklisted by %s\n", name); 15175b2fc499SJeff Garzik return -ENODEV; 15185b2fc499SJeff Garzik } 15195b2fc499SJeff Garzik xdev = interface_to_usbdev (udev); 15205b2fc499SJeff Garzik interface = udev->cur_altsetting; 15215b2fc499SJeff Garzik 15225b2fc499SJeff Garzik status = -ENOMEM; 15235b2fc499SJeff Garzik 15245b2fc499SJeff Garzik // set up our own records 15255b2fc499SJeff Garzik net = alloc_etherdev(sizeof(*dev)); 152641de8d4cSJoe Perches if (!net) 15275b2fc499SJeff Garzik goto out; 15285b2fc499SJeff Garzik 15290dacca73SBen Hutchings /* netdev_printk() needs this so do it as early as possible */ 15300dacca73SBen Hutchings SET_NETDEV_DEV(net, &udev->dev); 15310dacca73SBen Hutchings 15325b2fc499SJeff Garzik dev = netdev_priv(net); 15335b2fc499SJeff Garzik dev->udev = xdev; 1534a11a6544SOliver Neukum dev->intf = udev; 15355b2fc499SJeff Garzik dev->driver_info = info; 15365b2fc499SJeff Garzik dev->driver_name = name; 15375b2fc499SJeff Garzik dev->msg_enable = netif_msg_init (msg_level, NETIF_MSG_DRV 15385b2fc499SJeff Garzik | NETIF_MSG_PROBE | NETIF_MSG_LINK); 15395b2fc499SJeff Garzik skb_queue_head_init (&dev->rxq); 15405b2fc499SJeff Garzik skb_queue_head_init (&dev->txq); 15415b2fc499SJeff Garzik skb_queue_head_init (&dev->done); 15427834ddbcSJussi Kivilinna skb_queue_head_init(&dev->rxq_pause); 15435b2fc499SJeff Garzik dev->bh.func = usbnet_bh; 15445b2fc499SJeff Garzik dev->bh.data = (unsigned long) dev; 15455b2fc499SJeff Garzik INIT_WORK (&dev->kevent, kevent); 154669ee472fSOliver Neukum init_usb_anchor(&dev->deferred); 15475b2fc499SJeff Garzik dev->delay.function = usbnet_bh; 15485b2fc499SJeff Garzik dev->delay.data = (unsigned long) dev; 15495b2fc499SJeff Garzik init_timer (&dev->delay); 15505b2fc499SJeff Garzik mutex_init (&dev->phy_mutex); 15516eecdc5fSDan Williams mutex_init(&dev->interrupt_mutex); 15526eecdc5fSDan Williams dev->interrupt_count = 0; 15535b2fc499SJeff Garzik 15545b2fc499SJeff Garzik dev->net = net; 15555b2fc499SJeff Garzik strcpy (net->name, "usb%d"); 15565b2fc499SJeff Garzik memcpy (net->dev_addr, node_id, sizeof node_id); 15575b2fc499SJeff Garzik 15585b2fc499SJeff Garzik /* rx and tx sides can use different message sizes; 15595b2fc499SJeff Garzik * bind() should set rx_urb_size in that case. 15605b2fc499SJeff Garzik */ 15615b2fc499SJeff Garzik dev->hard_mtu = net->mtu + net->hard_header_len; 15625b2fc499SJeff Garzik #if 0 15635b2fc499SJeff Garzik // dma_supported() is deeply broken on almost all architectures 15645b2fc499SJeff Garzik // possible with some EHCI controllers 15656a35528aSYang Hongyang if (dma_supported (&udev->dev, DMA_BIT_MASK(64))) 15665b2fc499SJeff Garzik net->features |= NETIF_F_HIGHDMA; 15675b2fc499SJeff Garzik #endif 15685b2fc499SJeff Garzik 1569777baa47SStephen Hemminger net->netdev_ops = &usbnet_netdev_ops; 1570777baa47SStephen Hemminger net->watchdog_timeo = TX_TIMEOUT_JIFFIES; 15715b2fc499SJeff Garzik net->ethtool_ops = &usbnet_ethtool_ops; 15725b2fc499SJeff Garzik 15735b2fc499SJeff Garzik // allow device-specific bind/init procedures 15745b2fc499SJeff Garzik // NOTE net->name still not usable ... 15755b2fc499SJeff Garzik if (info->bind) { 15765b2fc499SJeff Garzik status = info->bind (dev, udev); 15775b2fc499SJeff Garzik if (status < 0) 15785b2fc499SJeff Garzik goto out1; 15795b2fc499SJeff Garzik 15805b2fc499SJeff Garzik // heuristic: "usb%d" for links we know are two-host, 15815b2fc499SJeff Garzik // else "eth%d" when there's reasonable doubt. userspace 15825b2fc499SJeff Garzik // can rename the link if it knows better. 15838e95a202SJoe Perches if ((dev->driver_info->flags & FLAG_ETHER) != 0 && 1584c261344dSArnd Bergmann ((dev->driver_info->flags & FLAG_POINTTOPOINT) == 0 || 1585c261344dSArnd Bergmann (net->dev_addr [0] & 0x02) == 0)) 15865b2fc499SJeff Garzik strcpy (net->name, "eth%d"); 15876e3bbcc5SJussi Kivilinna /* WLAN devices should always be named "wlan%d" */ 15886e3bbcc5SJussi Kivilinna if ((dev->driver_info->flags & FLAG_WLAN) != 0) 15896e3bbcc5SJussi Kivilinna strcpy(net->name, "wlan%d"); 1590e1e499eeSMarcel Holtmann /* WWAN devices should always be named "wwan%d" */ 1591e1e499eeSMarcel Holtmann if ((dev->driver_info->flags & FLAG_WWAN) != 0) 1592e1e499eeSMarcel Holtmann strcpy(net->name, "wwan%d"); 15935b2fc499SJeff Garzik 15946509141fSWei Shuai /* devices that cannot do ARP */ 15956509141fSWei Shuai if ((dev->driver_info->flags & FLAG_NOARP) != 0) 15966509141fSWei Shuai net->flags |= IFF_NOARP; 15976509141fSWei Shuai 15985b2fc499SJeff Garzik /* maybe the remote can't receive an Ethernet MTU */ 15995b2fc499SJeff Garzik if (net->mtu > (dev->hard_mtu - net->hard_header_len)) 16005b2fc499SJeff Garzik net->mtu = dev->hard_mtu - net->hard_header_len; 16015b2fc499SJeff Garzik } else if (!info->in || !info->out) 16025b2fc499SJeff Garzik status = usbnet_get_endpoints (dev, udev); 16035b2fc499SJeff Garzik else { 16045b2fc499SJeff Garzik dev->in = usb_rcvbulkpipe (xdev, info->in); 16055b2fc499SJeff Garzik dev->out = usb_sndbulkpipe (xdev, info->out); 16065b2fc499SJeff Garzik if (!(info->flags & FLAG_NO_SETINT)) 16075b2fc499SJeff Garzik status = usb_set_interface (xdev, 16085b2fc499SJeff Garzik interface->desc.bInterfaceNumber, 16095b2fc499SJeff Garzik interface->desc.bAlternateSetting); 16105b2fc499SJeff Garzik else 16115b2fc499SJeff Garzik status = 0; 16125b2fc499SJeff Garzik 16135b2fc499SJeff Garzik } 16149514bfe5SPeter Korsgaard if (status >= 0 && dev->status) 16155b2fc499SJeff Garzik status = init_status (dev, udev); 16165b2fc499SJeff Garzik if (status < 0) 16175b2fc499SJeff Garzik goto out3; 16185b2fc499SJeff Garzik 16195b2fc499SJeff Garzik if (!dev->rx_urb_size) 16205b2fc499SJeff Garzik dev->rx_urb_size = dev->hard_mtu; 16215b2fc499SJeff Garzik dev->maxpacket = usb_maxpacket (dev->udev, dev->out, 1); 16225b2fc499SJeff Garzik 1623225794f8SMarcel Holtmann if ((dev->driver_info->flags & FLAG_WLAN) != 0) 1624225794f8SMarcel Holtmann SET_NETDEV_DEVTYPE(net, &wlan_type); 1625225794f8SMarcel Holtmann if ((dev->driver_info->flags & FLAG_WWAN) != 0) 1626225794f8SMarcel Holtmann SET_NETDEV_DEVTYPE(net, &wwan_type); 1627225794f8SMarcel Holtmann 1628*a88c32aeSMing Lei /* initialize max rx_qlen and tx_qlen */ 1629*a88c32aeSMing Lei usbnet_update_max_qlen(dev); 1630*a88c32aeSMing Lei 16315b2fc499SJeff Garzik status = register_netdev (net); 16325b2fc499SJeff Garzik if (status) 1633a4723848Stom.leiming@gmail.com goto out4; 1634a475f603SJoe Perches netif_info(dev, probe, dev->net, 1635a475f603SJoe Perches "register '%s' at usb-%s-%s, %s, %pM\n", 16365b2fc499SJeff Garzik udev->dev.driver->name, 16375b2fc499SJeff Garzik xdev->bus->bus_name, xdev->devpath, 16385b2fc499SJeff Garzik dev->driver_info->description, 1639e174961cSJohannes Berg net->dev_addr); 16405b2fc499SJeff Garzik 16415b2fc499SJeff Garzik // ok, it's ready to go. 16425b2fc499SJeff Garzik usb_set_intfdata (udev, dev); 16435b2fc499SJeff Garzik 16445b2fc499SJeff Garzik netif_device_attach (net); 16455b2fc499SJeff Garzik 164637e8273cSBen Hutchings if (dev->driver_info->flags & FLAG_LINK_INTR) 16470162c554SMing Lei usbnet_link_change(dev, 0, 0); 164837e8273cSBen Hutchings 16495b2fc499SJeff Garzik return 0; 16505b2fc499SJeff Garzik 1651a4723848Stom.leiming@gmail.com out4: 1652a4723848Stom.leiming@gmail.com usb_free_urb(dev->interrupt); 16535b2fc499SJeff Garzik out3: 16545b2fc499SJeff Garzik if (info->unbind) 16555b2fc499SJeff Garzik info->unbind (dev, udev); 16565b2fc499SJeff Garzik out1: 16575b2fc499SJeff Garzik free_netdev(net); 16585b2fc499SJeff Garzik out: 16595b2fc499SJeff Garzik return status; 16605b2fc499SJeff Garzik } 16615b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_probe); 16625b2fc499SJeff Garzik 16635b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 16645b2fc499SJeff Garzik 166536433127SOliver Neukum /* 166636433127SOliver Neukum * suspend the whole driver as soon as the first interface is suspended 166736433127SOliver Neukum * resume only when the last interface is resumed 16685b2fc499SJeff Garzik */ 16695b2fc499SJeff Garzik 16705b2fc499SJeff Garzik int usbnet_suspend (struct usb_interface *intf, pm_message_t message) 16715b2fc499SJeff Garzik { 16725b2fc499SJeff Garzik struct usbnet *dev = usb_get_intfdata(intf); 16735b2fc499SJeff Garzik 167436433127SOliver Neukum if (!dev->suspend_count++) { 167569ee472fSOliver Neukum spin_lock_irq(&dev->txq.lock); 167669ee472fSOliver Neukum /* don't autosuspend while transmitting */ 16775b1b0b81SAlan Stern if (dev->txq.qlen && PMSG_IS_AUTO(message)) { 16785eeb3132SMing Lei dev->suspend_count--; 167969ee472fSOliver Neukum spin_unlock_irq(&dev->txq.lock); 168069ee472fSOliver Neukum return -EBUSY; 168169ee472fSOliver Neukum } else { 168269ee472fSOliver Neukum set_bit(EVENT_DEV_ASLEEP, &dev->flags); 168369ee472fSOliver Neukum spin_unlock_irq(&dev->txq.lock); 168469ee472fSOliver Neukum } 1685a11a6544SOliver Neukum /* 1686a11a6544SOliver Neukum * accelerate emptying of the rx and queues, to avoid 16875b2fc499SJeff Garzik * having everything error out. 16885b2fc499SJeff Garzik */ 16895b2fc499SJeff Garzik netif_device_detach (dev->net); 169069ee472fSOliver Neukum usbnet_terminate_urbs(dev); 16916eecdc5fSDan Williams __usbnet_status_stop_force(dev); 169269ee472fSOliver Neukum 1693a11a6544SOliver Neukum /* 1694a11a6544SOliver Neukum * reattach so runtime management can use and 1695a11a6544SOliver Neukum * wake the device 1696a11a6544SOliver Neukum */ 1697a11a6544SOliver Neukum netif_device_attach (dev->net); 169836433127SOliver Neukum } 16995b2fc499SJeff Garzik return 0; 17005b2fc499SJeff Garzik } 17015b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_suspend); 17025b2fc499SJeff Garzik 17035b2fc499SJeff Garzik int usbnet_resume (struct usb_interface *intf) 17045b2fc499SJeff Garzik { 17055b2fc499SJeff Garzik struct usbnet *dev = usb_get_intfdata(intf); 170669ee472fSOliver Neukum struct sk_buff *skb; 170769ee472fSOliver Neukum struct urb *res; 170869ee472fSOliver Neukum int retval; 17095b2fc499SJeff Garzik 171069ee472fSOliver Neukum if (!--dev->suspend_count) { 17116eecdc5fSDan Williams /* resume interrupt URB if it was previously submitted */ 17126eecdc5fSDan Williams __usbnet_status_start_force(dev, GFP_NOIO); 171368972efaSPaul Stewart 171469ee472fSOliver Neukum spin_lock_irq(&dev->txq.lock); 171569ee472fSOliver Neukum while ((res = usb_get_from_anchor(&dev->deferred))) { 171669ee472fSOliver Neukum 171769ee472fSOliver Neukum skb = (struct sk_buff *)res->context; 171869ee472fSOliver Neukum retval = usb_submit_urb(res, GFP_ATOMIC); 171969ee472fSOliver Neukum if (retval < 0) { 172069ee472fSOliver Neukum dev_kfree_skb_any(skb); 172169ee472fSOliver Neukum usb_free_urb(res); 172269ee472fSOliver Neukum usb_autopm_put_interface_async(dev->intf); 172369ee472fSOliver Neukum } else { 172469ee472fSOliver Neukum dev->net->trans_start = jiffies; 172569ee472fSOliver Neukum __skb_queue_tail(&dev->txq, skb); 172669ee472fSOliver Neukum } 172769ee472fSOliver Neukum } 172869ee472fSOliver Neukum 172969ee472fSOliver Neukum smp_mb(); 173069ee472fSOliver Neukum clear_bit(EVENT_DEV_ASLEEP, &dev->flags); 173169ee472fSOliver Neukum spin_unlock_irq(&dev->txq.lock); 173275bd0cbdSMing Lei 173375bd0cbdSMing Lei if (test_bit(EVENT_DEV_OPEN, &dev->flags)) { 173465841fd5SMing Lei /* handle remote wakeup ASAP */ 173565841fd5SMing Lei if (!dev->wait && 173665841fd5SMing Lei netif_device_present(dev->net) && 173765841fd5SMing Lei !timer_pending(&dev->delay) && 173865841fd5SMing Lei !test_bit(EVENT_RX_HALT, &dev->flags)) 1739ab6f148dSOliver Neukum rx_alloc_submit(dev, GFP_NOIO); 174065841fd5SMing Lei 174169ee472fSOliver Neukum if (!(dev->txq.qlen >= TX_QLEN(dev))) 17421aa9bc5bSAlexey Orishko netif_tx_wake_all_queues(dev->net); 17435b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 174469ee472fSOliver Neukum } 174575bd0cbdSMing Lei } 17465d9d01a3SOliver Neukum 17475d9d01a3SOliver Neukum if (test_and_clear_bit(EVENT_DEVICE_REPORT_IDLE, &dev->flags)) 17485d9d01a3SOliver Neukum usb_autopm_get_interface_no_resume(intf); 17495d9d01a3SOliver Neukum 17505b2fc499SJeff Garzik return 0; 17515b2fc499SJeff Garzik } 17525b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_resume); 17535b2fc499SJeff Garzik 17545d9d01a3SOliver Neukum /* 17555d9d01a3SOliver Neukum * Either a subdriver implements manage_power, then it is assumed to always 17565d9d01a3SOliver Neukum * be ready to be suspended or it reports the readiness to be suspended 17575d9d01a3SOliver Neukum * explicitly 17585d9d01a3SOliver Neukum */ 17595d9d01a3SOliver Neukum void usbnet_device_suggests_idle(struct usbnet *dev) 17605d9d01a3SOliver Neukum { 17615d9d01a3SOliver Neukum if (!test_and_set_bit(EVENT_DEVICE_REPORT_IDLE, &dev->flags)) { 17625d9d01a3SOliver Neukum dev->intf->needs_remote_wakeup = 1; 17635d9d01a3SOliver Neukum usb_autopm_put_interface_async(dev->intf); 17645d9d01a3SOliver Neukum } 17655d9d01a3SOliver Neukum } 17665d9d01a3SOliver Neukum EXPORT_SYMBOL(usbnet_device_suggests_idle); 17675b2fc499SJeff Garzik 17682dd7c8cfSOliver Neukum /* 17692dd7c8cfSOliver Neukum * For devices that can do without special commands 17702dd7c8cfSOliver Neukum */ 17712dd7c8cfSOliver Neukum int usbnet_manage_power(struct usbnet *dev, int on) 17722dd7c8cfSOliver Neukum { 17732dd7c8cfSOliver Neukum dev->intf->needs_remote_wakeup = on; 17742dd7c8cfSOliver Neukum return 0; 17752dd7c8cfSOliver Neukum } 17762dd7c8cfSOliver Neukum EXPORT_SYMBOL(usbnet_manage_power); 17772dd7c8cfSOliver Neukum 1778ac64995dSMing Lei void usbnet_link_change(struct usbnet *dev, bool link, bool need_reset) 1779ac64995dSMing Lei { 1780ac64995dSMing Lei /* update link after link is reseted */ 1781ac64995dSMing Lei if (link && !need_reset) 1782ac64995dSMing Lei netif_carrier_on(dev->net); 1783ac64995dSMing Lei else 1784ac64995dSMing Lei netif_carrier_off(dev->net); 1785ac64995dSMing Lei 1786ac64995dSMing Lei if (need_reset && link) 1787ac64995dSMing Lei usbnet_defer_kevent(dev, EVENT_LINK_RESET); 17884b49f58fSMing Lei else 17894b49f58fSMing Lei usbnet_defer_kevent(dev, EVENT_LINK_CHANGE); 1790ac64995dSMing Lei } 1791ac64995dSMing Lei EXPORT_SYMBOL(usbnet_link_change); 1792ac64995dSMing Lei 17935b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 17940547fad2SMing Lei static int __usbnet_read_cmd(struct usbnet *dev, u8 cmd, u8 reqtype, 1795877bd862SMing Lei u16 value, u16 index, void *data, u16 size) 1796877bd862SMing Lei { 1797877bd862SMing Lei void *buf = NULL; 1798877bd862SMing Lei int err = -ENOMEM; 1799877bd862SMing Lei 1800877bd862SMing Lei netdev_dbg(dev->net, "usbnet_read_cmd cmd=0x%02x reqtype=%02x" 1801877bd862SMing Lei " value=0x%04x index=0x%04x size=%d\n", 1802877bd862SMing Lei cmd, reqtype, value, index, size); 1803877bd862SMing Lei 1804877bd862SMing Lei if (data) { 1805877bd862SMing Lei buf = kmalloc(size, GFP_KERNEL); 1806877bd862SMing Lei if (!buf) 1807877bd862SMing Lei goto out; 1808877bd862SMing Lei } 1809877bd862SMing Lei 1810877bd862SMing Lei err = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0), 1811877bd862SMing Lei cmd, reqtype, value, index, buf, size, 1812877bd862SMing Lei USB_CTRL_GET_TIMEOUT); 1813877bd862SMing Lei if (err > 0 && err <= size) 1814877bd862SMing Lei memcpy(data, buf, err); 1815877bd862SMing Lei kfree(buf); 1816877bd862SMing Lei out: 1817877bd862SMing Lei return err; 1818877bd862SMing Lei } 1819877bd862SMing Lei 18200547fad2SMing Lei static int __usbnet_write_cmd(struct usbnet *dev, u8 cmd, u8 reqtype, 18210547fad2SMing Lei u16 value, u16 index, const void *data, 18220547fad2SMing Lei u16 size) 1823877bd862SMing Lei { 1824877bd862SMing Lei void *buf = NULL; 1825877bd862SMing Lei int err = -ENOMEM; 1826877bd862SMing Lei 1827877bd862SMing Lei netdev_dbg(dev->net, "usbnet_write_cmd cmd=0x%02x reqtype=%02x" 1828877bd862SMing Lei " value=0x%04x index=0x%04x size=%d\n", 1829877bd862SMing Lei cmd, reqtype, value, index, size); 1830877bd862SMing Lei 1831877bd862SMing Lei if (data) { 1832877bd862SMing Lei buf = kmemdup(data, size, GFP_KERNEL); 1833877bd862SMing Lei if (!buf) 1834877bd862SMing Lei goto out; 1835877bd862SMing Lei } 1836877bd862SMing Lei 1837877bd862SMing Lei err = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0), 1838877bd862SMing Lei cmd, reqtype, value, index, buf, size, 1839877bd862SMing Lei USB_CTRL_SET_TIMEOUT); 1840877bd862SMing Lei kfree(buf); 1841877bd862SMing Lei 1842877bd862SMing Lei out: 1843877bd862SMing Lei return err; 1844877bd862SMing Lei } 18450547fad2SMing Lei 18460547fad2SMing Lei /* 18470547fad2SMing Lei * The function can't be called inside suspend/resume callback, 18480547fad2SMing Lei * otherwise deadlock will be caused. 18490547fad2SMing Lei */ 18500547fad2SMing Lei int usbnet_read_cmd(struct usbnet *dev, u8 cmd, u8 reqtype, 18510547fad2SMing Lei u16 value, u16 index, void *data, u16 size) 18520547fad2SMing Lei { 18536f0a0986SMing Lei int ret; 18546f0a0986SMing Lei 18556f0a0986SMing Lei if (usb_autopm_get_interface(dev->intf) < 0) 18566f0a0986SMing Lei return -ENODEV; 18576f0a0986SMing Lei ret = __usbnet_read_cmd(dev, cmd, reqtype, value, index, 18580547fad2SMing Lei data, size); 18596f0a0986SMing Lei usb_autopm_put_interface(dev->intf); 18606f0a0986SMing Lei return ret; 18610547fad2SMing Lei } 18620547fad2SMing Lei EXPORT_SYMBOL_GPL(usbnet_read_cmd); 18630547fad2SMing Lei 18640547fad2SMing Lei /* 18650547fad2SMing Lei * The function can't be called inside suspend/resume callback, 18660547fad2SMing Lei * otherwise deadlock will be caused. 18670547fad2SMing Lei */ 18680547fad2SMing Lei int usbnet_write_cmd(struct usbnet *dev, u8 cmd, u8 reqtype, 18690547fad2SMing Lei u16 value, u16 index, const void *data, u16 size) 18700547fad2SMing Lei { 18716f0a0986SMing Lei int ret; 18726f0a0986SMing Lei 18736f0a0986SMing Lei if (usb_autopm_get_interface(dev->intf) < 0) 18746f0a0986SMing Lei return -ENODEV; 18756f0a0986SMing Lei ret = __usbnet_write_cmd(dev, cmd, reqtype, value, index, 18760547fad2SMing Lei data, size); 18776f0a0986SMing Lei usb_autopm_put_interface(dev->intf); 18786f0a0986SMing Lei return ret; 18790547fad2SMing Lei } 1880877bd862SMing Lei EXPORT_SYMBOL_GPL(usbnet_write_cmd); 1881877bd862SMing Lei 18820547fad2SMing Lei /* 18830547fad2SMing Lei * The function can be called inside suspend/resume callback safely 18840547fad2SMing Lei * and should only be called by suspend/resume callback generally. 18850547fad2SMing Lei */ 18860547fad2SMing Lei int usbnet_read_cmd_nopm(struct usbnet *dev, u8 cmd, u8 reqtype, 18870547fad2SMing Lei u16 value, u16 index, void *data, u16 size) 18880547fad2SMing Lei { 18890547fad2SMing Lei return __usbnet_read_cmd(dev, cmd, reqtype, value, index, 18900547fad2SMing Lei data, size); 18910547fad2SMing Lei } 18920547fad2SMing Lei EXPORT_SYMBOL_GPL(usbnet_read_cmd_nopm); 18930547fad2SMing Lei 18940547fad2SMing Lei /* 18950547fad2SMing Lei * The function can be called inside suspend/resume callback safely 18960547fad2SMing Lei * and should only be called by suspend/resume callback generally. 18970547fad2SMing Lei */ 18980547fad2SMing Lei int usbnet_write_cmd_nopm(struct usbnet *dev, u8 cmd, u8 reqtype, 18990547fad2SMing Lei u16 value, u16 index, const void *data, 19000547fad2SMing Lei u16 size) 19010547fad2SMing Lei { 19020547fad2SMing Lei return __usbnet_write_cmd(dev, cmd, reqtype, value, index, 19030547fad2SMing Lei data, size); 19040547fad2SMing Lei } 19050547fad2SMing Lei EXPORT_SYMBOL_GPL(usbnet_write_cmd_nopm); 19060547fad2SMing Lei 1907877bd862SMing Lei static void usbnet_async_cmd_cb(struct urb *urb) 1908877bd862SMing Lei { 1909877bd862SMing Lei struct usb_ctrlrequest *req = (struct usb_ctrlrequest *)urb->context; 1910877bd862SMing Lei int status = urb->status; 1911877bd862SMing Lei 1912877bd862SMing Lei if (status < 0) 1913877bd862SMing Lei dev_dbg(&urb->dev->dev, "%s failed with %d", 1914877bd862SMing Lei __func__, status); 1915877bd862SMing Lei 1916877bd862SMing Lei kfree(req); 1917877bd862SMing Lei usb_free_urb(urb); 1918877bd862SMing Lei } 1919877bd862SMing Lei 19200547fad2SMing Lei /* 19210547fad2SMing Lei * The caller must make sure that device can't be put into suspend 19220547fad2SMing Lei * state until the control URB completes. 19230547fad2SMing Lei */ 1924877bd862SMing Lei int usbnet_write_cmd_async(struct usbnet *dev, u8 cmd, u8 reqtype, 1925877bd862SMing Lei u16 value, u16 index, const void *data, u16 size) 1926877bd862SMing Lei { 1927877bd862SMing Lei struct usb_ctrlrequest *req = NULL; 1928877bd862SMing Lei struct urb *urb; 1929877bd862SMing Lei int err = -ENOMEM; 1930877bd862SMing Lei void *buf = NULL; 1931877bd862SMing Lei 1932877bd862SMing Lei netdev_dbg(dev->net, "usbnet_write_cmd cmd=0x%02x reqtype=%02x" 1933877bd862SMing Lei " value=0x%04x index=0x%04x size=%d\n", 1934877bd862SMing Lei cmd, reqtype, value, index, size); 1935877bd862SMing Lei 1936877bd862SMing Lei urb = usb_alloc_urb(0, GFP_ATOMIC); 1937877bd862SMing Lei if (!urb) { 1938877bd862SMing Lei netdev_err(dev->net, "Error allocating URB in" 1939877bd862SMing Lei " %s!\n", __func__); 1940877bd862SMing Lei goto fail; 1941877bd862SMing Lei } 1942877bd862SMing Lei 1943877bd862SMing Lei if (data) { 1944877bd862SMing Lei buf = kmemdup(data, size, GFP_ATOMIC); 1945877bd862SMing Lei if (!buf) { 1946877bd862SMing Lei netdev_err(dev->net, "Error allocating buffer" 1947877bd862SMing Lei " in %s!\n", __func__); 1948877bd862SMing Lei goto fail_free; 1949877bd862SMing Lei } 1950877bd862SMing Lei } 1951877bd862SMing Lei 1952877bd862SMing Lei req = kmalloc(sizeof(struct usb_ctrlrequest), GFP_ATOMIC); 195338673c82SJoe Perches if (!req) 1954877bd862SMing Lei goto fail_free_buf; 1955877bd862SMing Lei 1956877bd862SMing Lei req->bRequestType = reqtype; 1957877bd862SMing Lei req->bRequest = cmd; 1958877bd862SMing Lei req->wValue = cpu_to_le16(value); 1959877bd862SMing Lei req->wIndex = cpu_to_le16(index); 1960877bd862SMing Lei req->wLength = cpu_to_le16(size); 1961877bd862SMing Lei 1962877bd862SMing Lei usb_fill_control_urb(urb, dev->udev, 1963877bd862SMing Lei usb_sndctrlpipe(dev->udev, 0), 1964877bd862SMing Lei (void *)req, buf, size, 1965877bd862SMing Lei usbnet_async_cmd_cb, req); 1966877bd862SMing Lei urb->transfer_flags |= URB_FREE_BUFFER; 1967877bd862SMing Lei 1968877bd862SMing Lei err = usb_submit_urb(urb, GFP_ATOMIC); 1969877bd862SMing Lei if (err < 0) { 1970877bd862SMing Lei netdev_err(dev->net, "Error submitting the control" 1971877bd862SMing Lei " message: status=%d\n", err); 1972877bd862SMing Lei goto fail_free; 1973877bd862SMing Lei } 1974877bd862SMing Lei return 0; 1975877bd862SMing Lei 1976877bd862SMing Lei fail_free_buf: 1977877bd862SMing Lei kfree(buf); 1978877bd862SMing Lei fail_free: 1979877bd862SMing Lei kfree(req); 1980877bd862SMing Lei usb_free_urb(urb); 1981877bd862SMing Lei fail: 1982877bd862SMing Lei return err; 1983877bd862SMing Lei 1984877bd862SMing Lei } 1985877bd862SMing Lei EXPORT_SYMBOL_GPL(usbnet_write_cmd_async); 1986877bd862SMing Lei /*-------------------------------------------------------------------------*/ 19875b2fc499SJeff Garzik 19885b2fc499SJeff Garzik static int __init usbnet_init(void) 19895b2fc499SJeff Garzik { 1990c582a950SThiago Farina /* Compiler should optimize this out. */ 1991c582a950SThiago Farina BUILD_BUG_ON( 1992c582a950SThiago Farina FIELD_SIZEOF(struct sk_buff, cb) < sizeof(struct skb_data)); 19935b2fc499SJeff Garzik 1994c7e12eadSJoe Perches eth_random_addr(node_id); 19955b2fc499SJeff Garzik return 0; 19965b2fc499SJeff Garzik } 19975b2fc499SJeff Garzik module_init(usbnet_init); 19985b2fc499SJeff Garzik 19995b2fc499SJeff Garzik static void __exit usbnet_exit(void) 20005b2fc499SJeff Garzik { 20015b2fc499SJeff Garzik } 20025b2fc499SJeff Garzik module_exit(usbnet_exit); 20035b2fc499SJeff Garzik 20045b2fc499SJeff Garzik MODULE_AUTHOR("David Brownell"); 20055b2fc499SJeff Garzik MODULE_DESCRIPTION("USB network driver framework"); 20065b2fc499SJeff Garzik MODULE_LICENSE("GPL"); 2007