remove useless memzone includes
[dpdk.git] / drivers / event / dpaa2 / dpaa2_eventdev.c
index c00db7a..a23c734 100644 (file)
@@ -36,7 +36,6 @@
 #include <errno.h>
 #include <stdint.h>
 #include <string.h>
-#include <stdint.h>
 #include <sys/epoll.h>
 
 #include <rte_atomic.h>
 #include <rte_lcore.h>
 #include <rte_log.h>
 #include <rte_malloc.h>
+#include <rte_memcpy.h>
 #include <rte_memory.h>
-#include <rte_memzone.h>
 #include <rte_pci.h>
 #include <rte_vdev.h>
+#include <rte_ethdev.h>
+#include <rte_event_eth_rx_adapter.h>
 
 #include <fslmc_vfio.h>
 #include <dpaa2_hw_pvt.h>
 #include <dpaa2_hw_mempool.h>
 #include <dpaa2_hw_dpio.h>
+#include <dpaa2_ethdev.h>
 #include "dpaa2_eventdev.h"
 #include <portal/dpaa2_hw_pvt.h>
 #include <mc/fsl_dpci.h>
@@ -74,11 +76,94 @@ static uint16_t
 dpaa2_eventdev_enqueue_burst(void *port, const struct rte_event ev[],
                             uint16_t nb_events)
 {
+       struct rte_eventdev *ev_dev =
+                       ((struct dpaa2_io_portal_t *)port)->eventdev;
+       struct dpaa2_eventdev *priv = ev_dev->data->dev_private;
+       uint32_t queue_id = ev[0].queue_id;
+       struct evq_info_t *evq_info = &priv->evq_info[queue_id];
+       uint32_t fqid;
+       struct qbman_swp *swp;
+       struct qbman_fd fd_arr[MAX_TX_RING_SLOTS];
+       uint32_t loop, frames_to_send;
+       struct qbman_eq_desc eqdesc[MAX_TX_RING_SLOTS];
+       uint16_t num_tx = 0;
+       int ret;
+
        RTE_SET_USED(port);
-       RTE_SET_USED(ev);
-       RTE_SET_USED(nb_events);
 
-       return 0;
+       if (unlikely(!DPAA2_PER_LCORE_DPIO)) {
+               ret = dpaa2_affine_qbman_swp();
+               if (ret) {
+                       PMD_DRV_LOG(ERR, "Failure in affining portal\n");
+                       return 0;
+               }
+       }
+
+       swp = DPAA2_PER_LCORE_PORTAL;
+
+       while (nb_events) {
+               frames_to_send = (nb_events >> 3) ?
+                       MAX_TX_RING_SLOTS : nb_events;
+
+               for (loop = 0; loop < frames_to_send; loop++) {
+                       const struct rte_event *event = &ev[num_tx + loop];
+
+                       if (event->sched_type != RTE_SCHED_TYPE_ATOMIC)
+                               fqid = evq_info->dpci->queue[
+                                       DPAA2_EVENT_DPCI_PARALLEL_QUEUE].fqid;
+                       else
+                               fqid = evq_info->dpci->queue[
+                                       DPAA2_EVENT_DPCI_ATOMIC_QUEUE].fqid;
+
+                       /* Prepare enqueue descriptor */
+                       qbman_eq_desc_clear(&eqdesc[loop]);
+                       qbman_eq_desc_set_fq(&eqdesc[loop], fqid);
+                       qbman_eq_desc_set_no_orp(&eqdesc[loop], 0);
+                       qbman_eq_desc_set_response(&eqdesc[loop], 0, 0);
+
+                       if (event->impl_opaque) {
+                               uint8_t dqrr_index = event->impl_opaque - 1;
+
+                               qbman_eq_desc_set_dca(&eqdesc[loop], 1,
+                                                     dqrr_index, 0);
+                               DPAA2_PER_LCORE_DPIO->dqrr_size--;
+                               DPAA2_PER_LCORE_DPIO->dqrr_held &=
+                                       ~(1 << dqrr_index);
+                       }
+
+                       memset(&fd_arr[loop], 0, sizeof(struct qbman_fd));
+
+                       /*
+                        * todo - need to align with hw context data
+                        * to avoid copy
+                        */
+                       struct rte_event *ev_temp = rte_malloc(NULL,
+                               sizeof(struct rte_event), 0);
+
+                       if (!ev_temp) {
+                               if (!loop)
+                                       return num_tx;
+                               frames_to_send = loop;
+                               PMD_DRV_LOG(ERR, "Unable to allocate memory");
+                               goto send_partial;
+                       }
+                       rte_memcpy(ev_temp, event, sizeof(struct rte_event));
+                       DPAA2_SET_FD_ADDR((&fd_arr[loop]), ev_temp);
+                       DPAA2_SET_FD_LEN((&fd_arr[loop]),
+                                        sizeof(struct rte_event));
+               }
+send_partial:
+               loop = 0;
+               while (loop < frames_to_send) {
+                       loop += qbman_swp_enqueue_multiple_desc(swp,
+                                       &eqdesc[loop], &fd_arr[loop],
+                                       frames_to_send - loop);
+               }
+               num_tx += frames_to_send;
+               nb_events -= frames_to_send;
+       }
+
+       return num_tx;
 }
 
 static uint16_t
