drivers/raw/dpaa2_qdma/dpaa2_qdma.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright 2018 NXP
   3  */
   4
   5 #include <string.h>
   6
   7 #include <rte_eal.h>
   8 #include <rte_fslmc.h>
   9 #include <rte_atomic.h>
  10 #include <rte_lcore.h>
  11 #include <rte_rawdev.h>
  12 #include <rte_rawdev_pmd.h>
  13 #include <rte_malloc.h>
  14 #include <rte_ring.h>
  15 #include <rte_mempool.h>
  16
  17 #include <mc/fsl_dpdmai.h>
  18 #include <portal/dpaa2_hw_pvt.h>
  19 #include <portal/dpaa2_hw_dpio.h>
  20
  21 #include "dpaa2_qdma.h"
  22 #include "dpaa2_qdma_logs.h"
  23 #include "rte_pmd_dpaa2_qdma.h"
  24
  25 /* Dynamic log type identifier */
  26 int dpaa2_qdma_logtype;
  27
  28 /* QDMA device */
  29 static struct qdma_device qdma_dev;
  30
  31 /* QDMA H/W queues list */
  32 TAILQ_HEAD(qdma_hw_queue_list, qdma_hw_queue);
  33 static struct qdma_hw_queue_list qdma_queue_list
  34         = TAILQ_HEAD_INITIALIZER(qdma_queue_list);
  35
  36 /* QDMA Virtual Queues */
  37 static struct qdma_virt_queue *qdma_vqs;
  38
  39 /* QDMA per core data */
  40 static struct qdma_per_core_info qdma_core_info[RTE_MAX_LCORE];
  41
  42 static struct qdma_hw_queue *
  43 alloc_hw_queue(uint32_t lcore_id)
  44 {
  45         struct qdma_hw_queue *queue = NULL;
  46
  47         DPAA2_QDMA_FUNC_TRACE();
  48
  49         /* Get a free queue from the list */
  50         TAILQ_FOREACH(queue, &qdma_queue_list, next) {
  51                 if (queue->num_users == 0) {
  52                         queue->lcore_id = lcore_id;
  53                         queue->num_users++;
  54                         break;
  55                 }
  56         }
  57
  58         return queue;
  59 }
  60
  61 static void
  62 free_hw_queue(struct qdma_hw_queue *queue)
  63 {
  64         DPAA2_QDMA_FUNC_TRACE();
  65
  66         queue->num_users--;
  67 }
  68
  69
  70 static struct qdma_hw_queue *
  71 get_hw_queue(uint32_t lcore_id)
  72 {
  73         struct qdma_per_core_info *core_info;
  74         struct qdma_hw_queue *queue, *temp;
  75         uint32_t least_num_users;
  76         int num_hw_queues, i;
  77
  78         DPAA2_QDMA_FUNC_TRACE();
  79
  80         core_info = &qdma_core_info[lcore_id];
  81         num_hw_queues = core_info->num_hw_queues;
  82
  83         /*
  84          * Allocate a HW queue if there are less queues
  85          * than maximum per core queues configured
  86          */
  87         if (num_hw_queues < qdma_dev.max_hw_queues_per_core) {
  88                 queue = alloc_hw_queue(lcore_id);
  89                 if (queue) {
  90                         core_info->hw_queues[num_hw_queues] = queue;
  91                         core_info->num_hw_queues++;
  92                         return queue;
  93                 }
  94         }
  95
  96         queue = core_info->hw_queues[0];
  97         /* In case there is no queue associated with the core return NULL */
  98         if (!queue)
  99                 return NULL;
 100
 101         /* Fetch the least loaded H/W queue */
 102         least_num_users = core_info->hw_queues[0]->num_users;
 103         for (i = 0; i < num_hw_queues; i++) {
 104                 temp = core_info->hw_queues[i];
 105                 if (temp->num_users < least_num_users)
 106                         queue = temp;
 107         }
 108
 109         if (queue)
 110                 queue->num_users++;
 111
 112         return queue;
 113 }
 114
 115 static void
 116 put_hw_queue(struct qdma_hw_queue *queue)
 117 {
 118         struct qdma_per_core_info *core_info;
 119         int lcore_id, num_hw_queues, i;
 120
 121         DPAA2_QDMA_FUNC_TRACE();
 122
 123         /*
 124          * If this is the last user of the queue free it.
 125          * Also remove it from QDMA core info.
 126          */
 127         if (queue->num_users == 1) {
 128                 free_hw_queue(queue);
 129
 130                 /* Remove the physical queue from core info */
 131                 lcore_id = queue->lcore_id;
 132                 core_info = &qdma_core_info[lcore_id];
 133                 num_hw_queues = core_info->num_hw_queues;
 134                 for (i = 0; i < num_hw_queues; i++) {
 135                         if (queue == core_info->hw_queues[i])
 136                                 break;
 137                 }
 138                 for (; i < num_hw_queues - 1; i++)
 139                         core_info->hw_queues[i] = core_info->hw_queues[i + 1];
 140                 core_info->hw_queues[i] = NULL;
 141         } else {
 142                 queue->num_users--;
 143         }
 144 }
 145
 146 int __rte_experimental
 147 rte_qdma_init(void)
 148 {
 149         DPAA2_QDMA_FUNC_TRACE();
 150
 151         rte_spinlock_init(&qdma_dev.lock);
 152
 153         return 0;
 154 }
 155
 156 void __rte_experimental
 157 rte_qdma_attr_get(struct rte_qdma_attr *qdma_attr)
 158 {
 159         DPAA2_QDMA_FUNC_TRACE();
 160
 161         qdma_attr->num_hw_queues = qdma_dev.num_hw_queues;
 162 }
 163
 164 int __rte_experimental
 165 rte_qdma_reset(void)
 166 {
 167         struct qdma_hw_queue *queue;
 168         int i;
 169
 170         DPAA2_QDMA_FUNC_TRACE();
 171
 172         /* In case QDMA device is not in stopped state, return -EBUSY */
 173         if (qdma_dev.state == 1) {
 174                 DPAA2_QDMA_ERR(
 175                         "Device is in running state. Stop before reset.");
 176                 return -EBUSY;
 177         }
 178
 179         /* In case there are pending jobs on any VQ, return -EBUSY */
 180         for (i = 0; i < qdma_dev.max_vqs; i++) {
 181                 if (qdma_vqs[i].in_use && (qdma_vqs[i].num_enqueues !=
 182                     qdma_vqs[i].num_dequeues))
 183                         DPAA2_QDMA_ERR("Jobs are still pending on VQ: %d", i);
 184                         return -EBUSY;
 185         }
 186
 187         /* Reset HW queues */
 188         TAILQ_FOREACH(queue, &qdma_queue_list, next)
 189                 queue->num_users = 0;
 190
 191         /* Reset and free virtual queues */
 192         for (i = 0; i < qdma_dev.max_vqs; i++) {
 193                 if (qdma_vqs[i].status_ring)
 194                         rte_ring_free(qdma_vqs[i].status_ring);
 195         }
 196         if (qdma_vqs)
 197                 rte_free(qdma_vqs);
 198         qdma_vqs = NULL;
 199
 200         /* Reset per core info */
 201         memset(&qdma_core_info, 0,
 202                 sizeof(struct qdma_per_core_info) * RTE_MAX_LCORE);
 203
 204         /* Free the FLE pool */
 205         if (qdma_dev.fle_pool)
 206                 rte_mempool_free(qdma_dev.fle_pool);
 207
 208         /* Reset QDMA device structure */
 209         qdma_dev.mode = RTE_QDMA_MODE_HW;
 210         qdma_dev.max_hw_queues_per_core = 0;
 211         qdma_dev.fle_pool = NULL;
 212         qdma_dev.fle_pool_count = 0;
 213         qdma_dev.max_vqs = 0;
 214
 215         return 0;
 216 }
 217
 218 int __rte_experimental
 219 rte_qdma_configure(struct rte_qdma_config *qdma_config)
 220 {
 221         int ret;
 222
 223         DPAA2_QDMA_FUNC_TRACE();
 224
 225         /* In case QDMA device is not in stopped state, return -EBUSY */
 226         if (qdma_dev.state == 1) {
 227                 DPAA2_QDMA_ERR(
 228                         "Device is in running state. Stop before config.");
 229                 return -1;
 230         }
 231
 232         /* Reset the QDMA device */
 233         ret = rte_qdma_reset();
 234         if (ret) {
 235                 DPAA2_QDMA_ERR("Resetting QDMA failed");
 236                 return ret;
 237         }
 238
 239         /* Set mode */
 240         qdma_dev.mode = qdma_config->mode;
 241
 242         /* Set max HW queue per core */
 243         if (qdma_config->max_hw_queues_per_core > MAX_HW_QUEUE_PER_CORE) {
 244                 DPAA2_QDMA_ERR("H/W queues per core is more than: %d",
 245                                MAX_HW_QUEUE_PER_CORE);
 246                 return -EINVAL;
 247         }
 248         qdma_dev.max_hw_queues_per_core =
 249                 qdma_config->max_hw_queues_per_core;
 250
 251         /* Allocate Virtual Queues */
 252         qdma_vqs = rte_malloc("qdma_virtual_queues",
 253                         (sizeof(struct qdma_virt_queue) * qdma_config->max_vqs),
 254                         RTE_CACHE_LINE_SIZE);
 255         if (!qdma_vqs) {
 256                 DPAA2_QDMA_ERR("qdma_virtual_queues allocation failed");
 257                 return -ENOMEM;
 258         }
 259         qdma_dev.max_vqs = qdma_config->max_vqs;
 260
 261         /* Allocate FLE pool */
 262         qdma_dev.fle_pool = rte_mempool_create("qdma_fle_pool",
 263                         qdma_config->fle_pool_count, QDMA_FLE_POOL_SIZE,
 264                         QDMA_FLE_CACHE_SIZE(qdma_config->fle_pool_count), 0,
 265                         NULL, NULL, NULL, NULL, SOCKET_ID_ANY, 0);
 266         if (!qdma_dev.fle_pool) {
 267                 DPAA2_QDMA_ERR("qdma_fle_pool create failed");
 268                 rte_free(qdma_vqs);
 269                 qdma_vqs = NULL;
 270                 return -ENOMEM;
 271         }
 272         qdma_dev.fle_pool_count = qdma_config->fle_pool_count;
 273
 274         return 0;
 275 }
 276
 277 int __rte_experimental
 278 rte_qdma_start(void)
 279 {
 280         DPAA2_QDMA_FUNC_TRACE();
 281
 282         qdma_dev.state = 1;
 283
 284         return 0;
 285 }
 286
 287 int __rte_experimental
 288 rte_qdma_vq_create(uint32_t lcore_id, uint32_t flags)
 289 {
 290         char ring_name[32];
 291         int i;
 292
 293         DPAA2_QDMA_FUNC_TRACE();
 294
 295         rte_spinlock_lock(&qdma_dev.lock);
 296
 297         /* Get a free Virtual Queue */
 298         for (i = 0; i < qdma_dev.max_vqs; i++) {
 299                 if (qdma_vqs[i].in_use == 0)
 300                         break;
 301         }
 302
 303         /* Return in case no VQ is free */
 304         if (i == qdma_dev.max_vqs) {
 305                 rte_spinlock_unlock(&qdma_dev.lock);
 306                 return -ENODEV;
 307         }
 308
 309         if (qdma_dev.mode == RTE_QDMA_MODE_HW ||
 310                         (flags & RTE_QDMA_VQ_EXCLUSIVE_PQ)) {
 311                 /* Allocate HW queue for a VQ */
 312                 qdma_vqs[i].hw_queue = alloc_hw_queue(lcore_id);
 313                 qdma_vqs[i].exclusive_hw_queue = 1;
 314         } else {
 315                 /* Allocate a Ring for Virutal Queue in VQ mode */
 316                 sprintf(ring_name, "status ring %d", i);
 317                 qdma_vqs[i].status_ring = rte_ring_create(ring_name,
 318                         qdma_dev.fle_pool_count, rte_socket_id(), 0);
 319                 if (!qdma_vqs[i].status_ring) {
 320                         DPAA2_QDMA_ERR("Status ring creation failed for vq");
 321                         rte_spinlock_unlock(&qdma_dev.lock);
 322                         return rte_errno;
 323                 }
 324
 325                 /* Get a HW queue (shared) for a VQ */
 326                 qdma_vqs[i].hw_queue = get_hw_queue(lcore_id);
 327                 qdma_vqs[i].exclusive_hw_queue = 0;
 328         }
 329
 330         if (qdma_vqs[i].hw_queue == NULL) {
 331                 DPAA2_QDMA_ERR("No H/W queue available for VQ");
 332                 if (qdma_vqs[i].status_ring)
 333                         rte_ring_free(qdma_vqs[i].status_ring);
 334                 qdma_vqs[i].status_ring = NULL;
 335                 rte_spinlock_unlock(&qdma_dev.lock);
 336                 return -ENODEV;
 337         }
 338
 339         qdma_vqs[i].in_use = 1;
 340         qdma_vqs[i].lcore_id = lcore_id;
 341
 342         rte_spinlock_unlock(&qdma_dev.lock);
 343
 344         return i;
 345 }
 346
 347 static void
 348 dpaa2_qdma_populate_fle(struct qbman_fle *fle,
 349                         uint64_t src, uint64_t dest,
 350                         size_t len, uint32_t flags)
 351 {
 352         struct qdma_sdd *sdd;
 353
 354         DPAA2_QDMA_FUNC_TRACE();
 355
 356         sdd = (struct qdma_sdd *)((uint8_t *)(fle) +
 357                 (DPAA2_QDMA_MAX_FLE * sizeof(struct qbman_fle)));
 358
 359         /* first frame list to source descriptor */
 360         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sdd));
 361         DPAA2_SET_FLE_LEN(fle, (2 * (sizeof(struct qdma_sdd))));
 362
 363         /* source and destination descriptor */
 364         DPAA2_SET_SDD_RD_COHERENT(sdd); /* source descriptor CMD */
 365         sdd++;
 366         DPAA2_SET_SDD_WR_COHERENT(sdd); /* dest descriptor CMD */
 367
 368         fle++;
 369         /* source frame list to source buffer */
 370         if (flags & RTE_QDMA_JOB_SRC_PHY) {
 371                 DPAA2_SET_FLE_ADDR(fle, src);
 372                 DPAA2_SET_FLE_BMT(fle);
 373         } else {
 374                 DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(src));
 375         }
 376         DPAA2_SET_FLE_LEN(fle, len);
 377
 378         fle++;
 379         /* destination frame list to destination buffer */
 380         if (flags & RTE_QDMA_JOB_DEST_PHY) {
 381                 DPAA2_SET_FLE_BMT(fle);
 382                 DPAA2_SET_FLE_ADDR(fle, dest);
 383         } else {
 384                 DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(dest));
 385         }
 386         DPAA2_SET_FLE_LEN(fle, len);
 387
 388         /* Final bit: 1, for last frame list */
 389         DPAA2_SET_FLE_FIN(fle);
 390 }
 391
 392 static int
 393 dpdmai_dev_enqueue(struct dpaa2_dpdmai_dev *dpdmai_dev,
 394                    uint16_t txq_id,
 395                    uint16_t vq_id,
 396                    struct rte_qdma_job *job)
 397 {
 398         struct qdma_io_meta *io_meta;
 399         struct qbman_fd fd;
 400         struct dpaa2_queue *txq;
 401         struct qbman_fle *fle;
 402         struct qbman_eq_desc eqdesc;
 403         struct qbman_swp *swp;
 404         int ret;
 405
 406         DPAA2_QDMA_FUNC_TRACE();
 407
 408         if (unlikely(!DPAA2_PER_LCORE_DPIO)) {
 409                 ret = dpaa2_affine_qbman_swp();
 410                 if (ret) {
 411                         DPAA2_QDMA_ERR("Failure in affining portal");
 412                         return 0;
 413                 }
 414         }
 415         swp = DPAA2_PER_LCORE_PORTAL;
 416
 417         txq = &(dpdmai_dev->tx_queue[txq_id]);
 418
 419         /* Prepare enqueue descriptor */
 420         qbman_eq_desc_clear(&eqdesc);
 421         qbman_eq_desc_set_fq(&eqdesc, txq->fqid);
 422         qbman_eq_desc_set_no_orp(&eqdesc, 0);
 423         qbman_eq_desc_set_response(&eqdesc, 0, 0);
 424
 425         /*
 426          * Get an FLE/SDD from FLE pool.
 427          * Note: IO metadata is before the FLE and SDD memory.
 428          */
 429         ret = rte_mempool_get(qdma_dev.fle_pool, (void **)(&io_meta));
 430         if (ret) {
 431                 DPAA2_QDMA_DP_WARN("Memory alloc failed for FLE");
 432                 return ret;
 433         }
 434
 435         /* Set the metadata */
 436         io_meta->cnxt = (size_t)job;
 437         io_meta->id = vq_id;
 438
 439         fle = (struct qbman_fle *)(io_meta + 1);
 440
 441         /* populate Frame descriptor */
 442         memset(&fd, 0, sizeof(struct qbman_fd));
 443         DPAA2_SET_FD_ADDR(&fd, DPAA2_VADDR_TO_IOVA(fle));
 444         DPAA2_SET_FD_COMPOUND_FMT(&fd);
 445         DPAA2_SET_FD_FRC(&fd, QDMA_SER_CTX);
 446
 447         /* Populate FLE */
 448         memset(fle, 0, QDMA_FLE_POOL_SIZE);
 449         dpaa2_qdma_populate_fle(fle, job->src, job->dest, job->len, job->flags);
 450
 451         /* Enqueue the packet to the QBMAN */
 452         do {
 453                 ret = qbman_swp_enqueue_multiple(swp, &eqdesc, &fd, NULL, 1);
 454                 if (ret < 0 && ret != -EBUSY)
 455                         DPAA2_QDMA_ERR("Transmit failure with err: %d", ret);
 456         } while (ret == -EBUSY);
 457
 458         DPAA2_QDMA_DP_DEBUG("Successfully transmitted a packet");
 459
 460         return ret;
 461 }
 462
 463 int __rte_experimental
 464 rte_qdma_vq_enqueue_multi(uint16_t vq_id,
 465                           struct rte_qdma_job **job,
 466                           uint16_t nb_jobs)
 467 {
 468         int i, ret;
 469
 470         DPAA2_QDMA_FUNC_TRACE();
 471
 472         for (i = 0; i < nb_jobs; i++) {
 473                 ret = rte_qdma_vq_enqueue(vq_id, job[i]);
 474                 if (ret < 0)
 475                         break;
 476         }
 477
 478         return i;
 479 }
 480
 481 int __rte_experimental
 482 rte_qdma_vq_enqueue(uint16_t vq_id,
 483                     struct rte_qdma_job *job)
 484 {
 485         struct qdma_virt_queue *qdma_vq = &qdma_vqs[vq_id];
 486         struct qdma_hw_queue *qdma_pq = qdma_vq->hw_queue;
 487         struct dpaa2_dpdmai_dev *dpdmai_dev = qdma_pq->dpdmai_dev;
 488         int ret;
 489
 490         DPAA2_QDMA_FUNC_TRACE();
 491
 492         /* Return error in case of wrong lcore_id */
 493         if (rte_lcore_id() != qdma_vq->lcore_id) {
 494                 DPAA2_QDMA_ERR("QDMA enqueue for vqid %d on wrong core",
 495                                 vq_id);
 496                 return -EINVAL;
 497         }
 498
 499         ret = dpdmai_dev_enqueue(dpdmai_dev, qdma_pq->queue_id, vq_id, job);
 500         if (ret < 0) {
 501                 DPAA2_QDMA_ERR("DPDMAI device enqueue failed: %d", ret);
 502                 return ret;
 503         }
 504
 505         qdma_vq->num_enqueues++;
 506
 507         return 1;
 508 }
 509
 510 /* Function to receive a QDMA job for a given device and queue*/
 511 static int
 512 dpdmai_dev_dequeue(struct dpaa2_dpdmai_dev *dpdmai_dev,
 513                    uint16_t rxq_id,
 514                    uint16_t *vq_id,
 515                    struct rte_qdma_job **job)
 516 {
 517         struct qdma_io_meta *io_meta;
 518         struct dpaa2_queue *rxq;
 519         struct qbman_result *dq_storage;
 520         struct qbman_pull_desc pulldesc;
 521         const struct qbman_fd *fd;
 522         struct qbman_swp *swp;
 523         struct qbman_fle *fle;
 524         uint32_t fqid;
 525         uint8_t status;
 526         int ret;
 527
 528         DPAA2_QDMA_FUNC_TRACE();
 529
 530         if (unlikely(!DPAA2_PER_LCORE_DPIO)) {
 531                 ret = dpaa2_affine_qbman_swp();
 532                 if (ret) {
 533                         DPAA2_QDMA_ERR("Failure in affining portal");
 534                         return 0;
 535                 }
 536         }
 537         swp = DPAA2_PER_LCORE_PORTAL;
 538
 539         rxq = &(dpdmai_dev->rx_queue[rxq_id]);
 540         dq_storage = rxq->q_storage->dq_storage[0];
 541         fqid = rxq->fqid;
 542
 543         /* Prepare dequeue descriptor */
 544         qbman_pull_desc_clear(&pulldesc);
 545         qbman_pull_desc_set_fq(&pulldesc, fqid);
 546         qbman_pull_desc_set_storage(&pulldesc, dq_storage,
 547                 (uint64_t)(DPAA2_VADDR_TO_IOVA(dq_storage)), 1);
 548         qbman_pull_desc_set_numframes(&pulldesc, 1);
 549
 550         while (1) {
 551                 if (qbman_swp_pull(swp, &pulldesc)) {
 552                         DPAA2_QDMA_DP_WARN("VDQ command not issued. QBMAN busy");
 553                         continue;
 554                 }
 555                 break;
 556         }
 557
 558         /* Check if previous issued command is completed. */
 559         while (!qbman_check_command_complete(dq_storage))
 560                 ;
 561         /* Loop until dq_storage is updated with new token by QBMAN */
 562         while (!qbman_check_new_result(dq_storage))
 563                 ;
 564
 565         /* Check for valid frame. */
 566         status = qbman_result_DQ_flags(dq_storage);
 567         if (unlikely((status & QBMAN_DQ_STAT_VALIDFRAME) == 0)) {
 568                 DPAA2_QDMA_DP_DEBUG("No frame is delivered");
 569                 return 0;
 570         }
 571
 572         /* Get the FD */
 573         fd = qbman_result_DQ_fd(dq_storage);
 574
 575         /*
 576          * Fetch metadata from FLE. job and vq_id were set
 577          * in metadata in the enqueue operation.
 578          */
 579         fle = (struct qbman_fle *)DPAA2_IOVA_TO_VADDR(DPAA2_GET_FD_ADDR(fd));
 580         io_meta = (struct qdma_io_meta *)(fle) - 1;
 581         if (vq_id)
 582                 *vq_id = io_meta->id;
 583
 584         *job = (struct rte_qdma_job *)(size_t)io_meta->cnxt;
 585         (*job)->status = DPAA2_GET_FD_ERR(fd);
 586
 587         /* Free FLE to the pool */
 588         rte_mempool_put(qdma_dev.fle_pool, io_meta);
 589
 590         DPAA2_QDMA_DP_DEBUG("packet received");
 591
 592         return 1;
 593 }
 594
 595 int __rte_experimental
 596 rte_qdma_vq_dequeue_multi(uint16_t vq_id,
 597                           struct rte_qdma_job **job,
 598                           uint16_t nb_jobs)
 599 {
 600         int i;
 601
 602         DPAA2_QDMA_FUNC_TRACE();
 603
 604         for (i = 0; i < nb_jobs; i++) {
 605                 job[i] = rte_qdma_vq_dequeue(vq_id);
 606                 if (!job[i])
 607                         break;
 608         }
 609
 610         return i;
 611 }
 612
 613 struct rte_qdma_job * __rte_experimental
 614 rte_qdma_vq_dequeue(uint16_t vq_id)
 615 {
 616         struct qdma_virt_queue *qdma_vq = &qdma_vqs[vq_id];
 617         struct qdma_hw_queue *qdma_pq = qdma_vq->hw_queue;
 618         struct dpaa2_dpdmai_dev *dpdmai_dev = qdma_pq->dpdmai_dev;
 619         struct rte_qdma_job *job = NULL;
 620         struct qdma_virt_queue *temp_qdma_vq;
 621         int dequeue_budget = QDMA_DEQUEUE_BUDGET;
 622         int ring_count, ret, i;
 623         uint16_t temp_vq_id;
 624
 625         DPAA2_QDMA_FUNC_TRACE();
 626
 627         /* Return error in case of wrong lcore_id */
 628         if (rte_lcore_id() != (unsigned int)(qdma_vq->lcore_id)) {
 629                 DPAA2_QDMA_ERR("QDMA dequeue for vqid %d on wrong core",
 630                                 vq_id);
 631                 return NULL;
 632         }
 633
 634         /* Only dequeue when there are pending jobs on VQ */
 635         if (qdma_vq->num_enqueues == qdma_vq->num_dequeues)
 636                 return NULL;
 637
 638         if (qdma_vq->exclusive_hw_queue) {
 639                 /* In case of exclusive queue directly fetch from HW queue */
 640                 ret = dpdmai_dev_dequeue(dpdmai_dev, qdma_pq->queue_id,
 641                                          NULL, &job);
 642                 if (ret < 0) {
 643                         DPAA2_QDMA_ERR(
 644                                 "Dequeue from DPDMAI device failed: %d", ret);
 645                         return NULL;
 646                 }
 647         } else {
 648                 /*
 649                  * Get the QDMA completed jobs from the software ring.
 650                  * In case they are not available on the ring poke the HW
 651                  * to fetch completed jobs from corresponding HW queues
 652                  */
 653                 ring_count = rte_ring_count(qdma_vq->status_ring);
 654                 if (ring_count == 0) {
 655                         /* TODO - How to have right budget */
 656                         for (i = 0; i < dequeue_budget; i++) {
 657                                 ret = dpdmai_dev_dequeue(dpdmai_dev,
 658                                         qdma_pq->queue_id, &temp_vq_id, &job);
 659                                 if (ret == 0)
 660                                         break;
 661                                 temp_qdma_vq = &qdma_vqs[temp_vq_id];
 662                                 rte_ring_enqueue(temp_qdma_vq->status_ring,
 663                                         (void *)(job));
 664                                 ring_count = rte_ring_count(
 665                                         qdma_vq->status_ring);
 666                                 if (ring_count)
 667                                         break;
 668                         }
 669                 }
 670
 671                 /* Dequeue job from the software ring to provide to the user */
 672                 rte_ring_dequeue(qdma_vq->status_ring, (void **)&job);
 673                 if (job)
 674                         qdma_vq->num_dequeues++;
 675         }
 676
 677         return job;
 678 }
 679
 680 void __rte_experimental
 681 rte_qdma_vq_stats(uint16_t vq_id,
 682                   struct rte_qdma_vq_stats *vq_status)
 683 {
 684         struct qdma_virt_queue *qdma_vq = &qdma_vqs[vq_id];
 685
 686         DPAA2_QDMA_FUNC_TRACE();
 687
 688         if (qdma_vq->in_use) {
 689                 vq_status->exclusive_hw_queue = qdma_vq->exclusive_hw_queue;
 690                 vq_status->lcore_id = qdma_vq->lcore_id;
 691                 vq_status->num_enqueues = qdma_vq->num_enqueues;
 692                 vq_status->num_dequeues = qdma_vq->num_dequeues;
 693                 vq_status->num_pending_jobs = vq_status->num_enqueues -
 694                                 vq_status->num_dequeues;
 695         }
 696 }
 697
 698 int __rte_experimental
 699 rte_qdma_vq_destroy(uint16_t vq_id)
 700 {
 701         struct qdma_virt_queue *qdma_vq = &qdma_vqs[vq_id];
 702
 703         DPAA2_QDMA_FUNC_TRACE();
 704
 705         /* In case there are pending jobs on any VQ, return -EBUSY */
 706         if (qdma_vq->num_enqueues != qdma_vq->num_dequeues)
 707                 return -EBUSY;
 708
 709         rte_spinlock_lock(&qdma_dev.lock);
 710
 711         if (qdma_vq->exclusive_hw_queue)
 712                 free_hw_queue(qdma_vq->hw_queue);
 713         else {
 714                 if (qdma_vqs->status_ring)
 715                         rte_ring_free(qdma_vqs->status_ring);
 716
 717                 put_hw_queue(qdma_vq->hw_queue);
 718         }
 719
 720         memset(qdma_vq, 0, sizeof(struct qdma_virt_queue));
 721
 722         rte_spinlock_lock(&qdma_dev.lock);
 723
 724         return 0;
 725 }
 726
 727 void __rte_experimental
 728 rte_qdma_stop(void)
 729 {
 730         DPAA2_QDMA_FUNC_TRACE();
 731
 732         qdma_dev.state = 0;
 733 }
 734
 735 void __rte_experimental
 736 rte_qdma_destroy(void)
 737 {
 738         DPAA2_QDMA_FUNC_TRACE();
 739
 740         rte_qdma_reset();
 741 }
 742
 743 static const struct rte_rawdev_ops dpaa2_qdma_ops;
 744
 745 static int
 746 add_hw_queues_to_list(struct dpaa2_dpdmai_dev *dpdmai_dev)
 747 {
 748         struct qdma_hw_queue *queue;
 749         int i;
 750
 751         DPAA2_QDMA_FUNC_TRACE();
 752
 753         for (i = 0; i < dpdmai_dev->num_queues; i++) {
 754                 queue = rte_zmalloc(NULL, sizeof(struct qdma_hw_queue), 0);
 755                 if (!queue) {
 756                         DPAA2_QDMA_ERR(
 757                                 "Memory allocation failed for QDMA queue");
 758                         return -ENOMEM;
 759                 }
 760
 761                 queue->dpdmai_dev = dpdmai_dev;
 762                 queue->queue_id = i;
 763
 764                 TAILQ_INSERT_TAIL(&qdma_queue_list, queue, next);
 765                 qdma_dev.num_hw_queues++;
 766         }
 767
 768         return 0;
 769 }
 770
 771 static void
 772 remove_hw_queues_from_list(struct dpaa2_dpdmai_dev *dpdmai_dev)
 773 {
 774         struct qdma_hw_queue *queue = NULL;
 775         struct qdma_hw_queue *tqueue = NULL;
 776
 777         DPAA2_QDMA_FUNC_TRACE();
 778
 779         TAILQ_FOREACH_SAFE(queue, &qdma_queue_list, next, tqueue) {
 780                 if (queue->dpdmai_dev == dpdmai_dev) {
 781                         TAILQ_REMOVE(&qdma_queue_list, queue, next);
 782                         rte_free(queue);
 783                         queue = NULL;
 784                 }
 785         }
 786 }
 787
 788 static int
 789 dpaa2_dpdmai_dev_uninit(struct rte_rawdev *rawdev)
 790 {
 791         struct dpaa2_dpdmai_dev *dpdmai_dev = rawdev->dev_private;
 792         int ret, i;
 793
 794         DPAA2_QDMA_FUNC_TRACE();
 795
 796         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
 797                 return 0;
 798
 799         /* Remove HW queues from global list */
 800         remove_hw_queues_from_list(dpdmai_dev);
 801
 802         ret = dpdmai_disable(&dpdmai_dev->dpdmai, CMD_PRI_LOW,
 803                              dpdmai_dev->token);
 804         if (ret)
 805                 DPAA2_QDMA_ERR("dmdmai disable failed");
 806
 807         /* Set up the DQRR storage for Rx */
 808         for (i = 0; i < dpdmai_dev->num_queues; i++) {
 809                 struct dpaa2_queue *rxq = &(dpdmai_dev->rx_queue[i]);
 810
 811                 if (rxq->q_storage) {
 812                         dpaa2_free_dq_storage(rxq->q_storage);
 813                         rte_free(rxq->q_storage);
 814                 }
 815         }
 816
 817         /* Close the device at underlying layer*/
 818         ret = dpdmai_close(&dpdmai_dev->dpdmai, CMD_PRI_LOW, dpdmai_dev->token);
 819         if (ret)
 820                 DPAA2_QDMA_ERR("Failure closing dpdmai device");
 821
 822         return 0;
 823 }
 824
 825 static int
 826 dpaa2_dpdmai_dev_init(struct rte_rawdev *rawdev, int dpdmai_id)
 827 {
 828         struct dpaa2_dpdmai_dev *dpdmai_dev = rawdev->dev_private;
 829         struct dpdmai_rx_queue_cfg rx_queue_cfg;
 830         struct dpdmai_attr attr;
 831         struct dpdmai_rx_queue_attr rx_attr;
 832         struct dpdmai_tx_queue_attr tx_attr;
 833         int ret, i;
 834
 835         DPAA2_QDMA_FUNC_TRACE();
 836
 837         /* For secondary processes, the primary has done all the work */
 838         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
 839                 return 0;
 840
 841         /* Open DPDMAI device */
 842         dpdmai_dev->dpdmai_id = dpdmai_id;
 843         dpdmai_dev->dpdmai.regs = rte_mcp_ptr_list[MC_PORTAL_INDEX];
 844         ret = dpdmai_open(&dpdmai_dev->dpdmai, CMD_PRI_LOW,
 845                           dpdmai_dev->dpdmai_id, &dpdmai_dev->token);
 846         if (ret) {
 847                 DPAA2_QDMA_ERR("dpdmai_open() failed with err: %d", ret);
 848                 return ret;
 849         }
 850
 851         /* Get DPDMAI attributes */
 852         ret = dpdmai_get_attributes(&dpdmai_dev->dpdmai, CMD_PRI_LOW,
 853                                     dpdmai_dev->token, &attr);
 854         if (ret) {
 855                 DPAA2_QDMA_ERR("dpdmai get attributes failed with err: %d",
 856                                ret);
 857                 goto init_err;
 858         }
 859         dpdmai_dev->num_queues = attr.num_of_queues;
 860
 861         /* Set up Rx Queues */
 862         for (i = 0; i < dpdmai_dev->num_queues; i++) {
 863                 struct dpaa2_queue *rxq;
 864
 865                 memset(&rx_queue_cfg, 0, sizeof(struct dpdmai_rx_queue_cfg));
 866                 ret = dpdmai_set_rx_queue(&dpdmai_dev->dpdmai,
 867                                           CMD_PRI_LOW,
 868                                           dpdmai_dev->token,
 869                                           i, 0, &rx_queue_cfg);
 870                 if (ret) {
 871                         DPAA2_QDMA_ERR("Setting Rx queue failed with err: %d",
 872                                        ret);
 873                         goto init_err;
 874                 }
 875
 876                 /* Allocate DQ storage for the DPDMAI Rx queues */
 877                 rxq = &(dpdmai_dev->rx_queue[i]);
 878                 rxq->q_storage = rte_malloc("dq_storage",
 879                                             sizeof(struct queue_storage_info_t),
 880                                             RTE_CACHE_LINE_SIZE);
 881                 if (!rxq->q_storage) {
 882                         DPAA2_QDMA_ERR("q_storage allocation failed");
 883                         ret = -ENOMEM;
 884                         goto init_err;
 885                 }
 886
 887                 memset(rxq->q_storage, 0, sizeof(struct queue_storage_info_t));
 888                 ret = dpaa2_alloc_dq_storage(rxq->q_storage);
 889                 if (ret) {
 890                         DPAA2_QDMA_ERR("dpaa2_alloc_dq_storage failed");
 891                         goto init_err;
 892                 }
 893         }
 894
 895         /* Get Rx and Tx queues FQID's */
 896         for (i = 0; i < dpdmai_dev->num_queues; i++) {
 897                 ret = dpdmai_get_rx_queue(&dpdmai_dev->dpdmai, CMD_PRI_LOW,
 898                                           dpdmai_dev->token, i, 0, &rx_attr);
 899                 if (ret) {
 900                         DPAA2_QDMA_ERR("Reading device failed with err: %d",
 901                                        ret);
 902                         goto init_err;
 903                 }
 904                 dpdmai_dev->rx_queue[i].fqid = rx_attr.fqid;
 905
 906                 ret = dpdmai_get_tx_queue(&dpdmai_dev->dpdmai, CMD_PRI_LOW,
 907                                           dpdmai_dev->token, i, 0, &tx_attr);
 908                 if (ret) {
 909                         DPAA2_QDMA_ERR("Reading device failed with err: %d",
 910                                        ret);
 911                         goto init_err;
 912                 }
 913                 dpdmai_dev->tx_queue[i].fqid = tx_attr.fqid;
 914         }
 915
 916         /* Enable the device */
 917         ret = dpdmai_enable(&dpdmai_dev->dpdmai, CMD_PRI_LOW,
 918                             dpdmai_dev->token);
 919         if (ret) {
 920                 DPAA2_QDMA_ERR("Enabling device failed with err: %d", ret);
 921                 goto init_err;
 922         }
 923
 924         /* Add the HW queue to the global list */
 925         ret = add_hw_queues_to_list(dpdmai_dev);
 926         if (ret) {
 927                 DPAA2_QDMA_ERR("Adding H/W queue to list failed");
 928                 goto init_err;
 929         }
 930         DPAA2_QDMA_DEBUG("Initialized dpdmai object successfully");
 931
 932         return 0;
 933 init_err:
 934         dpaa2_dpdmai_dev_uninit(rawdev);
 935         return ret;
 936 }
 937
 938 static int
 939 rte_dpaa2_qdma_probe(struct rte_dpaa2_driver *dpaa2_drv,
 940                      struct rte_dpaa2_device *dpaa2_dev)
 941 {
 942         struct rte_rawdev *rawdev;
 943         int ret;
 944
 945         DPAA2_QDMA_FUNC_TRACE();
 946
 947         rawdev = rte_rawdev_pmd_allocate(dpaa2_dev->device.name,
 948                         sizeof(struct dpaa2_dpdmai_dev),
 949                         rte_socket_id());
 950         if (!rawdev) {
 951                 DPAA2_QDMA_ERR("Unable to allocate rawdevice");
 952                 return -EINVAL;
 953         }
 954
 955         dpaa2_dev->rawdev = rawdev;
 956         rawdev->dev_ops = &dpaa2_qdma_ops;
 957         rawdev->device = &dpaa2_dev->device;
 958         rawdev->driver_name = dpaa2_drv->driver.name;
 959
 960         /* Invoke PMD device initialization function */
 961         ret = dpaa2_dpdmai_dev_init(rawdev, dpaa2_dev->object_id);
 962         if (ret) {
 963                 rte_rawdev_pmd_release(rawdev);
 964                 return ret;
 965         }
 966
 967         return 0;
 968 }
 969
 970 static int
 971 rte_dpaa2_qdma_remove(struct rte_dpaa2_device *dpaa2_dev)
 972 {
 973         struct rte_rawdev *rawdev = dpaa2_dev->rawdev;
 974         int ret;
 975
 976         DPAA2_QDMA_FUNC_TRACE();
 977
 978         dpaa2_dpdmai_dev_uninit(rawdev);
 979
 980         ret = rte_rawdev_pmd_release(rawdev);
 981         if (ret)
 982                 DPAA2_QDMA_ERR("Device cleanup failed");
 983
 984         return 0;
 985 }
 986
 987 static struct rte_dpaa2_driver rte_dpaa2_qdma_pmd = {
 988         .drv_flags = RTE_DPAA2_DRV_IOVA_AS_VA,
 989         .drv_type = DPAA2_QDMA,
 990         .probe = rte_dpaa2_qdma_probe,
 991         .remove = rte_dpaa2_qdma_remove,
 992 };
 993
 994 RTE_PMD_REGISTER_DPAA2(dpaa2_qdma, rte_dpaa2_qdma_pmd);
 995
 996 RTE_INIT(dpaa2_qdma_init_log)
 997 {
 998         dpaa2_qdma_logtype = rte_log_register("pmd.raw.dpaa2.qdma");
 999         if (dpaa2_qdma_logtype >= 0)
1000                 rte_log_set_level(dpaa2_qdma_logtype, RTE_LOG_INFO);
1001 }