drivers/net/hns3/hns3_rxtx.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2018-2019 Hisilicon Limited.
   3  */
   4
   5 #include <stdarg.h>
   6 #include <stdbool.h>
   7 #include <stdint.h>
   8 #include <stdio.h>
   9 #include <unistd.h>
  10 #include <inttypes.h>
  11 #include <rte_bus_pci.h>
  12 #include <rte_byteorder.h>
  13 #include <rte_common.h>
  14 #include <rte_cycles.h>
  15 #include <rte_dev.h>
  16 #include <rte_eal.h>
  17 #include <rte_ether.h>
  18 #include <rte_vxlan.h>
  19 #include <rte_ethdev_driver.h>
  20 #include <rte_io.h>
  21 #include <rte_ip.h>
  22 #include <rte_gre.h>
  23 #include <rte_net.h>
  24 #include <rte_malloc.h>
  25 #include <rte_pci.h>
  26
  27 #include "hns3_ethdev.h"
  28 #include "hns3_rxtx.h"
  29 #include "hns3_regs.h"
  30 #include "hns3_logs.h"
  31
  32 #define HNS3_CFG_DESC_NUM(num)  ((num) / 8 - 1)
  33 #define HNS3_RX_RING_PREFETCTH_MASK     3
  34
  35 static void
  36 hns3_rx_queue_release_mbufs(struct hns3_rx_queue *rxq)
  37 {
  38         uint16_t i;
  39
  40         /* Note: Fake rx queue will not enter here */
  41         if (rxq->sw_ring == NULL)
  42                 return;
  43
  44         if (rxq->rx_rearm_nb == 0) {
  45                 for (i = 0; i < rxq->nb_rx_desc; i++) {
  46                         if (rxq->sw_ring[i].mbuf != NULL) {
  47                                 rte_pktmbuf_free_seg(rxq->sw_ring[i].mbuf);
  48                                 rxq->sw_ring[i].mbuf = NULL;
  49                         }
  50                 }
  51         } else {
  52                 for (i = rxq->next_to_use;
  53                      i != rxq->rx_rearm_start;
  54                      i = (i + 1) % rxq->nb_rx_desc) {
  55                         if (rxq->sw_ring[i].mbuf != NULL) {
  56                                 rte_pktmbuf_free_seg(rxq->sw_ring[i].mbuf);
  57                                 rxq->sw_ring[i].mbuf = NULL;
  58                         }
  59                 }
  60         }
  61
  62         for (i = 0; i < rxq->bulk_mbuf_num; i++)
  63                 rte_pktmbuf_free_seg(rxq->bulk_mbuf[i]);
  64         rxq->bulk_mbuf_num = 0;
  65
  66         if (rxq->pkt_first_seg) {
  67                 rte_pktmbuf_free(rxq->pkt_first_seg);
  68                 rxq->pkt_first_seg = NULL;
  69         }
  70 }
  71
  72 static void
  73 hns3_tx_queue_release_mbufs(struct hns3_tx_queue *txq)
  74 {
  75         uint16_t i;
  76
  77         /* Note: Fake rx queue will not enter here */
  78         if (txq->sw_ring) {
  79                 for (i = 0; i < txq->nb_tx_desc; i++) {
  80                         if (txq->sw_ring[i].mbuf) {
  81                                 rte_pktmbuf_free_seg(txq->sw_ring[i].mbuf);
  82                                 txq->sw_ring[i].mbuf = NULL;
  83                         }
  84                 }
  85         }
  86 }
  87
  88 static void
  89 hns3_rx_queue_release(void *queue)
  90 {
  91         struct hns3_rx_queue *rxq = queue;
  92         if (rxq) {
  93                 hns3_rx_queue_release_mbufs(rxq);
  94                 if (rxq->mz)
  95                         rte_memzone_free(rxq->mz);
  96                 if (rxq->sw_ring)
  97                         rte_free(rxq->sw_ring);
  98                 rte_free(rxq);
  99         }
 100 }
 101
 102 static void
 103 hns3_tx_queue_release(void *queue)
 104 {
 105         struct hns3_tx_queue *txq = queue;
 106         if (txq) {
 107                 hns3_tx_queue_release_mbufs(txq);
 108                 if (txq->mz)
 109                         rte_memzone_free(txq->mz);
 110                 if (txq->sw_ring)
 111                         rte_free(txq->sw_ring);
 112                 if (txq->free)
 113                         rte_free(txq->free);
 114                 rte_free(txq);
 115         }
 116 }
 117
 118 void
 119 hns3_dev_rx_queue_release(void *queue)
 120 {
 121         struct hns3_rx_queue *rxq = queue;
 122         struct hns3_adapter *hns;
 123
 124         if (rxq == NULL)
 125                 return;
 126
 127         hns = rxq->hns;
 128         rte_spinlock_lock(&hns->hw.lock);
 129         hns3_rx_queue_release(queue);
 130         rte_spinlock_unlock(&hns->hw.lock);
 131 }
 132
 133 void
 134 hns3_dev_tx_queue_release(void *queue)
 135 {
 136         struct hns3_tx_queue *txq = queue;
 137         struct hns3_adapter *hns;
 138
 139         if (txq == NULL)
 140                 return;
 141
 142         hns = txq->hns;
 143         rte_spinlock_lock(&hns->hw.lock);
 144         hns3_tx_queue_release(queue);
 145         rte_spinlock_unlock(&hns->hw.lock);
 146 }
 147
 148 static void
 149 hns3_fake_rx_queue_release(struct hns3_rx_queue *queue)
 150 {
 151         struct hns3_rx_queue *rxq = queue;
 152         struct hns3_adapter *hns;
 153         struct hns3_hw *hw;
 154         uint16_t idx;
 155
 156         if (rxq == NULL)
 157                 return;
 158
 159         hns = rxq->hns;
 160         hw = &hns->hw;
 161         idx = rxq->queue_id;
 162         if (hw->fkq_data.rx_queues[idx]) {
 163                 hns3_rx_queue_release(hw->fkq_data.rx_queues[idx]);
 164                 hw->fkq_data.rx_queues[idx] = NULL;
 165         }
 166
 167         /* free fake rx queue arrays */
 168         if (idx == (hw->fkq_data.nb_fake_rx_queues - 1)) {
 169                 hw->fkq_data.nb_fake_rx_queues = 0;
 170                 rte_free(hw->fkq_data.rx_queues);
 171                 hw->fkq_data.rx_queues = NULL;
 172         }
 173 }
 174
 175 static void
 176 hns3_fake_tx_queue_release(struct hns3_tx_queue *queue)
 177 {
 178         struct hns3_tx_queue *txq = queue;
 179         struct hns3_adapter *hns;
 180         struct hns3_hw *hw;
 181         uint16_t idx;
 182
 183         if (txq == NULL)
 184                 return;
 185
 186         hns = txq->hns;
 187         hw = &hns->hw;
 188         idx = txq->queue_id;
 189         if (hw->fkq_data.tx_queues[idx]) {
 190                 hns3_tx_queue_release(hw->fkq_data.tx_queues[idx]);
 191                 hw->fkq_data.tx_queues[idx] = NULL;
 192         }
 193
 194         /* free fake tx queue arrays */
 195         if (idx == (hw->fkq_data.nb_fake_tx_queues - 1)) {
 196                 hw->fkq_data.nb_fake_tx_queues = 0;
 197                 rte_free(hw->fkq_data.tx_queues);
 198                 hw->fkq_data.tx_queues = NULL;
 199         }
 200 }
 201
 202 static void
 203 hns3_free_rx_queues(struct rte_eth_dev *dev)
 204 {
 205         struct hns3_adapter *hns = dev->data->dev_private;
 206         struct hns3_fake_queue_data *fkq_data;
 207         struct hns3_hw *hw = &hns->hw;
 208         uint16_t nb_rx_q;
 209         uint16_t i;
 210
 211         nb_rx_q = hw->data->nb_rx_queues;
 212         for (i = 0; i < nb_rx_q; i++) {
 213                 if (dev->data->rx_queues[i]) {
 214                         hns3_rx_queue_release(dev->data->rx_queues[i]);
 215                         dev->data->rx_queues[i] = NULL;
 216                 }
 217         }
 218
 219         /* Free fake Rx queues */
 220         fkq_data = &hw->fkq_data;
 221         for (i = 0; i < fkq_data->nb_fake_rx_queues; i++) {
 222                 if (fkq_data->rx_queues[i])
 223                         hns3_fake_rx_queue_release(fkq_data->rx_queues[i]);
 224         }
 225 }
 226
 227 static void
 228 hns3_free_tx_queues(struct rte_eth_dev *dev)
 229 {
 230         struct hns3_adapter *hns = dev->data->dev_private;
 231         struct hns3_fake_queue_data *fkq_data;
 232         struct hns3_hw *hw = &hns->hw;
 233         uint16_t nb_tx_q;
 234         uint16_t i;
 235
 236         nb_tx_q = hw->data->nb_tx_queues;
 237         for (i = 0; i < nb_tx_q; i++) {
 238                 if (dev->data->tx_queues[i]) {
 239                         hns3_tx_queue_release(dev->data->tx_queues[i]);
 240                         dev->data->tx_queues[i] = NULL;
 241                 }
 242         }
 243
 244         /* Free fake Tx queues */
 245         fkq_data = &hw->fkq_data;
 246         for (i = 0; i < fkq_data->nb_fake_tx_queues; i++) {
 247                 if (fkq_data->tx_queues[i])
 248                         hns3_fake_tx_queue_release(fkq_data->tx_queues[i]);
 249         }
 250 }
 251
 252 void
 253 hns3_free_all_queues(struct rte_eth_dev *dev)
 254 {
 255         hns3_free_rx_queues(dev);
 256         hns3_free_tx_queues(dev);
 257 }
 258
 259 static int
 260 hns3_alloc_rx_queue_mbufs(struct hns3_hw *hw, struct hns3_rx_queue *rxq)
 261 {
 262         struct rte_mbuf *mbuf;
 263         uint64_t dma_addr;
 264         uint16_t i;
 265
 266         for (i = 0; i < rxq->nb_rx_desc; i++) {
 267                 mbuf = rte_mbuf_raw_alloc(rxq->mb_pool);
 268                 if (unlikely(mbuf == NULL)) {
 269                         hns3_err(hw, "Failed to allocate RXD[%d] for rx queue!",
 270                                  i);
 271                         hns3_rx_queue_release_mbufs(rxq);
 272                         return -ENOMEM;
 273                 }
 274
 275                 rte_mbuf_refcnt_set(mbuf, 1);
 276                 mbuf->next = NULL;
 277                 mbuf->data_off = RTE_PKTMBUF_HEADROOM;
 278                 mbuf->nb_segs = 1;
 279                 mbuf->port = rxq->port_id;
 280
 281                 rxq->sw_ring[i].mbuf = mbuf;
 282                 dma_addr = rte_cpu_to_le_64(rte_mbuf_data_iova_default(mbuf));
 283                 rxq->rx_ring[i].addr = dma_addr;
 284                 rxq->rx_ring[i].rx.bd_base_info = 0;
 285         }
 286
 287         return 0;
 288 }
 289
 290 static int
 291 hns3_buf_size2type(uint32_t buf_size)
 292 {
 293         int bd_size_type;
 294
 295         switch (buf_size) {
 296         case 512:
 297                 bd_size_type = HNS3_BD_SIZE_512_TYPE;
 298                 break;
 299         case 1024:
 300                 bd_size_type = HNS3_BD_SIZE_1024_TYPE;
 301                 break;
 302         case 4096:
 303                 bd_size_type = HNS3_BD_SIZE_4096_TYPE;
 304                 break;
 305         default:
 306                 bd_size_type = HNS3_BD_SIZE_2048_TYPE;
 307         }
 308
 309         return bd_size_type;
 310 }
 311
 312 static void
 313 hns3_init_rx_queue_hw(struct hns3_rx_queue *rxq)
 314 {
 315         uint32_t rx_buf_len = rxq->rx_buf_len;
 316         uint64_t dma_addr = rxq->rx_ring_phys_addr;
 317
 318         hns3_write_dev(rxq, HNS3_RING_RX_BASEADDR_L_REG, (uint32_t)dma_addr);
 319         hns3_write_dev(rxq, HNS3_RING_RX_BASEADDR_H_REG,
 320                        (uint32_t)((dma_addr >> 31) >> 1));
 321
 322         hns3_write_dev(rxq, HNS3_RING_RX_BD_LEN_REG,
 323                        hns3_buf_size2type(rx_buf_len));
 324         hns3_write_dev(rxq, HNS3_RING_RX_BD_NUM_REG,
 325                        HNS3_CFG_DESC_NUM(rxq->nb_rx_desc));
 326 }
 327
 328 static void
 329 hns3_init_tx_queue_hw(struct hns3_tx_queue *txq)
 330 {
 331         uint64_t dma_addr = txq->tx_ring_phys_addr;
 332
 333         hns3_write_dev(txq, HNS3_RING_TX_BASEADDR_L_REG, (uint32_t)dma_addr);
 334         hns3_write_dev(txq, HNS3_RING_TX_BASEADDR_H_REG,
 335                        (uint32_t)((dma_addr >> 31) >> 1));
 336
 337         hns3_write_dev(txq, HNS3_RING_TX_BD_NUM_REG,
 338                        HNS3_CFG_DESC_NUM(txq->nb_tx_desc));
 339 }
 340
 341 void
 342 hns3_update_all_queues_pvid_state(struct hns3_hw *hw)
 343 {
 344         uint16_t nb_rx_q = hw->data->nb_rx_queues;
 345         uint16_t nb_tx_q = hw->data->nb_tx_queues;
 346         struct hns3_rx_queue *rxq;
 347         struct hns3_tx_queue *txq;
 348         int pvid_state;
 349         int i;
 350
 351         pvid_state = hw->port_base_vlan_cfg.state;
 352         for (i = 0; i < hw->cfg_max_queues; i++) {
 353                 if (i < nb_rx_q) {
 354                         rxq = hw->data->rx_queues[i];
 355                         if (rxq != NULL)
 356                                 rxq->pvid_state = pvid_state;
 357                 }
 358                 if (i < nb_tx_q) {
 359                         txq = hw->data->tx_queues[i];
 360                         if (txq != NULL)
 361                                 txq->pvid_state = pvid_state;
 362                 }
 363         }
 364 }
 365
 366 void
 367 hns3_enable_all_queues(struct hns3_hw *hw, bool en)
 368 {
 369         uint16_t nb_rx_q = hw->data->nb_rx_queues;
 370         uint16_t nb_tx_q = hw->data->nb_tx_queues;
 371         struct hns3_rx_queue *rxq;
 372         struct hns3_tx_queue *txq;
 373         uint32_t rcb_reg;
 374         int i;
 375
 376         for (i = 0; i < hw->cfg_max_queues; i++) {
 377                 if (i < nb_rx_q)
 378                         rxq = hw->data->rx_queues[i];
 379                 else
 380                         rxq = hw->fkq_data.rx_queues[i - nb_rx_q];
 381                 if (i < nb_tx_q)
 382                         txq = hw->data->tx_queues[i];
 383                 else
 384                         txq = hw->fkq_data.tx_queues[i - nb_tx_q];
 385                 if (rxq == NULL || txq == NULL ||
 386                     (en && (rxq->rx_deferred_start || txq->tx_deferred_start)))
 387                         continue;
 388
 389                 rcb_reg = hns3_read_dev(rxq, HNS3_RING_EN_REG);
 390                 if (en)
 391                         rcb_reg |= BIT(HNS3_RING_EN_B);
 392                 else
 393                         rcb_reg &= ~BIT(HNS3_RING_EN_B);
 394                 hns3_write_dev(rxq, HNS3_RING_EN_REG, rcb_reg);
 395         }
 396 }
 397
 398 static int
 399 hns3_tqp_enable(struct hns3_hw *hw, uint16_t queue_id, bool enable)
 400 {
 401         struct hns3_cfg_com_tqp_queue_cmd *req;
 402         struct hns3_cmd_desc desc;
 403         int ret;
 404
 405         req = (struct hns3_cfg_com_tqp_queue_cmd *)desc.data;
 406
 407         hns3_cmd_setup_basic_desc(&desc, HNS3_OPC_CFG_COM_TQP_QUEUE, false);
 408         req->tqp_id = rte_cpu_to_le_16(queue_id & HNS3_RING_ID_MASK);
 409         req->stream_id = 0;
 410         hns3_set_bit(req->enable, HNS3_TQP_ENABLE_B, enable ? 1 : 0);
 411
 412         ret = hns3_cmd_send(hw, &desc, 1);
 413         if (ret)
 414                 hns3_err(hw, "TQP enable fail, ret = %d", ret);
 415
 416         return ret;
 417 }
 418
 419 static int
 420 hns3_send_reset_tqp_cmd(struct hns3_hw *hw, uint16_t queue_id, bool enable)
 421 {
 422         struct hns3_reset_tqp_queue_cmd *req;
 423         struct hns3_cmd_desc desc;
 424         int ret;
 425
 426         hns3_cmd_setup_basic_desc(&desc, HNS3_OPC_RESET_TQP_QUEUE, false);
 427
 428         req = (struct hns3_reset_tqp_queue_cmd *)desc.data;
 429         req->tqp_id = rte_cpu_to_le_16(queue_id & HNS3_RING_ID_MASK);
 430         hns3_set_bit(req->reset_req, HNS3_TQP_RESET_B, enable ? 1 : 0);
 431
 432         ret = hns3_cmd_send(hw, &desc, 1);
 433         if (ret)
 434                 hns3_err(hw, "Send tqp reset cmd error, ret = %d", ret);
 435
 436         return ret;
 437 }
 438
 439 static int
 440 hns3_get_reset_status(struct hns3_hw *hw, uint16_t queue_id)
 441 {
 442         struct hns3_reset_tqp_queue_cmd *req;
 443         struct hns3_cmd_desc desc;
 444         int ret;
 445
 446         hns3_cmd_setup_basic_desc(&desc, HNS3_OPC_RESET_TQP_QUEUE, true);
 447
 448         req = (struct hns3_reset_tqp_queue_cmd *)desc.data;
 449         req->tqp_id = rte_cpu_to_le_16(queue_id & HNS3_RING_ID_MASK);
 450
 451         ret = hns3_cmd_send(hw, &desc, 1);
 452         if (ret) {
 453                 hns3_err(hw, "Get reset status error, ret =%d", ret);
 454                 return ret;
 455         }
 456
 457         return hns3_get_bit(req->ready_to_reset, HNS3_TQP_RESET_B);
 458 }
 459
 460 static int
 461 hns3_reset_tqp(struct hns3_hw *hw, uint16_t queue_id)
 462 {
 463 #define HNS3_TQP_RESET_TRY_MS   200
 464         uint64_t end;
 465         int reset_status;
 466         int ret;
 467
 468         ret = hns3_tqp_enable(hw, queue_id, false);
 469         if (ret)
 470                 return ret;
 471
 472         /*
 473          * In current version VF is not supported when PF is driven by DPDK
 474          * driver, all task queue pairs are mapped to PF function, so PF's queue
 475          * id is equals to the global queue id in PF range.
 476          */
 477         ret = hns3_send_reset_tqp_cmd(hw, queue_id, true);
 478         if (ret) {
 479                 hns3_err(hw, "Send reset tqp cmd fail, ret = %d", ret);
 480                 return ret;
 481         }
 482         ret = -ETIMEDOUT;
 483         end = get_timeofday_ms() + HNS3_TQP_RESET_TRY_MS;
 484         do {
 485                 /* Wait for tqp hw reset */
 486                 rte_delay_ms(HNS3_POLL_RESPONE_MS);
 487                 reset_status = hns3_get_reset_status(hw, queue_id);
 488                 if (reset_status) {
 489                         ret = 0;
 490                         break;
 491                 }
 492         } while (get_timeofday_ms() < end);
 493
 494         if (ret) {
 495                 hns3_err(hw, "Reset TQP fail, ret = %d", ret);
 496                 return ret;
 497         }
 498
 499         ret = hns3_send_reset_tqp_cmd(hw, queue_id, false);
 500         if (ret)
 501                 hns3_err(hw, "Deassert the soft reset fail, ret = %d", ret);
 502
 503         return ret;
 504 }
 505
 506 static int
 507 hns3vf_reset_tqp(struct hns3_hw *hw, uint16_t queue_id)
 508 {
 509         uint8_t msg_data[2];
 510         int ret;
 511
 512         /* Disable VF's queue before send queue reset msg to PF */
 513         ret = hns3_tqp_enable(hw, queue_id, false);
 514         if (ret)
 515                 return ret;
 516
 517         memcpy(msg_data, &queue_id, sizeof(uint16_t));
 518
 519         return hns3_send_mbx_msg(hw, HNS3_MBX_QUEUE_RESET, 0, msg_data,
 520                                  sizeof(msg_data), true, NULL, 0);
 521 }
 522
 523 static int
 524 hns3_reset_queue(struct hns3_adapter *hns, uint16_t queue_id)
 525 {
 526         struct hns3_hw *hw = &hns->hw;
 527         if (hns->is_vf)
 528                 return hns3vf_reset_tqp(hw, queue_id);
 529         else
 530                 return hns3_reset_tqp(hw, queue_id);
 531 }
 532
 533 int
 534 hns3_reset_all_queues(struct hns3_adapter *hns)
 535 {
 536         struct hns3_hw *hw = &hns->hw;
 537         int ret, i;
 538
 539         for (i = 0; i < hw->cfg_max_queues; i++) {
 540                 ret = hns3_reset_queue(hns, i);
 541                 if (ret) {
 542                         hns3_err(hw, "Failed to reset No.%d queue: %d", i, ret);
 543                         return ret;
 544                 }
 545         }
 546         return 0;
 547 }
 548
 549 void
 550 hns3_set_queue_intr_gl(struct hns3_hw *hw, uint16_t queue_id,
 551                        uint8_t gl_idx, uint16_t gl_value)
 552 {
 553         uint32_t offset[] = {HNS3_TQP_INTR_GL0_REG,
 554                              HNS3_TQP_INTR_GL1_REG,
 555                              HNS3_TQP_INTR_GL2_REG};
 556         uint32_t addr, value;
 557
 558         if (gl_idx >= RTE_DIM(offset) || gl_value > HNS3_TQP_INTR_GL_MAX)
 559                 return;
 560
 561         addr = offset[gl_idx] + queue_id * HNS3_TQP_INTR_REG_SIZE;
 562         if (hw->intr.gl_unit == HNS3_INTR_COALESCE_GL_UINT_1US)
 563                 value = gl_value | HNS3_TQP_INTR_GL_UNIT_1US;
 564         else
 565                 value = HNS3_GL_USEC_TO_REG(gl_value);
 566
 567         hns3_write_dev(hw, addr, value);
 568 }
 569
 570 void
 571 hns3_set_queue_intr_rl(struct hns3_hw *hw, uint16_t queue_id, uint16_t rl_value)
 572 {
 573         uint32_t addr, value;
 574
 575         if (rl_value > HNS3_TQP_INTR_RL_MAX)
 576                 return;
 577
 578         addr = HNS3_TQP_INTR_RL_REG + queue_id * HNS3_TQP_INTR_REG_SIZE;
 579         value = HNS3_RL_USEC_TO_REG(rl_value);
 580         if (value > 0)
 581                 value |= HNS3_TQP_INTR_RL_ENABLE_MASK;
 582
 583         hns3_write_dev(hw, addr, value);
 584 }
 585
 586 void
 587 hns3_set_queue_intr_ql(struct hns3_hw *hw, uint16_t queue_id, uint16_t ql_value)
 588 {
 589         uint32_t addr;
 590
 591         if (hw->intr.coalesce_mode == HNS3_INTR_COALESCE_NON_QL)
 592                 return;
 593
 594         addr = HNS3_TQP_INTR_TX_QL_REG + queue_id * HNS3_TQP_INTR_REG_SIZE;
 595         hns3_write_dev(hw, addr, ql_value);
 596
 597         addr = HNS3_TQP_INTR_RX_QL_REG + queue_id * HNS3_TQP_INTR_REG_SIZE;
 598         hns3_write_dev(hw, addr, ql_value);
 599 }
 600
 601 static void
 602 hns3_queue_intr_enable(struct hns3_hw *hw, uint16_t queue_id, bool en)
 603 {
 604         uint32_t addr, value;
 605
 606         addr = HNS3_TQP_INTR_CTRL_REG + queue_id * HNS3_TQP_INTR_REG_SIZE;
 607         value = en ? 1 : 0;
 608
 609         hns3_write_dev(hw, addr, value);
 610 }
 611
 612 /*
 613  * Enable all rx queue interrupt when in interrupt rx mode.
 614  * This api was called before enable queue rx&tx (in normal start or reset
 615  * recover scenes), used to fix hardware rx queue interrupt enable was clear
 616  * when FLR.
 617  */
 618 void
 619 hns3_dev_all_rx_queue_intr_enable(struct hns3_hw *hw, bool en)
 620 {
 621         struct rte_eth_dev *dev = &rte_eth_devices[hw->data->port_id];
 622         uint16_t nb_rx_q = hw->data->nb_rx_queues;
 623         int i;
 624
 625         if (dev->data->dev_conf.intr_conf.rxq == 0)
 626                 return;
 627
 628         for (i = 0; i < nb_rx_q; i++)
 629                 hns3_queue_intr_enable(hw, i, en);
 630 }
 631
 632 int
 633 hns3_dev_rx_queue_intr_enable(struct rte_eth_dev *dev, uint16_t queue_id)
 634 {
 635         struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(dev);
 636         struct rte_intr_handle *intr_handle = &pci_dev->intr_handle;
 637         struct hns3_hw *hw = HNS3_DEV_PRIVATE_TO_HW(dev->data->dev_private);
 638
 639         if (dev->data->dev_conf.intr_conf.rxq == 0)
 640                 return -ENOTSUP;
 641
 642         hns3_queue_intr_enable(hw, queue_id, true);
 643
 644         return rte_intr_ack(intr_handle);
 645 }
 646
 647 int
 648 hns3_dev_rx_queue_intr_disable(struct rte_eth_dev *dev, uint16_t queue_id)
 649 {
 650         struct hns3_hw *hw = HNS3_DEV_PRIVATE_TO_HW(dev->data->dev_private);
 651
 652         if (dev->data->dev_conf.intr_conf.rxq == 0)
 653                 return -ENOTSUP;
 654
 655         hns3_queue_intr_enable(hw, queue_id, false);
 656
 657         return 0;
 658 }
 659
 660 static int
 661 hns3_dev_rx_queue_start(struct hns3_adapter *hns, uint16_t idx)
 662 {
 663         struct hns3_hw *hw = &hns->hw;
 664         struct hns3_rx_queue *rxq;
 665         int ret;
 666
 667         PMD_INIT_FUNC_TRACE();
 668
 669         rxq = (struct hns3_rx_queue *)hw->data->rx_queues[idx];
 670         ret = hns3_alloc_rx_queue_mbufs(hw, rxq);
 671         if (ret) {
 672                 hns3_err(hw, "Failed to alloc mbuf for No.%d rx queue: %d",
 673                          idx, ret);
 674                 return ret;
 675         }
 676
 677         rxq->next_to_use = 0;
 678         rxq->rx_rearm_start = 0;
 679         rxq->rx_free_hold = 0;
 680         rxq->rx_rearm_nb = 0;
 681         rxq->pkt_first_seg = NULL;
 682         rxq->pkt_last_seg = NULL;
 683         hns3_init_rx_queue_hw(rxq);
 684         hns3_rxq_vec_setup(rxq);
 685
 686         return 0;
 687 }
 688
 689 static void
 690 hns3_fake_rx_queue_start(struct hns3_adapter *hns, uint16_t idx)
 691 {
 692         struct hns3_hw *hw = &hns->hw;
 693         struct hns3_rx_queue *rxq;
 694
 695         rxq = (struct hns3_rx_queue *)hw->fkq_data.rx_queues[idx];
 696         rxq->next_to_use = 0;
 697         rxq->rx_free_hold = 0;
 698         rxq->rx_rearm_start = 0;
 699         rxq->rx_rearm_nb = 0;
 700         hns3_init_rx_queue_hw(rxq);
 701 }
 702
 703 static void
 704 hns3_init_tx_queue(struct hns3_tx_queue *queue)
 705 {
 706         struct hns3_tx_queue *txq = queue;
 707         struct hns3_desc *desc;
 708         int i;
 709
 710         /* Clear tx bd */
 711         desc = txq->tx_ring;
 712         for (i = 0; i < txq->nb_tx_desc; i++) {
 713                 desc->tx.tp_fe_sc_vld_ra_ri = 0;
 714                 desc++;
 715         }
 716
 717         txq->next_to_use = 0;
 718         txq->next_to_clean = 0;
 719         txq->tx_bd_ready = txq->nb_tx_desc - 1;
 720         hns3_init_tx_queue_hw(txq);
 721 }
 722
 723 static void
 724 hns3_dev_tx_queue_start(struct hns3_adapter *hns, uint16_t idx)
 725 {
 726         struct hns3_hw *hw = &hns->hw;
 727         struct hns3_tx_queue *txq;
 728
 729         txq = (struct hns3_tx_queue *)hw->data->tx_queues[idx];
 730         hns3_init_tx_queue(txq);
 731 }
 732
 733 static void
 734 hns3_fake_tx_queue_start(struct hns3_adapter *hns, uint16_t idx)
 735 {
 736         struct hns3_hw *hw = &hns->hw;
 737         struct hns3_tx_queue *txq;
 738
 739         txq = (struct hns3_tx_queue *)hw->fkq_data.tx_queues[idx];
 740         hns3_init_tx_queue(txq);
 741 }
 742
 743 static void
 744 hns3_init_tx_ring_tc(struct hns3_adapter *hns)
 745 {
 746         struct hns3_hw *hw = &hns->hw;
 747         struct hns3_tx_queue *txq;
 748         int i, num;
 749
 750         for (i = 0; i < HNS3_MAX_TC_NUM; i++) {
 751                 struct hns3_tc_queue_info *tc_queue = &hw->tc_queue[i];
 752                 int j;
 753
 754                 if (!tc_queue->enable)
 755                         continue;
 756
 757                 for (j = 0; j < tc_queue->tqp_count; j++) {
 758                         num = tc_queue->tqp_offset + j;
 759                         txq = (struct hns3_tx_queue *)hw->data->tx_queues[num];
 760                         if (txq == NULL)
 761                                 continue;
 762
 763                         hns3_write_dev(txq, HNS3_RING_TX_TC_REG, tc_queue->tc);
 764                 }
 765         }
 766 }
 767
 768 static int
 769 hns3_start_rx_queues(struct hns3_adapter *hns)
 770 {
 771         struct hns3_hw *hw = &hns->hw;
 772         struct hns3_rx_queue *rxq;
 773         int i, j;
 774         int ret;
 775
 776         /* Initialize RSS for queues */
 777         ret = hns3_config_rss(hns);
 778         if (ret) {
 779                 hns3_err(hw, "Failed to configure rss %d", ret);
 780                 return ret;
 781         }
 782
 783         for (i = 0; i < hw->data->nb_rx_queues; i++) {
 784                 rxq = (struct hns3_rx_queue *)hw->data->rx_queues[i];
 785                 if (rxq == NULL || rxq->rx_deferred_start)
 786                         continue;
 787                 ret = hns3_dev_rx_queue_start(hns, i);
 788                 if (ret) {
 789                         hns3_err(hw, "Failed to start No.%d rx queue: %d", i,
 790                                  ret);
 791                         goto out;
 792                 }
 793         }
 794
 795         for (i = 0; i < hw->fkq_data.nb_fake_rx_queues; i++) {
 796                 rxq = (struct hns3_rx_queue *)hw->fkq_data.rx_queues[i];
 797                 if (rxq == NULL || rxq->rx_deferred_start)
 798                         continue;
 799                 hns3_fake_rx_queue_start(hns, i);
 800         }
 801         return 0;
 802
 803 out:
 804         for (j = 0; j < i; j++) {
 805                 rxq = (struct hns3_rx_queue *)hw->data->rx_queues[j];
 806                 hns3_rx_queue_release_mbufs(rxq);
 807         }
 808
 809         return ret;
 810 }
 811
 812 static void
 813 hns3_start_tx_queues(struct hns3_adapter *hns)
 814 {
 815         struct hns3_hw *hw = &hns->hw;
 816         struct hns3_tx_queue *txq;
 817         int i;
 818
 819         for (i = 0; i < hw->data->nb_tx_queues; i++) {
 820                 txq = (struct hns3_tx_queue *)hw->data->tx_queues[i];
 821                 if (txq == NULL || txq->tx_deferred_start)
 822                         continue;
 823                 hns3_dev_tx_queue_start(hns, i);
 824         }
 825
 826         for (i = 0; i < hw->fkq_data.nb_fake_tx_queues; i++) {
 827                 txq = (struct hns3_tx_queue *)hw->fkq_data.tx_queues[i];
 828                 if (txq == NULL || txq->tx_deferred_start)
 829                         continue;
 830                 hns3_fake_tx_queue_start(hns, i);
 831         }
 832
 833         hns3_init_tx_ring_tc(hns);
 834 }
 835
 836 /*
 837  * Start all queues.
 838  * Note: just init and setup queues, and don't enable queue rx&tx.
 839  */
 840 int
 841 hns3_start_queues(struct hns3_adapter *hns, bool reset_queue)
 842 {
 843         struct hns3_hw *hw = &hns->hw;
 844         int ret;
 845
 846         if (reset_queue) {
 847                 ret = hns3_reset_all_queues(hns);
 848                 if (ret) {
 849                         hns3_err(hw, "Failed to reset all queues %d", ret);
 850                         return ret;
 851                 }
 852         }
 853
 854         ret = hns3_start_rx_queues(hns);
 855         if (ret) {
 856                 hns3_err(hw, "Failed to start rx queues: %d", ret);
 857                 return ret;
 858         }
 859
 860         hns3_start_tx_queues(hns);
 861
 862         return 0;
 863 }
 864
 865 int
 866 hns3_stop_queues(struct hns3_adapter *hns, bool reset_queue)
 867 {
 868         struct hns3_hw *hw = &hns->hw;
 869         int ret;
 870
 871         hns3_enable_all_queues(hw, false);
 872         if (reset_queue) {
 873                 ret = hns3_reset_all_queues(hns);
 874                 if (ret) {
 875                         hns3_err(hw, "Failed to reset all queues %d", ret);
 876                         return ret;
 877                 }
 878         }
 879         return 0;
 880 }
 881
 882 /*
 883  * Iterate over all Rx Queue, and call the callback() function for each Rx
 884  * queue.
 885  *
 886  * @param[in] dev
 887  *   The target eth dev.
 888  * @param[in] callback
 889  *   The function to call for each queue.
 890  *   if callback function return nonzero will stop iterate and return it's value
 891  * @param[in] arg
 892  *   The arguments to provide the callback function with.
 893  *
 894  * @return
 895  *   0 on success, otherwise with errno set.
 896  */
 897 int
 898 hns3_rxq_iterate(struct rte_eth_dev *dev,
 899                  int (*callback)(struct hns3_rx_queue *, void *), void *arg)
 900 {
 901         uint32_t i;
 902         int ret;
 903
 904         if (dev->data->rx_queues == NULL)
 905                 return -EINVAL;
 906
 907         for (i = 0; i < dev->data->nb_rx_queues; i++) {
 908                 ret = callback(dev->data->rx_queues[i], arg);
 909                 if (ret != 0)
 910                         return ret;
 911         }
 912
 913         return 0;
 914 }
 915
 916 static void*
 917 hns3_alloc_rxq_and_dma_zone(struct rte_eth_dev *dev,
 918                             struct hns3_queue_info *q_info)
 919 {
 920         struct hns3_hw *hw = HNS3_DEV_PRIVATE_TO_HW(dev->data->dev_private);
 921         const struct rte_memzone *rx_mz;
 922         struct hns3_rx_queue *rxq;
 923         unsigned int rx_desc;
 924
 925         rxq = rte_zmalloc_socket(q_info->type, sizeof(struct hns3_rx_queue),
 926                                  RTE_CACHE_LINE_SIZE, q_info->socket_id);
 927         if (rxq == NULL) {
 928                 hns3_err(hw, "Failed to allocate memory for No.%d rx ring!",
 929                          q_info->idx);
 930                 return NULL;
 931         }
 932
 933         /* Allocate rx ring hardware descriptors. */
 934         rxq->queue_id = q_info->idx;
 935         rxq->nb_rx_desc = q_info->nb_desc;
 936
 937         /*
 938          * Allocate a litter more memory because rx vector functions
 939          * don't check boundaries each time.
 940          */
 941         rx_desc = (rxq->nb_rx_desc + HNS3_DEFAULT_RX_BURST) *
 942                         sizeof(struct hns3_desc);
 943         rx_mz = rte_eth_dma_zone_reserve(dev, q_info->ring_name, q_info->idx,
 944                                          rx_desc, HNS3_RING_BASE_ALIGN,
 945                                          q_info->socket_id);
 946         if (rx_mz == NULL) {
 947                 hns3_err(hw, "Failed to reserve DMA memory for No.%d rx ring!",
 948                          q_info->idx);
 949                 hns3_rx_queue_release(rxq);
 950                 return NULL;
 951         }
 952         rxq->mz = rx_mz;
 953         rxq->rx_ring = (struct hns3_desc *)rx_mz->addr;
 954         rxq->rx_ring_phys_addr = rx_mz->iova;
 955
 956         hns3_dbg(hw, "No.%d rx descriptors iova 0x%" PRIx64, q_info->idx,
 957                  rxq->rx_ring_phys_addr);
 958
 959         return rxq;
 960 }
 961
 962 static int
 963 hns3_fake_rx_queue_setup(struct rte_eth_dev *dev, uint16_t idx,
 964                          uint16_t nb_desc, unsigned int socket_id)
 965 {
 966         struct hns3_adapter *hns = dev->data->dev_private;
 967         struct hns3_hw *hw = &hns->hw;
 968         struct hns3_queue_info q_info;
 969         struct hns3_rx_queue *rxq;
 970         uint16_t nb_rx_q;
 971
 972         if (hw->fkq_data.rx_queues[idx]) {
 973                 hns3_rx_queue_release(hw->fkq_data.rx_queues[idx]);
 974                 hw->fkq_data.rx_queues[idx] = NULL;
 975         }
 976
 977         q_info.idx = idx;
 978         q_info.socket_id = socket_id;
 979         q_info.nb_desc = nb_desc;
 980         q_info.type = "hns3 fake RX queue";
 981         q_info.ring_name = "rx_fake_ring";
 982         rxq = hns3_alloc_rxq_and_dma_zone(dev, &q_info);
 983         if (rxq == NULL) {
 984                 hns3_err(hw, "Failed to setup No.%d fake rx ring.", idx);
 985                 return -ENOMEM;
 986         }
 987
 988         /* Don't need alloc sw_ring, because upper applications don't use it */
 989         rxq->sw_ring = NULL;
 990
 991         rxq->hns = hns;
 992         rxq->rx_deferred_start = false;
 993         rxq->port_id = dev->data->port_id;
 994         rxq->configured = true;
 995         nb_rx_q = dev->data->nb_rx_queues;
 996         rxq->io_base = (void *)((char *)hw->io_base + HNS3_TQP_REG_OFFSET +
 997                                 (nb_rx_q + idx) * HNS3_TQP_REG_SIZE);
 998         rxq->rx_buf_len = HNS3_MIN_BD_BUF_SIZE;
 999
1000         rte_spinlock_lock(&hw->lock);
1001         hw->fkq_data.rx_queues[idx] = rxq;
1002         rte_spinlock_unlock(&hw->lock);
1003
1004         return 0;
1005 }
1006
1007 static void*
1008 hns3_alloc_txq_and_dma_zone(struct rte_eth_dev *dev,
1009                             struct hns3_queue_info *q_info)
1010 {
1011         struct hns3_hw *hw = HNS3_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1012         const struct rte_memzone *tx_mz;
1013         struct hns3_tx_queue *txq;
1014         struct hns3_desc *desc;
1015         unsigned int tx_desc;
1016         int i;
1017
1018         txq = rte_zmalloc_socket(q_info->type, sizeof(struct hns3_tx_queue),
1019                                  RTE_CACHE_LINE_SIZE, q_info->socket_id);
1020         if (txq == NULL) {
1021                 hns3_err(hw, "Failed to allocate memory for No.%d tx ring!",
1022                          q_info->idx);
1023                 return NULL;
1024         }
1025
1026         /* Allocate tx ring hardware descriptors. */
1027         txq->queue_id = q_info->idx;
1028         txq->nb_tx_desc = q_info->nb_desc;
1029         tx_desc = txq->nb_tx_desc * sizeof(struct hns3_desc);
1030         tx_mz = rte_eth_dma_zone_reserve(dev, q_info->ring_name, q_info->idx,
1031                                          tx_desc, HNS3_RING_BASE_ALIGN,
1032                                          q_info->socket_id);
1033         if (tx_mz == NULL) {
1034                 hns3_err(hw, "Failed to reserve DMA memory for No.%d tx ring!",
1035                          q_info->idx);
1036                 hns3_tx_queue_release(txq);
1037                 return NULL;
1038         }
1039         txq->mz = tx_mz;
1040         txq->tx_ring = (struct hns3_desc *)tx_mz->addr;
1041         txq->tx_ring_phys_addr = tx_mz->iova;
1042
1043         hns3_dbg(hw, "No.%d tx descriptors iova 0x%" PRIx64, q_info->idx,
1044                  txq->tx_ring_phys_addr);
1045
1046         /* Clear tx bd */
1047         desc = txq->tx_ring;
1048         for (i = 0; i < txq->nb_tx_desc; i++) {
1049                 desc->tx.tp_fe_sc_vld_ra_ri = 0;
1050                 desc++;
1051         }
1052
1053         return txq;
1054 }
1055
1056 static int
1057 hns3_fake_tx_queue_setup(struct rte_eth_dev *dev, uint16_t idx,
1058                          uint16_t nb_desc, unsigned int socket_id)
1059 {
1060         struct hns3_adapter *hns = dev->data->dev_private;
1061         struct hns3_hw *hw = &hns->hw;
1062         struct hns3_queue_info q_info;
1063         struct hns3_tx_queue *txq;
1064         uint16_t nb_tx_q;
1065
1066         if (hw->fkq_data.tx_queues[idx] != NULL) {
1067                 hns3_tx_queue_release(hw->fkq_data.tx_queues[idx]);
1068                 hw->fkq_data.tx_queues[idx] = NULL;
1069         }
1070
1071         q_info.idx = idx;
1072         q_info.socket_id = socket_id;
1073         q_info.nb_desc = nb_desc;
1074         q_info.type = "hns3 fake TX queue";
1075         q_info.ring_name = "tx_fake_ring";
1076         txq = hns3_alloc_txq_and_dma_zone(dev, &q_info);
1077         if (txq == NULL) {
1078                 hns3_err(hw, "Failed to setup No.%d fake tx ring.", idx);
1079                 return -ENOMEM;
1080         }
1081
1082         /* Don't need alloc sw_ring, because upper applications don't use it */
1083         txq->sw_ring = NULL;
1084         txq->free = NULL;
1085
1086         txq->hns = hns;
1087         txq->tx_deferred_start = false;
1088         txq->port_id = dev->data->port_id;
1089         txq->configured = true;
1090         nb_tx_q = dev->data->nb_tx_queues;
1091         txq->io_base = (void *)((char *)hw->io_base + HNS3_TQP_REG_OFFSET +
1092                                 (nb_tx_q + idx) * HNS3_TQP_REG_SIZE);
1093
1094         rte_spinlock_lock(&hw->lock);
1095         hw->fkq_data.tx_queues[idx] = txq;
1096         rte_spinlock_unlock(&hw->lock);
1097
1098         return 0;
1099 }
1100
1101 static int
1102 hns3_fake_rx_queue_config(struct hns3_hw *hw, uint16_t nb_queues)
1103 {
1104         uint16_t old_nb_queues = hw->fkq_data.nb_fake_rx_queues;
1105         void **rxq;
1106         uint8_t i;
1107
1108         if (hw->fkq_data.rx_queues == NULL && nb_queues != 0) {
1109                 /* first time configuration */
1110                 uint32_t size;
1111                 size = sizeof(hw->fkq_data.rx_queues[0]) * nb_queues;
1112                 hw->fkq_data.rx_queues = rte_zmalloc("fake_rx_queues", size,
1113                                                      RTE_CACHE_LINE_SIZE);
1114                 if (hw->fkq_data.rx_queues == NULL) {
1115                         hw->fkq_data.nb_fake_rx_queues = 0;
1116                         return -ENOMEM;
1117                 }
1118         } else if (hw->fkq_data.rx_queues != NULL && nb_queues != 0) {
1119                 /* re-configure */
1120                 rxq = hw->fkq_data.rx_queues;
1121                 for (i = nb_queues; i < old_nb_queues; i++)
1122                         hns3_dev_rx_queue_release(rxq[i]);
1123
1124                 rxq = rte_realloc(rxq, sizeof(rxq[0]) * nb_queues,
1125                                   RTE_CACHE_LINE_SIZE);
1126                 if (rxq == NULL)
1127                         return -ENOMEM;
1128                 if (nb_queues > old_nb_queues) {
1129                         uint16_t new_qs = nb_queues - old_nb_queues;
1130                         memset(rxq + old_nb_queues, 0, sizeof(rxq[0]) * new_qs);
1131                 }
1132
1133                 hw->fkq_data.rx_queues = rxq;
1134         } else if (hw->fkq_data.rx_queues != NULL && nb_queues == 0) {
1135                 rxq = hw->fkq_data.rx_queues;
1136                 for (i = nb_queues; i < old_nb_queues; i++)
1137                         hns3_dev_rx_queue_release(rxq[i]);
1138
1139                 rte_free(hw->fkq_data.rx_queues);
1140                 hw->fkq_data.rx_queues = NULL;
1141         }
1142
1143         hw->fkq_data.nb_fake_rx_queues = nb_queues;
1144
1145         return 0;
1146 }
1147
1148 static int
1149 hns3_fake_tx_queue_config(struct hns3_hw *hw, uint16_t nb_queues)
1150 {
1151         uint16_t old_nb_queues = hw->fkq_data.nb_fake_tx_queues;
1152         void **txq;
1153         uint8_t i;
1154
1155         if (hw->fkq_data.tx_queues == NULL && nb_queues != 0) {
1156                 /* first time configuration */
1157                 uint32_t size;
1158                 size = sizeof(hw->fkq_data.tx_queues[0]) * nb_queues;
1159                 hw->fkq_data.tx_queues = rte_zmalloc("fake_tx_queues", size,
1160                                                      RTE_CACHE_LINE_SIZE);
1161                 if (hw->fkq_data.tx_queues == NULL) {
1162                         hw->fkq_data.nb_fake_tx_queues = 0;
1163                         return -ENOMEM;
1164                 }
1165         } else if (hw->fkq_data.tx_queues != NULL && nb_queues != 0) {
1166                 /* re-configure */
1167                 txq = hw->fkq_data.tx_queues;
1168                 for (i = nb_queues; i < old_nb_queues; i++)
1169                         hns3_dev_tx_queue_release(txq[i]);
1170                 txq = rte_realloc(txq, sizeof(txq[0]) * nb_queues,
1171                                   RTE_CACHE_LINE_SIZE);
1172                 if (txq == NULL)
1173                         return -ENOMEM;
1174                 if (nb_queues > old_nb_queues) {
1175                         uint16_t new_qs = nb_queues - old_nb_queues;
1176                         memset(txq + old_nb_queues, 0, sizeof(txq[0]) * new_qs);
1177                 }
1178
1179                 hw->fkq_data.tx_queues = txq;
1180         } else if (hw->fkq_data.tx_queues != NULL && nb_queues == 0) {
1181                 txq = hw->fkq_data.tx_queues;
1182                 for (i = nb_queues; i < old_nb_queues; i++)
1183                         hns3_dev_tx_queue_release(txq[i]);
1184
1185                 rte_free(hw->fkq_data.tx_queues);
1186                 hw->fkq_data.tx_queues = NULL;
1187         }
1188         hw->fkq_data.nb_fake_tx_queues = nb_queues;
1189
1190         return 0;
1191 }
1192
1193 int
1194 hns3_set_fake_rx_or_tx_queues(struct rte_eth_dev *dev, uint16_t nb_rx_q,
1195                               uint16_t nb_tx_q)
1196 {
1197         struct hns3_hw *hw = HNS3_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1198         uint16_t rx_need_add_nb_q;
1199         uint16_t tx_need_add_nb_q;
1200         uint16_t port_id;
1201         uint16_t q;
1202         int ret;
1203
1204         /* Setup new number of fake RX/TX queues and reconfigure device. */
1205         hw->cfg_max_queues = RTE_MAX(nb_rx_q, nb_tx_q);
1206         rx_need_add_nb_q = hw->cfg_max_queues - nb_rx_q;
1207         tx_need_add_nb_q = hw->cfg_max_queues - nb_tx_q;
1208         ret = hns3_fake_rx_queue_config(hw, rx_need_add_nb_q);
1209         if (ret) {
1210                 hns3_err(hw, "Fail to configure fake rx queues: %d", ret);
1211                 goto cfg_fake_rx_q_fail;
1212         }
1213
1214         ret = hns3_fake_tx_queue_config(hw, tx_need_add_nb_q);
1215         if (ret) {
1216                 hns3_err(hw, "Fail to configure fake rx queues: %d", ret);
1217                 goto cfg_fake_tx_q_fail;
1218         }
1219
1220         /* Allocate and set up fake RX queue per Ethernet port. */
1221         port_id = hw->data->port_id;
1222         for (q = 0; q < rx_need_add_nb_q; q++) {
1223                 ret = hns3_fake_rx_queue_setup(dev, q, HNS3_MIN_RING_DESC,
1224                                                rte_eth_dev_socket_id(port_id));
1225                 if (ret)
1226                         goto setup_fake_rx_q_fail;
1227         }
1228
1229         /* Allocate and set up fake TX queue per Ethernet port. */
1230         for (q = 0; q < tx_need_add_nb_q; q++) {
1231                 ret = hns3_fake_tx_queue_setup(dev, q, HNS3_MIN_RING_DESC,
1232                                                rte_eth_dev_socket_id(port_id));
1233                 if (ret)
1234                         goto setup_fake_tx_q_fail;
1235         }
1236
1237         return 0;
1238
1239 setup_fake_tx_q_fail:
1240 setup_fake_rx_q_fail:
1241         (void)hns3_fake_tx_queue_config(hw, 0);
1242 cfg_fake_tx_q_fail:
1243         (void)hns3_fake_rx_queue_config(hw, 0);
1244 cfg_fake_rx_q_fail:
1245         hw->cfg_max_queues = 0;
1246
1247         return ret;
1248 }
1249
1250 void
1251 hns3_dev_release_mbufs(struct hns3_adapter *hns)
1252 {
1253         struct rte_eth_dev_data *dev_data = hns->hw.data;
1254         struct hns3_rx_queue *rxq;
1255         struct hns3_tx_queue *txq;
1256         int i;
1257
1258         if (dev_data->rx_queues)
1259                 for (i = 0; i < dev_data->nb_rx_queues; i++) {
1260                         rxq = dev_data->rx_queues[i];
1261                         if (rxq == NULL || rxq->rx_deferred_start)
1262                                 continue;
1263                         hns3_rx_queue_release_mbufs(rxq);
1264                 }
1265
1266         if (dev_data->tx_queues)
1267                 for (i = 0; i < dev_data->nb_tx_queues; i++) {
1268                         txq = dev_data->tx_queues[i];
1269                         if (txq == NULL || txq->tx_deferred_start)
1270                                 continue;
1271                         hns3_tx_queue_release_mbufs(txq);
1272                 }
1273 }
1274
1275 static int
1276 hns3_rx_buf_len_calc(struct rte_mempool *mp, uint16_t *rx_buf_len)
1277 {
1278         uint16_t vld_buf_size;
1279         uint16_t num_hw_specs;
1280         uint16_t i;
1281
1282         /*
1283          * hns3 network engine only support to set 4 typical specification, and
1284          * different buffer size will affect the max packet_len and the max
1285          * number of segmentation when hw gro is turned on in receive side. The
1286          * relationship between them is as follows:
1287          *      rx_buf_size     |  max_gro_pkt_len  |  max_gro_nb_seg
1288          * ---------------------|-------------------|----------------
1289          * HNS3_4K_BD_BUF_SIZE  |        60KB       |       15
1290          * HNS3_2K_BD_BUF_SIZE  |        62KB       |       31
1291          * HNS3_1K_BD_BUF_SIZE  |        63KB       |       63
1292          * HNS3_512_BD_BUF_SIZE |      31.5KB       |       63
1293          */
1294         static const uint16_t hw_rx_buf_size[] = {
1295                 HNS3_4K_BD_BUF_SIZE,
1296                 HNS3_2K_BD_BUF_SIZE,
1297                 HNS3_1K_BD_BUF_SIZE,
1298                 HNS3_512_BD_BUF_SIZE
1299         };
1300
1301         vld_buf_size = (uint16_t)(rte_pktmbuf_data_room_size(mp) -
1302                         RTE_PKTMBUF_HEADROOM);
1303
1304         if (vld_buf_size < HNS3_MIN_BD_BUF_SIZE)
1305                 return -EINVAL;
1306
1307         num_hw_specs = RTE_DIM(hw_rx_buf_size);
1308         for (i = 0; i < num_hw_specs; i++) {
1309                 if (vld_buf_size >= hw_rx_buf_size[i]) {
1310                         *rx_buf_len = hw_rx_buf_size[i];
1311                         break;
1312                 }
1313         }
1314         return 0;
1315 }
1316
1317 static int
1318 hns3_rx_queue_conf_check(struct hns3_hw *hw, const struct rte_eth_rxconf *conf,
1319                          struct rte_mempool *mp, uint16_t nb_desc,
1320                          uint16_t *buf_size)
1321 {
1322         if (nb_desc > HNS3_MAX_RING_DESC || nb_desc < HNS3_MIN_RING_DESC ||
1323             nb_desc % HNS3_ALIGN_RING_DESC) {
1324                 hns3_err(hw, "Number (%u) of rx descriptors is invalid",
1325                          nb_desc);
1326                 return -EINVAL;
1327         }
1328
1329         if (conf->rx_drop_en == 0)
1330                 hns3_warn(hw, "if no descriptors available, packets are always "
1331                           "dropped and rx_drop_en (1) is fixed on");
1332
1333         if (hns3_rx_buf_len_calc(mp, buf_size)) {
1334                 hns3_err(hw, "rxq mbufs' data room size (%u) is not enough! "
1335                                 "minimal data room size (%u).",
1336                                 rte_pktmbuf_data_room_size(mp),
1337                                 HNS3_MIN_BD_BUF_SIZE + RTE_PKTMBUF_HEADROOM);
1338                 return -EINVAL;
1339         }
1340
1341         return 0;
1342 }
1343
1344 int
1345 hns3_rx_queue_setup(struct rte_eth_dev *dev, uint16_t idx, uint16_t nb_desc,
1346                     unsigned int socket_id, const struct rte_eth_rxconf *conf,
1347                     struct rte_mempool *mp)
1348 {
1349         struct hns3_adapter *hns = dev->data->dev_private;
1350         struct hns3_hw *hw = &hns->hw;
1351         struct hns3_queue_info q_info;
1352         struct hns3_rx_queue *rxq;
1353         uint16_t rx_buf_size;
1354         int rx_entry_len;
1355         int ret;
1356
1357         if (dev->data->dev_started) {
1358                 hns3_err(hw, "rx_queue_setup after dev_start no supported");
1359                 return -EINVAL;
1360         }
1361
1362         ret = hns3_rx_queue_conf_check(hw, conf, mp, nb_desc, &rx_buf_size);
1363         if (ret)
1364                 return ret;
1365
1366         if (dev->data->rx_queues[idx]) {
1367                 hns3_rx_queue_release(dev->data->rx_queues[idx]);
1368                 dev->data->rx_queues[idx] = NULL;
1369         }
1370
1371         q_info.idx = idx;
1372         q_info.socket_id = socket_id;
1373         q_info.nb_desc = nb_desc;
1374         q_info.type = "hns3 RX queue";
1375         q_info.ring_name = "rx_ring";
1376
1377         rxq = hns3_alloc_rxq_and_dma_zone(dev, &q_info);
1378         if (rxq == NULL) {
1379                 hns3_err(hw,
1380                          "Failed to alloc mem and reserve DMA mem for rx ring!");
1381                 return -ENOMEM;
1382         }
1383
1384         rxq->hns = hns;
1385         rxq->ptype_tbl = &hns->ptype_tbl;
1386         rxq->mb_pool = mp;
1387         rxq->rx_free_thresh = (conf->rx_free_thresh > 0) ?
1388                 conf->rx_free_thresh : HNS3_DEFAULT_RX_FREE_THRESH;
1389         rxq->rx_deferred_start = conf->rx_deferred_start;
1390
1391         rx_entry_len = (rxq->nb_rx_desc + HNS3_DEFAULT_RX_BURST) *
1392                         sizeof(struct hns3_entry);
1393         rxq->sw_ring = rte_zmalloc_socket("hns3 RX sw ring", rx_entry_len,
1394                                           RTE_CACHE_LINE_SIZE, socket_id);
1395         if (rxq->sw_ring == NULL) {
1396                 hns3_err(hw, "Failed to allocate memory for rx sw ring!");
1397                 hns3_rx_queue_release(rxq);
1398                 return -ENOMEM;
1399         }
1400
1401         rxq->next_to_use = 0;
1402         rxq->rx_free_hold = 0;
1403         rxq->rx_rearm_start = 0;
1404         rxq->rx_rearm_nb = 0;
1405         rxq->pkt_first_seg = NULL;
1406         rxq->pkt_last_seg = NULL;
1407         rxq->port_id = dev->data->port_id;
1408         rxq->pvid_state = hw->port_base_vlan_cfg.state;
1409         rxq->configured = true;
1410         rxq->io_base = (void *)((char *)hw->io_base + HNS3_TQP_REG_OFFSET +
1411                                 idx * HNS3_TQP_REG_SIZE);
1412         rxq->io_head_reg = (volatile void *)((char *)rxq->io_base +
1413                            HNS3_RING_RX_HEAD_REG);
1414         rxq->rx_buf_len = rx_buf_size;
1415         rxq->l2_errors = 0;
1416         rxq->pkt_len_errors = 0;
1417         rxq->l3_csum_errors = 0;
1418         rxq->l4_csum_errors = 0;
1419         rxq->ol3_csum_errors = 0;
1420         rxq->ol4_csum_errors = 0;
1421
1422         /* CRC len set here is used for amending packet length */
1423         if (dev->data->dev_conf.rxmode.offloads & DEV_RX_OFFLOAD_KEEP_CRC)
1424                 rxq->crc_len = RTE_ETHER_CRC_LEN;
1425         else
1426                 rxq->crc_len = 0;
1427
1428         rxq->bulk_mbuf_num = 0;
1429
1430         rte_spinlock_lock(&hw->lock);
1431         dev->data->rx_queues[idx] = rxq;
1432         rte_spinlock_unlock(&hw->lock);
1433
1434         return 0;
1435 }
1436
1437 void
1438 hns3_rx_scattered_reset(struct rte_eth_dev *dev)
1439 {
1440         struct hns3_adapter *hns = dev->data->dev_private;
1441         struct hns3_hw *hw = &hns->hw;
1442
1443         hw->rx_buf_len = 0;
1444         dev->data->scattered_rx = false;
1445 }
1446
1447 void
1448 hns3_rx_scattered_calc(struct rte_eth_dev *dev)
1449 {
1450         struct rte_eth_conf *dev_conf = &dev->data->dev_conf;
1451         struct hns3_adapter *hns = dev->data->dev_private;
1452         struct hns3_hw *hw = &hns->hw;
1453         struct hns3_rx_queue *rxq;
1454         uint32_t queue_id;
1455
1456         if (dev->data->rx_queues == NULL)
1457                 return;
1458
1459         for (queue_id = 0; queue_id < dev->data->nb_rx_queues; queue_id++) {
1460                 rxq = dev->data->rx_queues[queue_id];
1461                 if (hw->rx_buf_len == 0)
1462                         hw->rx_buf_len = rxq->rx_buf_len;
1463                 else
1464                         hw->rx_buf_len = RTE_MIN(hw->rx_buf_len,
1465                                                  rxq->rx_buf_len);
1466         }
1467
1468         if (dev_conf->rxmode.offloads & DEV_RX_OFFLOAD_SCATTER ||
1469             dev_conf->rxmode.max_rx_pkt_len > hw->rx_buf_len)
1470                 dev->data->scattered_rx = true;
1471 }
1472
1473 const uint32_t *
1474 hns3_dev_supported_ptypes_get(struct rte_eth_dev *dev)
1475 {
1476         static const uint32_t ptypes[] = {
1477                 RTE_PTYPE_L2_ETHER,
1478                 RTE_PTYPE_L2_ETHER_VLAN,
1479                 RTE_PTYPE_L2_ETHER_QINQ,
1480                 RTE_PTYPE_L2_ETHER_LLDP,
1481                 RTE_PTYPE_L2_ETHER_ARP,
1482                 RTE_PTYPE_L3_IPV4,
1483                 RTE_PTYPE_L3_IPV4_EXT,
1484                 RTE_PTYPE_L3_IPV6,
1485                 RTE_PTYPE_L3_IPV6_EXT,
1486                 RTE_PTYPE_L4_IGMP,
1487                 RTE_PTYPE_L4_ICMP,
1488                 RTE_PTYPE_L4_SCTP,
1489                 RTE_PTYPE_L4_TCP,
1490                 RTE_PTYPE_L4_UDP,
1491                 RTE_PTYPE_TUNNEL_GRE,
1492                 RTE_PTYPE_UNKNOWN
1493         };
1494
1495         if (dev->rx_pkt_burst == hns3_recv_pkts ||
1496             dev->rx_pkt_burst == hns3_recv_scattered_pkts ||
1497             dev->rx_pkt_burst == hns3_recv_pkts_vec)
1498                 return ptypes;
1499
1500         return NULL;
1501 }
1502
1503 void
1504 hns3_init_rx_ptype_tble(struct rte_eth_dev *dev)
1505 {
1506         struct hns3_adapter *hns = dev->data->dev_private;
1507         struct hns3_ptype_table *tbl = &hns->ptype_tbl;
1508
1509         memset(tbl, 0, sizeof(*tbl));
1510
1511         tbl->l2table[0] = RTE_PTYPE_L2_ETHER;
1512         tbl->l2table[1] = RTE_PTYPE_L2_ETHER_QINQ;
1513         tbl->l2table[2] = RTE_PTYPE_L2_ETHER_VLAN;
1514         tbl->l2table[3] = RTE_PTYPE_L2_ETHER_VLAN;
1515
1516         tbl->l3table[0] = RTE_PTYPE_L3_IPV4;
1517         tbl->l3table[1] = RTE_PTYPE_L3_IPV6;
1518         tbl->l3table[2] = RTE_PTYPE_L2_ETHER_ARP;
1519         tbl->l3table[3] = RTE_PTYPE_L2_ETHER;
1520         tbl->l3table[4] = RTE_PTYPE_L3_IPV4_EXT;
1521         tbl->l3table[5] = RTE_PTYPE_L3_IPV6_EXT;
1522         tbl->l3table[6] = RTE_PTYPE_L2_ETHER_LLDP;
1523
1524         tbl->l4table[0] = RTE_PTYPE_L4_UDP;
1525         tbl->l4table[1] = RTE_PTYPE_L4_TCP;
1526         tbl->l4table[2] = RTE_PTYPE_TUNNEL_GRE;
1527         tbl->l4table[3] = RTE_PTYPE_L4_SCTP;
1528         tbl->l4table[4] = RTE_PTYPE_L4_IGMP;
1529         tbl->l4table[5] = RTE_PTYPE_L4_ICMP;
1530
1531         tbl->inner_l2table[0] = RTE_PTYPE_INNER_L2_ETHER;
1532         tbl->inner_l2table[1] = RTE_PTYPE_INNER_L2_ETHER_VLAN;
1533         tbl->inner_l2table[2] = RTE_PTYPE_INNER_L2_ETHER_QINQ;
1534
1535         tbl->inner_l3table[0] = RTE_PTYPE_INNER_L3_IPV4;
1536         tbl->inner_l3table[1] = RTE_PTYPE_INNER_L3_IPV6;
1537         tbl->inner_l3table[2] = 0;
1538         tbl->inner_l3table[3] = RTE_PTYPE_INNER_L2_ETHER;
1539         tbl->inner_l3table[4] = RTE_PTYPE_INNER_L3_IPV4_EXT;
1540         tbl->inner_l3table[5] = RTE_PTYPE_INNER_L3_IPV6_EXT;
1541
1542         tbl->inner_l4table[0] = RTE_PTYPE_INNER_L4_UDP;
1543         tbl->inner_l4table[1] = RTE_PTYPE_INNER_L4_TCP;
1544         tbl->inner_l4table[2] = RTE_PTYPE_TUNNEL_GRE;
1545         tbl->inner_l4table[3] = RTE_PTYPE_INNER_L4_SCTP;
1546         tbl->inner_l4table[4] = RTE_PTYPE_L4_IGMP;
1547         tbl->inner_l4table[5] = RTE_PTYPE_INNER_L4_ICMP;
1548
1549         tbl->ol3table[0] = RTE_PTYPE_L3_IPV4;
1550         tbl->ol3table[1] = RTE_PTYPE_L3_IPV6;
1551         tbl->ol3table[2] = 0;
1552         tbl->ol3table[3] = 0;
1553         tbl->ol3table[4] = RTE_PTYPE_L3_IPV4_EXT;
1554         tbl->ol3table[5] = RTE_PTYPE_L3_IPV6_EXT;
1555
1556         tbl->ol4table[0] = 0;
1557         tbl->ol4table[1] = RTE_PTYPE_TUNNEL_VXLAN;
1558         tbl->ol4table[2] = RTE_PTYPE_TUNNEL_NVGRE;
1559 }
1560
1561 static inline void
1562 hns3_rxd_to_vlan_tci(struct hns3_rx_queue *rxq, struct rte_mbuf *mb,
1563                      uint32_t l234_info, const struct hns3_desc *rxd)
1564 {
1565 #define HNS3_STRP_STATUS_NUM            0x4
1566
1567 #define HNS3_NO_STRP_VLAN_VLD           0x0
1568 #define HNS3_INNER_STRP_VLAN_VLD        0x1
1569 #define HNS3_OUTER_STRP_VLAN_VLD        0x2
1570         uint32_t strip_status;
1571         uint32_t report_mode;
1572
1573         /*
1574          * Since HW limitation, the vlan tag will always be inserted into RX
1575          * descriptor when strip the tag from packet, driver needs to determine
1576          * reporting which tag to mbuf according to the PVID configuration
1577          * and vlan striped status.
1578          */
1579         static const uint32_t report_type[][HNS3_STRP_STATUS_NUM] = {
1580                 {
1581                         HNS3_NO_STRP_VLAN_VLD,
1582                         HNS3_OUTER_STRP_VLAN_VLD,
1583                         HNS3_INNER_STRP_VLAN_VLD,
1584                         HNS3_OUTER_STRP_VLAN_VLD
1585                 },
1586                 {
1587                         HNS3_NO_STRP_VLAN_VLD,
1588                         HNS3_NO_STRP_VLAN_VLD,
1589                         HNS3_NO_STRP_VLAN_VLD,
1590                         HNS3_INNER_STRP_VLAN_VLD
1591                 }
1592         };
1593         strip_status = hns3_get_field(l234_info, HNS3_RXD_STRP_TAGP_M,
1594                                       HNS3_RXD_STRP_TAGP_S);
1595         report_mode = report_type[rxq->pvid_state][strip_status];
1596         switch (report_mode) {
1597         case HNS3_NO_STRP_VLAN_VLD:
1598                 mb->vlan_tci = 0;
1599                 return;
1600         case HNS3_INNER_STRP_VLAN_VLD:
1601                 mb->ol_flags |= PKT_RX_VLAN | PKT_RX_VLAN_STRIPPED;
1602                 mb->vlan_tci = rte_le_to_cpu_16(rxd->rx.vlan_tag);
1603                 return;
1604         case HNS3_OUTER_STRP_VLAN_VLD:
1605                 mb->ol_flags |= PKT_RX_VLAN | PKT_RX_VLAN_STRIPPED;
1606                 mb->vlan_tci = rte_le_to_cpu_16(rxd->rx.ot_vlan_tag);
1607                 return;
1608         }
1609 }
1610
1611 static inline void
1612 recalculate_data_len(struct rte_mbuf *first_seg, struct rte_mbuf *last_seg,
1613                     struct rte_mbuf *rxm, struct hns3_rx_queue *rxq,
1614                     uint16_t data_len)
1615 {
1616         uint8_t crc_len = rxq->crc_len;
1617
1618         if (data_len <= crc_len) {
1619                 rte_pktmbuf_free_seg(rxm);
1620                 first_seg->nb_segs--;
1621                 last_seg->data_len = (uint16_t)(last_seg->data_len -
1622                         (crc_len - data_len));
1623                 last_seg->next = NULL;
1624         } else
1625                 rxm->data_len = (uint16_t)(data_len - crc_len);
1626 }
1627
1628 static inline struct rte_mbuf *
1629 hns3_rx_alloc_buffer(struct hns3_rx_queue *rxq)
1630 {
1631         int ret;
1632
1633         if (likely(rxq->bulk_mbuf_num > 0))
1634                 return rxq->bulk_mbuf[--rxq->bulk_mbuf_num];
1635
1636         ret = rte_mempool_get_bulk(rxq->mb_pool, (void **)rxq->bulk_mbuf,
1637                                    HNS3_BULK_ALLOC_MBUF_NUM);
1638         if (likely(ret == 0)) {
1639                 rxq->bulk_mbuf_num = HNS3_BULK_ALLOC_MBUF_NUM;
1640                 return rxq->bulk_mbuf[--rxq->bulk_mbuf_num];
1641         } else
1642                 return rte_mbuf_raw_alloc(rxq->mb_pool);
1643 }
1644
1645 uint16_t
1646 hns3_recv_pkts(void *rx_queue, struct rte_mbuf **rx_pkts, uint16_t nb_pkts)
1647 {
1648         volatile struct hns3_desc *rx_ring;  /* RX ring (desc) */
1649         volatile struct hns3_desc *rxdp;     /* pointer of the current desc */
1650         struct hns3_rx_queue *rxq;      /* RX queue */
1651         struct hns3_entry *sw_ring;
1652         struct hns3_entry *rxe;
1653         struct hns3_desc rxd;
1654         struct rte_mbuf *nmb;           /* pointer of the new mbuf */
1655         struct rte_mbuf *rxm;
1656         uint32_t bd_base_info;
1657         uint32_t cksum_err;
1658         uint32_t l234_info;
1659         uint32_t ol_info;
1660         uint64_t dma_addr;
1661         uint16_t nb_rx_bd;
1662         uint16_t nb_rx;
1663         uint16_t rx_id;
1664         int ret;
1665
1666         nb_rx = 0;
1667         nb_rx_bd = 0;
1668         rxq = rx_queue;
1669         rx_ring = rxq->rx_ring;
1670         sw_ring = rxq->sw_ring;
1671         rx_id = rxq->next_to_use;
1672
1673         while (nb_rx < nb_pkts) {
1674                 rxdp = &rx_ring[rx_id];
1675                 bd_base_info = rte_le_to_cpu_32(rxdp->rx.bd_base_info);
1676                 if (unlikely(!(bd_base_info & BIT(HNS3_RXD_VLD_B))))
1677                         break;
1678
1679                 rxd = rxdp[(bd_base_info & (1u << HNS3_RXD_VLD_B)) -
1680                            (1u << HNS3_RXD_VLD_B)];
1681
1682                 nmb = hns3_rx_alloc_buffer(rxq);
1683                 if (unlikely(nmb == NULL)) {
1684                         uint16_t port_id;
1685
1686                         port_id = rxq->port_id;
1687                         rte_eth_devices[port_id].data->rx_mbuf_alloc_failed++;
1688                         break;
1689                 }
1690
1691                 nb_rx_bd++;
1692                 rxe = &sw_ring[rx_id];
1693                 rx_id++;
1694                 if (unlikely(rx_id == rxq->nb_rx_desc))
1695                         rx_id = 0;
1696
1697                 rte_prefetch0(sw_ring[rx_id].mbuf);
1698                 if ((rx_id & HNS3_RX_RING_PREFETCTH_MASK) == 0) {
1699                         rte_prefetch0(&rx_ring[rx_id]);
1700                         rte_prefetch0(&sw_ring[rx_id]);
1701                 }
1702
1703                 rxm = rxe->mbuf;
1704                 rxe->mbuf = nmb;
1705
1706                 dma_addr = rte_mbuf_data_iova_default(nmb);
1707                 rxdp->addr = rte_cpu_to_le_64(dma_addr);
1708                 rxdp->rx.bd_base_info = 0;
1709
1710                 rxm->data_off = RTE_PKTMBUF_HEADROOM;
1711                 rxm->pkt_len = (uint16_t)(rte_le_to_cpu_16(rxd.rx.pkt_len)) -
1712                                 rxq->crc_len;
1713                 rxm->data_len = rxm->pkt_len;
1714                 rxm->port = rxq->port_id;
1715                 rxm->hash.rss = rte_le_to_cpu_32(rxd.rx.rss_hash);
1716                 rxm->ol_flags = PKT_RX_RSS_HASH;
1717                 if (unlikely(bd_base_info & BIT(HNS3_RXD_LUM_B))) {
1718                         rxm->hash.fdir.hi =
1719                                 rte_le_to_cpu_16(rxd.rx.fd_id);
1720                         rxm->ol_flags |= PKT_RX_FDIR | PKT_RX_FDIR_ID;
1721                 }
1722                 rxm->nb_segs = 1;
1723                 rxm->next = NULL;
1724
1725                 /* Load remained descriptor data and extract necessary fields */
1726                 l234_info = rte_le_to_cpu_32(rxd.rx.l234_info);
1727                 ol_info = rte_le_to_cpu_32(rxd.rx.ol_info);
1728                 ret = hns3_handle_bdinfo(rxq, rxm, bd_base_info,
1729                                          l234_info, &cksum_err);
1730                 if (unlikely(ret))
1731                         goto pkt_err;
1732
1733                 rxm->packet_type = hns3_rx_calc_ptype(rxq, l234_info, ol_info);
1734
1735                 if (likely(bd_base_info & BIT(HNS3_RXD_L3L4P_B)))
1736                         hns3_rx_set_cksum_flag(rxm, rxm->packet_type,
1737                                                cksum_err);
1738                 hns3_rxd_to_vlan_tci(rxq, rxm, l234_info, &rxd);
1739
1740                 rx_pkts[nb_rx++] = rxm;
1741                 continue;
1742 pkt_err:
1743                 rte_pktmbuf_free(rxm);
1744         }
1745
1746         rxq->next_to_use = rx_id;
1747         rxq->rx_free_hold += nb_rx_bd;
1748         if (rxq->rx_free_hold > rxq->rx_free_thresh) {
1749                 hns3_write_reg_opt(rxq->io_head_reg, rxq->rx_free_hold);
1750                 rxq->rx_free_hold = 0;
1751         }
1752
1753         return nb_rx;
1754 }
1755
1756 uint16_t
1757 hns3_recv_scattered_pkts(void *rx_queue,
1758                          struct rte_mbuf **rx_pkts,
1759                          uint16_t nb_pkts)
1760 {
1761         volatile struct hns3_desc *rx_ring;  /* RX ring (desc) */
1762         volatile struct hns3_desc *rxdp;     /* pointer of the current desc */
1763         struct hns3_rx_queue *rxq;      /* RX queue */
1764         struct hns3_entry *sw_ring;
1765         struct hns3_entry *rxe;
1766         struct rte_mbuf *first_seg;
1767         struct rte_mbuf *last_seg;
1768         struct hns3_desc rxd;
1769         struct rte_mbuf *nmb;           /* pointer of the new mbuf */
1770         struct rte_mbuf *rxm;
1771         struct rte_eth_dev *dev;
1772         uint32_t bd_base_info;
1773         uint32_t cksum_err;
1774         uint32_t l234_info;
1775         uint32_t gro_size;
1776         uint32_t ol_info;
1777         uint64_t dma_addr;
1778         uint16_t nb_rx_bd;
1779         uint16_t nb_rx;
1780         uint16_t rx_id;
1781         int ret;
1782
1783         nb_rx = 0;
1784         nb_rx_bd = 0;
1785         rxq = rx_queue;
1786
1787         rx_id = rxq->next_to_use;
1788         rx_ring = rxq->rx_ring;
1789         sw_ring = rxq->sw_ring;
1790         first_seg = rxq->pkt_first_seg;
1791         last_seg = rxq->pkt_last_seg;
1792
1793         while (nb_rx < nb_pkts) {
1794                 rxdp = &rx_ring[rx_id];
1795                 bd_base_info = rte_le_to_cpu_32(rxdp->rx.bd_base_info);
1796                 if (unlikely(!(bd_base_info & BIT(HNS3_RXD_VLD_B))))
1797                         break;
1798
1799                 /*
1800                  * The interactive process between software and hardware of
1801                  * receiving a new packet in hns3 network engine:
1802                  * 1. Hardware network engine firstly writes the packet content
1803                  *    to the memory pointed by the 'addr' field of the Rx Buffer
1804                  *    Descriptor, secondly fills the result of parsing the
1805                  *    packet include the valid field into the Rx Buffer
1806                  *    Descriptor in one write operation.
1807                  * 2. Driver reads the Rx BD's valid field in the loop to check
1808                  *    whether it's valid, if valid then assign a new address to
1809                  *    the addr field, clear the valid field, get the other
1810                  *    information of the packet by parsing Rx BD's other fields,
1811                  *    finally write back the number of Rx BDs processed by the
1812                  *    driver to the HNS3_RING_RX_HEAD_REG register to inform
1813                  *    hardware.
1814                  * In the above process, the ordering is very important. We must
1815                  * make sure that CPU read Rx BD's other fields only after the
1816                  * Rx BD is valid.
1817                  *
1818                  * There are two type of re-ordering: compiler re-ordering and
1819                  * CPU re-ordering under the ARMv8 architecture.
1820                  * 1. we use volatile to deal with compiler re-ordering, so you
1821                  *    can see that rx_ring/rxdp defined with volatile.
1822                  * 2. we commonly use memory barrier to deal with CPU
1823                  *    re-ordering, but the cost is high.
1824                  *
1825                  * In order to solve the high cost of using memory barrier, we
1826                  * use the data dependency order under the ARMv8 architecture,
1827                  * for example:
1828                  *      instr01: load A
1829                  *      instr02: load B <- A
1830                  * the instr02 will always execute after instr01.
1831                  *
1832                  * To construct the data dependency ordering, we use the
1833                  * following assignment:
1834                  *      rxd = rxdp[(bd_base_info & (1u << HNS3_RXD_VLD_B)) -
1835                  *                 (1u<<HNS3_RXD_VLD_B)]
1836                  * Using gcc compiler under the ARMv8 architecture, the related
1837                  * assembly code example as follows:
1838                  * note: (1u << HNS3_RXD_VLD_B) equal 0x10
1839                  *      instr01: ldr w26, [x22, #28]  --read bd_base_info
1840                  *      instr02: and w0, w26, #0x10   --calc bd_base_info & 0x10
1841                  *      instr03: sub w0, w0, #0x10    --calc (bd_base_info &
1842                  *                                            0x10) - 0x10
1843                  *      instr04: add x0, x22, x0, lsl #5 --calc copy source addr
1844                  *      instr05: ldp x2, x3, [x0]
1845                  *      instr06: stp x2, x3, [x29, #256] --copy BD's [0 ~ 15]B
1846                  *      instr07: ldp x4, x5, [x0, #16]
1847                  *      instr08: stp x4, x5, [x29, #272] --copy BD's [16 ~ 31]B
1848                  * the instr05~08 depend on x0's value, x0 depent on w26's
1849                  * value, the w26 is the bd_base_info, this form the data
1850                  * dependency ordering.
1851                  * note: if BD is valid, (bd_base_info & (1u<<HNS3_RXD_VLD_B)) -
1852                  *       (1u<<HNS3_RXD_VLD_B) will always zero, so the
1853                  *       assignment is correct.
1854                  *
1855                  * So we use the data dependency ordering instead of memory
1856                  * barrier to improve receive performance.
1857                  */
1858                 rxd = rxdp[(bd_base_info & (1u << HNS3_RXD_VLD_B)) -
1859                            (1u << HNS3_RXD_VLD_B)];
1860
1861                 nmb = hns3_rx_alloc_buffer(rxq);
1862                 if (unlikely(nmb == NULL)) {
1863                         dev = &rte_eth_devices[rxq->port_id];
1864                         dev->data->rx_mbuf_alloc_failed++;
1865                         break;
1866                 }
1867
1868                 nb_rx_bd++;
1869                 rxe = &sw_ring[rx_id];
1870                 rx_id++;
1871                 if (unlikely(rx_id == rxq->nb_rx_desc))
1872                         rx_id = 0;
1873
1874                 rte_prefetch0(sw_ring[rx_id].mbuf);
1875                 if ((rx_id & HNS3_RX_RING_PREFETCTH_MASK) == 0) {
1876                         rte_prefetch0(&rx_ring[rx_id]);
1877                         rte_prefetch0(&sw_ring[rx_id]);
1878                 }
1879
1880                 rxm = rxe->mbuf;
1881                 rxe->mbuf = nmb;
1882
1883                 dma_addr = rte_cpu_to_le_64(rte_mbuf_data_iova_default(nmb));
1884                 rxdp->rx.bd_base_info = 0;
1885                 rxdp->addr = dma_addr;
1886
1887                 if (first_seg == NULL) {
1888                         first_seg = rxm;
1889                         first_seg->nb_segs = 1;
1890                 } else {
1891                         first_seg->nb_segs++;
1892                         last_seg->next = rxm;
1893                 }
1894
1895                 rxm->data_off = RTE_PKTMBUF_HEADROOM;
1896                 rxm->data_len = rte_le_to_cpu_16(rxd.rx.size);
1897
1898                 if (!(bd_base_info & BIT(HNS3_RXD_FE_B))) {
1899                         last_seg = rxm;
1900                         rxm->next = NULL;
1901                         continue;
1902                 }
1903
1904                 /*
1905                  * The last buffer of the received packet. packet len from
1906                  * buffer description may contains CRC len, packet len should
1907                  * subtract it, same as data len.
1908                  */
1909                 first_seg->pkt_len = rte_le_to_cpu_16(rxd.rx.pkt_len);
1910
1911                 /*
1912                  * This is the last buffer of the received packet. If the CRC
1913                  * is not stripped by the hardware:
1914                  *  - Subtract the CRC length from the total packet length.
1915                  *  - If the last buffer only contains the whole CRC or a part
1916                  *  of it, free the mbuf associated to the last buffer. If part
1917                  *  of the CRC is also contained in the previous mbuf, subtract
1918                  *  the length of that CRC part from the data length of the
1919                  *  previous mbuf.
1920                  */
1921                 rxm->next = NULL;
1922                 if (unlikely(rxq->crc_len > 0)) {
1923                         first_seg->pkt_len -= rxq->crc_len;
1924                         recalculate_data_len(first_seg, last_seg, rxm, rxq,
1925                                 rxm->data_len);
1926                 }
1927
1928                 first_seg->port = rxq->port_id;
1929                 first_seg->hash.rss = rte_le_to_cpu_32(rxd.rx.rss_hash);
1930                 first_seg->ol_flags = PKT_RX_RSS_HASH;
1931                 if (unlikely(bd_base_info & BIT(HNS3_RXD_LUM_B))) {
1932                         first_seg->hash.fdir.hi =
1933                                 rte_le_to_cpu_16(rxd.rx.fd_id);
1934                         first_seg->ol_flags |= PKT_RX_FDIR | PKT_RX_FDIR_ID;
1935                 }
1936
1937                 gro_size = hns3_get_field(bd_base_info, HNS3_RXD_GRO_SIZE_M,
1938                                           HNS3_RXD_GRO_SIZE_S);
1939                 if (gro_size != 0) {
1940                         first_seg->ol_flags |= PKT_RX_LRO;
1941                         first_seg->tso_segsz = gro_size;
1942                 }
1943
1944                 l234_info = rte_le_to_cpu_32(rxd.rx.l234_info);
1945                 ol_info = rte_le_to_cpu_32(rxd.rx.ol_info);
1946                 ret = hns3_handle_bdinfo(rxq, first_seg, bd_base_info,
1947                                          l234_info, &cksum_err);
1948                 if (unlikely(ret))
1949                         goto pkt_err;
1950
1951                 first_seg->packet_type = hns3_rx_calc_ptype(rxq,
1952                                                 l234_info, ol_info);
1953
1954                 if (bd_base_info & BIT(HNS3_RXD_L3L4P_B))
1955                         hns3_rx_set_cksum_flag(first_seg,
1956                                                first_seg->packet_type,
1957                                                cksum_err);
1958                 hns3_rxd_to_vlan_tci(rxq, first_seg, l234_info, &rxd);
1959
1960                 rx_pkts[nb_rx++] = first_seg;
1961                 first_seg = NULL;
1962                 continue;
1963 pkt_err:
1964                 rte_pktmbuf_free(first_seg);
1965                 first_seg = NULL;
1966         }
1967
1968         rxq->next_to_use = rx_id;
1969         rxq->pkt_first_seg = first_seg;
1970         rxq->pkt_last_seg = last_seg;
1971
1972         rxq->rx_free_hold += nb_rx_bd;
1973         if (rxq->rx_free_hold > rxq->rx_free_thresh) {
1974                 hns3_write_reg_opt(rxq->io_head_reg, rxq->rx_free_hold);
1975                 rxq->rx_free_hold = 0;
1976         }
1977
1978         return nb_rx;
1979 }
1980
1981 void __rte_weak
1982 hns3_rxq_vec_setup(__rte_unused struct hns3_rx_queue *rxq)
1983 {
1984 }
1985
1986 int __rte_weak
1987 hns3_rx_check_vec_support(__rte_unused struct rte_eth_dev *dev)
1988 {
1989         return -ENOTSUP;
1990 }
1991
1992 uint16_t __rte_weak
1993 hns3_recv_pkts_vec(__rte_unused void *tx_queue,
1994                    __rte_unused struct rte_mbuf **tx_pkts,
1995                    __rte_unused uint16_t nb_pkts)
1996 {
1997         return 0;
1998 }
1999
2000 int
2001 hns3_rx_burst_mode_get(struct rte_eth_dev *dev, __rte_unused uint16_t queue_id,
2002                        struct rte_eth_burst_mode *mode)
2003 {
2004         static const struct {
2005                 eth_rx_burst_t pkt_burst;
2006                 const char *info;
2007         } burst_infos[] = {
2008                 { hns3_recv_pkts,               "Scalar" },
2009                 { hns3_recv_scattered_pkts,     "Scalar Scattered" },
2010                 { hns3_recv_pkts_vec,           "Vector Neon" },
2011         };
2012
2013         eth_rx_burst_t pkt_burst = dev->rx_pkt_burst;
2014         int ret = -EINVAL;
2015         unsigned int i;
2016
2017         for (i = 0; i < RTE_DIM(burst_infos); i++) {
2018                 if (pkt_burst == burst_infos[i].pkt_burst) {
2019                         snprintf(mode->info, sizeof(mode->info), "%s",
2020                                  burst_infos[i].info);
2021                         ret = 0;
2022                         break;
2023                 }
2024         }
2025
2026         return ret;
2027 }
2028
2029 static eth_rx_burst_t
2030 hns3_get_rx_function(struct rte_eth_dev *dev)
2031 {
2032         struct hns3_adapter *hns = dev->data->dev_private;
2033         uint64_t offloads = dev->data->dev_conf.rxmode.offloads;
2034
2035         if (hns->rx_vec_allowed && hns3_rx_check_vec_support(dev) == 0)
2036                 return hns3_recv_pkts_vec;
2037
2038         if (hns->rx_simple_allowed && !dev->data->scattered_rx &&
2039             (offloads & DEV_RX_OFFLOAD_TCP_LRO) == 0)
2040                 return hns3_recv_pkts;
2041
2042         return hns3_recv_scattered_pkts;
2043 }
2044
2045 static int
2046 hns3_tx_queue_conf_check(struct hns3_hw *hw, const struct rte_eth_txconf *conf,
2047                          uint16_t nb_desc, uint16_t *tx_rs_thresh,
2048                          uint16_t *tx_free_thresh, uint16_t idx)
2049 {
2050 #define HNS3_TX_RS_FREE_THRESH_GAP      8
2051         uint16_t rs_thresh, free_thresh, fast_free_thresh;
2052
2053         if (nb_desc > HNS3_MAX_RING_DESC || nb_desc < HNS3_MIN_RING_DESC ||
2054             nb_desc % HNS3_ALIGN_RING_DESC) {
2055                 hns3_err(hw, "number (%u) of tx descriptors is invalid",
2056                          nb_desc);
2057                 return -EINVAL;
2058         }
2059
2060         rs_thresh = (conf->tx_rs_thresh > 0) ?
2061                         conf->tx_rs_thresh : HNS3_DEFAULT_TX_RS_THRESH;
2062         free_thresh = (conf->tx_free_thresh > 0) ?
2063                         conf->tx_free_thresh : HNS3_DEFAULT_TX_FREE_THRESH;
2064         if (rs_thresh + free_thresh > nb_desc || nb_desc % rs_thresh ||
2065             rs_thresh >= nb_desc - HNS3_TX_RS_FREE_THRESH_GAP ||
2066             free_thresh >= nb_desc - HNS3_TX_RS_FREE_THRESH_GAP) {
2067                 hns3_err(hw, "tx_rs_thresh (%d) tx_free_thresh (%d) nb_desc "
2068                          "(%d) of tx descriptors for port=%d queue=%d check "
2069                          "fail!",
2070                          rs_thresh, free_thresh, nb_desc, hw->data->port_id,
2071                          idx);
2072                 return -EINVAL;
2073         }
2074
2075         if (conf->tx_free_thresh == 0) {
2076                 /* Fast free Tx memory buffer to improve cache hit rate */
2077                 fast_free_thresh = nb_desc - rs_thresh;
2078                 if (fast_free_thresh >=
2079                     HNS3_TX_FAST_FREE_AHEAD + HNS3_DEFAULT_TX_FREE_THRESH)
2080                         free_thresh = fast_free_thresh -
2081                                         HNS3_TX_FAST_FREE_AHEAD;
2082         }
2083
2084         *tx_rs_thresh = rs_thresh;
2085         *tx_free_thresh = free_thresh;
2086         return 0;
2087 }
2088
2089 int
2090 hns3_tx_queue_setup(struct rte_eth_dev *dev, uint16_t idx, uint16_t nb_desc,
2091                     unsigned int socket_id, const struct rte_eth_txconf *conf)
2092 {
2093         struct hns3_adapter *hns = dev->data->dev_private;
2094         uint16_t tx_rs_thresh, tx_free_thresh;
2095         struct hns3_hw *hw = &hns->hw;
2096         struct hns3_queue_info q_info;
2097         struct hns3_tx_queue *txq;
2098         int tx_entry_len;
2099         int ret;
2100
2101         if (dev->data->dev_started) {
2102                 hns3_err(hw, "tx_queue_setup after dev_start no supported");
2103                 return -EINVAL;
2104         }
2105
2106         ret = hns3_tx_queue_conf_check(hw, conf, nb_desc,
2107                                        &tx_rs_thresh, &tx_free_thresh, idx);
2108         if (ret)
2109                 return ret;
2110
2111         if (dev->data->tx_queues[idx] != NULL) {
2112                 hns3_tx_queue_release(dev->data->tx_queues[idx]);
2113                 dev->data->tx_queues[idx] = NULL;
2114         }
2115
2116         q_info.idx = idx;
2117         q_info.socket_id = socket_id;
2118         q_info.nb_desc = nb_desc;
2119         q_info.type = "hns3 TX queue";
2120         q_info.ring_name = "tx_ring";
2121         txq = hns3_alloc_txq_and_dma_zone(dev, &q_info);
2122         if (txq == NULL) {
2123                 hns3_err(hw,
2124                          "Failed to alloc mem and reserve DMA mem for tx ring!");
2125                 return -ENOMEM;
2126         }
2127
2128         txq->tx_deferred_start = conf->tx_deferred_start;
2129         tx_entry_len = sizeof(struct hns3_entry) * txq->nb_tx_desc;
2130         txq->sw_ring = rte_zmalloc_socket("hns3 TX sw ring", tx_entry_len,
2131                                           RTE_CACHE_LINE_SIZE, socket_id);
2132         if (txq->sw_ring == NULL) {
2133                 hns3_err(hw, "Failed to allocate memory for tx sw ring!");
2134                 hns3_tx_queue_release(txq);
2135                 return -ENOMEM;
2136         }
2137
2138         txq->hns = hns;
2139         txq->next_to_use = 0;
2140         txq->next_to_clean = 0;
2141         txq->tx_bd_ready = txq->nb_tx_desc - 1;
2142         txq->tx_free_thresh = tx_free_thresh;
2143         txq->tx_rs_thresh = tx_rs_thresh;
2144         txq->free = rte_zmalloc_socket("hns3 TX mbuf free array",
2145                                 sizeof(struct rte_mbuf *) * txq->tx_rs_thresh,
2146                                 RTE_CACHE_LINE_SIZE, socket_id);
2147         if (!txq->free) {
2148                 hns3_err(hw, "failed to allocate tx mbuf free array!");
2149                 hns3_tx_queue_release(txq);
2150                 return -ENOMEM;
2151         }
2152
2153         txq->port_id = dev->data->port_id;
2154         txq->pvid_state = hw->port_base_vlan_cfg.state;
2155         txq->configured = true;
2156         txq->io_base = (void *)((char *)hw->io_base + HNS3_TQP_REG_OFFSET +
2157                                 idx * HNS3_TQP_REG_SIZE);
2158         txq->io_tail_reg = (volatile void *)((char *)txq->io_base +
2159                                              HNS3_RING_TX_TAIL_REG);
2160         txq->min_tx_pkt_len = hw->min_tx_pkt_len;
2161         txq->over_length_pkt_cnt = 0;
2162         txq->exceed_limit_bd_pkt_cnt = 0;
2163         txq->exceed_limit_bd_reassem_fail = 0;
2164         txq->unsupported_tunnel_pkt_cnt = 0;
2165         txq->queue_full_cnt = 0;
2166         txq->pkt_padding_fail_cnt = 0;
2167         rte_spinlock_lock(&hw->lock);
2168         dev->data->tx_queues[idx] = txq;
2169         rte_spinlock_unlock(&hw->lock);
2170
2171         return 0;
2172 }
2173
2174 static void
2175 hns3_tx_free_useless_buffer(struct hns3_tx_queue *txq)
2176 {
2177         uint16_t tx_next_clean = txq->next_to_clean;
2178         uint16_t tx_next_use   = txq->next_to_use;
2179         uint16_t tx_bd_ready   = txq->tx_bd_ready;
2180         uint16_t tx_bd_max     = txq->nb_tx_desc;
2181         struct hns3_entry *tx_bak_pkt = &txq->sw_ring[tx_next_clean];
2182         struct hns3_desc *desc = &txq->tx_ring[tx_next_clean];
2183         struct rte_mbuf *mbuf;
2184
2185         while ((!(desc->tx.tp_fe_sc_vld_ra_ri &
2186                 rte_cpu_to_le_16(BIT(HNS3_TXD_VLD_B)))) &&
2187                 tx_next_use != tx_next_clean) {
2188                 mbuf = tx_bak_pkt->mbuf;
2189                 if (mbuf) {
2190                         rte_pktmbuf_free_seg(mbuf);
2191                         tx_bak_pkt->mbuf = NULL;
2192                 }
2193
2194                 desc++;
2195                 tx_bak_pkt++;
2196                 tx_next_clean++;
2197                 tx_bd_ready++;
2198
2199                 if (tx_next_clean >= tx_bd_max) {
2200                         tx_next_clean = 0;
2201                         desc = txq->tx_ring;
2202                         tx_bak_pkt = txq->sw_ring;
2203                 }
2204         }
2205
2206         txq->next_to_clean = tx_next_clean;
2207         txq->tx_bd_ready   = tx_bd_ready;
2208 }
2209
2210 static int
2211 hns3_tso_proc_tunnel(struct hns3_desc *desc, uint64_t ol_flags,
2212                      struct rte_mbuf *rxm, uint8_t *l2_len)
2213 {
2214         uint64_t tun_flags;
2215         uint8_t ol4_len;
2216         uint32_t otmp;
2217
2218         tun_flags = ol_flags & PKT_TX_TUNNEL_MASK;
2219         if (tun_flags == 0)
2220                 return 0;
2221
2222         otmp = rte_le_to_cpu_32(desc->tx.ol_type_vlan_len_msec);
2223         switch (tun_flags) {
2224         case PKT_TX_TUNNEL_GENEVE:
2225         case PKT_TX_TUNNEL_VXLAN:
2226                 *l2_len = rxm->l2_len - RTE_ETHER_VXLAN_HLEN;
2227                 break;
2228         case PKT_TX_TUNNEL_GRE:
2229                 /*
2230                  * OL4 header size, defined in 4 Bytes, it contains outer
2231                  * L4(GRE) length and tunneling length.
2232                  */
2233                 ol4_len = hns3_get_field(otmp, HNS3_TXD_L4LEN_M,
2234                                          HNS3_TXD_L4LEN_S);
2235                 *l2_len = rxm->l2_len - (ol4_len << HNS3_L4_LEN_UNIT);
2236                 break;
2237         default:
2238                 /* For non UDP / GRE tunneling, drop the tunnel packet */
2239                 return -EINVAL;
2240         }
2241         hns3_set_field(otmp, HNS3_TXD_L2LEN_M, HNS3_TXD_L2LEN_S,
2242                        rxm->outer_l2_len >> HNS3_L2_LEN_UNIT);
2243         desc->tx.ol_type_vlan_len_msec = rte_cpu_to_le_32(otmp);
2244
2245         return 0;
2246 }
2247
2248 int
2249 hns3_config_gro(struct hns3_hw *hw, bool en)
2250 {
2251         struct hns3_cfg_gro_status_cmd *req;
2252         struct hns3_cmd_desc desc;
2253         int ret;
2254
2255         hns3_cmd_setup_basic_desc(&desc, HNS3_OPC_GRO_GENERIC_CONFIG, false);
2256         req = (struct hns3_cfg_gro_status_cmd *)desc.data;
2257
2258         req->gro_en = rte_cpu_to_le_16(en ? 1 : 0);
2259
2260         ret = hns3_cmd_send(hw, &desc, 1);
2261         if (ret)
2262                 hns3_err(hw, "%s hardware GRO failed, ret = %d",
2263                          en ? "enable" : "disable", ret);
2264
2265         return ret;
2266 }
2267
2268 int
2269 hns3_restore_gro_conf(struct hns3_hw *hw)
2270 {
2271         uint64_t offloads;
2272         bool gro_en;
2273         int ret;
2274
2275         offloads = hw->data->dev_conf.rxmode.offloads;
2276         gro_en = offloads & DEV_RX_OFFLOAD_TCP_LRO ? true : false;
2277         ret = hns3_config_gro(hw, gro_en);
2278         if (ret)
2279                 hns3_err(hw, "restore hardware GRO to %s failed, ret = %d",
2280                          gro_en ? "enabled" : "disabled", ret);
2281
2282         return ret;
2283 }
2284
2285 static inline bool
2286 hns3_pkt_is_tso(struct rte_mbuf *m)
2287 {
2288         return (m->tso_segsz != 0 && m->ol_flags & PKT_TX_TCP_SEG);
2289 }
2290
2291 static void
2292 hns3_set_tso(struct hns3_desc *desc, uint64_t ol_flags,
2293                 uint32_t paylen, struct rte_mbuf *rxm)
2294 {
2295         uint8_t l2_len = rxm->l2_len;
2296         uint32_t tmp;
2297
2298         if (!hns3_pkt_is_tso(rxm))
2299                 return;
2300
2301         if (hns3_tso_proc_tunnel(desc, ol_flags, rxm, &l2_len))
2302                 return;
2303
2304         if (paylen <= rxm->tso_segsz)
2305                 return;
2306
2307         tmp = rte_le_to_cpu_32(desc->tx.type_cs_vlan_tso_len);
2308         hns3_set_bit(tmp, HNS3_TXD_TSO_B, 1);
2309         hns3_set_bit(tmp, HNS3_TXD_L3CS_B, 1);
2310         hns3_set_field(tmp, HNS3_TXD_L4T_M, HNS3_TXD_L4T_S, HNS3_L4T_TCP);
2311         hns3_set_bit(tmp, HNS3_TXD_L4CS_B, 1);
2312         hns3_set_field(tmp, HNS3_TXD_L4LEN_M, HNS3_TXD_L4LEN_S,
2313                        sizeof(struct rte_tcp_hdr) >> HNS3_L4_LEN_UNIT);
2314         hns3_set_field(tmp, HNS3_TXD_L2LEN_M, HNS3_TXD_L2LEN_S,
2315                        l2_len >> HNS3_L2_LEN_UNIT);
2316         desc->tx.type_cs_vlan_tso_len = rte_cpu_to_le_32(tmp);
2317         desc->tx.mss = rte_cpu_to_le_16(rxm->tso_segsz);
2318 }
2319
2320 static inline void
2321 hns3_fill_per_desc(struct hns3_desc *desc, struct rte_mbuf *rxm)
2322 {
2323         desc->addr = rte_mbuf_data_iova(rxm);
2324         desc->tx.send_size = rte_cpu_to_le_16(rte_pktmbuf_data_len(rxm));
2325         desc->tx.tp_fe_sc_vld_ra_ri = rte_cpu_to_le_16(BIT(HNS3_TXD_VLD_B));
2326 }
2327
2328 static void
2329 hns3_fill_first_desc(struct hns3_tx_queue *txq, struct hns3_desc *desc,
2330                      struct rte_mbuf *rxm)
2331 {
2332         uint64_t ol_flags = rxm->ol_flags;
2333         uint32_t hdr_len;
2334         uint32_t paylen;
2335
2336         hdr_len = rxm->l2_len + rxm->l3_len + rxm->l4_len;
2337         hdr_len += (ol_flags & PKT_TX_TUNNEL_MASK) ?
2338                            rxm->outer_l2_len + rxm->outer_l3_len : 0;
2339         paylen = rxm->pkt_len - hdr_len;
2340         desc->tx.paylen = rte_cpu_to_le_32(paylen);
2341         hns3_set_tso(desc, ol_flags, paylen, rxm);
2342
2343         /*
2344          * Currently, hardware doesn't support more than two layers VLAN offload
2345          * in Tx direction based on hns3 network engine. So when the number of
2346          * VLANs in the packets represented by rxm plus the number of VLAN
2347          * offload by hardware such as PVID etc, exceeds two, the packets will
2348          * be discarded or the original VLAN of the packets will be overwitted
2349          * by hardware. When the PF PVID is enabled by calling the API function
2350          * named rte_eth_dev_set_vlan_pvid or the VF PVID is enabled by the hns3
2351          * PF kernel ether driver, the outer VLAN tag will always be the PVID.
2352          * To avoid the VLAN of Tx descriptor is overwritten by PVID, it should
2353          * be added to the position close to the IP header when PVID is enabled.
2354          */
2355         if (!txq->pvid_state && ol_flags & (PKT_TX_VLAN_PKT |
2356                                 PKT_TX_QINQ_PKT)) {
2357                 desc->tx.ol_type_vlan_len_msec |=
2358                                 rte_cpu_to_le_32(BIT(HNS3_TXD_OVLAN_B));
2359                 if (ol_flags & PKT_TX_QINQ_PKT)
2360                         desc->tx.outer_vlan_tag =
2361                                         rte_cpu_to_le_16(rxm->vlan_tci_outer);
2362                 else
2363                         desc->tx.outer_vlan_tag =
2364                                         rte_cpu_to_le_16(rxm->vlan_tci);
2365         }
2366
2367         if (ol_flags & PKT_TX_QINQ_PKT ||
2368             ((ol_flags & PKT_TX_VLAN_PKT) && txq->pvid_state)) {
2369                 desc->tx.type_cs_vlan_tso_len |=
2370                                         rte_cpu_to_le_32(BIT(HNS3_TXD_VLAN_B));
2371                 desc->tx.vlan_tag = rte_cpu_to_le_16(rxm->vlan_tci);
2372         }
2373 }
2374
2375 static inline int
2376 hns3_tx_alloc_mbufs(struct rte_mempool *mb_pool, uint16_t nb_new_buf,
2377                         struct rte_mbuf **alloc_mbuf)
2378 {
2379 #define MAX_NON_TSO_BD_PER_PKT 18
2380         struct rte_mbuf *pkt_segs[MAX_NON_TSO_BD_PER_PKT];
2381         uint16_t i;
2382
2383         /* Allocate enough mbufs */
2384         if (rte_mempool_get_bulk(mb_pool, (void **)pkt_segs, nb_new_buf))
2385                 return -ENOMEM;
2386
2387         for (i = 0; i < nb_new_buf - 1; i++)
2388                 pkt_segs[i]->next = pkt_segs[i + 1];
2389
2390         pkt_segs[nb_new_buf - 1]->next = NULL;
2391         pkt_segs[0]->nb_segs = nb_new_buf;
2392         *alloc_mbuf = pkt_segs[0];
2393
2394         return 0;
2395 }
2396
2397 static inline void
2398 hns3_pktmbuf_copy_hdr(struct rte_mbuf *new_pkt, struct rte_mbuf *old_pkt)
2399 {
2400         new_pkt->ol_flags = old_pkt->ol_flags;
2401         new_pkt->pkt_len = rte_pktmbuf_pkt_len(old_pkt);
2402         new_pkt->outer_l2_len = old_pkt->outer_l2_len;
2403         new_pkt->outer_l3_len = old_pkt->outer_l3_len;
2404         new_pkt->l2_len = old_pkt->l2_len;
2405         new_pkt->l3_len = old_pkt->l3_len;
2406         new_pkt->l4_len = old_pkt->l4_len;
2407         new_pkt->vlan_tci_outer = old_pkt->vlan_tci_outer;
2408         new_pkt->vlan_tci = old_pkt->vlan_tci;
2409 }
2410
2411 static int
2412 hns3_reassemble_tx_pkts(struct rte_mbuf *tx_pkt, struct rte_mbuf **new_pkt)
2413 {
2414         struct rte_mempool *mb_pool;
2415         struct rte_mbuf *new_mbuf;
2416         struct rte_mbuf *temp_new;
2417         struct rte_mbuf *temp;
2418         uint16_t last_buf_len;
2419         uint16_t nb_new_buf;
2420         uint16_t buf_size;
2421         uint16_t buf_len;
2422         uint16_t len_s;
2423         uint16_t len_d;
2424         uint16_t len;
2425         int ret;
2426         char *s;
2427         char *d;
2428
2429         mb_pool = tx_pkt->pool;
2430         buf_size = tx_pkt->buf_len - RTE_PKTMBUF_HEADROOM;
2431         nb_new_buf = (rte_pktmbuf_pkt_len(tx_pkt) - 1) / buf_size + 1;
2432         if (nb_new_buf > HNS3_MAX_NON_TSO_BD_PER_PKT)
2433                 return -EINVAL;
2434
2435         last_buf_len = rte_pktmbuf_pkt_len(tx_pkt) % buf_size;
2436         if (last_buf_len == 0)
2437                 last_buf_len = buf_size;
2438
2439         /* Allocate enough mbufs */
2440         ret = hns3_tx_alloc_mbufs(mb_pool, nb_new_buf, &new_mbuf);
2441         if (ret)
2442                 return ret;
2443
2444         /* Copy the original packet content to the new mbufs */
2445         temp = tx_pkt;
2446         s = rte_pktmbuf_mtod(temp, char *);
2447         len_s = rte_pktmbuf_data_len(temp);
2448         temp_new = new_mbuf;
2449         while (temp != NULL && temp_new != NULL) {
2450                 d = rte_pktmbuf_mtod(temp_new, char *);
2451                 buf_len = temp_new->next == NULL ? last_buf_len : buf_size;
2452                 len_d = buf_len;
2453
2454                 while (len_d) {
2455                         len = RTE_MIN(len_s, len_d);
2456                         memcpy(d, s, len);
2457                         s = s + len;
2458                         d = d + len;
2459                         len_d = len_d - len;
2460                         len_s = len_s - len;
2461
2462                         if (len_s == 0) {
2463                                 temp = temp->next;
2464                                 if (temp == NULL)
2465                                         break;
2466                                 s = rte_pktmbuf_mtod(temp, char *);
2467                                 len_s = rte_pktmbuf_data_len(temp);
2468                         }
2469                 }
2470
2471                 temp_new->data_len = buf_len;
2472                 temp_new = temp_new->next;
2473         }
2474         hns3_pktmbuf_copy_hdr(new_mbuf, tx_pkt);
2475
2476         /* free original mbufs */
2477         rte_pktmbuf_free(tx_pkt);
2478
2479         *new_pkt = new_mbuf;
2480
2481         return 0;
2482 }
2483
2484 static void
2485 hns3_parse_outer_params(uint64_t ol_flags, uint32_t *ol_type_vlan_len_msec)
2486 {
2487         uint32_t tmp = *ol_type_vlan_len_msec;
2488
2489         /* (outer) IP header type */
2490         if (ol_flags & PKT_TX_OUTER_IPV4) {
2491                 /* OL3 header size, defined in 4 bytes */
2492                 hns3_set_field(tmp, HNS3_TXD_L3LEN_M, HNS3_TXD_L3LEN_S,
2493                                sizeof(struct rte_ipv4_hdr) >> HNS3_L3_LEN_UNIT);
2494                 if (ol_flags & PKT_TX_OUTER_IP_CKSUM)
2495                         hns3_set_field(tmp, HNS3_TXD_OL3T_M,
2496                                        HNS3_TXD_OL3T_S, HNS3_OL3T_IPV4_CSUM);
2497                 else
2498                         hns3_set_field(tmp, HNS3_TXD_OL3T_M, HNS3_TXD_OL3T_S,
2499                                        HNS3_OL3T_IPV4_NO_CSUM);
2500         } else if (ol_flags & PKT_TX_OUTER_IPV6) {
2501                 hns3_set_field(tmp, HNS3_TXD_OL3T_M, HNS3_TXD_OL3T_S,
2502                                HNS3_OL3T_IPV6);
2503                 /* OL3 header size, defined in 4 bytes */
2504                 hns3_set_field(tmp, HNS3_TXD_L3LEN_M, HNS3_TXD_L3LEN_S,
2505                                sizeof(struct rte_ipv6_hdr) >> HNS3_L3_LEN_UNIT);
2506         }
2507
2508         *ol_type_vlan_len_msec = tmp;
2509 }
2510
2511 static int
2512 hns3_parse_inner_params(uint64_t ol_flags, uint32_t *ol_type_vlan_len_msec,
2513                         struct rte_net_hdr_lens *hdr_lens)
2514 {
2515         uint32_t tmp = *ol_type_vlan_len_msec;
2516         uint8_t l4_len;
2517
2518         /* OL2 header size, defined in 2 bytes */
2519         hns3_set_field(tmp, HNS3_TXD_L2LEN_M, HNS3_TXD_L2LEN_S,
2520                        sizeof(struct rte_ether_hdr) >> HNS3_L2_LEN_UNIT);
2521
2522         /* L4TUNT: L4 Tunneling Type */
2523         switch (ol_flags & PKT_TX_TUNNEL_MASK) {
2524         case PKT_TX_TUNNEL_GENEVE:
2525         case PKT_TX_TUNNEL_VXLAN:
2526                 /* MAC in UDP tunnelling packet, include VxLAN */
2527                 hns3_set_field(tmp, HNS3_TXD_TUNTYPE_M, HNS3_TXD_TUNTYPE_S,
2528                                HNS3_TUN_MAC_IN_UDP);
2529                 /*
2530                  * OL4 header size, defined in 4 Bytes, it contains outer
2531                  * L4(UDP) length and tunneling length.
2532                  */
2533                 hns3_set_field(tmp, HNS3_TXD_L4LEN_M, HNS3_TXD_L4LEN_S,
2534                                (uint8_t)RTE_ETHER_VXLAN_HLEN >>
2535                                HNS3_L4_LEN_UNIT);
2536                 break;
2537         case PKT_TX_TUNNEL_GRE:
2538                 hns3_set_field(tmp, HNS3_TXD_TUNTYPE_M, HNS3_TXD_TUNTYPE_S,
2539                                HNS3_TUN_NVGRE);
2540                 /*
2541                  * OL4 header size, defined in 4 Bytes, it contains outer
2542                  * L4(GRE) length and tunneling length.
2543                  */
2544                 l4_len = hdr_lens->l4_len + hdr_lens->tunnel_len;
2545                 hns3_set_field(tmp, HNS3_TXD_L4LEN_M, HNS3_TXD_L4LEN_S,
2546                                l4_len >> HNS3_L4_LEN_UNIT);
2547                 break;
2548         default:
2549                 /* For non UDP / GRE tunneling, drop the tunnel packet */
2550                 return -EINVAL;
2551         }
2552
2553         *ol_type_vlan_len_msec = tmp;
2554
2555         return 0;
2556 }
2557
2558 static int
2559 hns3_parse_tunneling_params(struct hns3_tx_queue *txq, uint16_t tx_desc_id,
2560                             uint64_t ol_flags,
2561                             struct rte_net_hdr_lens *hdr_lens)
2562 {
2563         struct hns3_desc *tx_ring = txq->tx_ring;
2564         struct hns3_desc *desc = &tx_ring[tx_desc_id];
2565         uint32_t value = 0;
2566         int ret;
2567
2568         hns3_parse_outer_params(ol_flags, &value);
2569         ret = hns3_parse_inner_params(ol_flags, &value, hdr_lens);
2570         if (ret)
2571                 return -EINVAL;
2572
2573         desc->tx.ol_type_vlan_len_msec |= rte_cpu_to_le_32(value);
2574
2575         return 0;
2576 }
2577
2578 static void
2579 hns3_parse_l3_cksum_params(uint64_t ol_flags, uint32_t *type_cs_vlan_tso_len)
2580 {
2581         uint32_t tmp;
2582
2583         /* Enable L3 checksum offloads */
2584         if (ol_flags & PKT_TX_IPV4) {
2585                 tmp = *type_cs_vlan_tso_len;
2586                 hns3_set_field(tmp, HNS3_TXD_L3T_M, HNS3_TXD_L3T_S,
2587                                HNS3_L3T_IPV4);
2588                 /* inner(/normal) L3 header size, defined in 4 bytes */
2589                 hns3_set_field(tmp, HNS3_TXD_L3LEN_M, HNS3_TXD_L3LEN_S,
2590                                sizeof(struct rte_ipv4_hdr) >> HNS3_L3_LEN_UNIT);
2591                 if (ol_flags & PKT_TX_IP_CKSUM)
2592                         hns3_set_bit(tmp, HNS3_TXD_L3CS_B, 1);
2593                 *type_cs_vlan_tso_len = tmp;
2594         } else if (ol_flags & PKT_TX_IPV6) {
2595                 tmp = *type_cs_vlan_tso_len;
2596                 /* L3T, IPv6 don't do checksum */
2597                 hns3_set_field(tmp, HNS3_TXD_L3T_M, HNS3_TXD_L3T_S,
2598                                HNS3_L3T_IPV6);
2599                 /* inner(/normal) L3 header size, defined in 4 bytes */
2600                 hns3_set_field(tmp, HNS3_TXD_L3LEN_M, HNS3_TXD_L3LEN_S,
2601                                sizeof(struct rte_ipv6_hdr) >> HNS3_L3_LEN_UNIT);
2602                 *type_cs_vlan_tso_len = tmp;
2603         }
2604 }
2605
2606 static void
2607 hns3_parse_l4_cksum_params(uint64_t ol_flags, uint32_t *type_cs_vlan_tso_len)
2608 {
2609         uint32_t tmp;
2610
2611         /* Enable L4 checksum offloads */
2612         switch (ol_flags & PKT_TX_L4_MASK) {
2613         case PKT_TX_TCP_CKSUM:
2614                 tmp = *type_cs_vlan_tso_len;
2615                 hns3_set_field(tmp, HNS3_TXD_L4T_M, HNS3_TXD_L4T_S,
2616                                HNS3_L4T_TCP);
2617                 hns3_set_bit(tmp, HNS3_TXD_L4CS_B, 1);
2618                 hns3_set_field(tmp, HNS3_TXD_L4LEN_M, HNS3_TXD_L4LEN_S,
2619                                sizeof(struct rte_tcp_hdr) >> HNS3_L4_LEN_UNIT);
2620                 *type_cs_vlan_tso_len = tmp;
2621                 break;
2622         case PKT_TX_UDP_CKSUM:
2623                 tmp = *type_cs_vlan_tso_len;
2624                 hns3_set_field(tmp, HNS3_TXD_L4T_M, HNS3_TXD_L4T_S,
2625                                HNS3_L4T_UDP);
2626                 hns3_set_bit(tmp, HNS3_TXD_L4CS_B, 1);
2627                 hns3_set_field(tmp, HNS3_TXD_L4LEN_M, HNS3_TXD_L4LEN_S,
2628                                sizeof(struct rte_udp_hdr) >> HNS3_L4_LEN_UNIT);
2629                 *type_cs_vlan_tso_len = tmp;
2630                 break;
2631         case PKT_TX_SCTP_CKSUM:
2632                 tmp = *type_cs_vlan_tso_len;
2633                 hns3_set_field(tmp, HNS3_TXD_L4T_M, HNS3_TXD_L4T_S,
2634                                HNS3_L4T_SCTP);
2635                 hns3_set_bit(tmp, HNS3_TXD_L4CS_B, 1);
2636                 hns3_set_field(tmp, HNS3_TXD_L4LEN_M, HNS3_TXD_L4LEN_S,
2637                                sizeof(struct rte_sctp_hdr) >> HNS3_L4_LEN_UNIT);
2638                 *type_cs_vlan_tso_len = tmp;
2639                 break;
2640         default:
2641                 break;
2642         }
2643 }
2644
2645 static void
2646 hns3_txd_enable_checksum(struct hns3_tx_queue *txq, uint16_t tx_desc_id,
2647                          uint64_t ol_flags)
2648 {
2649         struct hns3_desc *tx_ring = txq->tx_ring;
2650         struct hns3_desc *desc = &tx_ring[tx_desc_id];
2651         uint32_t value = 0;
2652
2653         /* inner(/normal) L2 header size, defined in 2 bytes */
2654         hns3_set_field(value, HNS3_TXD_L2LEN_M, HNS3_TXD_L2LEN_S,
2655                        sizeof(struct rte_ether_hdr) >> HNS3_L2_LEN_UNIT);
2656
2657         hns3_parse_l3_cksum_params(ol_flags, &value);
2658         hns3_parse_l4_cksum_params(ol_flags, &value);
2659
2660         desc->tx.type_cs_vlan_tso_len |= rte_cpu_to_le_32(value);
2661 }
2662
2663 static bool
2664 hns3_pkt_need_linearized(struct rte_mbuf *tx_pkts, uint32_t bd_num)
2665 {
2666         struct rte_mbuf *m_first = tx_pkts;
2667         struct rte_mbuf *m_last = tx_pkts;
2668         uint32_t tot_len = 0;
2669         uint32_t hdr_len;
2670         uint32_t i;
2671
2672         /*
2673          * Hardware requires that the sum of the data length of every 8
2674          * consecutive buffers is greater than MSS in hns3 network engine.
2675          * We simplify it by ensuring pkt_headlen + the first 8 consecutive
2676          * frags greater than gso header len + mss, and the remaining 7
2677          * consecutive frags greater than MSS except the last 7 frags.
2678          */
2679         if (bd_num <= HNS3_MAX_NON_TSO_BD_PER_PKT)
2680                 return false;
2681
2682         for (i = 0; m_last && i < HNS3_MAX_NON_TSO_BD_PER_PKT - 1;
2683              i++, m_last = m_last->next)
2684                 tot_len += m_last->data_len;
2685
2686         if (!m_last)
2687                 return true;
2688
2689         /* ensure the first 8 frags is greater than mss + header */
2690         hdr_len = tx_pkts->l2_len + tx_pkts->l3_len + tx_pkts->l4_len;
2691         hdr_len += (tx_pkts->ol_flags & PKT_TX_TUNNEL_MASK) ?
2692                    tx_pkts->outer_l2_len + tx_pkts->outer_l3_len : 0;
2693         if (tot_len + m_last->data_len < tx_pkts->tso_segsz + hdr_len)
2694                 return true;
2695
2696         /*
2697          * ensure the sum of the data length of every 7 consecutive buffer
2698          * is greater than mss except the last one.
2699          */
2700         for (i = 0; m_last && i < bd_num - HNS3_MAX_NON_TSO_BD_PER_PKT; i++) {
2701                 tot_len -= m_first->data_len;
2702                 tot_len += m_last->data_len;
2703
2704                 if (tot_len < tx_pkts->tso_segsz)
2705                         return true;
2706
2707                 m_first = m_first->next;
2708                 m_last = m_last->next;
2709         }
2710
2711         return false;
2712 }
2713
2714 static void
2715 hns3_outer_header_cksum_prepare(struct rte_mbuf *m)
2716 {
2717         uint64_t ol_flags = m->ol_flags;
2718         struct rte_ipv4_hdr *ipv4_hdr;
2719         struct rte_udp_hdr *udp_hdr;
2720         uint32_t paylen, hdr_len;
2721
2722         if (!(ol_flags & (PKT_TX_OUTER_IPV4 | PKT_TX_OUTER_IPV6)))
2723                 return;
2724
2725         if (ol_flags & PKT_TX_IPV4) {
2726                 ipv4_hdr = rte_pktmbuf_mtod_offset(m, struct rte_ipv4_hdr *,
2727                                                    m->outer_l2_len);
2728
2729                 if (ol_flags & PKT_TX_IP_CKSUM)
2730                         ipv4_hdr->hdr_checksum = 0;
2731         }
2732
2733         if ((ol_flags & PKT_TX_L4_MASK) == PKT_TX_UDP_CKSUM &&
2734             ol_flags & PKT_TX_TCP_SEG) {
2735                 hdr_len = m->l2_len + m->l3_len + m->l4_len;
2736                 hdr_len += (ol_flags & PKT_TX_TUNNEL_MASK) ?
2737                                 m->outer_l2_len + m->outer_l3_len : 0;
2738                 paylen = m->pkt_len - hdr_len;
2739                 if (paylen <= m->tso_segsz)
2740                         return;
2741                 udp_hdr = rte_pktmbuf_mtod_offset(m, struct rte_udp_hdr *,
2742                                                   m->outer_l2_len +
2743                                                   m->outer_l3_len);
2744                 udp_hdr->dgram_cksum = 0;
2745         }
2746 }
2747
2748 static int
2749 hns3_check_tso_pkt_valid(struct rte_mbuf *m)
2750 {
2751         uint32_t tmp_data_len_sum = 0;
2752         uint16_t nb_buf = m->nb_segs;
2753         uint32_t paylen, hdr_len;
2754         struct rte_mbuf *m_seg;
2755         int i;
2756
2757         if (nb_buf > HNS3_MAX_TSO_BD_PER_PKT)
2758                 return -EINVAL;
2759
2760         hdr_len = m->l2_len + m->l3_len + m->l4_len;
2761         hdr_len += (m->ol_flags & PKT_TX_TUNNEL_MASK) ?
2762                         m->outer_l2_len + m->outer_l3_len : 0;
2763         if (hdr_len > HNS3_MAX_TSO_HDR_SIZE)
2764                 return -EINVAL;
2765
2766         paylen = m->pkt_len - hdr_len;
2767         if (paylen > HNS3_MAX_BD_PAYLEN)
2768                 return -EINVAL;
2769
2770         /*
2771          * The TSO header (include outer and inner L2, L3 and L4 header)
2772          * should be provided by three descriptors in maximum in hns3 network
2773          * engine.
2774          */
2775         m_seg = m;
2776         for (i = 0; m_seg != NULL && i < HNS3_MAX_TSO_HDR_BD_NUM && i < nb_buf;
2777              i++, m_seg = m_seg->next) {
2778                 tmp_data_len_sum += m_seg->data_len;
2779         }
2780
2781         if (hdr_len > tmp_data_len_sum)
2782                 return -EINVAL;
2783
2784         return 0;
2785 }
2786
2787 #ifdef RTE_LIBRTE_ETHDEV_DEBUG
2788 static inline int
2789 hns3_vld_vlan_chk(struct hns3_tx_queue *txq, struct rte_mbuf *m)
2790 {
2791         struct rte_ether_hdr *eh;
2792         struct rte_vlan_hdr *vh;
2793
2794         if (!txq->pvid_state)
2795                 return 0;
2796
2797         /*
2798          * Due to hardware limitations, we only support two-layer VLAN hardware
2799          * offload in Tx direction based on hns3 network engine, so when PVID is
2800          * enabled, QinQ insert is no longer supported.
2801          * And when PVID is enabled, in the following two cases:
2802          *  i) packets with more than two VLAN tags.
2803          *  ii) packets with one VLAN tag while the hardware VLAN insert is
2804          *      enabled.
2805          * The packets will be regarded as abnormal packets and discarded by
2806          * hardware in Tx direction. For debugging purposes, a validation check
2807          * for these types of packets is added to the '.tx_pkt_prepare' ops
2808          * implementation function named hns3_prep_pkts to inform users that
2809          * these packets will be discarded.
2810          */
2811         if (m->ol_flags & PKT_TX_QINQ_PKT)
2812                 return -EINVAL;
2813
2814         eh = rte_pktmbuf_mtod(m, struct rte_ether_hdr *);
2815         if (eh->ether_type == rte_cpu_to_be_16(RTE_ETHER_TYPE_VLAN)) {
2816                 if (m->ol_flags & PKT_TX_VLAN_PKT)
2817                         return -EINVAL;
2818
2819                 /* Ensure the incoming packet is not a QinQ packet */
2820                 vh = (struct rte_vlan_hdr *)(eh + 1);
2821                 if (vh->eth_proto == rte_cpu_to_be_16(RTE_ETHER_TYPE_VLAN))
2822                         return -EINVAL;
2823         }
2824
2825         return 0;
2826 }
2827 #endif
2828
2829 uint16_t
2830 hns3_prep_pkts(__rte_unused void *tx_queue, struct rte_mbuf **tx_pkts,
2831                uint16_t nb_pkts)
2832 {
2833         struct rte_mbuf *m;
2834         uint16_t i;
2835         int ret;
2836
2837         for (i = 0; i < nb_pkts; i++) {
2838                 m = tx_pkts[i];
2839
2840                 if (hns3_pkt_is_tso(m) &&
2841                     (hns3_pkt_need_linearized(m, m->nb_segs) ||
2842                      hns3_check_tso_pkt_valid(m))) {
2843                         rte_errno = EINVAL;
2844                         return i;
2845                 }
2846
2847 #ifdef RTE_LIBRTE_ETHDEV_DEBUG
2848                 ret = rte_validate_tx_offload(m);
2849                 if (ret != 0) {
2850                         rte_errno = -ret;
2851                         return i;
2852                 }
2853
2854                 if (hns3_vld_vlan_chk(tx_queue, m)) {
2855                         rte_errno = EINVAL;
2856                         return i;
2857                 }
2858 #endif
2859                 ret = rte_net_intel_cksum_prepare(m);
2860                 if (ret != 0) {
2861                         rte_errno = -ret;
2862                         return i;
2863                 }
2864
2865                 hns3_outer_header_cksum_prepare(m);
2866         }
2867
2868         return i;
2869 }
2870
2871 static int
2872 hns3_parse_cksum(struct hns3_tx_queue *txq, uint16_t tx_desc_id,
2873                  const struct rte_mbuf *m, struct rte_net_hdr_lens *hdr_lens)
2874 {
2875         /* Fill in tunneling parameters if necessary */
2876         if (m->ol_flags & PKT_TX_TUNNEL_MASK) {
2877                 (void)rte_net_get_ptype(m, hdr_lens, RTE_PTYPE_ALL_MASK);
2878                 if (hns3_parse_tunneling_params(txq, tx_desc_id, m->ol_flags,
2879                                                 hdr_lens)) {
2880                         txq->unsupported_tunnel_pkt_cnt++;
2881                         return -EINVAL;
2882                 }
2883         }
2884         /* Enable checksum offloading */
2885         if (m->ol_flags & HNS3_TX_CKSUM_OFFLOAD_MASK)
2886                 hns3_txd_enable_checksum(txq, tx_desc_id, m->ol_flags);
2887
2888         return 0;
2889 }
2890
2891 static int
2892 hns3_check_non_tso_pkt(uint16_t nb_buf, struct rte_mbuf **m_seg,
2893                       struct rte_mbuf *tx_pkt, struct hns3_tx_queue *txq)
2894 {
2895         struct rte_mbuf *new_pkt;
2896         int ret;
2897
2898         if (hns3_pkt_is_tso(*m_seg))
2899                 return 0;
2900
2901         /*
2902          * If packet length is greater than HNS3_MAX_FRAME_LEN
2903          * driver support, the packet will be ignored.
2904          */
2905         if (unlikely(rte_pktmbuf_pkt_len(tx_pkt) > HNS3_MAX_FRAME_LEN)) {
2906                 txq->over_length_pkt_cnt++;
2907                 return -EINVAL;
2908         }
2909
2910         if (unlikely(nb_buf > HNS3_MAX_NON_TSO_BD_PER_PKT)) {
2911                 txq->exceed_limit_bd_pkt_cnt++;
2912                 ret = hns3_reassemble_tx_pkts(tx_pkt, &new_pkt);
2913                 if (ret) {
2914                         txq->exceed_limit_bd_reassem_fail++;
2915                         return ret;
2916                 }
2917                 *m_seg = new_pkt;
2918         }
2919
2920         return 0;
2921 }
2922
2923 static inline void
2924 hns3_tx_free_buffer_simple(struct hns3_tx_queue *txq)
2925 {
2926         struct hns3_entry *tx_entry;
2927         struct hns3_desc *desc;
2928         uint16_t tx_next_clean;
2929         int i;
2930
2931         while (1) {
2932                 if (HNS3_GET_TX_QUEUE_PEND_BD_NUM(txq) < txq->tx_rs_thresh)
2933                         break;
2934
2935                 /*
2936                  * All mbufs can be released only when the VLD bits of all
2937                  * descriptors in a batch are cleared.
2938                  */
2939                 tx_next_clean = (txq->next_to_clean + txq->tx_rs_thresh - 1) %
2940                                 txq->nb_tx_desc;
2941                 desc = &txq->tx_ring[tx_next_clean];
2942                 for (i = 0; i < txq->tx_rs_thresh; i++) {
2943                         if (rte_le_to_cpu_16(desc->tx.tp_fe_sc_vld_ra_ri) &
2944                                         BIT(HNS3_TXD_VLD_B))
2945                                 return;
2946                         desc--;
2947                 }
2948
2949                 tx_entry = &txq->sw_ring[txq->next_to_clean];
2950
2951                 for (i = 0; i < txq->tx_rs_thresh; i++)
2952                         rte_prefetch0((tx_entry + i)->mbuf);
2953                 for (i = 0; i < txq->tx_rs_thresh; i++, tx_entry++) {
2954                         rte_mempool_put(tx_entry->mbuf->pool, tx_entry->mbuf);
2955                         tx_entry->mbuf = NULL;
2956                 }
2957
2958                 txq->next_to_clean = (tx_next_clean + 1) % txq->nb_tx_desc;
2959                 txq->tx_bd_ready += txq->tx_rs_thresh;
2960         }
2961 }
2962
2963 static inline void
2964 hns3_tx_backup_1mbuf(struct hns3_entry *tx_entry, struct rte_mbuf **pkts)
2965 {
2966         tx_entry->mbuf = pkts[0];
2967 }
2968
2969 static inline void
2970 hns3_tx_backup_4mbuf(struct hns3_entry *tx_entry, struct rte_mbuf **pkts)
2971 {
2972         hns3_tx_backup_1mbuf(&tx_entry[0], &pkts[0]);
2973         hns3_tx_backup_1mbuf(&tx_entry[1], &pkts[1]);
2974         hns3_tx_backup_1mbuf(&tx_entry[2], &pkts[2]);
2975         hns3_tx_backup_1mbuf(&tx_entry[3], &pkts[3]);
2976 }
2977
2978 static inline void
2979 hns3_tx_setup_4bd(struct hns3_desc *txdp, struct rte_mbuf **pkts)
2980 {
2981 #define PER_LOOP_NUM    4
2982         const uint16_t bd_flag = BIT(HNS3_TXD_VLD_B) | BIT(HNS3_TXD_FE_B);
2983         uint64_t dma_addr;
2984         uint32_t i;
2985
2986         for (i = 0; i < PER_LOOP_NUM; i++, txdp++, pkts++) {
2987                 dma_addr = rte_mbuf_data_iova(*pkts);
2988                 txdp->addr = rte_cpu_to_le_64(dma_addr);
2989                 txdp->tx.send_size = rte_cpu_to_le_16((*pkts)->data_len);
2990                 txdp->tx.paylen = 0;
2991                 txdp->tx.type_cs_vlan_tso_len = 0;
2992                 txdp->tx.ol_type_vlan_len_msec = 0;
2993                 txdp->tx.tp_fe_sc_vld_ra_ri = rte_cpu_to_le_16(bd_flag);
2994         }
2995 }
2996
2997 static inline void
2998 hns3_tx_setup_1bd(struct hns3_desc *txdp, struct rte_mbuf **pkts)
2999 {
3000         const uint16_t bd_flag = BIT(HNS3_TXD_VLD_B) | BIT(HNS3_TXD_FE_B);
3001         uint64_t dma_addr;
3002
3003         dma_addr = rte_mbuf_data_iova(*pkts);
3004         txdp->addr = rte_cpu_to_le_64(dma_addr);
3005         txdp->tx.send_size = rte_cpu_to_le_16((*pkts)->data_len);
3006         txdp->tx.paylen = 0;
3007         txdp->tx.type_cs_vlan_tso_len = 0;
3008         txdp->tx.ol_type_vlan_len_msec = 0;
3009         txdp->tx.tp_fe_sc_vld_ra_ri = rte_cpu_to_le_16(bd_flag);
3010 }
3011
3012 static inline void
3013 hns3_tx_fill_hw_ring(struct hns3_tx_queue *txq,
3014                      struct rte_mbuf **pkts,
3015                      uint16_t nb_pkts)
3016 {
3017 #define PER_LOOP_NUM    4
3018 #define PER_LOOP_MASK   (PER_LOOP_NUM - 1)
3019         struct hns3_desc *txdp = &txq->tx_ring[txq->next_to_use];
3020         struct hns3_entry *tx_entry = &txq->sw_ring[txq->next_to_use];
3021         const uint32_t mainpart = (nb_pkts & ((uint32_t)~PER_LOOP_MASK));
3022         const uint32_t leftover = (nb_pkts & ((uint32_t)PER_LOOP_MASK));
3023         uint32_t i;
3024
3025         for (i = 0; i < mainpart; i += PER_LOOP_NUM) {
3026                 hns3_tx_backup_4mbuf(tx_entry + i, pkts + i);
3027                 hns3_tx_setup_4bd(txdp + i, pkts + i);
3028         }
3029         if (unlikely(leftover > 0)) {
3030                 for (i = 0; i < leftover; i++) {
3031                         hns3_tx_backup_1mbuf(tx_entry + mainpart + i,
3032                                              pkts + mainpart + i);
3033                         hns3_tx_setup_1bd(txdp + mainpart + i,
3034                                           pkts + mainpart + i);
3035                 }
3036         }
3037 }
3038
3039 uint16_t
3040 hns3_xmit_pkts_simple(void *tx_queue,
3041                       struct rte_mbuf **tx_pkts,
3042                       uint16_t nb_pkts)
3043 {
3044         struct hns3_tx_queue *txq = tx_queue;
3045         uint16_t nb_tx = 0;
3046
3047         hns3_tx_free_buffer_simple(txq);
3048
3049         nb_pkts = RTE_MIN(txq->tx_bd_ready, nb_pkts);
3050         if (unlikely(nb_pkts == 0)) {
3051                 if (txq->tx_bd_ready == 0)
3052                         txq->queue_full_cnt++;
3053                 return 0;
3054         }
3055
3056         txq->tx_bd_ready -= nb_pkts;
3057         if (txq->next_to_use + nb_pkts > txq->nb_tx_desc) {
3058                 nb_tx = txq->nb_tx_desc - txq->next_to_use;
3059                 hns3_tx_fill_hw_ring(txq, tx_pkts, nb_tx);
3060                 txq->next_to_use = 0;
3061         }
3062
3063         hns3_tx_fill_hw_ring(txq, tx_pkts + nb_tx, nb_pkts - nb_tx);
3064         txq->next_to_use += nb_pkts - nb_tx;
3065
3066         hns3_write_reg_opt(txq->io_tail_reg, nb_pkts);
3067
3068         return nb_pkts;
3069 }
3070
3071 uint16_t
3072 hns3_xmit_pkts(void *tx_queue, struct rte_mbuf **tx_pkts, uint16_t nb_pkts)
3073 {
3074         struct rte_net_hdr_lens hdr_lens = {0};
3075         struct hns3_tx_queue *txq = tx_queue;
3076         struct hns3_entry *tx_bak_pkt;
3077         struct hns3_desc *tx_ring;
3078         struct rte_mbuf *tx_pkt;
3079         struct rte_mbuf *m_seg;
3080         struct hns3_desc *desc;
3081         uint32_t nb_hold = 0;
3082         uint16_t tx_next_use;
3083         uint16_t tx_pkt_num;
3084         uint16_t tx_bd_max;
3085         uint16_t nb_buf;
3086         uint16_t nb_tx;
3087         uint16_t i;
3088
3089         /* free useless buffer */
3090         hns3_tx_free_useless_buffer(txq);
3091
3092         tx_next_use   = txq->next_to_use;
3093         tx_bd_max     = txq->nb_tx_desc;
3094         tx_pkt_num = nb_pkts;
3095         tx_ring = txq->tx_ring;
3096
3097         /* send packets */
3098         tx_bak_pkt = &txq->sw_ring[tx_next_use];
3099         for (nb_tx = 0; nb_tx < tx_pkt_num; nb_tx++) {
3100                 tx_pkt = *tx_pkts++;
3101
3102                 nb_buf = tx_pkt->nb_segs;
3103
3104                 if (nb_buf > txq->tx_bd_ready) {
3105                         txq->queue_full_cnt++;
3106                         if (nb_tx == 0)
3107                                 return 0;
3108
3109                         goto end_of_tx;
3110                 }
3111
3112                 /*
3113                  * If packet length is less than minimum packet length supported
3114                  * by hardware in Tx direction, driver need to pad it to avoid
3115                  * error.
3116                  */
3117                 if (unlikely(rte_pktmbuf_pkt_len(tx_pkt) <
3118                                                 txq->min_tx_pkt_len)) {
3119                         uint16_t add_len;
3120                         char *appended;
3121
3122                         add_len = txq->min_tx_pkt_len -
3123                                          rte_pktmbuf_pkt_len(tx_pkt);
3124                         appended = rte_pktmbuf_append(tx_pkt, add_len);
3125                         if (appended == NULL) {
3126                                 txq->pkt_padding_fail_cnt++;
3127                                 break;
3128                         }
3129
3130                         memset(appended, 0, add_len);
3131                 }
3132
3133                 m_seg = tx_pkt;
3134
3135                 if (hns3_check_non_tso_pkt(nb_buf, &m_seg, tx_pkt, txq))
3136                         goto end_of_tx;
3137
3138                 if (hns3_parse_cksum(txq, tx_next_use, m_seg, &hdr_lens))
3139                         goto end_of_tx;
3140
3141                 i = 0;
3142                 desc = &tx_ring[tx_next_use];
3143
3144                 /*
3145                  * If the packet is divided into multiple Tx Buffer Descriptors,
3146                  * only need to fill vlan, paylen and tso into the first Tx
3147                  * Buffer Descriptor.
3148                  */
3149                 hns3_fill_first_desc(txq, desc, m_seg);
3150
3151                 do {
3152                         desc = &tx_ring[tx_next_use];
3153                         /*
3154                          * Fill valid bits, DMA address and data length for each
3155                          * Tx Buffer Descriptor.
3156                          */
3157                         hns3_fill_per_desc(desc, m_seg);
3158                         tx_bak_pkt->mbuf = m_seg;
3159                         m_seg = m_seg->next;
3160                         tx_next_use++;
3161                         tx_bak_pkt++;
3162                         if (tx_next_use >= tx_bd_max) {
3163                                 tx_next_use = 0;
3164                                 tx_bak_pkt = txq->sw_ring;
3165                         }
3166
3167                         i++;
3168                 } while (m_seg != NULL);
3169
3170                 /* Add end flag for the last Tx Buffer Descriptor */
3171                 desc->tx.tp_fe_sc_vld_ra_ri |=
3172                                  rte_cpu_to_le_16(BIT(HNS3_TXD_FE_B));
3173
3174                 nb_hold += i;
3175                 txq->next_to_use = tx_next_use;
3176                 txq->tx_bd_ready -= i;
3177         }
3178
3179 end_of_tx:
3180
3181         if (likely(nb_tx))
3182                 hns3_write_reg_opt(txq->io_tail_reg, nb_hold);
3183
3184         return nb_tx;
3185 }
3186
3187 int __rte_weak
3188 hns3_tx_check_vec_support(__rte_unused struct rte_eth_dev *dev)
3189 {
3190         return -ENOTSUP;
3191 }
3192
3193 uint16_t __rte_weak
3194 hns3_xmit_pkts_vec(__rte_unused void *tx_queue,
3195                    __rte_unused struct rte_mbuf **tx_pkts,
3196                    __rte_unused uint16_t nb_pkts)
3197 {
3198         return 0;
3199 }
3200
3201 int
3202 hns3_tx_burst_mode_get(struct rte_eth_dev *dev, __rte_unused uint16_t queue_id,
3203                        struct rte_eth_burst_mode *mode)
3204 {
3205         eth_tx_burst_t pkt_burst = dev->tx_pkt_burst;
3206         const char *info = NULL;
3207
3208         if (pkt_burst == hns3_xmit_pkts_simple)
3209                 info = "Scalar Simple";
3210         else if (pkt_burst == hns3_xmit_pkts)
3211                 info = "Scalar";
3212         else if (pkt_burst == hns3_xmit_pkts_vec)
3213                 info = "Vector Neon";
3214
3215         if (info == NULL)
3216                 return -EINVAL;
3217
3218         snprintf(mode->info, sizeof(mode->info), "%s", info);
3219
3220         return 0;
3221 }
3222
3223 static eth_tx_burst_t
3224 hns3_get_tx_function(struct rte_eth_dev *dev, eth_tx_prep_t *prep)
3225 {
3226         uint64_t offloads = dev->data->dev_conf.txmode.offloads;
3227         struct hns3_adapter *hns = dev->data->dev_private;
3228
3229         if (hns->tx_vec_allowed && hns3_tx_check_vec_support(dev) == 0) {
3230                 *prep = NULL;
3231                 return hns3_xmit_pkts_vec;
3232         }
3233
3234         if (hns->tx_simple_allowed &&
3235             offloads == (offloads & DEV_TX_OFFLOAD_MBUF_FAST_FREE)) {
3236                 *prep = NULL;
3237                 return hns3_xmit_pkts_simple;
3238         }
3239
3240         *prep = hns3_prep_pkts;
3241         return hns3_xmit_pkts;
3242 }
3243
3244 static uint16_t
3245 hns3_dummy_rxtx_burst(void *dpdk_txq __rte_unused,
3246                       struct rte_mbuf **pkts __rte_unused,
3247                       uint16_t pkts_n __rte_unused)
3248 {
3249         return 0;
3250 }
3251
3252 void hns3_set_rxtx_function(struct rte_eth_dev *eth_dev)
3253 {
3254         struct hns3_adapter *hns = eth_dev->data->dev_private;
3255         eth_tx_prep_t prep = NULL;
3256
3257         if (hns->hw.adapter_state == HNS3_NIC_STARTED &&
3258             rte_atomic16_read(&hns->hw.reset.resetting) == 0) {
3259                 eth_dev->rx_pkt_burst = hns3_get_rx_function(eth_dev);
3260                 eth_dev->tx_pkt_burst = hns3_get_tx_function(eth_dev, &prep);
3261                 eth_dev->tx_pkt_prepare = prep;
3262         } else {
3263                 eth_dev->rx_pkt_burst = hns3_dummy_rxtx_burst;
3264                 eth_dev->tx_pkt_burst = hns3_dummy_rxtx_burst;
3265                 eth_dev->tx_pkt_prepare = hns3_dummy_rxtx_burst;
3266         }
3267 }
3268
3269 void
3270 hns3_rxq_info_get(struct rte_eth_dev *dev, uint16_t queue_id,
3271                   struct rte_eth_rxq_info *qinfo)
3272 {
3273         struct hns3_rx_queue *rxq = dev->data->rx_queues[queue_id];
3274
3275         qinfo->mp = rxq->mb_pool;
3276         qinfo->nb_desc = rxq->nb_rx_desc;
3277         qinfo->scattered_rx = dev->data->scattered_rx;
3278         /* Report the HW Rx buffer length to user */
3279         qinfo->rx_buf_size = rxq->rx_buf_len;
3280
3281         /*
3282          * If there are no available Rx buffer descriptors, incoming packets
3283          * are always dropped by hardware based on hns3 network engine.
3284          */
3285         qinfo->conf.rx_drop_en = 1;
3286         qinfo->conf.offloads = dev->data->dev_conf.rxmode.offloads;
3287         qinfo->conf.rx_free_thresh = rxq->rx_free_thresh;
3288         qinfo->conf.rx_deferred_start = rxq->rx_deferred_start;
3289 }
3290
3291 void
3292 hns3_txq_info_get(struct rte_eth_dev *dev, uint16_t queue_id,
3293                   struct rte_eth_txq_info *qinfo)
3294 {
3295         struct hns3_tx_queue *txq = dev->data->tx_queues[queue_id];
3296
3297         qinfo->nb_desc = txq->nb_tx_desc;
3298         qinfo->conf.offloads = dev->data->dev_conf.txmode.offloads;
3299         qinfo->conf.tx_rs_thresh = txq->tx_rs_thresh;
3300         qinfo->conf.tx_free_thresh = txq->tx_free_thresh;
3301         qinfo->conf.tx_deferred_start = txq->tx_deferred_start;
3302 }