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

   1 /*
   2  * Copyright (c) 2015-2016, 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/tcp.h>
  34 #include <linux/if_vlan.h>
  35 #include <net/geneve.h>
  36 #include <net/dsfield.h>
  37 #include "en.h"
  38 #include "en/txrx.h"
  39 #include "ipoib/ipoib.h"
  40 #include "en_accel/en_accel.h"
  41 #include "en/ptp.h"
  42
  43 static void mlx5e_dma_unmap_wqe_err(struct mlx5e_txqsq *sq, u8 num_dma)
  44 {
  45         int i;
  46
  47         for (i = 0; i < num_dma; i++) {
  48                 struct mlx5e_sq_dma *last_pushed_dma =
  49                         mlx5e_dma_get(sq, --sq->dma_fifo_pc);
  50
  51                 mlx5e_tx_dma_unmap(sq->pdev, last_pushed_dma);
  52         }
  53 }
  54
  55 #ifdef CONFIG_MLX5_CORE_EN_DCB
  56 static inline int mlx5e_get_dscp_up(struct mlx5e_priv *priv, struct sk_buff *skb)
  57 {
  58         int dscp_cp = 0;
  59
  60         if (skb->protocol == htons(ETH_P_IP))
  61                 dscp_cp = ipv4_get_dsfield(ip_hdr(skb)) >> 2;
  62         else if (skb->protocol == htons(ETH_P_IPV6))
  63                 dscp_cp = ipv6_get_dsfield(ipv6_hdr(skb)) >> 2;
  64
  65         return priv->dcbx_dp.dscp2prio[dscp_cp];
  66 }
  67 #endif
  68
  69 static u16 mlx5e_select_ptpsq(struct net_device *dev, struct sk_buff *skb)
  70 {
  71         struct mlx5e_priv *priv = netdev_priv(dev);
  72         int up = 0;
  73
  74         if (!netdev_get_num_tc(dev))
  75                 goto return_txq;
  76
  77 #ifdef CONFIG_MLX5_CORE_EN_DCB
  78         if (priv->dcbx_dp.trust_state == MLX5_QPTS_TRUST_DSCP)
  79                 up = mlx5e_get_dscp_up(priv, skb);
  80         else
  81 #endif
  82                 if (skb_vlan_tag_present(skb))
  83                         up = skb_vlan_tag_get_prio(skb);
  84
  85 return_txq:
  86         return priv->port_ptp_tc2realtxq[up];
  87 }
  88
  89 static int mlx5e_select_htb_queue(struct mlx5e_priv *priv, struct sk_buff *skb,
  90                                   u16 htb_maj_id)
  91 {
  92         u16 classid;
  93
  94         if ((TC_H_MAJ(skb->priority) >> 16) == htb_maj_id)
  95                 classid = TC_H_MIN(skb->priority);
  96         else
  97                 classid = READ_ONCE(priv->htb.defcls);
  98
  99         if (!classid)
 100                 return 0;
 101
 102         return mlx5e_get_txq_by_classid(priv, classid);
 103 }
 104
 105 u16 mlx5e_select_queue(struct net_device *dev, struct sk_buff *skb,
 106                        struct net_device *sb_dev)
 107 {
 108         struct mlx5e_priv *priv = netdev_priv(dev);
 109         int num_tc_x_num_ch;
 110         int txq_ix;
 111         int up = 0;
 112         int ch_ix;
 113
 114         /* Sync with mlx5e_update_num_tc_x_num_ch - avoid refetching. */
 115         num_tc_x_num_ch = READ_ONCE(priv->num_tc_x_num_ch);
 116         if (unlikely(dev->real_num_tx_queues > num_tc_x_num_ch)) {
 117                 struct mlx5e_ptp *ptp_channel;
 118
 119                 /* Order maj_id before defcls - pairs with mlx5e_htb_root_add. */
 120                 u16 htb_maj_id = smp_load_acquire(&priv->htb.maj_id);
 121
 122                 if (unlikely(htb_maj_id)) {
 123                         txq_ix = mlx5e_select_htb_queue(priv, skb, htb_maj_id);
 124                         if (txq_ix > 0)
 125                                 return txq_ix;
 126                 }
 127
 128                 ptp_channel = READ_ONCE(priv->channels.ptp);
 129                 if (unlikely(ptp_channel &&
 130                              test_bit(MLX5E_PTP_STATE_TX, ptp_channel->state) &&
 131                              mlx5e_use_ptpsq(skb)))
 132                         return mlx5e_select_ptpsq(dev, skb);
 133
 134                 txq_ix = netdev_pick_tx(dev, skb, NULL);
 135                 /* Fix netdev_pick_tx() not to choose ptp_channel and HTB txqs.
 136                  * If they are selected, switch to regular queues.
 137                  * Driver to select these queues only at mlx5e_select_ptpsq()
 138                  * and mlx5e_select_htb_queue().
 139                  */
 140                 if (unlikely(txq_ix >= num_tc_x_num_ch))
 141                         txq_ix %= num_tc_x_num_ch;
 142         } else {
 143                 txq_ix = netdev_pick_tx(dev, skb, NULL);
 144         }
 145
 146         if (!netdev_get_num_tc(dev))
 147                 return txq_ix;
 148
 149 #ifdef CONFIG_MLX5_CORE_EN_DCB
 150         if (priv->dcbx_dp.trust_state == MLX5_QPTS_TRUST_DSCP)
 151                 up = mlx5e_get_dscp_up(priv, skb);
 152         else
 153 #endif
 154                 if (skb_vlan_tag_present(skb))
 155                         up = skb_vlan_tag_get_prio(skb);
 156
 157         /* Normalize any picked txq_ix to [0, num_channels),
 158          * So we can return a txq_ix that matches the channel and
 159          * packet UP.
 160          */
 161         ch_ix = priv->txq2sq[txq_ix]->ch_ix;
 162
 163         return priv->channel_tc2realtxq[ch_ix][up];
 164 }
 165
 166 static inline int mlx5e_skb_l2_header_offset(struct sk_buff *skb)
 167 {
 168 #define MLX5E_MIN_INLINE (ETH_HLEN + VLAN_HLEN)
 169
 170         return max(skb_network_offset(skb), MLX5E_MIN_INLINE);
 171 }
 172
 173 static inline int mlx5e_skb_l3_header_offset(struct sk_buff *skb)
 174 {
 175         if (skb_transport_header_was_set(skb))
 176                 return skb_transport_offset(skb);
 177         else
 178                 return mlx5e_skb_l2_header_offset(skb);
 179 }
 180
 181 static inline u16 mlx5e_calc_min_inline(enum mlx5_inline_modes mode,
 182                                         struct sk_buff *skb)
 183 {
 184         u16 hlen;
 185
 186         switch (mode) {
 187         case MLX5_INLINE_MODE_NONE:
 188                 return 0;
 189         case MLX5_INLINE_MODE_TCP_UDP:
 190                 hlen = eth_get_headlen(skb->dev, skb->data, skb_headlen(skb));
 191                 if (hlen == ETH_HLEN && !skb_vlan_tag_present(skb))
 192                         hlen += VLAN_HLEN;
 193                 break;
 194         case MLX5_INLINE_MODE_IP:
 195                 hlen = mlx5e_skb_l3_header_offset(skb);
 196                 break;
 197         case MLX5_INLINE_MODE_L2:
 198         default:
 199                 hlen = mlx5e_skb_l2_header_offset(skb);
 200         }
 201         return min_t(u16, hlen, skb_headlen(skb));
 202 }
 203
 204 static inline void mlx5e_insert_vlan(void *start, struct sk_buff *skb, u16 ihs)
 205 {
 206         struct vlan_ethhdr *vhdr = (struct vlan_ethhdr *)start;
 207         int cpy1_sz = 2 * ETH_ALEN;
 208         int cpy2_sz = ihs - cpy1_sz;
 209
 210         memcpy(vhdr, skb->data, cpy1_sz);
 211         vhdr->h_vlan_proto = skb->vlan_proto;
 212         vhdr->h_vlan_TCI = cpu_to_be16(skb_vlan_tag_get(skb));
 213         memcpy(&vhdr->h_vlan_encapsulated_proto, skb->data + cpy1_sz, cpy2_sz);
 214 }
 215
 216 /* If packet is not IP's CHECKSUM_PARTIAL (e.g. icmd packet),
 217  * need to set L3 checksum flag for IPsec
 218  */
 219 static void
 220 ipsec_txwqe_build_eseg_csum(struct mlx5e_txqsq *sq, struct sk_buff *skb,
 221                             struct mlx5_wqe_eth_seg *eseg)
 222 {
 223         eseg->cs_flags = MLX5_ETH_WQE_L3_CSUM;
 224         if (skb->encapsulation) {
 225                 eseg->cs_flags |= MLX5_ETH_WQE_L3_INNER_CSUM;
 226                 sq->stats->csum_partial_inner++;
 227         } else {
 228                 sq->stats->csum_partial++;
 229         }
 230 }
 231
 232 static inline void
 233 mlx5e_txwqe_build_eseg_csum(struct mlx5e_txqsq *sq, struct sk_buff *skb,
 234                             struct mlx5e_accel_tx_state *accel,
 235                             struct mlx5_wqe_eth_seg *eseg)
 236 {
 237         if (likely(skb->ip_summed == CHECKSUM_PARTIAL)) {
 238                 eseg->cs_flags = MLX5_ETH_WQE_L3_CSUM;
 239                 if (skb->encapsulation) {
 240                         eseg->cs_flags |= MLX5_ETH_WQE_L3_INNER_CSUM |
 241                                           MLX5_ETH_WQE_L4_INNER_CSUM;
 242                         sq->stats->csum_partial_inner++;
 243                 } else {
 244                         eseg->cs_flags |= MLX5_ETH_WQE_L4_CSUM;
 245                         sq->stats->csum_partial++;
 246                 }
 247 #ifdef CONFIG_MLX5_EN_TLS
 248         } else if (unlikely(accel && accel->tls.tls_tisn)) {
 249                 eseg->cs_flags = MLX5_ETH_WQE_L3_CSUM | MLX5_ETH_WQE_L4_CSUM;
 250                 sq->stats->csum_partial++;
 251 #endif
 252         } else if (unlikely(mlx5e_ipsec_eseg_meta(eseg))) {
 253                 ipsec_txwqe_build_eseg_csum(sq, skb, eseg);
 254         } else
 255                 sq->stats->csum_none++;
 256 }
 257
 258 static inline u16
 259 mlx5e_tx_get_gso_ihs(struct mlx5e_txqsq *sq, struct sk_buff *skb)
 260 {
 261         struct mlx5e_sq_stats *stats = sq->stats;
 262         u16 ihs;
 263
 264         if (skb->encapsulation) {
 265                 ihs = skb_inner_transport_offset(skb) + inner_tcp_hdrlen(skb);
 266                 stats->tso_inner_packets++;
 267                 stats->tso_inner_bytes += skb->len - ihs;
 268         } else {
 269                 if (skb_shinfo(skb)->gso_type & SKB_GSO_UDP_L4)
 270                         ihs = skb_transport_offset(skb) + sizeof(struct udphdr);
 271                 else
 272                         ihs = skb_transport_offset(skb) + tcp_hdrlen(skb);
 273                 stats->tso_packets++;
 274                 stats->tso_bytes += skb->len - ihs;
 275         }
 276
 277         return ihs;
 278 }
 279
 280 static inline int
 281 mlx5e_txwqe_build_dsegs(struct mlx5e_txqsq *sq, struct sk_buff *skb,
 282                         unsigned char *skb_data, u16 headlen,
 283                         struct mlx5_wqe_data_seg *dseg)
 284 {
 285         dma_addr_t dma_addr = 0;
 286         u8 num_dma          = 0;
 287         int i;
 288
 289         if (headlen) {
 290                 dma_addr = dma_map_single(sq->pdev, skb_data, headlen,
 291                                           DMA_TO_DEVICE);
 292                 if (unlikely(dma_mapping_error(sq->pdev, dma_addr)))
 293                         goto dma_unmap_wqe_err;
 294
 295                 dseg->addr       = cpu_to_be64(dma_addr);
 296                 dseg->lkey       = sq->mkey_be;
 297                 dseg->byte_count = cpu_to_be32(headlen);
 298
 299                 mlx5e_dma_push(sq, dma_addr, headlen, MLX5E_DMA_MAP_SINGLE);
 300                 num_dma++;
 301                 dseg++;
 302         }
 303
 304         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
 305                 skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
 306                 int fsz = skb_frag_size(frag);
 307
 308                 dma_addr = skb_frag_dma_map(sq->pdev, frag, 0, fsz,
 309                                             DMA_TO_DEVICE);
 310                 if (unlikely(dma_mapping_error(sq->pdev, dma_addr)))
 311                         goto dma_unmap_wqe_err;
 312
 313                 dseg->addr       = cpu_to_be64(dma_addr);
 314                 dseg->lkey       = sq->mkey_be;
 315                 dseg->byte_count = cpu_to_be32(fsz);
 316
 317                 mlx5e_dma_push(sq, dma_addr, fsz, MLX5E_DMA_MAP_PAGE);
 318                 num_dma++;
 319                 dseg++;
 320         }
 321
 322         return num_dma;
 323
 324 dma_unmap_wqe_err:
 325         mlx5e_dma_unmap_wqe_err(sq, num_dma);
 326         return -ENOMEM;
 327 }
 328
 329 struct mlx5e_tx_attr {
 330         u32 num_bytes;
 331         u16 headlen;
 332         u16 ihs;
 333         __be16 mss;
 334         u16 insz;
 335         u8 opcode;
 336 };
 337
 338 struct mlx5e_tx_wqe_attr {
 339         u16 ds_cnt;
 340         u16 ds_cnt_inl;
 341         u16 ds_cnt_ids;
 342         u8 num_wqebbs;
 343 };
 344
 345 static u8
 346 mlx5e_tx_wqe_inline_mode(struct mlx5e_txqsq *sq, struct sk_buff *skb,
 347                          struct mlx5e_accel_tx_state *accel)
 348 {
 349         u8 mode;
 350
 351 #ifdef CONFIG_MLX5_EN_TLS
 352         if (accel && accel->tls.tls_tisn)
 353                 return MLX5_INLINE_MODE_TCP_UDP;
 354 #endif
 355
 356         mode = sq->min_inline_mode;
 357
 358         if (skb_vlan_tag_present(skb) &&
 359             test_bit(MLX5E_SQ_STATE_VLAN_NEED_L2_INLINE, &sq->state))
 360                 mode = max_t(u8, MLX5_INLINE_MODE_L2, mode);
 361
 362         return mode;
 363 }
 364
 365 static void mlx5e_sq_xmit_prepare(struct mlx5e_txqsq *sq, struct sk_buff *skb,
 366                                   struct mlx5e_accel_tx_state *accel,
 367                                   struct mlx5e_tx_attr *attr)
 368 {
 369         struct mlx5e_sq_stats *stats = sq->stats;
 370
 371         if (skb_is_gso(skb)) {
 372                 u16 ihs = mlx5e_tx_get_gso_ihs(sq, skb);
 373
 374                 *attr = (struct mlx5e_tx_attr) {
 375                         .opcode    = MLX5_OPCODE_LSO,
 376                         .mss       = cpu_to_be16(skb_shinfo(skb)->gso_size),
 377                         .ihs       = ihs,
 378                         .num_bytes = skb->len + (skb_shinfo(skb)->gso_segs - 1) * ihs,
 379                         .headlen   = skb_headlen(skb) - ihs,
 380                 };
 381
 382                 stats->packets += skb_shinfo(skb)->gso_segs;
 383         } else {
 384                 u8 mode = mlx5e_tx_wqe_inline_mode(sq, skb, accel);
 385                 u16 ihs = mlx5e_calc_min_inline(mode, skb);
 386
 387                 *attr = (struct mlx5e_tx_attr) {
 388                         .opcode    = MLX5_OPCODE_SEND,
 389                         .mss       = cpu_to_be16(0),
 390                         .ihs       = ihs,
 391                         .num_bytes = max_t(unsigned int, skb->len, ETH_ZLEN),
 392                         .headlen   = skb_headlen(skb) - ihs,
 393                 };
 394
 395                 stats->packets++;
 396         }
 397
 398         attr->insz = mlx5e_accel_tx_ids_len(sq, accel);
 399         stats->bytes += attr->num_bytes;
 400 }
 401
 402 static void mlx5e_sq_calc_wqe_attr(struct sk_buff *skb, const struct mlx5e_tx_attr *attr,
 403                                    struct mlx5e_tx_wqe_attr *wqe_attr)
 404 {
 405         u16 ds_cnt = MLX5E_TX_WQE_EMPTY_DS_COUNT;
 406         u16 ds_cnt_inl = 0;
 407         u16 ds_cnt_ids = 0;
 408
 409         if (attr->insz)
 410                 ds_cnt_ids = DIV_ROUND_UP(sizeof(struct mlx5_wqe_inline_seg) + attr->insz,
 411                                           MLX5_SEND_WQE_DS);
 412
 413         ds_cnt += !!attr->headlen + skb_shinfo(skb)->nr_frags + ds_cnt_ids;
 414         if (attr->ihs) {
 415                 u16 inl = attr->ihs - INL_HDR_START_SZ;
 416
 417                 if (skb_vlan_tag_present(skb))
 418                         inl += VLAN_HLEN;
 419
 420                 ds_cnt_inl = DIV_ROUND_UP(inl, MLX5_SEND_WQE_DS);
 421                 ds_cnt += ds_cnt_inl;
 422         }
 423
 424         *wqe_attr = (struct mlx5e_tx_wqe_attr) {
 425                 .ds_cnt     = ds_cnt,
 426                 .ds_cnt_inl = ds_cnt_inl,
 427                 .ds_cnt_ids = ds_cnt_ids,
 428                 .num_wqebbs = DIV_ROUND_UP(ds_cnt, MLX5_SEND_WQEBB_NUM_DS),
 429         };
 430 }
 431
 432 static void mlx5e_tx_skb_update_hwts_flags(struct sk_buff *skb)
 433 {
 434         if (unlikely(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP))
 435                 skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
 436 }
 437
 438 static void mlx5e_tx_check_stop(struct mlx5e_txqsq *sq)
 439 {
 440         if (unlikely(!mlx5e_wqc_has_room_for(&sq->wq, sq->cc, sq->pc, sq->stop_room))) {
 441                 netif_tx_stop_queue(sq->txq);
 442                 sq->stats->stopped++;
 443         }
 444 }
 445
 446 static inline void
 447 mlx5e_txwqe_complete(struct mlx5e_txqsq *sq, struct sk_buff *skb,
 448                      const struct mlx5e_tx_attr *attr,
 449                      const struct mlx5e_tx_wqe_attr *wqe_attr, u8 num_dma,
 450                      struct mlx5e_tx_wqe_info *wi, struct mlx5_wqe_ctrl_seg *cseg,
 451                      bool xmit_more)
 452 {
 453         struct mlx5_wq_cyc *wq = &sq->wq;
 454         bool send_doorbell;
 455
 456         *wi = (struct mlx5e_tx_wqe_info) {
 457                 .skb = skb,
 458                 .num_bytes = attr->num_bytes,
 459                 .num_dma = num_dma,
 460                 .num_wqebbs = wqe_attr->num_wqebbs,
 461                 .num_fifo_pkts = 0,
 462         };
 463
 464         cseg->opmod_idx_opcode = cpu_to_be32((sq->pc << 8) | attr->opcode);
 465         cseg->qpn_ds           = cpu_to_be32((sq->sqn << 8) | wqe_attr->ds_cnt);
 466
 467         mlx5e_tx_skb_update_hwts_flags(skb);
 468
 469         sq->pc += wi->num_wqebbs;
 470
 471         mlx5e_tx_check_stop(sq);
 472
 473         if (unlikely(sq->ptpsq)) {
 474                 mlx5e_skb_cb_hwtstamp_init(skb);
 475                 mlx5e_skb_fifo_push(&sq->ptpsq->skb_fifo, skb);
 476                 skb_get(skb);
 477         }
 478
 479         send_doorbell = __netdev_tx_sent_queue(sq->txq, attr->num_bytes, xmit_more);
 480         if (send_doorbell)
 481                 mlx5e_notify_hw(wq, sq->pc, sq->uar_map, cseg);
 482 }
 483
 484 static void
 485 mlx5e_sq_xmit_wqe(struct mlx5e_txqsq *sq, struct sk_buff *skb,
 486                   const struct mlx5e_tx_attr *attr, const struct mlx5e_tx_wqe_attr *wqe_attr,
 487                   struct mlx5e_tx_wqe *wqe, u16 pi, bool xmit_more)
 488 {
 489         struct mlx5_wqe_ctrl_seg *cseg;
 490         struct mlx5_wqe_eth_seg  *eseg;
 491         struct mlx5_wqe_data_seg *dseg;
 492         struct mlx5e_tx_wqe_info *wi;
 493
 494         struct mlx5e_sq_stats *stats = sq->stats;
 495         int num_dma;
 496
 497         stats->xmit_more += xmit_more;
 498
 499         /* fill wqe */
 500         wi   = &sq->db.wqe_info[pi];
 501         cseg = &wqe->ctrl;
 502         eseg = &wqe->eth;
 503         dseg =  wqe->data;
 504
 505         eseg->mss = attr->mss;
 506
 507         if (attr->ihs) {
 508                 if (skb_vlan_tag_present(skb)) {
 509                         eseg->inline_hdr.sz |= cpu_to_be16(attr->ihs + VLAN_HLEN);
 510                         mlx5e_insert_vlan(eseg->inline_hdr.start, skb, attr->ihs);
 511                         stats->added_vlan_packets++;
 512                 } else {
 513                         eseg->inline_hdr.sz |= cpu_to_be16(attr->ihs);
 514                         memcpy(eseg->inline_hdr.start, skb->data, attr->ihs);
 515                 }
 516                 dseg += wqe_attr->ds_cnt_inl;
 517         } else if (skb_vlan_tag_present(skb)) {
 518                 eseg->insert.type = cpu_to_be16(MLX5_ETH_WQE_INSERT_VLAN);
 519                 if (skb->vlan_proto == cpu_to_be16(ETH_P_8021AD))
 520                         eseg->insert.type |= cpu_to_be16(MLX5_ETH_WQE_SVLAN);
 521                 eseg->insert.vlan_tci = cpu_to_be16(skb_vlan_tag_get(skb));
 522                 stats->added_vlan_packets++;
 523         }
 524
 525         dseg += wqe_attr->ds_cnt_ids;
 526         num_dma = mlx5e_txwqe_build_dsegs(sq, skb, skb->data + attr->ihs,
 527                                           attr->headlen, dseg);
 528         if (unlikely(num_dma < 0))
 529                 goto err_drop;
 530
 531         mlx5e_txwqe_complete(sq, skb, attr, wqe_attr, num_dma, wi, cseg, xmit_more);
 532
 533         return;
 534
 535 err_drop:
 536         stats->dropped++;
 537         dev_kfree_skb_any(skb);
 538 }
 539
 540 static bool mlx5e_tx_skb_supports_mpwqe(struct sk_buff *skb, struct mlx5e_tx_attr *attr)
 541 {
 542         return !skb_is_nonlinear(skb) && !skb_vlan_tag_present(skb) && !attr->ihs &&
 543                !attr->insz;
 544 }
 545
 546 static bool mlx5e_tx_mpwqe_same_eseg(struct mlx5e_txqsq *sq, struct mlx5_wqe_eth_seg *eseg)
 547 {
 548         struct mlx5e_tx_mpwqe *session = &sq->mpwqe;
 549
 550         /* Assumes the session is already running and has at least one packet. */
 551         return !memcmp(&session->wqe->eth, eseg, MLX5E_ACCEL_ESEG_LEN);
 552 }
 553
 554 static void mlx5e_tx_mpwqe_session_start(struct mlx5e_txqsq *sq,
 555                                          struct mlx5_wqe_eth_seg *eseg)
 556 {
 557         struct mlx5e_tx_mpwqe *session = &sq->mpwqe;
 558         struct mlx5e_tx_wqe *wqe;
 559         u16 pi;
 560
 561         pi = mlx5e_txqsq_get_next_pi(sq, MLX5E_TX_MPW_MAX_WQEBBS);
 562         wqe = MLX5E_TX_FETCH_WQE(sq, pi);
 563         net_prefetchw(wqe->data);
 564
 565         *session = (struct mlx5e_tx_mpwqe) {
 566                 .wqe = wqe,
 567                 .bytes_count = 0,
 568                 .ds_count = MLX5E_TX_WQE_EMPTY_DS_COUNT,
 569                 .pkt_count = 0,
 570                 .inline_on = 0,
 571         };
 572
 573         memcpy(&session->wqe->eth, eseg, MLX5E_ACCEL_ESEG_LEN);
 574
 575         sq->stats->mpwqe_blks++;
 576 }
 577
 578 static bool mlx5e_tx_mpwqe_session_is_active(struct mlx5e_txqsq *sq)
 579 {
 580         return sq->mpwqe.wqe;
 581 }
 582
 583 static void mlx5e_tx_mpwqe_add_dseg(struct mlx5e_txqsq *sq, struct mlx5e_xmit_data *txd)
 584 {
 585         struct mlx5e_tx_mpwqe *session = &sq->mpwqe;
 586         struct mlx5_wqe_data_seg *dseg;
 587
 588         dseg = (struct mlx5_wqe_data_seg *)session->wqe + session->ds_count;
 589
 590         session->pkt_count++;
 591         session->bytes_count += txd->len;
 592
 593         dseg->addr = cpu_to_be64(txd->dma_addr);
 594         dseg->byte_count = cpu_to_be32(txd->len);
 595         dseg->lkey = sq->mkey_be;
 596         session->ds_count++;
 597
 598         sq->stats->mpwqe_pkts++;
 599 }
 600
 601 static struct mlx5_wqe_ctrl_seg *mlx5e_tx_mpwqe_session_complete(struct mlx5e_txqsq *sq)
 602 {
 603         struct mlx5e_tx_mpwqe *session = &sq->mpwqe;
 604         u8 ds_count = session->ds_count;
 605         struct mlx5_wqe_ctrl_seg *cseg;
 606         struct mlx5e_tx_wqe_info *wi;
 607         u16 pi;
 608
 609         cseg = &session->wqe->ctrl;
 610         cseg->opmod_idx_opcode = cpu_to_be32((sq->pc << 8) | MLX5_OPCODE_ENHANCED_MPSW);
 611         cseg->qpn_ds = cpu_to_be32((sq->sqn << 8) | ds_count);
 612
 613         pi = mlx5_wq_cyc_ctr2ix(&sq->wq, sq->pc);
 614         wi = &sq->db.wqe_info[pi];
 615         *wi = (struct mlx5e_tx_wqe_info) {
 616                 .skb = NULL,
 617                 .num_bytes = session->bytes_count,
 618                 .num_wqebbs = DIV_ROUND_UP(ds_count, MLX5_SEND_WQEBB_NUM_DS),
 619                 .num_dma = session->pkt_count,
 620                 .num_fifo_pkts = session->pkt_count,
 621         };
 622
 623         sq->pc += wi->num_wqebbs;
 624
 625         session->wqe = NULL;
 626
 627         mlx5e_tx_check_stop(sq);
 628
 629         return cseg;
 630 }
 631
 632 static void
 633 mlx5e_sq_xmit_mpwqe(struct mlx5e_txqsq *sq, struct sk_buff *skb,
 634                     struct mlx5_wqe_eth_seg *eseg, bool xmit_more)
 635 {
 636         struct mlx5_wqe_ctrl_seg *cseg;
 637         struct mlx5e_xmit_data txd;
 638
 639         if (!mlx5e_tx_mpwqe_session_is_active(sq)) {
 640                 mlx5e_tx_mpwqe_session_start(sq, eseg);
 641         } else if (!mlx5e_tx_mpwqe_same_eseg(sq, eseg)) {
 642                 mlx5e_tx_mpwqe_session_complete(sq);
 643                 mlx5e_tx_mpwqe_session_start(sq, eseg);
 644         }
 645
 646         sq->stats->xmit_more += xmit_more;
 647
 648         txd.data = skb->data;
 649         txd.len = skb->len;
 650
 651         txd.dma_addr = dma_map_single(sq->pdev, txd.data, txd.len, DMA_TO_DEVICE);
 652         if (unlikely(dma_mapping_error(sq->pdev, txd.dma_addr)))
 653                 goto err_unmap;
 654         mlx5e_dma_push(sq, txd.dma_addr, txd.len, MLX5E_DMA_MAP_SINGLE);
 655
 656         mlx5e_skb_fifo_push(&sq->db.skb_fifo, skb);
 657
 658         mlx5e_tx_mpwqe_add_dseg(sq, &txd);
 659
 660         mlx5e_tx_skb_update_hwts_flags(skb);
 661
 662         if (unlikely(mlx5e_tx_mpwqe_is_full(&sq->mpwqe))) {
 663                 /* Might stop the queue and affect the retval of __netdev_tx_sent_queue. */
 664                 cseg = mlx5e_tx_mpwqe_session_complete(sq);
 665
 666                 if (__netdev_tx_sent_queue(sq->txq, txd.len, xmit_more))
 667                         mlx5e_notify_hw(&sq->wq, sq->pc, sq->uar_map, cseg);
 668         } else if (__netdev_tx_sent_queue(sq->txq, txd.len, xmit_more)) {
 669                 /* Might stop the queue, but we were asked to ring the doorbell anyway. */
 670                 cseg = mlx5e_tx_mpwqe_session_complete(sq);
 671
 672                 mlx5e_notify_hw(&sq->wq, sq->pc, sq->uar_map, cseg);
 673         }
 674
 675         return;
 676
 677 err_unmap:
 678         mlx5e_dma_unmap_wqe_err(sq, 1);
 679         sq->stats->dropped++;
 680         dev_kfree_skb_any(skb);
 681 }
 682
 683 void mlx5e_tx_mpwqe_ensure_complete(struct mlx5e_txqsq *sq)
 684 {
 685         /* Unlikely in non-MPWQE workloads; not important in MPWQE workloads. */
 686         if (unlikely(mlx5e_tx_mpwqe_session_is_active(sq)))
 687                 mlx5e_tx_mpwqe_session_complete(sq);
 688 }
 689
 690 static bool mlx5e_txwqe_build_eseg(struct mlx5e_priv *priv, struct mlx5e_txqsq *sq,
 691                                    struct sk_buff *skb, struct mlx5e_accel_tx_state *accel,
 692                                    struct mlx5_wqe_eth_seg *eseg, u16 ihs)
 693 {
 694         if (unlikely(!mlx5e_accel_tx_eseg(priv, skb, eseg, ihs)))
 695                 return false;
 696
 697         mlx5e_txwqe_build_eseg_csum(sq, skb, accel, eseg);
 698
 699         return true;
 700 }
 701
 702 netdev_tx_t mlx5e_xmit(struct sk_buff *skb, struct net_device *dev)
 703 {
 704         struct mlx5e_priv *priv = netdev_priv(dev);
 705         struct mlx5e_accel_tx_state accel = {};
 706         struct mlx5e_tx_wqe_attr wqe_attr;
 707         struct mlx5e_tx_attr attr;
 708         struct mlx5e_tx_wqe *wqe;
 709         struct mlx5e_txqsq *sq;
 710         u16 pi;
 711
 712         sq = priv->txq2sq[skb_get_queue_mapping(skb)];
 713         if (unlikely(!sq)) {
 714                 dev_kfree_skb_any(skb);
 715                 return NETDEV_TX_OK;
 716         }
 717
 718         /* May send SKBs and WQEs. */
 719         if (unlikely(!mlx5e_accel_tx_begin(dev, sq, skb, &accel)))
 720                 return NETDEV_TX_OK;
 721
 722         mlx5e_sq_xmit_prepare(sq, skb, &accel, &attr);
 723
 724         if (test_bit(MLX5E_SQ_STATE_MPWQE, &sq->state)) {
 725                 if (mlx5e_tx_skb_supports_mpwqe(skb, &attr)) {
 726                         struct mlx5_wqe_eth_seg eseg = {};
 727
 728                         if (unlikely(!mlx5e_txwqe_build_eseg(priv, sq, skb, &accel, &eseg,
 729                                                              attr.ihs)))
 730                                 return NETDEV_TX_OK;
 731
 732                         mlx5e_sq_xmit_mpwqe(sq, skb, &eseg, netdev_xmit_more());
 733                         return NETDEV_TX_OK;
 734                 }
 735
 736                 mlx5e_tx_mpwqe_ensure_complete(sq);
 737         }
 738
 739         mlx5e_sq_calc_wqe_attr(skb, &attr, &wqe_attr);
 740         pi = mlx5e_txqsq_get_next_pi(sq, wqe_attr.num_wqebbs);
 741         wqe = MLX5E_TX_FETCH_WQE(sq, pi);
 742
 743         /* May update the WQE, but may not post other WQEs. */
 744         mlx5e_accel_tx_finish(sq, wqe, &accel,
 745                               (struct mlx5_wqe_inline_seg *)(wqe->data + wqe_attr.ds_cnt_inl));
 746         if (unlikely(!mlx5e_txwqe_build_eseg(priv, sq, skb, &accel, &wqe->eth, attr.ihs)))
 747                 return NETDEV_TX_OK;
 748
 749         mlx5e_sq_xmit_wqe(sq, skb, &attr, &wqe_attr, wqe, pi, netdev_xmit_more());
 750
 751         return NETDEV_TX_OK;
 752 }
 753
 754 void mlx5e_sq_xmit_simple(struct mlx5e_txqsq *sq, struct sk_buff *skb, bool xmit_more)
 755 {
 756         struct mlx5e_tx_wqe_attr wqe_attr;
 757         struct mlx5e_tx_attr attr;
 758         struct mlx5e_tx_wqe *wqe;
 759         u16 pi;
 760
 761         mlx5e_sq_xmit_prepare(sq, skb, NULL, &attr);
 762         mlx5e_sq_calc_wqe_attr(skb, &attr, &wqe_attr);
 763         pi = mlx5e_txqsq_get_next_pi(sq, wqe_attr.num_wqebbs);
 764         wqe = MLX5E_TX_FETCH_WQE(sq, pi);
 765         mlx5e_txwqe_build_eseg_csum(sq, skb, NULL, &wqe->eth);
 766         mlx5e_sq_xmit_wqe(sq, skb, &attr, &wqe_attr, wqe, pi, xmit_more);
 767 }
 768
 769 static void mlx5e_tx_wi_dma_unmap(struct mlx5e_txqsq *sq, struct mlx5e_tx_wqe_info *wi,
 770                                   u32 *dma_fifo_cc)
 771 {
 772         int i;
 773
 774         for (i = 0; i < wi->num_dma; i++) {
 775                 struct mlx5e_sq_dma *dma = mlx5e_dma_get(sq, (*dma_fifo_cc)++);
 776
 777                 mlx5e_tx_dma_unmap(sq->pdev, dma);
 778         }
 779 }
 780
 781 static void mlx5e_consume_skb(struct mlx5e_txqsq *sq, struct sk_buff *skb,
 782                               struct mlx5_cqe64 *cqe, int napi_budget)
 783 {
 784         if (unlikely(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP)) {
 785                 struct skb_shared_hwtstamps hwts = {};
 786                 u64 ts = get_cqe_ts(cqe);
 787
 788                 hwts.hwtstamp = mlx5e_cqe_ts_to_ns(sq->ptp_cyc2time, sq->clock, ts);
 789                 if (sq->ptpsq)
 790                         mlx5e_skb_cb_hwtstamp_handler(skb, MLX5E_SKB_CB_CQE_HWTSTAMP,
 791                                                       hwts.hwtstamp, sq->ptpsq->cq_stats);
 792                 else
 793                         skb_tstamp_tx(skb, &hwts);
 794         }
 795
 796         napi_consume_skb(skb, napi_budget);
 797 }
 798
 799 static void mlx5e_tx_wi_consume_fifo_skbs(struct mlx5e_txqsq *sq, struct mlx5e_tx_wqe_info *wi,
 800                                           struct mlx5_cqe64 *cqe, int napi_budget)
 801 {
 802         int i;
 803
 804         for (i = 0; i < wi->num_fifo_pkts; i++) {
 805                 struct sk_buff *skb = mlx5e_skb_fifo_pop(&sq->db.skb_fifo);
 806
 807                 mlx5e_consume_skb(sq, skb, cqe, napi_budget);
 808         }
 809 }
 810
 811 bool mlx5e_poll_tx_cq(struct mlx5e_cq *cq, int napi_budget)
 812 {
 813         struct mlx5e_sq_stats *stats;
 814         struct mlx5e_txqsq *sq;
 815         struct mlx5_cqe64 *cqe;
 816         u32 dma_fifo_cc;
 817         u32 nbytes;
 818         u16 npkts;
 819         u16 sqcc;
 820         int i;
 821
 822         sq = container_of(cq, struct mlx5e_txqsq, cq);
 823
 824         if (unlikely(!test_bit(MLX5E_SQ_STATE_ENABLED, &sq->state)))
 825                 return false;
 826
 827         cqe = mlx5_cqwq_get_cqe(&cq->wq);
 828         if (!cqe)
 829                 return false;
 830
 831         stats = sq->stats;
 832
 833         npkts = 0;
 834         nbytes = 0;
 835
 836         /* sq->cc must be updated only after mlx5_cqwq_update_db_record(),
 837          * otherwise a cq overrun may occur
 838          */
 839         sqcc = sq->cc;
 840
 841         /* avoid dirtying sq cache line every cqe */
 842         dma_fifo_cc = sq->dma_fifo_cc;
 843
 844         i = 0;
 845         do {
 846                 struct mlx5e_tx_wqe_info *wi;
 847                 u16 wqe_counter;
 848                 bool last_wqe;
 849                 u16 ci;
 850
 851                 mlx5_cqwq_pop(&cq->wq);
 852
 853                 wqe_counter = be16_to_cpu(cqe->wqe_counter);
 854
 855                 do {
 856                         last_wqe = (sqcc == wqe_counter);
 857
 858                         ci = mlx5_wq_cyc_ctr2ix(&sq->wq, sqcc);
 859                         wi = &sq->db.wqe_info[ci];
 860
 861                         sqcc += wi->num_wqebbs;
 862
 863                         if (likely(wi->skb)) {
 864                                 mlx5e_tx_wi_dma_unmap(sq, wi, &dma_fifo_cc);
 865                                 mlx5e_consume_skb(sq, wi->skb, cqe, napi_budget);
 866
 867                                 npkts++;
 868                                 nbytes += wi->num_bytes;
 869                                 continue;
 870                         }
 871
 872                         if (unlikely(mlx5e_ktls_tx_try_handle_resync_dump_comp(sq, wi,
 873                                                                                &dma_fifo_cc)))
 874                                 continue;
 875
 876                         if (wi->num_fifo_pkts) {
 877                                 mlx5e_tx_wi_dma_unmap(sq, wi, &dma_fifo_cc);
 878                                 mlx5e_tx_wi_consume_fifo_skbs(sq, wi, cqe, napi_budget);
 879
 880                                 npkts += wi->num_fifo_pkts;
 881                                 nbytes += wi->num_bytes;
 882                         }
 883                 } while (!last_wqe);
 884
 885                 if (unlikely(get_cqe_opcode(cqe) == MLX5_CQE_REQ_ERR)) {
 886                         if (!test_and_set_bit(MLX5E_SQ_STATE_RECOVERING,
 887                                               &sq->state)) {
 888                                 mlx5e_dump_error_cqe(&sq->cq, sq->sqn,
 889                                                      (struct mlx5_err_cqe *)cqe);
 890                                 mlx5_wq_cyc_wqe_dump(&sq->wq, ci, wi->num_wqebbs);
 891                                 queue_work(cq->priv->wq, &sq->recover_work);
 892                         }
 893                         stats->cqe_err++;
 894                 }
 895
 896         } while ((++i < MLX5E_TX_CQ_POLL_BUDGET) && (cqe = mlx5_cqwq_get_cqe(&cq->wq)));
 897
 898         stats->cqes += i;
 899
 900         mlx5_cqwq_update_db_record(&cq->wq);
 901
 902         /* ensure cq space is freed before enabling more cqes */
 903         wmb();
 904
 905         sq->dma_fifo_cc = dma_fifo_cc;
 906         sq->cc = sqcc;
 907
 908         netdev_tx_completed_queue(sq->txq, npkts, nbytes);
 909
 910         if (netif_tx_queue_stopped(sq->txq) &&
 911             mlx5e_wqc_has_room_for(&sq->wq, sq->cc, sq->pc, sq->stop_room) &&
 912             !test_bit(MLX5E_SQ_STATE_RECOVERING, &sq->state)) {
 913                 netif_tx_wake_queue(sq->txq);
 914                 stats->wake++;
 915         }
 916
 917         return (i == MLX5E_TX_CQ_POLL_BUDGET);
 918 }
 919
 920 static void mlx5e_tx_wi_kfree_fifo_skbs(struct mlx5e_txqsq *sq, struct mlx5e_tx_wqe_info *wi)
 921 {
 922         int i;
 923
 924         for (i = 0; i < wi->num_fifo_pkts; i++)
 925                 dev_kfree_skb_any(mlx5e_skb_fifo_pop(&sq->db.skb_fifo));
 926 }
 927
 928 void mlx5e_free_txqsq_descs(struct mlx5e_txqsq *sq)
 929 {
 930         struct mlx5e_tx_wqe_info *wi;
 931         u32 dma_fifo_cc, nbytes = 0;
 932         u16 ci, sqcc, npkts = 0;
 933
 934         sqcc = sq->cc;
 935         dma_fifo_cc = sq->dma_fifo_cc;
 936
 937         while (sqcc != sq->pc) {
 938                 ci = mlx5_wq_cyc_ctr2ix(&sq->wq, sqcc);
 939                 wi = &sq->db.wqe_info[ci];
 940
 941                 sqcc += wi->num_wqebbs;
 942
 943                 if (likely(wi->skb)) {
 944                         mlx5e_tx_wi_dma_unmap(sq, wi, &dma_fifo_cc);
 945                         dev_kfree_skb_any(wi->skb);
 946
 947                         npkts++;
 948                         nbytes += wi->num_bytes;
 949                         continue;
 950                 }
 951
 952                 if (unlikely(mlx5e_ktls_tx_try_handle_resync_dump_comp(sq, wi, &dma_fifo_cc)))
 953                         continue;
 954
 955                 if (wi->num_fifo_pkts) {
 956                         mlx5e_tx_wi_dma_unmap(sq, wi, &dma_fifo_cc);
 957                         mlx5e_tx_wi_kfree_fifo_skbs(sq, wi);
 958
 959                         npkts += wi->num_fifo_pkts;
 960                         nbytes += wi->num_bytes;
 961                 }
 962         }
 963
 964         sq->dma_fifo_cc = dma_fifo_cc;
 965         sq->cc = sqcc;
 966
 967         netdev_tx_completed_queue(sq->txq, npkts, nbytes);
 968 }
 969
 970 #ifdef CONFIG_MLX5_CORE_IPOIB
 971 static inline void
 972 mlx5i_txwqe_build_datagram(struct mlx5_av *av, u32 dqpn, u32 dqkey,
 973                            struct mlx5_wqe_datagram_seg *dseg)
 974 {
 975         memcpy(&dseg->av, av, sizeof(struct mlx5_av));
 976         dseg->av.dqp_dct = cpu_to_be32(dqpn | MLX5_EXTENDED_UD_AV);
 977         dseg->av.key.qkey.qkey = cpu_to_be32(dqkey);
 978 }
 979
 980 static void mlx5i_sq_calc_wqe_attr(struct sk_buff *skb,
 981                                    const struct mlx5e_tx_attr *attr,
 982                                    struct mlx5e_tx_wqe_attr *wqe_attr)
 983 {
 984         u16 ds_cnt = sizeof(struct mlx5i_tx_wqe) / MLX5_SEND_WQE_DS;
 985         u16 ds_cnt_inl = 0;
 986
 987         ds_cnt += !!attr->headlen + skb_shinfo(skb)->nr_frags;
 988
 989         if (attr->ihs) {
 990                 u16 inl = attr->ihs - INL_HDR_START_SZ;
 991
 992                 ds_cnt_inl = DIV_ROUND_UP(inl, MLX5_SEND_WQE_DS);
 993                 ds_cnt += ds_cnt_inl;
 994         }
 995
 996         *wqe_attr = (struct mlx5e_tx_wqe_attr) {
 997                 .ds_cnt     = ds_cnt,
 998                 .ds_cnt_inl = ds_cnt_inl,
 999                 .num_wqebbs = DIV_ROUND_UP(ds_cnt, MLX5_SEND_WQEBB_NUM_DS),
1000         };
1001 }
1002
1003 void mlx5i_sq_xmit(struct mlx5e_txqsq *sq, struct sk_buff *skb,
1004                    struct mlx5_av *av, u32 dqpn, u32 dqkey, bool xmit_more)
1005 {
1006         struct mlx5e_tx_wqe_attr wqe_attr;
1007         struct mlx5e_tx_attr attr;
1008         struct mlx5i_tx_wqe *wqe;
1009
1010         struct mlx5_wqe_datagram_seg *datagram;
1011         struct mlx5_wqe_ctrl_seg *cseg;
1012         struct mlx5_wqe_eth_seg  *eseg;
1013         struct mlx5_wqe_data_seg *dseg;
1014         struct mlx5e_tx_wqe_info *wi;
1015
1016         struct mlx5e_sq_stats *stats = sq->stats;
1017         int num_dma;
1018         u16 pi;
1019
1020         mlx5e_sq_xmit_prepare(sq, skb, NULL, &attr);
1021         mlx5i_sq_calc_wqe_attr(skb, &attr, &wqe_attr);
1022
1023         pi = mlx5e_txqsq_get_next_pi(sq, wqe_attr.num_wqebbs);
1024         wqe = MLX5I_SQ_FETCH_WQE(sq, pi);
1025
1026         stats->xmit_more += xmit_more;
1027
1028         /* fill wqe */
1029         wi       = &sq->db.wqe_info[pi];
1030         cseg     = &wqe->ctrl;
1031         datagram = &wqe->datagram;
1032         eseg     = &wqe->eth;
1033         dseg     =  wqe->data;
1034
1035         mlx5i_txwqe_build_datagram(av, dqpn, dqkey, datagram);
1036
1037         mlx5e_txwqe_build_eseg_csum(sq, skb, NULL, eseg);
1038
1039         eseg->mss = attr.mss;
1040
1041         if (attr.ihs) {
1042                 memcpy(eseg->inline_hdr.start, skb->data, attr.ihs);
1043                 eseg->inline_hdr.sz = cpu_to_be16(attr.ihs);
1044                 dseg += wqe_attr.ds_cnt_inl;
1045         }
1046
1047         num_dma = mlx5e_txwqe_build_dsegs(sq, skb, skb->data + attr.ihs,
1048                                           attr.headlen, dseg);
1049         if (unlikely(num_dma < 0))
1050                 goto err_drop;
1051
1052         mlx5e_txwqe_complete(sq, skb, &attr, &wqe_attr, num_dma, wi, cseg, xmit_more);
1053
1054         return;
1055
1056 err_drop:
1057         stats->dropped++;
1058         dev_kfree_skb_any(skb);
1059 }
1060 #endif