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 179cb00073SJeff Kirsher * along with this program; if not, see <http://www.gnu.org/licenses/>. 185b2fc499SJeff Garzik */ 195b2fc499SJeff Garzik 205b2fc499SJeff Garzik /* 215b2fc499SJeff Garzik * This is a generic "USB networking" framework that works with several 225b2fc499SJeff Garzik * kinds of full and high speed networking devices: host-to-host cables, 235b2fc499SJeff Garzik * smart usb peripherals, and actual Ethernet adapters. 245b2fc499SJeff Garzik * 255b2fc499SJeff Garzik * These devices usually differ in terms of control protocols (if they 265b2fc499SJeff Garzik * even have one!) and sometimes they define new framing to wrap or batch 275b2fc499SJeff Garzik * Ethernet packets. Otherwise, they talk to USB pretty much the same, 285b2fc499SJeff Garzik * so interface (un)binding, endpoint I/O queues, fault handling, and other 295b2fc499SJeff Garzik * issues can usefully be addressed by this framework. 305b2fc499SJeff Garzik */ 315b2fc499SJeff Garzik 325b2fc499SJeff Garzik // #define DEBUG // error path messages, extra info 335b2fc499SJeff Garzik // #define VERBOSE // more; success messages 345b2fc499SJeff Garzik 355b2fc499SJeff Garzik #include <linux/module.h> 365b2fc499SJeff Garzik #include <linux/init.h> 375b2fc499SJeff Garzik #include <linux/netdevice.h> 385b2fc499SJeff Garzik #include <linux/etherdevice.h> 3903ad032bSPeter Holik #include <linux/ctype.h> 405b2fc499SJeff Garzik #include <linux/ethtool.h> 415b2fc499SJeff Garzik #include <linux/workqueue.h> 425b2fc499SJeff Garzik #include <linux/mii.h> 435b2fc499SJeff Garzik #include <linux/usb.h> 443692e94fSJussi Kivilinna #include <linux/usb/usbnet.h> 45c40a2c88SOliver Neukum #include <linux/usb/cdc.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 * 62a88c32aeSMing Lei * The goal is to let the USB host controller be busy for 5msec or 63a88c32aeSMing Lei * more before an irq is required, under load. Jumbograms change 64a88c32aeSMing Lei * the equation. 655b2fc499SJeff Garzik */ 66a88c32aeSMing Lei #define MAX_QUEUE_MEMORY (60 * 1518) 67a88c32aeSMing Lei #define RX_QLEN(dev) ((dev)->rx_qlen) 68a88c32aeSMing 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 7337ebb549SPetr Mladek /* throttle rx/tx briefly after some faults, so hub_wq might disconnect() 7437ebb549SPetr Mladek * us (it polls at HZ/4 usually) before we report too many false errors. 7537ebb549SPetr Mladek */ 765b2fc499SJeff Garzik #define THROTTLE_JIFFIES (HZ/8) 775b2fc499SJeff Garzik 785b2fc499SJeff Garzik // between wakeups 795b2fc499SJeff Garzik #define UNLINK_TIMEOUT_MS 3 805b2fc499SJeff Garzik 815b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 825b2fc499SJeff Garzik 835b2fc499SJeff Garzik // randomly generated ethernet address 845b2fc499SJeff Garzik static u8 node_id [ETH_ALEN]; 855b2fc499SJeff Garzik 865b2fc499SJeff Garzik static const char driver_name [] = "usbnet"; 875b2fc499SJeff Garzik 885b2fc499SJeff Garzik /* use ethtool to change the level for any given device */ 895b2fc499SJeff Garzik static int msg_level = -1; 905b2fc499SJeff Garzik module_param (msg_level, int, 0); 915b2fc499SJeff Garzik MODULE_PARM_DESC (msg_level, "Override default message level"); 925b2fc499SJeff Garzik 935b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 945b2fc499SJeff Garzik 955b2fc499SJeff Garzik /* handles CDC Ethernet and many other network "bulk data" interfaces */ 965b2fc499SJeff Garzik int usbnet_get_endpoints(struct usbnet *dev, struct usb_interface *intf) 975b2fc499SJeff Garzik { 985b2fc499SJeff Garzik int tmp; 995b2fc499SJeff Garzik struct usb_host_interface *alt = NULL; 1005b2fc499SJeff Garzik struct usb_host_endpoint *in = NULL, *out = NULL; 1015b2fc499SJeff Garzik struct usb_host_endpoint *status = NULL; 1025b2fc499SJeff Garzik 1035b2fc499SJeff Garzik for (tmp = 0; tmp < intf->num_altsetting; tmp++) { 1045b2fc499SJeff Garzik unsigned ep; 1055b2fc499SJeff Garzik 1065b2fc499SJeff Garzik in = out = status = NULL; 1075b2fc499SJeff Garzik alt = intf->altsetting + tmp; 1085b2fc499SJeff Garzik 1095b2fc499SJeff Garzik /* take the first altsetting with in-bulk + out-bulk; 1105b2fc499SJeff Garzik * remember any status endpoint, just in case; 11170f23fd6SJustin P. Mattock * ignore other endpoints and altsettings. 1125b2fc499SJeff Garzik */ 1135b2fc499SJeff Garzik for (ep = 0; ep < alt->desc.bNumEndpoints; ep++) { 1145b2fc499SJeff Garzik struct usb_host_endpoint *e; 1155b2fc499SJeff Garzik int intr = 0; 1165b2fc499SJeff Garzik 1175b2fc499SJeff Garzik e = alt->endpoint + ep; 1185b2fc499SJeff Garzik switch (e->desc.bmAttributes) { 1195b2fc499SJeff Garzik case USB_ENDPOINT_XFER_INT: 1205b2fc499SJeff Garzik if (!usb_endpoint_dir_in(&e->desc)) 1215b2fc499SJeff Garzik continue; 1225b2fc499SJeff Garzik intr = 1; 1235b2fc499SJeff Garzik /* FALLTHROUGH */ 1245b2fc499SJeff Garzik case USB_ENDPOINT_XFER_BULK: 1255b2fc499SJeff Garzik break; 1265b2fc499SJeff Garzik default: 1275b2fc499SJeff Garzik continue; 1285b2fc499SJeff Garzik } 1295b2fc499SJeff Garzik if (usb_endpoint_dir_in(&e->desc)) { 1305b2fc499SJeff Garzik if (!intr && !in) 1315b2fc499SJeff Garzik in = e; 1325b2fc499SJeff Garzik else if (intr && !status) 1335b2fc499SJeff Garzik status = e; 1345b2fc499SJeff Garzik } else { 1355b2fc499SJeff Garzik if (!out) 1365b2fc499SJeff Garzik out = e; 1375b2fc499SJeff Garzik } 1385b2fc499SJeff Garzik } 1395b2fc499SJeff Garzik if (in && out) 1405b2fc499SJeff Garzik break; 1415b2fc499SJeff Garzik } 1425b2fc499SJeff Garzik if (!alt || !in || !out) 1435b2fc499SJeff Garzik return -EINVAL; 1445b2fc499SJeff Garzik 1458e95a202SJoe Perches if (alt->desc.bAlternateSetting != 0 || 1468e95a202SJoe Perches !(dev->driver_info->flags & FLAG_NO_SETINT)) { 1475b2fc499SJeff Garzik tmp = usb_set_interface (dev->udev, alt->desc.bInterfaceNumber, 1485b2fc499SJeff Garzik alt->desc.bAlternateSetting); 1495b2fc499SJeff Garzik if (tmp < 0) 1505b2fc499SJeff Garzik return tmp; 1515b2fc499SJeff Garzik } 1525b2fc499SJeff Garzik 1535b2fc499SJeff Garzik dev->in = usb_rcvbulkpipe (dev->udev, 1545b2fc499SJeff Garzik in->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK); 1555b2fc499SJeff Garzik dev->out = usb_sndbulkpipe (dev->udev, 1565b2fc499SJeff Garzik out->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK); 1575b2fc499SJeff Garzik dev->status = status; 1585b2fc499SJeff Garzik return 0; 1595b2fc499SJeff Garzik } 1605b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_endpoints); 1615b2fc499SJeff Garzik 16203ad032bSPeter Holik int usbnet_get_ethernet_addr(struct usbnet *dev, int iMACAddress) 16303ad032bSPeter Holik { 16451487ae7SAndy Shevchenko int tmp = -1, ret; 16503ad032bSPeter Holik unsigned char buf [13]; 16603ad032bSPeter Holik 16751487ae7SAndy Shevchenko ret = usb_string(dev->udev, iMACAddress, buf, sizeof buf); 16851487ae7SAndy Shevchenko if (ret == 12) 16951487ae7SAndy Shevchenko tmp = hex2bin(dev->net->dev_addr, buf, 6); 17051487ae7SAndy Shevchenko if (tmp < 0) { 17103ad032bSPeter Holik dev_dbg(&dev->udev->dev, 17203ad032bSPeter Holik "bad MAC string %d fetch, %d\n", iMACAddress, tmp); 17351487ae7SAndy Shevchenko if (ret >= 0) 17451487ae7SAndy Shevchenko ret = -EINVAL; 17551487ae7SAndy Shevchenko return ret; 17603ad032bSPeter Holik } 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 status = usb_submit_urb (urb, GFP_ATOMIC); 20824ead299Stom.leiming@gmail.com if (status != 0) 20924ead299Stom.leiming@gmail.com netif_err(dev, timer, dev->net, 21024ead299Stom.leiming@gmail.com "intr resubmit --> %d\n", status); 21124ead299Stom.leiming@gmail.com } 2125b2fc499SJeff Garzik 2135b2fc499SJeff Garzik static int init_status (struct usbnet *dev, struct usb_interface *intf) 2145b2fc499SJeff Garzik { 2155b2fc499SJeff Garzik char *buf = NULL; 2165b2fc499SJeff Garzik unsigned pipe = 0; 2175b2fc499SJeff Garzik unsigned maxp; 2185b2fc499SJeff Garzik unsigned period; 2195b2fc499SJeff Garzik 2205b2fc499SJeff Garzik if (!dev->driver_info->status) 2215b2fc499SJeff Garzik return 0; 2225b2fc499SJeff Garzik 2235b2fc499SJeff Garzik pipe = usb_rcvintpipe (dev->udev, 2245b2fc499SJeff Garzik dev->status->desc.bEndpointAddress 2255b2fc499SJeff Garzik & USB_ENDPOINT_NUMBER_MASK); 2265b2fc499SJeff Garzik maxp = usb_maxpacket (dev->udev, pipe, 0); 2275b2fc499SJeff Garzik 2285b2fc499SJeff Garzik /* avoid 1 msec chatter: min 8 msec poll rate */ 2295b2fc499SJeff Garzik period = max ((int) dev->status->desc.bInterval, 2305b2fc499SJeff Garzik (dev->udev->speed == USB_SPEED_HIGH) ? 7 : 3); 2315b2fc499SJeff Garzik 2325b2fc499SJeff Garzik buf = kmalloc (maxp, GFP_KERNEL); 2335b2fc499SJeff Garzik if (buf) { 2345b2fc499SJeff Garzik dev->interrupt = usb_alloc_urb (0, GFP_KERNEL); 2355b2fc499SJeff Garzik if (!dev->interrupt) { 2365b2fc499SJeff Garzik kfree (buf); 2375b2fc499SJeff Garzik return -ENOMEM; 2385b2fc499SJeff Garzik } else { 2395b2fc499SJeff Garzik usb_fill_int_urb(dev->interrupt, dev->udev, pipe, 2405b2fc499SJeff Garzik buf, maxp, intr_complete, dev, period); 241720f3d7cStom.leiming@gmail.com dev->interrupt->transfer_flags |= URB_FREE_BUFFER; 2425b2fc499SJeff Garzik dev_dbg(&intf->dev, 2435b2fc499SJeff Garzik "status ep%din, %d bytes period %d\n", 2445b2fc499SJeff Garzik usb_pipeendpoint(pipe), maxp, period); 2455b2fc499SJeff Garzik } 2465b2fc499SJeff Garzik } 2475b2fc499SJeff Garzik return 0; 2485b2fc499SJeff Garzik } 2495b2fc499SJeff Garzik 2506eecdc5fSDan Williams /* Submit the interrupt URB if not previously submitted, increasing refcount */ 2516eecdc5fSDan Williams int usbnet_status_start(struct usbnet *dev, gfp_t mem_flags) 2526eecdc5fSDan Williams { 2536eecdc5fSDan Williams int ret = 0; 2546eecdc5fSDan Williams 2556eecdc5fSDan Williams WARN_ON_ONCE(dev->interrupt == NULL); 2566eecdc5fSDan Williams if (dev->interrupt) { 2576eecdc5fSDan Williams mutex_lock(&dev->interrupt_mutex); 2586eecdc5fSDan Williams 2596eecdc5fSDan Williams if (++dev->interrupt_count == 1) 2606eecdc5fSDan Williams ret = usb_submit_urb(dev->interrupt, mem_flags); 2616eecdc5fSDan Williams 2626eecdc5fSDan Williams dev_dbg(&dev->udev->dev, "incremented interrupt URB count to %d\n", 2636eecdc5fSDan Williams dev->interrupt_count); 2646eecdc5fSDan Williams mutex_unlock(&dev->interrupt_mutex); 2656eecdc5fSDan Williams } 2666eecdc5fSDan Williams return ret; 2676eecdc5fSDan Williams } 2686eecdc5fSDan Williams EXPORT_SYMBOL_GPL(usbnet_status_start); 2696eecdc5fSDan Williams 2706eecdc5fSDan Williams /* For resume; submit interrupt URB if previously submitted */ 2716eecdc5fSDan Williams static int __usbnet_status_start_force(struct usbnet *dev, gfp_t mem_flags) 2726eecdc5fSDan Williams { 2736eecdc5fSDan Williams int ret = 0; 2746eecdc5fSDan Williams 2756eecdc5fSDan Williams mutex_lock(&dev->interrupt_mutex); 2766eecdc5fSDan Williams if (dev->interrupt_count) { 2776eecdc5fSDan Williams ret = usb_submit_urb(dev->interrupt, mem_flags); 2786eecdc5fSDan Williams dev_dbg(&dev->udev->dev, 2796eecdc5fSDan Williams "submitted interrupt URB for resume\n"); 2806eecdc5fSDan Williams } 2816eecdc5fSDan Williams mutex_unlock(&dev->interrupt_mutex); 2826eecdc5fSDan Williams return ret; 2836eecdc5fSDan Williams } 2846eecdc5fSDan Williams 2856eecdc5fSDan Williams /* Kill the interrupt URB if all submitters want it killed */ 2866eecdc5fSDan Williams void usbnet_status_stop(struct usbnet *dev) 2876eecdc5fSDan Williams { 2886eecdc5fSDan Williams if (dev->interrupt) { 2896eecdc5fSDan Williams mutex_lock(&dev->interrupt_mutex); 2906eecdc5fSDan Williams WARN_ON(dev->interrupt_count == 0); 2916eecdc5fSDan Williams 2926eecdc5fSDan Williams if (dev->interrupt_count && --dev->interrupt_count == 0) 2936eecdc5fSDan Williams usb_kill_urb(dev->interrupt); 2946eecdc5fSDan Williams 2956eecdc5fSDan Williams dev_dbg(&dev->udev->dev, 2966eecdc5fSDan Williams "decremented interrupt URB count to %d\n", 2976eecdc5fSDan Williams dev->interrupt_count); 2986eecdc5fSDan Williams mutex_unlock(&dev->interrupt_mutex); 2996eecdc5fSDan Williams } 3006eecdc5fSDan Williams } 3016eecdc5fSDan Williams EXPORT_SYMBOL_GPL(usbnet_status_stop); 3026eecdc5fSDan Williams 3036eecdc5fSDan Williams /* For suspend; always kill interrupt URB */ 3046eecdc5fSDan Williams static void __usbnet_status_stop_force(struct usbnet *dev) 3056eecdc5fSDan Williams { 3066eecdc5fSDan Williams if (dev->interrupt) { 3076eecdc5fSDan Williams mutex_lock(&dev->interrupt_mutex); 3086eecdc5fSDan Williams usb_kill_urb(dev->interrupt); 3096eecdc5fSDan Williams dev_dbg(&dev->udev->dev, "killed interrupt URB for suspend\n"); 3106eecdc5fSDan Williams mutex_unlock(&dev->interrupt_mutex); 3116eecdc5fSDan Williams } 3126eecdc5fSDan Williams } 3136eecdc5fSDan Williams 3145b2fc499SJeff Garzik /* Passes this packet up the stack, updating its accounting. 3155b2fc499SJeff Garzik * Some link protocols batch packets, so their rx_fixup paths 3165b2fc499SJeff Garzik * can return clones as well as just modify the original skb. 3175b2fc499SJeff Garzik */ 3185b2fc499SJeff Garzik void usbnet_skb_return (struct usbnet *dev, struct sk_buff *skb) 3195b2fc499SJeff Garzik { 3205b2fc499SJeff Garzik int status; 3215b2fc499SJeff Garzik 3227834ddbcSJussi Kivilinna if (test_bit(EVENT_RX_PAUSED, &dev->flags)) { 3237834ddbcSJussi Kivilinna skb_queue_tail(&dev->rxq_pause, skb); 3247834ddbcSJussi Kivilinna return; 3257834ddbcSJussi Kivilinna } 3267834ddbcSJussi Kivilinna 32781e0ce79SBjørn Mork /* only update if unset to allow minidriver rx_fixup override */ 32881e0ce79SBjørn Mork if (skb->protocol == 0) 3295b2fc499SJeff Garzik skb->protocol = eth_type_trans (skb, dev->net); 33081e0ce79SBjørn Mork 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 348a88c32aeSMing Lei /* must be called if hard_mtu or rx_urb_size changed */ 349a88c32aeSMing Lei void usbnet_update_max_qlen(struct usbnet *dev) 350a88c32aeSMing Lei { 351a88c32aeSMing Lei enum usb_device_speed speed = dev->udev->speed; 352a88c32aeSMing Lei 353a88c32aeSMing Lei switch (speed) { 354a88c32aeSMing Lei case USB_SPEED_HIGH: 355a88c32aeSMing Lei dev->rx_qlen = MAX_QUEUE_MEMORY / dev->rx_urb_size; 356a88c32aeSMing Lei dev->tx_qlen = MAX_QUEUE_MEMORY / dev->hard_mtu; 357a88c32aeSMing Lei break; 358452c447aSMing Lei case USB_SPEED_SUPER: 359ea079842SOliver Neukum case USB_SPEED_SUPER_PLUS: 360452c447aSMing Lei /* 361452c447aSMing Lei * Not take default 5ms qlen for super speed HC to 362452c447aSMing Lei * save memory, and iperf tests show 2.5ms qlen can 363452c447aSMing Lei * work well 364452c447aSMing Lei */ 365452c447aSMing Lei dev->rx_qlen = 5 * MAX_QUEUE_MEMORY / dev->rx_urb_size; 366452c447aSMing Lei dev->tx_qlen = 5 * MAX_QUEUE_MEMORY / dev->hard_mtu; 367452c447aSMing Lei break; 368a88c32aeSMing Lei default: 369a88c32aeSMing Lei dev->rx_qlen = dev->tx_qlen = 4; 370a88c32aeSMing Lei } 371a88c32aeSMing Lei } 372a88c32aeSMing Lei EXPORT_SYMBOL_GPL(usbnet_update_max_qlen); 373a88c32aeSMing Lei 3745b2fc499SJeff Garzik 3755b2fc499SJeff Garzik /*------------------------------------------------------------------------- 3765b2fc499SJeff Garzik * 3775b2fc499SJeff Garzik * Network Device Driver (peer link to "Host Device", from USB host) 3785b2fc499SJeff Garzik * 3795b2fc499SJeff Garzik *-------------------------------------------------------------------------*/ 3805b2fc499SJeff Garzik 381777baa47SStephen Hemminger int usbnet_change_mtu (struct net_device *net, int new_mtu) 3825b2fc499SJeff Garzik { 3835b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 3845b2fc499SJeff Garzik int ll_mtu = new_mtu + net->hard_header_len; 3855b2fc499SJeff Garzik int old_hard_mtu = dev->hard_mtu; 3865b2fc499SJeff Garzik int old_rx_urb_size = dev->rx_urb_size; 3875b2fc499SJeff Garzik 3885b2fc499SJeff Garzik if (new_mtu <= 0) 3895b2fc499SJeff Garzik return -EINVAL; 3905b2fc499SJeff Garzik // no second zero-length packet read wanted after mtu-sized packets 3915b2fc499SJeff Garzik if ((ll_mtu % dev->maxpacket) == 0) 3925b2fc499SJeff Garzik return -EDOM; 3935b2fc499SJeff Garzik net->mtu = new_mtu; 3945b2fc499SJeff Garzik 3955b2fc499SJeff Garzik dev->hard_mtu = net->mtu + net->hard_header_len; 3965b2fc499SJeff Garzik if (dev->rx_urb_size == old_hard_mtu) { 3975b2fc499SJeff Garzik dev->rx_urb_size = dev->hard_mtu; 398*43daa96bSSoohoon Lee if (dev->rx_urb_size > old_rx_urb_size) { 399*43daa96bSSoohoon Lee usbnet_pause_rx(dev); 4005b2fc499SJeff Garzik usbnet_unlink_rx_urbs(dev); 401*43daa96bSSoohoon Lee usbnet_resume_rx(dev); 402*43daa96bSSoohoon Lee } 4035b2fc499SJeff Garzik } 4045b2fc499SJeff Garzik 405a88c32aeSMing Lei /* max qlen depend on hard_mtu and rx_urb_size */ 406a88c32aeSMing Lei usbnet_update_max_qlen(dev); 407a88c32aeSMing Lei 4085b2fc499SJeff Garzik return 0; 4095b2fc499SJeff Garzik } 410777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_change_mtu); 4115b2fc499SJeff Garzik 4125b6e9bcdSMing Lei /* The caller must hold list->lock */ 4135b6e9bcdSMing Lei static void __usbnet_queue_skb(struct sk_buff_head *list, 4145b6e9bcdSMing Lei struct sk_buff *newsk, enum skb_state state) 4155b6e9bcdSMing Lei { 4165b6e9bcdSMing Lei struct skb_data *entry = (struct skb_data *) newsk->cb; 4175b6e9bcdSMing Lei 4185b6e9bcdSMing Lei __skb_queue_tail(list, newsk); 4195b6e9bcdSMing Lei entry->state = state; 4205b6e9bcdSMing Lei } 4215b6e9bcdSMing Lei 4225b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 4235b2fc499SJeff Garzik 4245b2fc499SJeff Garzik /* some LK 2.4 HCDs oopsed if we freed or resubmitted urbs from 4255b2fc499SJeff Garzik * completion callbacks. 2.5 should have fixed those bugs... 4265b2fc499SJeff Garzik */ 4275b2fc499SJeff Garzik 4285b6e9bcdSMing Lei static enum skb_state defer_bh(struct usbnet *dev, struct sk_buff *skb, 4295b6e9bcdSMing Lei struct sk_buff_head *list, enum skb_state state) 4305b2fc499SJeff Garzik { 4315b2fc499SJeff Garzik unsigned long flags; 4325b6e9bcdSMing Lei enum skb_state old_state; 4335b6e9bcdSMing Lei struct skb_data *entry = (struct skb_data *) skb->cb; 4345b2fc499SJeff Garzik 4355b2fc499SJeff Garzik spin_lock_irqsave(&list->lock, flags); 4365b6e9bcdSMing Lei old_state = entry->state; 4375b6e9bcdSMing Lei entry->state = state; 4385b2fc499SJeff Garzik __skb_unlink(skb, list); 439fcb0bb6aSEugene Shatokhin 440fcb0bb6aSEugene Shatokhin /* defer_bh() is never called with list == &dev->done. 441fcb0bb6aSEugene Shatokhin * spin_lock_nested() tells lockdep that it is OK to take 442fcb0bb6aSEugene Shatokhin * dev->done.lock here with list->lock held. 443fcb0bb6aSEugene Shatokhin */ 444fcb0bb6aSEugene Shatokhin spin_lock_nested(&dev->done.lock, SINGLE_DEPTH_NESTING); 445fcb0bb6aSEugene Shatokhin 4465b2fc499SJeff Garzik __skb_queue_tail(&dev->done, skb); 4475b2fc499SJeff Garzik if (dev->done.qlen == 1) 4485b2fc499SJeff Garzik tasklet_schedule(&dev->bh); 449fcb0bb6aSEugene Shatokhin spin_unlock(&dev->done.lock); 450fcb0bb6aSEugene Shatokhin spin_unlock_irqrestore(&list->lock, flags); 4515b6e9bcdSMing Lei return old_state; 4525b2fc499SJeff Garzik } 4535b2fc499SJeff Garzik 4545b2fc499SJeff Garzik /* some work can't be done in tasklets, so we use keventd 4555b2fc499SJeff Garzik * 4565b2fc499SJeff Garzik * NOTE: annoying asymmetry: if it's active, schedule_work() fails, 4575b2fc499SJeff Garzik * but tasklet_schedule() doesn't. hope the failure is rare. 4585b2fc499SJeff Garzik */ 4595b2fc499SJeff Garzik void usbnet_defer_kevent (struct usbnet *dev, int work) 4605b2fc499SJeff Garzik { 4615b2fc499SJeff Garzik set_bit (work, &dev->flags); 4629532021dSSteve Glendinning if (!schedule_work (&dev->kevent)) { 4639532021dSSteve Glendinning if (net_ratelimit()) 46460b86755SJoe Perches netdev_err(dev->net, "kevent %d may have been dropped\n", work); 4659532021dSSteve Glendinning } else { 46660b86755SJoe Perches netdev_dbg(dev->net, "kevent %d scheduled\n", work); 4675b2fc499SJeff Garzik } 4689532021dSSteve Glendinning } 4695b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_defer_kevent); 4705b2fc499SJeff Garzik 4715b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 4725b2fc499SJeff Garzik 4735b2fc499SJeff Garzik static void rx_complete (struct urb *urb); 4745b2fc499SJeff Garzik 475dacb3975SDavid S. Miller static int rx_submit (struct usbnet *dev, struct urb *urb, gfp_t flags) 4765b2fc499SJeff Garzik { 4775b2fc499SJeff Garzik struct sk_buff *skb; 4785b2fc499SJeff Garzik struct skb_data *entry; 4795b2fc499SJeff Garzik int retval = 0; 4805b2fc499SJeff Garzik unsigned long lockflags; 4815b2fc499SJeff Garzik size_t size = dev->rx_urb_size; 4825b2fc499SJeff Garzik 48370c37bf9SBjørn Mork /* prevent rx skb allocation when error ratio is high */ 48470c37bf9SBjørn Mork if (test_bit(EVENT_RX_KILL, &dev->flags)) { 48570c37bf9SBjørn Mork usb_free_urb(urb); 48670c37bf9SBjørn Mork return -ENOLINK; 48770c37bf9SBjørn Mork } 48870c37bf9SBjørn Mork 4897bdd4027SEric Dumazet skb = __netdev_alloc_skb_ip_align(dev->net, size, flags); 4907bdd4027SEric Dumazet if (!skb) { 491a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, "no rx skb\n"); 4925b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_RX_MEMORY); 4935b2fc499SJeff Garzik usb_free_urb (urb); 494dacb3975SDavid S. Miller return -ENOMEM; 4955b2fc499SJeff Garzik } 4965b2fc499SJeff Garzik 4975b2fc499SJeff Garzik entry = (struct skb_data *) skb->cb; 4985b2fc499SJeff Garzik entry->urb = urb; 4995b2fc499SJeff Garzik entry->dev = dev; 5005b2fc499SJeff Garzik entry->length = 0; 5015b2fc499SJeff Garzik 5025b2fc499SJeff Garzik usb_fill_bulk_urb (urb, dev->udev, dev->in, 5035b2fc499SJeff Garzik skb->data, size, rx_complete, skb); 5045b2fc499SJeff Garzik 5055b2fc499SJeff Garzik spin_lock_irqsave (&dev->rxq.lock, lockflags); 5065b2fc499SJeff Garzik 5078e95a202SJoe Perches if (netif_running (dev->net) && 5088e95a202SJoe Perches netif_device_present (dev->net) && 50969ee472fSOliver Neukum !test_bit (EVENT_RX_HALT, &dev->flags) && 51069ee472fSOliver Neukum !test_bit (EVENT_DEV_ASLEEP, &dev->flags)) { 5115b2fc499SJeff Garzik switch (retval = usb_submit_urb (urb, GFP_ATOMIC)) { 5125b2fc499SJeff Garzik case -EPIPE: 5135b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_RX_HALT); 5145b2fc499SJeff Garzik break; 5155b2fc499SJeff Garzik case -ENOMEM: 5165b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_RX_MEMORY); 5175b2fc499SJeff Garzik break; 5185b2fc499SJeff Garzik case -ENODEV: 519a475f603SJoe Perches netif_dbg(dev, ifdown, dev->net, "device gone\n"); 5205b2fc499SJeff Garzik netif_device_detach (dev->net); 5215b2fc499SJeff Garzik break; 522dacb3975SDavid S. Miller case -EHOSTUNREACH: 523dacb3975SDavid S. Miller retval = -ENOLINK; 524dacb3975SDavid S. Miller break; 5255b2fc499SJeff Garzik default: 526a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, 527a475f603SJoe Perches "rx submit, %d\n", retval); 5285b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 5295b2fc499SJeff Garzik break; 5305b2fc499SJeff Garzik case 0: 5315b6e9bcdSMing Lei __usbnet_queue_skb(&dev->rxq, skb, rx_start); 5325b2fc499SJeff Garzik } 5335b2fc499SJeff Garzik } else { 534a475f603SJoe Perches netif_dbg(dev, ifdown, dev->net, "rx: stopped\n"); 5355b2fc499SJeff Garzik retval = -ENOLINK; 5365b2fc499SJeff Garzik } 5375b2fc499SJeff Garzik spin_unlock_irqrestore (&dev->rxq.lock, lockflags); 5385b2fc499SJeff Garzik if (retval) { 5395b2fc499SJeff Garzik dev_kfree_skb_any (skb); 5405b2fc499SJeff Garzik usb_free_urb (urb); 5415b2fc499SJeff Garzik } 542dacb3975SDavid S. Miller return retval; 5435b2fc499SJeff Garzik } 5445b2fc499SJeff Garzik 5455b2fc499SJeff Garzik 5465b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 5475b2fc499SJeff Garzik 5485b2fc499SJeff Garzik static inline void rx_process (struct usbnet *dev, struct sk_buff *skb) 5495b2fc499SJeff Garzik { 5508e95a202SJoe Perches if (dev->driver_info->rx_fixup && 5517a635ea9SAndrzej Zaborowski !dev->driver_info->rx_fixup (dev, skb)) { 5527a635ea9SAndrzej Zaborowski /* With RX_ASSEMBLE, rx_fixup() must update counters */ 5537a635ea9SAndrzej Zaborowski if (!(dev->driver_info->flags & FLAG_RX_ASSEMBLE)) 5547a635ea9SAndrzej Zaborowski dev->net->stats.rx_errors++; 5557a635ea9SAndrzej Zaborowski goto done; 5567a635ea9SAndrzej Zaborowski } 5575b2fc499SJeff Garzik // else network stack removes extra byte if we forced a short packet 5585b2fc499SJeff Garzik 559073285fdSAlexey Orishko /* all data was already cloned from skb inside the driver */ 560073285fdSAlexey Orishko if (dev->driver_info->flags & FLAG_MULTI_PACKET) 561eb85569fSEmil Goode goto done; 562eb85569fSEmil Goode 563eb85569fSEmil Goode if (skb->len < ETH_HLEN) { 564eb85569fSEmil Goode dev->net->stats.rx_errors++; 565eb85569fSEmil Goode dev->net->stats.rx_length_errors++; 566eb85569fSEmil Goode netif_dbg(dev, rx_err, dev->net, "rx length %d\n", skb->len); 567eb85569fSEmil Goode } else { 5685b2fc499SJeff Garzik usbnet_skb_return(dev, skb); 569073285fdSAlexey Orishko return; 570073285fdSAlexey Orishko } 571073285fdSAlexey Orishko 5727a635ea9SAndrzej Zaborowski done: 5735b2fc499SJeff Garzik skb_queue_tail(&dev->done, skb); 5745b2fc499SJeff Garzik } 5755b2fc499SJeff Garzik 5765b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 5775b2fc499SJeff Garzik 5785b2fc499SJeff Garzik static void rx_complete (struct urb *urb) 5795b2fc499SJeff Garzik { 5805b2fc499SJeff Garzik struct sk_buff *skb = (struct sk_buff *) urb->context; 5815b2fc499SJeff Garzik struct skb_data *entry = (struct skb_data *) skb->cb; 5825b2fc499SJeff Garzik struct usbnet *dev = entry->dev; 5835b2fc499SJeff Garzik int urb_status = urb->status; 5845b6e9bcdSMing Lei enum skb_state state; 5855b2fc499SJeff Garzik 5865b2fc499SJeff Garzik skb_put (skb, urb->actual_length); 5875b6e9bcdSMing Lei state = rx_done; 5885b2fc499SJeff Garzik entry->urb = NULL; 5895b2fc499SJeff Garzik 5905b2fc499SJeff Garzik switch (urb_status) { 59118ab458fSDavid Brownell /* success */ 5925b2fc499SJeff Garzik case 0: 5935b2fc499SJeff Garzik break; 5945b2fc499SJeff Garzik 59518ab458fSDavid Brownell /* stalls need manual reset. this is rare ... except that 59618ab458fSDavid Brownell * when going through USB 2.0 TTs, unplug appears this way. 5973ac49a1cSJean Delvare * we avoid the highspeed version of the ETIMEDOUT/EILSEQ 59818ab458fSDavid Brownell * storm, recovering as needed. 59918ab458fSDavid Brownell */ 6005b2fc499SJeff Garzik case -EPIPE: 6017963837fSHerbert Xu dev->net->stats.rx_errors++; 6025b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_RX_HALT); 6035b2fc499SJeff Garzik // FALLTHROUGH 6045b2fc499SJeff Garzik 60518ab458fSDavid Brownell /* software-driven interface shutdown */ 60618ab458fSDavid Brownell case -ECONNRESET: /* async unlink */ 60718ab458fSDavid Brownell case -ESHUTDOWN: /* hardware gone */ 608a475f603SJoe Perches netif_dbg(dev, ifdown, dev->net, 609a475f603SJoe Perches "rx shutdown, code %d\n", urb_status); 6105b2fc499SJeff Garzik goto block; 6115b2fc499SJeff Garzik 61237ebb549SPetr Mladek /* we get controller i/o faults during hub_wq disconnect() delays. 61318ab458fSDavid Brownell * throttle down resubmits, to avoid log floods; just temporarily, 61437ebb549SPetr Mladek * so we still recover when the fault isn't a hub_wq delay. 61518ab458fSDavid Brownell */ 6165b2fc499SJeff Garzik case -EPROTO: 6175b2fc499SJeff Garzik case -ETIME: 6185b2fc499SJeff Garzik case -EILSEQ: 6197963837fSHerbert Xu dev->net->stats.rx_errors++; 6205b2fc499SJeff Garzik if (!timer_pending (&dev->delay)) { 6215b2fc499SJeff Garzik mod_timer (&dev->delay, jiffies + THROTTLE_JIFFIES); 622a475f603SJoe Perches netif_dbg(dev, link, dev->net, 623a475f603SJoe Perches "rx throttle %d\n", urb_status); 6245b2fc499SJeff Garzik } 6255b2fc499SJeff Garzik block: 6265b6e9bcdSMing Lei state = rx_cleanup; 6275b2fc499SJeff Garzik entry->urb = urb; 6285b2fc499SJeff Garzik urb = NULL; 6295b2fc499SJeff Garzik break; 6305b2fc499SJeff Garzik 63118ab458fSDavid Brownell /* data overrun ... flush fifo? */ 6325b2fc499SJeff Garzik case -EOVERFLOW: 6337963837fSHerbert Xu dev->net->stats.rx_over_errors++; 6345b2fc499SJeff Garzik // FALLTHROUGH 6355b2fc499SJeff Garzik 6365b2fc499SJeff Garzik default: 6375b6e9bcdSMing Lei state = rx_cleanup; 6387963837fSHerbert Xu dev->net->stats.rx_errors++; 639a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, "rx status %d\n", urb_status); 6405b2fc499SJeff Garzik break; 6415b2fc499SJeff Garzik } 6425b2fc499SJeff Garzik 64370c37bf9SBjørn Mork /* stop rx if packet error rate is high */ 64470c37bf9SBjørn Mork if (++dev->pkt_cnt > 30) { 64570c37bf9SBjørn Mork dev->pkt_cnt = 0; 64670c37bf9SBjørn Mork dev->pkt_err = 0; 64770c37bf9SBjørn Mork } else { 64870c37bf9SBjørn Mork if (state == rx_cleanup) 64970c37bf9SBjørn Mork dev->pkt_err++; 65070c37bf9SBjørn Mork if (dev->pkt_err > 20) 65170c37bf9SBjørn Mork set_bit(EVENT_RX_KILL, &dev->flags); 65270c37bf9SBjørn Mork } 65370c37bf9SBjørn Mork 6545b6e9bcdSMing Lei state = defer_bh(dev, skb, &dev->rxq, state); 6555b2fc499SJeff Garzik 6565b2fc499SJeff Garzik if (urb) { 6578e95a202SJoe Perches if (netif_running (dev->net) && 6585b6e9bcdSMing Lei !test_bit (EVENT_RX_HALT, &dev->flags) && 6595b6e9bcdSMing Lei state != unlink_start) { 6605b2fc499SJeff Garzik rx_submit (dev, urb, GFP_ATOMIC); 6618a783354SOliver Neukum usb_mark_last_busy(dev->udev); 6625b2fc499SJeff Garzik return; 6635b2fc499SJeff Garzik } 6645b2fc499SJeff Garzik usb_free_urb (urb); 6655b2fc499SJeff Garzik } 666a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, "no read resubmitted\n"); 6675b2fc499SJeff Garzik } 6685b2fc499SJeff Garzik 6695b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 6707834ddbcSJussi Kivilinna void usbnet_pause_rx(struct usbnet *dev) 6717834ddbcSJussi Kivilinna { 6727834ddbcSJussi Kivilinna set_bit(EVENT_RX_PAUSED, &dev->flags); 6737834ddbcSJussi Kivilinna 674a475f603SJoe Perches netif_dbg(dev, rx_status, dev->net, "paused rx queue enabled\n"); 6757834ddbcSJussi Kivilinna } 6767834ddbcSJussi Kivilinna EXPORT_SYMBOL_GPL(usbnet_pause_rx); 6777834ddbcSJussi Kivilinna 6787834ddbcSJussi Kivilinna void usbnet_resume_rx(struct usbnet *dev) 6797834ddbcSJussi Kivilinna { 6807834ddbcSJussi Kivilinna struct sk_buff *skb; 6817834ddbcSJussi Kivilinna int num = 0; 6827834ddbcSJussi Kivilinna 6837834ddbcSJussi Kivilinna clear_bit(EVENT_RX_PAUSED, &dev->flags); 6847834ddbcSJussi Kivilinna 6857834ddbcSJussi Kivilinna while ((skb = skb_dequeue(&dev->rxq_pause)) != NULL) { 6867834ddbcSJussi Kivilinna usbnet_skb_return(dev, skb); 6877834ddbcSJussi Kivilinna num++; 6887834ddbcSJussi Kivilinna } 6897834ddbcSJussi Kivilinna 6907834ddbcSJussi Kivilinna tasklet_schedule(&dev->bh); 6917834ddbcSJussi Kivilinna 692a475f603SJoe Perches netif_dbg(dev, rx_status, dev->net, 693a475f603SJoe Perches "paused rx queue disabled, %d skbs requeued\n", num); 6947834ddbcSJussi Kivilinna } 6957834ddbcSJussi Kivilinna EXPORT_SYMBOL_GPL(usbnet_resume_rx); 6967834ddbcSJussi Kivilinna 6977834ddbcSJussi Kivilinna void usbnet_purge_paused_rxq(struct usbnet *dev) 6987834ddbcSJussi Kivilinna { 6997834ddbcSJussi Kivilinna skb_queue_purge(&dev->rxq_pause); 7007834ddbcSJussi Kivilinna } 7017834ddbcSJussi Kivilinna EXPORT_SYMBOL_GPL(usbnet_purge_paused_rxq); 7027834ddbcSJussi Kivilinna 7037834ddbcSJussi Kivilinna /*-------------------------------------------------------------------------*/ 7045b2fc499SJeff Garzik 7055b2fc499SJeff Garzik // unlink pending rx/tx; completion handlers do all other cleanup 7065b2fc499SJeff Garzik 7075b2fc499SJeff Garzik static int unlink_urbs (struct usbnet *dev, struct sk_buff_head *q) 7085b2fc499SJeff Garzik { 7095b2fc499SJeff Garzik unsigned long flags; 7105b6e9bcdSMing Lei struct sk_buff *skb; 7115b2fc499SJeff Garzik int count = 0; 7125b2fc499SJeff Garzik 7135b2fc499SJeff Garzik spin_lock_irqsave (&q->lock, flags); 7145b6e9bcdSMing Lei while (!skb_queue_empty(q)) { 7155b2fc499SJeff Garzik struct skb_data *entry; 7165b2fc499SJeff Garzik struct urb *urb; 7175b2fc499SJeff Garzik int retval; 7185b2fc499SJeff Garzik 7195b6e9bcdSMing Lei skb_queue_walk(q, skb) { 7205b2fc499SJeff Garzik entry = (struct skb_data *) skb->cb; 7215b6e9bcdSMing Lei if (entry->state != unlink_start) 7225b6e9bcdSMing Lei goto found; 7235b6e9bcdSMing Lei } 7245b6e9bcdSMing Lei break; 7255b6e9bcdSMing Lei found: 7265b6e9bcdSMing Lei entry->state = unlink_start; 7275b2fc499SJeff Garzik urb = entry->urb; 7285b2fc499SJeff Garzik 7290956a8c2Stom.leiming@gmail.com /* 7300956a8c2Stom.leiming@gmail.com * Get reference count of the URB to avoid it to be 7310956a8c2Stom.leiming@gmail.com * freed during usb_unlink_urb, which may trigger 7320956a8c2Stom.leiming@gmail.com * use-after-free problem inside usb_unlink_urb since 7330956a8c2Stom.leiming@gmail.com * usb_unlink_urb is always racing with .complete 7340956a8c2Stom.leiming@gmail.com * handler(include defer_bh). 7350956a8c2Stom.leiming@gmail.com */ 7360956a8c2Stom.leiming@gmail.com usb_get_urb(urb); 7374231d47eSSebastian Siewior spin_unlock_irqrestore(&q->lock, flags); 7385b2fc499SJeff Garzik // during some PM-driven resume scenarios, 7395b2fc499SJeff Garzik // these (async) unlinks complete immediately 7405b2fc499SJeff Garzik retval = usb_unlink_urb (urb); 7415b2fc499SJeff Garzik if (retval != -EINPROGRESS && retval != 0) 74260b86755SJoe Perches netdev_dbg(dev->net, "unlink urb err, %d\n", retval); 7435b2fc499SJeff Garzik else 7445b2fc499SJeff Garzik count++; 7450956a8c2Stom.leiming@gmail.com usb_put_urb(urb); 7464231d47eSSebastian Siewior spin_lock_irqsave(&q->lock, flags); 7475b2fc499SJeff Garzik } 7485b2fc499SJeff Garzik spin_unlock_irqrestore (&q->lock, flags); 7495b2fc499SJeff Garzik return count; 7505b2fc499SJeff Garzik } 7515b2fc499SJeff Garzik 7525b2fc499SJeff Garzik // Flush all pending rx urbs 7535b2fc499SJeff Garzik // minidrivers may need to do this when the MTU changes 7545b2fc499SJeff Garzik 7555b2fc499SJeff Garzik void usbnet_unlink_rx_urbs(struct usbnet *dev) 7565b2fc499SJeff Garzik { 7575b2fc499SJeff Garzik if (netif_running(dev->net)) { 7585b2fc499SJeff Garzik (void) unlink_urbs (dev, &dev->rxq); 7595b2fc499SJeff Garzik tasklet_schedule(&dev->bh); 7605b2fc499SJeff Garzik } 7615b2fc499SJeff Garzik } 7625b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_unlink_rx_urbs); 7635b2fc499SJeff Garzik 7645b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 7655b2fc499SJeff Garzik 766fcb0bb6aSEugene Shatokhin static void wait_skb_queue_empty(struct sk_buff_head *q) 767fcb0bb6aSEugene Shatokhin { 768fcb0bb6aSEugene Shatokhin unsigned long flags; 769fcb0bb6aSEugene Shatokhin 770fcb0bb6aSEugene Shatokhin spin_lock_irqsave(&q->lock, flags); 771fcb0bb6aSEugene Shatokhin while (!skb_queue_empty(q)) { 772fcb0bb6aSEugene Shatokhin spin_unlock_irqrestore(&q->lock, flags); 773fcb0bb6aSEugene Shatokhin schedule_timeout(msecs_to_jiffies(UNLINK_TIMEOUT_MS)); 774fcb0bb6aSEugene Shatokhin set_current_state(TASK_UNINTERRUPTIBLE); 775fcb0bb6aSEugene Shatokhin spin_lock_irqsave(&q->lock, flags); 776fcb0bb6aSEugene Shatokhin } 777fcb0bb6aSEugene Shatokhin spin_unlock_irqrestore(&q->lock, flags); 778fcb0bb6aSEugene Shatokhin } 779fcb0bb6aSEugene Shatokhin 7805b2fc499SJeff Garzik // precondition: never called in_interrupt 78169ee472fSOliver Neukum static void usbnet_terminate_urbs(struct usbnet *dev) 78269ee472fSOliver Neukum { 78369ee472fSOliver Neukum DECLARE_WAITQUEUE(wait, current); 78469ee472fSOliver Neukum int temp; 78569ee472fSOliver Neukum 78669ee472fSOliver Neukum /* ensure there are no more active urbs */ 78714a0d635SOliver Neukum add_wait_queue(&dev->wait, &wait); 78869ee472fSOliver Neukum set_current_state(TASK_UNINTERRUPTIBLE); 78969ee472fSOliver Neukum temp = unlink_urbs(dev, &dev->txq) + 79069ee472fSOliver Neukum unlink_urbs(dev, &dev->rxq); 79169ee472fSOliver Neukum 79269ee472fSOliver Neukum /* maybe wait for deletions to finish. */ 793fcb0bb6aSEugene Shatokhin wait_skb_queue_empty(&dev->rxq); 794fcb0bb6aSEugene Shatokhin wait_skb_queue_empty(&dev->txq); 795fcb0bb6aSEugene Shatokhin wait_skb_queue_empty(&dev->done); 796a475f603SJoe Perches netif_dbg(dev, ifdown, dev->net, 797a475f603SJoe Perches "waited for %d urb completions\n", temp); 79869ee472fSOliver Neukum set_current_state(TASK_RUNNING); 79914a0d635SOliver Neukum remove_wait_queue(&dev->wait, &wait); 80069ee472fSOliver Neukum } 8015b2fc499SJeff Garzik 802777baa47SStephen Hemminger int usbnet_stop (struct net_device *net) 8035b2fc499SJeff Garzik { 8045b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 805a33e9e7fSJussi Kivilinna struct driver_info *info = dev->driver_info; 806f50791acSEugene Shatokhin int retval, pm, mpn; 8075b2fc499SJeff Garzik 80875bd0cbdSMing Lei clear_bit(EVENT_DEV_OPEN, &dev->flags); 8095b2fc499SJeff Garzik netif_stop_queue (net); 8105b2fc499SJeff Garzik 811a475f603SJoe Perches netif_info(dev, ifdown, dev->net, 8128ccef431SBen Hutchings "stop stats: rx/tx %lu/%lu, errs %lu/%lu\n", 8137963837fSHerbert Xu net->stats.rx_packets, net->stats.tx_packets, 81460b86755SJoe Perches net->stats.rx_errors, net->stats.tx_errors); 8155b2fc499SJeff Garzik 81614a0d635SOliver Neukum /* to not race resume */ 81714a0d635SOliver Neukum pm = usb_autopm_get_interface(dev->intf); 818a33e9e7fSJussi Kivilinna /* allow minidriver to stop correctly (wireless devices to turn off 819a33e9e7fSJussi Kivilinna * radio etc) */ 820a33e9e7fSJussi Kivilinna if (info->stop) { 821a33e9e7fSJussi Kivilinna retval = info->stop(dev); 822a475f603SJoe Perches if (retval < 0) 823a475f603SJoe Perches netif_info(dev, ifdown, dev->net, 82460b86755SJoe Perches "stop fail (%d) usbnet usb-%s-%s, %s\n", 825a33e9e7fSJussi Kivilinna retval, 826a33e9e7fSJussi Kivilinna dev->udev->bus->bus_name, dev->udev->devpath, 827a33e9e7fSJussi Kivilinna info->description); 828a33e9e7fSJussi Kivilinna } 829a33e9e7fSJussi Kivilinna 83069ee472fSOliver Neukum if (!(info->flags & FLAG_AVOID_UNLINK_URBS)) 83169ee472fSOliver Neukum usbnet_terminate_urbs(dev); 8325b2fc499SJeff Garzik 8336eecdc5fSDan Williams usbnet_status_stop(dev); 8345b2fc499SJeff Garzik 8357834ddbcSJussi Kivilinna usbnet_purge_paused_rxq(dev); 8367834ddbcSJussi Kivilinna 837f50791acSEugene Shatokhin mpn = !test_and_clear_bit(EVENT_NO_RUNTIME_PM, &dev->flags); 838f50791acSEugene Shatokhin 8395b2fc499SJeff Garzik /* deferred work (task, timer, softirq) must also stop. 8405b2fc499SJeff Garzik * can't flush_scheduled_work() until we drop rtnl (later), 8415b2fc499SJeff Garzik * else workers could deadlock; so make workers a NOP. 8425b2fc499SJeff Garzik */ 8435b2fc499SJeff Garzik dev->flags = 0; 8445b2fc499SJeff Garzik del_timer_sync (&dev->delay); 8455b2fc499SJeff Garzik tasklet_kill (&dev->bh); 84614a0d635SOliver Neukum if (!pm) 84714a0d635SOliver Neukum usb_autopm_put_interface(dev->intf); 84814a0d635SOliver Neukum 849f50791acSEugene Shatokhin if (info->manage_power && mpn) 85069ee472fSOliver Neukum info->manage_power(dev, 0); 85169ee472fSOliver Neukum else 852a11a6544SOliver Neukum usb_autopm_put_interface(dev->intf); 8535b2fc499SJeff Garzik 8545b2fc499SJeff Garzik return 0; 8555b2fc499SJeff Garzik } 856777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_stop); 8575b2fc499SJeff Garzik 8585b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 8595b2fc499SJeff Garzik 8605b2fc499SJeff Garzik // posts reads, and enables write queuing 8615b2fc499SJeff Garzik 8625b2fc499SJeff Garzik // precondition: never called in_interrupt 8635b2fc499SJeff Garzik 864777baa47SStephen Hemminger int usbnet_open (struct net_device *net) 8655b2fc499SJeff Garzik { 8665b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 867a11a6544SOliver Neukum int retval; 8685b2fc499SJeff Garzik struct driver_info *info = dev->driver_info; 8695b2fc499SJeff Garzik 870a11a6544SOliver Neukum if ((retval = usb_autopm_get_interface(dev->intf)) < 0) { 871a475f603SJoe Perches netif_info(dev, ifup, dev->net, 87260b86755SJoe Perches "resumption fail (%d) usbnet usb-%s-%s, %s\n", 873a11a6544SOliver Neukum retval, 87460b86755SJoe Perches dev->udev->bus->bus_name, 87560b86755SJoe Perches dev->udev->devpath, 876a11a6544SOliver Neukum info->description); 877a11a6544SOliver Neukum goto done_nopm; 878a11a6544SOliver Neukum } 879a11a6544SOliver Neukum 8805b2fc499SJeff Garzik // put into "known safe" state 8815b2fc499SJeff Garzik if (info->reset && (retval = info->reset (dev)) < 0) { 882a475f603SJoe Perches netif_info(dev, ifup, dev->net, 88360b86755SJoe Perches "open reset fail (%d) usbnet usb-%s-%s, %s\n", 8845b2fc499SJeff Garzik retval, 88560b86755SJoe Perches dev->udev->bus->bus_name, 88660b86755SJoe Perches dev->udev->devpath, 8875b2fc499SJeff Garzik info->description); 8885b2fc499SJeff Garzik goto done; 8895b2fc499SJeff Garzik } 8905b2fc499SJeff Garzik 891a88c32aeSMing Lei /* hard_mtu or rx_urb_size may change in reset() */ 892a88c32aeSMing Lei usbnet_update_max_qlen(dev); 893a88c32aeSMing Lei 8945b2fc499SJeff Garzik // insist peer be connected 8955b2fc499SJeff Garzik if (info->check_connect && (retval = info->check_connect (dev)) < 0) { 896a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, "can't open; %d\n", retval); 8975b2fc499SJeff Garzik goto done; 8985b2fc499SJeff Garzik } 8995b2fc499SJeff Garzik 9005b2fc499SJeff Garzik /* start any status interrupt transfer */ 9015b2fc499SJeff Garzik if (dev->interrupt) { 9026eecdc5fSDan Williams retval = usbnet_status_start(dev, GFP_KERNEL); 9035b2fc499SJeff Garzik if (retval < 0) { 904a475f603SJoe Perches netif_err(dev, ifup, dev->net, 905a475f603SJoe Perches "intr submit %d\n", retval); 9065b2fc499SJeff Garzik goto done; 9075b2fc499SJeff Garzik } 9085b2fc499SJeff Garzik } 9095b2fc499SJeff Garzik 91068972efaSPaul Stewart set_bit(EVENT_DEV_OPEN, &dev->flags); 9115b2fc499SJeff Garzik netif_start_queue (net); 912a475f603SJoe Perches netif_info(dev, ifup, dev->net, 913a475f603SJoe Perches "open: enable queueing (rx %d, tx %d) mtu %d %s framing\n", 91460b86755SJoe Perches (int)RX_QLEN(dev), (int)TX_QLEN(dev), 915a475f603SJoe Perches dev->net->mtu, 916a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_NC) ? "NetChip" : 917a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_GL) ? "GeneSys" : 918a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_Z) ? "Zaurus" : 919a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_RN) ? "RNDIS" : 920a475f603SJoe Perches (dev->driver_info->flags & FLAG_FRAMING_AX) ? "ASIX" : 921a475f603SJoe Perches "simple"); 9225b2fc499SJeff Garzik 92370c37bf9SBjørn Mork /* reset rx error state */ 92470c37bf9SBjørn Mork dev->pkt_cnt = 0; 92570c37bf9SBjørn Mork dev->pkt_err = 0; 92670c37bf9SBjørn Mork clear_bit(EVENT_RX_KILL, &dev->flags); 92770c37bf9SBjørn Mork 9285b2fc499SJeff Garzik // delay posting reads until we're fully open 9295b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 93069ee472fSOliver Neukum if (info->manage_power) { 93169ee472fSOliver Neukum retval = info->manage_power(dev, 1); 932a1c088e0SOliver Neukum if (retval < 0) { 933a1c088e0SOliver Neukum retval = 0; 934a1c088e0SOliver Neukum set_bit(EVENT_NO_RUNTIME_PM, &dev->flags); 935a1c088e0SOliver Neukum } else { 93669ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 93769ee472fSOliver Neukum } 938a1c088e0SOliver Neukum } 939a11a6544SOliver Neukum return retval; 9405b2fc499SJeff Garzik done: 941a11a6544SOliver Neukum usb_autopm_put_interface(dev->intf); 942a11a6544SOliver Neukum done_nopm: 9435b2fc499SJeff Garzik return retval; 9445b2fc499SJeff Garzik } 945777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_open); 9465b2fc499SJeff Garzik 9475b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 9485b2fc499SJeff Garzik 9495b2fc499SJeff Garzik /* ethtool methods; minidrivers may need to add some more, but 9505b2fc499SJeff Garzik * they'll probably want to use this base set. 9515b2fc499SJeff Garzik */ 9525b2fc499SJeff Garzik 9535b2fc499SJeff Garzik int usbnet_get_settings (struct net_device *net, struct ethtool_cmd *cmd) 9545b2fc499SJeff Garzik { 9555b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 9565b2fc499SJeff Garzik 9575b2fc499SJeff Garzik if (!dev->mii.mdio_read) 9585b2fc499SJeff Garzik return -EOPNOTSUPP; 9595b2fc499SJeff Garzik 9605b2fc499SJeff Garzik return mii_ethtool_gset(&dev->mii, cmd); 9615b2fc499SJeff Garzik } 9625b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_settings); 9635b2fc499SJeff Garzik 9645b2fc499SJeff Garzik int usbnet_set_settings (struct net_device *net, struct ethtool_cmd *cmd) 9655b2fc499SJeff Garzik { 9665b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 9675b2fc499SJeff Garzik int retval; 9685b2fc499SJeff Garzik 9695b2fc499SJeff Garzik if (!dev->mii.mdio_write) 9705b2fc499SJeff Garzik return -EOPNOTSUPP; 9715b2fc499SJeff Garzik 9725b2fc499SJeff Garzik retval = mii_ethtool_sset(&dev->mii, cmd); 9735b2fc499SJeff Garzik 9745b2fc499SJeff Garzik /* link speed/duplex might have changed */ 9755b2fc499SJeff Garzik if (dev->driver_info->link_reset) 9765b2fc499SJeff Garzik dev->driver_info->link_reset(dev); 9775b2fc499SJeff Garzik 978a88c32aeSMing Lei /* hard_mtu or rx_urb_size may change in link_reset() */ 979a88c32aeSMing Lei usbnet_update_max_qlen(dev); 980a88c32aeSMing Lei 9815b2fc499SJeff Garzik return retval; 9825b2fc499SJeff Garzik 9835b2fc499SJeff Garzik } 9845b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_set_settings); 9855b2fc499SJeff Garzik 9865b2fc499SJeff Garzik u32 usbnet_get_link (struct net_device *net) 9875b2fc499SJeff Garzik { 9885b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 9895b2fc499SJeff Garzik 9905b2fc499SJeff Garzik /* If a check_connect is defined, return its result */ 9915b2fc499SJeff Garzik if (dev->driver_info->check_connect) 9925b2fc499SJeff Garzik return dev->driver_info->check_connect (dev) == 0; 9935b2fc499SJeff Garzik 9945b2fc499SJeff Garzik /* if the device has mii operations, use those */ 9955b2fc499SJeff Garzik if (dev->mii.mdio_read) 9965b2fc499SJeff Garzik return mii_link_ok(&dev->mii); 9975b2fc499SJeff Garzik 99805ffb3e2SBjørn Mork /* Otherwise, dtrt for drivers calling netif_carrier_{on,off} */ 99905ffb3e2SBjørn Mork return ethtool_op_get_link(net); 10005b2fc499SJeff Garzik } 10015b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_link); 10025b2fc499SJeff Garzik 10035b2fc499SJeff Garzik int usbnet_nway_reset(struct net_device *net) 10045b2fc499SJeff Garzik { 10055b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 10065b2fc499SJeff Garzik 10075b2fc499SJeff Garzik if (!dev->mii.mdio_write) 10085b2fc499SJeff Garzik return -EOPNOTSUPP; 10095b2fc499SJeff Garzik 10105b2fc499SJeff Garzik return mii_nway_restart(&dev->mii); 10115b2fc499SJeff Garzik } 10125b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_nway_reset); 10135b2fc499SJeff Garzik 10145b2fc499SJeff Garzik void usbnet_get_drvinfo (struct net_device *net, struct ethtool_drvinfo *info) 10155b2fc499SJeff Garzik { 10165b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 10175b2fc499SJeff Garzik 101886a2f415SPhil Sutter strlcpy (info->driver, dev->driver_name, sizeof info->driver); 101986a2f415SPhil Sutter strlcpy (info->version, DRIVER_VERSION, sizeof info->version); 102086a2f415SPhil Sutter strlcpy (info->fw_version, dev->driver_info->description, 10215b2fc499SJeff Garzik sizeof info->fw_version); 10225b2fc499SJeff Garzik usb_make_path (dev->udev, info->bus_info, sizeof info->bus_info); 10235b2fc499SJeff Garzik } 10245b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_drvinfo); 10255b2fc499SJeff Garzik 10265b2fc499SJeff Garzik u32 usbnet_get_msglevel (struct net_device *net) 10275b2fc499SJeff Garzik { 10285b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 10295b2fc499SJeff Garzik 10305b2fc499SJeff Garzik return dev->msg_enable; 10315b2fc499SJeff Garzik } 10325b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_get_msglevel); 10335b2fc499SJeff Garzik 10345b2fc499SJeff Garzik void usbnet_set_msglevel (struct net_device *net, u32 level) 10355b2fc499SJeff Garzik { 10365b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 10375b2fc499SJeff Garzik 10385b2fc499SJeff Garzik dev->msg_enable = level; 10395b2fc499SJeff Garzik } 10405b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_set_msglevel); 10415b2fc499SJeff Garzik 10425b2fc499SJeff Garzik /* drivers may override default ethtool_ops in their bind() routine */ 10430fc0b732SStephen Hemminger static const struct ethtool_ops usbnet_ethtool_ops = { 10445b2fc499SJeff Garzik .get_settings = usbnet_get_settings, 10455b2fc499SJeff Garzik .set_settings = usbnet_set_settings, 10465b2fc499SJeff Garzik .get_link = usbnet_get_link, 10475b2fc499SJeff Garzik .nway_reset = usbnet_nway_reset, 10485b2fc499SJeff Garzik .get_drvinfo = usbnet_get_drvinfo, 10495b2fc499SJeff Garzik .get_msglevel = usbnet_get_msglevel, 10505b2fc499SJeff Garzik .set_msglevel = usbnet_set_msglevel, 1051123edb18SRichard Cochran .get_ts_info = ethtool_op_get_ts_info, 10525b2fc499SJeff Garzik }; 10535b2fc499SJeff Garzik 10545b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 10555b2fc499SJeff Garzik 10564b49f58fSMing Lei static void __handle_link_change(struct usbnet *dev) 10574b49f58fSMing Lei { 10584b49f58fSMing Lei if (!test_bit(EVENT_DEV_OPEN, &dev->flags)) 10594b49f58fSMing Lei return; 10604b49f58fSMing Lei 10614b49f58fSMing Lei if (!netif_carrier_ok(dev->net)) { 10624b49f58fSMing Lei /* kill URBs for reading packets to save bus bandwidth */ 10634b49f58fSMing Lei unlink_urbs(dev, &dev->rxq); 10644b49f58fSMing Lei 10654b49f58fSMing Lei /* 10664b49f58fSMing Lei * tx_timeout will unlink URBs for sending packets and 10674b49f58fSMing Lei * tx queue is stopped by netcore after link becomes off 10684b49f58fSMing Lei */ 10694b49f58fSMing Lei } else { 10704b49f58fSMing Lei /* submitting URBs for reading packets */ 10714b49f58fSMing Lei tasklet_schedule(&dev->bh); 10724b49f58fSMing Lei } 10734b49f58fSMing Lei 1074a88c32aeSMing Lei /* hard_mtu or rx_urb_size may change during link change */ 1075a88c32aeSMing Lei usbnet_update_max_qlen(dev); 1076a88c32aeSMing Lei 10774b49f58fSMing Lei clear_bit(EVENT_LINK_CHANGE, &dev->flags); 10784b49f58fSMing Lei } 10794b49f58fSMing Lei 10801efed2d0SOlivier Blin static void usbnet_set_rx_mode(struct net_device *net) 10811efed2d0SOlivier Blin { 10821efed2d0SOlivier Blin struct usbnet *dev = netdev_priv(net); 10831efed2d0SOlivier Blin 10841efed2d0SOlivier Blin usbnet_defer_kevent(dev, EVENT_SET_RX_MODE); 10851efed2d0SOlivier Blin } 10861efed2d0SOlivier Blin 10871efed2d0SOlivier Blin static void __handle_set_rx_mode(struct usbnet *dev) 10881efed2d0SOlivier Blin { 10891efed2d0SOlivier Blin if (dev->driver_info->set_rx_mode) 10901efed2d0SOlivier Blin (dev->driver_info->set_rx_mode)(dev); 10911efed2d0SOlivier Blin 10921efed2d0SOlivier Blin clear_bit(EVENT_SET_RX_MODE, &dev->flags); 10931efed2d0SOlivier Blin } 10941efed2d0SOlivier Blin 10955b2fc499SJeff Garzik /* work that cannot be done in interrupt context uses keventd. 10965b2fc499SJeff Garzik * 10975b2fc499SJeff Garzik * NOTE: with 2.5 we could do more of this using completion callbacks, 10985b2fc499SJeff Garzik * especially now that control transfers can be queued. 10995b2fc499SJeff Garzik */ 11005b2fc499SJeff Garzik static void 110111f17ef3SOliver Neukum usbnet_deferred_kevent (struct work_struct *work) 11025b2fc499SJeff Garzik { 11035b2fc499SJeff Garzik struct usbnet *dev = 11045b2fc499SJeff Garzik container_of(work, struct usbnet, kevent); 11055b2fc499SJeff Garzik int status; 11065b2fc499SJeff Garzik 11075b2fc499SJeff Garzik /* usb_clear_halt() needs a thread context */ 11085b2fc499SJeff Garzik if (test_bit (EVENT_TX_HALT, &dev->flags)) { 11095b2fc499SJeff Garzik unlink_urbs (dev, &dev->txq); 111069ee472fSOliver Neukum status = usb_autopm_get_interface(dev->intf); 111169ee472fSOliver Neukum if (status < 0) 111269ee472fSOliver Neukum goto fail_pipe; 11135b2fc499SJeff Garzik status = usb_clear_halt (dev->udev, dev->out); 111469ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 11158e95a202SJoe Perches if (status < 0 && 11168e95a202SJoe Perches status != -EPIPE && 11178e95a202SJoe Perches status != -ESHUTDOWN) { 11185b2fc499SJeff Garzik if (netif_msg_tx_err (dev)) 111969ee472fSOliver Neukum fail_pipe: 112060b86755SJoe Perches netdev_err(dev->net, "can't clear tx halt, status %d\n", 11215b2fc499SJeff Garzik status); 11225b2fc499SJeff Garzik } else { 11235b2fc499SJeff Garzik clear_bit (EVENT_TX_HALT, &dev->flags); 11245b2fc499SJeff Garzik if (status != -ESHUTDOWN) 11255b2fc499SJeff Garzik netif_wake_queue (dev->net); 11265b2fc499SJeff Garzik } 11275b2fc499SJeff Garzik } 11285b2fc499SJeff Garzik if (test_bit (EVENT_RX_HALT, &dev->flags)) { 11295b2fc499SJeff Garzik unlink_urbs (dev, &dev->rxq); 113069ee472fSOliver Neukum status = usb_autopm_get_interface(dev->intf); 113169ee472fSOliver Neukum if (status < 0) 113269ee472fSOliver Neukum goto fail_halt; 11335b2fc499SJeff Garzik status = usb_clear_halt (dev->udev, dev->in); 113469ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 11358e95a202SJoe Perches if (status < 0 && 11368e95a202SJoe Perches status != -EPIPE && 11378e95a202SJoe Perches status != -ESHUTDOWN) { 11385b2fc499SJeff Garzik if (netif_msg_rx_err (dev)) 113969ee472fSOliver Neukum fail_halt: 114060b86755SJoe Perches netdev_err(dev->net, "can't clear rx halt, status %d\n", 11415b2fc499SJeff Garzik status); 11425b2fc499SJeff Garzik } else { 11435b2fc499SJeff Garzik clear_bit (EVENT_RX_HALT, &dev->flags); 11445b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 11455b2fc499SJeff Garzik } 11465b2fc499SJeff Garzik } 11475b2fc499SJeff Garzik 11485b2fc499SJeff Garzik /* tasklet could resubmit itself forever if memory is tight */ 11495b2fc499SJeff Garzik if (test_bit (EVENT_RX_MEMORY, &dev->flags)) { 11505b2fc499SJeff Garzik struct urb *urb = NULL; 1151dacb3975SDavid S. Miller int resched = 1; 11525b2fc499SJeff Garzik 11535b2fc499SJeff Garzik if (netif_running (dev->net)) 11545b2fc499SJeff Garzik urb = usb_alloc_urb (0, GFP_KERNEL); 11555b2fc499SJeff Garzik else 11565b2fc499SJeff Garzik clear_bit (EVENT_RX_MEMORY, &dev->flags); 11575b2fc499SJeff Garzik if (urb != NULL) { 11585b2fc499SJeff Garzik clear_bit (EVENT_RX_MEMORY, &dev->flags); 115969ee472fSOliver Neukum status = usb_autopm_get_interface(dev->intf); 1160ab60707fSJesper Juhl if (status < 0) { 1161ab60707fSJesper Juhl usb_free_urb(urb); 116269ee472fSOliver Neukum goto fail_lowmem; 1163ab60707fSJesper Juhl } 1164dacb3975SDavid S. Miller if (rx_submit (dev, urb, GFP_KERNEL) == -ENOLINK) 1165dacb3975SDavid S. Miller resched = 0; 116669ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 116769ee472fSOliver Neukum fail_lowmem: 1168dacb3975SDavid S. Miller if (resched) 11695b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 11705b2fc499SJeff Garzik } 11715b2fc499SJeff Garzik } 11725b2fc499SJeff Garzik 11735b2fc499SJeff Garzik if (test_bit (EVENT_LINK_RESET, &dev->flags)) { 11745b2fc499SJeff Garzik struct driver_info *info = dev->driver_info; 11755b2fc499SJeff Garzik int retval = 0; 11765b2fc499SJeff Garzik 11775b2fc499SJeff Garzik clear_bit (EVENT_LINK_RESET, &dev->flags); 117869ee472fSOliver Neukum status = usb_autopm_get_interface(dev->intf); 117969ee472fSOliver Neukum if (status < 0) 118069ee472fSOliver Neukum goto skip_reset; 11815b2fc499SJeff Garzik if(info->link_reset && (retval = info->link_reset(dev)) < 0) { 118269ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 118369ee472fSOliver Neukum skip_reset: 118460b86755SJoe Perches netdev_info(dev->net, "link reset failed (%d) usbnet usb-%s-%s, %s\n", 11855b2fc499SJeff Garzik retval, 118660b86755SJoe Perches dev->udev->bus->bus_name, 118760b86755SJoe Perches dev->udev->devpath, 11885b2fc499SJeff Garzik info->description); 118969ee472fSOliver Neukum } else { 119069ee472fSOliver Neukum usb_autopm_put_interface(dev->intf); 11915b2fc499SJeff Garzik } 11924b49f58fSMing Lei 11934b49f58fSMing Lei /* handle link change from link resetting */ 11944b49f58fSMing Lei __handle_link_change(dev); 11955b2fc499SJeff Garzik } 11965b2fc499SJeff Garzik 11974b49f58fSMing Lei if (test_bit (EVENT_LINK_CHANGE, &dev->flags)) 11984b49f58fSMing Lei __handle_link_change(dev); 11994b49f58fSMing Lei 12001efed2d0SOlivier Blin if (test_bit (EVENT_SET_RX_MODE, &dev->flags)) 12011efed2d0SOlivier Blin __handle_set_rx_mode(dev); 12021efed2d0SOlivier Blin 12031efed2d0SOlivier Blin 12045b2fc499SJeff Garzik if (dev->flags) 120560b86755SJoe Perches netdev_dbg(dev->net, "kevent done, flags = 0x%lx\n", dev->flags); 12065b2fc499SJeff Garzik } 12075b2fc499SJeff Garzik 12085b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 12095b2fc499SJeff Garzik 12105b2fc499SJeff Garzik static void tx_complete (struct urb *urb) 12115b2fc499SJeff Garzik { 12125b2fc499SJeff Garzik struct sk_buff *skb = (struct sk_buff *) urb->context; 12135b2fc499SJeff Garzik struct skb_data *entry = (struct skb_data *) skb->cb; 12145b2fc499SJeff Garzik struct usbnet *dev = entry->dev; 12155b2fc499SJeff Garzik 12165b2fc499SJeff Garzik if (urb->status == 0) { 12171e9e39f4SBen Hutchings dev->net->stats.tx_packets += entry->packets; 12187963837fSHerbert Xu dev->net->stats.tx_bytes += entry->length; 12195b2fc499SJeff Garzik } else { 12207963837fSHerbert Xu dev->net->stats.tx_errors++; 12215b2fc499SJeff Garzik 12225b2fc499SJeff Garzik switch (urb->status) { 12235b2fc499SJeff Garzik case -EPIPE: 12245b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_TX_HALT); 12255b2fc499SJeff Garzik break; 12265b2fc499SJeff Garzik 12275b2fc499SJeff Garzik /* software-driven interface shutdown */ 12285b2fc499SJeff Garzik case -ECONNRESET: // async unlink 12295b2fc499SJeff Garzik case -ESHUTDOWN: // hardware gone 12305b2fc499SJeff Garzik break; 12315b2fc499SJeff Garzik 123237ebb549SPetr Mladek /* like rx, tx gets controller i/o faults during hub_wq 123337ebb549SPetr Mladek * delays and so it uses the same throttling mechanism. 123437ebb549SPetr Mladek */ 12355b2fc499SJeff Garzik case -EPROTO: 12365b2fc499SJeff Garzik case -ETIME: 12375b2fc499SJeff Garzik case -EILSEQ: 123869ee472fSOliver Neukum usb_mark_last_busy(dev->udev); 12395b2fc499SJeff Garzik if (!timer_pending (&dev->delay)) { 12405b2fc499SJeff Garzik mod_timer (&dev->delay, 12415b2fc499SJeff Garzik jiffies + THROTTLE_JIFFIES); 1242a475f603SJoe Perches netif_dbg(dev, link, dev->net, 1243a475f603SJoe Perches "tx throttle %d\n", urb->status); 12445b2fc499SJeff Garzik } 12455b2fc499SJeff Garzik netif_stop_queue (dev->net); 12465b2fc499SJeff Garzik break; 12475b2fc499SJeff Garzik default: 1248a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, 1249a475f603SJoe Perches "tx err %d\n", entry->urb->status); 12505b2fc499SJeff Garzik break; 12515b2fc499SJeff Garzik } 12525b2fc499SJeff Garzik } 12535b2fc499SJeff Garzik 125469ee472fSOliver Neukum usb_autopm_put_interface_async(dev->intf); 12555b6e9bcdSMing Lei (void) defer_bh(dev, skb, &dev->txq, tx_done); 12565b2fc499SJeff Garzik } 12575b2fc499SJeff Garzik 12585b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 12595b2fc499SJeff Garzik 1260777baa47SStephen Hemminger void usbnet_tx_timeout (struct net_device *net) 12615b2fc499SJeff Garzik { 12625b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 12635b2fc499SJeff Garzik 12645b2fc499SJeff Garzik unlink_urbs (dev, &dev->txq); 12655b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 1266dbcdd4d5SOliver Neukum /* this needs to be handled individually because the generic layer 1267dbcdd4d5SOliver Neukum * doesn't know what is sufficient and could not restore private 1268dbcdd4d5SOliver Neukum * information if a remedy of an unconditional reset were used. 1269dbcdd4d5SOliver Neukum */ 1270dbcdd4d5SOliver Neukum if (dev->driver_info->recover) 1271dbcdd4d5SOliver Neukum (dev->driver_info->recover)(dev); 12725b2fc499SJeff Garzik } 1273777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_tx_timeout); 12745b2fc499SJeff Garzik 12755b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 12765b2fc499SJeff Garzik 1277638c5115SMing Lei static int build_dma_sg(const struct sk_buff *skb, struct urb *urb) 1278638c5115SMing Lei { 1279638c5115SMing Lei unsigned num_sgs, total_len = 0; 1280638c5115SMing Lei int i, s = 0; 1281638c5115SMing Lei 1282638c5115SMing Lei num_sgs = skb_shinfo(skb)->nr_frags + 1; 1283638c5115SMing Lei if (num_sgs == 1) 1284638c5115SMing Lei return 0; 1285638c5115SMing Lei 128660e453a9SMing Lei /* reserve one for zero packet */ 128760e453a9SMing Lei urb->sg = kmalloc((num_sgs + 1) * sizeof(struct scatterlist), 128860e453a9SMing Lei GFP_ATOMIC); 1289638c5115SMing Lei if (!urb->sg) 1290638c5115SMing Lei return -ENOMEM; 1291638c5115SMing Lei 1292638c5115SMing Lei urb->num_sgs = num_sgs; 1293fdc3452cSBjørn Mork sg_init_table(urb->sg, urb->num_sgs + 1); 1294638c5115SMing Lei 1295638c5115SMing Lei sg_set_buf(&urb->sg[s++], skb->data, skb_headlen(skb)); 1296638c5115SMing Lei total_len += skb_headlen(skb); 1297638c5115SMing Lei 1298638c5115SMing Lei for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) { 1299638c5115SMing Lei struct skb_frag_struct *f = &skb_shinfo(skb)->frags[i]; 1300638c5115SMing Lei 1301638c5115SMing Lei total_len += skb_frag_size(f); 1302638c5115SMing Lei sg_set_page(&urb->sg[i + s], f->page.p, f->size, 1303638c5115SMing Lei f->page_offset); 1304638c5115SMing Lei } 1305638c5115SMing Lei urb->transfer_buffer_length = total_len; 1306638c5115SMing Lei 1307638c5115SMing Lei return 1; 1308638c5115SMing Lei } 1309638c5115SMing Lei 131025a79c41SStephen Hemminger netdev_tx_t usbnet_start_xmit (struct sk_buff *skb, 131125a79c41SStephen Hemminger struct net_device *net) 13125b2fc499SJeff Garzik { 13135b2fc499SJeff Garzik struct usbnet *dev = netdev_priv(net); 13143e4336a6SJason A. Donenfeld unsigned int length; 13155b2fc499SJeff Garzik struct urb *urb = NULL; 13165b2fc499SJeff Garzik struct skb_data *entry; 13175b2fc499SJeff Garzik struct driver_info *info = dev->driver_info; 13185b2fc499SJeff Garzik unsigned long flags; 131925a79c41SStephen Hemminger int retval; 13205b2fc499SJeff Garzik 132123ba0799SKonstantin Khlebnikov if (skb) 1322f9b491ecSMichael Riesch skb_tx_timestamp(skb); 1323f9b491ecSMichael Riesch 13245b2fc499SJeff Garzik // some devices want funky USB-level framing, for 13255b2fc499SJeff Garzik // win32 driver (usually) and/or hardware quirks 13265b2fc499SJeff Garzik if (info->tx_fixup) { 13275b2fc499SJeff Garzik skb = info->tx_fixup (dev, skb, GFP_ATOMIC); 13285b2fc499SJeff Garzik if (!skb) { 1329bf414b36SBjørn Mork /* packet collected; minidriver waiting for more */ 1330bf414b36SBjørn Mork if (info->flags & FLAG_MULTI_PACKET) 1331bf414b36SBjørn Mork goto not_drop; 1332a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, "can't tx_fixup skb\n"); 13335b2fc499SJeff Garzik goto drop; 13345b2fc499SJeff Garzik } 13355b2fc499SJeff Garzik } 13365b2fc499SJeff Garzik 13375b2fc499SJeff Garzik if (!(urb = usb_alloc_urb (0, GFP_ATOMIC))) { 1338a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, "no urb\n"); 13395b2fc499SJeff Garzik goto drop; 13405b2fc499SJeff Garzik } 13415b2fc499SJeff Garzik 13425b2fc499SJeff Garzik entry = (struct skb_data *) skb->cb; 13435b2fc499SJeff Garzik entry->urb = urb; 13445b2fc499SJeff Garzik entry->dev = dev; 13455b2fc499SJeff Garzik 13465b2fc499SJeff Garzik usb_fill_bulk_urb (urb, dev->udev, dev->out, 13475b2fc499SJeff Garzik skb->data, skb->len, tx_complete, skb); 1348638c5115SMing Lei if (dev->can_dma_sg) { 1349638c5115SMing Lei if (build_dma_sg(skb, urb) < 0) 1350638c5115SMing Lei goto drop; 1351638c5115SMing Lei } 135260e453a9SMing Lei length = urb->transfer_buffer_length; 13535b2fc499SJeff Garzik 13545b2fc499SJeff Garzik /* don't assume the hardware handles USB_ZERO_PACKET 13555b2fc499SJeff Garzik * NOTE: strictly conforming cdc-ether devices should expect 13565b2fc499SJeff Garzik * the ZLP here, but ignore the one-byte packet. 1357073285fdSAlexey Orishko * NOTE2: CDC NCM specification is different from CDC ECM when 1358073285fdSAlexey Orishko * handling ZLP/short packets, so cdc_ncm driver will make short 1359073285fdSAlexey Orishko * packet itself if needed. 13605b2fc499SJeff Garzik */ 1361b4d562e3SElina Pasheva if (length % dev->maxpacket == 0) { 1362b4d562e3SElina Pasheva if (!(info->flags & FLAG_SEND_ZLP)) { 1363073285fdSAlexey Orishko if (!(info->flags & FLAG_MULTI_PACKET)) { 136460e453a9SMing Lei length++; 136560e453a9SMing Lei if (skb_tailroom(skb) && !urb->num_sgs) { 13663e323f3eSPeter Korsgaard skb->data[skb->len] = 0; 13673e323f3eSPeter Korsgaard __skb_put(skb, 1); 136860e453a9SMing Lei } else if (urb->num_sgs) 136960e453a9SMing Lei sg_set_buf(&urb->sg[urb->num_sgs++], 137060e453a9SMing Lei dev->padding_pkt, 1); 1371073285fdSAlexey Orishko } 1372b4d562e3SElina Pasheva } else 1373b4d562e3SElina Pasheva urb->transfer_flags |= URB_ZERO_PACKET; 13743e323f3eSPeter Korsgaard } 13757a1e890eSBen Hutchings urb->transfer_buffer_length = length; 13767a1e890eSBen Hutchings 13777a1e890eSBen Hutchings if (info->flags & FLAG_MULTI_PACKET) { 13787a1e890eSBen Hutchings /* Driver has set number of packets and a length delta. 13797a1e890eSBen Hutchings * Calculate the complete length and ensure that it's 13807a1e890eSBen Hutchings * positive. 13817a1e890eSBen Hutchings */ 13827a1e890eSBen Hutchings entry->length += length; 13837a1e890eSBen Hutchings if (WARN_ON_ONCE(entry->length <= 0)) 13847a1e890eSBen Hutchings entry->length = length; 13857a1e890eSBen Hutchings } else { 13867a1e890eSBen Hutchings usbnet_set_skb_tx_stats(skb, 1, length); 13877a1e890eSBen Hutchings } 13885b2fc499SJeff Garzik 13895b2fc499SJeff Garzik spin_lock_irqsave(&dev->txq.lock, flags); 139069ee472fSOliver Neukum retval = usb_autopm_get_interface_async(dev->intf); 139169ee472fSOliver Neukum if (retval < 0) { 139269ee472fSOliver Neukum spin_unlock_irqrestore(&dev->txq.lock, flags); 139369ee472fSOliver Neukum goto drop; 139469ee472fSOliver Neukum } 139569ee472fSOliver Neukum 139669ee472fSOliver Neukum #ifdef CONFIG_PM 139769ee472fSOliver Neukum /* if this triggers the device is still a sleep */ 139869ee472fSOliver Neukum if (test_bit(EVENT_DEV_ASLEEP, &dev->flags)) { 139969ee472fSOliver Neukum /* transmission will be done in resume */ 140069ee472fSOliver Neukum usb_anchor_urb(urb, &dev->deferred); 140169ee472fSOliver Neukum /* no use to process more packets */ 140269ee472fSOliver Neukum netif_stop_queue(net); 140339707c2aSHemant Kumar usb_put_urb(urb); 140469ee472fSOliver Neukum spin_unlock_irqrestore(&dev->txq.lock, flags); 140560b86755SJoe Perches netdev_dbg(dev->net, "Delaying transmission for resumption\n"); 140669ee472fSOliver Neukum goto deferred; 140769ee472fSOliver Neukum } 140869ee472fSOliver Neukum #endif 14095b2fc499SJeff Garzik 14105b2fc499SJeff Garzik switch ((retval = usb_submit_urb (urb, GFP_ATOMIC))) { 14115b2fc499SJeff Garzik case -EPIPE: 14125b2fc499SJeff Garzik netif_stop_queue (net); 14135b2fc499SJeff Garzik usbnet_defer_kevent (dev, EVENT_TX_HALT); 141469ee472fSOliver Neukum usb_autopm_put_interface_async(dev->intf); 14155b2fc499SJeff Garzik break; 14165b2fc499SJeff Garzik default: 141769ee472fSOliver Neukum usb_autopm_put_interface_async(dev->intf); 1418a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, 1419a475f603SJoe Perches "tx: submit urb err %d\n", retval); 14205b2fc499SJeff Garzik break; 14215b2fc499SJeff Garzik case 0: 1422860e9538SFlorian Westphal netif_trans_update(net); 14235b6e9bcdSMing Lei __usbnet_queue_skb(&dev->txq, skb, tx_start); 14245b2fc499SJeff Garzik if (dev->txq.qlen >= TX_QLEN (dev)) 14255b2fc499SJeff Garzik netif_stop_queue (net); 14265b2fc499SJeff Garzik } 14275b2fc499SJeff Garzik spin_unlock_irqrestore (&dev->txq.lock, flags); 14285b2fc499SJeff Garzik 14295b2fc499SJeff Garzik if (retval) { 1430a475f603SJoe Perches netif_dbg(dev, tx_err, dev->net, "drop, code %d\n", retval); 14315b2fc499SJeff Garzik drop: 14327963837fSHerbert Xu dev->net->stats.tx_dropped++; 1433073285fdSAlexey Orishko not_drop: 14345b2fc499SJeff Garzik if (skb) 14355b2fc499SJeff Garzik dev_kfree_skb_any (skb); 1436638c5115SMing Lei if (urb) { 1437638c5115SMing Lei kfree(urb->sg); 14385b2fc499SJeff Garzik usb_free_urb(urb); 1439638c5115SMing Lei } 1440a475f603SJoe Perches } else 1441a475f603SJoe Perches netif_dbg(dev, tx_queued, dev->net, 14423e4336a6SJason A. Donenfeld "> tx, len %u, type 0x%x\n", length, skb->protocol); 144369ee472fSOliver Neukum #ifdef CONFIG_PM 144469ee472fSOliver Neukum deferred: 144569ee472fSOliver Neukum #endif 144625a79c41SStephen Hemminger return NETDEV_TX_OK; 14475b2fc499SJeff Garzik } 1448777baa47SStephen Hemminger EXPORT_SYMBOL_GPL(usbnet_start_xmit); 14495b2fc499SJeff Garzik 145085e87870SBjørn Mork static int rx_alloc_submit(struct usbnet *dev, gfp_t flags) 145165841fd5SMing Lei { 145265841fd5SMing Lei struct urb *urb; 145365841fd5SMing Lei int i; 145485e87870SBjørn Mork int ret = 0; 145565841fd5SMing Lei 145665841fd5SMing Lei /* don't refill the queue all at once */ 145765841fd5SMing Lei for (i = 0; i < 10 && dev->rxq.qlen < RX_QLEN(dev); i++) { 145865841fd5SMing Lei urb = usb_alloc_urb(0, flags); 145965841fd5SMing Lei if (urb != NULL) { 146085e87870SBjørn Mork ret = rx_submit(dev, urb, flags); 146185e87870SBjørn Mork if (ret) 146285e87870SBjørn Mork goto err; 146385e87870SBjørn Mork } else { 146485e87870SBjørn Mork ret = -ENOMEM; 146585e87870SBjørn Mork goto err; 146665841fd5SMing Lei } 146765841fd5SMing Lei } 146885e87870SBjørn Mork err: 146985e87870SBjørn Mork return ret; 147065841fd5SMing Lei } 147165841fd5SMing Lei 14725b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 14735b2fc499SJeff Garzik 14745b2fc499SJeff Garzik // tasklet (work deferred from completions, in_irq) or timer 14755b2fc499SJeff Garzik 14765b2fc499SJeff Garzik static void usbnet_bh (unsigned long param) 14775b2fc499SJeff Garzik { 14785b2fc499SJeff Garzik struct usbnet *dev = (struct usbnet *) param; 14795b2fc499SJeff Garzik struct sk_buff *skb; 14805b2fc499SJeff Garzik struct skb_data *entry; 14815b2fc499SJeff Garzik 14825b2fc499SJeff Garzik while ((skb = skb_dequeue (&dev->done))) { 14835b2fc499SJeff Garzik entry = (struct skb_data *) skb->cb; 14845b2fc499SJeff Garzik switch (entry->state) { 14855b2fc499SJeff Garzik case rx_done: 14865b2fc499SJeff Garzik entry->state = rx_cleanup; 14875b2fc499SJeff Garzik rx_process (dev, skb); 14885b2fc499SJeff Garzik continue; 14895b2fc499SJeff Garzik case tx_done: 1490638c5115SMing Lei kfree(entry->urb->sg); 14915b2fc499SJeff Garzik case rx_cleanup: 14925b2fc499SJeff Garzik usb_free_urb (entry->urb); 14935b2fc499SJeff Garzik dev_kfree_skb (skb); 14945b2fc499SJeff Garzik continue; 14955b2fc499SJeff Garzik default: 149660b86755SJoe Perches netdev_dbg(dev->net, "bogus skb state %d\n", entry->state); 14975b2fc499SJeff Garzik } 14985b2fc499SJeff Garzik } 14995b2fc499SJeff Garzik 150070c37bf9SBjørn Mork /* restart RX again after disabling due to high error rate */ 150170c37bf9SBjørn Mork clear_bit(EVENT_RX_KILL, &dev->flags); 150270c37bf9SBjørn Mork 150314a0d635SOliver Neukum /* waiting for all pending urbs to complete? 150414a0d635SOliver Neukum * only then can we forgo submitting anew 150514a0d635SOliver Neukum */ 150614a0d635SOliver Neukum if (waitqueue_active(&dev->wait)) { 150714a0d635SOliver Neukum if (dev->txq.qlen + dev->rxq.qlen + dev->done.qlen == 0) 150814a0d635SOliver Neukum wake_up_all(&dev->wait); 15095b2fc499SJeff Garzik 15105b2fc499SJeff Garzik // or are we maybe short a few urbs? 15118e95a202SJoe Perches } else if (netif_running (dev->net) && 15128e95a202SJoe Perches netif_device_present (dev->net) && 15134b49f58fSMing Lei netif_carrier_ok(dev->net) && 15148e95a202SJoe Perches !timer_pending(&dev->delay) && 1515*43daa96bSSoohoon Lee !test_bit(EVENT_RX_PAUSED, &dev->flags) && 15168e95a202SJoe Perches !test_bit(EVENT_RX_HALT, &dev->flags)) { 15175b2fc499SJeff Garzik int temp = dev->rxq.qlen; 15185b2fc499SJeff Garzik 151965841fd5SMing Lei if (temp < RX_QLEN(dev)) { 152085e87870SBjørn Mork if (rx_alloc_submit(dev, GFP_ATOMIC) == -ENOLINK) 152185e87870SBjørn Mork return; 1522a475f603SJoe Perches if (temp != dev->rxq.qlen) 1523a475f603SJoe Perches netif_dbg(dev, link, dev->net, 1524a475f603SJoe Perches "rxqlen %d --> %d\n", 15255b2fc499SJeff Garzik temp, dev->rxq.qlen); 152665841fd5SMing Lei if (dev->rxq.qlen < RX_QLEN(dev)) 15275b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 15285b2fc499SJeff Garzik } 15295b2fc499SJeff Garzik if (dev->txq.qlen < TX_QLEN (dev)) 15305b2fc499SJeff Garzik netif_wake_queue (dev->net); 15315b2fc499SJeff Garzik } 15325b2fc499SJeff Garzik } 15335b2fc499SJeff Garzik 15345b2fc499SJeff Garzik 15355b2fc499SJeff Garzik /*------------------------------------------------------------------------- 15365b2fc499SJeff Garzik * 15375b2fc499SJeff Garzik * USB Device Driver support 15385b2fc499SJeff Garzik * 15395b2fc499SJeff Garzik *-------------------------------------------------------------------------*/ 15405b2fc499SJeff Garzik 15415b2fc499SJeff Garzik // precondition: never called in_interrupt 15425b2fc499SJeff Garzik 15435b2fc499SJeff Garzik void usbnet_disconnect (struct usb_interface *intf) 15445b2fc499SJeff Garzik { 15455b2fc499SJeff Garzik struct usbnet *dev; 15465b2fc499SJeff Garzik struct usb_device *xdev; 15475b2fc499SJeff Garzik struct net_device *net; 15485b2fc499SJeff Garzik 15495b2fc499SJeff Garzik dev = usb_get_intfdata(intf); 15505b2fc499SJeff Garzik usb_set_intfdata(intf, NULL); 15515b2fc499SJeff Garzik if (!dev) 15525b2fc499SJeff Garzik return; 15535b2fc499SJeff Garzik 15545b2fc499SJeff Garzik xdev = interface_to_usbdev (intf); 15555b2fc499SJeff Garzik 1556a475f603SJoe Perches netif_info(dev, probe, dev->net, "unregister '%s' usb-%s-%s, %s\n", 15575b2fc499SJeff Garzik intf->dev.driver->name, 15585b2fc499SJeff Garzik xdev->bus->bus_name, xdev->devpath, 15595b2fc499SJeff Garzik dev->driver_info->description); 15605b2fc499SJeff Garzik 15615b2fc499SJeff Garzik net = dev->net; 15625b2fc499SJeff Garzik unregister_netdev (net); 15635b2fc499SJeff Garzik 156423f333a2STejun Heo cancel_work_sync(&dev->kevent); 15655b2fc499SJeff Garzik 156639707c2aSHemant Kumar usb_scuttle_anchored_urbs(&dev->deferred); 156739707c2aSHemant Kumar 15685b2fc499SJeff Garzik if (dev->driver_info->unbind) 15695b2fc499SJeff Garzik dev->driver_info->unbind (dev, intf); 15705b2fc499SJeff Garzik 157168972efaSPaul Stewart usb_kill_urb(dev->interrupt); 157268972efaSPaul Stewart usb_free_urb(dev->interrupt); 157360e453a9SMing Lei kfree(dev->padding_pkt); 157468972efaSPaul Stewart 15755b2fc499SJeff Garzik free_netdev(net); 15765b2fc499SJeff Garzik } 15775b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_disconnect); 15785b2fc499SJeff Garzik 1579777baa47SStephen Hemminger static const struct net_device_ops usbnet_netdev_ops = { 1580777baa47SStephen Hemminger .ndo_open = usbnet_open, 1581777baa47SStephen Hemminger .ndo_stop = usbnet_stop, 1582777baa47SStephen Hemminger .ndo_start_xmit = usbnet_start_xmit, 1583777baa47SStephen Hemminger .ndo_tx_timeout = usbnet_tx_timeout, 15841efed2d0SOlivier Blin .ndo_set_rx_mode = usbnet_set_rx_mode, 1585777baa47SStephen Hemminger .ndo_change_mtu = usbnet_change_mtu, 1586777baa47SStephen Hemminger .ndo_set_mac_address = eth_mac_addr, 1587777baa47SStephen Hemminger .ndo_validate_addr = eth_validate_addr, 1588777baa47SStephen Hemminger }; 15895b2fc499SJeff Garzik 15905b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 15915b2fc499SJeff Garzik 15925b2fc499SJeff Garzik // precondition: never called in_interrupt 15935b2fc499SJeff Garzik 1594225794f8SMarcel Holtmann static struct device_type wlan_type = { 1595225794f8SMarcel Holtmann .name = "wlan", 1596225794f8SMarcel Holtmann }; 1597225794f8SMarcel Holtmann 1598225794f8SMarcel Holtmann static struct device_type wwan_type = { 1599225794f8SMarcel Holtmann .name = "wwan", 1600225794f8SMarcel Holtmann }; 1601225794f8SMarcel Holtmann 16025b2fc499SJeff Garzik int 16035b2fc499SJeff Garzik usbnet_probe (struct usb_interface *udev, const struct usb_device_id *prod) 16045b2fc499SJeff Garzik { 16055b2fc499SJeff Garzik struct usbnet *dev; 16065b2fc499SJeff Garzik struct net_device *net; 16075b2fc499SJeff Garzik struct usb_host_interface *interface; 16085b2fc499SJeff Garzik struct driver_info *info; 16095b2fc499SJeff Garzik struct usb_device *xdev; 16105b2fc499SJeff Garzik int status; 16115b2fc499SJeff Garzik const char *name; 1612b0786b43SMing Lei struct usb_driver *driver = to_usb_driver(udev->dev.driver); 1613b0786b43SMing Lei 1614b0786b43SMing Lei /* usbnet already took usb runtime pm, so have to enable the feature 1615b0786b43SMing Lei * for usb interface, otherwise usb_autopm_get_interface may return 161698f541c6SAlan Stern * failure if RUNTIME_PM is enabled. 1617b0786b43SMing Lei */ 1618b0786b43SMing Lei if (!driver->supports_autosuspend) { 1619b0786b43SMing Lei driver->supports_autosuspend = 1; 1620b0786b43SMing Lei pm_runtime_enable(&udev->dev); 1621b0786b43SMing Lei } 16225b2fc499SJeff Garzik 16235b2fc499SJeff Garzik name = udev->dev.driver->name; 16245b2fc499SJeff Garzik info = (struct driver_info *) prod->driver_info; 16255b2fc499SJeff Garzik if (!info) { 16265b2fc499SJeff Garzik dev_dbg (&udev->dev, "blacklisted by %s\n", name); 16275b2fc499SJeff Garzik return -ENODEV; 16285b2fc499SJeff Garzik } 16295b2fc499SJeff Garzik xdev = interface_to_usbdev (udev); 16305b2fc499SJeff Garzik interface = udev->cur_altsetting; 16315b2fc499SJeff Garzik 16325b2fc499SJeff Garzik status = -ENOMEM; 16335b2fc499SJeff Garzik 16345b2fc499SJeff Garzik // set up our own records 16355b2fc499SJeff Garzik net = alloc_etherdev(sizeof(*dev)); 163641de8d4cSJoe Perches if (!net) 16375b2fc499SJeff Garzik goto out; 16385b2fc499SJeff Garzik 16390dacca73SBen Hutchings /* netdev_printk() needs this so do it as early as possible */ 16400dacca73SBen Hutchings SET_NETDEV_DEV(net, &udev->dev); 16410dacca73SBen Hutchings 16425b2fc499SJeff Garzik dev = netdev_priv(net); 16435b2fc499SJeff Garzik dev->udev = xdev; 1644a11a6544SOliver Neukum dev->intf = udev; 16455b2fc499SJeff Garzik dev->driver_info = info; 16465b2fc499SJeff Garzik dev->driver_name = name; 16475b2fc499SJeff Garzik dev->msg_enable = netif_msg_init (msg_level, NETIF_MSG_DRV 16485b2fc499SJeff Garzik | NETIF_MSG_PROBE | NETIF_MSG_LINK); 164914a0d635SOliver Neukum init_waitqueue_head(&dev->wait); 16505b2fc499SJeff Garzik skb_queue_head_init (&dev->rxq); 16515b2fc499SJeff Garzik skb_queue_head_init (&dev->txq); 16525b2fc499SJeff Garzik skb_queue_head_init (&dev->done); 16537834ddbcSJussi Kivilinna skb_queue_head_init(&dev->rxq_pause); 16545b2fc499SJeff Garzik dev->bh.func = usbnet_bh; 16555b2fc499SJeff Garzik dev->bh.data = (unsigned long) dev; 165611f17ef3SOliver Neukum INIT_WORK (&dev->kevent, usbnet_deferred_kevent); 165769ee472fSOliver Neukum init_usb_anchor(&dev->deferred); 16585b2fc499SJeff Garzik dev->delay.function = usbnet_bh; 16595b2fc499SJeff Garzik dev->delay.data = (unsigned long) dev; 16605b2fc499SJeff Garzik init_timer (&dev->delay); 16615b2fc499SJeff Garzik mutex_init (&dev->phy_mutex); 16626eecdc5fSDan Williams mutex_init(&dev->interrupt_mutex); 16636eecdc5fSDan Williams dev->interrupt_count = 0; 16645b2fc499SJeff Garzik 16655b2fc499SJeff Garzik dev->net = net; 16665b2fc499SJeff Garzik strcpy (net->name, "usb%d"); 16675b2fc499SJeff Garzik memcpy (net->dev_addr, node_id, sizeof node_id); 16685b2fc499SJeff Garzik 16695b2fc499SJeff Garzik /* rx and tx sides can use different message sizes; 16705b2fc499SJeff Garzik * bind() should set rx_urb_size in that case. 16715b2fc499SJeff Garzik */ 16725b2fc499SJeff Garzik dev->hard_mtu = net->mtu + net->hard_header_len; 16735b2fc499SJeff Garzik 1674777baa47SStephen Hemminger net->netdev_ops = &usbnet_netdev_ops; 1675777baa47SStephen Hemminger net->watchdog_timeo = TX_TIMEOUT_JIFFIES; 16765b2fc499SJeff Garzik net->ethtool_ops = &usbnet_ethtool_ops; 16775b2fc499SJeff Garzik 16785b2fc499SJeff Garzik // allow device-specific bind/init procedures 16795b2fc499SJeff Garzik // NOTE net->name still not usable ... 16805b2fc499SJeff Garzik if (info->bind) { 16815b2fc499SJeff Garzik status = info->bind (dev, udev); 16825b2fc499SJeff Garzik if (status < 0) 16835b2fc499SJeff Garzik goto out1; 16845b2fc499SJeff Garzik 16855b2fc499SJeff Garzik // heuristic: "usb%d" for links we know are two-host, 16865b2fc499SJeff Garzik // else "eth%d" when there's reasonable doubt. userspace 16875b2fc499SJeff Garzik // can rename the link if it knows better. 16888e95a202SJoe Perches if ((dev->driver_info->flags & FLAG_ETHER) != 0 && 1689c261344dSArnd Bergmann ((dev->driver_info->flags & FLAG_POINTTOPOINT) == 0 || 1690c261344dSArnd Bergmann (net->dev_addr [0] & 0x02) == 0)) 16915b2fc499SJeff Garzik strcpy (net->name, "eth%d"); 16926e3bbcc5SJussi Kivilinna /* WLAN devices should always be named "wlan%d" */ 16936e3bbcc5SJussi Kivilinna if ((dev->driver_info->flags & FLAG_WLAN) != 0) 16946e3bbcc5SJussi Kivilinna strcpy(net->name, "wlan%d"); 1695e1e499eeSMarcel Holtmann /* WWAN devices should always be named "wwan%d" */ 1696e1e499eeSMarcel Holtmann if ((dev->driver_info->flags & FLAG_WWAN) != 0) 1697e1e499eeSMarcel Holtmann strcpy(net->name, "wwan%d"); 16985b2fc499SJeff Garzik 16996509141fSWei Shuai /* devices that cannot do ARP */ 17006509141fSWei Shuai if ((dev->driver_info->flags & FLAG_NOARP) != 0) 17016509141fSWei Shuai net->flags |= IFF_NOARP; 17026509141fSWei Shuai 17035b2fc499SJeff Garzik /* maybe the remote can't receive an Ethernet MTU */ 17045b2fc499SJeff Garzik if (net->mtu > (dev->hard_mtu - net->hard_header_len)) 17055b2fc499SJeff Garzik net->mtu = dev->hard_mtu - net->hard_header_len; 17065b2fc499SJeff Garzik } else if (!info->in || !info->out) 17075b2fc499SJeff Garzik status = usbnet_get_endpoints (dev, udev); 17085b2fc499SJeff Garzik else { 17095b2fc499SJeff Garzik dev->in = usb_rcvbulkpipe (xdev, info->in); 17105b2fc499SJeff Garzik dev->out = usb_sndbulkpipe (xdev, info->out); 17115b2fc499SJeff Garzik if (!(info->flags & FLAG_NO_SETINT)) 17125b2fc499SJeff Garzik status = usb_set_interface (xdev, 17135b2fc499SJeff Garzik interface->desc.bInterfaceNumber, 17145b2fc499SJeff Garzik interface->desc.bAlternateSetting); 17155b2fc499SJeff Garzik else 17165b2fc499SJeff Garzik status = 0; 17175b2fc499SJeff Garzik 17185b2fc499SJeff Garzik } 17199514bfe5SPeter Korsgaard if (status >= 0 && dev->status) 17205b2fc499SJeff Garzik status = init_status (dev, udev); 17215b2fc499SJeff Garzik if (status < 0) 17225b2fc499SJeff Garzik goto out3; 17235b2fc499SJeff Garzik 17245b2fc499SJeff Garzik if (!dev->rx_urb_size) 17255b2fc499SJeff Garzik dev->rx_urb_size = dev->hard_mtu; 17265b2fc499SJeff Garzik dev->maxpacket = usb_maxpacket (dev->udev, dev->out, 1); 17275b2fc499SJeff Garzik 1728eef23b53SBjørn Mork /* let userspace know we have a random address */ 1729eef23b53SBjørn Mork if (ether_addr_equal(net->dev_addr, node_id)) 1730eef23b53SBjørn Mork net->addr_assign_type = NET_ADDR_RANDOM; 1731eef23b53SBjørn Mork 1732225794f8SMarcel Holtmann if ((dev->driver_info->flags & FLAG_WLAN) != 0) 1733225794f8SMarcel Holtmann SET_NETDEV_DEVTYPE(net, &wlan_type); 1734225794f8SMarcel Holtmann if ((dev->driver_info->flags & FLAG_WWAN) != 0) 1735225794f8SMarcel Holtmann SET_NETDEV_DEVTYPE(net, &wwan_type); 1736225794f8SMarcel Holtmann 1737a88c32aeSMing Lei /* initialize max rx_qlen and tx_qlen */ 1738a88c32aeSMing Lei usbnet_update_max_qlen(dev); 1739a88c32aeSMing Lei 174060e453a9SMing Lei if (dev->can_dma_sg && !(info->flags & FLAG_SEND_ZLP) && 174160e453a9SMing Lei !(info->flags & FLAG_MULTI_PACKET)) { 174260e453a9SMing Lei dev->padding_pkt = kzalloc(1, GFP_KERNEL); 174309b69024SWei Yongjun if (!dev->padding_pkt) { 174409b69024SWei Yongjun status = -ENOMEM; 174560e453a9SMing Lei goto out4; 174660e453a9SMing Lei } 174709b69024SWei Yongjun } 174860e453a9SMing Lei 17495b2fc499SJeff Garzik status = register_netdev (net); 17505b2fc499SJeff Garzik if (status) 175160e453a9SMing Lei goto out5; 1752a475f603SJoe Perches netif_info(dev, probe, dev->net, 1753a475f603SJoe Perches "register '%s' at usb-%s-%s, %s, %pM\n", 17545b2fc499SJeff Garzik udev->dev.driver->name, 17555b2fc499SJeff Garzik xdev->bus->bus_name, xdev->devpath, 17565b2fc499SJeff Garzik dev->driver_info->description, 1757e174961cSJohannes Berg net->dev_addr); 17585b2fc499SJeff Garzik 17595b2fc499SJeff Garzik // ok, it's ready to go. 17605b2fc499SJeff Garzik usb_set_intfdata (udev, dev); 17615b2fc499SJeff Garzik 17625b2fc499SJeff Garzik netif_device_attach (net); 17635b2fc499SJeff Garzik 176437e8273cSBen Hutchings if (dev->driver_info->flags & FLAG_LINK_INTR) 17650162c554SMing Lei usbnet_link_change(dev, 0, 0); 176637e8273cSBen Hutchings 17675b2fc499SJeff Garzik return 0; 17685b2fc499SJeff Garzik 176960e453a9SMing Lei out5: 177060e453a9SMing Lei kfree(dev->padding_pkt); 1771a4723848Stom.leiming@gmail.com out4: 1772a4723848Stom.leiming@gmail.com usb_free_urb(dev->interrupt); 17735b2fc499SJeff Garzik out3: 17745b2fc499SJeff Garzik if (info->unbind) 17755b2fc499SJeff Garzik info->unbind (dev, udev); 17765b2fc499SJeff Garzik out1: 17771666984cSOliver Neukum /* subdrivers must undo all they did in bind() if they 17781666984cSOliver Neukum * fail it, but we may fail later and a deferred kevent 17791666984cSOliver Neukum * may trigger an error resubmitting itself and, worse, 17801666984cSOliver Neukum * schedule a timer. So we kill it all just in case. 17811666984cSOliver Neukum */ 17821666984cSOliver Neukum cancel_work_sync(&dev->kevent); 17831666984cSOliver Neukum del_timer_sync(&dev->delay); 17845b2fc499SJeff Garzik free_netdev(net); 17855b2fc499SJeff Garzik out: 17865b2fc499SJeff Garzik return status; 17875b2fc499SJeff Garzik } 17885b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_probe); 17895b2fc499SJeff Garzik 17905b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 17915b2fc499SJeff Garzik 179236433127SOliver Neukum /* 179336433127SOliver Neukum * suspend the whole driver as soon as the first interface is suspended 179436433127SOliver Neukum * resume only when the last interface is resumed 17955b2fc499SJeff Garzik */ 17965b2fc499SJeff Garzik 17975b2fc499SJeff Garzik int usbnet_suspend (struct usb_interface *intf, pm_message_t message) 17985b2fc499SJeff Garzik { 17995b2fc499SJeff Garzik struct usbnet *dev = usb_get_intfdata(intf); 18005b2fc499SJeff Garzik 180136433127SOliver Neukum if (!dev->suspend_count++) { 180269ee472fSOliver Neukum spin_lock_irq(&dev->txq.lock); 180369ee472fSOliver Neukum /* don't autosuspend while transmitting */ 18045b1b0b81SAlan Stern if (dev->txq.qlen && PMSG_IS_AUTO(message)) { 18055eeb3132SMing Lei dev->suspend_count--; 180669ee472fSOliver Neukum spin_unlock_irq(&dev->txq.lock); 180769ee472fSOliver Neukum return -EBUSY; 180869ee472fSOliver Neukum } else { 180969ee472fSOliver Neukum set_bit(EVENT_DEV_ASLEEP, &dev->flags); 181069ee472fSOliver Neukum spin_unlock_irq(&dev->txq.lock); 181169ee472fSOliver Neukum } 1812a11a6544SOliver Neukum /* 1813a11a6544SOliver Neukum * accelerate emptying of the rx and queues, to avoid 18145b2fc499SJeff Garzik * having everything error out. 18155b2fc499SJeff Garzik */ 18165b2fc499SJeff Garzik netif_device_detach (dev->net); 181769ee472fSOliver Neukum usbnet_terminate_urbs(dev); 18186eecdc5fSDan Williams __usbnet_status_stop_force(dev); 181969ee472fSOliver Neukum 1820a11a6544SOliver Neukum /* 1821a11a6544SOliver Neukum * reattach so runtime management can use and 1822a11a6544SOliver Neukum * wake the device 1823a11a6544SOliver Neukum */ 1824a11a6544SOliver Neukum netif_device_attach (dev->net); 182536433127SOliver Neukum } 18265b2fc499SJeff Garzik return 0; 18275b2fc499SJeff Garzik } 18285b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_suspend); 18295b2fc499SJeff Garzik 18305b2fc499SJeff Garzik int usbnet_resume (struct usb_interface *intf) 18315b2fc499SJeff Garzik { 18325b2fc499SJeff Garzik struct usbnet *dev = usb_get_intfdata(intf); 183369ee472fSOliver Neukum struct sk_buff *skb; 183469ee472fSOliver Neukum struct urb *res; 183569ee472fSOliver Neukum int retval; 18365b2fc499SJeff Garzik 183769ee472fSOliver Neukum if (!--dev->suspend_count) { 18386eecdc5fSDan Williams /* resume interrupt URB if it was previously submitted */ 18396eecdc5fSDan Williams __usbnet_status_start_force(dev, GFP_NOIO); 184068972efaSPaul Stewart 184169ee472fSOliver Neukum spin_lock_irq(&dev->txq.lock); 184269ee472fSOliver Neukum while ((res = usb_get_from_anchor(&dev->deferred))) { 184369ee472fSOliver Neukum 184469ee472fSOliver Neukum skb = (struct sk_buff *)res->context; 184569ee472fSOliver Neukum retval = usb_submit_urb(res, GFP_ATOMIC); 184669ee472fSOliver Neukum if (retval < 0) { 184769ee472fSOliver Neukum dev_kfree_skb_any(skb); 1848638c5115SMing Lei kfree(res->sg); 184969ee472fSOliver Neukum usb_free_urb(res); 185069ee472fSOliver Neukum usb_autopm_put_interface_async(dev->intf); 185169ee472fSOliver Neukum } else { 1852860e9538SFlorian Westphal netif_trans_update(dev->net); 185369ee472fSOliver Neukum __skb_queue_tail(&dev->txq, skb); 185469ee472fSOliver Neukum } 185569ee472fSOliver Neukum } 185669ee472fSOliver Neukum 185769ee472fSOliver Neukum smp_mb(); 185869ee472fSOliver Neukum clear_bit(EVENT_DEV_ASLEEP, &dev->flags); 185969ee472fSOliver Neukum spin_unlock_irq(&dev->txq.lock); 186075bd0cbdSMing Lei 186175bd0cbdSMing Lei if (test_bit(EVENT_DEV_OPEN, &dev->flags)) { 186214a0d635SOliver Neukum /* handle remote wakeup ASAP 186314a0d635SOliver Neukum * we cannot race against stop 186414a0d635SOliver Neukum */ 186514a0d635SOliver Neukum if (netif_device_present(dev->net) && 186665841fd5SMing Lei !timer_pending(&dev->delay) && 186765841fd5SMing Lei !test_bit(EVENT_RX_HALT, &dev->flags)) 1868ab6f148dSOliver Neukum rx_alloc_submit(dev, GFP_NOIO); 186965841fd5SMing Lei 187069ee472fSOliver Neukum if (!(dev->txq.qlen >= TX_QLEN(dev))) 18711aa9bc5bSAlexey Orishko netif_tx_wake_all_queues(dev->net); 18725b2fc499SJeff Garzik tasklet_schedule (&dev->bh); 187369ee472fSOliver Neukum } 187475bd0cbdSMing Lei } 18755d9d01a3SOliver Neukum 18765d9d01a3SOliver Neukum if (test_and_clear_bit(EVENT_DEVICE_REPORT_IDLE, &dev->flags)) 18775d9d01a3SOliver Neukum usb_autopm_get_interface_no_resume(intf); 18785d9d01a3SOliver Neukum 18795b2fc499SJeff Garzik return 0; 18805b2fc499SJeff Garzik } 18815b2fc499SJeff Garzik EXPORT_SYMBOL_GPL(usbnet_resume); 18825b2fc499SJeff Garzik 18835d9d01a3SOliver Neukum /* 18845d9d01a3SOliver Neukum * Either a subdriver implements manage_power, then it is assumed to always 18855d9d01a3SOliver Neukum * be ready to be suspended or it reports the readiness to be suspended 18865d9d01a3SOliver Neukum * explicitly 18875d9d01a3SOliver Neukum */ 18885d9d01a3SOliver Neukum void usbnet_device_suggests_idle(struct usbnet *dev) 18895d9d01a3SOliver Neukum { 18905d9d01a3SOliver Neukum if (!test_and_set_bit(EVENT_DEVICE_REPORT_IDLE, &dev->flags)) { 18915d9d01a3SOliver Neukum dev->intf->needs_remote_wakeup = 1; 18925d9d01a3SOliver Neukum usb_autopm_put_interface_async(dev->intf); 18935d9d01a3SOliver Neukum } 18945d9d01a3SOliver Neukum } 18955d9d01a3SOliver Neukum EXPORT_SYMBOL(usbnet_device_suggests_idle); 18965b2fc499SJeff Garzik 18972dd7c8cfSOliver Neukum /* 18982dd7c8cfSOliver Neukum * For devices that can do without special commands 18992dd7c8cfSOliver Neukum */ 19002dd7c8cfSOliver Neukum int usbnet_manage_power(struct usbnet *dev, int on) 19012dd7c8cfSOliver Neukum { 19022dd7c8cfSOliver Neukum dev->intf->needs_remote_wakeup = on; 19032dd7c8cfSOliver Neukum return 0; 19042dd7c8cfSOliver Neukum } 19052dd7c8cfSOliver Neukum EXPORT_SYMBOL(usbnet_manage_power); 19062dd7c8cfSOliver Neukum 1907ac64995dSMing Lei void usbnet_link_change(struct usbnet *dev, bool link, bool need_reset) 1908ac64995dSMing Lei { 1909ac64995dSMing Lei /* update link after link is reseted */ 1910ac64995dSMing Lei if (link && !need_reset) 1911ac64995dSMing Lei netif_carrier_on(dev->net); 1912ac64995dSMing Lei else 1913ac64995dSMing Lei netif_carrier_off(dev->net); 1914ac64995dSMing Lei 1915ac64995dSMing Lei if (need_reset && link) 1916ac64995dSMing Lei usbnet_defer_kevent(dev, EVENT_LINK_RESET); 19174b49f58fSMing Lei else 19184b49f58fSMing Lei usbnet_defer_kevent(dev, EVENT_LINK_CHANGE); 1919ac64995dSMing Lei } 1920ac64995dSMing Lei EXPORT_SYMBOL(usbnet_link_change); 1921ac64995dSMing Lei 19225b2fc499SJeff Garzik /*-------------------------------------------------------------------------*/ 19230547fad2SMing Lei static int __usbnet_read_cmd(struct usbnet *dev, u8 cmd, u8 reqtype, 1924877bd862SMing Lei u16 value, u16 index, void *data, u16 size) 1925877bd862SMing Lei { 1926877bd862SMing Lei void *buf = NULL; 1927877bd862SMing Lei int err = -ENOMEM; 1928877bd862SMing Lei 1929877bd862SMing Lei netdev_dbg(dev->net, "usbnet_read_cmd cmd=0x%02x reqtype=%02x" 1930877bd862SMing Lei " value=0x%04x index=0x%04x size=%d\n", 1931877bd862SMing Lei cmd, reqtype, value, index, size); 1932877bd862SMing Lei 1933877bd862SMing Lei if (data) { 1934877bd862SMing Lei buf = kmalloc(size, GFP_KERNEL); 1935877bd862SMing Lei if (!buf) 1936877bd862SMing Lei goto out; 1937877bd862SMing Lei } 1938877bd862SMing Lei 1939877bd862SMing Lei err = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0), 1940877bd862SMing Lei cmd, reqtype, value, index, buf, size, 1941877bd862SMing Lei USB_CTRL_GET_TIMEOUT); 1942877bd862SMing Lei if (err > 0 && err <= size) 1943877bd862SMing Lei memcpy(data, buf, err); 1944877bd862SMing Lei kfree(buf); 1945877bd862SMing Lei out: 1946877bd862SMing Lei return err; 1947877bd862SMing Lei } 1948877bd862SMing Lei 19490547fad2SMing Lei static int __usbnet_write_cmd(struct usbnet *dev, u8 cmd, u8 reqtype, 19500547fad2SMing Lei u16 value, u16 index, const void *data, 19510547fad2SMing Lei u16 size) 1952877bd862SMing Lei { 1953877bd862SMing Lei void *buf = NULL; 1954877bd862SMing Lei int err = -ENOMEM; 1955877bd862SMing Lei 1956877bd862SMing Lei netdev_dbg(dev->net, "usbnet_write_cmd cmd=0x%02x reqtype=%02x" 1957877bd862SMing Lei " value=0x%04x index=0x%04x size=%d\n", 1958877bd862SMing Lei cmd, reqtype, value, index, size); 1959877bd862SMing Lei 1960877bd862SMing Lei if (data) { 1961877bd862SMing Lei buf = kmemdup(data, size, GFP_KERNEL); 1962877bd862SMing Lei if (!buf) 1963877bd862SMing Lei goto out; 1964877bd862SMing Lei } 1965877bd862SMing Lei 1966877bd862SMing Lei err = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0), 1967877bd862SMing Lei cmd, reqtype, value, index, buf, size, 1968877bd862SMing Lei USB_CTRL_SET_TIMEOUT); 1969877bd862SMing Lei kfree(buf); 1970877bd862SMing Lei 1971877bd862SMing Lei out: 1972877bd862SMing Lei return err; 1973877bd862SMing Lei } 19740547fad2SMing Lei 1975c40a2c88SOliver Neukum int cdc_parse_cdc_header(struct usb_cdc_parsed_header *hdr, 1976c40a2c88SOliver Neukum struct usb_interface *intf, 1977c40a2c88SOliver Neukum u8 *buffer, 1978c40a2c88SOliver Neukum int buflen) 1979c40a2c88SOliver Neukum { 1980c40a2c88SOliver Neukum /* duplicates are ignored */ 1981c40a2c88SOliver Neukum struct usb_cdc_union_desc *union_header = NULL; 1982c40a2c88SOliver Neukum 1983c40a2c88SOliver Neukum /* duplicates are not tolerated */ 1984c40a2c88SOliver Neukum struct usb_cdc_header_desc *header = NULL; 1985c40a2c88SOliver Neukum struct usb_cdc_ether_desc *ether = NULL; 1986c40a2c88SOliver Neukum struct usb_cdc_mdlm_detail_desc *detail = NULL; 1987c40a2c88SOliver Neukum struct usb_cdc_mdlm_desc *desc = NULL; 1988c40a2c88SOliver Neukum 1989c40a2c88SOliver Neukum unsigned int elength; 1990c40a2c88SOliver Neukum int cnt = 0; 1991c40a2c88SOliver Neukum 1992c40a2c88SOliver Neukum memset(hdr, 0x00, sizeof(struct usb_cdc_parsed_header)); 1993c40a2c88SOliver Neukum hdr->phonet_magic_present = false; 1994c40a2c88SOliver Neukum while (buflen > 0) { 1995c40a2c88SOliver Neukum elength = buffer[0]; 1996c40a2c88SOliver Neukum if (!elength) { 1997c40a2c88SOliver Neukum dev_err(&intf->dev, "skipping garbage byte\n"); 1998c40a2c88SOliver Neukum elength = 1; 1999c40a2c88SOliver Neukum goto next_desc; 2000c40a2c88SOliver Neukum } 2001c40a2c88SOliver Neukum if (buffer[1] != USB_DT_CS_INTERFACE) { 2002c40a2c88SOliver Neukum dev_err(&intf->dev, "skipping garbage\n"); 2003c40a2c88SOliver Neukum goto next_desc; 2004c40a2c88SOliver Neukum } 2005c40a2c88SOliver Neukum 2006c40a2c88SOliver Neukum switch (buffer[2]) { 2007c40a2c88SOliver Neukum case USB_CDC_UNION_TYPE: /* we've found it */ 2008c40a2c88SOliver Neukum if (elength < sizeof(struct usb_cdc_union_desc)) 2009c40a2c88SOliver Neukum goto next_desc; 2010c40a2c88SOliver Neukum if (union_header) { 2011c40a2c88SOliver Neukum dev_err(&intf->dev, "More than one union descriptor, skipping ...\n"); 2012c40a2c88SOliver Neukum goto next_desc; 2013c40a2c88SOliver Neukum } 2014c40a2c88SOliver Neukum union_header = (struct usb_cdc_union_desc *)buffer; 2015c40a2c88SOliver Neukum break; 2016c40a2c88SOliver Neukum case USB_CDC_COUNTRY_TYPE: 2017c40a2c88SOliver Neukum if (elength < sizeof(struct usb_cdc_country_functional_desc)) 2018c40a2c88SOliver Neukum goto next_desc; 2019c40a2c88SOliver Neukum hdr->usb_cdc_country_functional_desc = 2020c40a2c88SOliver Neukum (struct usb_cdc_country_functional_desc *)buffer; 2021c40a2c88SOliver Neukum break; 2022c40a2c88SOliver Neukum case USB_CDC_HEADER_TYPE: 2023c40a2c88SOliver Neukum if (elength != sizeof(struct usb_cdc_header_desc)) 2024c40a2c88SOliver Neukum goto next_desc; 2025c40a2c88SOliver Neukum if (header) 2026c40a2c88SOliver Neukum return -EINVAL; 2027c40a2c88SOliver Neukum header = (struct usb_cdc_header_desc *)buffer; 2028c40a2c88SOliver Neukum break; 2029c40a2c88SOliver Neukum case USB_CDC_ACM_TYPE: 2030c40a2c88SOliver Neukum if (elength < sizeof(struct usb_cdc_acm_descriptor)) 2031c40a2c88SOliver Neukum goto next_desc; 2032c40a2c88SOliver Neukum hdr->usb_cdc_acm_descriptor = 2033c40a2c88SOliver Neukum (struct usb_cdc_acm_descriptor *)buffer; 2034c40a2c88SOliver Neukum break; 2035c40a2c88SOliver Neukum case USB_CDC_ETHERNET_TYPE: 2036c40a2c88SOliver Neukum if (elength != sizeof(struct usb_cdc_ether_desc)) 2037c40a2c88SOliver Neukum goto next_desc; 2038c40a2c88SOliver Neukum if (ether) 2039c40a2c88SOliver Neukum return -EINVAL; 2040c40a2c88SOliver Neukum ether = (struct usb_cdc_ether_desc *)buffer; 2041c40a2c88SOliver Neukum break; 2042c40a2c88SOliver Neukum case USB_CDC_CALL_MANAGEMENT_TYPE: 2043c40a2c88SOliver Neukum if (elength < sizeof(struct usb_cdc_call_mgmt_descriptor)) 2044c40a2c88SOliver Neukum goto next_desc; 2045c40a2c88SOliver Neukum hdr->usb_cdc_call_mgmt_descriptor = 2046c40a2c88SOliver Neukum (struct usb_cdc_call_mgmt_descriptor *)buffer; 2047c40a2c88SOliver Neukum break; 2048c40a2c88SOliver Neukum case USB_CDC_DMM_TYPE: 2049c40a2c88SOliver Neukum if (elength < sizeof(struct usb_cdc_dmm_desc)) 2050c40a2c88SOliver Neukum goto next_desc; 2051c40a2c88SOliver Neukum hdr->usb_cdc_dmm_desc = 2052c40a2c88SOliver Neukum (struct usb_cdc_dmm_desc *)buffer; 2053c40a2c88SOliver Neukum break; 2054c40a2c88SOliver Neukum case USB_CDC_MDLM_TYPE: 2055c40a2c88SOliver Neukum if (elength < sizeof(struct usb_cdc_mdlm_desc *)) 2056c40a2c88SOliver Neukum goto next_desc; 2057c40a2c88SOliver Neukum if (desc) 2058c40a2c88SOliver Neukum return -EINVAL; 2059c40a2c88SOliver Neukum desc = (struct usb_cdc_mdlm_desc *)buffer; 2060c40a2c88SOliver Neukum break; 2061c40a2c88SOliver Neukum case USB_CDC_MDLM_DETAIL_TYPE: 2062c40a2c88SOliver Neukum if (elength < sizeof(struct usb_cdc_mdlm_detail_desc *)) 2063c40a2c88SOliver Neukum goto next_desc; 2064c40a2c88SOliver Neukum if (detail) 2065c40a2c88SOliver Neukum return -EINVAL; 2066c40a2c88SOliver Neukum detail = (struct usb_cdc_mdlm_detail_desc *)buffer; 2067c40a2c88SOliver Neukum break; 2068c40a2c88SOliver Neukum case USB_CDC_NCM_TYPE: 2069c40a2c88SOliver Neukum if (elength < sizeof(struct usb_cdc_ncm_desc)) 2070c40a2c88SOliver Neukum goto next_desc; 2071c40a2c88SOliver Neukum hdr->usb_cdc_ncm_desc = (struct usb_cdc_ncm_desc *)buffer; 2072c40a2c88SOliver Neukum break; 2073c40a2c88SOliver Neukum case USB_CDC_MBIM_TYPE: 2074c40a2c88SOliver Neukum if (elength < sizeof(struct usb_cdc_mbim_desc)) 2075c40a2c88SOliver Neukum goto next_desc; 2076c40a2c88SOliver Neukum 2077c40a2c88SOliver Neukum hdr->usb_cdc_mbim_desc = (struct usb_cdc_mbim_desc *)buffer; 2078c40a2c88SOliver Neukum break; 2079c40a2c88SOliver Neukum case USB_CDC_MBIM_EXTENDED_TYPE: 2080c40a2c88SOliver Neukum if (elength < sizeof(struct usb_cdc_mbim_extended_desc)) 2081c40a2c88SOliver Neukum break; 2082c40a2c88SOliver Neukum hdr->usb_cdc_mbim_extended_desc = 2083c40a2c88SOliver Neukum (struct usb_cdc_mbim_extended_desc *)buffer; 2084c40a2c88SOliver Neukum break; 2085c40a2c88SOliver Neukum case CDC_PHONET_MAGIC_NUMBER: 2086c40a2c88SOliver Neukum hdr->phonet_magic_present = true; 2087c40a2c88SOliver Neukum break; 2088c40a2c88SOliver Neukum default: 2089c40a2c88SOliver Neukum /* 2090c40a2c88SOliver Neukum * there are LOTS more CDC descriptors that 2091c40a2c88SOliver Neukum * could legitimately be found here. 2092c40a2c88SOliver Neukum */ 2093c40a2c88SOliver Neukum dev_dbg(&intf->dev, "Ignoring descriptor: type %02x, length %ud\n", 2094c40a2c88SOliver Neukum buffer[2], elength); 2095c40a2c88SOliver Neukum goto next_desc; 2096c40a2c88SOliver Neukum } 2097c40a2c88SOliver Neukum cnt++; 2098c40a2c88SOliver Neukum next_desc: 2099c40a2c88SOliver Neukum buflen -= elength; 2100c40a2c88SOliver Neukum buffer += elength; 2101c40a2c88SOliver Neukum } 2102c40a2c88SOliver Neukum hdr->usb_cdc_union_desc = union_header; 2103c40a2c88SOliver Neukum hdr->usb_cdc_header_desc = header; 2104c40a2c88SOliver Neukum hdr->usb_cdc_mdlm_detail_desc = detail; 2105c40a2c88SOliver Neukum hdr->usb_cdc_mdlm_desc = desc; 2106c40a2c88SOliver Neukum hdr->usb_cdc_ether_desc = ether; 2107c40a2c88SOliver Neukum return cnt; 2108c40a2c88SOliver Neukum } 2109c40a2c88SOliver Neukum 2110c40a2c88SOliver Neukum EXPORT_SYMBOL(cdc_parse_cdc_header); 2111c40a2c88SOliver Neukum 21120547fad2SMing Lei /* 21130547fad2SMing Lei * The function can't be called inside suspend/resume callback, 21140547fad2SMing Lei * otherwise deadlock will be caused. 21150547fad2SMing Lei */ 21160547fad2SMing Lei int usbnet_read_cmd(struct usbnet *dev, u8 cmd, u8 reqtype, 21170547fad2SMing Lei u16 value, u16 index, void *data, u16 size) 21180547fad2SMing Lei { 21196f0a0986SMing Lei int ret; 21206f0a0986SMing Lei 21216f0a0986SMing Lei if (usb_autopm_get_interface(dev->intf) < 0) 21226f0a0986SMing Lei return -ENODEV; 21236f0a0986SMing Lei ret = __usbnet_read_cmd(dev, cmd, reqtype, value, index, 21240547fad2SMing Lei data, size); 21256f0a0986SMing Lei usb_autopm_put_interface(dev->intf); 21266f0a0986SMing Lei return ret; 21270547fad2SMing Lei } 21280547fad2SMing Lei EXPORT_SYMBOL_GPL(usbnet_read_cmd); 21290547fad2SMing Lei 21300547fad2SMing Lei /* 21310547fad2SMing Lei * The function can't be called inside suspend/resume callback, 21320547fad2SMing Lei * otherwise deadlock will be caused. 21330547fad2SMing Lei */ 21340547fad2SMing Lei int usbnet_write_cmd(struct usbnet *dev, u8 cmd, u8 reqtype, 21350547fad2SMing Lei u16 value, u16 index, const void *data, u16 size) 21360547fad2SMing Lei { 21376f0a0986SMing Lei int ret; 21386f0a0986SMing Lei 21396f0a0986SMing Lei if (usb_autopm_get_interface(dev->intf) < 0) 21406f0a0986SMing Lei return -ENODEV; 21416f0a0986SMing Lei ret = __usbnet_write_cmd(dev, cmd, reqtype, value, index, 21420547fad2SMing Lei data, size); 21436f0a0986SMing Lei usb_autopm_put_interface(dev->intf); 21446f0a0986SMing Lei return ret; 21450547fad2SMing Lei } 2146877bd862SMing Lei EXPORT_SYMBOL_GPL(usbnet_write_cmd); 2147877bd862SMing Lei 21480547fad2SMing Lei /* 21490547fad2SMing Lei * The function can be called inside suspend/resume callback safely 21500547fad2SMing Lei * and should only be called by suspend/resume callback generally. 21510547fad2SMing Lei */ 21520547fad2SMing Lei int usbnet_read_cmd_nopm(struct usbnet *dev, u8 cmd, u8 reqtype, 21530547fad2SMing Lei u16 value, u16 index, void *data, u16 size) 21540547fad2SMing Lei { 21550547fad2SMing Lei return __usbnet_read_cmd(dev, cmd, reqtype, value, index, 21560547fad2SMing Lei data, size); 21570547fad2SMing Lei } 21580547fad2SMing Lei EXPORT_SYMBOL_GPL(usbnet_read_cmd_nopm); 21590547fad2SMing Lei 21600547fad2SMing Lei /* 21610547fad2SMing Lei * The function can be called inside suspend/resume callback safely 21620547fad2SMing Lei * and should only be called by suspend/resume callback generally. 21630547fad2SMing Lei */ 21640547fad2SMing Lei int usbnet_write_cmd_nopm(struct usbnet *dev, u8 cmd, u8 reqtype, 21650547fad2SMing Lei u16 value, u16 index, const void *data, 21660547fad2SMing Lei u16 size) 21670547fad2SMing Lei { 21680547fad2SMing Lei return __usbnet_write_cmd(dev, cmd, reqtype, value, index, 21690547fad2SMing Lei data, size); 21700547fad2SMing Lei } 21710547fad2SMing Lei EXPORT_SYMBOL_GPL(usbnet_write_cmd_nopm); 21720547fad2SMing Lei 2173877bd862SMing Lei static void usbnet_async_cmd_cb(struct urb *urb) 2174877bd862SMing Lei { 2175877bd862SMing Lei struct usb_ctrlrequest *req = (struct usb_ctrlrequest *)urb->context; 2176877bd862SMing Lei int status = urb->status; 2177877bd862SMing Lei 2178877bd862SMing Lei if (status < 0) 2179877bd862SMing Lei dev_dbg(&urb->dev->dev, "%s failed with %d", 2180877bd862SMing Lei __func__, status); 2181877bd862SMing Lei 2182877bd862SMing Lei kfree(req); 2183877bd862SMing Lei usb_free_urb(urb); 2184877bd862SMing Lei } 2185877bd862SMing Lei 21860547fad2SMing Lei /* 21870547fad2SMing Lei * The caller must make sure that device can't be put into suspend 21880547fad2SMing Lei * state until the control URB completes. 21890547fad2SMing Lei */ 2190877bd862SMing Lei int usbnet_write_cmd_async(struct usbnet *dev, u8 cmd, u8 reqtype, 2191877bd862SMing Lei u16 value, u16 index, const void *data, u16 size) 2192877bd862SMing Lei { 2193877bd862SMing Lei struct usb_ctrlrequest *req = NULL; 2194877bd862SMing Lei struct urb *urb; 2195877bd862SMing Lei int err = -ENOMEM; 2196877bd862SMing Lei void *buf = NULL; 2197877bd862SMing Lei 2198877bd862SMing Lei netdev_dbg(dev->net, "usbnet_write_cmd cmd=0x%02x reqtype=%02x" 2199877bd862SMing Lei " value=0x%04x index=0x%04x size=%d\n", 2200877bd862SMing Lei cmd, reqtype, value, index, size); 2201877bd862SMing Lei 2202877bd862SMing Lei urb = usb_alloc_urb(0, GFP_ATOMIC); 2203877bd862SMing Lei if (!urb) { 2204877bd862SMing Lei netdev_err(dev->net, "Error allocating URB in" 2205877bd862SMing Lei " %s!\n", __func__); 2206877bd862SMing Lei goto fail; 2207877bd862SMing Lei } 2208877bd862SMing Lei 2209877bd862SMing Lei if (data) { 2210877bd862SMing Lei buf = kmemdup(data, size, GFP_ATOMIC); 2211877bd862SMing Lei if (!buf) { 2212877bd862SMing Lei netdev_err(dev->net, "Error allocating buffer" 2213877bd862SMing Lei " in %s!\n", __func__); 2214877bd862SMing Lei goto fail_free; 2215877bd862SMing Lei } 2216877bd862SMing Lei } 2217877bd862SMing Lei 2218877bd862SMing Lei req = kmalloc(sizeof(struct usb_ctrlrequest), GFP_ATOMIC); 221938673c82SJoe Perches if (!req) 2220877bd862SMing Lei goto fail_free_buf; 2221877bd862SMing Lei 2222877bd862SMing Lei req->bRequestType = reqtype; 2223877bd862SMing Lei req->bRequest = cmd; 2224877bd862SMing Lei req->wValue = cpu_to_le16(value); 2225877bd862SMing Lei req->wIndex = cpu_to_le16(index); 2226877bd862SMing Lei req->wLength = cpu_to_le16(size); 2227877bd862SMing Lei 2228877bd862SMing Lei usb_fill_control_urb(urb, dev->udev, 2229877bd862SMing Lei usb_sndctrlpipe(dev->udev, 0), 2230877bd862SMing Lei (void *)req, buf, size, 2231877bd862SMing Lei usbnet_async_cmd_cb, req); 2232877bd862SMing Lei urb->transfer_flags |= URB_FREE_BUFFER; 2233877bd862SMing Lei 2234877bd862SMing Lei err = usb_submit_urb(urb, GFP_ATOMIC); 2235877bd862SMing Lei if (err < 0) { 2236877bd862SMing Lei netdev_err(dev->net, "Error submitting the control" 2237877bd862SMing Lei " message: status=%d\n", err); 2238877bd862SMing Lei goto fail_free; 2239877bd862SMing Lei } 2240877bd862SMing Lei return 0; 2241877bd862SMing Lei 2242877bd862SMing Lei fail_free_buf: 2243877bd862SMing Lei kfree(buf); 2244877bd862SMing Lei fail_free: 2245877bd862SMing Lei kfree(req); 2246877bd862SMing Lei usb_free_urb(urb); 2247877bd862SMing Lei fail: 2248877bd862SMing Lei return err; 2249877bd862SMing Lei 2250877bd862SMing Lei } 2251877bd862SMing Lei EXPORT_SYMBOL_GPL(usbnet_write_cmd_async); 2252877bd862SMing Lei /*-------------------------------------------------------------------------*/ 22535b2fc499SJeff Garzik 22545b2fc499SJeff Garzik static int __init usbnet_init(void) 22555b2fc499SJeff Garzik { 2256c582a950SThiago Farina /* Compiler should optimize this out. */ 2257c582a950SThiago Farina BUILD_BUG_ON( 2258c582a950SThiago Farina FIELD_SIZEOF(struct sk_buff, cb) < sizeof(struct skb_data)); 22595b2fc499SJeff Garzik 2260c7e12eadSJoe Perches eth_random_addr(node_id); 22615b2fc499SJeff Garzik return 0; 22625b2fc499SJeff Garzik } 22635b2fc499SJeff Garzik module_init(usbnet_init); 22645b2fc499SJeff Garzik 22655b2fc499SJeff Garzik static void __exit usbnet_exit(void) 22665b2fc499SJeff Garzik { 22675b2fc499SJeff Garzik } 22685b2fc499SJeff Garzik module_exit(usbnet_exit); 22695b2fc499SJeff Garzik 22705b2fc499SJeff Garzik MODULE_AUTHOR("David Brownell"); 22715b2fc499SJeff Garzik MODULE_DESCRIPTION("USB network driver framework"); 22725b2fc499SJeff Garzik MODULE_LICENSE("GPL"); 2273