@@ -87,16 +172,127 @@ dpaa2_eventdev_enqueue(void *port, const struct rte_event *ev)
        return dpaa2_eventdev_enqueue_burst(port, ev, 1);
 }
 
+static void dpaa2_eventdev_dequeue_wait(uint64_t timeout_ticks)
+{
+       struct epoll_event epoll_ev;
+       int ret, i = 0;
+
+       qbman_swp_interrupt_clear_status(DPAA2_PER_LCORE_PORTAL,
+                                        QBMAN_SWP_INTERRUPT_DQRI);
+
+RETRY:
+       ret = epoll_wait(DPAA2_PER_LCORE_DPIO->epoll_fd,
+                        &epoll_ev, 1, timeout_ticks);
+       if (ret < 1) {
+               /* sometimes due to some spurious interrupts epoll_wait fails
+                * with errno EINTR. so here we are retrying epoll_wait in such
+                * case to avoid the problem.
+                */
+               if (errno == EINTR) {
+                       PMD_DRV_LOG(DEBUG, "epoll_wait fails\n");
+                       if (i++ > 10)
+                               PMD_DRV_LOG(DEBUG, "Dequeue burst Failed\n");
+               goto RETRY;
+               }
+       }
+}
+
+static void dpaa2_eventdev_process_parallel(struct qbman_swp *swp,
+                                           const struct qbman_fd *fd,
+                                           const struct qbman_result *dq,
+                                           struct dpaa2_queue *rxq,
+                                           struct rte_event *ev)
+{
+       struct rte_event *ev_temp =
+               (struct rte_event *)DPAA2_GET_FD_ADDR(fd);
+
+       RTE_SET_USED(rxq);
+
+       rte_memcpy(ev, ev_temp, sizeof(struct rte_event));
+       rte_free(ev_temp);
+
+       qbman_swp_dqrr_consume(swp, dq);
+}
+
+static void dpaa2_eventdev_process_atomic(struct qbman_swp *swp,
+                                         const struct qbman_fd *fd,
+                                         const struct qbman_result *dq,
+                                         struct dpaa2_queue *rxq,
+                                         struct rte_event *ev)
+{
+       struct rte_event *ev_temp =
+               (struct rte_event *)DPAA2_GET_FD_ADDR(fd);
+       uint8_t dqrr_index = qbman_get_dqrr_idx(dq);
+
+       RTE_SET_USED(swp);
+       RTE_SET_USED(rxq);
+
+       rte_memcpy(ev, ev_temp, sizeof(struct rte_event));
+       rte_free(ev_temp);
+       ev->impl_opaque = dqrr_index + 1;
+       DPAA2_PER_LCORE_DPIO->dqrr_size++;
+       DPAA2_PER_LCORE_DPIO->dqrr_held |= 1 << dqrr_index;
+}
+
 static uint16_t
 dpaa2_eventdev_dequeue_burst(void *port, struct rte_event ev[],
                             uint16_t nb_events, uint64_t timeout_ticks)
 {
+       const struct qbman_result *dq;
+       struct qbman_swp *swp;
+       const struct qbman_fd *fd;
+       struct dpaa2_queue *rxq;
+       int num_pkts = 0, ret, i = 0;
+
        RTE_SET_USED(port);
-       RTE_SET_USED(ev);
-       RTE_SET_USED(nb_events);
-       RTE_SET_USED(timeout_ticks);
 
-       return 0;
+       if (unlikely(!DPAA2_PER_LCORE_DPIO)) {
+               ret = dpaa2_affine_qbman_swp();
+               if (ret) {
+                       PMD_DRV_LOG(ERR, "Failure in affining portal\n");
+                       return 0;
+               }
+       }
+
+       swp = DPAA2_PER_LCORE_PORTAL;
+
+       /* Check if there are atomic contexts to be released */
+       while (DPAA2_PER_LCORE_DPIO->dqrr_size) {
+               if (DPAA2_PER_LCORE_DPIO->dqrr_held & (1 << i)) {
+                       dq = qbman_get_dqrr_from_idx(swp, i);
+                       qbman_swp_dqrr_consume(swp, dq);
+                       DPAA2_PER_LCORE_DPIO->dqrr_size--;
+               }
+               i++;
+       }
+       DPAA2_PER_LCORE_DPIO->dqrr_held = 0;
+
+       do {
+               dq = qbman_swp_dqrr_next(swp);
+               if (!dq) {
+                       if (!num_pkts && timeout_ticks) {
+                               dpaa2_eventdev_dequeue_wait(timeout_ticks);
+                               timeout_ticks = 0;
+                               continue;
+                       }
+                       return num_pkts;
+               }
+
+               fd = qbman_result_DQ_fd(dq);
+
+               rxq = (struct dpaa2_queue *)qbman_result_DQ_fqd_ctx(dq);
+               if (rxq) {
+                       rxq->cb(swp, fd, dq, rxq, &ev[num_pkts]);
+               } else {
+                       qbman_swp_dqrr_consume(swp, dq);
+                       PMD_DRV_LOG(ERR, "Null Return VQ received\n");
+                       return 0;
+               }
+
+               num_pkts++;
+       } while (num_pkts < nb_events);
+
+       return num_pkts;
 }
 
 static uint16_t
