Imported Upstream version 17.05
[deb_dpdk.git] / drivers / event / octeontx / ssovf_worker.c
diff --git a/drivers/event/octeontx/ssovf_worker.c b/drivers/event/octeontx/ssovf_worker.c
new file mode 100644 (file)
index 0000000..ad3fe68
--- /dev/null
@@ -0,0 +1,252 @@
+/*
+ *   BSD LICENSE
+ *
+ *   Copyright (C) Cavium networks Ltd. 2017.
+ *
+ *   Redistribution and use in source and binary forms, with or without
+ *   modification, are permitted provided that the following conditions
+ *   are met:
+ *
+ *     * Redistributions of source code must retain the above copyright
+ *       notice, this list of conditions and the following disclaimer.
+ *     * Redistributions in binary form must reproduce the above copyright
+ *       notice, this list of conditions and the following disclaimer in
+ *       the documentation and/or other materials provided with the
+ *       distribution.
+ *     * Neither the name of Cavium networks nor the names of its
+ *       contributors may be used to endorse or promote products derived
+ *       from this software without specific prior written permission.
+ *
+ *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
+ *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
+ *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
+ *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+ *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include "ssovf_worker.h"
+
+static force_inline void
+ssows_new_event(struct ssows *ws, const struct rte_event *ev)
+{
+       const uint64_t event_ptr = ev->u64;
+       const uint32_t tag = (uint32_t)ev->event;
+       const uint8_t new_tt = ev->sched_type;
+       const uint8_t grp = ev->queue_id;
+
+       ssows_add_work(ws, event_ptr, tag, new_tt, grp);
+}
+
+static force_inline void
+ssows_fwd_swtag(struct ssows *ws, const struct rte_event *ev, const uint8_t grp)
+{
+       const uint8_t cur_tt = ws->cur_tt;
+       const uint8_t new_tt = ev->sched_type;
+       const uint32_t tag = (uint32_t)ev->event;
+       /*
+        * cur_tt/new_tt     SSO_SYNC_ORDERED SSO_SYNC_ATOMIC SSO_SYNC_UNTAGGED
+        *
+        * SSO_SYNC_ORDERED        norm           norm             untag
+        * SSO_SYNC_ATOMIC         norm           norm             untag
+        * SSO_SYNC_UNTAGGED       full           full             NOOP
+        */
+       if (unlikely(cur_tt == SSO_SYNC_UNTAGGED)) {
+               if (new_tt != SSO_SYNC_UNTAGGED) {
+                       ssows_swtag_full(ws, ev->u64, tag,
+                               new_tt, grp);
+               }
+       } else {
+               if (likely(new_tt != SSO_SYNC_UNTAGGED))
+                       ssows_swtag_norm(ws, tag, new_tt);
+               else
+                       ssows_swtag_untag(ws);
+       }
+       ws->swtag_req = 1;
+}
+
+#define OCT_EVENT_TYPE_GRP_FWD (RTE_EVENT_TYPE_MAX - 1)
+
+static force_inline void
+ssows_fwd_group(struct ssows *ws, const struct rte_event *ev, const uint8_t grp)
+{
+       const uint64_t event_ptr = ev->u64;
+       const uint32_t tag = (uint32_t)ev->event;
+       const uint8_t cur_tt = ws->cur_tt;
+       const uint8_t new_tt = ev->sched_type;
+
+       if (cur_tt == SSO_SYNC_ORDERED) {
+               /* Create unique tag based on custom event type and new grp */
+               uint32_t newtag = OCT_EVENT_TYPE_GRP_FWD << 28;
+
+               newtag |= grp << 20;
+               newtag |= tag;
+               ssows_swtag_norm(ws, newtag, SSO_SYNC_ATOMIC);
+               rte_smp_wmb();
+               ssows_swtag_wait(ws);
+       } else {
+               rte_smp_wmb();
+       }
+       ssows_add_work(ws, event_ptr, tag, new_tt, grp);
+}
+
+static force_inline void
+ssows_forward_event(struct ssows *ws, const struct rte_event *ev)
+{
+       const uint8_t grp = ev->queue_id;
+
+       /* Group hasn't changed, Use SWTAG to forward the event */
+       if (ws->cur_grp == grp)
+               ssows_fwd_swtag(ws, ev, grp);
+       else
+       /*
+        * Group has been changed for group based work pipelining,
+        * Use deschedule/add_work operation to transfer the event to
+        * new group/core
+        */
+               ssows_fwd_group(ws, ev, grp);
+}
+
+static force_inline void
+ssows_release_event(struct ssows *ws)
+{
+       if (likely(ws->cur_tt != SSO_SYNC_UNTAGGED))
+               ssows_swtag_untag(ws);
+}
+
+force_inline uint16_t __hot
+ssows_deq(void *port, struct rte_event *ev, uint64_t timeout_ticks)
+{
+       struct ssows *ws = port;
+
+       RTE_SET_USED(timeout_ticks);
+
+       ssows_swtag_wait(ws);
+       if (ws->swtag_req) {
+               ws->swtag_req = 0;
+               return 1;
+       } else {
+               return ssows_get_work(ws, ev);
+       }
+}
+
+force_inline uint16_t __hot
+ssows_deq_timeout(void *port, struct rte_event *ev, uint64_t timeout_ticks)
+{
+       struct ssows *ws = port;
+       uint64_t iter;
+       uint16_t ret = 1;
+
+       ssows_swtag_wait(ws);
+       if (ws->swtag_req) {
+               ws->swtag_req = 0;
+       } else {
+               ret = ssows_get_work(ws, ev);
+               for (iter = 1; iter < timeout_ticks && (ret == 0); iter++)
+                       ret = ssows_get_work(ws, ev);
+       }
+       return ret;
+}
+
+uint16_t __hot
+ssows_deq_burst(void *port, struct rte_event ev[], uint16_t nb_events,
+               uint64_t timeout_ticks)
+{
+       RTE_SET_USED(nb_events);
+
+       return ssows_deq(port, ev, timeout_ticks);
+}
+
+uint16_t __hot
+ssows_deq_timeout_burst(void *port, struct rte_event ev[], uint16_t nb_events,
+                       uint64_t timeout_ticks)
+{
+       RTE_SET_USED(nb_events);
+
+       return ssows_deq_timeout(port, ev, timeout_ticks);
+}
+
+force_inline uint16_t __hot
+ssows_enq(void *port, const struct rte_event *ev)
+{
+       struct ssows *ws = port;
+       uint16_t ret = 1;
+
+       switch (ev->op) {
+       case RTE_EVENT_OP_NEW:
+               ssows_new_event(ws, ev);
+               break;
+       case RTE_EVENT_OP_FORWARD:
+               ssows_forward_event(ws, ev);
+               break;
+       case RTE_EVENT_OP_RELEASE:
+               ssows_release_event(ws);
+               break;
+       default:
+               ret = 0;
+       }
+       return ret;
+}
+
+uint16_t __hot
+ssows_enq_burst(void *port, const struct rte_event ev[], uint16_t nb_events)
+{
+       RTE_SET_USED(nb_events);
+       return ssows_enq(port, ev);
+}
+
+void
+ssows_flush_events(struct ssows *ws, uint8_t queue_id)
+{
+       uint32_t reg_off;
+       uint64_t aq_cnt = 1;
+       uint64_t cq_ds_cnt = 1;
+       uint64_t enable, get_work0, get_work1;
+       uint8_t *base = octeontx_ssovf_bar(OCTEONTX_SSO_GROUP, queue_id, 0);
+
+       enable = ssovf_read64(base + SSO_VHGRP_QCTL);
+       if (!enable)
+               return;
+
+       reg_off = SSOW_VHWS_OP_GET_WORK0;
+       reg_off |= 1 << 17; /* Grouped */
+       reg_off |= 1 << 16; /* WAIT */
+       reg_off |= queue_id << 4; /* INDEX_GGRP_MASK(group number) */
+       while (aq_cnt || cq_ds_cnt) {
+               aq_cnt = ssovf_read64(base + SSO_VHGRP_AQ_CNT);
+               cq_ds_cnt = ssovf_read64(base + SSO_VHGRP_INT_CNT);
+               /* Extract cq and ds count */
+               cq_ds_cnt &= 0x1FFF1FFF0000;
+               ssovf_load_pair(get_work0, get_work1, ws->base + reg_off);
+       }
+
+       RTE_SET_USED(get_work0);
+       RTE_SET_USED(get_work1);
+}
+
+void
+ssows_reset(struct ssows *ws)
+{
+       uint64_t tag;
+       uint64_t pend_tag;
+       uint8_t pend_tt;
+       uint8_t tt;
+
+       tag = ssovf_read64(ws->base + SSOW_VHWS_TAG);
+       pend_tag = ssovf_read64(ws->base + SSOW_VHWS_PENDTAG);
+
+       if (pend_tag & (1ULL << 63)) { /* Tagswitch pending */
+               pend_tt = (pend_tag >> 32) & 0x3;
+               if (pend_tt == SSO_SYNC_ORDERED || pend_tt == SSO_SYNC_ATOMIC)
+                       ssows_desched(ws);
+       } else {
+               tt = (tag >> 32) & 0x3;
+               if (tt == SSO_SYNC_ORDERED || tt == SSO_SYNC_ATOMIC)
+                       ssows_swtag_untag(ws);
+       }
+}