event/cnxk: add device start
[dpdk.git] / drivers / event / cnxk / cn9k_eventdev.c
index d042f58..20919e3 100644 (file)
  * Copyright(C) 2021 Marvell.
  */
 
+#include "cn9k_worker.h"
 #include "cnxk_eventdev.h"
+#include "cnxk_worker.h"
 
 #define CN9K_DUAL_WS_NB_WS         2
 #define CN9K_DUAL_WS_PAIR_ID(x, id) (((x)*CN9K_DUAL_WS_NB_WS) + id)
 
+static void
+cn9k_init_hws_ops(struct cn9k_sso_hws_state *ws, uintptr_t base)
+{
+       ws->tag_op = base + SSOW_LF_GWS_TAG;
+       ws->wqp_op = base + SSOW_LF_GWS_WQP;
+       ws->getwrk_op = base + SSOW_LF_GWS_OP_GET_WORK0;
+       ws->swtag_flush_op = base + SSOW_LF_GWS_OP_SWTAG_FLUSH;
+       ws->swtag_norm_op = base + SSOW_LF_GWS_OP_SWTAG_NORM;
+       ws->swtag_desched_op = base + SSOW_LF_GWS_OP_SWTAG_DESCHED;
+}
+
+static int
+cn9k_sso_hws_link(void *arg, void *port, uint16_t *map, uint16_t nb_link)
+{
+       struct cnxk_sso_evdev *dev = arg;
+       struct cn9k_sso_hws_dual *dws;
+       struct cn9k_sso_hws *ws;
+       int rc;
+
+       if (dev->dual_ws) {
+               dws = port;
+               rc = roc_sso_hws_link(&dev->sso,
+                                     CN9K_DUAL_WS_PAIR_ID(dws->hws_id, 0), map,
+                                     nb_link);
+               rc |= roc_sso_hws_link(&dev->sso,
+                                      CN9K_DUAL_WS_PAIR_ID(dws->hws_id, 1),
+                                      map, nb_link);
+       } else {
+               ws = port;
+               rc = roc_sso_hws_link(&dev->sso, ws->hws_id, map, nb_link);
+       }
+
+       return rc;
+}
+
+static int
+cn9k_sso_hws_unlink(void *arg, void *port, uint16_t *map, uint16_t nb_link)
+{
+       struct cnxk_sso_evdev *dev = arg;
+       struct cn9k_sso_hws_dual *dws;
+       struct cn9k_sso_hws *ws;
+       int rc;
+
+       if (dev->dual_ws) {
+               dws = port;
+               rc = roc_sso_hws_unlink(&dev->sso,
+                                       CN9K_DUAL_WS_PAIR_ID(dws->hws_id, 0),
+                                       map, nb_link);
+               rc |= roc_sso_hws_unlink(&dev->sso,
+                                        CN9K_DUAL_WS_PAIR_ID(dws->hws_id, 1),
+                                        map, nb_link);
+       } else {
+               ws = port;
+               rc = roc_sso_hws_unlink(&dev->sso, ws->hws_id, map, nb_link);
+       }
+
+       return rc;
+}
+
+static void
+cn9k_sso_hws_setup(void *arg, void *hws, uintptr_t *grps_base)
+{
+       struct cnxk_sso_evdev *dev = arg;
+       struct cn9k_sso_hws_dual *dws;
+       struct cn9k_sso_hws *ws;
+       uint64_t val;
+
+       /* Set get_work tmo for HWS */
+       val = NSEC2USEC(dev->deq_tmo_ns) - 1;
+       if (dev->dual_ws) {
+               dws = hws;
+               rte_memcpy(dws->grps_base, grps_base,
+                          sizeof(uintptr_t) * CNXK_SSO_MAX_HWGRP);
+               dws->fc_mem = dev->fc_mem;
+               dws->xaq_lmt = dev->xaq_lmt;
+
+               plt_write64(val, dws->base[0] + SSOW_LF_GWS_NW_TIM);
+               plt_write64(val, dws->base[1] + SSOW_LF_GWS_NW_TIM);
+       } else {
+               ws = hws;
+               rte_memcpy(ws->grps_base, grps_base,
+                          sizeof(uintptr_t) * CNXK_SSO_MAX_HWGRP);
+               ws->fc_mem = dev->fc_mem;
+               ws->xaq_lmt = dev->xaq_lmt;
+
+               plt_write64(val, ws->base + SSOW_LF_GWS_NW_TIM);
+       }
+}
+
+static void
+cn9k_sso_hws_release(void *arg, void *hws)
+{
+       struct cnxk_sso_evdev *dev = arg;
+       struct cn9k_sso_hws_dual *dws;
+       struct cn9k_sso_hws *ws;
+       int i;
+
+       if (dev->dual_ws) {
+               dws = hws;
+               for (i = 0; i < dev->nb_event_queues; i++) {
+                       roc_sso_hws_unlink(&dev->sso,
+                                          CN9K_DUAL_WS_PAIR_ID(dws->hws_id, 0),
+                                          (uint16_t *)&i, 1);
+                       roc_sso_hws_unlink(&dev->sso,
+                                          CN9K_DUAL_WS_PAIR_ID(dws->hws_id, 1),
+                                          (uint16_t *)&i, 1);
+               }
+               memset(dws, 0, sizeof(*dws));
+       } else {
+               ws = hws;
+               for (i = 0; i < dev->nb_event_queues; i++)
+                       roc_sso_hws_unlink(&dev->sso, ws->hws_id,
+                                          (uint16_t *)&i, 1);
+               memset(ws, 0, sizeof(*ws));
+       }
+}
+
+static void
+cn9k_sso_hws_flush_events(void *hws, uint8_t queue_id, uintptr_t base,
+                         cnxk_handle_event_t fn, void *arg)
+{
+       struct cnxk_sso_evdev *dev = cnxk_sso_pmd_priv(arg);
+       struct cn9k_sso_hws_dual *dws;
+       struct cn9k_sso_hws_state *st;
+       struct cn9k_sso_hws *ws;
+       uint64_t cq_ds_cnt = 1;
+       uint64_t aq_cnt = 1;
+       uint64_t ds_cnt = 1;
+       struct rte_event ev;
+       uintptr_t ws_base;
+       uint64_t val, req;
+
+       plt_write64(0, base + SSO_LF_GGRP_QCTL);
+
+       req = queue_id;     /* GGRP ID */
+       req |= BIT_ULL(18); /* Grouped */
+       req |= BIT_ULL(16); /* WAIT */
+
+       aq_cnt = plt_read64(base + SSO_LF_GGRP_AQ_CNT);
+       ds_cnt = plt_read64(base + SSO_LF_GGRP_MISC_CNT);
+       cq_ds_cnt = plt_read64(base + SSO_LF_GGRP_INT_CNT);
+       cq_ds_cnt &= 0x3FFF3FFF0000;
+
+       if (dev->dual_ws) {
+               dws = hws;
+               st = &dws->ws_state[0];
+               ws_base = dws->base[0];
+       } else {
+               ws = hws;
+               st = (struct cn9k_sso_hws_state *)ws;
+               ws_base = ws->base;
+       }
+
+       while (aq_cnt || cq_ds_cnt || ds_cnt) {
+               plt_write64(req, st->getwrk_op);
+               cn9k_sso_hws_get_work_empty(st, &ev);
+               if (fn != NULL && ev.u64 != 0)
+                       fn(arg, ev);
+               if (ev.sched_type != SSO_TT_EMPTY)
+                       cnxk_sso_hws_swtag_flush(st->tag_op,
+                                                st->swtag_flush_op);
+               do {
+                       val = plt_read64(ws_base + SSOW_LF_GWS_PENDSTATE);
+               } while (val & BIT_ULL(56));
+               aq_cnt = plt_read64(base + SSO_LF_GGRP_AQ_CNT);
+               ds_cnt = plt_read64(base + SSO_LF_GGRP_MISC_CNT);
+               cq_ds_cnt = plt_read64(base + SSO_LF_GGRP_INT_CNT);
+               /* Extract cq and ds count */
+               cq_ds_cnt &= 0x3FFF3FFF0000;
+       }
+
+       plt_write64(0, ws_base + SSOW_LF_GWS_OP_GWC_INVAL);
+}
+
+static void
+cn9k_sso_hws_reset(void *arg, void *hws)
+{
+       struct cnxk_sso_evdev *dev = arg;
+       struct cn9k_sso_hws_dual *dws;
+       struct cn9k_sso_hws *ws;
+       uint64_t pend_state;
+       uint8_t pend_tt;
+       uintptr_t base;
+       uint64_t tag;
+       uint8_t i;
+
+       dws = hws;
+       ws = hws;
+       for (i = 0; i < (dev->dual_ws ? CN9K_DUAL_WS_NB_WS : 1); i++) {
+               base = dev->dual_ws ? dws->base[i] : ws->base;
+               /* Wait till getwork/swtp/waitw/desched completes. */
+               do {
+                       pend_state = plt_read64(base + SSOW_LF_GWS_PENDSTATE);
+               } while (pend_state & (BIT_ULL(63) | BIT_ULL(62) | BIT_ULL(58) |
+                                      BIT_ULL(56)));
+
+               tag = plt_read64(base + SSOW_LF_GWS_TAG);
+               pend_tt = (tag >> 32) & 0x3;
+               if (pend_tt != SSO_TT_EMPTY) { /* Work was pending */
+                       if (pend_tt == SSO_TT_ATOMIC ||
+                           pend_tt == SSO_TT_ORDERED)
+                               cnxk_sso_hws_swtag_untag(
+                                       base + SSOW_LF_GWS_OP_SWTAG_UNTAG);
+                       plt_write64(0, base + SSOW_LF_GWS_OP_DESCHED);
+               }
+
+               /* Wait for desched to complete. */
+               do {
+                       pend_state = plt_read64(base + SSOW_LF_GWS_PENDSTATE);
+               } while (pend_state & BIT_ULL(58));
+       }
+}
+
 static void
 cn9k_sso_set_rsrc(void *arg)
 {
@@ -33,6 +248,94 @@ cn9k_sso_rsrc_init(void *arg, uint8_t hws, uint8_t hwgrp)
        return roc_sso_rsrc_init(&dev->sso, hws, hwgrp);
 }
 