@@ -136,7 +332,8 @@ dpaa2_eventdev_info_get(struct rte_eventdev *dev,
        dev_info->max_event_port_enqueue_depth =
                DPAA2_EVENT_MAX_PORT_ENQUEUE_DEPTH;
        dev_info->max_num_events = DPAA2_EVENT_MAX_NUM_EVENTS;
-       dev_info->event_dev_cap = RTE_EVENT_DEV_CAP_DISTRIBUTED_SCHED;
+       dev_info->event_dev_cap = RTE_EVENT_DEV_CAP_DISTRIBUTED_SCHED |
+               RTE_EVENT_DEV_CAP_BURST_MODE;
 }
 
 static int
@@ -198,8 +395,8 @@ dpaa2_eventdev_queue_def_conf(struct rte_eventdev *dev, uint8_t queue_id,
        RTE_SET_USED(queue_conf);
 
        queue_conf->nb_atomic_flows = DPAA2_EVENT_QUEUE_ATOMIC_FLOWS;
-       queue_conf->event_queue_cfg = RTE_EVENT_QUEUE_CFG_ATOMIC_ONLY |
-                                     RTE_EVENT_QUEUE_CFG_PARALLEL_ONLY;
+       queue_conf->schedule_type = RTE_SCHED_TYPE_ATOMIC |
+                                     RTE_SCHED_TYPE_PARALLEL;
        queue_conf->priority = RTE_EVENT_DEV_PRIORITY_NORMAL;
 }
 
@@ -371,6 +568,147 @@ dpaa2_eventdev_dump(struct rte_eventdev *dev, FILE *f)
        RTE_SET_USED(f);
 }
 
