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 #include "en/txrx.h"
  36 #include "en/xdp.h"
  37 #include "en/xsk/rx.h"
  38 #include "en/xsk/tx.h"
  39 #include "en_accel/ktls_txrx.h"
  40
  41 static inline bool mlx5e_channel_no_affinity_change(struct mlx5e_channel *c)
  42 {
  43         int current_cpu = smp_processor_id();
  44
  45         return cpumask_test_cpu(current_cpu, c->aff_mask);
  46 }
  47
  48 static void mlx5e_handle_tx_dim(struct mlx5e_txqsq *sq)
  49 {
  50         struct mlx5e_sq_stats *stats = sq->stats;
  51         struct dim_sample dim_sample = {};
  52
  53         if (unlikely(!test_bit(MLX5E_SQ_STATE_AM, &sq->state)))
  54                 return;
  55
  56         dim_update_sample(sq->cq.event_ctr, stats->packets, stats->bytes, &dim_sample);
  57         net_dim(&sq->dim, dim_sample);
  58 }
  59
  60 static void mlx5e_handle_rx_dim(struct mlx5e_rq *rq)
  61 {
  62         struct mlx5e_rq_stats *stats = rq->stats;
  63         struct dim_sample dim_sample = {};
  64
  65         if (unlikely(!test_bit(MLX5E_RQ_STATE_AM, &rq->state)))
  66                 return;
  67
  68         dim_update_sample(rq->cq.event_ctr, stats->packets, stats->bytes, &dim_sample);
  69         net_dim(&rq->dim, dim_sample);
  70 }
  71
  72 void mlx5e_trigger_irq(struct mlx5e_icosq *sq)
  73 {
  74         struct mlx5_wq_cyc *wq = &sq->wq;
  75         struct mlx5e_tx_wqe *nopwqe;
  76         u16 pi = mlx5_wq_cyc_ctr2ix(wq, sq->pc);
  77
  78         sq->db.wqe_info[pi] = (struct mlx5e_icosq_wqe_info) {
  79                 .wqe_type   = MLX5E_ICOSQ_WQE_NOP,
  80                 .num_wqebbs = 1,
  81         };
  82
  83         nopwqe = mlx5e_post_nop(wq, sq->sqn, &sq->pc);
  84         mlx5e_notify_hw(wq, sq->pc, sq->uar_map, &nopwqe->ctrl);
  85 }
  86
  87 static bool mlx5e_napi_xsk_post(struct mlx5e_xdpsq *xsksq, struct mlx5e_rq *xskrq)
  88 {
  89         bool busy_xsk = false, xsk_rx_alloc_err;
  90
  91         /* Handle the race between the application querying need_wakeup and the
  92          * driver setting it:
  93          * 1. Update need_wakeup both before and after the TX. If it goes to
  94          * "yes", it can only happen with the first update.
  95          * 2. If the application queried need_wakeup before we set it, the
  96          * packets will be transmitted anyway, even w/o a wakeup.
  97          * 3. Give a chance to clear need_wakeup after new packets were queued
  98          * for TX.
  99          */
 100         mlx5e_xsk_update_tx_wakeup(xsksq);
 101         busy_xsk |= mlx5e_xsk_tx(xsksq, MLX5E_TX_XSK_POLL_BUDGET);
 102         mlx5e_xsk_update_tx_wakeup(xsksq);
 103
 104         xsk_rx_alloc_err = INDIRECT_CALL_2(xskrq->post_wqes,
 105                                            mlx5e_post_rx_mpwqes,
 106                                            mlx5e_post_rx_wqes,
 107                                            xskrq);
 108         busy_xsk |= mlx5e_xsk_update_rx_wakeup(xskrq, xsk_rx_alloc_err);
 109
 110         return busy_xsk;
 111 }
 112
 113 int mlx5e_napi_poll(struct napi_struct *napi, int budget)
 114 {
 115         struct mlx5e_channel *c = container_of(napi, struct mlx5e_channel,
 116                                                napi);
 117         struct mlx5e_ch_stats *ch_stats = c->stats;
 118         struct mlx5e_xdpsq *xsksq = &c->xsksq;
 119         struct mlx5e_txqsq __rcu **qos_sqs;
 120         struct mlx5e_rq *xskrq = &c->xskrq;
 121         struct mlx5e_rq *rq = &c->rq;
 122         bool aff_change = false;
 123         bool busy_xsk = false;
 124         bool busy = false;
 125         int work_done = 0;
 126         u16 qos_sqs_size;
 127         bool xsk_open;
 128         int i;
 129
 130         rcu_read_lock();
 131
 132         qos_sqs = rcu_dereference(c->qos_sqs);
 133
 134         xsk_open = test_bit(MLX5E_CHANNEL_STATE_XSK, c->state);
 135
 136         ch_stats->poll++;
 137
 138         for (i = 0; i < c->num_tc; i++)
 139                 busy |= mlx5e_poll_tx_cq(&c->sq[i].cq, budget);
 140
 141         if (unlikely(qos_sqs)) {
 142                 smp_rmb(); /* Pairs with mlx5e_qos_alloc_queues. */
 143                 qos_sqs_size = READ_ONCE(c->qos_sqs_size);
 144
 145                 for (i = 0; i < qos_sqs_size; i++) {
 146                         struct mlx5e_txqsq *sq = rcu_dereference(qos_sqs[i]);
 147
 148                         if (sq)
 149                                 busy |= mlx5e_poll_tx_cq(&sq->cq, budget);
 150                 }
 151         }
 152
 153         busy |= mlx5e_poll_xdpsq_cq(&c->xdpsq.cq);
 154
 155         if (c->xdp)
 156                 busy |= mlx5e_poll_xdpsq_cq(&c->rq_xdpsq.cq);
 157
 158         if (likely(budget)) { /* budget=0 means: don't poll rx rings */
 159                 if (xsk_open)
 160                         work_done = mlx5e_poll_rx_cq(&xskrq->cq, budget);
 161
 162                 if (likely(budget - work_done))
 163                         work_done += mlx5e_poll_rx_cq(&rq->cq, budget - work_done);
 164
 165                 busy |= work_done == budget;
 166         }
 167
 168         mlx5e_poll_ico_cq(&c->icosq.cq);
 169         if (mlx5e_poll_ico_cq(&c->async_icosq.cq))
 170                 /* Don't clear the flag if nothing was polled to prevent
 171                  * queueing more WQEs and overflowing the async ICOSQ.
 172                  */
 173                 clear_bit(MLX5E_SQ_STATE_PENDING_XSK_TX, &c->async_icosq.state);
 174
 175         /* Keep after async ICOSQ CQ poll */
 176         if (unlikely(mlx5e_ktls_rx_pending_resync_list(c, budget)))
 177                 busy |= mlx5e_ktls_rx_handle_resync_list(c, budget);
 178
 179         busy |= INDIRECT_CALL_2(rq->post_wqes,
 180                                 mlx5e_post_rx_mpwqes,
 181                                 mlx5e_post_rx_wqes,
 182                                 rq);
 183         if (xsk_open) {
 184                 busy |= mlx5e_poll_xdpsq_cq(&xsksq->cq);
 185                 busy_xsk |= mlx5e_napi_xsk_post(xsksq, xskrq);
 186         }
 187
 188         busy |= busy_xsk;
 189
 190         if (busy) {
 191                 if (likely(mlx5e_channel_no_affinity_change(c))) {
 192                         work_done = budget;
 193                         goto out;
 194                 }
 195                 ch_stats->aff_change++;
 196                 aff_change = true;
 197                 if (budget && work_done == budget)
 198                         work_done--;
 199         }
 200
 201         if (unlikely(!napi_complete_done(napi, work_done)))
 202                 goto out;
 203
 204         ch_stats->arm++;
 205
 206         for (i = 0; i < c->num_tc; i++) {
 207                 mlx5e_handle_tx_dim(&c->sq[i]);
 208                 mlx5e_cq_arm(&c->sq[i].cq);
 209         }
 210         if (unlikely(qos_sqs)) {
 211                 for (i = 0; i < qos_sqs_size; i++) {
 212                         struct mlx5e_txqsq *sq = rcu_dereference(qos_sqs[i]);
 213
 214                         if (sq) {
 215                                 mlx5e_handle_tx_dim(sq);
 216                                 mlx5e_cq_arm(&sq->cq);
 217                         }
 218                 }
 219         }
 220
 221         mlx5e_handle_rx_dim(rq);
 222
 223         mlx5e_cq_arm(&rq->cq);
 224         mlx5e_cq_arm(&c->icosq.cq);
 225         mlx5e_cq_arm(&c->async_icosq.cq);
 226         mlx5e_cq_arm(&c->xdpsq.cq);
 227
 228         if (xsk_open) {
 229                 mlx5e_handle_rx_dim(xskrq);
 230                 mlx5e_cq_arm(&xsksq->cq);
 231                 mlx5e_cq_arm(&xskrq->cq);
 232         }
 233
 234         if (unlikely(aff_change && busy_xsk)) {
 235                 mlx5e_trigger_irq(&c->icosq);
 236                 ch_stats->force_irq++;
 237         }
 238
 239 out:
 240         rcu_read_unlock();
 241
 242         return work_done;
 243 }
 244
 245 void mlx5e_completion_event(struct mlx5_core_cq *mcq, struct mlx5_eqe *eqe)
 246 {
 247         struct mlx5e_cq *cq = container_of(mcq, struct mlx5e_cq, mcq);
 248
 249         napi_schedule(cq->napi);
 250         cq->event_ctr++;
 251         cq->ch_stats->events++;
 252 }
 253
 254 void mlx5e_cq_error_event(struct mlx5_core_cq *mcq, enum mlx5_event event)
 255 {
 256         struct mlx5e_cq *cq = container_of(mcq, struct mlx5e_cq, mcq);
 257         struct net_device *netdev = cq->netdev;
 258
 259         netdev_err(netdev, "%s: cqn=0x%.6x event=0x%.2x\n",
 260                    __func__, mcq->cqn, event);
 261 }