+static void
+cn9k_sso_fp_fns_set(struct rte_eventdev *event_dev)
+{
+       struct cnxk_sso_evdev *dev = cnxk_sso_pmd_priv(event_dev);
+
+       event_dev->enqueue = cn9k_sso_hws_enq;
+       event_dev->enqueue_burst = cn9k_sso_hws_enq_burst;
+       event_dev->enqueue_new_burst = cn9k_sso_hws_enq_new_burst;
+       event_dev->enqueue_forward_burst = cn9k_sso_hws_enq_fwd_burst;
+
+       event_dev->dequeue = cn9k_sso_hws_deq;
+       event_dev->dequeue_burst = cn9k_sso_hws_deq_burst;
+       if (dev->deq_tmo_ns) {
+               event_dev->dequeue = cn9k_sso_hws_tmo_deq;
+               event_dev->dequeue_burst = cn9k_sso_hws_tmo_deq_burst;
+       }
+
+       if (dev->dual_ws) {
+               event_dev->enqueue = cn9k_sso_hws_dual_enq;
+               event_dev->enqueue_burst = cn9k_sso_hws_dual_enq_burst;
+               event_dev->enqueue_new_burst = cn9k_sso_hws_dual_enq_new_burst;
+               event_dev->enqueue_forward_burst =
+                       cn9k_sso_hws_dual_enq_fwd_burst;
+
+               event_dev->dequeue = cn9k_sso_hws_dual_deq;
+               event_dev->dequeue_burst = cn9k_sso_hws_dual_deq_burst;
+               if (dev->deq_tmo_ns) {
+                       event_dev->dequeue = cn9k_sso_hws_dual_tmo_deq;
+                       event_dev->dequeue_burst =
+                               cn9k_sso_hws_dual_tmo_deq_burst;
+               }
+       }
+}
+
+static void *
+cn9k_sso_init_hws_mem(void *arg, uint8_t port_id)
+{
+       struct cnxk_sso_evdev *dev = arg;
+       struct cn9k_sso_hws_dual *dws;
+       struct cn9k_sso_hws *ws;
+       void *data;
+
+       if (dev->dual_ws) {
+               dws = rte_zmalloc("cn9k_dual_ws",
+                                 sizeof(struct cn9k_sso_hws_dual) +
+                                         RTE_CACHE_LINE_SIZE,
+                                 RTE_CACHE_LINE_SIZE);
+               if (dws == NULL) {
+                       plt_err("Failed to alloc memory for port=%d", port_id);
+                       return NULL;
+               }
+
+               dws = RTE_PTR_ADD(dws, sizeof(struct cnxk_sso_hws_cookie));
+               dws->base[0] = roc_sso_hws_base_get(
+                       &dev->sso, CN9K_DUAL_WS_PAIR_ID(port_id, 0));
+               dws->base[1] = roc_sso_hws_base_get(
+                       &dev->sso, CN9K_DUAL_WS_PAIR_ID(port_id, 1));
+               cn9k_init_hws_ops(&dws->ws_state[0], dws->base[0]);
+               cn9k_init_hws_ops(&dws->ws_state[1], dws->base[1]);
+               dws->hws_id = port_id;
+               dws->swtag_req = 0;
+               dws->vws = 0;
+
+               data = dws;
+       } else {
+               /* Allocate event port memory */
+               ws = rte_zmalloc("cn9k_ws",
+                                sizeof(struct cn9k_sso_hws) +
+                                        RTE_CACHE_LINE_SIZE,
+                                RTE_CACHE_LINE_SIZE);
+               if (ws == NULL) {
+                       plt_err("Failed to alloc memory for port=%d", port_id);
+                       return NULL;
+               }
+
+               /* First cache line is reserved for cookie */
+               ws = RTE_PTR_ADD(ws, sizeof(struct cnxk_sso_hws_cookie));
+               ws->base = roc_sso_hws_base_get(&dev->sso, port_id);
+               cn9k_init_hws_ops((struct cn9k_sso_hws_state *)ws, ws->base);
+               ws->hws_id = port_id;
+               ws->swtag_req = 0;
+
+               data = ws;
+       }
+
+       return data;
+}
+
 static void
 cn9k_sso_info_get(struct rte_eventdev *event_dev,
                  struct rte_event_dev_info *dev_info)