+static int
+dpaa2_eventdev_eth_caps_get(const struct rte_eventdev *dev,
+                           const struct rte_eth_dev *eth_dev,
+                           uint32_t *caps)
+{
+       const char *ethdev_driver = eth_dev->device->driver->name;
+
+       PMD_DRV_FUNC_TRACE();
+
+       RTE_SET_USED(dev);
+
+       if (!strcmp(ethdev_driver, "net_dpaa2"))
+               *caps = RTE_EVENT_ETH_RX_ADAPTER_DPAA2_CAP;
+       else
+               *caps = RTE_EVENT_ETH_RX_ADAPTER_SW_CAP;
+
+       return 0;
+}
+
+static int
+dpaa2_eventdev_eth_queue_add_all(const struct rte_eventdev *dev,
+               const struct rte_eth_dev *eth_dev,
+               const struct rte_event_eth_rx_adapter_queue_conf *queue_conf)
+{
+       struct dpaa2_eventdev *priv = dev->data->dev_private;
+       uint8_t ev_qid = queue_conf->ev.queue_id;
+       uint16_t dpcon_id = priv->evq_info[ev_qid].dpcon->dpcon_id;
+       int i, ret;
+
+       PMD_DRV_FUNC_TRACE();
+
+       for (i = 0; i < eth_dev->data->nb_rx_queues; i++) {
+               ret = dpaa2_eth_eventq_attach(eth_dev, i,
+                               dpcon_id, queue_conf);
+               if (ret) {
+                       PMD_DRV_ERR("dpaa2_eth_eventq_attach failed: ret %d\n",
+                                   ret);
+                       goto fail;
+               }
+       }
+       return 0;
+fail:
+       for (i = (i - 1); i >= 0 ; i--)
+               dpaa2_eth_eventq_detach(eth_dev, i);
+
+       return ret;
+}
+
+static int
+dpaa2_eventdev_eth_queue_add(const struct rte_eventdev *dev,
+               const struct rte_eth_dev *eth_dev,
+               int32_t rx_queue_id,
+               const struct rte_event_eth_rx_adapter_queue_conf *queue_conf)
+{
+       struct dpaa2_eventdev *priv = dev->data->dev_private;
+       uint8_t ev_qid = queue_conf->ev.queue_id;
+       uint16_t dpcon_id = priv->evq_info[ev_qid].dpcon->dpcon_id;
+       int ret;
+
+       PMD_DRV_FUNC_TRACE();
+
+       if (rx_queue_id == -1)
+               return dpaa2_eventdev_eth_queue_add_all(dev,
+                               eth_dev, queue_conf);
+
+       ret = dpaa2_eth_eventq_attach(eth_dev, rx_queue_id,
+                       dpcon_id, queue_conf);
+       if (ret) {
+               PMD_DRV_ERR("dpaa2_eth_eventq_attach failed: ret: %d\n", ret);
+               return ret;
+       }
+       return 0;
+}
+
+static int
+dpaa2_eventdev_eth_queue_del_all(const struct rte_eventdev *dev,
+                            const struct rte_eth_dev *eth_dev)
+{
+       int i, ret;
+
+       PMD_DRV_FUNC_TRACE();
+
+       RTE_SET_USED(dev);
+
+       for (i = 0; i < eth_dev->data->nb_rx_queues; i++) {
+               ret = dpaa2_eth_eventq_detach(eth_dev, i);
+               if (ret) {
+                       PMD_DRV_ERR("dpaa2_eth_eventq_detach failed: ret %d\n",
+                                   ret);
+                       return ret;
+               }
+       }
+
+       return 0;
+}
+
+static int
+dpaa2_eventdev_eth_queue_del(const struct rte_eventdev *dev,
+                            const struct rte_eth_dev *eth_dev,
+                            int32_t rx_queue_id)
+{
+       int ret;
+
+       PMD_DRV_FUNC_TRACE();
+
+       if (rx_queue_id == -1)
+               return dpaa2_eventdev_eth_queue_del_all(dev, eth_dev);
+
+       ret = dpaa2_eth_eventq_detach(eth_dev, rx_queue_id);
+       if (ret) {
+               PMD_DRV_ERR("dpaa2_eth_eventq_detach failed: ret: %d\n", ret);
+               return ret;
+       }
+
+       return 0;
+}
+
+static int
+dpaa2_eventdev_eth_start(const struct rte_eventdev *dev,
+                        const struct rte_eth_dev *eth_dev)
+{
+       PMD_DRV_FUNC_TRACE();
+
+       RTE_SET_USED(dev);
+       RTE_SET_USED(eth_dev);
+
+       return 0;
+}
+
+static int
+dpaa2_eventdev_eth_stop(const struct rte_eventdev *dev,
+                       const struct rte_eth_dev *eth_dev)
+{
+       PMD_DRV_FUNC_TRACE();
+
+       RTE_SET_USED(dev);
+       RTE_SET_USED(eth_dev);
+
+       return 0;
+}
+
 static const struct rte_eventdev_ops dpaa2_eventdev_ops = {
        .dev_infos_get    = dpaa2_eventdev_info_get,
        .dev_configure    = dpaa2_eventdev_configure,
@@ -386,7 +724,12 @@ static const struct rte_eventdev_ops dpaa2_eventdev_ops = {
        .port_link        = dpaa2_eventdev_port_link,
        .port_unlink      = dpaa2_eventdev_port_unlink,
        .timeout_ticks    = dpaa2_eventdev_timeout_ticks,
-       .dump             = dpaa2_eventdev_dump
+       .dump             = dpaa2_eventdev_dump,
+       .eth_rx_adapter_caps_get = dpaa2_eventdev_eth_caps_get,
+       .eth_rx_adapter_queue_add = dpaa2_eventdev_eth_queue_add,
+       .eth_rx_adapter_queue_del = dpaa2_eventdev_eth_queue_del,
+       .eth_rx_adapter_start = dpaa2_eventdev_eth_start,
+       .eth_rx_adapter_stop = dpaa2_eventdev_eth_stop,
 };
 
 static int
@@ -397,11 +740,17 @@ dpaa2_eventdev_setup_dpci(struct dpaa2_dpci_dev *dpci_dev,
        int ret, i;
 
        /*Do settings to get the frame on a DPCON object*/
-       rx_queue_cfg.options = DPCI_QUEUE_OPT_DEST;
+       rx_queue_cfg.options = DPCI_QUEUE_OPT_DEST |
+                 DPCI_QUEUE_OPT_USER_CTX;
        rx_queue_cfg.dest_cfg.dest_type = DPCI_DEST_DPCON;
        rx_queue_cfg.dest_cfg.dest_id = dpcon_dev->dpcon_id;
        rx_queue_cfg.dest_cfg.priority = DPAA2_EVENT_DEFAULT_DPCI_PRIO;
 
+       dpci_dev->queue[DPAA2_EVENT_DPCI_PARALLEL_QUEUE].cb =
+               dpaa2_eventdev_process_parallel;
+       dpci_dev->queue[DPAA2_EVENT_DPCI_ATOMIC_QUEUE].cb =
+               dpaa2_eventdev_process_atomic;
+
        for (i = 0 ; i < DPAA2_EVENT_DPCI_MAX_QUEUES; i++) {
                rx_queue_cfg.user_ctx = (uint64_t)(&dpci_dev->queue[i]);
                ret = dpci_set_rx_queue(&dpci_dev->dpci,
@@ -409,7 +758,7 @@ dpaa2_eventdev_setup_dpci(struct dpaa2_dpci_dev *dpci_dev,
                                        dpci_dev->token, i,
                                        &rx_queue_cfg);
                if (ret) {
-                       PMD_DRV_LOG(ERR, PMD,
+                       PMD_DRV_LOG(ERR,
                                    "set_rx_q failed with err code: %d", ret);
                        return ret;
                }
@@ -435,9 +784,10 @@ dpaa2_eventdev_create(const char *name)
        }
 
        eventdev->dev_ops       = &dpaa2_eventdev_ops;
-       eventdev->schedule      = NULL;
        eventdev->enqueue       = dpaa2_eventdev_enqueue;
        eventdev->enqueue_burst = dpaa2_eventdev_enqueue_burst;
+       eventdev->enqueue_new_burst = dpaa2_eventdev_enqueue_burst;
+       eventdev->enqueue_forward_burst = dpaa2_eventdev_enqueue_burst;
        eventdev->dequeue       = dpaa2_eventdev_dequeue;
        eventdev->dequeue_burst = dpaa2_eventdev_dequeue_burst;
 
@@ -463,7 +813,7 @@ dpaa2_eventdev_create(const char *name)
 
                ret = dpaa2_eventdev_setup_dpci(dpci_dev, dpcon_dev);
                if (ret) {
-                       PMD_DRV_LOG(ERR, PMD,
+                       PMD_DRV_LOG(ERR,
                                    "dpci setup failed with err code: %d", ret);
                        return ret;
                }
@@ -481,7 +831,7 @@ dpaa2_eventdev_probe(struct rte_vdev_device *vdev)
        const char *name;
 
        name = rte_vdev_device_name(vdev);
-       PMD_DRV_LOG(INFO, PMD, "Initializing %s\n", name);
+       PMD_DRV_LOG(INFO, "Initializing %s", name);
        return dpaa2_eventdev_create(name);
 }