net/mlx4: Set number of RX rings in a utility function
[firefly-linux-kernel-4.4.55.git] / drivers / net / ethernet / mellanox / mlx4 / en_rx.c
1 /*
2  * Copyright (c) 2007 Mellanox Technologies. All rights reserved.
3  *
4  * This software is available to you under a choice of one of two
5  * licenses.  You may choose to be licensed under the terms of the GNU
6  * General Public License (GPL) Version 2, available from the file
7  * COPYING in the main directory of this source tree, or the
8  * OpenIB.org BSD license below:
9  *
10  *     Redistribution and use in source and binary forms, with or
11  *     without modification, are permitted provided that the following
12  *     conditions are met:
13  *
14  *      - Redistributions of source code must retain the above
15  *        copyright notice, this list of conditions and the following
16  *        disclaimer.
17  *
18  *      - Redistributions in binary form must reproduce the above
19  *        copyright notice, this list of conditions and the following
20  *        disclaimer in the documentation and/or other materials
21  *        provided with the distribution.
22  *
23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30  * SOFTWARE.
31  *
32  */
33
34 #include <net/busy_poll.h>
35 #include <linux/mlx4/cq.h>
36 #include <linux/slab.h>
37 #include <linux/mlx4/qp.h>
38 #include <linux/skbuff.h>
39 #include <linux/rculist.h>
40 #include <linux/if_ether.h>
41 #include <linux/if_vlan.h>
42 #include <linux/vmalloc.h>
43
44 #include "mlx4_en.h"
45
46 static int mlx4_alloc_pages(struct mlx4_en_priv *priv,
47                             struct mlx4_en_rx_alloc *page_alloc,
48                             const struct mlx4_en_frag_info *frag_info,
49                             gfp_t _gfp)
50 {
51         int order;
52         struct page *page;
53         dma_addr_t dma;
54
55         for (order = MLX4_EN_ALLOC_PREFER_ORDER; ;) {
56                 gfp_t gfp = _gfp;
57
58                 if (order)
59                         gfp |= __GFP_COMP | __GFP_NOWARN;
60                 page = alloc_pages(gfp, order);
61                 if (likely(page))
62                         break;
63                 if (--order < 0 ||
64                     ((PAGE_SIZE << order) < frag_info->frag_size))
65                         return -ENOMEM;
66         }
67         dma = dma_map_page(priv->ddev, page, 0, PAGE_SIZE << order,
68                            PCI_DMA_FROMDEVICE);
69         if (dma_mapping_error(priv->ddev, dma)) {
70                 put_page(page);
71                 return -ENOMEM;
72         }
73         page_alloc->page_size = PAGE_SIZE << order;
74         page_alloc->page = page;
75         page_alloc->dma = dma;
76         page_alloc->page_offset = frag_info->frag_align;
77         /* Not doing get_page() for each frag is a big win
78          * on asymetric workloads.
79          */
80         atomic_set(&page->_count,
81                    page_alloc->page_size / frag_info->frag_stride);
82         return 0;
83 }
84
85 static int mlx4_en_alloc_frags(struct mlx4_en_priv *priv,
86                                struct mlx4_en_rx_desc *rx_desc,
87                                struct mlx4_en_rx_alloc *frags,
88                                struct mlx4_en_rx_alloc *ring_alloc,
89                                gfp_t gfp)
90 {
91         struct mlx4_en_rx_alloc page_alloc[MLX4_EN_MAX_RX_FRAGS];
92         const struct mlx4_en_frag_info *frag_info;
93         struct page *page;
94         dma_addr_t dma;
95         int i;
96
97         for (i = 0; i < priv->num_frags; i++) {
98                 frag_info = &priv->frag_info[i];
99                 page_alloc[i] = ring_alloc[i];
100                 page_alloc[i].page_offset += frag_info->frag_stride;
101
102                 if (page_alloc[i].page_offset + frag_info->frag_stride <=
103                     ring_alloc[i].page_size)
104                         continue;
105
106                 if (mlx4_alloc_pages(priv, &page_alloc[i], frag_info, gfp))
107                         goto out;
108         }
109
110         for (i = 0; i < priv->num_frags; i++) {
111                 frags[i] = ring_alloc[i];
112                 dma = ring_alloc[i].dma + ring_alloc[i].page_offset;
113                 ring_alloc[i] = page_alloc[i];
114                 rx_desc->data[i].addr = cpu_to_be64(dma);
115         }
116
117         return 0;
118
119 out:
120         while (i--) {
121                 frag_info = &priv->frag_info[i];
122                 if (page_alloc[i].page != ring_alloc[i].page) {
123                         dma_unmap_page(priv->ddev, page_alloc[i].dma,
124                                 page_alloc[i].page_size, PCI_DMA_FROMDEVICE);
125                         page = page_alloc[i].page;
126                         atomic_set(&page->_count, 1);
127                         put_page(page);
128                 }
129         }
130         return -ENOMEM;
131 }
132
133 static void mlx4_en_free_frag(struct mlx4_en_priv *priv,
134                               struct mlx4_en_rx_alloc *frags,
135                               int i)
136 {
137         const struct mlx4_en_frag_info *frag_info = &priv->frag_info[i];
138         u32 next_frag_end = frags[i].page_offset + 2 * frag_info->frag_stride;
139
140
141         if (next_frag_end > frags[i].page_size)
142                 dma_unmap_page(priv->ddev, frags[i].dma, frags[i].page_size,
143                                PCI_DMA_FROMDEVICE);
144
145         if (frags[i].page)
146                 put_page(frags[i].page);
147 }
148
149 static int mlx4_en_init_allocator(struct mlx4_en_priv *priv,
150                                   struct mlx4_en_rx_ring *ring)
151 {
152         int i;
153         struct mlx4_en_rx_alloc *page_alloc;
154
155         for (i = 0; i < priv->num_frags; i++) {
156                 const struct mlx4_en_frag_info *frag_info = &priv->frag_info[i];
157
158                 if (mlx4_alloc_pages(priv, &ring->page_alloc[i],
159                                      frag_info, GFP_KERNEL))
160                         goto out;
161         }
162         return 0;
163
164 out:
165         while (i--) {
166                 struct page *page;
167
168                 page_alloc = &ring->page_alloc[i];
169                 dma_unmap_page(priv->ddev, page_alloc->dma,
170                                page_alloc->page_size, PCI_DMA_FROMDEVICE);
171                 page = page_alloc->page;
172                 atomic_set(&page->_count, 1);
173                 put_page(page);
174                 page_alloc->page = NULL;
175         }
176         return -ENOMEM;
177 }
178
179 static void mlx4_en_destroy_allocator(struct mlx4_en_priv *priv,
180                                       struct mlx4_en_rx_ring *ring)
181 {
182         struct mlx4_en_rx_alloc *page_alloc;
183         int i;
184
185         for (i = 0; i < priv->num_frags; i++) {
186                 const struct mlx4_en_frag_info *frag_info = &priv->frag_info[i];
187
188                 page_alloc = &ring->page_alloc[i];
189                 en_dbg(DRV, priv, "Freeing allocator:%d count:%d\n",
190                        i, page_count(page_alloc->page));
191
192                 dma_unmap_page(priv->ddev, page_alloc->dma,
193                                 page_alloc->page_size, PCI_DMA_FROMDEVICE);
194                 while (page_alloc->page_offset + frag_info->frag_stride <
195                        page_alloc->page_size) {
196                         put_page(page_alloc->page);
197                         page_alloc->page_offset += frag_info->frag_stride;
198                 }
199                 page_alloc->page = NULL;
200         }
201 }
202
203 static void mlx4_en_init_rx_desc(struct mlx4_en_priv *priv,
204                                  struct mlx4_en_rx_ring *ring, int index)
205 {
206         struct mlx4_en_rx_desc *rx_desc = ring->buf + ring->stride * index;
207         int possible_frags;
208         int i;
209
210         /* Set size and memtype fields */
211         for (i = 0; i < priv->num_frags; i++) {
212                 rx_desc->data[i].byte_count =
213                         cpu_to_be32(priv->frag_info[i].frag_size);
214                 rx_desc->data[i].lkey = cpu_to_be32(priv->mdev->mr.key);
215         }
216
217         /* If the number of used fragments does not fill up the ring stride,
218          * remaining (unused) fragments must be padded with null address/size
219          * and a special memory key */
220         possible_frags = (ring->stride - sizeof(struct mlx4_en_rx_desc)) / DS_SIZE;
221         for (i = priv->num_frags; i < possible_frags; i++) {
222                 rx_desc->data[i].byte_count = 0;
223                 rx_desc->data[i].lkey = cpu_to_be32(MLX4_EN_MEMTYPE_PAD);
224                 rx_desc->data[i].addr = 0;
225         }
226 }
227
228 static int mlx4_en_prepare_rx_desc(struct mlx4_en_priv *priv,
229                                    struct mlx4_en_rx_ring *ring, int index,
230                                    gfp_t gfp)
231 {
232         struct mlx4_en_rx_desc *rx_desc = ring->buf + (index * ring->stride);
233         struct mlx4_en_rx_alloc *frags = ring->rx_info +
234                                         (index << priv->log_rx_info);
235
236         return mlx4_en_alloc_frags(priv, rx_desc, frags, ring->page_alloc, gfp);
237 }
238
239 static inline void mlx4_en_update_rx_prod_db(struct mlx4_en_rx_ring *ring)
240 {
241         *ring->wqres.db.db = cpu_to_be32(ring->prod & 0xffff);
242 }
243
244 static void mlx4_en_free_rx_desc(struct mlx4_en_priv *priv,
245                                  struct mlx4_en_rx_ring *ring,
246                                  int index)
247 {
248         struct mlx4_en_rx_alloc *frags;
249         int nr;
250
251         frags = ring->rx_info + (index << priv->log_rx_info);
252         for (nr = 0; nr < priv->num_frags; nr++) {
253                 en_dbg(DRV, priv, "Freeing fragment:%d\n", nr);
254                 mlx4_en_free_frag(priv, frags, nr);
255         }
256 }
257
258 static int mlx4_en_fill_rx_buffers(struct mlx4_en_priv *priv)
259 {
260         struct mlx4_en_rx_ring *ring;
261         int ring_ind;
262         int buf_ind;
263         int new_size;
264
265         for (buf_ind = 0; buf_ind < priv->prof->rx_ring_size; buf_ind++) {
266                 for (ring_ind = 0; ring_ind < priv->rx_ring_num; ring_ind++) {
267                         ring = priv->rx_ring[ring_ind];
268
269                         if (mlx4_en_prepare_rx_desc(priv, ring,
270                                                     ring->actual_size,
271                                                     GFP_KERNEL)) {
272                                 if (ring->actual_size < MLX4_EN_MIN_RX_SIZE) {
273                                         en_err(priv, "Failed to allocate "
274                                                      "enough rx buffers\n");
275                                         return -ENOMEM;
276                                 } else {
277                                         new_size = rounddown_pow_of_two(ring->actual_size);
278                                         en_warn(priv, "Only %d buffers allocated "
279                                                       "reducing ring size to %d",
280                                                 ring->actual_size, new_size);
281                                         goto reduce_rings;
282                                 }
283                         }
284                         ring->actual_size++;
285                         ring->prod++;
286                 }
287         }
288         return 0;
289
290 reduce_rings:
291         for (ring_ind = 0; ring_ind < priv->rx_ring_num; ring_ind++) {
292                 ring = priv->rx_ring[ring_ind];
293                 while (ring->actual_size > new_size) {
294                         ring->actual_size--;
295                         ring->prod--;
296                         mlx4_en_free_rx_desc(priv, ring, ring->actual_size);
297                 }
298         }
299
300         return 0;
301 }
302
303 static void mlx4_en_free_rx_buf(struct mlx4_en_priv *priv,
304                                 struct mlx4_en_rx_ring *ring)
305 {
306         int index;
307
308         en_dbg(DRV, priv, "Freeing Rx buf - cons:%d prod:%d\n",
309                ring->cons, ring->prod);
310
311         /* Unmap and free Rx buffers */
312         BUG_ON((u32) (ring->prod - ring->cons) > ring->actual_size);
313         while (ring->cons != ring->prod) {
314                 index = ring->cons & ring->size_mask;
315                 en_dbg(DRV, priv, "Processing descriptor:%d\n", index);
316                 mlx4_en_free_rx_desc(priv, ring, index);
317                 ++ring->cons;
318         }
319 }
320
321 void mlx4_en_set_num_rx_rings(struct mlx4_en_dev *mdev)
322 {
323         int i;
324         int num_of_eqs;
325         struct mlx4_dev *dev = mdev->dev;
326
327         mlx4_foreach_port(i, dev, MLX4_PORT_TYPE_ETH) {
328                 if (!dev->caps.comp_pool)
329                         num_of_eqs = max_t(int, MIN_RX_RINGS,
330                                            min_t(int,
331                                                  dev->caps.num_comp_vectors,
332                                                  DEF_RX_RINGS));
333                 else
334                         num_of_eqs = min_t(int, MAX_MSIX_P_PORT,
335                                            dev->caps.comp_pool/
336                                            dev->caps.num_ports) - 1;
337
338                 mdev->profile.prof[i].rx_ring_num =
339                         rounddown_pow_of_two(num_of_eqs);
340         }
341 }
342
343 int mlx4_en_create_rx_ring(struct mlx4_en_priv *priv,
344                            struct mlx4_en_rx_ring **pring,
345                            u32 size, u16 stride, int node)
346 {
347         struct mlx4_en_dev *mdev = priv->mdev;
348         struct mlx4_en_rx_ring *ring;
349         int err = -ENOMEM;
350         int tmp;
351
352         ring = kzalloc_node(sizeof(*ring), GFP_KERNEL, node);
353         if (!ring) {
354                 ring = kzalloc(sizeof(*ring), GFP_KERNEL);
355                 if (!ring) {
356                         en_err(priv, "Failed to allocate RX ring structure\n");
357                         return -ENOMEM;
358                 }
359         }
360
361         ring->prod = 0;
362         ring->cons = 0;
363         ring->size = size;
364         ring->size_mask = size - 1;
365         ring->stride = stride;
366         ring->log_stride = ffs(ring->stride) - 1;
367         ring->buf_size = ring->size * ring->stride + TXBB_SIZE;
368
369         tmp = size * roundup_pow_of_two(MLX4_EN_MAX_RX_FRAGS *
370                                         sizeof(struct mlx4_en_rx_alloc));
371         ring->rx_info = vmalloc_node(tmp, node);
372         if (!ring->rx_info) {
373                 ring->rx_info = vmalloc(tmp);
374                 if (!ring->rx_info) {
375                         err = -ENOMEM;
376                         goto err_ring;
377                 }
378         }
379
380         en_dbg(DRV, priv, "Allocated rx_info ring at addr:%p size:%d\n",
381                  ring->rx_info, tmp);
382
383         /* Allocate HW buffers on provided NUMA node */
384         set_dev_node(&mdev->dev->pdev->dev, node);
385         err = mlx4_alloc_hwq_res(mdev->dev, &ring->wqres,
386                                  ring->buf_size, 2 * PAGE_SIZE);
387         set_dev_node(&mdev->dev->pdev->dev, mdev->dev->numa_node);
388         if (err)
389                 goto err_info;
390
391         err = mlx4_en_map_buffer(&ring->wqres.buf);
392         if (err) {
393                 en_err(priv, "Failed to map RX buffer\n");
394                 goto err_hwq;
395         }
396         ring->buf = ring->wqres.buf.direct.buf;
397
398         ring->hwtstamp_rx_filter = priv->hwtstamp_config.rx_filter;
399
400         *pring = ring;
401         return 0;
402
403 err_hwq:
404         mlx4_free_hwq_res(mdev->dev, &ring->wqres, ring->buf_size);
405 err_info:
406         vfree(ring->rx_info);
407         ring->rx_info = NULL;
408 err_ring:
409         kfree(ring);
410         *pring = NULL;
411
412         return err;
413 }
414
415 int mlx4_en_activate_rx_rings(struct mlx4_en_priv *priv)
416 {
417         struct mlx4_en_rx_ring *ring;
418         int i;
419         int ring_ind;
420         int err;
421         int stride = roundup_pow_of_two(sizeof(struct mlx4_en_rx_desc) +
422                                         DS_SIZE * priv->num_frags);
423
424         for (ring_ind = 0; ring_ind < priv->rx_ring_num; ring_ind++) {
425                 ring = priv->rx_ring[ring_ind];
426
427                 ring->prod = 0;
428                 ring->cons = 0;
429                 ring->actual_size = 0;
430                 ring->cqn = priv->rx_cq[ring_ind]->mcq.cqn;
431
432                 ring->stride = stride;
433                 if (ring->stride <= TXBB_SIZE)
434                         ring->buf += TXBB_SIZE;
435
436                 ring->log_stride = ffs(ring->stride) - 1;
437                 ring->buf_size = ring->size * ring->stride;
438
439                 memset(ring->buf, 0, ring->buf_size);
440                 mlx4_en_update_rx_prod_db(ring);
441
442                 /* Initialize all descriptors */
443                 for (i = 0; i < ring->size; i++)
444                         mlx4_en_init_rx_desc(priv, ring, i);
445
446                 /* Initialize page allocators */
447                 err = mlx4_en_init_allocator(priv, ring);
448                 if (err) {
449                         en_err(priv, "Failed initializing ring allocator\n");
450                         if (ring->stride <= TXBB_SIZE)
451                                 ring->buf -= TXBB_SIZE;
452                         ring_ind--;
453                         goto err_allocator;
454                 }
455         }
456         err = mlx4_en_fill_rx_buffers(priv);
457         if (err)
458                 goto err_buffers;
459
460         for (ring_ind = 0; ring_ind < priv->rx_ring_num; ring_ind++) {
461                 ring = priv->rx_ring[ring_ind];
462
463                 ring->size_mask = ring->actual_size - 1;
464                 mlx4_en_update_rx_prod_db(ring);
465         }
466
467         return 0;
468
469 err_buffers:
470         for (ring_ind = 0; ring_ind < priv->rx_ring_num; ring_ind++)
471                 mlx4_en_free_rx_buf(priv, priv->rx_ring[ring_ind]);
472
473         ring_ind = priv->rx_ring_num - 1;
474 err_allocator:
475         while (ring_ind >= 0) {
476                 if (priv->rx_ring[ring_ind]->stride <= TXBB_SIZE)
477                         priv->rx_ring[ring_ind]->buf -= TXBB_SIZE;
478                 mlx4_en_destroy_allocator(priv, priv->rx_ring[ring_ind]);
479                 ring_ind--;
480         }
481         return err;
482 }
483
484 void mlx4_en_destroy_rx_ring(struct mlx4_en_priv *priv,
485                              struct mlx4_en_rx_ring **pring,
486                              u32 size, u16 stride)
487 {
488         struct mlx4_en_dev *mdev = priv->mdev;
489         struct mlx4_en_rx_ring *ring = *pring;
490
491         mlx4_en_unmap_buffer(&ring->wqres.buf);
492         mlx4_free_hwq_res(mdev->dev, &ring->wqres, size * stride + TXBB_SIZE);
493         vfree(ring->rx_info);
494         ring->rx_info = NULL;
495         kfree(ring);
496         *pring = NULL;
497 #ifdef CONFIG_RFS_ACCEL
498         mlx4_en_cleanup_filters(priv);
499 #endif
500 }
501
502 void mlx4_en_deactivate_rx_ring(struct mlx4_en_priv *priv,
503                                 struct mlx4_en_rx_ring *ring)
504 {
505         mlx4_en_free_rx_buf(priv, ring);
506         if (ring->stride <= TXBB_SIZE)
507                 ring->buf -= TXBB_SIZE;
508         mlx4_en_destroy_allocator(priv, ring);
509 }
510
511
512 static int mlx4_en_complete_rx_desc(struct mlx4_en_priv *priv,
513                                     struct mlx4_en_rx_desc *rx_desc,
514                                     struct mlx4_en_rx_alloc *frags,
515                                     struct sk_buff *skb,
516                                     int length)
517 {
518         struct skb_frag_struct *skb_frags_rx = skb_shinfo(skb)->frags;
519         struct mlx4_en_frag_info *frag_info;
520         int nr;
521         dma_addr_t dma;
522
523         /* Collect used fragments while replacing them in the HW descriptors */
524         for (nr = 0; nr < priv->num_frags; nr++) {
525                 frag_info = &priv->frag_info[nr];
526                 if (length <= frag_info->frag_prefix_size)
527                         break;
528                 if (!frags[nr].page)
529                         goto fail;
530
531                 dma = be64_to_cpu(rx_desc->data[nr].addr);
532                 dma_sync_single_for_cpu(priv->ddev, dma, frag_info->frag_size,
533                                         DMA_FROM_DEVICE);
534
535                 /* Save page reference in skb */
536                 __skb_frag_set_page(&skb_frags_rx[nr], frags[nr].page);
537                 skb_frag_size_set(&skb_frags_rx[nr], frag_info->frag_size);
538                 skb_frags_rx[nr].page_offset = frags[nr].page_offset;
539                 skb->truesize += frag_info->frag_stride;
540                 frags[nr].page = NULL;
541         }
542         /* Adjust size of last fragment to match actual length */
543         if (nr > 0)
544                 skb_frag_size_set(&skb_frags_rx[nr - 1],
545                         length - priv->frag_info[nr - 1].frag_prefix_size);
546         return nr;
547
548 fail:
549         while (nr > 0) {
550                 nr--;
551                 __skb_frag_unref(&skb_frags_rx[nr]);
552         }
553         return 0;
554 }
555
556
557 static struct sk_buff *mlx4_en_rx_skb(struct mlx4_en_priv *priv,
558                                       struct mlx4_en_rx_desc *rx_desc,
559                                       struct mlx4_en_rx_alloc *frags,
560                                       unsigned int length)
561 {
562         struct sk_buff *skb;
563         void *va;
564         int used_frags;
565         dma_addr_t dma;
566
567         skb = netdev_alloc_skb(priv->dev, SMALL_PACKET_SIZE + NET_IP_ALIGN);
568         if (!skb) {
569                 en_dbg(RX_ERR, priv, "Failed allocating skb\n");
570                 return NULL;
571         }
572         skb_reserve(skb, NET_IP_ALIGN);
573         skb->len = length;
574
575         /* Get pointer to first fragment so we could copy the headers into the
576          * (linear part of the) skb */
577         va = page_address(frags[0].page) + frags[0].page_offset;
578
579         if (length <= SMALL_PACKET_SIZE) {
580                 /* We are copying all relevant data to the skb - temporarily
581                  * sync buffers for the copy */
582                 dma = be64_to_cpu(rx_desc->data[0].addr);
583                 dma_sync_single_for_cpu(priv->ddev, dma, length,
584                                         DMA_FROM_DEVICE);
585                 skb_copy_to_linear_data(skb, va, length);
586                 skb->tail += length;
587         } else {
588                 /* Move relevant fragments to skb */
589                 used_frags = mlx4_en_complete_rx_desc(priv, rx_desc, frags,
590                                                         skb, length);
591                 if (unlikely(!used_frags)) {
592                         kfree_skb(skb);
593                         return NULL;
594                 }
595                 skb_shinfo(skb)->nr_frags = used_frags;
596
597                 /* Copy headers into the skb linear buffer */
598                 memcpy(skb->data, va, HEADER_COPY_SIZE);
599                 skb->tail += HEADER_COPY_SIZE;
600
601                 /* Skip headers in first fragment */
602                 skb_shinfo(skb)->frags[0].page_offset += HEADER_COPY_SIZE;
603
604                 /* Adjust size of first fragment */
605                 skb_frag_size_sub(&skb_shinfo(skb)->frags[0], HEADER_COPY_SIZE);
606                 skb->data_len = length - HEADER_COPY_SIZE;
607         }
608         return skb;
609 }
610
611 static void validate_loopback(struct mlx4_en_priv *priv, struct sk_buff *skb)
612 {
613         int i;
614         int offset = ETH_HLEN;
615
616         for (i = 0; i < MLX4_LOOPBACK_TEST_PAYLOAD; i++, offset++) {
617                 if (*(skb->data + offset) != (unsigned char) (i & 0xff))
618                         goto out_loopback;
619         }
620         /* Loopback found */
621         priv->loopback_ok = 1;
622
623 out_loopback:
624         dev_kfree_skb_any(skb);
625 }
626
627 static void mlx4_en_refill_rx_buffers(struct mlx4_en_priv *priv,
628                                      struct mlx4_en_rx_ring *ring)
629 {
630         int index = ring->prod & ring->size_mask;
631
632         while ((u32) (ring->prod - ring->cons) < ring->actual_size) {
633                 if (mlx4_en_prepare_rx_desc(priv, ring, index, GFP_ATOMIC))
634                         break;
635                 ring->prod++;
636                 index = ring->prod & ring->size_mask;
637         }
638 }
639
640 int mlx4_en_process_rx_cq(struct net_device *dev, struct mlx4_en_cq *cq, int budget)
641 {
642         struct mlx4_en_priv *priv = netdev_priv(dev);
643         struct mlx4_en_dev *mdev = priv->mdev;
644         struct mlx4_cqe *cqe;
645         struct mlx4_en_rx_ring *ring = priv->rx_ring[cq->ring];
646         struct mlx4_en_rx_alloc *frags;
647         struct mlx4_en_rx_desc *rx_desc;
648         struct sk_buff *skb;
649         int index;
650         int nr;
651         unsigned int length;
652         int polled = 0;
653         int ip_summed;
654         int factor = priv->cqe_factor;
655         u64 timestamp;
656         bool l2_tunnel;
657
658         if (!priv->port_up)
659                 return 0;
660
661         /* We assume a 1:1 mapping between CQEs and Rx descriptors, so Rx
662          * descriptor offset can be deduced from the CQE index instead of
663          * reading 'cqe->index' */
664         index = cq->mcq.cons_index & ring->size_mask;
665         cqe = &cq->buf[(index << factor) + factor];
666
667         /* Process all completed CQEs */
668         while (XNOR(cqe->owner_sr_opcode & MLX4_CQE_OWNER_MASK,
669                     cq->mcq.cons_index & cq->size)) {
670
671                 frags = ring->rx_info + (index << priv->log_rx_info);
672                 rx_desc = ring->buf + (index << ring->log_stride);
673
674                 /*
675                  * make sure we read the CQE after we read the ownership bit
676                  */
677                 rmb();
678
679                 /* Drop packet on bad receive or bad checksum */
680                 if (unlikely((cqe->owner_sr_opcode & MLX4_CQE_OPCODE_MASK) ==
681                                                 MLX4_CQE_OPCODE_ERROR)) {
682                         en_err(priv, "CQE completed in error - vendor "
683                                   "syndrom:%d syndrom:%d\n",
684                                   ((struct mlx4_err_cqe *) cqe)->vendor_err_syndrome,
685                                   ((struct mlx4_err_cqe *) cqe)->syndrome);
686                         goto next;
687                 }
688                 if (unlikely(cqe->badfcs_enc & MLX4_CQE_BAD_FCS)) {
689                         en_dbg(RX_ERR, priv, "Accepted frame with bad FCS\n");
690                         goto next;
691                 }
692
693                 /* Check if we need to drop the packet if SRIOV is not enabled
694                  * and not performing the selftest or flb disabled
695                  */
696                 if (priv->flags & MLX4_EN_FLAG_RX_FILTER_NEEDED) {
697                         struct ethhdr *ethh;
698                         dma_addr_t dma;
699                         /* Get pointer to first fragment since we haven't
700                          * skb yet and cast it to ethhdr struct
701                          */
702                         dma = be64_to_cpu(rx_desc->data[0].addr);
703                         dma_sync_single_for_cpu(priv->ddev, dma, sizeof(*ethh),
704                                                 DMA_FROM_DEVICE);
705                         ethh = (struct ethhdr *)(page_address(frags[0].page) +
706                                                  frags[0].page_offset);
707
708                         if (is_multicast_ether_addr(ethh->h_dest)) {
709                                 struct mlx4_mac_entry *entry;
710                                 struct hlist_head *bucket;
711                                 unsigned int mac_hash;
712
713                                 /* Drop the packet, since HW loopback-ed it */
714                                 mac_hash = ethh->h_source[MLX4_EN_MAC_HASH_IDX];
715                                 bucket = &priv->mac_hash[mac_hash];
716                                 rcu_read_lock();
717                                 hlist_for_each_entry_rcu(entry, bucket, hlist) {
718                                         if (ether_addr_equal_64bits(entry->mac,
719                                                                     ethh->h_source)) {
720                                                 rcu_read_unlock();
721                                                 goto next;
722                                         }
723                                 }
724                                 rcu_read_unlock();
725                         }
726                 }
727
728                 /*
729                  * Packet is OK - process it.
730                  */
731                 length = be32_to_cpu(cqe->byte_cnt);
732                 length -= ring->fcs_del;
733                 ring->bytes += length;
734                 ring->packets++;
735                 l2_tunnel = (dev->hw_enc_features & NETIF_F_RXCSUM) &&
736                         (cqe->vlan_my_qpn & cpu_to_be32(MLX4_CQE_L2_TUNNEL));
737
738                 if (likely(dev->features & NETIF_F_RXCSUM)) {
739                         if ((cqe->status & cpu_to_be16(MLX4_CQE_STATUS_IPOK)) &&
740                             (cqe->checksum == cpu_to_be16(0xffff))) {
741                                 ring->csum_ok++;
742                                 /* This packet is eligible for GRO if it is:
743                                  * - DIX Ethernet (type interpretation)
744                                  * - TCP/IP (v4)
745                                  * - without IP options
746                                  * - not an IP fragment
747                                  * - no LLS polling in progress
748                                  */
749                                 if (!mlx4_en_cq_busy_polling(cq) &&
750                                     (dev->features & NETIF_F_GRO)) {
751                                         struct sk_buff *gro_skb = napi_get_frags(&cq->napi);
752                                         if (!gro_skb)
753                                                 goto next;
754
755                                         nr = mlx4_en_complete_rx_desc(priv,
756                                                 rx_desc, frags, gro_skb,
757                                                 length);
758                                         if (!nr)
759                                                 goto next;
760
761                                         skb_shinfo(gro_skb)->nr_frags = nr;
762                                         gro_skb->len = length;
763                                         gro_skb->data_len = length;
764                                         gro_skb->ip_summed = CHECKSUM_UNNECESSARY;
765
766                                         if (l2_tunnel)
767                                                 gro_skb->encapsulation = 1;
768                                         if ((cqe->vlan_my_qpn &
769                                             cpu_to_be32(MLX4_CQE_VLAN_PRESENT_MASK)) &&
770                                             (dev->features & NETIF_F_HW_VLAN_CTAG_RX)) {
771                                                 u16 vid = be16_to_cpu(cqe->sl_vid);
772
773                                                 __vlan_hwaccel_put_tag(gro_skb, htons(ETH_P_8021Q), vid);
774                                         }
775
776                                         if (dev->features & NETIF_F_RXHASH)
777                                                 skb_set_hash(gro_skb,
778                                                              be32_to_cpu(cqe->immed_rss_invalid),
779                                                              PKT_HASH_TYPE_L3);
780
781                                         skb_record_rx_queue(gro_skb, cq->ring);
782
783                                         if (ring->hwtstamp_rx_filter == HWTSTAMP_FILTER_ALL) {
784                                                 timestamp = mlx4_en_get_cqe_ts(cqe);
785                                                 mlx4_en_fill_hwtstamps(mdev,
786                                                                        skb_hwtstamps(gro_skb),
787                                                                        timestamp);
788                                         }
789
790                                         napi_gro_frags(&cq->napi);
791                                         goto next;
792                                 }
793
794                                 /* GRO not possible, complete processing here */
795                                 ip_summed = CHECKSUM_UNNECESSARY;
796                         } else {
797                                 ip_summed = CHECKSUM_NONE;
798                                 ring->csum_none++;
799                         }
800                 } else {
801                         ip_summed = CHECKSUM_NONE;
802                         ring->csum_none++;
803                 }
804
805                 skb = mlx4_en_rx_skb(priv, rx_desc, frags, length);
806                 if (!skb) {
807                         priv->stats.rx_dropped++;
808                         goto next;
809                 }
810
811                 if (unlikely(priv->validate_loopback)) {
812                         validate_loopback(priv, skb);
813                         goto next;
814                 }
815
816                 skb->ip_summed = ip_summed;
817                 skb->protocol = eth_type_trans(skb, dev);
818                 skb_record_rx_queue(skb, cq->ring);
819
820                 if (l2_tunnel)
821                         skb->encapsulation = 1;
822
823                 if (dev->features & NETIF_F_RXHASH)
824                         skb_set_hash(skb,
825                                      be32_to_cpu(cqe->immed_rss_invalid),
826                                      PKT_HASH_TYPE_L3);
827
828                 if ((be32_to_cpu(cqe->vlan_my_qpn) &
829                     MLX4_CQE_VLAN_PRESENT_MASK) &&
830                     (dev->features & NETIF_F_HW_VLAN_CTAG_RX))
831                         __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), be16_to_cpu(cqe->sl_vid));
832
833                 if (ring->hwtstamp_rx_filter == HWTSTAMP_FILTER_ALL) {
834                         timestamp = mlx4_en_get_cqe_ts(cqe);
835                         mlx4_en_fill_hwtstamps(mdev, skb_hwtstamps(skb),
836                                                timestamp);
837                 }
838
839                 skb_mark_napi_id(skb, &cq->napi);
840
841                 if (!mlx4_en_cq_busy_polling(cq))
842                         napi_gro_receive(&cq->napi, skb);
843                 else
844                         netif_receive_skb(skb);
845
846 next:
847                 for (nr = 0; nr < priv->num_frags; nr++)
848                         mlx4_en_free_frag(priv, frags, nr);
849
850                 ++cq->mcq.cons_index;
851                 index = (cq->mcq.cons_index) & ring->size_mask;
852                 cqe = &cq->buf[(index << factor) + factor];
853                 if (++polled == budget)
854                         goto out;
855         }
856
857 out:
858         AVG_PERF_COUNTER(priv->pstats.rx_coal_avg, polled);
859         mlx4_cq_set_ci(&cq->mcq);
860         wmb(); /* ensure HW sees CQ consumer before we post new buffers */
861         ring->cons = cq->mcq.cons_index;
862         mlx4_en_refill_rx_buffers(priv, ring);
863         mlx4_en_update_rx_prod_db(ring);
864         return polled;
865 }
866
867
868 void mlx4_en_rx_irq(struct mlx4_cq *mcq)
869 {
870         struct mlx4_en_cq *cq = container_of(mcq, struct mlx4_en_cq, mcq);
871         struct mlx4_en_priv *priv = netdev_priv(cq->dev);
872
873         if (priv->port_up)
874                 napi_schedule(&cq->napi);
875         else
876                 mlx4_en_arm_cq(priv, cq);
877 }
878
879 /* Rx CQ polling - called by NAPI */
880 int mlx4_en_poll_rx_cq(struct napi_struct *napi, int budget)
881 {
882         struct mlx4_en_cq *cq = container_of(napi, struct mlx4_en_cq, napi);
883         struct net_device *dev = cq->dev;
884         struct mlx4_en_priv *priv = netdev_priv(dev);
885         int done;
886
887         if (!mlx4_en_cq_lock_napi(cq))
888                 return budget;
889
890         done = mlx4_en_process_rx_cq(dev, cq, budget);
891
892         mlx4_en_cq_unlock_napi(cq);
893
894         /* If we used up all the quota - we're probably not done yet... */
895         if (done == budget)
896                 INC_PERF_COUNTER(priv->pstats.napi_quota);
897         else {
898                 /* Done for now */
899                 napi_complete(napi);
900                 mlx4_en_arm_cq(priv, cq);
901         }
902         return done;
903 }
904
905 static const int frag_sizes[] = {
906         FRAG_SZ0,
907         FRAG_SZ1,
908         FRAG_SZ2,
909         FRAG_SZ3
910 };
911
912 void mlx4_en_calc_rx_buf(struct net_device *dev)
913 {
914         struct mlx4_en_priv *priv = netdev_priv(dev);
915         int eff_mtu = dev->mtu + ETH_HLEN + VLAN_HLEN + ETH_LLC_SNAP_SIZE;
916         int buf_size = 0;
917         int i = 0;
918
919         while (buf_size < eff_mtu) {
920                 priv->frag_info[i].frag_size =
921                         (eff_mtu > buf_size + frag_sizes[i]) ?
922                                 frag_sizes[i] : eff_mtu - buf_size;
923                 priv->frag_info[i].frag_prefix_size = buf_size;
924                 if (!i) {
925                         priv->frag_info[i].frag_align = NET_IP_ALIGN;
926                         priv->frag_info[i].frag_stride =
927                                 ALIGN(frag_sizes[i] + NET_IP_ALIGN, SMP_CACHE_BYTES);
928                 } else {
929                         priv->frag_info[i].frag_align = 0;
930                         priv->frag_info[i].frag_stride =
931                                 ALIGN(frag_sizes[i], SMP_CACHE_BYTES);
932                 }
933                 buf_size += priv->frag_info[i].frag_size;
934                 i++;
935         }
936
937         priv->num_frags = i;
938         priv->rx_skb_size = eff_mtu;
939         priv->log_rx_info = ROUNDUP_LOG2(i * sizeof(struct mlx4_en_rx_alloc));
940
941         en_dbg(DRV, priv, "Rx buffer scatter-list (effective-mtu:%d "
942                   "num_frags:%d):\n", eff_mtu, priv->num_frags);
943         for (i = 0; i < priv->num_frags; i++) {
944                 en_err(priv,
945                        "  frag:%d - size:%d prefix:%d align:%d stride:%d\n",
946                        i,
947                        priv->frag_info[i].frag_size,
948                        priv->frag_info[i].frag_prefix_size,
949                        priv->frag_info[i].frag_align,
950                        priv->frag_info[i].frag_stride);
951         }
952 }
953
954 /* RSS related functions */
955
956 static int mlx4_en_config_rss_qp(struct mlx4_en_priv *priv, int qpn,
957                                  struct mlx4_en_rx_ring *ring,
958                                  enum mlx4_qp_state *state,
959                                  struct mlx4_qp *qp)
960 {
961         struct mlx4_en_dev *mdev = priv->mdev;
962         struct mlx4_qp_context *context;
963         int err = 0;
964
965         context = kmalloc(sizeof(*context), GFP_KERNEL);
966         if (!context)
967                 return -ENOMEM;
968
969         err = mlx4_qp_alloc(mdev->dev, qpn, qp);
970         if (err) {
971                 en_err(priv, "Failed to allocate qp #%x\n", qpn);
972                 goto out;
973         }
974         qp->event = mlx4_en_sqp_event;
975
976         memset(context, 0, sizeof *context);
977         mlx4_en_fill_qp_context(priv, ring->actual_size, ring->stride, 0, 0,
978                                 qpn, ring->cqn, -1, context);
979         context->db_rec_addr = cpu_to_be64(ring->wqres.db.dma);
980
981         /* Cancel FCS removal if FW allows */
982         if (mdev->dev->caps.flags & MLX4_DEV_CAP_FLAG_FCS_KEEP) {
983                 context->param3 |= cpu_to_be32(1 << 29);
984                 ring->fcs_del = ETH_FCS_LEN;
985         } else
986                 ring->fcs_del = 0;
987
988         err = mlx4_qp_to_ready(mdev->dev, &ring->wqres.mtt, context, qp, state);
989         if (err) {
990                 mlx4_qp_remove(mdev->dev, qp);
991                 mlx4_qp_free(mdev->dev, qp);
992         }
993         mlx4_en_update_rx_prod_db(ring);
994 out:
995         kfree(context);
996         return err;
997 }
998
999 int mlx4_en_create_drop_qp(struct mlx4_en_priv *priv)
1000 {
1001         int err;
1002         u32 qpn;
1003
1004         err = mlx4_qp_reserve_range(priv->mdev->dev, 1, 1, &qpn);
1005         if (err) {
1006                 en_err(priv, "Failed reserving drop qpn\n");
1007                 return err;
1008         }
1009         err = mlx4_qp_alloc(priv->mdev->dev, qpn, &priv->drop_qp);
1010         if (err) {
1011                 en_err(priv, "Failed allocating drop qp\n");
1012                 mlx4_qp_release_range(priv->mdev->dev, qpn, 1);
1013                 return err;
1014         }
1015
1016         return 0;
1017 }
1018
1019 void mlx4_en_destroy_drop_qp(struct mlx4_en_priv *priv)
1020 {
1021         u32 qpn;
1022
1023         qpn = priv->drop_qp.qpn;
1024         mlx4_qp_remove(priv->mdev->dev, &priv->drop_qp);
1025         mlx4_qp_free(priv->mdev->dev, &priv->drop_qp);
1026         mlx4_qp_release_range(priv->mdev->dev, qpn, 1);
1027 }
1028
1029 /* Allocate rx qp's and configure them according to rss map */
1030 int mlx4_en_config_rss_steer(struct mlx4_en_priv *priv)
1031 {
1032         struct mlx4_en_dev *mdev = priv->mdev;
1033         struct mlx4_en_rss_map *rss_map = &priv->rss_map;
1034         struct mlx4_qp_context context;
1035         struct mlx4_rss_context *rss_context;
1036         int rss_rings;
1037         void *ptr;
1038         u8 rss_mask = (MLX4_RSS_IPV4 | MLX4_RSS_TCP_IPV4 | MLX4_RSS_IPV6 |
1039                         MLX4_RSS_TCP_IPV6);
1040         int i, qpn;
1041         int err = 0;
1042         int good_qps = 0;
1043         static const u32 rsskey[10] = { 0xD181C62C, 0xF7F4DB5B, 0x1983A2FC,
1044                                 0x943E1ADB, 0xD9389E6B, 0xD1039C2C, 0xA74499AD,
1045                                 0x593D56D9, 0xF3253C06, 0x2ADC1FFC};
1046
1047         en_dbg(DRV, priv, "Configuring rss steering\n");
1048         err = mlx4_qp_reserve_range(mdev->dev, priv->rx_ring_num,
1049                                     priv->rx_ring_num,
1050                                     &rss_map->base_qpn);
1051         if (err) {
1052                 en_err(priv, "Failed reserving %d qps\n", priv->rx_ring_num);
1053                 return err;
1054         }
1055
1056         for (i = 0; i < priv->rx_ring_num; i++) {
1057                 qpn = rss_map->base_qpn + i;
1058                 err = mlx4_en_config_rss_qp(priv, qpn, priv->rx_ring[i],
1059                                             &rss_map->state[i],
1060                                             &rss_map->qps[i]);
1061                 if (err)
1062                         goto rss_err;
1063
1064                 ++good_qps;
1065         }
1066
1067         /* Configure RSS indirection qp */
1068         err = mlx4_qp_alloc(mdev->dev, priv->base_qpn, &rss_map->indir_qp);
1069         if (err) {
1070                 en_err(priv, "Failed to allocate RSS indirection QP\n");
1071                 goto rss_err;
1072         }
1073         rss_map->indir_qp.event = mlx4_en_sqp_event;
1074         mlx4_en_fill_qp_context(priv, 0, 0, 0, 1, priv->base_qpn,
1075                                 priv->rx_ring[0]->cqn, -1, &context);
1076
1077         if (!priv->prof->rss_rings || priv->prof->rss_rings > priv->rx_ring_num)
1078                 rss_rings = priv->rx_ring_num;
1079         else
1080                 rss_rings = priv->prof->rss_rings;
1081
1082         ptr = ((void *) &context) + offsetof(struct mlx4_qp_context, pri_path)
1083                                         + MLX4_RSS_OFFSET_IN_QPC_PRI_PATH;
1084         rss_context = ptr;
1085         rss_context->base_qpn = cpu_to_be32(ilog2(rss_rings) << 24 |
1086                                             (rss_map->base_qpn));
1087         rss_context->default_qpn = cpu_to_be32(rss_map->base_qpn);
1088         if (priv->mdev->profile.udp_rss) {
1089                 rss_mask |=  MLX4_RSS_UDP_IPV4 | MLX4_RSS_UDP_IPV6;
1090                 rss_context->base_qpn_udp = rss_context->default_qpn;
1091         }
1092
1093         if (mdev->dev->caps.tunnel_offload_mode == MLX4_TUNNEL_OFFLOAD_MODE_VXLAN) {
1094                 en_info(priv, "Setting RSS context tunnel type to RSS on inner headers\n");
1095                 rss_mask |= MLX4_RSS_BY_INNER_HEADERS;
1096         }
1097
1098         rss_context->flags = rss_mask;
1099         rss_context->hash_fn = MLX4_RSS_HASH_TOP;
1100         for (i = 0; i < 10; i++)
1101                 rss_context->rss_key[i] = cpu_to_be32(rsskey[i]);
1102
1103         err = mlx4_qp_to_ready(mdev->dev, &priv->res.mtt, &context,
1104                                &rss_map->indir_qp, &rss_map->indir_state);
1105         if (err)
1106                 goto indir_err;
1107
1108         return 0;
1109
1110 indir_err:
1111         mlx4_qp_modify(mdev->dev, NULL, rss_map->indir_state,
1112                        MLX4_QP_STATE_RST, NULL, 0, 0, &rss_map->indir_qp);
1113         mlx4_qp_remove(mdev->dev, &rss_map->indir_qp);
1114         mlx4_qp_free(mdev->dev, &rss_map->indir_qp);
1115 rss_err:
1116         for (i = 0; i < good_qps; i++) {
1117                 mlx4_qp_modify(mdev->dev, NULL, rss_map->state[i],
1118                                MLX4_QP_STATE_RST, NULL, 0, 0, &rss_map->qps[i]);
1119                 mlx4_qp_remove(mdev->dev, &rss_map->qps[i]);
1120                 mlx4_qp_free(mdev->dev, &rss_map->qps[i]);
1121         }
1122         mlx4_qp_release_range(mdev->dev, rss_map->base_qpn, priv->rx_ring_num);
1123         return err;
1124 }
1125
1126 void mlx4_en_release_rss_steer(struct mlx4_en_priv *priv)
1127 {
1128         struct mlx4_en_dev *mdev = priv->mdev;
1129         struct mlx4_en_rss_map *rss_map = &priv->rss_map;
1130         int i;
1131
1132         mlx4_qp_modify(mdev->dev, NULL, rss_map->indir_state,
1133                        MLX4_QP_STATE_RST, NULL, 0, 0, &rss_map->indir_qp);
1134         mlx4_qp_remove(mdev->dev, &rss_map->indir_qp);
1135         mlx4_qp_free(mdev->dev, &rss_map->indir_qp);
1136
1137         for (i = 0; i < priv->rx_ring_num; i++) {
1138                 mlx4_qp_modify(mdev->dev, NULL, rss_map->state[i],
1139                                MLX4_QP_STATE_RST, NULL, 0, 0, &rss_map->qps[i]);
1140                 mlx4_qp_remove(mdev->dev, &rss_map->qps[i]);
1141                 mlx4_qp_free(mdev->dev, &rss_map->qps[i]);
1142         }
1143         mlx4_qp_release_range(mdev->dev, rss_map->base_qpn, priv->rx_ring_num);
1144 }