@@ -63,6 +366,100 @@ cn9k_sso_dev_configure(const struct rte_eventdev *event_dev)
                return -ENODEV;
        }
 
+       rc = cnxk_sso_xaq_allocate(dev);
+       if (rc < 0)
+               goto cnxk_rsrc_fini;
+
+       rc = cnxk_setup_event_ports(event_dev, cn9k_sso_init_hws_mem,
+                                   cn9k_sso_hws_setup);
+       if (rc < 0)
+               goto cnxk_rsrc_fini;
+
+       /* Restore any prior port-queue mapping. */
+       cnxk_sso_restore_links(event_dev, cn9k_sso_hws_link);
+
+       dev->configured = 1;
+       rte_mb();
+
+       return 0;
+cnxk_rsrc_fini:
+       roc_sso_rsrc_fini(&dev->sso);
+       dev->nb_event_ports = 0;
+       return rc;
+}
+
+static int
+cn9k_sso_port_setup(struct rte_eventdev *event_dev, uint8_t port_id,
+                   const struct rte_event_port_conf *port_conf)
+{
+
+       RTE_SET_USED(port_conf);
+       return cnxk_sso_port_setup(event_dev, port_id, cn9k_sso_hws_setup);
+}
+
+static void
+cn9k_sso_port_release(void *port)
+{
+       struct cnxk_sso_hws_cookie *gws_cookie = cnxk_sso_hws_get_cookie(port);
+       struct cnxk_sso_evdev *dev;
+
+       if (port == NULL)
+               return;
+
+       dev = cnxk_sso_pmd_priv(gws_cookie->event_dev);
+       if (!gws_cookie->configured)
+               goto free;
+
+       cn9k_sso_hws_release(dev, port);
+       memset(gws_cookie, 0, sizeof(*gws_cookie));
+free:
+       rte_free(gws_cookie);
+}
+
+static int
+cn9k_sso_port_link(struct rte_eventdev *event_dev, void *port,
+                  const uint8_t queues[], const uint8_t priorities[],
+                  uint16_t nb_links)
+{
+       struct cnxk_sso_evdev *dev = cnxk_sso_pmd_priv(event_dev);
+       uint16_t hwgrp_ids[nb_links];
+       uint16_t link;
+
+       RTE_SET_USED(priorities);
+       for (link = 0; link < nb_links; link++)
+               hwgrp_ids[link] = queues[link];
+       nb_links = cn9k_sso_hws_link(dev, port, hwgrp_ids, nb_links);
+
+       return (int)nb_links;
+}
+
+static int
+cn9k_sso_port_unlink(struct rte_eventdev *event_dev, void *port,
+                    uint8_t queues[], uint16_t nb_unlinks)
+{
+       struct cnxk_sso_evdev *dev = cnxk_sso_pmd_priv(event_dev);
+       uint16_t hwgrp_ids[nb_unlinks];
+       uint16_t unlink;
+
+       for (unlink = 0; unlink < nb_unlinks; unlink++)
+               hwgrp_ids[unlink] = queues[unlink];
+       nb_unlinks = cn9k_sso_hws_unlink(dev, port, hwgrp_ids, nb_unlinks);
+
+       return (int)nb_unlinks;
+}
+
+static int
+cn9k_sso_start(struct rte_eventdev *event_dev)
+{
+       int rc;
+
+       rc = cnxk_sso_start(event_dev, cn9k_sso_hws_reset,
+                           cn9k_sso_hws_flush_events);
+       if (rc < 0)
+               return rc;
+
+       cn9k_sso_fp_fns_set(event_dev);
+
        return rc;
 }
 
