drivers/net/ethernet/mellanox/mlx5/core/en_txrx.c

   1 /*
   2  * Copyright (c) 2015, 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 #include <linux/irq.h>
  34 #include "en.h"
  35
  36 static inline bool mlx5e_channel_no_affinity_change(struct mlx5e_channel *c)
  37 {
  38         int current_cpu = smp_processor_id();
  39         const struct cpumask *aff;
  40         struct irq_data *idata;
  41
  42         idata = irq_desc_get_irq_data(c->irq_desc);
  43         aff = irq_data_get_affinity_mask(idata);
  44         return cpumask_test_cpu(current_cpu, aff);
  45 }
  46
  47 static void mlx5e_handle_tx_dim(struct mlx5e_txqsq *sq)
  48 {
  49         struct net_dim_sample dim_sample;
  50
  51         if (unlikely(!MLX5E_TEST_BIT(sq->state, MLX5E_SQ_STATE_AM)))
  52                 return;
  53
  54         net_dim_sample(sq->cq.event_ctr, sq->stats.packets, sq->stats.bytes,
  55                        &dim_sample);
  56         net_dim(&sq->dim, dim_sample);
  57 }
  58
  59 static void mlx5e_handle_rx_dim(struct mlx5e_rq *rq)
  60 {
  61         struct net_dim_sample dim_sample;
  62
  63         if (unlikely(!MLX5E_TEST_BIT(rq->state, MLX5E_RQ_STATE_AM)))
  64                 return;
  65
  66         net_dim_sample(rq->cq.event_ctr, rq->stats.packets, rq->stats.bytes,
  67                        &dim_sample);
  68         net_dim(&rq->dim, dim_sample);
  69 }
  70
  71 int mlx5e_napi_poll(struct napi_struct *napi, int budget)
  72 {
  73         struct mlx5e_channel *c = container_of(napi, struct mlx5e_channel,
  74                                                napi);
  75         bool busy = false;
  76         int work_done = 0;
  77         int i;
  78
  79         for (i = 0; i < c->num_tc; i++)
  80                 busy |= mlx5e_poll_tx_cq(&c->sq[i].cq, budget);
  81
  82         if (c->xdp)
  83                 busy |= mlx5e_poll_xdpsq_cq(&c->rq.xdpsq.cq);
  84
  85         if (likely(budget)) { /* budget=0 means: don't poll rx rings */
  86                 work_done = mlx5e_poll_rx_cq(&c->rq.cq, budget);
  87                 busy |= work_done == budget;
  88         }
  89
  90         busy |= c->rq.post_wqes(&c->rq);
  91
  92         if (busy) {
  93                 if (likely(mlx5e_channel_no_affinity_change(c)))
  94                         return budget;
  95                 if (budget && work_done == budget)
  96                         work_done--;
  97         }
  98
  99         if (unlikely(!napi_complete_done(napi, work_done)))
 100                 return work_done;
 101
 102         for (i = 0; i < c->num_tc; i++) {
 103                 mlx5e_handle_tx_dim(&c->sq[i]);
 104                 mlx5e_cq_arm(&c->sq[i].cq);
 105         }
 106
 107         mlx5e_handle_rx_dim(&c->rq);
 108
 109         mlx5e_cq_arm(&c->rq.cq);
 110         mlx5e_cq_arm(&c->icosq.cq);
 111
 112         return work_done;
 113 }
 114
 115 void mlx5e_completion_event(struct mlx5_core_cq *mcq)
 116 {
 117         struct mlx5e_cq *cq = container_of(mcq, struct mlx5e_cq, mcq);
 118
 119         cq->event_ctr++;
 120         napi_schedule(cq->napi);
 121 }
 122
 123 void mlx5e_cq_error_event(struct mlx5_core_cq *mcq, enum mlx5_event event)
 124 {
 125         struct mlx5e_cq *cq = container_of(mcq, struct mlx5e_cq, mcq);
 126         struct mlx5e_channel *c = cq->channel;
 127         struct net_device *netdev = c->netdev;
 128
 129         netdev_err(netdev, "%s: cqn=0x%.6x event=0x%.2x\n",
 130                    __func__, mcq->cqn, event);
 131 }