| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | * Common framework for low-level network console, dump, and debugger code | 
|  | 3 | * | 
|  | 4 | * Sep 8 2003  Matt Mackall <mpm@selenic.com> | 
|  | 5 | * | 
|  | 6 | * based on the netconsole code from: | 
|  | 7 | * | 
|  | 8 | * Copyright (C) 2001  Ingo Molnar <mingo@redhat.com> | 
|  | 9 | * Copyright (C) 2002  Red Hat, Inc. | 
|  | 10 | */ | 
|  | 11 |  | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 12 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | 
|  | 13 |  | 
| Anton Vorontsov | bff3877 | 2009-07-08 11:10:56 -0700 | [diff] [blame] | 14 | #include <linux/moduleparam.h> | 
| Andy Shevchenko | 4cd5773 | 2013-06-04 19:46:26 +0300 | [diff] [blame] | 15 | #include <linux/kernel.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | #include <linux/netdevice.h> | 
|  | 17 | #include <linux/etherdevice.h> | 
|  | 18 | #include <linux/string.h> | 
| Arnaldo Carvalho de Melo | 14c8502 | 2005-12-27 02:43:12 -0200 | [diff] [blame] | 19 | #include <linux/if_arp.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | #include <linux/inetdevice.h> | 
|  | 21 | #include <linux/inet.h> | 
|  | 22 | #include <linux/interrupt.h> | 
|  | 23 | #include <linux/netpoll.h> | 
|  | 24 | #include <linux/sched.h> | 
|  | 25 | #include <linux/delay.h> | 
|  | 26 | #include <linux/rcupdate.h> | 
|  | 27 | #include <linux/workqueue.h> | 
| Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 28 | #include <linux/slab.h> | 
| Paul Gortmaker | bc3b2d7 | 2011-07-15 11:47:34 -0400 | [diff] [blame] | 29 | #include <linux/export.h> | 
| Amerigo Wang | 689971b | 2012-08-10 01:24:49 +0000 | [diff] [blame] | 30 | #include <linux/if_vlan.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 31 | #include <net/tcp.h> | 
|  | 32 | #include <net/udp.h> | 
| Cong Wang | b3d936f | 2013-01-07 20:52:41 +0000 | [diff] [blame] | 33 | #include <net/addrconf.h> | 
|  | 34 | #include <net/ndisc.h> | 
|  | 35 | #include <net/ip6_checksum.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 36 | #include <asm/unaligned.h> | 
| David S. Miller | 9cbc1cb | 2009-06-15 03:02:23 -0700 | [diff] [blame] | 37 | #include <trace/events/napi.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 |  | 
|  | 39 | /* | 
|  | 40 | * We maintain a small pool of fully-sized skbs, to make sure the | 
|  | 41 | * message gets out even in extreme OOM situations. | 
|  | 42 | */ | 
|  | 43 |  | 
|  | 44 | #define MAX_UDP_CHUNK 1460 | 
|  | 45 | #define MAX_SKBS 32 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 46 |  | 
| Stephen Hemminger | a1bcfac | 2006-11-14 10:43:58 -0800 | [diff] [blame] | 47 | static struct sk_buff_head skb_pool; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 |  | 
| Lai Jiangshan | 7f9421c | 2013-03-15 06:50:52 +0000 | [diff] [blame] | 49 | DEFINE_STATIC_SRCU(netpoll_srcu); | 
| Neil Horman | ca99ca1 | 2013-02-05 08:05:43 +0000 | [diff] [blame] | 50 |  | 
| Stephen Hemminger | 2bdfe0b | 2006-10-26 15:46:54 -0700 | [diff] [blame] | 51 | #define USEC_PER_POLL	50 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 52 |  | 
| Joe Perches | 6f70624 | 2012-01-29 15:50:44 +0000 | [diff] [blame] | 53 | #define MAX_SKB_SIZE							\ | 
|  | 54 | (sizeof(struct ethhdr) +					\ | 
|  | 55 | sizeof(struct iphdr) +						\ | 
|  | 56 | sizeof(struct udphdr) +					\ | 
|  | 57 | MAX_UDP_CHUNK) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 |  | 
| David S. Miller | 3578b0c | 2010-08-03 00:24:04 -0700 | [diff] [blame] | 59 | static void zap_completion_queue(void); | 
| Neil Horman | 2cde6ac | 2013-02-11 10:25:30 +0000 | [diff] [blame] | 60 | static void netpoll_async_cleanup(struct work_struct *work); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 61 |  | 
| Anton Vorontsov | bff3877 | 2009-07-08 11:10:56 -0700 | [diff] [blame] | 62 | static unsigned int carrier_timeout = 4; | 
|  | 63 | module_param(carrier_timeout, uint, 0644); | 
|  | 64 |  | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 65 | #define np_info(np, fmt, ...)				\ | 
|  | 66 | pr_info("%s: " fmt, np->name, ##__VA_ARGS__) | 
|  | 67 | #define np_err(np, fmt, ...)				\ | 
|  | 68 | pr_err("%s: " fmt, np->name, ##__VA_ARGS__) | 
|  | 69 | #define np_notice(np, fmt, ...)				\ | 
|  | 70 | pr_notice("%s: " fmt, np->name, ##__VA_ARGS__) | 
|  | 71 |  | 
| David Howells | c402895 | 2006-11-22 14:57:56 +0000 | [diff] [blame] | 72 | static void queue_process(struct work_struct *work) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 73 | { | 
| David Howells | 4c1ac1b | 2006-12-05 14:37:56 +0000 | [diff] [blame] | 74 | struct netpoll_info *npinfo = | 
|  | 75 | container_of(work, struct netpoll_info, tx_work.work); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 76 | struct sk_buff *skb; | 
| Ingo Molnar | 3640543 | 2006-12-12 17:20:42 +0100 | [diff] [blame] | 77 | unsigned long flags; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 78 |  | 
| Stephen Hemminger | 6c43ff1 | 2006-10-26 15:46:53 -0700 | [diff] [blame] | 79 | while ((skb = skb_dequeue(&npinfo->txq))) { | 
|  | 80 | struct net_device *dev = skb->dev; | 
| Stephen Hemminger | 0082982 | 2008-11-20 20:14:53 -0800 | [diff] [blame] | 81 | const struct net_device_ops *ops = dev->netdev_ops; | 
| David S. Miller | fd2ea0a | 2008-07-17 01:56:23 -0700 | [diff] [blame] | 82 | struct netdev_queue *txq; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 83 |  | 
| Stephen Hemminger | 6c43ff1 | 2006-10-26 15:46:53 -0700 | [diff] [blame] | 84 | if (!netif_device_present(dev) || !netif_running(dev)) { | 
|  | 85 | __kfree_skb(skb); | 
|  | 86 | continue; | 
|  | 87 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 88 |  | 
| David S. Miller | fd2ea0a | 2008-07-17 01:56:23 -0700 | [diff] [blame] | 89 | txq = netdev_get_tx_queue(dev, skb_get_queue_mapping(skb)); | 
|  | 90 |  | 
| Ingo Molnar | 3640543 | 2006-12-12 17:20:42 +0100 | [diff] [blame] | 91 | local_irq_save(flags); | 
| David S. Miller | fd2ea0a | 2008-07-17 01:56:23 -0700 | [diff] [blame] | 92 | __netif_tx_lock(txq, smp_processor_id()); | 
| Tom Herbert | 73466498 | 2011-11-28 16:32:44 +0000 | [diff] [blame] | 93 | if (netif_xmit_frozen_or_stopped(txq) || | 
| Stephen Hemminger | 0082982 | 2008-11-20 20:14:53 -0800 | [diff] [blame] | 94 | ops->ndo_start_xmit(skb, dev) != NETDEV_TX_OK) { | 
| Stephen Hemminger | 6c43ff1 | 2006-10-26 15:46:53 -0700 | [diff] [blame] | 95 | skb_queue_head(&npinfo->txq, skb); | 
| David S. Miller | fd2ea0a | 2008-07-17 01:56:23 -0700 | [diff] [blame] | 96 | __netif_tx_unlock(txq); | 
| Ingo Molnar | 3640543 | 2006-12-12 17:20:42 +0100 | [diff] [blame] | 97 | local_irq_restore(flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 98 |  | 
| Jarek Poplawski | 25442ca | 2007-07-05 17:42:44 -0700 | [diff] [blame] | 99 | schedule_delayed_work(&npinfo->tx_work, HZ/10); | 
| Stephen Hemminger | 6c43ff1 | 2006-10-26 15:46:53 -0700 | [diff] [blame] | 100 | return; | 
|  | 101 | } | 
| David S. Miller | fd2ea0a | 2008-07-17 01:56:23 -0700 | [diff] [blame] | 102 | __netif_tx_unlock(txq); | 
| Ingo Molnar | 3640543 | 2006-12-12 17:20:42 +0100 | [diff] [blame] | 103 | local_irq_restore(flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 104 | } | 
|  | 105 | } | 
|  | 106 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 107 | /* | 
|  | 108 | * Check whether delayed processing was scheduled for our NIC. If so, | 
|  | 109 | * we attempt to grab the poll lock and use ->poll() to pump the card. | 
|  | 110 | * If this fails, either we've recursed in ->poll() or it's already | 
|  | 111 | * running on another CPU. | 
|  | 112 | * | 
|  | 113 | * Note: we don't mask interrupts with this lock because we're using | 
|  | 114 | * trylock here and interrupts are already disabled in the softirq | 
|  | 115 | * case. Further, we test the poll_owner to avoid recursion on UP | 
|  | 116 | * systems where the lock doesn't exist. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 117 | */ | 
| Eric W. Biederman | b249b51 | 2014-03-14 20:44:37 -0700 | [diff] [blame] | 118 | static int poll_one_napi(struct napi_struct *napi, int budget) | 
| David S. Miller | 0a7606c | 2007-10-29 21:28:47 -0700 | [diff] [blame] | 119 | { | 
|  | 120 | int work; | 
|  | 121 |  | 
|  | 122 | /* net_rx_action's ->poll() invocations and our's are | 
|  | 123 | * synchronized by this test which is only made while | 
|  | 124 | * holding the napi->poll_lock. | 
|  | 125 | */ | 
|  | 126 | if (!test_bit(NAPI_STATE_SCHED, &napi->state)) | 
|  | 127 | return budget; | 
|  | 128 |  | 
| Neil Horman | 7b363e4 | 2008-12-09 23:22:26 -0800 | [diff] [blame] | 129 | set_bit(NAPI_STATE_NPSVC, &napi->state); | 
| David S. Miller | 0a7606c | 2007-10-29 21:28:47 -0700 | [diff] [blame] | 130 |  | 
|  | 131 | work = napi->poll(napi, budget); | 
| Eric W. Biederman | e97dc3f | 2014-03-14 20:47:15 -0700 | [diff] [blame] | 132 | WARN_ONCE(work > budget, "%pF exceeded budget in poll\n", napi->poll); | 
| David S. Miller | 7d18f11 | 2009-05-21 23:30:09 -0700 | [diff] [blame] | 133 | trace_napi_poll(napi); | 
| David S. Miller | 0a7606c | 2007-10-29 21:28:47 -0700 | [diff] [blame] | 134 |  | 
| Neil Horman | 7b363e4 | 2008-12-09 23:22:26 -0800 | [diff] [blame] | 135 | clear_bit(NAPI_STATE_NPSVC, &napi->state); | 
| David S. Miller | 0a7606c | 2007-10-29 21:28:47 -0700 | [diff] [blame] | 136 |  | 
|  | 137 | return budget - work; | 
|  | 138 | } | 
|  | 139 |  | 
| Eric W. Biederman | 9852fbe | 2014-03-14 20:45:17 -0700 | [diff] [blame] | 140 | static void poll_napi(struct net_device *dev, int budget) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 141 | { | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 142 | struct napi_struct *napi; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 143 |  | 
| Neil Horman | f13d493 | 2010-10-19 07:04:26 +0000 | [diff] [blame] | 144 | list_for_each_entry(napi, &dev->napi_list, dev_list) { | 
| David S. Miller | 0a7606c | 2007-10-29 21:28:47 -0700 | [diff] [blame] | 145 | if (napi->poll_owner != smp_processor_id() && | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 146 | spin_trylock(&napi->poll_lock)) { | 
| Eric W. Biederman | b249b51 | 2014-03-14 20:44:37 -0700 | [diff] [blame] | 147 | budget = poll_one_napi(napi, budget); | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 148 | spin_unlock(&napi->poll_lock); | 
|  | 149 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 150 | } | 
|  | 151 | } | 
|  | 152 |  | 
| Joe Perches | 234b921 | 2011-06-30 15:08:57 +0000 | [diff] [blame] | 153 | static void netpoll_poll_dev(struct net_device *dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 154 | { | 
| Pavel Emelyanov | 5e39273 | 2009-05-11 00:36:35 +0000 | [diff] [blame] | 155 | const struct net_device_ops *ops; | 
| Amerigo Wang | 2899656 | 2012-08-10 01:24:42 +0000 | [diff] [blame] | 156 | struct netpoll_info *ni = rcu_dereference_bh(dev->npinfo); | 
| Eric W. Biederman | 9c62a68 | 2014-03-14 20:51:52 -0700 | [diff] [blame] | 157 | int budget = 0; | 
| Stephen Hemminger | 5106930 | 2007-11-19 19:18:11 -0800 | [diff] [blame] | 158 |  | 
| Neil Horman | ca99ca1 | 2013-02-05 08:05:43 +0000 | [diff] [blame] | 159 | /* Don't do any rx activity if the dev_lock mutex is held | 
|  | 160 | * the dev_open/close paths use this to block netpoll activity | 
|  | 161 | * while changing device state | 
|  | 162 | */ | 
| Dan Carpenter | a3dbbc2 | 2013-05-06 02:15:13 +0000 | [diff] [blame] | 163 | if (down_trylock(&ni->dev_lock)) | 
| Neil Horman | ca99ca1 | 2013-02-05 08:05:43 +0000 | [diff] [blame] | 164 | return; | 
|  | 165 |  | 
| Neil Horman | 959d5fd | 2013-02-13 11:32:42 -0500 | [diff] [blame] | 166 | if (!netif_running(dev)) { | 
| Neil Horman | bd7c4b6 | 2013-04-30 05:35:05 +0000 | [diff] [blame] | 167 | up(&ni->dev_lock); | 
| Pavel Emelyanov | 5e39273 | 2009-05-11 00:36:35 +0000 | [diff] [blame] | 168 | return; | 
| Neil Horman | 959d5fd | 2013-02-13 11:32:42 -0500 | [diff] [blame] | 169 | } | 
| Pavel Emelyanov | 5e39273 | 2009-05-11 00:36:35 +0000 | [diff] [blame] | 170 |  | 
|  | 171 | ops = dev->netdev_ops; | 
| Neil Horman | 959d5fd | 2013-02-13 11:32:42 -0500 | [diff] [blame] | 172 | if (!ops->ndo_poll_controller) { | 
| Neil Horman | bd7c4b6 | 2013-04-30 05:35:05 +0000 | [diff] [blame] | 173 | up(&ni->dev_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 174 | return; | 
| Neil Horman | 959d5fd | 2013-02-13 11:32:42 -0500 | [diff] [blame] | 175 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 176 |  | 
|  | 177 | /* Process pending work on NIC */ | 
| Stephen Hemminger | d314774 | 2008-11-19 21:32:24 -0800 | [diff] [blame] | 178 | ops->ndo_poll_controller(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 179 |  | 
| Eric W. Biederman | 9852fbe | 2014-03-14 20:45:17 -0700 | [diff] [blame] | 180 | poll_napi(dev, budget); | 
| Stephen Hemminger | 5106930 | 2007-11-19 19:18:11 -0800 | [diff] [blame] | 181 |  | 
| Neil Horman | bd7c4b6 | 2013-04-30 05:35:05 +0000 | [diff] [blame] | 182 | up(&ni->dev_lock); | 
| Neil Horman | ca99ca1 | 2013-02-05 08:05:43 +0000 | [diff] [blame] | 183 |  | 
| David S. Miller | 3578b0c | 2010-08-03 00:24:04 -0700 | [diff] [blame] | 184 | zap_completion_queue(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 185 | } | 
|  | 186 |  | 
| dingtianhong | da6e378 | 2013-05-27 19:53:31 +0000 | [diff] [blame] | 187 | void netpoll_rx_disable(struct net_device *dev) | 
| Neil Horman | ca99ca1 | 2013-02-05 08:05:43 +0000 | [diff] [blame] | 188 | { | 
|  | 189 | struct netpoll_info *ni; | 
|  | 190 | int idx; | 
|  | 191 | might_sleep(); | 
|  | 192 | idx = srcu_read_lock(&netpoll_srcu); | 
|  | 193 | ni = srcu_dereference(dev->npinfo, &netpoll_srcu); | 
|  | 194 | if (ni) | 
| Neil Horman | bd7c4b6 | 2013-04-30 05:35:05 +0000 | [diff] [blame] | 195 | down(&ni->dev_lock); | 
| Neil Horman | ca99ca1 | 2013-02-05 08:05:43 +0000 | [diff] [blame] | 196 | srcu_read_unlock(&netpoll_srcu, idx); | 
| Neil Horman | ca99ca1 | 2013-02-05 08:05:43 +0000 | [diff] [blame] | 197 | } | 
|  | 198 | EXPORT_SYMBOL(netpoll_rx_disable); | 
|  | 199 |  | 
|  | 200 | void netpoll_rx_enable(struct net_device *dev) | 
|  | 201 | { | 
|  | 202 | struct netpoll_info *ni; | 
|  | 203 | rcu_read_lock(); | 
|  | 204 | ni = rcu_dereference(dev->npinfo); | 
|  | 205 | if (ni) | 
| Neil Horman | bd7c4b6 | 2013-04-30 05:35:05 +0000 | [diff] [blame] | 206 | up(&ni->dev_lock); | 
| Neil Horman | ca99ca1 | 2013-02-05 08:05:43 +0000 | [diff] [blame] | 207 | rcu_read_unlock(); | 
|  | 208 | } | 
|  | 209 | EXPORT_SYMBOL(netpoll_rx_enable); | 
|  | 210 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 211 | static void refill_skbs(void) | 
|  | 212 | { | 
|  | 213 | struct sk_buff *skb; | 
|  | 214 | unsigned long flags; | 
|  | 215 |  | 
| Stephen Hemminger | a1bcfac | 2006-11-14 10:43:58 -0800 | [diff] [blame] | 216 | spin_lock_irqsave(&skb_pool.lock, flags); | 
|  | 217 | while (skb_pool.qlen < MAX_SKBS) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 218 | skb = alloc_skb(MAX_SKB_SIZE, GFP_ATOMIC); | 
|  | 219 | if (!skb) | 
|  | 220 | break; | 
|  | 221 |  | 
| Stephen Hemminger | a1bcfac | 2006-11-14 10:43:58 -0800 | [diff] [blame] | 222 | __skb_queue_tail(&skb_pool, skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 223 | } | 
| Stephen Hemminger | a1bcfac | 2006-11-14 10:43:58 -0800 | [diff] [blame] | 224 | spin_unlock_irqrestore(&skb_pool.lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 225 | } | 
|  | 226 |  | 
| David S. Miller | 3578b0c | 2010-08-03 00:24:04 -0700 | [diff] [blame] | 227 | static void zap_completion_queue(void) | 
|  | 228 | { | 
|  | 229 | unsigned long flags; | 
|  | 230 | struct softnet_data *sd = &get_cpu_var(softnet_data); | 
|  | 231 |  | 
|  | 232 | if (sd->completion_queue) { | 
|  | 233 | struct sk_buff *clist; | 
|  | 234 |  | 
|  | 235 | local_irq_save(flags); | 
|  | 236 | clist = sd->completion_queue; | 
|  | 237 | sd->completion_queue = NULL; | 
|  | 238 | local_irq_restore(flags); | 
|  | 239 |  | 
|  | 240 | while (clist != NULL) { | 
|  | 241 | struct sk_buff *skb = clist; | 
|  | 242 | clist = clist->next; | 
|  | 243 | if (skb->destructor) { | 
|  | 244 | atomic_inc(&skb->users); | 
|  | 245 | dev_kfree_skb_any(skb); /* put this one back */ | 
|  | 246 | } else { | 
|  | 247 | __kfree_skb(skb); | 
|  | 248 | } | 
|  | 249 | } | 
|  | 250 | } | 
|  | 251 |  | 
|  | 252 | put_cpu_var(softnet_data); | 
|  | 253 | } | 
|  | 254 |  | 
| Stephen Hemminger | a1bcfac | 2006-11-14 10:43:58 -0800 | [diff] [blame] | 255 | static struct sk_buff *find_skb(struct netpoll *np, int len, int reserve) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 256 | { | 
| Stephen Hemminger | a1bcfac | 2006-11-14 10:43:58 -0800 | [diff] [blame] | 257 | int count = 0; | 
|  | 258 | struct sk_buff *skb; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 259 |  | 
| David S. Miller | 3578b0c | 2010-08-03 00:24:04 -0700 | [diff] [blame] | 260 | zap_completion_queue(); | 
| Stephen Hemminger | a1bcfac | 2006-11-14 10:43:58 -0800 | [diff] [blame] | 261 | refill_skbs(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 262 | repeat: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 263 |  | 
|  | 264 | skb = alloc_skb(len, GFP_ATOMIC); | 
| Stephen Hemminger | a1bcfac | 2006-11-14 10:43:58 -0800 | [diff] [blame] | 265 | if (!skb) | 
|  | 266 | skb = skb_dequeue(&skb_pool); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 267 |  | 
|  | 268 | if (!skb) { | 
| Stephen Hemminger | a1bcfac | 2006-11-14 10:43:58 -0800 | [diff] [blame] | 269 | if (++count < 10) { | 
| Joe Perches | 2a49e00 | 2011-06-30 15:08:58 +0000 | [diff] [blame] | 270 | netpoll_poll_dev(np->dev); | 
| Stephen Hemminger | a1bcfac | 2006-11-14 10:43:58 -0800 | [diff] [blame] | 271 | goto repeat; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 272 | } | 
| Stephen Hemminger | a1bcfac | 2006-11-14 10:43:58 -0800 | [diff] [blame] | 273 | return NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 274 | } | 
|  | 275 |  | 
|  | 276 | atomic_set(&skb->users, 1); | 
|  | 277 | skb_reserve(skb, reserve); | 
|  | 278 | return skb; | 
|  | 279 | } | 
|  | 280 |  | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 281 | static int netpoll_owner_active(struct net_device *dev) | 
|  | 282 | { | 
|  | 283 | struct napi_struct *napi; | 
|  | 284 |  | 
|  | 285 | list_for_each_entry(napi, &dev->napi_list, dev_list) { | 
|  | 286 | if (napi->poll_owner == smp_processor_id()) | 
|  | 287 | return 1; | 
|  | 288 | } | 
|  | 289 | return 0; | 
|  | 290 | } | 
|  | 291 |  | 
| Amerigo Wang | 2899656 | 2012-08-10 01:24:42 +0000 | [diff] [blame] | 292 | /* call with IRQ disabled */ | 
| Neil Horman | c2355e1 | 2010-10-13 16:01:49 +0000 | [diff] [blame] | 293 | void netpoll_send_skb_on_dev(struct netpoll *np, struct sk_buff *skb, | 
|  | 294 | struct net_device *dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 295 | { | 
| Stephen Hemminger | 2bdfe0b | 2006-10-26 15:46:54 -0700 | [diff] [blame] | 296 | int status = NETDEV_TX_BUSY; | 
|  | 297 | unsigned long tries; | 
| Stephen Hemminger | 0082982 | 2008-11-20 20:14:53 -0800 | [diff] [blame] | 298 | const struct net_device_ops *ops = dev->netdev_ops; | 
| Herbert Xu | de85d99 | 2010-06-10 16:12:44 +0000 | [diff] [blame] | 299 | /* It is up to the caller to keep npinfo alive. */ | 
| Amerigo Wang | 2899656 | 2012-08-10 01:24:42 +0000 | [diff] [blame] | 300 | struct netpoll_info *npinfo; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 301 |  | 
| Amerigo Wang | 2899656 | 2012-08-10 01:24:42 +0000 | [diff] [blame] | 302 | WARN_ON_ONCE(!irqs_disabled()); | 
|  | 303 |  | 
|  | 304 | npinfo = rcu_dereference_bh(np->dev->npinfo); | 
| YOSHIFUJI Hideaki | 4ec93ed | 2007-02-09 23:24:36 +0900 | [diff] [blame] | 305 | if (!npinfo || !netif_running(dev) || !netif_device_present(dev)) { | 
|  | 306 | __kfree_skb(skb); | 
|  | 307 | return; | 
|  | 308 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 309 |  | 
| Stephen Hemminger | 2bdfe0b | 2006-10-26 15:46:54 -0700 | [diff] [blame] | 310 | /* don't get messages out of order, and no recursion */ | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 311 | if (skb_queue_len(&npinfo->txq) == 0 && !netpoll_owner_active(dev)) { | 
| David S. Miller | fd2ea0a | 2008-07-17 01:56:23 -0700 | [diff] [blame] | 312 | struct netdev_queue *txq; | 
| Andrew Morton | a49f99f | 2006-12-11 17:24:46 -0800 | [diff] [blame] | 313 |  | 
| Jason Wang | f663dd9 | 2014-01-10 16:18:26 +0800 | [diff] [blame] | 314 | txq = netdev_pick_tx(dev, skb, NULL); | 
| David S. Miller | fd2ea0a | 2008-07-17 01:56:23 -0700 | [diff] [blame] | 315 |  | 
| Stephen Hemminger | 0db3dc7 | 2007-06-27 00:39:42 -0700 | [diff] [blame] | 316 | /* try until next clock tick */ | 
|  | 317 | for (tries = jiffies_to_usecs(1)/USEC_PER_POLL; | 
|  | 318 | tries > 0; --tries) { | 
| David S. Miller | fd2ea0a | 2008-07-17 01:56:23 -0700 | [diff] [blame] | 319 | if (__netif_tx_trylock(txq)) { | 
| Tom Herbert | 73466498 | 2011-11-28 16:32:44 +0000 | [diff] [blame] | 320 | if (!netif_xmit_stopped(txq)) { | 
| Amerigo Wang | 689971b | 2012-08-10 01:24:49 +0000 | [diff] [blame] | 321 | if (vlan_tx_tag_present(skb) && | 
| Patrick McHardy | 86a9bad | 2013-04-19 02:04:30 +0000 | [diff] [blame] | 322 | !vlan_hw_offload_capable(netif_skb_features(skb), | 
|  | 323 | skb->vlan_proto)) { | 
|  | 324 | skb = __vlan_put_tag(skb, skb->vlan_proto, vlan_tx_tag_get(skb)); | 
| David S. Miller | aca5f58 | 2014-01-02 19:50:52 -0500 | [diff] [blame] | 325 | if (unlikely(!skb)) { | 
|  | 326 | /* This is actually a packet drop, but we | 
|  | 327 | * don't want the code at the end of this | 
|  | 328 | * function to try and re-queue a NULL skb. | 
|  | 329 | */ | 
|  | 330 | status = NETDEV_TX_OK; | 
|  | 331 | goto unlock_txq; | 
|  | 332 | } | 
| Amerigo Wang | 689971b | 2012-08-10 01:24:49 +0000 | [diff] [blame] | 333 | skb->vlan_tci = 0; | 
|  | 334 | } | 
|  | 335 |  | 
| Stephen Hemminger | 0082982 | 2008-11-20 20:14:53 -0800 | [diff] [blame] | 336 | status = ops->ndo_start_xmit(skb, dev); | 
| Eric Dumazet | 08baf56 | 2009-05-25 22:58:01 -0700 | [diff] [blame] | 337 | if (status == NETDEV_TX_OK) | 
|  | 338 | txq_trans_update(txq); | 
|  | 339 | } | 
| David S. Miller | aca5f58 | 2014-01-02 19:50:52 -0500 | [diff] [blame] | 340 | unlock_txq: | 
| David S. Miller | fd2ea0a | 2008-07-17 01:56:23 -0700 | [diff] [blame] | 341 | __netif_tx_unlock(txq); | 
| Matt Mackall | f0d3459 | 2005-08-11 19:25:11 -0700 | [diff] [blame] | 342 |  | 
| Andrew Morton | e37b8d9 | 2006-12-09 14:01:49 -0800 | [diff] [blame] | 343 | if (status == NETDEV_TX_OK) | 
|  | 344 | break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 345 |  | 
| Andrew Morton | e37b8d9 | 2006-12-09 14:01:49 -0800 | [diff] [blame] | 346 | } | 
| Stephen Hemminger | 0db3dc7 | 2007-06-27 00:39:42 -0700 | [diff] [blame] | 347 |  | 
|  | 348 | /* tickle device maybe there is some cleanup */ | 
| Joe Perches | 2a49e00 | 2011-06-30 15:08:58 +0000 | [diff] [blame] | 349 | netpoll_poll_dev(np->dev); | 
| Stephen Hemminger | 0db3dc7 | 2007-06-27 00:39:42 -0700 | [diff] [blame] | 350 |  | 
|  | 351 | udelay(USEC_PER_POLL); | 
| Matt Mackall | 0db1d6f | 2005-08-11 19:25:54 -0700 | [diff] [blame] | 352 | } | 
| Dongdong Deng | 79b1bee | 2009-08-21 03:33:36 +0000 | [diff] [blame] | 353 |  | 
|  | 354 | WARN_ONCE(!irqs_disabled(), | 
| Amerigo Wang | 2899656 | 2012-08-10 01:24:42 +0000 | [diff] [blame] | 355 | "netpoll_send_skb_on_dev(): %s enabled interrupts in poll (%pF)\n", | 
| Dongdong Deng | 79b1bee | 2009-08-21 03:33:36 +0000 | [diff] [blame] | 356 | dev->name, ops->ndo_start_xmit); | 
|  | 357 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 358 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 359 |  | 
| Stephen Hemminger | 2bdfe0b | 2006-10-26 15:46:54 -0700 | [diff] [blame] | 360 | if (status != NETDEV_TX_OK) { | 
| Stephen Hemminger | 5de4a47 | 2006-10-26 15:46:55 -0700 | [diff] [blame] | 361 | skb_queue_tail(&npinfo->txq, skb); | 
| David Howells | 4c1ac1b | 2006-12-05 14:37:56 +0000 | [diff] [blame] | 362 | schedule_delayed_work(&npinfo->tx_work,0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 363 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 364 | } | 
| Neil Horman | c2355e1 | 2010-10-13 16:01:49 +0000 | [diff] [blame] | 365 | EXPORT_SYMBOL(netpoll_send_skb_on_dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 366 |  | 
|  | 367 | void netpoll_send_udp(struct netpoll *np, const char *msg, int len) | 
|  | 368 | { | 
| Eric Dumazet | 954fba0 | 2012-06-12 19:30:21 +0000 | [diff] [blame] | 369 | int total_len, ip_len, udp_len; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 370 | struct sk_buff *skb; | 
|  | 371 | struct udphdr *udph; | 
|  | 372 | struct iphdr *iph; | 
|  | 373 | struct ethhdr *eth; | 
| Eric Dumazet | ee13040 | 2012-08-24 01:47:26 +0000 | [diff] [blame] | 374 | static atomic_t ip_ident; | 
| Cong Wang | b3d936f | 2013-01-07 20:52:41 +0000 | [diff] [blame] | 375 | struct ipv6hdr *ip6h; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 376 |  | 
|  | 377 | udp_len = len + sizeof(*udph); | 
| Cong Wang | b3d936f | 2013-01-07 20:52:41 +0000 | [diff] [blame] | 378 | if (np->ipv6) | 
|  | 379 | ip_len = udp_len + sizeof(*ip6h); | 
|  | 380 | else | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 381 | ip_len = udp_len + sizeof(*iph); | 
|  | 382 |  | 
| Eric Dumazet | 954fba0 | 2012-06-12 19:30:21 +0000 | [diff] [blame] | 383 | total_len = ip_len + LL_RESERVED_SPACE(np->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 384 |  | 
| Eric Dumazet | 954fba0 | 2012-06-12 19:30:21 +0000 | [diff] [blame] | 385 | skb = find_skb(np, total_len + np->dev->needed_tailroom, | 
|  | 386 | total_len - len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 387 | if (!skb) | 
|  | 388 | return; | 
|  | 389 |  | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 390 | skb_copy_to_linear_data(skb, msg, len); | 
| Eric Dumazet | 954fba0 | 2012-06-12 19:30:21 +0000 | [diff] [blame] | 391 | skb_put(skb, len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 392 |  | 
| Arnaldo Carvalho de Melo | 4bedb45 | 2007-03-13 14:28:48 -0300 | [diff] [blame] | 393 | skb_push(skb, sizeof(*udph)); | 
|  | 394 | skb_reset_transport_header(skb); | 
|  | 395 | udph = udp_hdr(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 396 | udph->source = htons(np->local_port); | 
|  | 397 | udph->dest = htons(np->remote_port); | 
|  | 398 | udph->len = htons(udp_len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 399 |  | 
| Cong Wang | b3d936f | 2013-01-07 20:52:41 +0000 | [diff] [blame] | 400 | if (np->ipv6) { | 
|  | 401 | udph->check = 0; | 
|  | 402 | udph->check = csum_ipv6_magic(&np->local_ip.in6, | 
|  | 403 | &np->remote_ip.in6, | 
|  | 404 | udp_len, IPPROTO_UDP, | 
|  | 405 | csum_partial(udph, udp_len, 0)); | 
|  | 406 | if (udph->check == 0) | 
|  | 407 | udph->check = CSUM_MANGLED_0; | 
|  | 408 |  | 
|  | 409 | skb_push(skb, sizeof(*ip6h)); | 
|  | 410 | skb_reset_network_header(skb); | 
|  | 411 | ip6h = ipv6_hdr(skb); | 
|  | 412 |  | 
|  | 413 | /* ip6h->version = 6; ip6h->priority = 0; */ | 
|  | 414 | put_unaligned(0x60, (unsigned char *)ip6h); | 
|  | 415 | ip6h->flow_lbl[0] = 0; | 
|  | 416 | ip6h->flow_lbl[1] = 0; | 
|  | 417 | ip6h->flow_lbl[2] = 0; | 
|  | 418 |  | 
|  | 419 | ip6h->payload_len = htons(sizeof(struct udphdr) + len); | 
|  | 420 | ip6h->nexthdr = IPPROTO_UDP; | 
|  | 421 | ip6h->hop_limit = 32; | 
|  | 422 | ip6h->saddr = np->local_ip.in6; | 
|  | 423 | ip6h->daddr = np->remote_ip.in6; | 
|  | 424 |  | 
|  | 425 | eth = (struct ethhdr *) skb_push(skb, ETH_HLEN); | 
|  | 426 | skb_reset_mac_header(skb); | 
|  | 427 | skb->protocol = eth->h_proto = htons(ETH_P_IPV6); | 
|  | 428 | } else { | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 429 | udph->check = 0; | 
|  | 430 | udph->check = csum_tcpudp_magic(np->local_ip.ip, | 
|  | 431 | np->remote_ip.ip, | 
|  | 432 | udp_len, IPPROTO_UDP, | 
|  | 433 | csum_partial(udph, udp_len, 0)); | 
|  | 434 | if (udph->check == 0) | 
|  | 435 | udph->check = CSUM_MANGLED_0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 436 |  | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 437 | skb_push(skb, sizeof(*iph)); | 
|  | 438 | skb_reset_network_header(skb); | 
|  | 439 | iph = ip_hdr(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 440 |  | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 441 | /* iph->version = 4; iph->ihl = 5; */ | 
|  | 442 | put_unaligned(0x45, (unsigned char *)iph); | 
|  | 443 | iph->tos      = 0; | 
|  | 444 | put_unaligned(htons(ip_len), &(iph->tot_len)); | 
|  | 445 | iph->id       = htons(atomic_inc_return(&ip_ident)); | 
|  | 446 | iph->frag_off = 0; | 
|  | 447 | iph->ttl      = 64; | 
|  | 448 | iph->protocol = IPPROTO_UDP; | 
|  | 449 | iph->check    = 0; | 
|  | 450 | put_unaligned(np->local_ip.ip, &(iph->saddr)); | 
|  | 451 | put_unaligned(np->remote_ip.ip, &(iph->daddr)); | 
|  | 452 | iph->check    = ip_fast_csum((unsigned char *)iph, iph->ihl); | 
|  | 453 |  | 
|  | 454 | eth = (struct ethhdr *) skb_push(skb, ETH_HLEN); | 
|  | 455 | skb_reset_mac_header(skb); | 
|  | 456 | skb->protocol = eth->h_proto = htons(ETH_P_IP); | 
|  | 457 | } | 
|  | 458 |  | 
| Joe Perches | c62326a | 2014-01-20 09:52:18 -0800 | [diff] [blame] | 459 | ether_addr_copy(eth->h_source, np->dev->dev_addr); | 
|  | 460 | ether_addr_copy(eth->h_dest, np->remote_mac); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 461 |  | 
|  | 462 | skb->dev = np->dev; | 
|  | 463 |  | 
|  | 464 | netpoll_send_skb(np, skb); | 
|  | 465 | } | 
| Eric Dumazet | 9e34a5b | 2010-07-09 21:22:04 +0000 | [diff] [blame] | 466 | EXPORT_SYMBOL(netpoll_send_udp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 467 |  | 
| Satyam Sharma | 0bcc181 | 2007-08-10 15:35:05 -0700 | [diff] [blame] | 468 | void netpoll_print_options(struct netpoll *np) | 
|  | 469 | { | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 470 | np_info(np, "local port %d\n", np->local_port); | 
| Cong Wang | b3d936f | 2013-01-07 20:52:41 +0000 | [diff] [blame] | 471 | if (np->ipv6) | 
|  | 472 | np_info(np, "local IPv6 address %pI6c\n", &np->local_ip.in6); | 
|  | 473 | else | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 474 | np_info(np, "local IPv4 address %pI4\n", &np->local_ip.ip); | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 475 | np_info(np, "interface '%s'\n", np->dev_name); | 
|  | 476 | np_info(np, "remote port %d\n", np->remote_port); | 
| Cong Wang | b3d936f | 2013-01-07 20:52:41 +0000 | [diff] [blame] | 477 | if (np->ipv6) | 
|  | 478 | np_info(np, "remote IPv6 address %pI6c\n", &np->remote_ip.in6); | 
|  | 479 | else | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 480 | np_info(np, "remote IPv4 address %pI4\n", &np->remote_ip.ip); | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 481 | np_info(np, "remote ethernet address %pM\n", np->remote_mac); | 
| Satyam Sharma | 0bcc181 | 2007-08-10 15:35:05 -0700 | [diff] [blame] | 482 | } | 
| Eric Dumazet | 9e34a5b | 2010-07-09 21:22:04 +0000 | [diff] [blame] | 483 | EXPORT_SYMBOL(netpoll_print_options); | 
| Satyam Sharma | 0bcc181 | 2007-08-10 15:35:05 -0700 | [diff] [blame] | 484 |  | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 485 | static int netpoll_parse_ip_addr(const char *str, union inet_addr *addr) | 
|  | 486 | { | 
|  | 487 | const char *end; | 
|  | 488 |  | 
|  | 489 | if (!strchr(str, ':') && | 
|  | 490 | in4_pton(str, -1, (void *)addr, -1, &end) > 0) { | 
|  | 491 | if (!*end) | 
|  | 492 | return 0; | 
|  | 493 | } | 
|  | 494 | if (in6_pton(str, -1, addr->in6.s6_addr, -1, &end) > 0) { | 
|  | 495 | #if IS_ENABLED(CONFIG_IPV6) | 
|  | 496 | if (!*end) | 
|  | 497 | return 1; | 
|  | 498 | #else | 
|  | 499 | return -1; | 
|  | 500 | #endif | 
|  | 501 | } | 
|  | 502 | return -1; | 
|  | 503 | } | 
|  | 504 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 505 | int netpoll_parse_options(struct netpoll *np, char *opt) | 
|  | 506 | { | 
|  | 507 | char *cur=opt, *delim; | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 508 | int ipv6; | 
| Sabrina Dubroca | 00fe11b | 2014-02-06 18:34:12 +0100 | [diff] [blame] | 509 | bool ipversion_set = false; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 510 |  | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 511 | if (*cur != '@') { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 512 | if ((delim = strchr(cur, '@')) == NULL) | 
|  | 513 | goto parse_failed; | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 514 | *delim = 0; | 
| Abhijit Pawar | 4b5511e | 2012-12-09 23:12:28 +0000 | [diff] [blame] | 515 | if (kstrtou16(cur, 10, &np->local_port)) | 
|  | 516 | goto parse_failed; | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 517 | cur = delim; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 518 | } | 
|  | 519 | cur++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 520 |  | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 521 | if (*cur != '/') { | 
| Sabrina Dubroca | 00fe11b | 2014-02-06 18:34:12 +0100 | [diff] [blame] | 522 | ipversion_set = true; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 523 | if ((delim = strchr(cur, '/')) == NULL) | 
|  | 524 | goto parse_failed; | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 525 | *delim = 0; | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 526 | ipv6 = netpoll_parse_ip_addr(cur, &np->local_ip); | 
|  | 527 | if (ipv6 < 0) | 
|  | 528 | goto parse_failed; | 
|  | 529 | else | 
|  | 530 | np->ipv6 = (bool)ipv6; | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 531 | cur = delim; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 532 | } | 
|  | 533 | cur++; | 
|  | 534 |  | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 535 | if (*cur != ',') { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 536 | /* parse out dev name */ | 
|  | 537 | if ((delim = strchr(cur, ',')) == NULL) | 
|  | 538 | goto parse_failed; | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 539 | *delim = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 540 | strlcpy(np->dev_name, cur, sizeof(np->dev_name)); | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 541 | cur = delim; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 542 | } | 
|  | 543 | cur++; | 
|  | 544 |  | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 545 | if (*cur != '@') { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 546 | /* dst port */ | 
|  | 547 | if ((delim = strchr(cur, '@')) == NULL) | 
|  | 548 | goto parse_failed; | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 549 | *delim = 0; | 
| Amerigo Wang | 5fc05f8 | 2010-03-21 22:59:58 +0000 | [diff] [blame] | 550 | if (*cur == ' ' || *cur == '\t') | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 551 | np_info(np, "warning: whitespace is not allowed\n"); | 
| Abhijit Pawar | 4b5511e | 2012-12-09 23:12:28 +0000 | [diff] [blame] | 552 | if (kstrtou16(cur, 10, &np->remote_port)) | 
|  | 553 | goto parse_failed; | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 554 | cur = delim; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 555 | } | 
|  | 556 | cur++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 557 |  | 
|  | 558 | /* dst ip */ | 
|  | 559 | if ((delim = strchr(cur, '/')) == NULL) | 
|  | 560 | goto parse_failed; | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 561 | *delim = 0; | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 562 | ipv6 = netpoll_parse_ip_addr(cur, &np->remote_ip); | 
|  | 563 | if (ipv6 < 0) | 
|  | 564 | goto parse_failed; | 
| Sabrina Dubroca | 00fe11b | 2014-02-06 18:34:12 +0100 | [diff] [blame] | 565 | else if (ipversion_set && np->ipv6 != (bool)ipv6) | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 566 | goto parse_failed; | 
|  | 567 | else | 
|  | 568 | np->ipv6 = (bool)ipv6; | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 569 | cur = delim + 1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 570 |  | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 571 | if (*cur != 0) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 572 | /* MAC address */ | 
| Alexey Dobriyan | 4940fc8 | 2011-05-07 23:00:07 +0000 | [diff] [blame] | 573 | if (!mac_pton(cur, np->remote_mac)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 574 | goto parse_failed; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 575 | } | 
|  | 576 |  | 
| Satyam Sharma | 0bcc181 | 2007-08-10 15:35:05 -0700 | [diff] [blame] | 577 | netpoll_print_options(np); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 578 |  | 
|  | 579 | return 0; | 
|  | 580 |  | 
|  | 581 | parse_failed: | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 582 | np_info(np, "couldn't parse config at '%s'!\n", cur); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 583 | return -1; | 
|  | 584 | } | 
| Eric Dumazet | 9e34a5b | 2010-07-09 21:22:04 +0000 | [diff] [blame] | 585 | EXPORT_SYMBOL(netpoll_parse_options); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 586 |  | 
| Eric W. Biederman | a8779ec | 2014-03-27 15:36:38 -0700 | [diff] [blame^] | 587 | int __netpoll_setup(struct netpoll *np, struct net_device *ndev) | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 588 | { | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 589 | struct netpoll_info *npinfo; | 
|  | 590 | const struct net_device_ops *ops; | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 591 | int err; | 
|  | 592 |  | 
| Jiri Pirko | 30fdd8a0 | 2012-07-17 05:22:35 +0000 | [diff] [blame] | 593 | np->dev = ndev; | 
|  | 594 | strlcpy(np->dev_name, ndev->name, IFNAMSIZ); | 
| Neil Horman | 2cde6ac | 2013-02-11 10:25:30 +0000 | [diff] [blame] | 595 | INIT_WORK(&np->cleanup_work, netpoll_async_cleanup); | 
| Jiri Pirko | 30fdd8a0 | 2012-07-17 05:22:35 +0000 | [diff] [blame] | 596 |  | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 597 | if ((ndev->priv_flags & IFF_DISABLE_NETPOLL) || | 
|  | 598 | !ndev->netdev_ops->ndo_poll_controller) { | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 599 | np_err(np, "%s doesn't support polling, aborting\n", | 
|  | 600 | np->dev_name); | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 601 | err = -ENOTSUPP; | 
|  | 602 | goto out; | 
|  | 603 | } | 
|  | 604 |  | 
|  | 605 | if (!ndev->npinfo) { | 
| Eric W. Biederman | a8779ec | 2014-03-27 15:36:38 -0700 | [diff] [blame^] | 606 | npinfo = kmalloc(sizeof(*npinfo), GFP_KERNEL); | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 607 | if (!npinfo) { | 
|  | 608 | err = -ENOMEM; | 
|  | 609 | goto out; | 
|  | 610 | } | 
|  | 611 |  | 
| Neil Horman | bd7c4b6 | 2013-04-30 05:35:05 +0000 | [diff] [blame] | 612 | sema_init(&npinfo->dev_lock, 1); | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 613 | skb_queue_head_init(&npinfo->txq); | 
|  | 614 | INIT_DELAYED_WORK(&npinfo->tx_work, queue_process); | 
|  | 615 |  | 
|  | 616 | atomic_set(&npinfo->refcnt, 1); | 
|  | 617 |  | 
|  | 618 | ops = np->dev->netdev_ops; | 
|  | 619 | if (ops->ndo_netpoll_setup) { | 
| Eric W. Biederman | a8779ec | 2014-03-27 15:36:38 -0700 | [diff] [blame^] | 620 | err = ops->ndo_netpoll_setup(ndev, npinfo); | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 621 | if (err) | 
|  | 622 | goto free_npinfo; | 
|  | 623 | } | 
|  | 624 | } else { | 
| Neil Horman | 0790bbb | 2013-02-11 10:25:31 +0000 | [diff] [blame] | 625 | npinfo = rtnl_dereference(ndev->npinfo); | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 626 | atomic_inc(&npinfo->refcnt); | 
|  | 627 | } | 
|  | 628 |  | 
|  | 629 | npinfo->netpoll = np; | 
|  | 630 |  | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 631 | /* last thing to do is link it to the net device structure */ | 
| Eric Dumazet | cf778b0 | 2012-01-12 04:41:32 +0000 | [diff] [blame] | 632 | rcu_assign_pointer(ndev->npinfo, npinfo); | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 633 |  | 
|  | 634 | return 0; | 
|  | 635 |  | 
|  | 636 | free_npinfo: | 
|  | 637 | kfree(npinfo); | 
|  | 638 | out: | 
|  | 639 | return err; | 
|  | 640 | } | 
|  | 641 | EXPORT_SYMBOL_GPL(__netpoll_setup); | 
|  | 642 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 643 | int netpoll_setup(struct netpoll *np) | 
|  | 644 | { | 
|  | 645 | struct net_device *ndev = NULL; | 
|  | 646 | struct in_device *in_dev; | 
| Stephen Hemminger | b41848b | 2006-10-26 15:46:52 -0700 | [diff] [blame] | 647 | int err; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 648 |  | 
| Cong Wang | f92d318 | 2013-01-14 23:34:06 +0000 | [diff] [blame] | 649 | rtnl_lock(); | 
| Cong Wang | 556e625 | 2013-01-27 15:55:21 +0000 | [diff] [blame] | 650 | if (np->dev_name) { | 
|  | 651 | struct net *net = current->nsproxy->net_ns; | 
|  | 652 | ndev = __dev_get_by_name(net, np->dev_name); | 
|  | 653 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 654 | if (!ndev) { | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 655 | np_err(np, "%s doesn't exist, aborting\n", np->dev_name); | 
| Cong Wang | f92d318 | 2013-01-14 23:34:06 +0000 | [diff] [blame] | 656 | err = -ENODEV; | 
|  | 657 | goto unlock; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 658 | } | 
| Cong Wang | 5bd30d3 | 2013-01-17 12:21:08 +0800 | [diff] [blame] | 659 | dev_hold(ndev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 660 |  | 
| Jiri Pirko | 49bd8fb | 2013-01-03 22:48:55 +0000 | [diff] [blame] | 661 | if (netdev_master_upper_dev_get(ndev)) { | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 662 | np_err(np, "%s is a slave device, aborting\n", np->dev_name); | 
| Dan Carpenter | 83fe32d | 2011-06-11 18:55:22 -0700 | [diff] [blame] | 663 | err = -EBUSY; | 
|  | 664 | goto put; | 
| WANG Cong | 0c1ad04 | 2011-06-09 00:28:13 -0700 | [diff] [blame] | 665 | } | 
|  | 666 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 667 | if (!netif_running(ndev)) { | 
|  | 668 | unsigned long atmost, atleast; | 
|  | 669 |  | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 670 | np_info(np, "device %s not up yet, forcing it\n", np->dev_name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 671 |  | 
| Stephen Hemminger | b41848b | 2006-10-26 15:46:52 -0700 | [diff] [blame] | 672 | err = dev_open(ndev); | 
| Stephen Hemminger | b41848b | 2006-10-26 15:46:52 -0700 | [diff] [blame] | 673 |  | 
|  | 674 | if (err) { | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 675 | np_err(np, "failed to open %s\n", ndev->name); | 
| Herbert Xu | dbaa154 | 2010-06-10 16:12:46 +0000 | [diff] [blame] | 676 | goto put; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 677 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 678 |  | 
| Cong Wang | f92d318 | 2013-01-14 23:34:06 +0000 | [diff] [blame] | 679 | rtnl_unlock(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 680 | atleast = jiffies + HZ/10; | 
| Anton Vorontsov | bff3877 | 2009-07-08 11:10:56 -0700 | [diff] [blame] | 681 | atmost = jiffies + carrier_timeout * HZ; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 682 | while (!netif_carrier_ok(ndev)) { | 
|  | 683 | if (time_after(jiffies, atmost)) { | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 684 | np_notice(np, "timeout waiting for carrier\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 685 | break; | 
|  | 686 | } | 
| Anton Vorontsov | 1b614fb | 2009-07-08 20:09:44 -0700 | [diff] [blame] | 687 | msleep(1); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 688 | } | 
|  | 689 |  | 
|  | 690 | /* If carrier appears to come up instantly, we don't | 
|  | 691 | * trust it and pause so that we don't pump all our | 
|  | 692 | * queued console messages into the bitbucket. | 
|  | 693 | */ | 
|  | 694 |  | 
|  | 695 | if (time_before(jiffies, atleast)) { | 
| Joe Perches | e6ec26935 | 2012-01-29 15:50:43 +0000 | [diff] [blame] | 696 | np_notice(np, "carrier detect appears untrustworthy, waiting 4 seconds\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 697 | msleep(4000); | 
|  | 698 | } | 
| Cong Wang | f92d318 | 2013-01-14 23:34:06 +0000 | [diff] [blame] | 699 | rtnl_lock(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 700 | } | 
|  | 701 |  | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 702 | if (!np->local_ip.ip) { | 
|  | 703 | if (!np->ipv6) { | 
| Cong Wang | f92d318 | 2013-01-14 23:34:06 +0000 | [diff] [blame] | 704 | in_dev = __in_dev_get_rtnl(ndev); | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 705 |  | 
|  | 706 | if (!in_dev || !in_dev->ifa_list) { | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 707 | np_err(np, "no IP address for %s, aborting\n", | 
|  | 708 | np->dev_name); | 
|  | 709 | err = -EDESTADDRREQ; | 
|  | 710 | goto put; | 
|  | 711 | } | 
|  | 712 |  | 
|  | 713 | np->local_ip.ip = in_dev->ifa_list->ifa_local; | 
| Cong Wang | b7394d2 | 2013-01-07 20:52:39 +0000 | [diff] [blame] | 714 | np_info(np, "local IP %pI4\n", &np->local_ip.ip); | 
| Cong Wang | b3d936f | 2013-01-07 20:52:41 +0000 | [diff] [blame] | 715 | } else { | 
|  | 716 | #if IS_ENABLED(CONFIG_IPV6) | 
|  | 717 | struct inet6_dev *idev; | 
|  | 718 |  | 
|  | 719 | err = -EDESTADDRREQ; | 
| Cong Wang | b3d936f | 2013-01-07 20:52:41 +0000 | [diff] [blame] | 720 | idev = __in6_dev_get(ndev); | 
|  | 721 | if (idev) { | 
|  | 722 | struct inet6_ifaddr *ifp; | 
|  | 723 |  | 
|  | 724 | read_lock_bh(&idev->lock); | 
|  | 725 | list_for_each_entry(ifp, &idev->addr_list, if_list) { | 
|  | 726 | if (ipv6_addr_type(&ifp->addr) & IPV6_ADDR_LINKLOCAL) | 
|  | 727 | continue; | 
|  | 728 | np->local_ip.in6 = ifp->addr; | 
|  | 729 | err = 0; | 
|  | 730 | break; | 
|  | 731 | } | 
|  | 732 | read_unlock_bh(&idev->lock); | 
|  | 733 | } | 
| Cong Wang | b3d936f | 2013-01-07 20:52:41 +0000 | [diff] [blame] | 734 | if (err) { | 
|  | 735 | np_err(np, "no IPv6 address for %s, aborting\n", | 
|  | 736 | np->dev_name); | 
|  | 737 | goto put; | 
|  | 738 | } else | 
|  | 739 | np_info(np, "local IPv6 %pI6c\n", &np->local_ip.in6); | 
|  | 740 | #else | 
|  | 741 | np_err(np, "IPv6 is not supported %s, aborting\n", | 
|  | 742 | np->dev_name); | 
| Cong Wang | e39363a | 2013-01-22 17:39:11 +0000 | [diff] [blame] | 743 | err = -EINVAL; | 
| Cong Wang | b3d936f | 2013-01-07 20:52:41 +0000 | [diff] [blame] | 744 | goto put; | 
|  | 745 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 746 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 747 | } | 
|  | 748 |  | 
| Herbert Xu | dbaa154 | 2010-06-10 16:12:46 +0000 | [diff] [blame] | 749 | /* fill up the skb queue */ | 
|  | 750 | refill_skbs(); | 
|  | 751 |  | 
| Eric W. Biederman | a8779ec | 2014-03-27 15:36:38 -0700 | [diff] [blame^] | 752 | err = __netpoll_setup(np, ndev); | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 753 | if (err) | 
|  | 754 | goto put; | 
|  | 755 |  | 
| Cong Wang | f92d318 | 2013-01-14 23:34:06 +0000 | [diff] [blame] | 756 | rtnl_unlock(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 757 | return 0; | 
|  | 758 |  | 
| Jiri Slaby | 21edbb2 | 2010-03-16 05:29:54 +0000 | [diff] [blame] | 759 | put: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 760 | dev_put(ndev); | 
| Cong Wang | f92d318 | 2013-01-14 23:34:06 +0000 | [diff] [blame] | 761 | unlock: | 
|  | 762 | rtnl_unlock(); | 
| Stephen Hemminger | b41848b | 2006-10-26 15:46:52 -0700 | [diff] [blame] | 763 | return err; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 764 | } | 
| Eric Dumazet | 9e34a5b | 2010-07-09 21:22:04 +0000 | [diff] [blame] | 765 | EXPORT_SYMBOL(netpoll_setup); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 766 |  | 
| David S. Miller | c68b907 | 2006-11-14 20:40:49 -0800 | [diff] [blame] | 767 | static int __init netpoll_init(void) | 
|  | 768 | { | 
| Stephen Hemminger | a1bcfac | 2006-11-14 10:43:58 -0800 | [diff] [blame] | 769 | skb_queue_head_init(&skb_pool); | 
|  | 770 | return 0; | 
|  | 771 | } | 
|  | 772 | core_initcall(netpoll_init); | 
|  | 773 |  | 
| Amerigo Wang | 38e6bc1 | 2012-08-10 01:24:38 +0000 | [diff] [blame] | 774 | static void rcu_cleanup_netpoll_info(struct rcu_head *rcu_head) | 
|  | 775 | { | 
|  | 776 | struct netpoll_info *npinfo = | 
|  | 777 | container_of(rcu_head, struct netpoll_info, rcu); | 
|  | 778 |  | 
| Amerigo Wang | 38e6bc1 | 2012-08-10 01:24:38 +0000 | [diff] [blame] | 779 | skb_queue_purge(&npinfo->txq); | 
|  | 780 |  | 
|  | 781 | /* we can't call cancel_delayed_work_sync here, as we are in softirq */ | 
|  | 782 | cancel_delayed_work(&npinfo->tx_work); | 
|  | 783 |  | 
|  | 784 | /* clean after last, unfinished work */ | 
|  | 785 | __skb_queue_purge(&npinfo->txq); | 
|  | 786 | /* now cancel it again */ | 
|  | 787 | cancel_delayed_work(&npinfo->tx_work); | 
|  | 788 | kfree(npinfo); | 
|  | 789 | } | 
|  | 790 |  | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 791 | void __netpoll_cleanup(struct netpoll *np) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 792 | { | 
| Jeff Moyer | fbeec2e | 2005-06-22 22:05:59 -0700 | [diff] [blame] | 793 | struct netpoll_info *npinfo; | 
| Jeff Moyer | fbeec2e | 2005-06-22 22:05:59 -0700 | [diff] [blame] | 794 |  | 
| Neil Horman | 0790bbb | 2013-02-11 10:25:31 +0000 | [diff] [blame] | 795 | /* rtnl_dereference would be preferable here but | 
|  | 796 | * rcu_cleanup_netpoll path can put us in here safely without | 
|  | 797 | * holding the rtnl, so plain rcu_dereference it is | 
|  | 798 | */ | 
|  | 799 | npinfo = rtnl_dereference(np->dev->npinfo); | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 800 | if (!npinfo) | 
| Herbert Xu | dbaa154 | 2010-06-10 16:12:46 +0000 | [diff] [blame] | 801 | return; | 
| Stephen Hemminger | 93ec2c7 | 2006-10-26 15:46:50 -0700 | [diff] [blame] | 802 |  | 
| Neil Horman | ca99ca1 | 2013-02-05 08:05:43 +0000 | [diff] [blame] | 803 | synchronize_srcu(&netpoll_srcu); | 
|  | 804 |  | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 805 | if (atomic_dec_and_test(&npinfo->refcnt)) { | 
|  | 806 | const struct net_device_ops *ops; | 
|  | 807 |  | 
|  | 808 | ops = np->dev->netdev_ops; | 
|  | 809 | if (ops->ndo_netpoll_cleanup) | 
|  | 810 | ops->ndo_netpoll_cleanup(np->dev); | 
|  | 811 |  | 
| Monam Agarwal | fcb144b | 2014-03-24 00:42:46 +0530 | [diff] [blame] | 812 | RCU_INIT_POINTER(np->dev->npinfo, NULL); | 
| Amerigo Wang | 38e6bc1 | 2012-08-10 01:24:38 +0000 | [diff] [blame] | 813 | call_rcu_bh(&npinfo->rcu, rcu_cleanup_netpoll_info); | 
| Herbert Xu | dbaa154 | 2010-06-10 16:12:46 +0000 | [diff] [blame] | 814 | } | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 815 | } | 
|  | 816 | EXPORT_SYMBOL_GPL(__netpoll_cleanup); | 
|  | 817 |  | 
| Neil Horman | 2cde6ac | 2013-02-11 10:25:30 +0000 | [diff] [blame] | 818 | static void netpoll_async_cleanup(struct work_struct *work) | 
| Amerigo Wang | 38e6bc1 | 2012-08-10 01:24:38 +0000 | [diff] [blame] | 819 | { | 
| Neil Horman | 2cde6ac | 2013-02-11 10:25:30 +0000 | [diff] [blame] | 820 | struct netpoll *np = container_of(work, struct netpoll, cleanup_work); | 
| Amerigo Wang | 38e6bc1 | 2012-08-10 01:24:38 +0000 | [diff] [blame] | 821 |  | 
| Neil Horman | 2cde6ac | 2013-02-11 10:25:30 +0000 | [diff] [blame] | 822 | rtnl_lock(); | 
| Amerigo Wang | 38e6bc1 | 2012-08-10 01:24:38 +0000 | [diff] [blame] | 823 | __netpoll_cleanup(np); | 
| Neil Horman | 2cde6ac | 2013-02-11 10:25:30 +0000 | [diff] [blame] | 824 | rtnl_unlock(); | 
| Amerigo Wang | 38e6bc1 | 2012-08-10 01:24:38 +0000 | [diff] [blame] | 825 | kfree(np); | 
|  | 826 | } | 
|  | 827 |  | 
| Neil Horman | 2cde6ac | 2013-02-11 10:25:30 +0000 | [diff] [blame] | 828 | void __netpoll_free_async(struct netpoll *np) | 
| Amerigo Wang | 38e6bc1 | 2012-08-10 01:24:38 +0000 | [diff] [blame] | 829 | { | 
| Neil Horman | 2cde6ac | 2013-02-11 10:25:30 +0000 | [diff] [blame] | 830 | schedule_work(&np->cleanup_work); | 
| Amerigo Wang | 38e6bc1 | 2012-08-10 01:24:38 +0000 | [diff] [blame] | 831 | } | 
| Neil Horman | 2cde6ac | 2013-02-11 10:25:30 +0000 | [diff] [blame] | 832 | EXPORT_SYMBOL_GPL(__netpoll_free_async); | 
| Amerigo Wang | 38e6bc1 | 2012-08-10 01:24:38 +0000 | [diff] [blame] | 833 |  | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 834 | void netpoll_cleanup(struct netpoll *np) | 
|  | 835 | { | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 836 | rtnl_lock(); | 
| Nikolay Aleksandrov | d0fe8c88 | 2013-09-19 15:02:35 +0200 | [diff] [blame] | 837 | if (!np->dev) | 
|  | 838 | goto out; | 
| Herbert Xu | 8fdd95e | 2010-06-10 16:12:48 +0000 | [diff] [blame] | 839 | __netpoll_cleanup(np); | 
| Herbert Xu | dbaa154 | 2010-06-10 16:12:46 +0000 | [diff] [blame] | 840 | dev_put(np->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 841 | np->dev = NULL; | 
| Nikolay Aleksandrov | d0fe8c88 | 2013-09-19 15:02:35 +0200 | [diff] [blame] | 842 | out: | 
|  | 843 | rtnl_unlock(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 844 | } | 
| Eric Dumazet | 9e34a5b | 2010-07-09 21:22:04 +0000 | [diff] [blame] | 845 | EXPORT_SYMBOL(netpoll_cleanup); |