@@ -70,7 +467,16 @@ static struct rte_eventdev_ops cn9k_sso_dev_ops = {
        .dev_infos_get = cn9k_sso_info_get,
        .dev_configure = cn9k_sso_dev_configure,
        .queue_def_conf = cnxk_sso_queue_def_conf,
+       .queue_setup = cnxk_sso_queue_setup,
+       .queue_release = cnxk_sso_queue_release,
        .port_def_conf = cnxk_sso_port_def_conf,
+       .port_setup = cn9k_sso_port_setup,
+       .port_release = cn9k_sso_port_release,
+       .port_link = cn9k_sso_port_link,
+       .port_unlink = cn9k_sso_port_unlink,
+       .timeout_ticks = cnxk_sso_timeout_ticks,
+
+       .dev_start = cn9k_sso_start,
 };
 
 static int
@@ -92,8 +498,10 @@ cn9k_sso_init(struct rte_eventdev *event_dev)
 
        event_dev->dev_ops = &cn9k_sso_dev_ops;
        /* For secondary processes, the primary has done all the work */
-       if (rte_eal_process_type() != RTE_PROC_PRIMARY)
+       if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
+               cn9k_sso_fp_fns_set(event_dev);
                return 0;
+       }
 
        rc = cnxk_sso_init(event_dev);
        if (rc < 0)
@@ -137,3 +545,6 @@ static struct rte_pci_driver cn9k_pci_sso = {
 RTE_PMD_REGISTER_PCI(event_cn9k, cn9k_pci_sso);
 RTE_PMD_REGISTER_PCI_TABLE(event_cn9k, cn9k_pci_sso_map);
 RTE_PMD_REGISTER_KMOD_DEP(event_cn9k, "vfio-pci");
+RTE_PMD_REGISTER_PARAM_STRING(event_cn9k, CNXK_SSO_XAE_CNT "=<int>"
+                             CNXK_SSO_GGRP_QOS "=<string>"
+                             CN9K_SSO_SINGLE_WS "=1");