blob: 12dfc5fee58ebe855f857cdf16efabc8855a8652 [file] [log] [blame]
Rusty Russell48925e32009-09-24 09:59:20 -06001/* A network driver using virtio.
Rusty Russell296f96f2007-10-22 11:03:37 +10002 *
3 * Copyright 2007 Rusty Russell <rusty@rustcorp.com.au> IBM Corporation
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
Jeff Kirsheradf8d3f2013-12-06 06:28:47 -080016 * along with this program; if not, see <http://www.gnu.org/licenses/>.
Rusty Russell296f96f2007-10-22 11:03:37 +100017 */
18//#define DEBUG
19#include <linux/netdevice.h>
20#include <linux/etherdevice.h>
Herbert Xua9ea3fc2008-04-18 11:21:42 +080021#include <linux/ethtool.h>
Rusty Russell296f96f2007-10-22 11:03:37 +100022#include <linux/module.h>
23#include <linux/virtio.h>
24#include <linux/virtio_net.h>
John Fastabendf600b692016-12-15 12:13:24 -080025#include <linux/bpf.h>
Daniel Borkmanna67edbf2017-01-25 02:28:18 +010026#include <linux/bpf_trace.h>
Rusty Russell296f96f2007-10-22 11:03:37 +100027#include <linux/scatterlist.h>
Alex Williamsone918085a2009-01-25 18:06:26 -080028#include <linux/if_vlan.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090029#include <linux/slab.h>
Wanlong Gao8de4b2f2013-01-24 23:51:31 +000030#include <linux/cpu.h>
Michael Daltonab7db912014-01-16 22:23:27 -080031#include <linux/average.h>
Jason Wang186b3c92017-09-19 17:42:43 +080032#include <linux/filter.h>
Michael S. Tsirkind85b758f72017-03-09 02:21:21 +020033#include <net/route.h>
Jesper Dangaard Brouer754b8a22018-01-03 11:26:04 +010034#include <net/xdp.h>
Rusty Russell296f96f2007-10-22 11:03:37 +100035
Amerigo Wangd34710e2013-05-09 19:50:51 +000036static int napi_weight = NAPI_POLL_WEIGHT;
Dor Laor6c0cd7c2007-12-16 15:19:43 +020037module_param(napi_weight, int, 0444);
38
Willem de Bruijnb92f1e62017-04-24 13:49:27 -040039static bool csum = true, gso = true, napi_tx;
Rusty Russell34a48572008-02-04 23:50:02 -050040module_param(csum, bool, 0444);
41module_param(gso, bool, 0444);
Willem de Bruijnb92f1e62017-04-24 13:49:27 -040042module_param(napi_tx, bool, 0644);
Rusty Russell34a48572008-02-04 23:50:02 -050043
Rusty Russell296f96f2007-10-22 11:03:37 +100044/* FIXME: MTU in config. */
Michael Dalton5061de32013-11-14 10:41:04 -080045#define GOOD_PACKET_LEN (ETH_HLEN + VLAN_HLEN + ETH_DATA_LEN)
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -080046#define GOOD_COPY_LEN 128
Rusty Russell296f96f2007-10-22 11:03:37 +100047
Jason Wangf6b10202017-02-21 16:46:28 +080048#define VIRTNET_RX_PAD (NET_IP_ALIGN + NET_SKB_PAD)
49
John Fastabend2de2f7f2017-02-02 19:16:29 -080050/* Amount of XDP headroom to prepend to packets for use by xdp_adjust_head */
51#define VIRTIO_XDP_HEADROOM 256
52
Johannes Berg5377d7582015-08-19 09:48:40 +020053/* RX packet size EWMA. The average packet size is used to determine the packet
54 * buffer size when refilling RX rings. As the entire RX ring may be refilled
55 * at once, the weight is chosen so that the EWMA will be insensitive to short-
56 * term, transient changes in packet size.
Michael Daltonab7db912014-01-16 22:23:27 -080057 */
Johannes Bergeb1e0112017-02-15 09:49:26 +010058DECLARE_EWMA(pkt_len, 0, 64)
Michael Daltonab7db912014-01-16 22:23:27 -080059
Rick Jones66846042011-11-14 14:17:08 +000060#define VIRTNET_DRIVER_VERSION "1.0.0"
Alex Williamson2a41f712009-02-04 09:02:34 +000061
Colin Ian King7acd4322017-08-12 22:45:53 +010062static const unsigned long guest_offloads[] = {
63 VIRTIO_NET_F_GUEST_TSO4,
64 VIRTIO_NET_F_GUEST_TSO6,
65 VIRTIO_NET_F_GUEST_ECN,
66 VIRTIO_NET_F_GUEST_UFO
67};
Jason Wang3f935222017-07-19 16:54:49 +080068
stephen hemminger3fa2a1d2011-06-15 06:36:29 +000069struct virtnet_stats {
Eric Dumazet83a27052012-06-05 22:35:24 +000070 struct u64_stats_sync tx_syncp;
71 struct u64_stats_sync rx_syncp;
stephen hemminger3fa2a1d2011-06-15 06:36:29 +000072 u64 tx_bytes;
73 u64 tx_packets;
74
75 u64 rx_bytes;
76 u64 rx_packets;
77};
78
Jason Wange9d74172012-12-07 07:04:55 +000079/* Internal representation of a send virtqueue */
80struct send_queue {
81 /* Virtqueue associated with this send _queue */
82 struct virtqueue *vq;
83
84 /* TX: fragments + linear part + virtio header */
85 struct scatterlist sg[MAX_SKB_FRAGS + 2];
Jason Wang986a4f42012-12-07 07:04:56 +000086
87 /* Name of the send queue: output.$index */
88 char name[40];
Willem de Bruijnb92f1e62017-04-24 13:49:27 -040089
90 struct napi_struct napi;
Jason Wange9d74172012-12-07 07:04:55 +000091};
92
93/* Internal representation of a receive virtqueue */
94struct receive_queue {
95 /* Virtqueue associated with this receive_queue */
96 struct virtqueue *vq;
97
Rusty Russell296f96f2007-10-22 11:03:37 +100098 struct napi_struct napi;
99
John Fastabendf600b692016-12-15 12:13:24 -0800100 struct bpf_prog __rcu *xdp_prog;
101
Jason Wange9d74172012-12-07 07:04:55 +0000102 /* Chain pages by the private ptr. */
103 struct page *pages;
104
Michael Daltonab7db912014-01-16 22:23:27 -0800105 /* Average packet length for mergeable receive buffers. */
Johannes Berg5377d7582015-08-19 09:48:40 +0200106 struct ewma_pkt_len mrg_avg_pkt_len;
Michael Daltonab7db912014-01-16 22:23:27 -0800107
Michael Daltonfb518792014-01-16 22:23:26 -0800108 /* Page frag for packet buffer allocation. */
109 struct page_frag alloc_frag;
110
Jason Wange9d74172012-12-07 07:04:55 +0000111 /* RX: fragments + linear part + virtio header */
112 struct scatterlist sg[MAX_SKB_FRAGS + 2];
Jason Wang986a4f42012-12-07 07:04:56 +0000113
Michael S. Tsirkind85b758f72017-03-09 02:21:21 +0200114 /* Min single buffer size for mergeable buffers case. */
115 unsigned int min_buf_len;
116
Jason Wang986a4f42012-12-07 07:04:56 +0000117 /* Name of this receive queue: input.$index */
118 char name[40];
Jesper Dangaard Brouer754b8a22018-01-03 11:26:04 +0100119
120 struct xdp_rxq_info xdp_rxq;
Jason Wange9d74172012-12-07 07:04:55 +0000121};
122
123struct virtnet_info {
124 struct virtio_device *vdev;
125 struct virtqueue *cvq;
126 struct net_device *dev;
Jason Wang986a4f42012-12-07 07:04:56 +0000127 struct send_queue *sq;
128 struct receive_queue *rq;
Jason Wange9d74172012-12-07 07:04:55 +0000129 unsigned int status;
130
Jason Wang986a4f42012-12-07 07:04:56 +0000131 /* Max # of queue pairs supported by the device */
132 u16 max_queue_pairs;
133
134 /* # of queue pairs currently used by the driver */
135 u16 curr_queue_pairs;
136
John Fastabend672aafd2016-12-15 12:13:49 -0800137 /* # of XDP queue pairs currently used by the driver */
138 u16 xdp_queue_pairs;
139
Herbert Xu97402b92008-04-18 11:24:27 +0800140 /* I like... big packets and I cannot lie! */
141 bool big_packets;
142
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -0800143 /* Host will merge rx buffers for big packets (shake it! shake it!) */
144 bool mergeable_rx_bufs;
145
Jason Wang986a4f42012-12-07 07:04:56 +0000146 /* Has control virtqueue */
147 bool has_cvq;
148
Michael S. Tsirkine7428e92013-07-25 10:20:23 +0930149 /* Host can handle any s/g split between our header and packet data */
150 bool any_header_sg;
151
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300152 /* Packet virtio header size */
153 u8 hdr_len;
154
stephen hemminger3fa2a1d2011-06-15 06:36:29 +0000155 /* Active statistics */
156 struct virtnet_stats __percpu *stats;
157
Rusty Russell3161e452009-08-26 12:22:32 -0700158 /* Work struct for refilling if we run low on memory. */
159 struct delayed_work refill;
160
Jason Wang586d17c2012-04-11 20:43:52 +0000161 /* Work struct for config space updates */
162 struct work_struct config_work;
163
Jason Wang986a4f42012-12-07 07:04:56 +0000164 /* Does the affinity hint is set for virtqueues? */
165 bool affinity_hint_set;
Wanlong Gao47be2472013-01-24 23:51:29 +0000166
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +0200167 /* CPU hotplug instances for online & dead */
168 struct hlist_node node;
169 struct hlist_node node_dead;
Michael S. Tsirkin2ac46032015-11-15 15:11:00 +0200170
171 /* Control VQ buffers: protected by the rtnl lock */
172 struct virtio_net_ctrl_hdr ctrl_hdr;
173 virtio_net_ctrl_ack ctrl_status;
Andy Lutomirskia725ee32016-07-18 15:34:49 -0700174 struct virtio_net_ctrl_mq ctrl_mq;
Michael S. Tsirkin2ac46032015-11-15 15:11:00 +0200175 u8 ctrl_promisc;
176 u8 ctrl_allmulti;
Andy Lutomirskia725ee32016-07-18 15:34:49 -0700177 u16 ctrl_vid;
Jason Wang3f935222017-07-19 16:54:49 +0800178 u64 ctrl_offloads;
Nikolay Aleksandrov16032be2016-02-03 04:04:37 +0100179
180 /* Ethtool settings */
181 u8 duplex;
182 u32 speed;
Jason Wang3f935222017-07-19 16:54:49 +0800183
184 unsigned long guest_offloads;
Rusty Russell296f96f2007-10-22 11:03:37 +1000185};
186
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000187struct padded_vnet_hdr {
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300188 struct virtio_net_hdr_mrg_rxbuf hdr;
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000189 /*
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300190 * hdr is in a separate sg buffer, and data sg buffer shares same page
191 * with this header sg. This padding makes next sg 16 byte aligned
192 * after the header.
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000193 */
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300194 char padding[4];
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000195};
196
Jason Wang986a4f42012-12-07 07:04:56 +0000197/* Converting between virtqueue no. and kernel tx/rx queue no.
198 * 0:rx0 1:tx0 2:rx1 3:tx1 ... 2N:rxN 2N+1:txN 2N+2:cvq
199 */
200static int vq2txq(struct virtqueue *vq)
201{
Rusty Russell9d0ca6e2013-03-21 14:17:34 +0000202 return (vq->index - 1) / 2;
Jason Wang986a4f42012-12-07 07:04:56 +0000203}
204
205static int txq2vq(int txq)
206{
207 return txq * 2 + 1;
208}
209
210static int vq2rxq(struct virtqueue *vq)
211{
Rusty Russell9d0ca6e2013-03-21 14:17:34 +0000212 return vq->index / 2;
Jason Wang986a4f42012-12-07 07:04:56 +0000213}
214
215static int rxq2vq(int rxq)
216{
217 return rxq * 2;
218}
219
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300220static inline struct virtio_net_hdr_mrg_rxbuf *skb_vnet_hdr(struct sk_buff *skb)
Rusty Russell296f96f2007-10-22 11:03:37 +1000221{
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300222 return (struct virtio_net_hdr_mrg_rxbuf *)skb->cb;
Rusty Russell296f96f2007-10-22 11:03:37 +1000223}
224
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000225/*
226 * private is used to chain pages for big packets, put the whole
227 * most recent used list in the beginning for reuse
228 */
Jason Wange9d74172012-12-07 07:04:55 +0000229static void give_pages(struct receive_queue *rq, struct page *page)
Rusty Russellfb6813f2008-07-25 12:06:01 -0500230{
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000231 struct page *end;
232
Jason Wange9d74172012-12-07 07:04:55 +0000233 /* Find end of list, sew whole thing into vi->rq.pages. */
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000234 for (end = page; end->private; end = (struct page *)end->private);
Jason Wange9d74172012-12-07 07:04:55 +0000235 end->private = (unsigned long)rq->pages;
236 rq->pages = page;
Rusty Russellfb6813f2008-07-25 12:06:01 -0500237}
238
Jason Wange9d74172012-12-07 07:04:55 +0000239static struct page *get_a_page(struct receive_queue *rq, gfp_t gfp_mask)
Rusty Russellfb6813f2008-07-25 12:06:01 -0500240{
Jason Wange9d74172012-12-07 07:04:55 +0000241 struct page *p = rq->pages;
Rusty Russellfb6813f2008-07-25 12:06:01 -0500242
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000243 if (p) {
Jason Wange9d74172012-12-07 07:04:55 +0000244 rq->pages = (struct page *)p->private;
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000245 /* clear private here, it is used to chain pages */
246 p->private = 0;
247 } else
Rusty Russellfb6813f2008-07-25 12:06:01 -0500248 p = alloc_page(gfp_mask);
249 return p;
250}
251
Willem de Bruijne4e84522017-04-24 13:49:26 -0400252static void virtqueue_napi_schedule(struct napi_struct *napi,
253 struct virtqueue *vq)
254{
255 if (napi_schedule_prep(napi)) {
256 virtqueue_disable_cb(vq);
257 __napi_schedule(napi);
258 }
259}
260
261static void virtqueue_napi_complete(struct napi_struct *napi,
262 struct virtqueue *vq, int processed)
263{
264 int opaque;
265
266 opaque = virtqueue_enable_cb_prepare(vq);
Toshiaki Makitafdaa7672017-12-07 13:15:15 +0900267 if (napi_complete_done(napi, processed)) {
268 if (unlikely(virtqueue_poll(vq, opaque)))
269 virtqueue_napi_schedule(napi, vq);
270 } else {
271 virtqueue_disable_cb(vq);
272 }
Willem de Bruijne4e84522017-04-24 13:49:26 -0400273}
274
Jason Wange9d74172012-12-07 07:04:55 +0000275static void skb_xmit_done(struct virtqueue *vq)
Rusty Russell296f96f2007-10-22 11:03:37 +1000276{
Jason Wange9d74172012-12-07 07:04:55 +0000277 struct virtnet_info *vi = vq->vdev->priv;
Willem de Bruijnb92f1e62017-04-24 13:49:27 -0400278 struct napi_struct *napi = &vi->sq[vq2txq(vq)].napi;
Rusty Russell296f96f2007-10-22 11:03:37 +1000279
Rusty Russell2cb9c6b2008-02-04 23:50:07 -0500280 /* Suppress further interrupts. */
Jason Wange9d74172012-12-07 07:04:55 +0000281 virtqueue_disable_cb(vq);
Rusty Russell11a3a152008-05-26 17:48:13 +1000282
Willem de Bruijnb92f1e62017-04-24 13:49:27 -0400283 if (napi->weight)
284 virtqueue_napi_schedule(napi, vq);
285 else
286 /* We were probably waiting for more output buffers. */
287 netif_wake_subqueue(vi->dev, vq2txq(vq));
Rusty Russell296f96f2007-10-22 11:03:37 +1000288}
289
Jason Wang28b39bc2017-07-19 16:54:46 +0800290#define MRG_CTX_HEADER_SHIFT 22
291static void *mergeable_len_to_ctx(unsigned int truesize,
292 unsigned int headroom)
293{
294 return (void *)(unsigned long)((headroom << MRG_CTX_HEADER_SHIFT) | truesize);
295}
296
297static unsigned int mergeable_ctx_to_headroom(void *mrg_ctx)
298{
299 return (unsigned long)mrg_ctx >> MRG_CTX_HEADER_SHIFT;
300}
301
302static unsigned int mergeable_ctx_to_truesize(void *mrg_ctx)
303{
304 return (unsigned long)mrg_ctx & ((1 << MRG_CTX_HEADER_SHIFT) - 1);
305}
306
Mike Waychison34646452012-01-04 12:52:32 +0000307/* Called from bottom half context */
Michael S. Tsirkin946fa562014-10-24 00:12:10 +0300308static struct sk_buff *page_to_skb(struct virtnet_info *vi,
309 struct receive_queue *rq,
Michael Dalton2613af02013-10-28 15:44:18 -0700310 struct page *page, unsigned int offset,
311 unsigned int len, unsigned int truesize)
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000312{
313 struct sk_buff *skb;
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300314 struct virtio_net_hdr_mrg_rxbuf *hdr;
Michael Dalton2613af02013-10-28 15:44:18 -0700315 unsigned int copy, hdr_len, hdr_padded_len;
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000316 char *p;
317
Michael Dalton2613af02013-10-28 15:44:18 -0700318 p = page_address(page) + offset;
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000319
320 /* copy small packet so we can reuse these pages for small data */
Paolo Abenic67f5db2016-03-17 15:44:00 +0100321 skb = napi_alloc_skb(&rq->napi, GOOD_COPY_LEN);
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000322 if (unlikely(!skb))
323 return NULL;
324
325 hdr = skb_vnet_hdr(skb);
326
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300327 hdr_len = vi->hdr_len;
328 if (vi->mergeable_rx_bufs)
stephen hemmingera4a76502017-08-15 10:29:17 -0700329 hdr_padded_len = sizeof(*hdr);
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300330 else
Michael Dalton2613af02013-10-28 15:44:18 -0700331 hdr_padded_len = sizeof(struct padded_vnet_hdr);
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000332
333 memcpy(hdr, p, hdr_len);
334
335 len -= hdr_len;
Michael Dalton2613af02013-10-28 15:44:18 -0700336 offset += hdr_padded_len;
337 p += hdr_padded_len;
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000338
339 copy = len;
340 if (copy > skb_tailroom(skb))
341 copy = skb_tailroom(skb);
Johannes Berg59ae1d12017-06-16 14:29:20 +0200342 skb_put_data(skb, p, copy);
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000343
344 len -= copy;
345 offset += copy;
346
Michael Dalton2613af02013-10-28 15:44:18 -0700347 if (vi->mergeable_rx_bufs) {
348 if (len)
349 skb_add_rx_frag(skb, 0, page, offset, len, truesize);
350 else
351 put_page(page);
352 return skb;
353 }
354
Sasha Levine878d782011-09-28 04:40:54 +0000355 /*
356 * Verify that we can indeed put this data into a skb.
357 * This is here to handle cases when the device erroneously
358 * tries to receive more than is possible. This is usually
359 * the case of a broken device.
360 */
361 if (unlikely(len > MAX_SKB_FRAGS * PAGE_SIZE)) {
Amerigo Wangbe443892012-11-08 17:47:28 +0000362 net_dbg_ratelimited("%s: too much data\n", skb->dev->name);
Sasha Levine878d782011-09-28 04:40:54 +0000363 dev_kfree_skb(skb);
364 return NULL;
365 }
Michael Dalton2613af02013-10-28 15:44:18 -0700366 BUG_ON(offset >= PAGE_SIZE);
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000367 while (len) {
Michael Dalton2613af02013-10-28 15:44:18 -0700368 unsigned int frag_size = min((unsigned)PAGE_SIZE - offset, len);
369 skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, page, offset,
370 frag_size, truesize);
371 len -= frag_size;
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000372 page = (struct page *)page->private;
373 offset = 0;
374 }
375
376 if (page)
Jason Wange9d74172012-12-07 07:04:55 +0000377 give_pages(rq, page);
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000378
379 return skb;
380}
381
Jason Wang186b3c92017-09-19 17:42:43 +0800382static void virtnet_xdp_flush(struct net_device *dev)
383{
384 struct virtnet_info *vi = netdev_priv(dev);
385 struct send_queue *sq;
386 unsigned int qp;
387
388 qp = vi->curr_queue_pairs - vi->xdp_queue_pairs + smp_processor_id();
389 sq = &vi->sq[qp];
390
391 virtqueue_kick(sq->vq);
392}
393
394static bool __virtnet_xdp_xmit(struct virtnet_info *vi,
395 struct xdp_buff *xdp)
John Fastabend56434a02016-12-15 12:14:13 -0800396{
John Fastabend56434a02016-12-15 12:14:13 -0800397 struct virtio_net_hdr_mrg_rxbuf *hdr;
Jason Wangf6b10202017-02-21 16:46:28 +0800398 unsigned int len;
John Fastabend722d8282017-02-02 19:15:32 -0800399 struct send_queue *sq;
400 unsigned int qp;
John Fastabend56434a02016-12-15 12:14:13 -0800401 void *xdp_sent;
402 int err;
403
John Fastabend722d8282017-02-02 19:15:32 -0800404 qp = vi->curr_queue_pairs - vi->xdp_queue_pairs + smp_processor_id();
405 sq = &vi->sq[qp];
406
John Fastabend56434a02016-12-15 12:14:13 -0800407 /* Free up any pending old buffers before queueing new ones. */
408 while ((xdp_sent = virtqueue_get_buf(sq->vq, &len)) != NULL) {
Jason Wangf6b10202017-02-21 16:46:28 +0800409 struct page *sent_page = virt_to_head_page(xdp_sent);
Jason Wangbb91acc2016-12-23 22:37:32 +0800410
Jason Wangf6b10202017-02-21 16:46:28 +0800411 put_page(sent_page);
John Fastabend56434a02016-12-15 12:14:13 -0800412 }
413
Jason Wangf6b10202017-02-21 16:46:28 +0800414 xdp->data -= vi->hdr_len;
415 /* Zero header and leave csum up to XDP layers */
416 hdr = xdp->data;
417 memset(hdr, 0, vi->hdr_len);
John Fastabend56434a02016-12-15 12:14:13 -0800418
Jason Wangf6b10202017-02-21 16:46:28 +0800419 sg_init_one(sq->sg, xdp->data, xdp->data_end - xdp->data);
Jason Wangbb91acc2016-12-23 22:37:32 +0800420
Jason Wangf6b10202017-02-21 16:46:28 +0800421 err = virtqueue_add_outbuf(sq->vq, sq->sg, 1, xdp->data, GFP_ATOMIC);
John Fastabend56434a02016-12-15 12:14:13 -0800422 if (unlikely(err)) {
Jason Wangf6b10202017-02-21 16:46:28 +0800423 struct page *page = virt_to_head_page(xdp->data);
Jason Wangbb91acc2016-12-23 22:37:32 +0800424
Jason Wangf6b10202017-02-21 16:46:28 +0800425 put_page(page);
Daniel Borkmanna67edbf2017-01-25 02:28:18 +0100426 return false;
John Fastabend56434a02016-12-15 12:14:13 -0800427 }
428
Daniel Borkmanna67edbf2017-01-25 02:28:18 +0100429 return true;
John Fastabend56434a02016-12-15 12:14:13 -0800430}
431
Jason Wang186b3c92017-09-19 17:42:43 +0800432static int virtnet_xdp_xmit(struct net_device *dev, struct xdp_buff *xdp)
433{
434 struct virtnet_info *vi = netdev_priv(dev);
435 bool sent = __virtnet_xdp_xmit(vi, xdp);
436
437 if (!sent)
438 return -ENOSPC;
439 return 0;
440}
441
Jason Wangf6b10202017-02-21 16:46:28 +0800442static unsigned int virtnet_get_headroom(struct virtnet_info *vi)
443{
444 return vi->xdp_queue_pairs ? VIRTIO_XDP_HEADROOM : 0;
445}
446
Jason Wang4941d472017-07-19 16:54:48 +0800447/* We copy the packet for XDP in the following cases:
448 *
449 * 1) Packet is scattered across multiple rx buffers.
450 * 2) Headroom space is insufficient.
451 *
452 * This is inefficient but it's a temporary condition that
453 * we hit right after XDP is enabled and until queue is refilled
454 * with large buffers with sufficient headroom - so it should affect
455 * at most queue size packets.
456 * Afterwards, the conditions to enable
457 * XDP should preclude the underlying device from sending packets
458 * across multiple buffers (num_buf > 1), and we make sure buffers
459 * have enough headroom.
John Fastabend72979a62016-12-15 12:14:36 -0800460 */
461static struct page *xdp_linearize_page(struct receive_queue *rq,
Jason Wang56a86f82016-12-23 22:37:26 +0800462 u16 *num_buf,
John Fastabend72979a62016-12-15 12:14:36 -0800463 struct page *p,
464 int offset,
Jason Wang4941d472017-07-19 16:54:48 +0800465 int page_off,
John Fastabend72979a62016-12-15 12:14:36 -0800466 unsigned int *len)
467{
468 struct page *page = alloc_page(GFP_ATOMIC);
John Fastabend72979a62016-12-15 12:14:36 -0800469
470 if (!page)
471 return NULL;
472
473 memcpy(page_address(page) + page_off, page_address(p) + offset, *len);
474 page_off += *len;
475
Jason Wang56a86f82016-12-23 22:37:26 +0800476 while (--*num_buf) {
John Fastabend72979a62016-12-15 12:14:36 -0800477 unsigned int buflen;
John Fastabend72979a62016-12-15 12:14:36 -0800478 void *buf;
479 int off;
480
Michael S. Tsirkin680557c2017-03-06 21:29:47 +0200481 buf = virtqueue_get_buf(rq->vq, &buflen);
482 if (unlikely(!buf))
John Fastabend72979a62016-12-15 12:14:36 -0800483 goto err_buf;
484
John Fastabend72979a62016-12-15 12:14:36 -0800485 p = virt_to_head_page(buf);
486 off = buf - page_address(p);
487
Jason Wang56a86f82016-12-23 22:37:26 +0800488 /* guard against a misconfigured or uncooperative backend that
489 * is sending packet larger than the MTU.
490 */
491 if ((page_off + buflen) > PAGE_SIZE) {
492 put_page(p);
493 goto err_buf;
494 }
495
John Fastabend72979a62016-12-15 12:14:36 -0800496 memcpy(page_address(page) + page_off,
497 page_address(p) + off, buflen);
498 page_off += buflen;
Jason Wang56a86f82016-12-23 22:37:26 +0800499 put_page(p);
John Fastabend72979a62016-12-15 12:14:36 -0800500 }
501
John Fastabend2de2f7f2017-02-02 19:16:29 -0800502 /* Headroom does not contribute to packet length */
503 *len = page_off - VIRTIO_XDP_HEADROOM;
John Fastabend72979a62016-12-15 12:14:36 -0800504 return page;
505err_buf:
506 __free_pages(page, 0);
507 return NULL;
508}
509
Jason Wang4941d472017-07-19 16:54:48 +0800510static struct sk_buff *receive_small(struct net_device *dev,
511 struct virtnet_info *vi,
512 struct receive_queue *rq,
513 void *buf, void *ctx,
Jason Wang186b3c92017-09-19 17:42:43 +0800514 unsigned int len,
515 bool *xdp_xmit)
Jason Wang4941d472017-07-19 16:54:48 +0800516{
517 struct sk_buff *skb;
518 struct bpf_prog *xdp_prog;
519 unsigned int xdp_headroom = (unsigned long)ctx;
520 unsigned int header_offset = VIRTNET_RX_PAD + xdp_headroom;
521 unsigned int headroom = vi->hdr_len + header_offset;
522 unsigned int buflen = SKB_DATA_ALIGN(GOOD_PACKET_LEN + headroom) +
523 SKB_DATA_ALIGN(sizeof(struct skb_shared_info));
524 struct page *page = virt_to_head_page(buf);
Jason Wang186b3c92017-09-19 17:42:43 +0800525 unsigned int delta = 0, err;
Jason Wang4941d472017-07-19 16:54:48 +0800526 struct page *xdp_page;
527 len -= vi->hdr_len;
528
529 rcu_read_lock();
530 xdp_prog = rcu_dereference(rq->xdp_prog);
531 if (xdp_prog) {
532 struct virtio_net_hdr_mrg_rxbuf *hdr = buf + header_offset;
533 struct xdp_buff xdp;
534 void *orig_data;
535 u32 act;
536
537 if (unlikely(hdr->hdr.gso_type || hdr->hdr.flags))
538 goto err_xdp;
539
540 if (unlikely(xdp_headroom < virtnet_get_headroom(vi))) {
541 int offset = buf - page_address(page) + header_offset;
542 unsigned int tlen = len + vi->hdr_len;
543 u16 num_buf = 1;
544
545 xdp_headroom = virtnet_get_headroom(vi);
546 header_offset = VIRTNET_RX_PAD + xdp_headroom;
547 headroom = vi->hdr_len + header_offset;
548 buflen = SKB_DATA_ALIGN(GOOD_PACKET_LEN + headroom) +
549 SKB_DATA_ALIGN(sizeof(struct skb_shared_info));
550 xdp_page = xdp_linearize_page(rq, &num_buf, page,
551 offset, header_offset,
552 &tlen);
553 if (!xdp_page)
554 goto err_xdp;
555
556 buf = page_address(xdp_page);
557 put_page(page);
558 page = xdp_page;
559 }
560
561 xdp.data_hard_start = buf + VIRTNET_RX_PAD + vi->hdr_len;
562 xdp.data = xdp.data_hard_start + xdp_headroom;
Daniel Borkmannde8f3a82017-09-25 02:25:51 +0200563 xdp_set_data_meta_invalid(&xdp);
Jason Wang4941d472017-07-19 16:54:48 +0800564 xdp.data_end = xdp.data + len;
Jesper Dangaard Brouer754b8a22018-01-03 11:26:04 +0100565 xdp.rxq = &rq->xdp_rxq;
Jason Wang4941d472017-07-19 16:54:48 +0800566 orig_data = xdp.data;
567 act = bpf_prog_run_xdp(xdp_prog, &xdp);
568
569 switch (act) {
570 case XDP_PASS:
571 /* Recalculate length in case bpf program changed it */
572 delta = orig_data - xdp.data;
573 break;
574 case XDP_TX:
Jason Wang186b3c92017-09-19 17:42:43 +0800575 if (unlikely(!__virtnet_xdp_xmit(vi, &xdp)))
Jason Wang4941d472017-07-19 16:54:48 +0800576 trace_xdp_exception(vi->dev, xdp_prog, act);
Jason Wang186b3c92017-09-19 17:42:43 +0800577 else
578 *xdp_xmit = true;
579 rcu_read_unlock();
580 goto xdp_xmit;
581 case XDP_REDIRECT:
582 err = xdp_do_redirect(dev, &xdp, xdp_prog);
583 if (!err)
584 *xdp_xmit = true;
Jason Wang4941d472017-07-19 16:54:48 +0800585 rcu_read_unlock();
586 goto xdp_xmit;
587 default:
588 bpf_warn_invalid_xdp_action(act);
589 case XDP_ABORTED:
590 trace_xdp_exception(vi->dev, xdp_prog, act);
591 case XDP_DROP:
592 goto err_xdp;
593 }
594 }
595 rcu_read_unlock();
596
597 skb = build_skb(buf, buflen);
598 if (!skb) {
599 put_page(page);
600 goto err;
601 }
602 skb_reserve(skb, headroom - delta);
603 skb_put(skb, len + delta);
604 if (!delta) {
605 buf += header_offset;
606 memcpy(skb_vnet_hdr(skb), buf, vi->hdr_len);
607 } /* keep zeroed vnet hdr since packet was changed by bpf */
608
609err:
610 return skb;
611
612err_xdp:
613 rcu_read_unlock();
614 dev->stats.rx_dropped++;
615 put_page(page);
616xdp_xmit:
617 return NULL;
618}
619
620static struct sk_buff *receive_big(struct net_device *dev,
621 struct virtnet_info *vi,
622 struct receive_queue *rq,
623 void *buf,
624 unsigned int len)
625{
626 struct page *page = buf;
627 struct sk_buff *skb = page_to_skb(vi, rq, page, 0, len, PAGE_SIZE);
628
629 if (unlikely(!skb))
630 goto err;
631
632 return skb;
633
634err:
635 dev->stats.rx_dropped++;
636 give_pages(rq, page);
637 return NULL;
638}
639
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200640static struct sk_buff *receive_mergeable(struct net_device *dev,
Michael S. Tsirkinfdd819b2014-10-07 16:39:48 +0200641 struct virtnet_info *vi,
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200642 struct receive_queue *rq,
Michael S. Tsirkin680557c2017-03-06 21:29:47 +0200643 void *buf,
644 void *ctx,
Jason Wang186b3c92017-09-19 17:42:43 +0800645 unsigned int len,
646 bool *xdp_xmit)
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000647{
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300648 struct virtio_net_hdr_mrg_rxbuf *hdr = buf;
649 u16 num_buf = virtio16_to_cpu(vi->vdev, hdr->num_buffers);
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200650 struct page *page = virt_to_head_page(buf);
651 int offset = buf - page_address(page);
John Fastabendf600b692016-12-15 12:13:24 -0800652 struct sk_buff *head_skb, *curr_skb;
653 struct bpf_prog *xdp_prog;
654 unsigned int truesize;
Jason Wang4941d472017-07-19 16:54:48 +0800655 unsigned int headroom = mergeable_ctx_to_headroom(ctx);
Jason Wang186b3c92017-09-19 17:42:43 +0800656 int err;
Michael Daltonab7db912014-01-16 22:23:27 -0800657
John Fastabend56434a02016-12-15 12:14:13 -0800658 head_skb = NULL;
659
John Fastabendf600b692016-12-15 12:13:24 -0800660 rcu_read_lock();
661 xdp_prog = rcu_dereference(rq->xdp_prog);
662 if (xdp_prog) {
John Fastabend72979a62016-12-15 12:14:36 -0800663 struct page *xdp_page;
John Fastabend0354e4d2017-02-02 19:15:01 -0800664 struct xdp_buff xdp;
John Fastabend0354e4d2017-02-02 19:15:01 -0800665 void *data;
John Fastabendf600b692016-12-15 12:13:24 -0800666 u32 act;
667
Jason Wang73b62bd2016-12-23 22:37:24 +0800668 /* This happens when rx buffer size is underestimated */
Jason Wang4941d472017-07-19 16:54:48 +0800669 if (unlikely(num_buf > 1 ||
670 headroom < virtnet_get_headroom(vi))) {
John Fastabend72979a62016-12-15 12:14:36 -0800671 /* linearize data for XDP */
Jason Wang56a86f82016-12-23 22:37:26 +0800672 xdp_page = xdp_linearize_page(rq, &num_buf,
Jason Wang4941d472017-07-19 16:54:48 +0800673 page, offset,
674 VIRTIO_XDP_HEADROOM,
675 &len);
John Fastabend72979a62016-12-15 12:14:36 -0800676 if (!xdp_page)
677 goto err_xdp;
John Fastabend2de2f7f2017-02-02 19:16:29 -0800678 offset = VIRTIO_XDP_HEADROOM;
John Fastabend72979a62016-12-15 12:14:36 -0800679 } else {
680 xdp_page = page;
John Fastabendf600b692016-12-15 12:13:24 -0800681 }
682
683 /* Transient failure which in theory could occur if
684 * in-flight packets from before XDP was enabled reach
685 * the receive path after XDP is loaded. In practice I
686 * was not able to create this condition.
687 */
Jason Wangb00f70b2016-12-23 22:37:28 +0800688 if (unlikely(hdr->hdr.gso_type))
John Fastabendf600b692016-12-15 12:13:24 -0800689 goto err_xdp;
690
John Fastabend2de2f7f2017-02-02 19:16:29 -0800691 /* Allow consuming headroom but reserve enough space to push
692 * the descriptor on if we get an XDP_TX return code.
693 */
John Fastabend0354e4d2017-02-02 19:15:01 -0800694 data = page_address(xdp_page) + offset;
John Fastabend2de2f7f2017-02-02 19:16:29 -0800695 xdp.data_hard_start = data - VIRTIO_XDP_HEADROOM + vi->hdr_len;
John Fastabend0354e4d2017-02-02 19:15:01 -0800696 xdp.data = data + vi->hdr_len;
Daniel Borkmannde8f3a82017-09-25 02:25:51 +0200697 xdp_set_data_meta_invalid(&xdp);
John Fastabend0354e4d2017-02-02 19:15:01 -0800698 xdp.data_end = xdp.data + (len - vi->hdr_len);
Jesper Dangaard Brouer754b8a22018-01-03 11:26:04 +0100699 xdp.rxq = &rq->xdp_rxq;
700
John Fastabend0354e4d2017-02-02 19:15:01 -0800701 act = bpf_prog_run_xdp(xdp_prog, &xdp);
702
Jason Wang31240342017-09-19 17:42:42 +0800703 if (act != XDP_PASS)
704 ewma_pkt_len_add(&rq->mrg_avg_pkt_len, len);
705
John Fastabend56434a02016-12-15 12:14:13 -0800706 switch (act) {
707 case XDP_PASS:
John Fastabend2de2f7f2017-02-02 19:16:29 -0800708 /* recalculate offset to account for any header
709 * adjustments. Note other cases do not build an
710 * skb and avoid using offset
711 */
712 offset = xdp.data -
713 page_address(xdp_page) - vi->hdr_len;
714
Jason Wang1830f892016-12-23 22:37:27 +0800715 /* We can only create skb based on xdp_page. */
716 if (unlikely(xdp_page != page)) {
717 rcu_read_unlock();
718 put_page(page);
719 head_skb = page_to_skb(vi, rq, xdp_page,
John Fastabend2de2f7f2017-02-02 19:16:29 -0800720 offset, len, PAGE_SIZE);
Jason Wang1830f892016-12-23 22:37:27 +0800721 return head_skb;
722 }
John Fastabend56434a02016-12-15 12:14:13 -0800723 break;
724 case XDP_TX:
Jason Wang186b3c92017-09-19 17:42:43 +0800725 if (unlikely(!__virtnet_xdp_xmit(vi, &xdp)))
John Fastabend0354e4d2017-02-02 19:15:01 -0800726 trace_xdp_exception(vi->dev, xdp_prog, act);
Jason Wang186b3c92017-09-19 17:42:43 +0800727 else
728 *xdp_xmit = true;
John Fastabend72979a62016-12-15 12:14:36 -0800729 if (unlikely(xdp_page != page))
730 goto err_xdp;
John Fastabend56434a02016-12-15 12:14:13 -0800731 rcu_read_unlock();
732 goto xdp_xmit;
Jason Wang186b3c92017-09-19 17:42:43 +0800733 case XDP_REDIRECT:
734 err = xdp_do_redirect(dev, &xdp, xdp_prog);
Jason Wangdd543792017-09-22 14:38:58 +0800735 if (!err)
Jason Wang186b3c92017-09-19 17:42:43 +0800736 *xdp_xmit = true;
737 rcu_read_unlock();
738 goto xdp_xmit;
John Fastabend56434a02016-12-15 12:14:13 -0800739 default:
John Fastabend0354e4d2017-02-02 19:15:01 -0800740 bpf_warn_invalid_xdp_action(act);
741 case XDP_ABORTED:
742 trace_xdp_exception(vi->dev, xdp_prog, act);
743 case XDP_DROP:
John Fastabend72979a62016-12-15 12:14:36 -0800744 if (unlikely(xdp_page != page))
745 __free_pages(xdp_page, 0);
John Fastabendf600b692016-12-15 12:13:24 -0800746 goto err_xdp;
John Fastabend56434a02016-12-15 12:14:13 -0800747 }
John Fastabendf600b692016-12-15 12:13:24 -0800748 }
749 rcu_read_unlock();
750
Jason Wang28b39bc2017-07-19 16:54:46 +0800751 truesize = mergeable_ctx_to_truesize(ctx);
752 if (unlikely(len > truesize)) {
Dan Carpenter56da5fd2017-04-06 12:04:47 +0300753 pr_debug("%s: rx error: len %u exceeds truesize %lu\n",
Michael S. Tsirkin680557c2017-03-06 21:29:47 +0200754 dev->name, len, (unsigned long)ctx);
755 dev->stats.rx_length_errors++;
756 goto err_skb;
757 }
Jason Wang28b39bc2017-07-19 16:54:46 +0800758
John Fastabendf600b692016-12-15 12:13:24 -0800759 head_skb = page_to_skb(vi, rq, page, offset, len, truesize);
760 curr_skb = head_skb;
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000761
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200762 if (unlikely(!curr_skb))
763 goto err_skb;
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000764 while (--num_buf) {
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200765 int num_skb_frags;
766
Michael S. Tsirkin680557c2017-03-06 21:29:47 +0200767 buf = virtqueue_get_buf_ctx(rq->vq, &len, &ctx);
Yunjian Wang03e9f8a2017-12-04 14:02:19 +0800768 if (unlikely(!buf)) {
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200769 pr_debug("%s: rx error: %d buffers out of %d missing\n",
Michael S. Tsirkinfdd819b2014-10-07 16:39:48 +0200770 dev->name, num_buf,
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300771 virtio16_to_cpu(vi->vdev,
772 hdr->num_buffers));
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200773 dev->stats.rx_length_errors++;
774 goto err_buf;
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000775 }
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200776
777 page = virt_to_head_page(buf);
Jason Wang28b39bc2017-07-19 16:54:46 +0800778
779 truesize = mergeable_ctx_to_truesize(ctx);
780 if (unlikely(len > truesize)) {
Dan Carpenter56da5fd2017-04-06 12:04:47 +0300781 pr_debug("%s: rx error: len %u exceeds truesize %lu\n",
Michael S. Tsirkin680557c2017-03-06 21:29:47 +0200782 dev->name, len, (unsigned long)ctx);
783 dev->stats.rx_length_errors++;
784 goto err_skb;
785 }
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200786
787 num_skb_frags = skb_shinfo(curr_skb)->nr_frags;
Michael Dalton2613af02013-10-28 15:44:18 -0700788 if (unlikely(num_skb_frags == MAX_SKB_FRAGS)) {
789 struct sk_buff *nskb = alloc_skb(0, GFP_ATOMIC);
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200790
791 if (unlikely(!nskb))
792 goto err_skb;
Michael Dalton2613af02013-10-28 15:44:18 -0700793 if (curr_skb == head_skb)
794 skb_shinfo(curr_skb)->frag_list = nskb;
795 else
796 curr_skb->next = nskb;
797 curr_skb = nskb;
798 head_skb->truesize += nskb->truesize;
799 num_skb_frags = 0;
800 }
801 if (curr_skb != head_skb) {
802 head_skb->data_len += len;
803 head_skb->len += len;
Michael Daltonfb518792014-01-16 22:23:26 -0800804 head_skb->truesize += truesize;
Michael Dalton2613af02013-10-28 15:44:18 -0700805 }
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200806 offset = buf - page_address(page);
Jason Wangba275242013-11-01 14:07:48 +0800807 if (skb_can_coalesce(curr_skb, num_skb_frags, page, offset)) {
808 put_page(page);
809 skb_coalesce_rx_frag(curr_skb, num_skb_frags - 1,
Michael Daltonfb518792014-01-16 22:23:26 -0800810 len, truesize);
Jason Wangba275242013-11-01 14:07:48 +0800811 } else {
812 skb_add_rx_frag(curr_skb, num_skb_frags, page,
Michael Daltonfb518792014-01-16 22:23:26 -0800813 offset, len, truesize);
Jason Wangba275242013-11-01 14:07:48 +0800814 }
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200815 }
816
Johannes Berg5377d7582015-08-19 09:48:40 +0200817 ewma_pkt_len_add(&rq->mrg_avg_pkt_len, head_skb->len);
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200818 return head_skb;
819
John Fastabendf600b692016-12-15 12:13:24 -0800820err_xdp:
821 rcu_read_unlock();
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200822err_skb:
823 put_page(page);
824 while (--num_buf) {
Michael S. Tsirkin680557c2017-03-06 21:29:47 +0200825 buf = virtqueue_get_buf(rq->vq, &len);
826 if (unlikely(!buf)) {
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200827 pr_debug("%s: rx error: %d buffers missing\n",
828 dev->name, num_buf);
829 dev->stats.rx_length_errors++;
830 break;
831 }
Michael S. Tsirkin680557c2017-03-06 21:29:47 +0200832 page = virt_to_head_page(buf);
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200833 put_page(page);
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000834 }
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200835err_buf:
836 dev->stats.rx_dropped++;
837 dev_kfree_skb(head_skb);
John Fastabend56434a02016-12-15 12:14:13 -0800838xdp_xmit:
Michael S. Tsirkin8fc3b9e2013-11-28 13:30:55 +0200839 return NULL;
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000840}
841
Jason Wang61845d22017-02-17 11:33:09 +0800842static int receive_buf(struct virtnet_info *vi, struct receive_queue *rq,
Jason Wang186b3c92017-09-19 17:42:43 +0800843 void *buf, unsigned int len, void **ctx, bool *xdp_xmit)
Rusty Russell296f96f2007-10-22 11:03:37 +1000844{
Jason Wange9d74172012-12-07 07:04:55 +0000845 struct net_device *dev = vi->dev;
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000846 struct sk_buff *skb;
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300847 struct virtio_net_hdr_mrg_rxbuf *hdr;
Jason Wang61845d22017-02-17 11:33:09 +0800848 int ret;
Rusty Russell296f96f2007-10-22 11:03:37 +1000849
Michael S. Tsirkinbcff3162014-10-24 00:22:11 +0300850 if (unlikely(len < vi->hdr_len + ETH_HLEN)) {
Rusty Russell296f96f2007-10-22 11:03:37 +1000851 pr_debug("%s: short packet %i\n", dev->name, len);
852 dev->stats.rx_length_errors++;
Michael Daltonab7db912014-01-16 22:23:27 -0800853 if (vi->mergeable_rx_bufs) {
Michael S. Tsirkin680557c2017-03-06 21:29:47 +0200854 put_page(virt_to_head_page(buf));
Michael Daltonab7db912014-01-16 22:23:27 -0800855 } else if (vi->big_packets) {
Michael Dalton98bfd232013-12-05 13:14:05 -0800856 give_pages(rq, buf);
Michael Daltonab7db912014-01-16 22:23:27 -0800857 } else {
Jason Wangf6b10202017-02-21 16:46:28 +0800858 put_page(virt_to_head_page(buf));
Michael Daltonab7db912014-01-16 22:23:27 -0800859 }
Jason Wang61845d22017-02-17 11:33:09 +0800860 return 0;
Rusty Russell296f96f2007-10-22 11:03:37 +1000861 }
Rusty Russell296f96f2007-10-22 11:03:37 +1000862
Michael S. Tsirkinf1211592013-11-28 13:30:59 +0200863 if (vi->mergeable_rx_bufs)
Jason Wang186b3c92017-09-19 17:42:43 +0800864 skb = receive_mergeable(dev, vi, rq, buf, ctx, len, xdp_xmit);
Michael S. Tsirkinf1211592013-11-28 13:30:59 +0200865 else if (vi->big_packets)
Michael S. Tsirkin946fa562014-10-24 00:12:10 +0300866 skb = receive_big(dev, vi, rq, buf, len);
Michael S. Tsirkinf1211592013-11-28 13:30:59 +0200867 else
Jason Wang186b3c92017-09-19 17:42:43 +0800868 skb = receive_small(dev, vi, rq, buf, ctx, len, xdp_xmit);
Michael S. Tsirkinf1211592013-11-28 13:30:59 +0200869
870 if (unlikely(!skb))
Jason Wang61845d22017-02-17 11:33:09 +0800871 return 0;
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -0800872
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000873 hdr = skb_vnet_hdr(skb);
stephen hemminger3fa2a1d2011-06-15 06:36:29 +0000874
Jason Wang61845d22017-02-17 11:33:09 +0800875 ret = skb->len;
Rusty Russell296f96f2007-10-22 11:03:37 +1000876
Mike Rapoporte858fae2016-06-08 16:09:21 +0300877 if (hdr->hdr.flags & VIRTIO_NET_HDR_F_DATA_VALID)
Jason Wang10a8d942011-06-10 00:56:17 +0000878 skb->ip_summed = CHECKSUM_UNNECESSARY;
Rusty Russell296f96f2007-10-22 11:03:37 +1000879
Mike Rapoporte858fae2016-06-08 16:09:21 +0300880 if (virtio_net_hdr_to_skb(skb, &hdr->hdr,
881 virtio_is_little_endian(vi->vdev))) {
882 net_warn_ratelimited("%s: bad gso: type: %u, size: %u\n",
883 dev->name, hdr->hdr.gso_type,
884 hdr->hdr.gso_size);
885 goto frame_err;
Rusty Russell296f96f2007-10-22 11:03:37 +1000886 }
887
Mike Rapoportd1dc06d2016-06-14 08:29:38 +0300888 skb->protocol = eth_type_trans(skb, dev);
889 pr_debug("Receiving skb proto 0x%04x len %i type %i\n",
890 ntohs(skb->protocol), skb->len, skb->pkt_type);
891
Eric Dumazet0fbd0502015-07-31 18:25:17 +0200892 napi_gro_receive(&rq->napi, skb);
Jason Wang61845d22017-02-17 11:33:09 +0800893 return ret;
Rusty Russell296f96f2007-10-22 11:03:37 +1000894
895frame_err:
896 dev->stats.rx_frame_errors++;
Rusty Russell296f96f2007-10-22 11:03:37 +1000897 dev_kfree_skb(skb);
Jason Wang61845d22017-02-17 11:33:09 +0800898 return 0;
Rusty Russell296f96f2007-10-22 11:03:37 +1000899}
900
Jason Wang192f68c2017-07-19 16:54:47 +0800901/* Unlike mergeable buffers, all buffers are allocated to the
902 * same size, except for the headroom. For this reason we do
903 * not need to use mergeable_len_to_ctx here - it is enough
904 * to store the headroom as the context ignoring the truesize.
905 */
Michael S. Tsirkin946fa562014-10-24 00:12:10 +0300906static int add_recvbuf_small(struct virtnet_info *vi, struct receive_queue *rq,
907 gfp_t gfp)
Rusty Russell296f96f2007-10-22 11:03:37 +1000908{
Jason Wangf6b10202017-02-21 16:46:28 +0800909 struct page_frag *alloc_frag = &rq->alloc_frag;
910 char *buf;
John Fastabend2de2f7f2017-02-02 19:16:29 -0800911 unsigned int xdp_headroom = virtnet_get_headroom(vi);
Jason Wang192f68c2017-07-19 16:54:47 +0800912 void *ctx = (void *)(unsigned long)xdp_headroom;
Jason Wangf6b10202017-02-21 16:46:28 +0800913 int len = vi->hdr_len + VIRTNET_RX_PAD + GOOD_PACKET_LEN + xdp_headroom;
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000914 int err;
Rusty Russell296f96f2007-10-22 11:03:37 +1000915
Jason Wangf6b10202017-02-21 16:46:28 +0800916 len = SKB_DATA_ALIGN(len) +
917 SKB_DATA_ALIGN(sizeof(struct skb_shared_info));
918 if (unlikely(!skb_page_frag_refill(len, alloc_frag, gfp)))
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000919 return -ENOMEM;
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -0800920
Jason Wangf6b10202017-02-21 16:46:28 +0800921 buf = (char *)page_address(alloc_frag->page) + alloc_frag->offset;
922 get_page(alloc_frag->page);
923 alloc_frag->offset += len;
924 sg_init_one(rq->sg, buf + VIRTNET_RX_PAD + xdp_headroom,
925 vi->hdr_len + GOOD_PACKET_LEN);
Jason Wang192f68c2017-07-19 16:54:47 +0800926 err = virtqueue_add_inbuf_ctx(rq->vq, rq->sg, 1, buf, ctx, gfp);
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000927 if (err < 0)
Jason Wangf6b10202017-02-21 16:46:28 +0800928 put_page(virt_to_head_page(buf));
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000929 return err;
930}
931
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300932static int add_recvbuf_big(struct virtnet_info *vi, struct receive_queue *rq,
933 gfp_t gfp)
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000934{
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000935 struct page *first, *list = NULL;
936 char *p;
937 int i, err, offset;
938
Rusty Russella5835442014-09-11 10:17:36 +0930939 sg_init_table(rq->sg, MAX_SKB_FRAGS + 2);
940
Jason Wange9d74172012-12-07 07:04:55 +0000941 /* page in rq->sg[MAX_SKB_FRAGS + 1] is list tail */
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000942 for (i = MAX_SKB_FRAGS + 1; i > 1; --i) {
Jason Wange9d74172012-12-07 07:04:55 +0000943 first = get_a_page(rq, gfp);
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000944 if (!first) {
945 if (list)
Jason Wange9d74172012-12-07 07:04:55 +0000946 give_pages(rq, list);
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000947 return -ENOMEM;
Rusty Russell3161e452009-08-26 12:22:32 -0700948 }
Jason Wange9d74172012-12-07 07:04:55 +0000949 sg_set_buf(&rq->sg[i], page_address(first), PAGE_SIZE);
Rusty Russell296f96f2007-10-22 11:03:37 +1000950
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000951 /* chain new page in list head to match sg */
952 first->private = (unsigned long)list;
953 list = first;
954 }
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -0800955
Jason Wange9d74172012-12-07 07:04:55 +0000956 first = get_a_page(rq, gfp);
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000957 if (!first) {
Jason Wange9d74172012-12-07 07:04:55 +0000958 give_pages(rq, list);
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000959 return -ENOMEM;
960 }
961 p = page_address(first);
Herbert Xu97402b92008-04-18 11:24:27 +0800962
Jason Wange9d74172012-12-07 07:04:55 +0000963 /* rq->sg[0], rq->sg[1] share the same page */
Michael S. Tsirkin012873d2014-10-24 16:55:57 +0300964 /* a separated rq->sg[0] for header - required in case !any_header_sg */
965 sg_set_buf(&rq->sg[0], p, vi->hdr_len);
Herbert Xu97402b92008-04-18 11:24:27 +0800966
Jason Wange9d74172012-12-07 07:04:55 +0000967 /* rq->sg[1] for data packet, from offset */
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000968 offset = sizeof(struct padded_vnet_hdr);
Jason Wange9d74172012-12-07 07:04:55 +0000969 sg_set_buf(&rq->sg[1], p + offset, PAGE_SIZE - offset);
Herbert Xu97402b92008-04-18 11:24:27 +0800970
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000971 /* chain first in list head */
972 first->private = (unsigned long)list;
Rusty Russell9dc7b9e2013-03-20 15:44:28 +1030973 err = virtqueue_add_inbuf(rq->vq, rq->sg, MAX_SKB_FRAGS + 2,
974 first, gfp);
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000975 if (err < 0)
Jason Wange9d74172012-12-07 07:04:55 +0000976 give_pages(rq, first);
Herbert Xu97402b92008-04-18 11:24:27 +0800977
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000978 return err;
979}
Herbert Xu97402b92008-04-18 11:24:27 +0800980
Michael S. Tsirkind85b758f72017-03-09 02:21:21 +0200981static unsigned int get_mergeable_buf_len(struct receive_queue *rq,
982 struct ewma_pkt_len *avg_pkt_len)
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000983{
Michael Daltonab7db912014-01-16 22:23:27 -0800984 const size_t hdr_len = sizeof(struct virtio_net_hdr_mrg_rxbuf);
Michael Daltonfbf28d72014-01-16 22:23:30 -0800985 unsigned int len;
986
Johannes Berg5377d7582015-08-19 09:48:40 +0200987 len = hdr_len + clamp_t(unsigned int, ewma_pkt_len_read(avg_pkt_len),
Michael S. Tsirkinf0c31922017-06-02 17:54:33 +0300988 rq->min_buf_len, PAGE_SIZE - hdr_len);
Michael S. Tsirkine377fcc2017-03-06 22:21:35 +0200989 return ALIGN(len, L1_CACHE_BYTES);
Michael Daltonfbf28d72014-01-16 22:23:30 -0800990}
991
John Fastabend2de2f7f2017-02-02 19:16:29 -0800992static int add_recvbuf_mergeable(struct virtnet_info *vi,
993 struct receive_queue *rq, gfp_t gfp)
Michael Daltonfbf28d72014-01-16 22:23:30 -0800994{
Michael Daltonfb518792014-01-16 22:23:26 -0800995 struct page_frag *alloc_frag = &rq->alloc_frag;
John Fastabend2de2f7f2017-02-02 19:16:29 -0800996 unsigned int headroom = virtnet_get_headroom(vi);
Michael Daltonfb518792014-01-16 22:23:26 -0800997 char *buf;
Michael S. Tsirkin680557c2017-03-06 21:29:47 +0200998 void *ctx;
Shirley Ma9ab86bb2010-01-29 03:20:04 +0000999 int err;
Michael Daltonfb518792014-01-16 22:23:26 -08001000 unsigned int len, hole;
Rusty Russell296f96f2007-10-22 11:03:37 +10001001
Michael S. Tsirkind85b758f72017-03-09 02:21:21 +02001002 len = get_mergeable_buf_len(rq, &rq->mrg_avg_pkt_len);
John Fastabend2de2f7f2017-02-02 19:16:29 -08001003 if (unlikely(!skb_page_frag_refill(len + headroom, alloc_frag, gfp)))
Shirley Ma9ab86bb2010-01-29 03:20:04 +00001004 return -ENOMEM;
Michael Daltonab7db912014-01-16 22:23:27 -08001005
Michael Daltonfb518792014-01-16 22:23:26 -08001006 buf = (char *)page_address(alloc_frag->page) + alloc_frag->offset;
John Fastabend2de2f7f2017-02-02 19:16:29 -08001007 buf += headroom; /* advance address leaving hole at front of pkt */
Michael Daltonfb518792014-01-16 22:23:26 -08001008 get_page(alloc_frag->page);
John Fastabend2de2f7f2017-02-02 19:16:29 -08001009 alloc_frag->offset += len + headroom;
Michael Daltonfb518792014-01-16 22:23:26 -08001010 hole = alloc_frag->size - alloc_frag->offset;
John Fastabend2de2f7f2017-02-02 19:16:29 -08001011 if (hole < len + headroom) {
Michael Daltonab7db912014-01-16 22:23:27 -08001012 /* To avoid internal fragmentation, if there is very likely not
1013 * enough space for another buffer, add the remaining space to
Michael S. Tsirkin1daa8792017-07-31 21:49:49 +03001014 * the current buffer.
Michael Daltonab7db912014-01-16 22:23:27 -08001015 */
Michael Daltonfb518792014-01-16 22:23:26 -08001016 len += hole;
1017 alloc_frag->offset += hole;
1018 }
Shirley Ma9ab86bb2010-01-29 03:20:04 +00001019
Michael Daltonfb518792014-01-16 22:23:26 -08001020 sg_init_one(rq->sg, buf, len);
David S. Miller29fda252017-08-01 10:07:50 -07001021 ctx = mergeable_len_to_ctx(len, headroom);
Michael S. Tsirkin680557c2017-03-06 21:29:47 +02001022 err = virtqueue_add_inbuf_ctx(rq->vq, rq->sg, 1, buf, ctx, gfp);
Shirley Ma9ab86bb2010-01-29 03:20:04 +00001023 if (err < 0)
Michael Dalton2613af02013-10-28 15:44:18 -07001024 put_page(virt_to_head_page(buf));
Shirley Ma9ab86bb2010-01-29 03:20:04 +00001025
1026 return err;
Rusty Russell296f96f2007-10-22 11:03:37 +10001027}
1028
Rusty Russellb2baed62011-12-29 00:42:38 +00001029/*
1030 * Returns false if we couldn't fill entirely (OOM).
1031 *
1032 * Normally run in the receive path, but can also be run from ndo_open
1033 * before we're receiving packets, or from refill_work which is
1034 * careful to disable receiving (using napi_disable).
1035 */
Michael S. Tsirkin946fa562014-10-24 00:12:10 +03001036static bool try_fill_recv(struct virtnet_info *vi, struct receive_queue *rq,
1037 gfp_t gfp)
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -08001038{
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -08001039 int err;
Michael S. Tsirkin1788f4952010-07-02 16:32:55 +00001040 bool oom;
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -08001041
Amit Shah0aea51c2009-08-26 14:58:28 +05301042 do {
Shirley Ma9ab86bb2010-01-29 03:20:04 +00001043 if (vi->mergeable_rx_bufs)
John Fastabend2de2f7f2017-02-02 19:16:29 -08001044 err = add_recvbuf_mergeable(vi, rq, gfp);
Shirley Ma9ab86bb2010-01-29 03:20:04 +00001045 else if (vi->big_packets)
Michael S. Tsirkin012873d2014-10-24 16:55:57 +03001046 err = add_recvbuf_big(vi, rq, gfp);
Shirley Ma9ab86bb2010-01-29 03:20:04 +00001047 else
Michael S. Tsirkin946fa562014-10-24 00:12:10 +03001048 err = add_recvbuf_small(vi, rq, gfp);
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -08001049
Michael S. Tsirkin1788f4952010-07-02 16:32:55 +00001050 oom = err == -ENOMEM;
Rusty Russell9ed4cb02012-10-16 23:56:14 +10301051 if (err)
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -08001052 break;
Linus Torvaldsb7dfde92012-12-20 08:37:04 -08001053 } while (rq->vq->num_free);
Jason Wang681daee22014-03-26 13:03:00 +08001054 virtqueue_kick(rq->vq);
Rusty Russell3161e452009-08-26 12:22:32 -07001055 return !oom;
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -08001056}
1057
Rusty Russell18445c42008-02-04 23:49:57 -05001058static void skb_recv_done(struct virtqueue *rvq)
Rusty Russell296f96f2007-10-22 11:03:37 +10001059{
1060 struct virtnet_info *vi = rvq->vdev->priv;
Jason Wang986a4f42012-12-07 07:04:56 +00001061 struct receive_queue *rq = &vi->rq[vq2rxq(rvq)];
Jason Wange9d74172012-12-07 07:04:55 +00001062
Willem de Bruijne4e84522017-04-24 13:49:26 -04001063 virtqueue_napi_schedule(&rq->napi, rvq);
Rusty Russell296f96f2007-10-22 11:03:37 +10001064}
1065
Willem de Bruijne4e84522017-04-24 13:49:26 -04001066static void virtnet_napi_enable(struct virtqueue *vq, struct napi_struct *napi)
Bruce Rogers3e9d08e2011-02-10 11:03:31 -08001067{
Willem de Bruijne4e84522017-04-24 13:49:26 -04001068 napi_enable(napi);
Bruce Rogers3e9d08e2011-02-10 11:03:31 -08001069
1070 /* If all buffers were filled by other side before we napi_enabled, we
Willem de Bruijne4e84522017-04-24 13:49:26 -04001071 * won't get another interrupt, so process any outstanding packets now.
1072 * Call local_bh_enable after to trigger softIRQ processing.
1073 */
1074 local_bh_disable();
1075 virtqueue_napi_schedule(napi, vq);
1076 local_bh_enable();
Bruce Rogers3e9d08e2011-02-10 11:03:31 -08001077}
1078
Willem de Bruijnb92f1e62017-04-24 13:49:27 -04001079static void virtnet_napi_tx_enable(struct virtnet_info *vi,
1080 struct virtqueue *vq,
1081 struct napi_struct *napi)
1082{
1083 if (!napi->weight)
1084 return;
1085
1086 /* Tx napi touches cachelines on the cpu handling tx interrupts. Only
1087 * enable the feature if this is likely affine with the transmit path.
1088 */
1089 if (!vi->affinity_hint_set) {
1090 napi->weight = 0;
1091 return;
1092 }
1093
1094 return virtnet_napi_enable(vq, napi);
1095}
1096
Willem de Bruijn78a57b42017-04-25 15:59:17 -04001097static void virtnet_napi_tx_disable(struct napi_struct *napi)
1098{
1099 if (napi->weight)
1100 napi_disable(napi);
1101}
1102
Rusty Russell3161e452009-08-26 12:22:32 -07001103static void refill_work(struct work_struct *work)
1104{
Jason Wange9d74172012-12-07 07:04:55 +00001105 struct virtnet_info *vi =
1106 container_of(work, struct virtnet_info, refill.work);
Rusty Russell3161e452009-08-26 12:22:32 -07001107 bool still_empty;
Jason Wang986a4f42012-12-07 07:04:56 +00001108 int i;
Rusty Russell3161e452009-08-26 12:22:32 -07001109
Sasha Levin55257d72013-04-29 12:00:08 +09301110 for (i = 0; i < vi->curr_queue_pairs; i++) {
Jason Wang986a4f42012-12-07 07:04:56 +00001111 struct receive_queue *rq = &vi->rq[i];
Rusty Russell3161e452009-08-26 12:22:32 -07001112
Jason Wang986a4f42012-12-07 07:04:56 +00001113 napi_disable(&rq->napi);
Michael S. Tsirkin946fa562014-10-24 00:12:10 +03001114 still_empty = !try_fill_recv(vi, rq, GFP_KERNEL);
Willem de Bruijne4e84522017-04-24 13:49:26 -04001115 virtnet_napi_enable(rq->vq, &rq->napi);
Jason Wang986a4f42012-12-07 07:04:56 +00001116
1117 /* In theory, this can happen: if we don't get any buffers in
1118 * we will *never* try to fill again.
1119 */
1120 if (still_empty)
1121 schedule_delayed_work(&vi->refill, HZ/2);
1122 }
Rusty Russell3161e452009-08-26 12:22:32 -07001123}
1124
Jason Wang186b3c92017-09-19 17:42:43 +08001125static int virtnet_receive(struct receive_queue *rq, int budget, bool *xdp_xmit)
Rusty Russell296f96f2007-10-22 11:03:37 +10001126{
Jason Wange9d74172012-12-07 07:04:55 +00001127 struct virtnet_info *vi = rq->vq->vdev->priv;
Jason Wang61845d22017-02-17 11:33:09 +08001128 unsigned int len, received = 0, bytes = 0;
Shirley Ma9ab86bb2010-01-29 03:20:04 +00001129 void *buf;
Jason Wang61845d22017-02-17 11:33:09 +08001130 struct virtnet_stats *stats = this_cpu_ptr(vi->stats);
Rusty Russell296f96f2007-10-22 11:03:37 +10001131
Jason Wang192f68c2017-07-19 16:54:47 +08001132 if (!vi->big_packets || vi->mergeable_rx_bufs) {
Michael S. Tsirkin680557c2017-03-06 21:29:47 +02001133 void *ctx;
1134
1135 while (received < budget &&
1136 (buf = virtqueue_get_buf_ctx(rq->vq, &len, &ctx))) {
Jason Wang186b3c92017-09-19 17:42:43 +08001137 bytes += receive_buf(vi, rq, buf, len, ctx, xdp_xmit);
Michael S. Tsirkin680557c2017-03-06 21:29:47 +02001138 received++;
1139 }
1140 } else {
1141 while (received < budget &&
1142 (buf = virtqueue_get_buf(rq->vq, &len)) != NULL) {
Jason Wang186b3c92017-09-19 17:42:43 +08001143 bytes += receive_buf(vi, rq, buf, len, NULL, xdp_xmit);
Michael S. Tsirkin680557c2017-03-06 21:29:47 +02001144 received++;
1145 }
Rusty Russell296f96f2007-10-22 11:03:37 +10001146 }
1147
Jason Wangbe121f42014-01-16 14:45:24 +08001148 if (rq->vq->num_free > virtqueue_get_vring_size(rq->vq) / 2) {
Michael S. Tsirkin946fa562014-10-24 00:12:10 +03001149 if (!try_fill_recv(vi, rq, GFP_ATOMIC))
Tejun Heo3b07e9c2012-08-20 14:51:24 -07001150 schedule_delayed_work(&vi->refill, 0);
Rusty Russell3161e452009-08-26 12:22:32 -07001151 }
Rusty Russell296f96f2007-10-22 11:03:37 +10001152
Jason Wang61845d22017-02-17 11:33:09 +08001153 u64_stats_update_begin(&stats->rx_syncp);
1154 stats->rx_bytes += bytes;
1155 stats->rx_packets += received;
1156 u64_stats_update_end(&stats->rx_syncp);
1157
Jason Wang2ffa7592014-07-23 16:33:54 +08001158 return received;
1159}
1160
Willem de Bruijnea7735d2017-04-24 13:49:28 -04001161static void free_old_xmit_skbs(struct send_queue *sq)
1162{
1163 struct sk_buff *skb;
1164 unsigned int len;
1165 struct virtnet_info *vi = sq->vq->vdev->priv;
1166 struct virtnet_stats *stats = this_cpu_ptr(vi->stats);
1167 unsigned int packets = 0;
1168 unsigned int bytes = 0;
1169
1170 while ((skb = virtqueue_get_buf(sq->vq, &len)) != NULL) {
1171 pr_debug("Sent skb %p\n", skb);
1172
1173 bytes += skb->len;
1174 packets++;
1175
Eric Dumazetdadc0732017-08-24 09:02:49 -07001176 dev_consume_skb_any(skb);
Willem de Bruijnea7735d2017-04-24 13:49:28 -04001177 }
1178
1179 /* Avoid overhead when no packets have been processed
1180 * happens when called speculatively from start_xmit.
1181 */
1182 if (!packets)
1183 return;
1184
1185 u64_stats_update_begin(&stats->tx_syncp);
1186 stats->tx_bytes += bytes;
1187 stats->tx_packets += packets;
1188 u64_stats_update_end(&stats->tx_syncp);
1189}
1190
Willem de Bruijn7b0411e2017-04-24 13:49:29 -04001191static void virtnet_poll_cleantx(struct receive_queue *rq)
1192{
1193 struct virtnet_info *vi = rq->vq->vdev->priv;
1194 unsigned int index = vq2rxq(rq->vq);
1195 struct send_queue *sq = &vi->sq[index];
1196 struct netdev_queue *txq = netdev_get_tx_queue(vi->dev, index);
1197
1198 if (!sq->napi.weight)
1199 return;
1200
1201 if (__netif_tx_trylock(txq)) {
1202 free_old_xmit_skbs(sq);
1203 __netif_tx_unlock(txq);
1204 }
1205
1206 if (sq->vq->num_free >= 2 + MAX_SKB_FRAGS)
1207 netif_tx_wake_queue(txq);
1208}
1209
Jason Wang2ffa7592014-07-23 16:33:54 +08001210static int virtnet_poll(struct napi_struct *napi, int budget)
1211{
1212 struct receive_queue *rq =
1213 container_of(napi, struct receive_queue, napi);
Willem de Bruijne4e84522017-04-24 13:49:26 -04001214 unsigned int received;
Jason Wang186b3c92017-09-19 17:42:43 +08001215 bool xdp_xmit = false;
Jason Wang2ffa7592014-07-23 16:33:54 +08001216
Willem de Bruijn7b0411e2017-04-24 13:49:29 -04001217 virtnet_poll_cleantx(rq);
1218
Jason Wang186b3c92017-09-19 17:42:43 +08001219 received = virtnet_receive(rq, budget, &xdp_xmit);
Jason Wang2ffa7592014-07-23 16:33:54 +08001220
Rusty Russell8329d982007-11-19 11:20:43 -05001221 /* Out of packets? */
Willem de Bruijne4e84522017-04-24 13:49:26 -04001222 if (received < budget)
1223 virtqueue_napi_complete(napi, rq->vq, received);
Rusty Russell296f96f2007-10-22 11:03:37 +10001224
Jason Wang186b3c92017-09-19 17:42:43 +08001225 if (xdp_xmit)
1226 xdp_do_flush_map();
1227
Rusty Russell296f96f2007-10-22 11:03:37 +10001228 return received;
1229}
1230
Jason Wang986a4f42012-12-07 07:04:56 +00001231static int virtnet_open(struct net_device *dev)
1232{
1233 struct virtnet_info *vi = netdev_priv(dev);
Jesper Dangaard Brouer754b8a22018-01-03 11:26:04 +01001234 int i, err;
Jason Wang986a4f42012-12-07 07:04:56 +00001235
Jason Wange4166622013-05-21 20:03:58 +00001236 for (i = 0; i < vi->max_queue_pairs; i++) {
1237 if (i < vi->curr_queue_pairs)
1238 /* Make sure we have some buffers: if oom use wq. */
Michael S. Tsirkin946fa562014-10-24 00:12:10 +03001239 if (!try_fill_recv(vi, &vi->rq[i], GFP_KERNEL))
Jason Wange4166622013-05-21 20:03:58 +00001240 schedule_delayed_work(&vi->refill, 0);
Jesper Dangaard Brouer754b8a22018-01-03 11:26:04 +01001241
1242 err = xdp_rxq_info_reg(&vi->rq[i].xdp_rxq, dev, i);
1243 if (err < 0)
1244 return err;
1245
Willem de Bruijne4e84522017-04-24 13:49:26 -04001246 virtnet_napi_enable(vi->rq[i].vq, &vi->rq[i].napi);
Willem de Bruijnb92f1e62017-04-24 13:49:27 -04001247 virtnet_napi_tx_enable(vi, vi->sq[i].vq, &vi->sq[i].napi);
Jason Wang986a4f42012-12-07 07:04:56 +00001248 }
1249
1250 return 0;
1251}
1252
Willem de Bruijnb92f1e62017-04-24 13:49:27 -04001253static int virtnet_poll_tx(struct napi_struct *napi, int budget)
1254{
1255 struct send_queue *sq = container_of(napi, struct send_queue, napi);
1256 struct virtnet_info *vi = sq->vq->vdev->priv;
1257 struct netdev_queue *txq = netdev_get_tx_queue(vi->dev, vq2txq(sq->vq));
1258
1259 __netif_tx_lock(txq, raw_smp_processor_id());
1260 free_old_xmit_skbs(sq);
1261 __netif_tx_unlock(txq);
1262
1263 virtqueue_napi_complete(napi, sq->vq, 0);
1264
1265 if (sq->vq->num_free >= 2 + MAX_SKB_FRAGS)
1266 netif_tx_wake_queue(txq);
1267
1268 return 0;
1269}
1270
Jason Wange9d74172012-12-07 07:04:55 +00001271static int xmit_skb(struct send_queue *sq, struct sk_buff *skb)
Rusty Russell296f96f2007-10-22 11:03:37 +10001272{
Michael S. Tsirkin012873d2014-10-24 16:55:57 +03001273 struct virtio_net_hdr_mrg_rxbuf *hdr;
Rusty Russell296f96f2007-10-22 11:03:37 +10001274 const unsigned char *dest = ((struct ethhdr *)skb->data)->h_dest;
Jason Wange9d74172012-12-07 07:04:55 +00001275 struct virtnet_info *vi = sq->vq->vdev->priv;
Jason A. Donenfelde2fcad52017-06-04 04:16:26 +02001276 int num_sg;
Michael S. Tsirkin012873d2014-10-24 16:55:57 +03001277 unsigned hdr_len = vi->hdr_len;
Michael S. Tsirkine7428e92013-07-25 10:20:23 +09301278 bool can_push;
Rusty Russell296f96f2007-10-22 11:03:37 +10001279
Johannes Berge1749612008-10-27 15:59:26 -07001280 pr_debug("%s: xmit %p %pM\n", vi->dev->name, skb, dest);
Michael S. Tsirkine7428e92013-07-25 10:20:23 +09301281
1282 can_push = vi->any_header_sg &&
1283 !((unsigned long)skb->data & (__alignof__(*hdr) - 1)) &&
1284 !skb_header_cloned(skb) && skb_headroom(skb) >= hdr_len;
1285 /* Even if we can, don't push here yet as this would skew
1286 * csum_start offset below. */
1287 if (can_push)
Michael S. Tsirkin012873d2014-10-24 16:55:57 +03001288 hdr = (struct virtio_net_hdr_mrg_rxbuf *)(skb->data - hdr_len);
Michael S. Tsirkine7428e92013-07-25 10:20:23 +09301289 else
1290 hdr = skb_vnet_hdr(skb);
Rusty Russell296f96f2007-10-22 11:03:37 +10001291
Mike Rapoporte858fae2016-06-08 16:09:21 +03001292 if (virtio_net_hdr_from_skb(skb, &hdr->hdr,
Jason Wang6391a442017-01-20 14:32:42 +08001293 virtio_is_little_endian(vi->vdev), false))
Mike Rapoporte858fae2016-06-08 16:09:21 +03001294 BUG();
Rusty Russell296f96f2007-10-22 11:03:37 +10001295
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -08001296 if (vi->mergeable_rx_bufs)
Michael S. Tsirkin012873d2014-10-24 16:55:57 +03001297 hdr->num_buffers = 0;
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -08001298
Jason Wang547c8902015-08-27 14:53:06 +08001299 sg_init_table(sq->sg, skb_shinfo(skb)->nr_frags + (can_push ? 1 : 2));
Michael S. Tsirkine7428e92013-07-25 10:20:23 +09301300 if (can_push) {
1301 __skb_push(skb, hdr_len);
1302 num_sg = skb_to_sgvec(skb, sq->sg, 0, skb->len);
Jason A. Donenfelde2fcad52017-06-04 04:16:26 +02001303 if (unlikely(num_sg < 0))
1304 return num_sg;
Michael S. Tsirkine7428e92013-07-25 10:20:23 +09301305 /* Pull header back to avoid skew in tx bytes calculations. */
1306 __skb_pull(skb, hdr_len);
1307 } else {
1308 sg_set_buf(sq->sg, hdr, hdr_len);
Jason A. Donenfelde2fcad52017-06-04 04:16:26 +02001309 num_sg = skb_to_sgvec(skb, sq->sg + 1, 0, skb->len);
1310 if (unlikely(num_sg < 0))
1311 return num_sg;
1312 num_sg++;
Michael S. Tsirkine7428e92013-07-25 10:20:23 +09301313 }
Rusty Russell9dc7b9e2013-03-20 15:44:28 +10301314 return virtqueue_add_outbuf(sq->vq, sq->sg, num_sg, skb, GFP_ATOMIC);
Rusty Russell11a3a152008-05-26 17:48:13 +10001315}
1316
Stephen Hemminger424efe92009-08-31 19:50:51 +00001317static netdev_tx_t start_xmit(struct sk_buff *skb, struct net_device *dev)
Rusty Russell99ffc692008-05-02 21:50:46 -05001318{
1319 struct virtnet_info *vi = netdev_priv(dev);
Jason Wang986a4f42012-12-07 07:04:56 +00001320 int qnum = skb_get_queue_mapping(skb);
1321 struct send_queue *sq = &vi->sq[qnum];
Rusty Russell9ed4cb02012-10-16 23:56:14 +10301322 int err;
Michael S. Tsirkin4b7fd2e62014-10-15 16:23:28 +03001323 struct netdev_queue *txq = netdev_get_tx_queue(dev, qnum);
1324 bool kick = !skb->xmit_more;
Willem de Bruijnb92f1e62017-04-24 13:49:27 -04001325 bool use_napi = sq->napi.weight;
Rusty Russell2cb9c6b2008-02-04 23:50:07 -05001326
Rusty Russell2cb9c6b2008-02-04 23:50:07 -05001327 /* Free up any pending old buffers before queueing new ones. */
Jason Wange9d74172012-12-07 07:04:55 +00001328 free_old_xmit_skbs(sq);
Rusty Russell2cb9c6b2008-02-04 23:50:07 -05001329
Willem de Bruijnbdb12e02017-04-24 13:49:30 -04001330 if (use_napi && kick)
1331 virtqueue_enable_cb_delayed(sq->vq);
1332
Jacob Keller074c3582014-06-25 02:37:13 +00001333 /* timestamp packet in software */
1334 skb_tx_timestamp(skb);
1335
Michael S. Tsirkin03f191b2009-10-28 04:03:38 -07001336 /* Try to transmit */
Linus Torvaldsb7dfde92012-12-20 08:37:04 -08001337 err = xmit_skb(sq, skb);
Rusty Russell48925e32009-09-24 09:59:20 -06001338
Rusty Russell9ed4cb02012-10-16 23:56:14 +10301339 /* This should not happen! */
Jason Wang681daee22014-03-26 13:03:00 +08001340 if (unlikely(err)) {
Rusty Russell9ed4cb02012-10-16 23:56:14 +10301341 dev->stats.tx_fifo_errors++;
1342 if (net_ratelimit())
1343 dev_warn(&dev->dev,
Linus Torvaldsb7dfde92012-12-20 08:37:04 -08001344 "Unexpected TXQ (%d) queue failure: %d\n", qnum, err);
Rusty Russell58eba97d2010-07-02 16:34:01 +00001345 dev->stats.tx_dropped++;
Eric W. Biederman85e94522014-03-15 18:43:33 -07001346 dev_kfree_skb_any(skb);
Rusty Russell58eba97d2010-07-02 16:34:01 +00001347 return NETDEV_TX_OK;
Rusty Russell99ffc692008-05-02 21:50:46 -05001348 }
Michael S. Tsirkin03f191b2009-10-28 04:03:38 -07001349
Rusty Russell48925e32009-09-24 09:59:20 -06001350 /* Don't wait up for transmitted skbs to be freed. */
Willem de Bruijnb92f1e62017-04-24 13:49:27 -04001351 if (!use_napi) {
1352 skb_orphan(skb);
1353 nf_reset(skb);
1354 }
Rusty Russell99ffc692008-05-02 21:50:46 -05001355
Michael S. Tsirkin60302ff2015-04-02 13:05:47 +02001356 /* If running out of space, stop queue to avoid getting packets that we
1357 * are then unable to transmit.
1358 * An alternative would be to force queuing layer to requeue the skb by
1359 * returning NETDEV_TX_BUSY. However, NETDEV_TX_BUSY should not be
1360 * returned in a normal path of operation: it means that driver is not
1361 * maintaining the TX queue stop/start state properly, and causes
1362 * the stack to do a non-trivial amount of useless work.
1363 * Since most packets only take 1 or 2 ring slots, stopping the queue
1364 * early means 16 slots are typically wasted.
stephen hemmingerd631b942015-03-24 16:22:07 -07001365 */
Linus Torvaldsb7dfde92012-12-20 08:37:04 -08001366 if (sq->vq->num_free < 2+MAX_SKB_FRAGS) {
Jason Wang986a4f42012-12-07 07:04:56 +00001367 netif_stop_subqueue(dev, qnum);
Willem de Bruijnb92f1e62017-04-24 13:49:27 -04001368 if (!use_napi &&
1369 unlikely(!virtqueue_enable_cb_delayed(sq->vq))) {
Rusty Russell48925e32009-09-24 09:59:20 -06001370 /* More just got used, free them then recheck. */
Linus Torvaldsb7dfde92012-12-20 08:37:04 -08001371 free_old_xmit_skbs(sq);
1372 if (sq->vq->num_free >= 2+MAX_SKB_FRAGS) {
Jason Wang986a4f42012-12-07 07:04:56 +00001373 netif_start_subqueue(dev, qnum);
Jason Wange9d74172012-12-07 07:04:55 +00001374 virtqueue_disable_cb(sq->vq);
Rusty Russell48925e32009-09-24 09:59:20 -06001375 }
1376 }
Rusty Russell99ffc692008-05-02 21:50:46 -05001377 }
Rusty Russell48925e32009-09-24 09:59:20 -06001378
Michael S. Tsirkin4b7fd2e62014-10-15 16:23:28 +03001379 if (kick || netif_xmit_stopped(txq))
David S. Miller0b725a22014-08-25 15:51:53 -07001380 virtqueue_kick(sq->vq);
1381
Rusty Russell48925e32009-09-24 09:59:20 -06001382 return NETDEV_TX_OK;
Rusty Russell296f96f2007-10-22 11:03:37 +10001383}
1384
Amos Kong40cbfc32013-01-21 01:17:21 +00001385/*
1386 * Send command via the control virtqueue and check status. Commands
1387 * supported by the hypervisor, as indicated by feature bits, should
stephen hemminger788a8b62013-12-09 16:18:45 -08001388 * never fail unless improperly formatted.
Amos Kong40cbfc32013-01-21 01:17:21 +00001389 */
1390static bool virtnet_send_command(struct virtnet_info *vi, u8 class, u8 cmd,
stephen hemmingerd24bae32013-12-09 16:17:40 -08001391 struct scatterlist *out)
Amos Kong40cbfc32013-01-21 01:17:21 +00001392{
Rusty Russellf7bc9592013-03-20 15:44:28 +10301393 struct scatterlist *sgs[4], hdr, stat;
stephen hemmingerd24bae32013-12-09 16:17:40 -08001394 unsigned out_num = 0, tmp;
Amos Kong40cbfc32013-01-21 01:17:21 +00001395
1396 /* Caller should know better */
Rusty Russellf7bc9592013-03-20 15:44:28 +10301397 BUG_ON(!virtio_has_feature(vi->vdev, VIRTIO_NET_F_CTRL_VQ));
Amos Kong40cbfc32013-01-21 01:17:21 +00001398
Michael S. Tsirkin2ac46032015-11-15 15:11:00 +02001399 vi->ctrl_status = ~0;
1400 vi->ctrl_hdr.class = class;
1401 vi->ctrl_hdr.cmd = cmd;
Rusty Russellf7bc9592013-03-20 15:44:28 +10301402 /* Add header */
Michael S. Tsirkin2ac46032015-11-15 15:11:00 +02001403 sg_init_one(&hdr, &vi->ctrl_hdr, sizeof(vi->ctrl_hdr));
Rusty Russellf7bc9592013-03-20 15:44:28 +10301404 sgs[out_num++] = &hdr;
Amos Kong40cbfc32013-01-21 01:17:21 +00001405
Rusty Russellf7bc9592013-03-20 15:44:28 +10301406 if (out)
1407 sgs[out_num++] = out;
Amos Kong40cbfc32013-01-21 01:17:21 +00001408
Rusty Russellf7bc9592013-03-20 15:44:28 +10301409 /* Add return status. */
Michael S. Tsirkin2ac46032015-11-15 15:11:00 +02001410 sg_init_one(&stat, &vi->ctrl_status, sizeof(vi->ctrl_status));
stephen hemmingerd24bae32013-12-09 16:17:40 -08001411 sgs[out_num] = &stat;
Amos Kong40cbfc32013-01-21 01:17:21 +00001412
stephen hemmingerd24bae32013-12-09 16:17:40 -08001413 BUG_ON(out_num + 1 > ARRAY_SIZE(sgs));
Rusty Russella7c58142014-03-13 11:23:39 +10301414 virtqueue_add_sgs(vi->cvq, sgs, out_num, 1, vi, GFP_ATOMIC);
Amos Kong40cbfc32013-01-21 01:17:21 +00001415
Heinz Graalfs67975902013-10-29 09:40:02 +10301416 if (unlikely(!virtqueue_kick(vi->cvq)))
Michael S. Tsirkin2ac46032015-11-15 15:11:00 +02001417 return vi->ctrl_status == VIRTIO_NET_OK;
Amos Kong40cbfc32013-01-21 01:17:21 +00001418
1419 /* Spin for a response, the kick causes an ioport write, trapping
1420 * into the hypervisor, so the request should be handled immediately.
1421 */
Heinz Graalfs047b9b92013-10-29 09:40:47 +10301422 while (!virtqueue_get_buf(vi->cvq, &tmp) &&
1423 !virtqueue_is_broken(vi->cvq))
Amos Kong40cbfc32013-01-21 01:17:21 +00001424 cpu_relax();
1425
Michael S. Tsirkin2ac46032015-11-15 15:11:00 +02001426 return vi->ctrl_status == VIRTIO_NET_OK;
Amos Kong40cbfc32013-01-21 01:17:21 +00001427}
1428
Alex Williamson9c46f6d2009-02-04 16:36:34 -08001429static int virtnet_set_mac_address(struct net_device *dev, void *p)
1430{
1431 struct virtnet_info *vi = netdev_priv(dev);
1432 struct virtio_device *vdev = vi->vdev;
Jiri Pirkof2f2c8b2012-06-29 05:10:06 +00001433 int ret;
Andy Lutomirskie37e2ff2016-12-05 18:10:58 -08001434 struct sockaddr *addr;
Amos Kong7e58d5a2013-01-21 01:17:23 +00001435 struct scatterlist sg;
Alex Williamson9c46f6d2009-02-04 16:36:34 -08001436
Shyam Saini801822d2016-12-24 00:44:58 +05301437 addr = kmemdup(p, sizeof(*addr), GFP_KERNEL);
Andy Lutomirskie37e2ff2016-12-05 18:10:58 -08001438 if (!addr)
1439 return -ENOMEM;
Andy Lutomirskie37e2ff2016-12-05 18:10:58 -08001440
1441 ret = eth_prepare_mac_addr_change(dev, addr);
Jiri Pirkof2f2c8b2012-06-29 05:10:06 +00001442 if (ret)
Andy Lutomirskie37e2ff2016-12-05 18:10:58 -08001443 goto out;
Alex Williamson9c46f6d2009-02-04 16:36:34 -08001444
Amos Kong7e58d5a2013-01-21 01:17:23 +00001445 if (virtio_has_feature(vdev, VIRTIO_NET_F_CTRL_MAC_ADDR)) {
1446 sg_init_one(&sg, addr->sa_data, dev->addr_len);
1447 if (!virtnet_send_command(vi, VIRTIO_NET_CTRL_MAC,
stephen hemmingerd24bae32013-12-09 16:17:40 -08001448 VIRTIO_NET_CTRL_MAC_ADDR_SET, &sg)) {
Amos Kong7e58d5a2013-01-21 01:17:23 +00001449 dev_warn(&vdev->dev,
1450 "Failed to set mac address by vq command.\n");
Andy Lutomirskie37e2ff2016-12-05 18:10:58 -08001451 ret = -EINVAL;
1452 goto out;
Amos Kong7e58d5a2013-01-21 01:17:23 +00001453 }
Michael S. Tsirkin7e93a022014-11-26 15:58:28 +02001454 } else if (virtio_has_feature(vdev, VIRTIO_NET_F_MAC) &&
1455 !virtio_has_feature(vdev, VIRTIO_F_VERSION_1)) {
Rusty Russell855e0c52013-10-14 18:11:51 +10301456 unsigned int i;
1457
1458 /* Naturally, this has an atomicity problem. */
1459 for (i = 0; i < dev->addr_len; i++)
1460 virtio_cwrite8(vdev,
1461 offsetof(struct virtio_net_config, mac) +
1462 i, addr->sa_data[i]);
Amos Kong7e58d5a2013-01-21 01:17:23 +00001463 }
1464
1465 eth_commit_mac_addr_change(dev, p);
Andy Lutomirskie37e2ff2016-12-05 18:10:58 -08001466 ret = 0;
Alex Williamson9c46f6d2009-02-04 16:36:34 -08001467
Andy Lutomirskie37e2ff2016-12-05 18:10:58 -08001468out:
1469 kfree(addr);
1470 return ret;
Alex Williamson9c46f6d2009-02-04 16:36:34 -08001471}
1472
stephen hemmingerbc1f4472017-01-06 19:12:52 -08001473static void virtnet_stats(struct net_device *dev,
1474 struct rtnl_link_stats64 *tot)
stephen hemminger3fa2a1d2011-06-15 06:36:29 +00001475{
1476 struct virtnet_info *vi = netdev_priv(dev);
1477 int cpu;
1478 unsigned int start;
1479
1480 for_each_possible_cpu(cpu) {
Eric Dumazet58472a72012-02-13 06:53:41 +00001481 struct virtnet_stats *stats = per_cpu_ptr(vi->stats, cpu);
stephen hemminger3fa2a1d2011-06-15 06:36:29 +00001482 u64 tpackets, tbytes, rpackets, rbytes;
1483
1484 do {
Eric W. Biederman57a77442014-03-13 21:26:42 -07001485 start = u64_stats_fetch_begin_irq(&stats->tx_syncp);
stephen hemminger3fa2a1d2011-06-15 06:36:29 +00001486 tpackets = stats->tx_packets;
1487 tbytes = stats->tx_bytes;
Eric W. Biederman57a77442014-03-13 21:26:42 -07001488 } while (u64_stats_fetch_retry_irq(&stats->tx_syncp, start));
Eric Dumazet83a27052012-06-05 22:35:24 +00001489
1490 do {
Eric W. Biederman57a77442014-03-13 21:26:42 -07001491 start = u64_stats_fetch_begin_irq(&stats->rx_syncp);
stephen hemminger3fa2a1d2011-06-15 06:36:29 +00001492 rpackets = stats->rx_packets;
1493 rbytes = stats->rx_bytes;
Eric W. Biederman57a77442014-03-13 21:26:42 -07001494 } while (u64_stats_fetch_retry_irq(&stats->rx_syncp, start));
stephen hemminger3fa2a1d2011-06-15 06:36:29 +00001495
1496 tot->rx_packets += rpackets;
1497 tot->tx_packets += tpackets;
1498 tot->rx_bytes += rbytes;
1499 tot->tx_bytes += tbytes;
1500 }
1501
1502 tot->tx_dropped = dev->stats.tx_dropped;
Rick Jones021ac8d2011-11-21 09:28:17 +00001503 tot->tx_fifo_errors = dev->stats.tx_fifo_errors;
stephen hemminger3fa2a1d2011-06-15 06:36:29 +00001504 tot->rx_dropped = dev->stats.rx_dropped;
1505 tot->rx_length_errors = dev->stats.rx_length_errors;
1506 tot->rx_frame_errors = dev->stats.rx_frame_errors;
stephen hemminger3fa2a1d2011-06-15 06:36:29 +00001507}
1508
Amit Shahda74e892008-02-29 16:24:50 +05301509#ifdef CONFIG_NET_POLL_CONTROLLER
1510static void virtnet_netpoll(struct net_device *dev)
1511{
1512 struct virtnet_info *vi = netdev_priv(dev);
Jason Wang986a4f42012-12-07 07:04:56 +00001513 int i;
Amit Shahda74e892008-02-29 16:24:50 +05301514
Jason Wang986a4f42012-12-07 07:04:56 +00001515 for (i = 0; i < vi->curr_queue_pairs; i++)
1516 napi_schedule(&vi->rq[i].napi);
Amit Shahda74e892008-02-29 16:24:50 +05301517}
1518#endif
1519
Jason Wang586d17c2012-04-11 20:43:52 +00001520static void virtnet_ack_link_announce(struct virtnet_info *vi)
1521{
1522 rtnl_lock();
1523 if (!virtnet_send_command(vi, VIRTIO_NET_CTRL_ANNOUNCE,
stephen hemmingerd24bae32013-12-09 16:17:40 -08001524 VIRTIO_NET_CTRL_ANNOUNCE_ACK, NULL))
Jason Wang586d17c2012-04-11 20:43:52 +00001525 dev_warn(&vi->dev->dev, "Failed to ack link announce.\n");
1526 rtnl_unlock();
1527}
1528
John Fastabend473153292017-02-02 19:14:32 -08001529static int _virtnet_set_queues(struct virtnet_info *vi, u16 queue_pairs)
Jason Wang986a4f42012-12-07 07:04:56 +00001530{
1531 struct scatterlist sg;
Jason Wang986a4f42012-12-07 07:04:56 +00001532 struct net_device *dev = vi->dev;
1533
1534 if (!vi->has_cvq || !virtio_has_feature(vi->vdev, VIRTIO_NET_F_MQ))
1535 return 0;
1536
Andy Lutomirskia725ee32016-07-18 15:34:49 -07001537 vi->ctrl_mq.virtqueue_pairs = cpu_to_virtio16(vi->vdev, queue_pairs);
1538 sg_init_one(&sg, &vi->ctrl_mq, sizeof(vi->ctrl_mq));
Jason Wang986a4f42012-12-07 07:04:56 +00001539
1540 if (!virtnet_send_command(vi, VIRTIO_NET_CTRL_MQ,
stephen hemmingerd24bae32013-12-09 16:17:40 -08001541 VIRTIO_NET_CTRL_MQ_VQ_PAIRS_SET, &sg)) {
Jason Wang986a4f42012-12-07 07:04:56 +00001542 dev_warn(&dev->dev, "Fail to set num of queue pairs to %d\n",
1543 queue_pairs);
1544 return -EINVAL;
Sasha Levin55257d72013-04-29 12:00:08 +09301545 } else {
Jason Wang986a4f42012-12-07 07:04:56 +00001546 vi->curr_queue_pairs = queue_pairs;
Jason Wang35ed1592013-10-15 11:18:59 +08001547 /* virtnet_open() will refill when device is going to up. */
1548 if (dev->flags & IFF_UP)
1549 schedule_delayed_work(&vi->refill, 0);
Sasha Levin55257d72013-04-29 12:00:08 +09301550 }
Jason Wang986a4f42012-12-07 07:04:56 +00001551
1552 return 0;
1553}
1554
John Fastabend473153292017-02-02 19:14:32 -08001555static int virtnet_set_queues(struct virtnet_info *vi, u16 queue_pairs)
1556{
1557 int err;
1558
1559 rtnl_lock();
1560 err = _virtnet_set_queues(vi, queue_pairs);
1561 rtnl_unlock();
1562 return err;
1563}
1564
Rusty Russell296f96f2007-10-22 11:03:37 +10001565static int virtnet_close(struct net_device *dev)
1566{
1567 struct virtnet_info *vi = netdev_priv(dev);
Jason Wang986a4f42012-12-07 07:04:56 +00001568 int i;
Rusty Russell296f96f2007-10-22 11:03:37 +10001569
Rusty Russellb2baed62011-12-29 00:42:38 +00001570 /* Make sure refill_work doesn't re-enable napi! */
1571 cancel_delayed_work_sync(&vi->refill);
Jason Wang986a4f42012-12-07 07:04:56 +00001572
Willem de Bruijnb92f1e62017-04-24 13:49:27 -04001573 for (i = 0; i < vi->max_queue_pairs; i++) {
Jesper Dangaard Brouer754b8a22018-01-03 11:26:04 +01001574 xdp_rxq_info_unreg(&vi->rq[i].xdp_rxq);
Jason Wang986a4f42012-12-07 07:04:56 +00001575 napi_disable(&vi->rq[i].napi);
Willem de Bruijn78a57b42017-04-25 15:59:17 -04001576 virtnet_napi_tx_disable(&vi->sq[i].napi);
Willem de Bruijnb92f1e62017-04-24 13:49:27 -04001577 }
Rusty Russell296f96f2007-10-22 11:03:37 +10001578
Rusty Russell296f96f2007-10-22 11:03:37 +10001579 return 0;
1580}
1581
Alex Williamson2af76982009-02-04 09:02:40 +00001582static void virtnet_set_rx_mode(struct net_device *dev)
1583{
1584 struct virtnet_info *vi = netdev_priv(dev);
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001585 struct scatterlist sg[2];
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001586 struct virtio_net_ctrl_mac *mac_data;
Jiri Pirkoccffad252009-05-22 23:22:17 +00001587 struct netdev_hw_addr *ha;
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08001588 int uc_count;
Jiri Pirko4cd24ea2010-02-08 04:30:35 +00001589 int mc_count;
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001590 void *buf;
1591 int i;
Alex Williamson2af76982009-02-04 09:02:40 +00001592
stephen hemminger788a8b62013-12-09 16:18:45 -08001593 /* We can't dynamically set ndo_set_rx_mode, so return gracefully */
Alex Williamson2af76982009-02-04 09:02:40 +00001594 if (!virtio_has_feature(vi->vdev, VIRTIO_NET_F_CTRL_RX))
1595 return;
1596
Michael S. Tsirkin2ac46032015-11-15 15:11:00 +02001597 vi->ctrl_promisc = ((dev->flags & IFF_PROMISC) != 0);
1598 vi->ctrl_allmulti = ((dev->flags & IFF_ALLMULTI) != 0);
Alex Williamson2af76982009-02-04 09:02:40 +00001599
Michael S. Tsirkin2ac46032015-11-15 15:11:00 +02001600 sg_init_one(sg, &vi->ctrl_promisc, sizeof(vi->ctrl_promisc));
Alex Williamson2af76982009-02-04 09:02:40 +00001601
1602 if (!virtnet_send_command(vi, VIRTIO_NET_CTRL_RX,
stephen hemmingerd24bae32013-12-09 16:17:40 -08001603 VIRTIO_NET_CTRL_RX_PROMISC, sg))
Alex Williamson2af76982009-02-04 09:02:40 +00001604 dev_warn(&dev->dev, "Failed to %sable promisc mode.\n",
Michael S. Tsirkin2ac46032015-11-15 15:11:00 +02001605 vi->ctrl_promisc ? "en" : "dis");
Alex Williamson2af76982009-02-04 09:02:40 +00001606
Michael S. Tsirkin2ac46032015-11-15 15:11:00 +02001607 sg_init_one(sg, &vi->ctrl_allmulti, sizeof(vi->ctrl_allmulti));
Alex Williamson2af76982009-02-04 09:02:40 +00001608
1609 if (!virtnet_send_command(vi, VIRTIO_NET_CTRL_RX,
stephen hemmingerd24bae32013-12-09 16:17:40 -08001610 VIRTIO_NET_CTRL_RX_ALLMULTI, sg))
Alex Williamson2af76982009-02-04 09:02:40 +00001611 dev_warn(&dev->dev, "Failed to %sable allmulti mode.\n",
Michael S. Tsirkin2ac46032015-11-15 15:11:00 +02001612 vi->ctrl_allmulti ? "en" : "dis");
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001613
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08001614 uc_count = netdev_uc_count(dev);
Jiri Pirko4cd24ea2010-02-08 04:30:35 +00001615 mc_count = netdev_mc_count(dev);
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001616 /* MAC filter - use one buffer for both lists */
Jiri Pirko4cd24ea2010-02-08 04:30:35 +00001617 buf = kzalloc(((uc_count + mc_count) * ETH_ALEN) +
1618 (2 * sizeof(mac_data->entries)), GFP_ATOMIC);
1619 mac_data = buf;
Joe Perchese68ed8f2013-02-03 17:28:15 +00001620 if (!buf)
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001621 return;
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001622
Alex Williamson23e258e2009-05-01 17:27:56 +00001623 sg_init_table(sg, 2);
1624
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001625 /* Store the unicast list and count in the front of the buffer */
Michael S. Tsirkinfdd819b2014-10-07 16:39:48 +02001626 mac_data->entries = cpu_to_virtio32(vi->vdev, uc_count);
Jiri Pirkoccffad252009-05-22 23:22:17 +00001627 i = 0;
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08001628 netdev_for_each_uc_addr(ha, dev)
Jiri Pirkoccffad252009-05-22 23:22:17 +00001629 memcpy(&mac_data->macs[i++][0], ha->addr, ETH_ALEN);
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001630
1631 sg_set_buf(&sg[0], mac_data,
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08001632 sizeof(mac_data->entries) + (uc_count * ETH_ALEN));
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001633
1634 /* multicast list and count fill the end */
Jiri Pirko32e7bfc2010-01-25 13:36:10 -08001635 mac_data = (void *)&mac_data->macs[uc_count][0];
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001636
Michael S. Tsirkinfdd819b2014-10-07 16:39:48 +02001637 mac_data->entries = cpu_to_virtio32(vi->vdev, mc_count);
Jiri Pirko567ec872010-02-23 23:17:07 +00001638 i = 0;
Jiri Pirko22bedad32010-04-01 21:22:57 +00001639 netdev_for_each_mc_addr(ha, dev)
1640 memcpy(&mac_data->macs[i++][0], ha->addr, ETH_ALEN);
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001641
1642 sg_set_buf(&sg[1], mac_data,
Jiri Pirko4cd24ea2010-02-08 04:30:35 +00001643 sizeof(mac_data->entries) + (mc_count * ETH_ALEN));
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001644
1645 if (!virtnet_send_command(vi, VIRTIO_NET_CTRL_MAC,
stephen hemmingerd24bae32013-12-09 16:17:40 -08001646 VIRTIO_NET_CTRL_MAC_TABLE_SET, sg))
Thomas Huth99e872a2013-11-29 10:02:19 +01001647 dev_warn(&dev->dev, "Failed to set MAC filter table.\n");
Alex Williamsonf565a7c2009-02-04 09:02:45 +00001648
1649 kfree(buf);
Alex Williamson2af76982009-02-04 09:02:40 +00001650}
1651
Patrick McHardy80d5c362013-04-19 02:04:28 +00001652static int virtnet_vlan_rx_add_vid(struct net_device *dev,
1653 __be16 proto, u16 vid)
Alex Williamson0bde95692009-02-04 09:02:50 +00001654{
1655 struct virtnet_info *vi = netdev_priv(dev);
1656 struct scatterlist sg;
1657
Andy Lutomirskia725ee32016-07-18 15:34:49 -07001658 vi->ctrl_vid = vid;
1659 sg_init_one(&sg, &vi->ctrl_vid, sizeof(vi->ctrl_vid));
Alex Williamson0bde95692009-02-04 09:02:50 +00001660
1661 if (!virtnet_send_command(vi, VIRTIO_NET_CTRL_VLAN,
stephen hemmingerd24bae32013-12-09 16:17:40 -08001662 VIRTIO_NET_CTRL_VLAN_ADD, &sg))
Alex Williamson0bde95692009-02-04 09:02:50 +00001663 dev_warn(&dev->dev, "Failed to add VLAN ID %d.\n", vid);
Jiri Pirko8e586132011-12-08 19:52:37 -05001664 return 0;
Alex Williamson0bde95692009-02-04 09:02:50 +00001665}
1666
Patrick McHardy80d5c362013-04-19 02:04:28 +00001667static int virtnet_vlan_rx_kill_vid(struct net_device *dev,
1668 __be16 proto, u16 vid)
Alex Williamson0bde95692009-02-04 09:02:50 +00001669{
1670 struct virtnet_info *vi = netdev_priv(dev);
1671 struct scatterlist sg;
1672
Andy Lutomirskia725ee32016-07-18 15:34:49 -07001673 vi->ctrl_vid = vid;
1674 sg_init_one(&sg, &vi->ctrl_vid, sizeof(vi->ctrl_vid));
Alex Williamson0bde95692009-02-04 09:02:50 +00001675
1676 if (!virtnet_send_command(vi, VIRTIO_NET_CTRL_VLAN,
stephen hemmingerd24bae32013-12-09 16:17:40 -08001677 VIRTIO_NET_CTRL_VLAN_DEL, &sg))
Alex Williamson0bde95692009-02-04 09:02:50 +00001678 dev_warn(&dev->dev, "Failed to kill VLAN ID %d.\n", vid);
Jiri Pirko8e586132011-12-08 19:52:37 -05001679 return 0;
Alex Williamson0bde95692009-02-04 09:02:50 +00001680}
1681
Wanlong Gao8898c212013-01-24 23:51:30 +00001682static void virtnet_clean_affinity(struct virtnet_info *vi, long hcpu)
Jason Wang986a4f42012-12-07 07:04:56 +00001683{
1684 int i;
Wanlong Gao8898c212013-01-24 23:51:30 +00001685
1686 if (vi->affinity_hint_set) {
1687 for (i = 0; i < vi->max_queue_pairs; i++) {
1688 virtqueue_set_affinity(vi->rq[i].vq, -1);
1689 virtqueue_set_affinity(vi->sq[i].vq, -1);
1690 }
1691
1692 vi->affinity_hint_set = false;
1693 }
Wanlong Gao8898c212013-01-24 23:51:30 +00001694}
1695
1696static void virtnet_set_affinity(struct virtnet_info *vi)
Jason Wang986a4f42012-12-07 07:04:56 +00001697{
1698 int i;
Wanlong Gao47be2472013-01-24 23:51:29 +00001699 int cpu;
Jason Wang986a4f42012-12-07 07:04:56 +00001700
1701 /* In multiqueue mode, when the number of cpu is equal to the number of
1702 * queue pairs, we let the queue pairs to be private to one cpu by
1703 * setting the affinity hint to eliminate the contention.
1704 */
Wanlong Gao8898c212013-01-24 23:51:30 +00001705 if (vi->curr_queue_pairs == 1 ||
1706 vi->max_queue_pairs != num_online_cpus()) {
1707 virtnet_clean_affinity(vi, -1);
1708 return;
Jason Wang986a4f42012-12-07 07:04:56 +00001709 }
1710
Wanlong Gao8898c212013-01-24 23:51:30 +00001711 i = 0;
1712 for_each_online_cpu(cpu) {
Jason Wang986a4f42012-12-07 07:04:56 +00001713 virtqueue_set_affinity(vi->rq[i].vq, cpu);
1714 virtqueue_set_affinity(vi->sq[i].vq, cpu);
Jason Wang9bb8ca82013-11-05 18:19:45 +08001715 netif_set_xps_queue(vi->dev, cpumask_of(cpu), i);
Wanlong Gao8898c212013-01-24 23:51:30 +00001716 i++;
Jason Wang986a4f42012-12-07 07:04:56 +00001717 }
1718
Wanlong Gao8898c212013-01-24 23:51:30 +00001719 vi->affinity_hint_set = true;
Jason Wang986a4f42012-12-07 07:04:56 +00001720}
1721
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +02001722static int virtnet_cpu_online(unsigned int cpu, struct hlist_node *node)
Wanlong Gao8de4b2f2013-01-24 23:51:31 +00001723{
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +02001724 struct virtnet_info *vi = hlist_entry_safe(node, struct virtnet_info,
1725 node);
1726 virtnet_set_affinity(vi);
1727 return 0;
1728}
Wanlong Gao8de4b2f2013-01-24 23:51:31 +00001729
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +02001730static int virtnet_cpu_dead(unsigned int cpu, struct hlist_node *node)
1731{
1732 struct virtnet_info *vi = hlist_entry_safe(node, struct virtnet_info,
1733 node_dead);
1734 virtnet_set_affinity(vi);
1735 return 0;
1736}
Jason Wang3ab098d2013-10-15 11:18:58 +08001737
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +02001738static int virtnet_cpu_down_prep(unsigned int cpu, struct hlist_node *node)
1739{
1740 struct virtnet_info *vi = hlist_entry_safe(node, struct virtnet_info,
1741 node);
1742
1743 virtnet_clean_affinity(vi, cpu);
1744 return 0;
1745}
1746
1747static enum cpuhp_state virtionet_online;
1748
1749static int virtnet_cpu_notif_add(struct virtnet_info *vi)
1750{
1751 int ret;
1752
1753 ret = cpuhp_state_add_instance_nocalls(virtionet_online, &vi->node);
1754 if (ret)
1755 return ret;
1756 ret = cpuhp_state_add_instance_nocalls(CPUHP_VIRT_NET_DEAD,
1757 &vi->node_dead);
1758 if (!ret)
1759 return ret;
1760 cpuhp_state_remove_instance_nocalls(virtionet_online, &vi->node);
1761 return ret;
1762}
1763
1764static void virtnet_cpu_notif_remove(struct virtnet_info *vi)
1765{
1766 cpuhp_state_remove_instance_nocalls(virtionet_online, &vi->node);
1767 cpuhp_state_remove_instance_nocalls(CPUHP_VIRT_NET_DEAD,
1768 &vi->node_dead);
Herbert Xua9ea3fc2008-04-18 11:21:42 +08001769}
1770
Rick Jones8f9f4662011-10-19 08:10:59 +00001771static void virtnet_get_ringparam(struct net_device *dev,
1772 struct ethtool_ringparam *ring)
1773{
1774 struct virtnet_info *vi = netdev_priv(dev);
1775
Jason Wang986a4f42012-12-07 07:04:56 +00001776 ring->rx_max_pending = virtqueue_get_vring_size(vi->rq[0].vq);
1777 ring->tx_max_pending = virtqueue_get_vring_size(vi->sq[0].vq);
Rick Jones8f9f4662011-10-19 08:10:59 +00001778 ring->rx_pending = ring->rx_max_pending;
1779 ring->tx_pending = ring->tx_max_pending;
Rick Jones8f9f4662011-10-19 08:10:59 +00001780}
1781
Rick Jones66846042011-11-14 14:17:08 +00001782
1783static void virtnet_get_drvinfo(struct net_device *dev,
1784 struct ethtool_drvinfo *info)
1785{
1786 struct virtnet_info *vi = netdev_priv(dev);
1787 struct virtio_device *vdev = vi->vdev;
1788
1789 strlcpy(info->driver, KBUILD_MODNAME, sizeof(info->driver));
1790 strlcpy(info->version, VIRTNET_DRIVER_VERSION, sizeof(info->version));
1791 strlcpy(info->bus_info, virtio_bus_name(vdev), sizeof(info->bus_info));
1792
1793}
1794
Jason Wangd73bcd22012-12-07 07:04:57 +00001795/* TODO: Eliminate OOO packets during switching */
1796static int virtnet_set_channels(struct net_device *dev,
1797 struct ethtool_channels *channels)
1798{
1799 struct virtnet_info *vi = netdev_priv(dev);
1800 u16 queue_pairs = channels->combined_count;
1801 int err;
1802
1803 /* We don't support separate rx/tx channels.
1804 * We don't allow setting 'other' channels.
1805 */
1806 if (channels->rx_count || channels->tx_count || channels->other_count)
1807 return -EINVAL;
1808
Amos Kongc18e9cd2014-04-18 13:45:41 +08001809 if (queue_pairs > vi->max_queue_pairs || queue_pairs == 0)
Jason Wangd73bcd22012-12-07 07:04:57 +00001810 return -EINVAL;
1811
John Fastabendf600b692016-12-15 12:13:24 -08001812 /* For now we don't support modifying channels while XDP is loaded
1813 * also when XDP is loaded all RX queues have XDP programs so we only
1814 * need to check a single RX queue.
1815 */
1816 if (vi->rq[0].xdp_prog)
1817 return -EINVAL;
1818
Wanlong Gao47be2472013-01-24 23:51:29 +00001819 get_online_cpus();
John Fastabend473153292017-02-02 19:14:32 -08001820 err = _virtnet_set_queues(vi, queue_pairs);
Jason Wangd73bcd22012-12-07 07:04:57 +00001821 if (!err) {
1822 netif_set_real_num_tx_queues(dev, queue_pairs);
1823 netif_set_real_num_rx_queues(dev, queue_pairs);
1824
Wanlong Gao8898c212013-01-24 23:51:30 +00001825 virtnet_set_affinity(vi);
Jason Wangd73bcd22012-12-07 07:04:57 +00001826 }
Wanlong Gao47be2472013-01-24 23:51:29 +00001827 put_online_cpus();
Jason Wangd73bcd22012-12-07 07:04:57 +00001828
1829 return err;
1830}
1831
1832static void virtnet_get_channels(struct net_device *dev,
1833 struct ethtool_channels *channels)
1834{
1835 struct virtnet_info *vi = netdev_priv(dev);
1836
1837 channels->combined_count = vi->curr_queue_pairs;
1838 channels->max_combined = vi->max_queue_pairs;
1839 channels->max_other = 0;
1840 channels->rx_count = 0;
1841 channels->tx_count = 0;
1842 channels->other_count = 0;
1843}
1844
Nikolay Aleksandrov16032be2016-02-03 04:04:37 +01001845/* Check if the user is trying to change anything besides speed/duplex */
Philippe Reynesebb6b4b2017-03-21 23:24:24 +01001846static bool
1847virtnet_validate_ethtool_cmd(const struct ethtool_link_ksettings *cmd)
Nikolay Aleksandrov16032be2016-02-03 04:04:37 +01001848{
Philippe Reynesebb6b4b2017-03-21 23:24:24 +01001849 struct ethtool_link_ksettings diff1 = *cmd;
1850 struct ethtool_link_ksettings diff2 = {};
Nikolay Aleksandrov16032be2016-02-03 04:04:37 +01001851
Nikolay Aleksandrov0cf3ace2016-02-07 21:52:24 +01001852 /* cmd is always set so we need to clear it, validate the port type
1853 * and also without autonegotiation we can ignore advertising
1854 */
Philippe Reynesebb6b4b2017-03-21 23:24:24 +01001855 diff1.base.speed = 0;
1856 diff2.base.port = PORT_OTHER;
1857 ethtool_link_ksettings_zero_link_mode(&diff1, advertising);
1858 diff1.base.duplex = 0;
1859 diff1.base.cmd = 0;
1860 diff1.base.link_mode_masks_nwords = 0;
Nikolay Aleksandrov16032be2016-02-03 04:04:37 +01001861
Philippe Reynesebb6b4b2017-03-21 23:24:24 +01001862 return !memcmp(&diff1.base, &diff2.base, sizeof(diff1.base)) &&
1863 bitmap_empty(diff1.link_modes.supported,
1864 __ETHTOOL_LINK_MODE_MASK_NBITS) &&
1865 bitmap_empty(diff1.link_modes.advertising,
1866 __ETHTOOL_LINK_MODE_MASK_NBITS) &&
1867 bitmap_empty(diff1.link_modes.lp_advertising,
1868 __ETHTOOL_LINK_MODE_MASK_NBITS);
Nikolay Aleksandrov16032be2016-02-03 04:04:37 +01001869}
1870
Philippe Reynesebb6b4b2017-03-21 23:24:24 +01001871static int virtnet_set_link_ksettings(struct net_device *dev,
1872 const struct ethtool_link_ksettings *cmd)
Nikolay Aleksandrov16032be2016-02-03 04:04:37 +01001873{
1874 struct virtnet_info *vi = netdev_priv(dev);
1875 u32 speed;
1876
Philippe Reynesebb6b4b2017-03-21 23:24:24 +01001877 speed = cmd->base.speed;
Nikolay Aleksandrov16032be2016-02-03 04:04:37 +01001878 /* don't allow custom speed and duplex */
1879 if (!ethtool_validate_speed(speed) ||
Philippe Reynesebb6b4b2017-03-21 23:24:24 +01001880 !ethtool_validate_duplex(cmd->base.duplex) ||
Nikolay Aleksandrov16032be2016-02-03 04:04:37 +01001881 !virtnet_validate_ethtool_cmd(cmd))
1882 return -EINVAL;
1883 vi->speed = speed;
Philippe Reynesebb6b4b2017-03-21 23:24:24 +01001884 vi->duplex = cmd->base.duplex;
Nikolay Aleksandrov16032be2016-02-03 04:04:37 +01001885
1886 return 0;
1887}
1888
Philippe Reynesebb6b4b2017-03-21 23:24:24 +01001889static int virtnet_get_link_ksettings(struct net_device *dev,
1890 struct ethtool_link_ksettings *cmd)
Nikolay Aleksandrov16032be2016-02-03 04:04:37 +01001891{
1892 struct virtnet_info *vi = netdev_priv(dev);
1893
Philippe Reynesebb6b4b2017-03-21 23:24:24 +01001894 cmd->base.speed = vi->speed;
1895 cmd->base.duplex = vi->duplex;
1896 cmd->base.port = PORT_OTHER;
Nikolay Aleksandrov16032be2016-02-03 04:04:37 +01001897
1898 return 0;
1899}
1900
1901static void virtnet_init_settings(struct net_device *dev)
1902{
1903 struct virtnet_info *vi = netdev_priv(dev);
1904
1905 vi->speed = SPEED_UNKNOWN;
1906 vi->duplex = DUPLEX_UNKNOWN;
1907}
1908
Jason Baronfaa9b392018-01-05 17:44:54 -05001909static void virtnet_update_settings(struct virtnet_info *vi)
1910{
1911 u32 speed;
1912 u8 duplex;
1913
1914 if (!virtio_has_feature(vi->vdev, VIRTIO_NET_F_SPEED_DUPLEX))
1915 return;
1916
1917 speed = virtio_cread32(vi->vdev, offsetof(struct virtio_net_config,
1918 speed));
1919 if (ethtool_validate_speed(speed))
1920 vi->speed = speed;
1921 duplex = virtio_cread8(vi->vdev, offsetof(struct virtio_net_config,
1922 duplex));
1923 if (ethtool_validate_duplex(duplex))
1924 vi->duplex = duplex;
1925}
1926
Stephen Hemminger0fc0b732009-09-02 01:03:33 -07001927static const struct ethtool_ops virtnet_ethtool_ops = {
Rick Jones66846042011-11-14 14:17:08 +00001928 .get_drvinfo = virtnet_get_drvinfo,
Mark McLoughlin9f4d26d2009-01-19 17:09:49 -08001929 .get_link = ethtool_op_get_link,
Rick Jones8f9f4662011-10-19 08:10:59 +00001930 .get_ringparam = virtnet_get_ringparam,
Jason Wangd73bcd22012-12-07 07:04:57 +00001931 .set_channels = virtnet_set_channels,
1932 .get_channels = virtnet_get_channels,
Jacob Keller074c3582014-06-25 02:37:13 +00001933 .get_ts_info = ethtool_op_get_ts_info,
Philippe Reynesebb6b4b2017-03-21 23:24:24 +01001934 .get_link_ksettings = virtnet_get_link_ksettings,
1935 .set_link_ksettings = virtnet_set_link_ksettings,
Herbert Xua9ea3fc2008-04-18 11:21:42 +08001936};
1937
John Fastabend9fe7bfc2017-02-02 19:16:01 -08001938static void virtnet_freeze_down(struct virtio_device *vdev)
1939{
1940 struct virtnet_info *vi = vdev->priv;
1941 int i;
1942
1943 /* Make sure no work handler is accessing the device */
1944 flush_work(&vi->config_work);
1945
1946 netif_device_detach(vi->dev);
Jason Wang713a98d2017-06-28 09:51:03 +08001947 netif_tx_disable(vi->dev);
John Fastabend9fe7bfc2017-02-02 19:16:01 -08001948 cancel_delayed_work_sync(&vi->refill);
1949
1950 if (netif_running(vi->dev)) {
Willem de Bruijnb92f1e62017-04-24 13:49:27 -04001951 for (i = 0; i < vi->max_queue_pairs; i++) {
John Fastabend9fe7bfc2017-02-02 19:16:01 -08001952 napi_disable(&vi->rq[i].napi);
Willem de Bruijn78a57b42017-04-25 15:59:17 -04001953 virtnet_napi_tx_disable(&vi->sq[i].napi);
Willem de Bruijnb92f1e62017-04-24 13:49:27 -04001954 }
John Fastabend9fe7bfc2017-02-02 19:16:01 -08001955 }
1956}
1957
1958static int init_vqs(struct virtnet_info *vi);
1959
1960static int virtnet_restore_up(struct virtio_device *vdev)
1961{
1962 struct virtnet_info *vi = vdev->priv;
1963 int err, i;
1964
1965 err = init_vqs(vi);
1966 if (err)
1967 return err;
1968
1969 virtio_device_ready(vdev);
1970
1971 if (netif_running(vi->dev)) {
1972 for (i = 0; i < vi->curr_queue_pairs; i++)
1973 if (!try_fill_recv(vi, &vi->rq[i], GFP_KERNEL))
1974 schedule_delayed_work(&vi->refill, 0);
1975
Willem de Bruijnb92f1e62017-04-24 13:49:27 -04001976 for (i = 0; i < vi->max_queue_pairs; i++) {
Willem de Bruijne4e84522017-04-24 13:49:26 -04001977 virtnet_napi_enable(vi->rq[i].vq, &vi->rq[i].napi);
Willem de Bruijnb92f1e62017-04-24 13:49:27 -04001978 virtnet_napi_tx_enable(vi, vi->sq[i].vq,
1979 &vi->sq[i].napi);
1980 }
John Fastabend9fe7bfc2017-02-02 19:16:01 -08001981 }
1982
1983 netif_device_attach(vi->dev);
1984 return err;
1985}
1986
Jason Wang3f935222017-07-19 16:54:49 +08001987static int virtnet_set_guest_offloads(struct virtnet_info *vi, u64 offloads)
1988{
1989 struct scatterlist sg;
1990 vi->ctrl_offloads = cpu_to_virtio64(vi->vdev, offloads);
1991
1992 sg_init_one(&sg, &vi->ctrl_offloads, sizeof(vi->ctrl_offloads));
1993
1994 if (!virtnet_send_command(vi, VIRTIO_NET_CTRL_GUEST_OFFLOADS,
1995 VIRTIO_NET_CTRL_GUEST_OFFLOADS_SET, &sg)) {
1996 dev_warn(&vi->dev->dev, "Fail to set guest offload. \n");
1997 return -EINVAL;
1998 }
1999
2000 return 0;
2001}
2002
2003static int virtnet_clear_guest_offloads(struct virtnet_info *vi)
2004{
2005 u64 offloads = 0;
2006
2007 if (!vi->guest_offloads)
2008 return 0;
2009
2010 if (virtio_has_feature(vi->vdev, VIRTIO_NET_F_GUEST_CSUM))
2011 offloads = 1ULL << VIRTIO_NET_F_GUEST_CSUM;
2012
2013 return virtnet_set_guest_offloads(vi, offloads);
2014}
2015
2016static int virtnet_restore_guest_offloads(struct virtnet_info *vi)
2017{
2018 u64 offloads = vi->guest_offloads;
2019
2020 if (!vi->guest_offloads)
2021 return 0;
2022 if (virtio_has_feature(vi->vdev, VIRTIO_NET_F_GUEST_CSUM))
2023 offloads |= 1ULL << VIRTIO_NET_F_GUEST_CSUM;
2024
2025 return virtnet_set_guest_offloads(vi, offloads);
2026}
2027
Jakub Kicinski9861ce02017-04-30 21:46:48 -07002028static int virtnet_xdp_set(struct net_device *dev, struct bpf_prog *prog,
2029 struct netlink_ext_ack *extack)
John Fastabendf600b692016-12-15 12:13:24 -08002030{
2031 unsigned long int max_sz = PAGE_SIZE - sizeof(struct padded_vnet_hdr);
2032 struct virtnet_info *vi = netdev_priv(dev);
2033 struct bpf_prog *old_prog;
Jason Wang017b29c2017-02-20 11:50:20 +08002034 u16 xdp_qp = 0, curr_qp;
John Fastabend672aafd2016-12-15 12:13:49 -08002035 int i, err;
John Fastabendf600b692016-12-15 12:13:24 -08002036
Jason Wang3f935222017-07-19 16:54:49 +08002037 if (!virtio_has_feature(vi->vdev, VIRTIO_NET_F_CTRL_GUEST_OFFLOADS)
2038 && (virtio_has_feature(vi->vdev, VIRTIO_NET_F_GUEST_TSO4) ||
2039 virtio_has_feature(vi->vdev, VIRTIO_NET_F_GUEST_TSO6) ||
2040 virtio_has_feature(vi->vdev, VIRTIO_NET_F_GUEST_ECN) ||
2041 virtio_has_feature(vi->vdev, VIRTIO_NET_F_GUEST_UFO))) {
Daniel Borkmann4d463c42017-05-03 00:39:17 +02002042 NL_SET_ERR_MSG_MOD(extack, "Can't set XDP while host is implementing LRO, disable LRO first");
John Fastabendf600b692016-12-15 12:13:24 -08002043 return -EOPNOTSUPP;
2044 }
2045
2046 if (vi->mergeable_rx_bufs && !vi->any_header_sg) {
Daniel Borkmann4d463c42017-05-03 00:39:17 +02002047 NL_SET_ERR_MSG_MOD(extack, "XDP expects header/data in single page, any_header_sg required");
John Fastabendf600b692016-12-15 12:13:24 -08002048 return -EINVAL;
2049 }
2050
2051 if (dev->mtu > max_sz) {
Daniel Borkmann4d463c42017-05-03 00:39:17 +02002052 NL_SET_ERR_MSG_MOD(extack, "MTU too large to enable XDP");
John Fastabendf600b692016-12-15 12:13:24 -08002053 netdev_warn(dev, "XDP requires MTU less than %lu\n", max_sz);
2054 return -EINVAL;
2055 }
2056
John Fastabend672aafd2016-12-15 12:13:49 -08002057 curr_qp = vi->curr_queue_pairs - vi->xdp_queue_pairs;
2058 if (prog)
2059 xdp_qp = nr_cpu_ids;
2060
2061 /* XDP requires extra queues for XDP_TX */
2062 if (curr_qp + xdp_qp > vi->max_queue_pairs) {
Daniel Borkmann4d463c42017-05-03 00:39:17 +02002063 NL_SET_ERR_MSG_MOD(extack, "Too few free TX rings available");
John Fastabend672aafd2016-12-15 12:13:49 -08002064 netdev_warn(dev, "request %i queues but max is %i\n",
2065 curr_qp + xdp_qp, vi->max_queue_pairs);
2066 return -ENOMEM;
2067 }
2068
John Fastabend2de2f7f2017-02-02 19:16:29 -08002069 if (prog) {
2070 prog = bpf_prog_add(prog, vi->max_queue_pairs - 1);
2071 if (IS_ERR(prog))
2072 return PTR_ERR(prog);
2073 }
2074
Jason Wang4941d472017-07-19 16:54:48 +08002075 /* Make sure NAPI is not using any XDP TX queues for RX. */
2076 for (i = 0; i < vi->max_queue_pairs; i++)
2077 napi_disable(&vi->rq[i].napi);
John Fastabendf600b692016-12-15 12:13:24 -08002078
John Fastabend672aafd2016-12-15 12:13:49 -08002079 netif_set_real_num_rx_queues(dev, curr_qp + xdp_qp);
Jason Wang4941d472017-07-19 16:54:48 +08002080 err = _virtnet_set_queues(vi, curr_qp + xdp_qp);
2081 if (err)
2082 goto err;
2083 vi->xdp_queue_pairs = xdp_qp;
John Fastabend672aafd2016-12-15 12:13:49 -08002084
John Fastabendf600b692016-12-15 12:13:24 -08002085 for (i = 0; i < vi->max_queue_pairs; i++) {
2086 old_prog = rtnl_dereference(vi->rq[i].xdp_prog);
2087 rcu_assign_pointer(vi->rq[i].xdp_prog, prog);
Jason Wang3f935222017-07-19 16:54:49 +08002088 if (i == 0) {
2089 if (!old_prog)
2090 virtnet_clear_guest_offloads(vi);
2091 if (!prog)
2092 virtnet_restore_guest_offloads(vi);
2093 }
John Fastabendf600b692016-12-15 12:13:24 -08002094 if (old_prog)
2095 bpf_prog_put(old_prog);
Jason Wang4941d472017-07-19 16:54:48 +08002096 virtnet_napi_enable(vi->rq[i].vq, &vi->rq[i].napi);
John Fastabendf600b692016-12-15 12:13:24 -08002097 }
2098
2099 return 0;
John Fastabend2de2f7f2017-02-02 19:16:29 -08002100
Jason Wang4941d472017-07-19 16:54:48 +08002101err:
2102 for (i = 0; i < vi->max_queue_pairs; i++)
2103 virtnet_napi_enable(vi->rq[i].vq, &vi->rq[i].napi);
John Fastabend2de2f7f2017-02-02 19:16:29 -08002104 if (prog)
2105 bpf_prog_sub(prog, vi->max_queue_pairs - 1);
2106 return err;
John Fastabendf600b692016-12-15 12:13:24 -08002107}
2108
Martin KaFai Lau5b0e6622017-06-15 17:29:12 -07002109static u32 virtnet_xdp_query(struct net_device *dev)
John Fastabendf600b692016-12-15 12:13:24 -08002110{
2111 struct virtnet_info *vi = netdev_priv(dev);
Martin KaFai Lau5b0e6622017-06-15 17:29:12 -07002112 const struct bpf_prog *xdp_prog;
John Fastabendf600b692016-12-15 12:13:24 -08002113 int i;
2114
2115 for (i = 0; i < vi->max_queue_pairs; i++) {
Martin KaFai Lau5b0e6622017-06-15 17:29:12 -07002116 xdp_prog = rtnl_dereference(vi->rq[i].xdp_prog);
2117 if (xdp_prog)
2118 return xdp_prog->aux->id;
John Fastabendf600b692016-12-15 12:13:24 -08002119 }
Martin KaFai Lau5b0e6622017-06-15 17:29:12 -07002120 return 0;
John Fastabendf600b692016-12-15 12:13:24 -08002121}
2122
Jakub Kicinskif4e63522017-11-03 13:56:16 -07002123static int virtnet_xdp(struct net_device *dev, struct netdev_bpf *xdp)
John Fastabendf600b692016-12-15 12:13:24 -08002124{
2125 switch (xdp->command) {
2126 case XDP_SETUP_PROG:
Jakub Kicinski9861ce02017-04-30 21:46:48 -07002127 return virtnet_xdp_set(dev, xdp->prog, xdp->extack);
John Fastabendf600b692016-12-15 12:13:24 -08002128 case XDP_QUERY_PROG:
Martin KaFai Lau5b0e6622017-06-15 17:29:12 -07002129 xdp->prog_id = virtnet_xdp_query(dev);
2130 xdp->prog_attached = !!xdp->prog_id;
John Fastabendf600b692016-12-15 12:13:24 -08002131 return 0;
2132 default:
2133 return -EINVAL;
2134 }
2135}
2136
Stephen Hemminger76288b42009-01-06 10:44:22 -08002137static const struct net_device_ops virtnet_netdev = {
2138 .ndo_open = virtnet_open,
2139 .ndo_stop = virtnet_close,
2140 .ndo_start_xmit = start_xmit,
2141 .ndo_validate_addr = eth_validate_addr,
Alex Williamson9c46f6d2009-02-04 16:36:34 -08002142 .ndo_set_mac_address = virtnet_set_mac_address,
Alex Williamson2af76982009-02-04 09:02:40 +00002143 .ndo_set_rx_mode = virtnet_set_rx_mode,
stephen hemminger3fa2a1d2011-06-15 06:36:29 +00002144 .ndo_get_stats64 = virtnet_stats,
Alex Williamson1824a982009-05-01 17:31:10 +00002145 .ndo_vlan_rx_add_vid = virtnet_vlan_rx_add_vid,
2146 .ndo_vlan_rx_kill_vid = virtnet_vlan_rx_kill_vid,
Stephen Hemminger76288b42009-01-06 10:44:22 -08002147#ifdef CONFIG_NET_POLL_CONTROLLER
2148 .ndo_poll_controller = virtnet_netpoll,
2149#endif
Jakub Kicinskif4e63522017-11-03 13:56:16 -07002150 .ndo_bpf = virtnet_xdp,
Jason Wang186b3c92017-09-19 17:42:43 +08002151 .ndo_xdp_xmit = virtnet_xdp_xmit,
2152 .ndo_xdp_flush = virtnet_xdp_flush,
Vlad Yasevich2836b4f2017-05-23 13:38:43 -04002153 .ndo_features_check = passthru_features_check,
Stephen Hemminger76288b42009-01-06 10:44:22 -08002154};
2155
Jason Wang586d17c2012-04-11 20:43:52 +00002156static void virtnet_config_changed_work(struct work_struct *work)
Mark McLoughlin9f4d26d2009-01-19 17:09:49 -08002157{
Jason Wang586d17c2012-04-11 20:43:52 +00002158 struct virtnet_info *vi =
2159 container_of(work, struct virtnet_info, config_work);
Mark McLoughlin9f4d26d2009-01-19 17:09:49 -08002160 u16 v;
2161
Rusty Russell855e0c52013-10-14 18:11:51 +10302162 if (virtio_cread_feature(vi->vdev, VIRTIO_NET_F_STATUS,
2163 struct virtio_net_config, status, &v) < 0)
Michael S. Tsirkin507613b2014-10-15 10:22:30 +10302164 return;
Jason Wang586d17c2012-04-11 20:43:52 +00002165
2166 if (v & VIRTIO_NET_S_ANNOUNCE) {
Amerigo Wangee89bab2012-08-09 22:14:56 +00002167 netdev_notify_peers(vi->dev);
Jason Wang586d17c2012-04-11 20:43:52 +00002168 virtnet_ack_link_announce(vi);
2169 }
Mark McLoughlin9f4d26d2009-01-19 17:09:49 -08002170
2171 /* Ignore unknown (future) status bits */
2172 v &= VIRTIO_NET_S_LINK_UP;
2173
2174 if (vi->status == v)
Michael S. Tsirkin507613b2014-10-15 10:22:30 +10302175 return;
Mark McLoughlin9f4d26d2009-01-19 17:09:49 -08002176
2177 vi->status = v;
2178
2179 if (vi->status & VIRTIO_NET_S_LINK_UP) {
Jason Baronfaa9b392018-01-05 17:44:54 -05002180 virtnet_update_settings(vi);
Mark McLoughlin9f4d26d2009-01-19 17:09:49 -08002181 netif_carrier_on(vi->dev);
Jason Wang986a4f42012-12-07 07:04:56 +00002182 netif_tx_wake_all_queues(vi->dev);
Mark McLoughlin9f4d26d2009-01-19 17:09:49 -08002183 } else {
2184 netif_carrier_off(vi->dev);
Jason Wang986a4f42012-12-07 07:04:56 +00002185 netif_tx_stop_all_queues(vi->dev);
Mark McLoughlin9f4d26d2009-01-19 17:09:49 -08002186 }
2187}
2188
2189static void virtnet_config_changed(struct virtio_device *vdev)
2190{
2191 struct virtnet_info *vi = vdev->priv;
2192
Tejun Heo3b07e9c2012-08-20 14:51:24 -07002193 schedule_work(&vi->config_work);
Mark McLoughlin9f4d26d2009-01-19 17:09:49 -08002194}
2195
Jason Wang986a4f42012-12-07 07:04:56 +00002196static void virtnet_free_queues(struct virtnet_info *vi)
2197{
Andrey Vagind4fb84e2013-12-05 18:36:21 +04002198 int i;
2199
Jason Wangab3971b2015-03-12 13:57:44 +08002200 for (i = 0; i < vi->max_queue_pairs; i++) {
2201 napi_hash_del(&vi->rq[i].napi);
Andrey Vagind4fb84e2013-12-05 18:36:21 +04002202 netif_napi_del(&vi->rq[i].napi);
Willem de Bruijnb92f1e62017-04-24 13:49:27 -04002203 netif_napi_del(&vi->sq[i].napi);
Jason Wangab3971b2015-03-12 13:57:44 +08002204 }
Andrey Vagind4fb84e2013-12-05 18:36:21 +04002205
Eric Dumazet963abe52016-11-15 22:24:12 -08002206 /* We called napi_hash_del() before netif_napi_del(),
2207 * we need to respect an RCU grace period before freeing vi->rq
2208 */
2209 synchronize_net();
2210
Jason Wang986a4f42012-12-07 07:04:56 +00002211 kfree(vi->rq);
2212 kfree(vi->sq);
2213}
2214
John Fastabend473153292017-02-02 19:14:32 -08002215static void _free_receive_bufs(struct virtnet_info *vi)
Jason Wang986a4f42012-12-07 07:04:56 +00002216{
John Fastabendf600b692016-12-15 12:13:24 -08002217 struct bpf_prog *old_prog;
Jason Wang986a4f42012-12-07 07:04:56 +00002218 int i;
2219
2220 for (i = 0; i < vi->max_queue_pairs; i++) {
2221 while (vi->rq[i].pages)
2222 __free_pages(get_a_page(&vi->rq[i], GFP_KERNEL), 0);
John Fastabendf600b692016-12-15 12:13:24 -08002223
2224 old_prog = rtnl_dereference(vi->rq[i].xdp_prog);
2225 RCU_INIT_POINTER(vi->rq[i].xdp_prog, NULL);
2226 if (old_prog)
2227 bpf_prog_put(old_prog);
Jason Wang986a4f42012-12-07 07:04:56 +00002228 }
John Fastabend473153292017-02-02 19:14:32 -08002229}
2230
2231static void free_receive_bufs(struct virtnet_info *vi)
2232{
2233 rtnl_lock();
2234 _free_receive_bufs(vi);
John Fastabendf600b692016-12-15 12:13:24 -08002235 rtnl_unlock();
Jason Wang986a4f42012-12-07 07:04:56 +00002236}
2237
Michael Daltonfb518792014-01-16 22:23:26 -08002238static void free_receive_page_frags(struct virtnet_info *vi)
2239{
2240 int i;
2241 for (i = 0; i < vi->max_queue_pairs; i++)
2242 if (vi->rq[i].alloc_frag.page)
2243 put_page(vi->rq[i].alloc_frag.page);
2244}
2245
John Fastabendb68df012017-01-25 18:22:48 -08002246static bool is_xdp_raw_buffer_queue(struct virtnet_info *vi, int q)
John Fastabend56434a02016-12-15 12:14:13 -08002247{
2248 if (q < (vi->curr_queue_pairs - vi->xdp_queue_pairs))
2249 return false;
2250 else if (q < vi->curr_queue_pairs)
2251 return true;
2252 else
2253 return false;
2254}
2255
Jason Wang986a4f42012-12-07 07:04:56 +00002256static void free_unused_bufs(struct virtnet_info *vi)
2257{
2258 void *buf;
2259 int i;
2260
2261 for (i = 0; i < vi->max_queue_pairs; i++) {
2262 struct virtqueue *vq = vi->sq[i].vq;
John Fastabend56434a02016-12-15 12:14:13 -08002263 while ((buf = virtqueue_detach_unused_buf(vq)) != NULL) {
John Fastabendb68df012017-01-25 18:22:48 -08002264 if (!is_xdp_raw_buffer_queue(vi, i))
John Fastabend56434a02016-12-15 12:14:13 -08002265 dev_kfree_skb(buf);
2266 else
2267 put_page(virt_to_head_page(buf));
2268 }
Jason Wang986a4f42012-12-07 07:04:56 +00002269 }
2270
2271 for (i = 0; i < vi->max_queue_pairs; i++) {
2272 struct virtqueue *vq = vi->rq[i].vq;
2273
2274 while ((buf = virtqueue_detach_unused_buf(vq)) != NULL) {
Michael Daltonab7db912014-01-16 22:23:27 -08002275 if (vi->mergeable_rx_bufs) {
Michael S. Tsirkin680557c2017-03-06 21:29:47 +02002276 put_page(virt_to_head_page(buf));
Michael Daltonab7db912014-01-16 22:23:27 -08002277 } else if (vi->big_packets) {
Andrey Vaginfa9fac12013-12-05 18:36:20 +04002278 give_pages(&vi->rq[i], buf);
Michael Daltonab7db912014-01-16 22:23:27 -08002279 } else {
Jason Wangf6b10202017-02-21 16:46:28 +08002280 put_page(virt_to_head_page(buf));
Michael Daltonab7db912014-01-16 22:23:27 -08002281 }
Jason Wang986a4f42012-12-07 07:04:56 +00002282 }
Jason Wang986a4f42012-12-07 07:04:56 +00002283 }
2284}
2285
Jason Wange9d74172012-12-07 07:04:55 +00002286static void virtnet_del_vqs(struct virtnet_info *vi)
2287{
2288 struct virtio_device *vdev = vi->vdev;
2289
Wanlong Gao8898c212013-01-24 23:51:30 +00002290 virtnet_clean_affinity(vi, -1);
Jason Wang986a4f42012-12-07 07:04:56 +00002291
Jason Wange9d74172012-12-07 07:04:55 +00002292 vdev->config->del_vqs(vdev);
Jason Wang986a4f42012-12-07 07:04:56 +00002293
2294 virtnet_free_queues(vi);
2295}
2296
Michael S. Tsirkind85b758f72017-03-09 02:21:21 +02002297/* How large should a single buffer be so a queue full of these can fit at
2298 * least one full packet?
2299 * Logic below assumes the mergeable buffer header is used.
2300 */
2301static unsigned int mergeable_min_buf_len(struct virtnet_info *vi, struct virtqueue *vq)
2302{
2303 const unsigned int hdr_len = sizeof(struct virtio_net_hdr_mrg_rxbuf);
2304 unsigned int rq_size = virtqueue_get_vring_size(vq);
2305 unsigned int packet_len = vi->big_packets ? IP_MAX_MTU : vi->dev->max_mtu;
2306 unsigned int buf_len = hdr_len + ETH_HLEN + VLAN_HLEN + packet_len;
2307 unsigned int min_buf_len = DIV_ROUND_UP(buf_len, rq_size);
2308
Michael S. Tsirkinf0c31922017-06-02 17:54:33 +03002309 return max(max(min_buf_len, hdr_len) - hdr_len,
2310 (unsigned int)GOOD_PACKET_LEN);
Michael S. Tsirkind85b758f72017-03-09 02:21:21 +02002311}
2312
Jason Wang986a4f42012-12-07 07:04:56 +00002313static int virtnet_find_vqs(struct virtnet_info *vi)
2314{
2315 vq_callback_t **callbacks;
2316 struct virtqueue **vqs;
2317 int ret = -ENOMEM;
2318 int i, total_vqs;
2319 const char **names;
Michael S. Tsirkind45b8972017-03-06 20:31:21 +02002320 bool *ctx;
Jason Wang986a4f42012-12-07 07:04:56 +00002321
2322 /* We expect 1 RX virtqueue followed by 1 TX virtqueue, followed by
2323 * possible N-1 RX/TX queue pairs used in multiqueue mode, followed by
2324 * possible control vq.
2325 */
2326 total_vqs = vi->max_queue_pairs * 2 +
2327 virtio_has_feature(vi->vdev, VIRTIO_NET_F_CTRL_VQ);
2328
2329 /* Allocate space for find_vqs parameters */
2330 vqs = kzalloc(total_vqs * sizeof(*vqs), GFP_KERNEL);
2331 if (!vqs)
2332 goto err_vq;
2333 callbacks = kmalloc(total_vqs * sizeof(*callbacks), GFP_KERNEL);
2334 if (!callbacks)
2335 goto err_callback;
2336 names = kmalloc(total_vqs * sizeof(*names), GFP_KERNEL);
2337 if (!names)
2338 goto err_names;
Jason Wang192f68c2017-07-19 16:54:47 +08002339 if (!vi->big_packets || vi->mergeable_rx_bufs) {
Michael S. Tsirkind45b8972017-03-06 20:31:21 +02002340 ctx = kzalloc(total_vqs * sizeof(*ctx), GFP_KERNEL);
2341 if (!ctx)
2342 goto err_ctx;
2343 } else {
2344 ctx = NULL;
2345 }
Jason Wang986a4f42012-12-07 07:04:56 +00002346
2347 /* Parameters for control virtqueue, if any */
2348 if (vi->has_cvq) {
2349 callbacks[total_vqs - 1] = NULL;
2350 names[total_vqs - 1] = "control";
2351 }
2352
2353 /* Allocate/initialize parameters for send/receive virtqueues */
2354 for (i = 0; i < vi->max_queue_pairs; i++) {
2355 callbacks[rxq2vq(i)] = skb_recv_done;
2356 callbacks[txq2vq(i)] = skb_xmit_done;
2357 sprintf(vi->rq[i].name, "input.%d", i);
2358 sprintf(vi->sq[i].name, "output.%d", i);
2359 names[rxq2vq(i)] = vi->rq[i].name;
2360 names[txq2vq(i)] = vi->sq[i].name;
Michael S. Tsirkind45b8972017-03-06 20:31:21 +02002361 if (ctx)
2362 ctx[rxq2vq(i)] = true;
Jason Wang986a4f42012-12-07 07:04:56 +00002363 }
2364
2365 ret = vi->vdev->config->find_vqs(vi->vdev, total_vqs, vqs, callbacks,
Michael S. Tsirkind45b8972017-03-06 20:31:21 +02002366 names, ctx, NULL);
Jason Wang986a4f42012-12-07 07:04:56 +00002367 if (ret)
2368 goto err_find;
2369
2370 if (vi->has_cvq) {
2371 vi->cvq = vqs[total_vqs - 1];
2372 if (virtio_has_feature(vi->vdev, VIRTIO_NET_F_CTRL_VLAN))
Patrick McHardyf6469682013-04-19 02:04:27 +00002373 vi->dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER;
Jason Wang986a4f42012-12-07 07:04:56 +00002374 }
2375
2376 for (i = 0; i < vi->max_queue_pairs; i++) {
2377 vi->rq[i].vq = vqs[rxq2vq(i)];
Michael S. Tsirkind85b758f72017-03-09 02:21:21 +02002378 vi->rq[i].min_buf_len = mergeable_min_buf_len(vi, vi->rq[i].vq);
Jason Wang986a4f42012-12-07 07:04:56 +00002379 vi->sq[i].vq = vqs[txq2vq(i)];
2380 }
2381
2382 kfree(names);
2383 kfree(callbacks);
2384 kfree(vqs);
Jason Wang55281622017-07-07 19:56:09 +08002385 kfree(ctx);
Jason Wang986a4f42012-12-07 07:04:56 +00002386
2387 return 0;
2388
2389err_find:
Michael S. Tsirkind45b8972017-03-06 20:31:21 +02002390 kfree(ctx);
2391err_ctx:
Jason Wang986a4f42012-12-07 07:04:56 +00002392 kfree(names);
2393err_names:
2394 kfree(callbacks);
2395err_callback:
2396 kfree(vqs);
2397err_vq:
2398 return ret;
2399}
2400
2401static int virtnet_alloc_queues(struct virtnet_info *vi)
2402{
2403 int i;
2404
2405 vi->sq = kzalloc(sizeof(*vi->sq) * vi->max_queue_pairs, GFP_KERNEL);
2406 if (!vi->sq)
2407 goto err_sq;
2408 vi->rq = kzalloc(sizeof(*vi->rq) * vi->max_queue_pairs, GFP_KERNEL);
Amerigo Wang008d4272012-12-10 02:24:08 +00002409 if (!vi->rq)
Jason Wang986a4f42012-12-07 07:04:56 +00002410 goto err_rq;
2411
2412 INIT_DELAYED_WORK(&vi->refill, refill_work);
2413 for (i = 0; i < vi->max_queue_pairs; i++) {
2414 vi->rq[i].pages = NULL;
2415 netif_napi_add(vi->dev, &vi->rq[i].napi, virtnet_poll,
2416 napi_weight);
Willem de Bruijn1d11e732017-04-27 20:37:58 -04002417 netif_tx_napi_add(vi->dev, &vi->sq[i].napi, virtnet_poll_tx,
2418 napi_tx ? napi_weight : 0);
Jason Wang986a4f42012-12-07 07:04:56 +00002419
2420 sg_init_table(vi->rq[i].sg, ARRAY_SIZE(vi->rq[i].sg));
Johannes Berg5377d7582015-08-19 09:48:40 +02002421 ewma_pkt_len_init(&vi->rq[i].mrg_avg_pkt_len);
Jason Wang986a4f42012-12-07 07:04:56 +00002422 sg_init_table(vi->sq[i].sg, ARRAY_SIZE(vi->sq[i].sg));
2423 }
2424
2425 return 0;
2426
2427err_rq:
2428 kfree(vi->sq);
2429err_sq:
2430 return -ENOMEM;
Jason Wange9d74172012-12-07 07:04:55 +00002431}
2432
Amit Shah3f9c10b2011-12-22 16:58:31 +05302433static int init_vqs(struct virtnet_info *vi)
2434{
Jason Wang986a4f42012-12-07 07:04:56 +00002435 int ret;
Amit Shah3f9c10b2011-12-22 16:58:31 +05302436
Jason Wang986a4f42012-12-07 07:04:56 +00002437 /* Allocate send & receive queues */
2438 ret = virtnet_alloc_queues(vi);
2439 if (ret)
2440 goto err;
Amit Shah3f9c10b2011-12-22 16:58:31 +05302441
Jason Wang986a4f42012-12-07 07:04:56 +00002442 ret = virtnet_find_vqs(vi);
2443 if (ret)
2444 goto err_free;
Amit Shah3f9c10b2011-12-22 16:58:31 +05302445
Wanlong Gao47be2472013-01-24 23:51:29 +00002446 get_online_cpus();
Wanlong Gao8898c212013-01-24 23:51:30 +00002447 virtnet_set_affinity(vi);
Wanlong Gao47be2472013-01-24 23:51:29 +00002448 put_online_cpus();
2449
Amit Shah3f9c10b2011-12-22 16:58:31 +05302450 return 0;
Jason Wang986a4f42012-12-07 07:04:56 +00002451
2452err_free:
2453 virtnet_free_queues(vi);
2454err:
2455 return ret;
Amit Shah3f9c10b2011-12-22 16:58:31 +05302456}
2457
Michael Daltonfbf28d72014-01-16 22:23:30 -08002458#ifdef CONFIG_SYSFS
2459static ssize_t mergeable_rx_buffer_size_show(struct netdev_rx_queue *queue,
stephen hemminger718ad682017-08-18 13:46:24 -07002460 char *buf)
Michael Daltonfbf28d72014-01-16 22:23:30 -08002461{
2462 struct virtnet_info *vi = netdev_priv(queue->dev);
2463 unsigned int queue_index = get_netdev_rx_queue_index(queue);
Johannes Berg5377d7582015-08-19 09:48:40 +02002464 struct ewma_pkt_len *avg;
Michael Daltonfbf28d72014-01-16 22:23:30 -08002465
2466 BUG_ON(queue_index >= vi->max_queue_pairs);
2467 avg = &vi->rq[queue_index].mrg_avg_pkt_len;
Michael S. Tsirkind85b758f72017-03-09 02:21:21 +02002468 return sprintf(buf, "%u\n",
2469 get_mergeable_buf_len(&vi->rq[queue_index], avg));
Michael Daltonfbf28d72014-01-16 22:23:30 -08002470}
2471
2472static struct rx_queue_attribute mergeable_rx_buffer_size_attribute =
2473 __ATTR_RO(mergeable_rx_buffer_size);
2474
2475static struct attribute *virtio_net_mrg_rx_attrs[] = {
2476 &mergeable_rx_buffer_size_attribute.attr,
2477 NULL
2478};
2479
2480static const struct attribute_group virtio_net_mrg_rx_group = {
2481 .name = "virtio_net",
2482 .attrs = virtio_net_mrg_rx_attrs
2483};
2484#endif
2485
Jason Wang892d6eb2014-11-20 17:03:05 +08002486static bool virtnet_fail_on_feature(struct virtio_device *vdev,
2487 unsigned int fbit,
2488 const char *fname, const char *dname)
2489{
2490 if (!virtio_has_feature(vdev, fbit))
2491 return false;
2492
2493 dev_err(&vdev->dev, "device advertises feature %s but not %s",
2494 fname, dname);
2495
2496 return true;
2497}
2498
2499#define VIRTNET_FAIL_ON(vdev, fbit, dbit) \
2500 virtnet_fail_on_feature(vdev, fbit, #fbit, dbit)
2501
2502static bool virtnet_validate_features(struct virtio_device *vdev)
2503{
2504 if (!virtio_has_feature(vdev, VIRTIO_NET_F_CTRL_VQ) &&
2505 (VIRTNET_FAIL_ON(vdev, VIRTIO_NET_F_CTRL_RX,
2506 "VIRTIO_NET_F_CTRL_VQ") ||
2507 VIRTNET_FAIL_ON(vdev, VIRTIO_NET_F_CTRL_VLAN,
2508 "VIRTIO_NET_F_CTRL_VQ") ||
2509 VIRTNET_FAIL_ON(vdev, VIRTIO_NET_F_GUEST_ANNOUNCE,
2510 "VIRTIO_NET_F_CTRL_VQ") ||
2511 VIRTNET_FAIL_ON(vdev, VIRTIO_NET_F_MQ, "VIRTIO_NET_F_CTRL_VQ") ||
2512 VIRTNET_FAIL_ON(vdev, VIRTIO_NET_F_CTRL_MAC_ADDR,
2513 "VIRTIO_NET_F_CTRL_VQ"))) {
2514 return false;
2515 }
2516
2517 return true;
2518}
2519
Jarod Wilsond0c2c992016-10-20 13:55:21 -04002520#define MIN_MTU ETH_MIN_MTU
2521#define MAX_MTU ETH_MAX_MTU
2522
Michael S. Tsirkinfe36cbe2017-03-29 19:09:14 +03002523static int virtnet_validate(struct virtio_device *vdev)
Rusty Russell296f96f2007-10-22 11:03:37 +10002524{
Michael S. Tsirkin6ba42242015-01-12 16:23:37 +02002525 if (!vdev->config->get) {
2526 dev_err(&vdev->dev, "%s failure: config access disabled\n",
2527 __func__);
2528 return -EINVAL;
2529 }
2530
Jason Wang892d6eb2014-11-20 17:03:05 +08002531 if (!virtnet_validate_features(vdev))
2532 return -EINVAL;
2533
Michael S. Tsirkinfe36cbe2017-03-29 19:09:14 +03002534 if (virtio_has_feature(vdev, VIRTIO_NET_F_MTU)) {
2535 int mtu = virtio_cread16(vdev,
2536 offsetof(struct virtio_net_config,
2537 mtu));
2538 if (mtu < MIN_MTU)
2539 __virtio_clear_bit(vdev, VIRTIO_NET_F_MTU);
2540 }
2541
2542 return 0;
2543}
2544
2545static int virtnet_probe(struct virtio_device *vdev)
2546{
2547 int i, err;
2548 struct net_device *dev;
2549 struct virtnet_info *vi;
2550 u16 max_queue_pairs;
2551 int mtu;
2552
Jason Wang986a4f42012-12-07 07:04:56 +00002553 /* Find if host supports multiqueue virtio_net device */
Rusty Russell855e0c52013-10-14 18:11:51 +10302554 err = virtio_cread_feature(vdev, VIRTIO_NET_F_MQ,
2555 struct virtio_net_config,
2556 max_virtqueue_pairs, &max_queue_pairs);
Jason Wang986a4f42012-12-07 07:04:56 +00002557
2558 /* We need at least 2 queue's */
2559 if (err || max_queue_pairs < VIRTIO_NET_CTRL_MQ_VQ_PAIRS_MIN ||
2560 max_queue_pairs > VIRTIO_NET_CTRL_MQ_VQ_PAIRS_MAX ||
2561 !virtio_has_feature(vdev, VIRTIO_NET_F_CTRL_VQ))
2562 max_queue_pairs = 1;
Rusty Russell296f96f2007-10-22 11:03:37 +10002563
2564 /* Allocate ourselves a network device with room for our info */
Jason Wang986a4f42012-12-07 07:04:56 +00002565 dev = alloc_etherdev_mq(sizeof(struct virtnet_info), max_queue_pairs);
Rusty Russell296f96f2007-10-22 11:03:37 +10002566 if (!dev)
2567 return -ENOMEM;
2568
2569 /* Set up network device as normal. */
Jiri Pirkof2f2c8b2012-06-29 05:10:06 +00002570 dev->priv_flags |= IFF_UNICAST_FLT | IFF_LIVE_ADDR_CHANGE;
Stephen Hemminger76288b42009-01-06 10:44:22 -08002571 dev->netdev_ops = &virtnet_netdev;
Rusty Russell296f96f2007-10-22 11:03:37 +10002572 dev->features = NETIF_F_HIGHDMA;
stephen hemminger3fa2a1d2011-06-15 06:36:29 +00002573
Wilfried Klaebe7ad24ea2014-05-11 00:12:32 +00002574 dev->ethtool_ops = &virtnet_ethtool_ops;
Rusty Russell296f96f2007-10-22 11:03:37 +10002575 SET_NETDEV_DEV(dev, &vdev->dev);
2576
2577 /* Do we support "hardware" checksums? */
Michał Mirosław98e778c2011-03-31 01:01:35 +00002578 if (virtio_has_feature(vdev, VIRTIO_NET_F_CSUM)) {
Rusty Russell296f96f2007-10-22 11:03:37 +10002579 /* This opens up the world of extra features. */
Jason Wang48900cb2015-08-05 10:34:04 +08002580 dev->hw_features |= NETIF_F_HW_CSUM | NETIF_F_SG;
Michał Mirosław98e778c2011-03-31 01:01:35 +00002581 if (csum)
Jason Wang48900cb2015-08-05 10:34:04 +08002582 dev->features |= NETIF_F_HW_CSUM | NETIF_F_SG;
Michał Mirosław98e778c2011-03-31 01:01:35 +00002583
2584 if (virtio_has_feature(vdev, VIRTIO_NET_F_GSO)) {
David S. Millere078de02017-07-03 06:37:32 -07002585 dev->hw_features |= NETIF_F_TSO
Rusty Russell34a48572008-02-04 23:50:02 -05002586 | NETIF_F_TSO_ECN | NETIF_F_TSO6;
2587 }
Rusty Russell5539ae962008-05-02 21:50:46 -05002588 /* Individual feature bits: what can host handle? */
Michał Mirosław98e778c2011-03-31 01:01:35 +00002589 if (virtio_has_feature(vdev, VIRTIO_NET_F_HOST_TSO4))
2590 dev->hw_features |= NETIF_F_TSO;
2591 if (virtio_has_feature(vdev, VIRTIO_NET_F_HOST_TSO6))
2592 dev->hw_features |= NETIF_F_TSO6;
2593 if (virtio_has_feature(vdev, VIRTIO_NET_F_HOST_ECN))
2594 dev->hw_features |= NETIF_F_TSO_ECN;
Michał Mirosław98e778c2011-03-31 01:01:35 +00002595
Jason Wang41f2f122014-12-24 11:03:52 +08002596 dev->features |= NETIF_F_GSO_ROBUST;
2597
Michał Mirosław98e778c2011-03-31 01:01:35 +00002598 if (gso)
David S. Millere078de02017-07-03 06:37:32 -07002599 dev->features |= dev->hw_features & NETIF_F_ALL_TSO;
Michał Mirosław98e778c2011-03-31 01:01:35 +00002600 /* (!csum && gso) case will be fixed by register_netdev() */
Rusty Russell296f96f2007-10-22 11:03:37 +10002601 }
Thomas Huth4f491292013-08-27 17:09:02 +02002602 if (virtio_has_feature(vdev, VIRTIO_NET_F_GUEST_CSUM))
2603 dev->features |= NETIF_F_RXCSUM;
Rusty Russell296f96f2007-10-22 11:03:37 +10002604
Jason Wang4fda8302013-04-10 23:32:21 +00002605 dev->vlan_features = dev->features;
2606
Jarod Wilsond0c2c992016-10-20 13:55:21 -04002607 /* MTU range: 68 - 65535 */
2608 dev->min_mtu = MIN_MTU;
2609 dev->max_mtu = MAX_MTU;
2610
Rusty Russell296f96f2007-10-22 11:03:37 +10002611 /* Configuration may specify what MAC to use. Otherwise random. */
Rusty Russell855e0c52013-10-14 18:11:51 +10302612 if (virtio_has_feature(vdev, VIRTIO_NET_F_MAC))
2613 virtio_cread_bytes(vdev,
2614 offsetof(struct virtio_net_config, mac),
2615 dev->dev_addr, dev->addr_len);
2616 else
Danny Kukawkaf2cedb62012-02-15 06:45:39 +00002617 eth_hw_addr_random(dev);
Rusty Russell296f96f2007-10-22 11:03:37 +10002618
2619 /* Set up our device-specific information */
2620 vi = netdev_priv(dev);
Rusty Russell296f96f2007-10-22 11:03:37 +10002621 vi->dev = dev;
2622 vi->vdev = vdev;
Christian Borntraegerd9d5dcc2008-02-18 10:02:51 +01002623 vdev->priv = vi;
stephen hemminger3fa2a1d2011-06-15 06:36:29 +00002624 vi->stats = alloc_percpu(struct virtnet_stats);
2625 err = -ENOMEM;
2626 if (vi->stats == NULL)
2627 goto free;
2628
John Stultz827da442013-10-07 15:51:58 -07002629 for_each_possible_cpu(i) {
2630 struct virtnet_stats *virtnet_stats;
2631 virtnet_stats = per_cpu_ptr(vi->stats, i);
2632 u64_stats_init(&virtnet_stats->tx_syncp);
2633 u64_stats_init(&virtnet_stats->rx_syncp);
2634 }
2635
Jason Wang586d17c2012-04-11 20:43:52 +00002636 INIT_WORK(&vi->config_work, virtnet_config_changed_work);
Rusty Russell296f96f2007-10-22 11:03:37 +10002637
Herbert Xu97402b92008-04-18 11:24:27 +08002638 /* If we can receive ANY GSO packets, we must allocate large ones. */
Joe Perches8e95a202009-12-03 07:58:21 +00002639 if (virtio_has_feature(vdev, VIRTIO_NET_F_GUEST_TSO4) ||
2640 virtio_has_feature(vdev, VIRTIO_NET_F_GUEST_TSO6) ||
Vlad Yaseviche3e3c422015-02-03 16:36:17 -05002641 virtio_has_feature(vdev, VIRTIO_NET_F_GUEST_ECN) ||
2642 virtio_has_feature(vdev, VIRTIO_NET_F_GUEST_UFO))
Herbert Xu97402b92008-04-18 11:24:27 +08002643 vi->big_packets = true;
2644
Mark McLoughlin3f2c31d2008-11-16 22:41:34 -08002645 if (virtio_has_feature(vdev, VIRTIO_NET_F_MRG_RXBUF))
2646 vi->mergeable_rx_bufs = true;
2647
Michael S. Tsirkind04302b2014-10-24 00:24:03 +03002648 if (virtio_has_feature(vdev, VIRTIO_NET_F_MRG_RXBUF) ||
2649 virtio_has_feature(vdev, VIRTIO_F_VERSION_1))
Michael S. Tsirkin012873d2014-10-24 16:55:57 +03002650 vi->hdr_len = sizeof(struct virtio_net_hdr_mrg_rxbuf);
2651 else
2652 vi->hdr_len = sizeof(struct virtio_net_hdr);
2653
Michael S. Tsirkin75993302015-07-15 15:26:19 +03002654 if (virtio_has_feature(vdev, VIRTIO_F_ANY_LAYOUT) ||
2655 virtio_has_feature(vdev, VIRTIO_F_VERSION_1))
Michael S. Tsirkine7428e92013-07-25 10:20:23 +09302656 vi->any_header_sg = true;
2657
Jason Wang986a4f42012-12-07 07:04:56 +00002658 if (virtio_has_feature(vdev, VIRTIO_NET_F_CTRL_VQ))
2659 vi->has_cvq = true;
2660
Aaron Conole14de9d12016-06-03 16:57:12 -04002661 if (virtio_has_feature(vdev, VIRTIO_NET_F_MTU)) {
2662 mtu = virtio_cread16(vdev,
2663 offsetof(struct virtio_net_config,
2664 mtu));
Aaron Conole93a205e2016-10-25 16:12:12 -04002665 if (mtu < dev->min_mtu) {
Michael S. Tsirkinfe36cbe2017-03-29 19:09:14 +03002666 /* Should never trigger: MTU was previously validated
2667 * in virtnet_validate.
2668 */
2669 dev_err(&vdev->dev, "device MTU appears to have changed "
2670 "it is now %d < %d", mtu, dev->min_mtu);
2671 goto free_stats;
Aaron Conole93a205e2016-10-25 16:12:12 -04002672 }
Michael S. Tsirkin2e123b42017-03-08 02:14:25 +02002673
Michael S. Tsirkinfe36cbe2017-03-29 19:09:14 +03002674 dev->mtu = mtu;
2675 dev->max_mtu = mtu;
2676
Michael S. Tsirkin2e123b42017-03-08 02:14:25 +02002677 /* TODO: size buffers correctly in this case. */
2678 if (dev->mtu > ETH_DATA_LEN)
2679 vi->big_packets = true;
Aaron Conole14de9d12016-06-03 16:57:12 -04002680 }
2681
Michael S. Tsirkin012873d2014-10-24 16:55:57 +03002682 if (vi->any_header_sg)
2683 dev->needed_headroom = vi->hdr_len;
Zhangjie \(HZ\)6ebbc1a2014-04-29 18:43:22 +08002684
Jason Wang44900012016-11-25 12:37:26 +08002685 /* Enable multiqueue by default */
2686 if (num_online_cpus() >= max_queue_pairs)
2687 vi->curr_queue_pairs = max_queue_pairs;
2688 else
2689 vi->curr_queue_pairs = num_online_cpus();
Jason Wang986a4f42012-12-07 07:04:56 +00002690 vi->max_queue_pairs = max_queue_pairs;
2691
2692 /* Allocate/initialize the rx/tx queues, and invoke find_vqs */
Amit Shah3f9c10b2011-12-22 16:58:31 +05302693 err = init_vqs(vi);
Michael S. Tsirkind2a7ddd2009-06-12 22:16:36 -06002694 if (err)
Jason Wang9bb8ca82013-11-05 18:19:45 +08002695 goto free_stats;
Michael S. Tsirkind2a7ddd2009-06-12 22:16:36 -06002696
Michael Daltonfbf28d72014-01-16 22:23:30 -08002697#ifdef CONFIG_SYSFS
2698 if (vi->mergeable_rx_bufs)
2699 dev->sysfs_rx_queue_group = &virtio_net_mrg_rx_group;
2700#endif
Zhi Yong Wu0f13b662013-11-18 21:19:27 +08002701 netif_set_real_num_tx_queues(dev, vi->curr_queue_pairs);
2702 netif_set_real_num_rx_queues(dev, vi->curr_queue_pairs);
Jason Wang986a4f42012-12-07 07:04:56 +00002703
Nikolay Aleksandrov16032be2016-02-03 04:04:37 +01002704 virtnet_init_settings(dev);
2705
Rusty Russell296f96f2007-10-22 11:03:37 +10002706 err = register_netdev(dev);
2707 if (err) {
2708 pr_debug("virtio_net: registering device failed\n");
Michael S. Tsirkind2a7ddd2009-06-12 22:16:36 -06002709 goto free_vqs;
Rusty Russell296f96f2007-10-22 11:03:37 +10002710 }
Rusty Russellb3369c12008-02-04 23:50:02 -05002711
Michael S. Tsirkin4baf1e32014-10-15 10:22:30 +10302712 virtio_device_ready(vdev);
2713
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +02002714 err = virtnet_cpu_notif_add(vi);
Wanlong Gao8de4b2f2013-01-24 23:51:31 +00002715 if (err) {
2716 pr_debug("virtio_net: registering cpu notifier failed\n");
wangyunjianf00e35e2016-05-31 11:52:43 +08002717 goto free_unregister_netdev;
Wanlong Gao8de4b2f2013-01-24 23:51:31 +00002718 }
2719
Jason Wanga2208712016-12-13 14:23:05 +08002720 virtnet_set_queues(vi, vi->curr_queue_pairs);
Jason Wang44900012016-11-25 12:37:26 +08002721
Jason Wang167c25e2010-11-10 14:45:41 +00002722 /* Assume link up if device can't report link status,
2723 otherwise get link status from config. */
2724 if (virtio_has_feature(vi->vdev, VIRTIO_NET_F_STATUS)) {
2725 netif_carrier_off(dev);
Tejun Heo3b07e9c2012-08-20 14:51:24 -07002726 schedule_work(&vi->config_work);
Jason Wang167c25e2010-11-10 14:45:41 +00002727 } else {
2728 vi->status = VIRTIO_NET_S_LINK_UP;
Jason Baronfaa9b392018-01-05 17:44:54 -05002729 virtnet_update_settings(vi);
Jason Wang167c25e2010-11-10 14:45:41 +00002730 netif_carrier_on(dev);
2731 }
Mark McLoughlin9f4d26d2009-01-19 17:09:49 -08002732
Jason Wang3f935222017-07-19 16:54:49 +08002733 for (i = 0; i < ARRAY_SIZE(guest_offloads); i++)
2734 if (virtio_has_feature(vi->vdev, guest_offloads[i]))
2735 set_bit(guest_offloads[i], &vi->guest_offloads);
2736
Jason Wang986a4f42012-12-07 07:04:56 +00002737 pr_debug("virtnet: registered device %s with %d RX and TX vq's\n",
2738 dev->name, max_queue_pairs);
2739
Rusty Russell296f96f2007-10-22 11:03:37 +10002740 return 0;
2741
wangyunjianf00e35e2016-05-31 11:52:43 +08002742free_unregister_netdev:
Michael S. Tsirkin02465552014-10-15 10:22:31 +10302743 vi->vdev->config->reset(vdev);
2744
Rusty Russellb3369c12008-02-04 23:50:02 -05002745 unregister_netdev(dev);
Michael S. Tsirkind2a7ddd2009-06-12 22:16:36 -06002746free_vqs:
Jason Wang986a4f42012-12-07 07:04:56 +00002747 cancel_delayed_work_sync(&vi->refill);
Michael Daltonfb518792014-01-16 22:23:26 -08002748 free_receive_page_frags(vi);
Jason Wange9d74172012-12-07 07:04:55 +00002749 virtnet_del_vqs(vi);
stephen hemminger3fa2a1d2011-06-15 06:36:29 +00002750free_stats:
2751 free_percpu(vi->stats);
Rusty Russell296f96f2007-10-22 11:03:37 +10002752free:
2753 free_netdev(dev);
2754 return err;
2755}
2756
Amit Shah04486ed2011-12-22 16:58:32 +05302757static void remove_vq_common(struct virtnet_info *vi)
Rusty Russell296f96f2007-10-22 11:03:37 +10002758{
Amit Shah04486ed2011-12-22 16:58:32 +05302759 vi->vdev->config->reset(vi->vdev);
Shirley Ma830a8a92010-02-08 14:14:42 +00002760
2761 /* Free unused buffers in both send and recv, if any. */
Shirley Ma9ab86bb2010-01-29 03:20:04 +00002762 free_unused_bufs(vi);
Rusty Russellfb6813f2008-07-25 12:06:01 -05002763
Jason Wang986a4f42012-12-07 07:04:56 +00002764 free_receive_bufs(vi);
Michael S. Tsirkind2a7ddd2009-06-12 22:16:36 -06002765
Michael Daltonfb518792014-01-16 22:23:26 -08002766 free_receive_page_frags(vi);
2767
Jason Wang986a4f42012-12-07 07:04:56 +00002768 virtnet_del_vqs(vi);
Amit Shah04486ed2011-12-22 16:58:32 +05302769}
2770
Bill Pemberton8cc085d2012-12-03 09:24:15 -05002771static void virtnet_remove(struct virtio_device *vdev)
Amit Shah04486ed2011-12-22 16:58:32 +05302772{
2773 struct virtnet_info *vi = vdev->priv;
2774
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +02002775 virtnet_cpu_notif_remove(vi);
Wanlong Gao8de4b2f2013-01-24 23:51:31 +00002776
Michael S. Tsirkin102a2782014-10-15 10:22:29 +10302777 /* Make sure no work handler is accessing the device. */
2778 flush_work(&vi->config_work);
Jason Wang586d17c2012-04-11 20:43:52 +00002779
Amit Shah04486ed2011-12-22 16:58:32 +05302780 unregister_netdev(vi->dev);
2781
2782 remove_vq_common(vi);
Rusty Russellfb6813f2008-07-25 12:06:01 -05002783
Krishna Kumar2e66f552011-07-20 03:56:02 +00002784 free_percpu(vi->stats);
Rusty Russell74b25532007-11-19 11:20:42 -05002785 free_netdev(vi->dev);
Rusty Russell296f96f2007-10-22 11:03:37 +10002786}
2787
Arnd Bergmann67a75192017-07-25 17:35:50 +02002788static __maybe_unused int virtnet_freeze(struct virtio_device *vdev)
Amit Shah0741bcb2011-12-22 16:58:33 +05302789{
2790 struct virtnet_info *vi = vdev->priv;
2791
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +02002792 virtnet_cpu_notif_remove(vi);
John Fastabend9fe7bfc2017-02-02 19:16:01 -08002793 virtnet_freeze_down(vdev);
Amit Shah0741bcb2011-12-22 16:58:33 +05302794 remove_vq_common(vi);
2795
2796 return 0;
2797}
2798
Arnd Bergmann67a75192017-07-25 17:35:50 +02002799static __maybe_unused int virtnet_restore(struct virtio_device *vdev)
Amit Shah0741bcb2011-12-22 16:58:33 +05302800{
2801 struct virtnet_info *vi = vdev->priv;
John Fastabend9fe7bfc2017-02-02 19:16:01 -08002802 int err;
Amit Shah0741bcb2011-12-22 16:58:33 +05302803
John Fastabend9fe7bfc2017-02-02 19:16:01 -08002804 err = virtnet_restore_up(vdev);
Amit Shah0741bcb2011-12-22 16:58:33 +05302805 if (err)
2806 return err;
Jason Wang986a4f42012-12-07 07:04:56 +00002807 virtnet_set_queues(vi, vi->curr_queue_pairs);
2808
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +02002809 err = virtnet_cpu_notif_add(vi);
Jason Wangec9debb2013-10-29 15:11:07 +08002810 if (err)
2811 return err;
2812
Amit Shah0741bcb2011-12-22 16:58:33 +05302813 return 0;
2814}
Amit Shah0741bcb2011-12-22 16:58:33 +05302815
Rusty Russell296f96f2007-10-22 11:03:37 +10002816static struct virtio_device_id id_table[] = {
2817 { VIRTIO_ID_NET, VIRTIO_DEV_ANY_ID },
2818 { 0 },
2819};
2820
Michael S. Tsirkinf3358502016-11-04 12:55:36 +02002821#define VIRTNET_FEATURES \
2822 VIRTIO_NET_F_CSUM, VIRTIO_NET_F_GUEST_CSUM, \
2823 VIRTIO_NET_F_MAC, \
2824 VIRTIO_NET_F_HOST_TSO4, VIRTIO_NET_F_HOST_UFO, VIRTIO_NET_F_HOST_TSO6, \
2825 VIRTIO_NET_F_HOST_ECN, VIRTIO_NET_F_GUEST_TSO4, VIRTIO_NET_F_GUEST_TSO6, \
2826 VIRTIO_NET_F_GUEST_ECN, VIRTIO_NET_F_GUEST_UFO, \
2827 VIRTIO_NET_F_MRG_RXBUF, VIRTIO_NET_F_STATUS, VIRTIO_NET_F_CTRL_VQ, \
2828 VIRTIO_NET_F_CTRL_RX, VIRTIO_NET_F_CTRL_VLAN, \
2829 VIRTIO_NET_F_GUEST_ANNOUNCE, VIRTIO_NET_F_MQ, \
2830 VIRTIO_NET_F_CTRL_MAC_ADDR, \
Jason Baronfaa9b392018-01-05 17:44:54 -05002831 VIRTIO_NET_F_MTU, VIRTIO_NET_F_CTRL_GUEST_OFFLOADS, \
2832 VIRTIO_NET_F_SPEED_DUPLEX
Michael S. Tsirkinf3358502016-11-04 12:55:36 +02002833
Rusty Russellc45a6812008-05-02 21:50:50 -05002834static unsigned int features[] = {
Michael S. Tsirkinf3358502016-11-04 12:55:36 +02002835 VIRTNET_FEATURES,
2836};
2837
2838static unsigned int features_legacy[] = {
2839 VIRTNET_FEATURES,
2840 VIRTIO_NET_F_GSO,
Michael S. Tsirkine7428e92013-07-25 10:20:23 +09302841 VIRTIO_F_ANY_LAYOUT,
Rusty Russellc45a6812008-05-02 21:50:50 -05002842};
2843
Uwe Kleine-König22402522009-11-05 01:32:44 -08002844static struct virtio_driver virtio_net_driver = {
Rusty Russellc45a6812008-05-02 21:50:50 -05002845 .feature_table = features,
2846 .feature_table_size = ARRAY_SIZE(features),
Michael S. Tsirkinf3358502016-11-04 12:55:36 +02002847 .feature_table_legacy = features_legacy,
2848 .feature_table_size_legacy = ARRAY_SIZE(features_legacy),
Rusty Russell296f96f2007-10-22 11:03:37 +10002849 .driver.name = KBUILD_MODNAME,
2850 .driver.owner = THIS_MODULE,
2851 .id_table = id_table,
Michael S. Tsirkinfe36cbe2017-03-29 19:09:14 +03002852 .validate = virtnet_validate,
Rusty Russell296f96f2007-10-22 11:03:37 +10002853 .probe = virtnet_probe,
Bill Pemberton8cc085d2012-12-03 09:24:15 -05002854 .remove = virtnet_remove,
Mark McLoughlin9f4d26d2009-01-19 17:09:49 -08002855 .config_changed = virtnet_config_changed,
Aaron Lu89107002013-09-17 09:25:23 +09302856#ifdef CONFIG_PM_SLEEP
Amit Shah0741bcb2011-12-22 16:58:33 +05302857 .freeze = virtnet_freeze,
2858 .restore = virtnet_restore,
2859#endif
Rusty Russell296f96f2007-10-22 11:03:37 +10002860};
2861
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +02002862static __init int virtio_net_driver_init(void)
2863{
2864 int ret;
2865
Thomas Gleixner73c1b412016-12-21 20:19:54 +01002866 ret = cpuhp_setup_state_multi(CPUHP_AP_ONLINE_DYN, "virtio/net:online",
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +02002867 virtnet_cpu_online,
2868 virtnet_cpu_down_prep);
2869 if (ret < 0)
2870 goto out;
2871 virtionet_online = ret;
Thomas Gleixner73c1b412016-12-21 20:19:54 +01002872 ret = cpuhp_setup_state_multi(CPUHP_VIRT_NET_DEAD, "virtio/net:dead",
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +02002873 NULL, virtnet_cpu_dead);
2874 if (ret)
2875 goto err_dead;
2876
2877 ret = register_virtio_driver(&virtio_net_driver);
2878 if (ret)
2879 goto err_virtio;
2880 return 0;
2881err_virtio:
2882 cpuhp_remove_multi_state(CPUHP_VIRT_NET_DEAD);
2883err_dead:
2884 cpuhp_remove_multi_state(virtionet_online);
2885out:
2886 return ret;
2887}
2888module_init(virtio_net_driver_init);
2889
2890static __exit void virtio_net_driver_exit(void)
2891{
Andrew Jonescfa0ebc2017-07-24 15:38:32 +02002892 unregister_virtio_driver(&virtio_net_driver);
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +02002893 cpuhp_remove_multi_state(CPUHP_VIRT_NET_DEAD);
2894 cpuhp_remove_multi_state(virtionet_online);
Sebastian Andrzej Siewior8017c272016-08-12 19:49:43 +02002895}
2896module_exit(virtio_net_driver_exit);
Rusty Russell296f96f2007-10-22 11:03:37 +10002897
2898MODULE_DEVICE_TABLE(virtio, id_table);
2899MODULE_DESCRIPTION("Virtio network driver");
2900MODULE_LICENSE("GPL");