drivers: update copyright for NXP files
[dpdk.git] / drivers / raw / dpaa2_cmdif / dpaa2_cmdif.c
index 470eb53..997d1c8 100644 (file)
@@ -1,5 +1,5 @@
 /* SPDX-License-Identifier: BSD-3-Clause
- * Copyright 2018 NXP
+ * Copyright 2018-2019 NXP
  */
 
 #include <stdio.h>
@@ -18,6 +18,7 @@
 #include <portal/dpaa2_hw_pvt.h>
 #include <portal/dpaa2_hw_dpio.h>
 #include "dpaa2_cmdif_logs.h"
+#include "rte_pmd_dpaa2_cmdif.h"
 
 /* Dynamic log type identifier */
 int dpaa2_cmdif_logtype;
@@ -25,10 +26,170 @@ int dpaa2_cmdif_logtype;
 /* CMDIF driver name */
 #define DPAA2_CMDIF_PMD_NAME dpaa2_dpci
 
-/* CMDIF driver object */
-static struct rte_vdev_driver dpaa2_cmdif_drv;
+/*
+ * This API provides the DPCI device ID in 'attr_value'.
+ * The device ID shall be passed by GPP to the AIOP using CMDIF commands.
+ */
+static int
+dpaa2_cmdif_get_attr(struct rte_rawdev *dev,
+                    const char *attr_name,
+                    uint64_t *attr_value)
+{
+       struct dpaa2_dpci_dev *cidev = dev->dev_private;
+
+       DPAA2_CMDIF_FUNC_TRACE();
+
+       RTE_SET_USED(attr_name);
 
-static const struct rte_rawdev_ops dpaa2_cmdif_ops;
+       if (!attr_value) {
+               DPAA2_CMDIF_ERR("Invalid arguments for getting attributes");
+               return -EINVAL;
+       }
+       *attr_value = cidev->dpci_id;
+
+       return 0;
+}
+
+static int
+dpaa2_cmdif_enqueue_bufs(struct rte_rawdev *dev,
+                        struct rte_rawdev_buf **buffers,
+                        unsigned int count,
+                        rte_rawdev_obj_t context)
+{
+       struct dpaa2_dpci_dev *cidev = dev->dev_private;
+       struct rte_dpaa2_cmdif_context *cmdif_send_cnxt;
+       struct dpaa2_queue *txq;
+       struct qbman_fd fd;
+       struct qbman_eq_desc eqdesc;
+       struct qbman_swp *swp;
+       uint32_t retry_count = 0;
+       int ret;
+
+       RTE_SET_USED(count);
+
+       if (unlikely(!DPAA2_PER_LCORE_DPIO)) {
+               ret = dpaa2_affine_qbman_swp();
+               if (ret) {
+                       DPAA2_CMDIF_ERR("Failure in affining portal\n");
+                       return 0;
+               }
+       }
+       swp = DPAA2_PER_LCORE_PORTAL;
+
+       cmdif_send_cnxt = (struct rte_dpaa2_cmdif_context *)(context);
+       txq = &(cidev->tx_queue[cmdif_send_cnxt->priority]);
+
+       /* Prepare enqueue descriptor */
+       qbman_eq_desc_clear(&eqdesc);
+       qbman_eq_desc_set_fq(&eqdesc, txq->fqid);
+       qbman_eq_desc_set_no_orp(&eqdesc, 0);
+       qbman_eq_desc_set_response(&eqdesc, 0, 0);
+
+       /* Set some of the FD parameters to i.
+        * For performance reasons do not memset
+        */
+       fd.simple.bpid_offset = 0;
+       fd.simple.ctrl = 0;
+
+       DPAA2_SET_FD_ADDR(&fd, DPAA2_VADDR_TO_IOVA(buffers[0]->buf_addr));
+       DPAA2_SET_FD_LEN(&fd, cmdif_send_cnxt->size);
+       DPAA2_SET_FD_FRC(&fd, cmdif_send_cnxt->frc);
+       DPAA2_SET_FD_FLC(&fd, cmdif_send_cnxt->flc);
+
+       /* Enqueue a packet to the QBMAN */
+       do {
+               ret = qbman_swp_enqueue_multiple(swp, &eqdesc, &fd, NULL, 1);
+               if (ret < 0 && ret != -EBUSY)
+                       DPAA2_CMDIF_ERR("Transmit failure with err: %d\n", ret);
+               retry_count++;
+       } while ((ret == -EBUSY) && (retry_count < DPAA2_MAX_TX_RETRY_COUNT));
+
+       if (ret < 0)
+               return ret;
+
+       DPAA2_CMDIF_DP_DEBUG("Successfully transmitted a packet\n");
+
+       return 1;
+}
+
+static int
+dpaa2_cmdif_dequeue_bufs(struct rte_rawdev *dev,
+                        struct rte_rawdev_buf **buffers,
+                        unsigned int count,
+                        rte_rawdev_obj_t context)
+{
+       struct dpaa2_dpci_dev *cidev = dev->dev_private;
+       struct rte_dpaa2_cmdif_context *cmdif_rcv_cnxt;
+       struct dpaa2_queue *rxq;
+       struct qbman_swp *swp;
+       struct qbman_result *dq_storage;
+       const struct qbman_fd *fd;
+       struct qbman_pull_desc pulldesc;
+       uint8_t status;
+       int ret;
+
+       RTE_SET_USED(count);
+
+       if (unlikely(!DPAA2_PER_LCORE_DPIO)) {
+               ret = dpaa2_affine_qbman_swp();
+               if (ret) {
+                       DPAA2_CMDIF_ERR("Failure in affining portal\n");
+                       return 0;
+               }
+       }
+       swp = DPAA2_PER_LCORE_PORTAL;
+
+       cmdif_rcv_cnxt = (struct rte_dpaa2_cmdif_context *)(context);
+       rxq = &(cidev->rx_queue[cmdif_rcv_cnxt->priority]);
+       dq_storage = rxq->q_storage->dq_storage[0];
+
+       qbman_pull_desc_clear(&pulldesc);
+       qbman_pull_desc_set_fq(&pulldesc, rxq->fqid);
+       qbman_pull_desc_set_numframes(&pulldesc, 1);
+       qbman_pull_desc_set_storage(&pulldesc, dq_storage,
+               (uint64_t)(DPAA2_VADDR_TO_IOVA(dq_storage)), 1);
+
+       while (1) {
+               if (qbman_swp_pull(swp, &pulldesc)) {
+                       DPAA2_CMDIF_DP_WARN("VDQ cmd not issued. QBMAN is busy\n");
+                       /* Portal was busy, try again */
+                       continue;
+               }
+               break;
+       }
+
+       /* Check if previous issued command is completed. */
+       while (!qbman_check_command_complete(dq_storage))
+               ;
+       /* Loop until the dq_storage is updated with new token by QBMAN */
+       while (!qbman_result_has_new_result(swp, dq_storage))
+               ;
+
+       /* Check for valid frame. */
+       status = (uint8_t)qbman_result_DQ_flags(dq_storage);
+       if (unlikely((status & QBMAN_DQ_STAT_VALIDFRAME) == 0)) {
+               DPAA2_CMDIF_DP_DEBUG("No frame is delivered\n");
+               return 0;
+       }
+
+       fd = qbman_result_DQ_fd(dq_storage);
+
+       buffers[0]->buf_addr = (void *)DPAA2_IOVA_TO_VADDR(
+                       DPAA2_GET_FD_ADDR(fd) + DPAA2_GET_FD_OFFSET(fd));
+       cmdif_rcv_cnxt->size = DPAA2_GET_FD_LEN(fd);
+       cmdif_rcv_cnxt->flc = DPAA2_GET_FD_FLC(fd);
+       cmdif_rcv_cnxt->frc = DPAA2_GET_FD_FRC(fd);
+
+       DPAA2_CMDIF_DP_DEBUG("packet received\n");
+
+       return 1;
+}
+
+static const struct rte_rawdev_ops dpaa2_cmdif_ops = {
+       .attr_get = dpaa2_cmdif_get_attr,
+       .enqueue_bufs = dpaa2_cmdif_enqueue_bufs,
+       .dequeue_bufs = dpaa2_cmdif_dequeue_bufs,
+};
 
 static int
 dpaa2_cmdif_create(const char *name,
@@ -48,7 +209,6 @@ dpaa2_cmdif_create(const char *name,
 
        rawdev->dev_ops = &dpaa2_cmdif_ops;
        rawdev->device = &vdev->device;
-       rawdev->driver_name = vdev->device.driver->name;
 
        /* For secondary processes, the primary has done all the work */
        if (rte_eal_process_type() != RTE_PROC_PRIMARY)
@@ -111,6 +271,8 @@ dpaa2_cmdif_remove(struct rte_vdev_device *vdev)
        int ret;
 
        name = rte_vdev_device_name(vdev);
+       if (name == NULL)
+               return -1;
 
        DPAA2_CMDIF_INFO("Closing %s on NUMA node %d", name, rte_socket_id());
 
@@ -126,10 +288,7 @@ static struct rte_vdev_driver dpaa2_cmdif_drv = {
 
 RTE_PMD_REGISTER_VDEV(DPAA2_CMDIF_PMD_NAME, dpaa2_cmdif_drv);
 
-RTE_INIT(dpaa2_cmdif_init_log);
-
-static void
-dpaa2_cmdif_init_log(void)
+RTE_INIT(dpaa2_cmdif_init_log)
 {
        dpaa2_cmdif_logtype = rte_log_register("pmd.raw.dpaa2.cmdif");
        if (dpaa2_cmdif_logtype >= 0)