event/octeontx2: support PTP for SSO
[dpdk.git] / drivers / event / octeontx2 / otx2_worker_dual.h
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(C) 2019 Marvell International Ltd.
3  */
4
5 #ifndef __OTX2_WORKER_DUAL_H__
6 #define __OTX2_WORKER_DUAL_H__
7
8 #include <rte_branch_prediction.h>
9 #include <rte_common.h>
10
11 #include <otx2_common.h>
12 #include "otx2_evdev.h"
13
14 /* SSO Operations */
15 static __rte_always_inline uint16_t
16 otx2_ssogws_dual_get_work(struct otx2_ssogws_state *ws,
17                           struct otx2_ssogws_state *ws_pair,
18                           struct rte_event *ev, const uint32_t flags,
19                           const void * const lookup_mem,
20                           struct otx2_timesync_info * const tstamp)
21 {
22         const uint64_t set_gw = BIT_ULL(16) | 1;
23         union otx2_sso_event event;
24         uint64_t get_work1;
25         uint64_t mbuf;
26
27         if (flags & NIX_RX_OFFLOAD_PTYPE_F)
28                 rte_prefetch_non_temporal(lookup_mem);
29 #ifdef RTE_ARCH_ARM64
30         asm volatile(
31                         "        ldr %[tag], [%[tag_loc]]    \n"
32                         "        ldr %[wqp], [%[wqp_loc]]    \n"
33                         "        tbz %[tag], 63, done%=      \n"
34                         "        sevl                        \n"
35                         "rty%=:  wfe                         \n"
36                         "        ldr %[tag], [%[tag_loc]]    \n"
37                         "        ldr %[wqp], [%[wqp_loc]]    \n"
38                         "        tbnz %[tag], 63, rty%=      \n"
39                         "done%=: str %[gw], [%[pong]]        \n"
40                         "        dmb ld                      \n"
41                         "        prfm pldl1keep, [%[wqp], #8]\n"
42                         "        sub %[mbuf], %[wqp], #0x80  \n"
43                         "        prfm pldl1keep, [%[mbuf]]   \n"
44                         : [tag] "=&r" (event.get_work0),
45                           [wqp] "=&r" (get_work1),
46                           [mbuf] "=&r" (mbuf)
47                         : [tag_loc] "r" (ws->tag_op),
48                           [wqp_loc] "r" (ws->wqp_op),
49                           [gw] "r" (set_gw),
50                           [pong] "r" (ws_pair->getwrk_op)
51                         );
52 #else
53         event.get_work0 = otx2_read64(ws->tag_op);
54         while ((BIT_ULL(63)) & event.get_work0)
55                 event.get_work0 = otx2_read64(ws->tag_op);
56         get_work1 = otx2_read64(ws->wqp_op);
57         otx2_write64(set_gw, ws_pair->getwrk_op);
58
59         rte_prefetch0((const void *)get_work1);
60         mbuf = (uint64_t)((char *)get_work1 - sizeof(struct rte_mbuf));
61         rte_prefetch0((const void *)mbuf);
62 #endif
63         event.get_work0 = (event.get_work0 & (0x3ull << 32)) << 6 |
64                 (event.get_work0 & (0x3FFull << 36)) << 4 |
65                 (event.get_work0 & 0xffffffff);
66         ws->cur_tt = event.sched_type;
67         ws->cur_grp = event.queue_id;
68
69         if (event.sched_type != SSO_TT_EMPTY &&
70             event.event_type == RTE_EVENT_TYPE_ETHDEV) {
71                 otx2_wqe_to_mbuf(get_work1, mbuf, event.sub_event_type,
72                                  (uint32_t) event.get_work0, flags, lookup_mem);
73                 /* Extracting tstamp, if PTP enabled*/
74                 otx2_nix_mbuf_to_tstamp((struct rte_mbuf *)mbuf, tstamp, flags);
75                 get_work1 = mbuf;
76         }
77
78         ev->event = event.get_work0;
79         ev->u64 = get_work1;
80
81         return !!get_work1;
82 }
83
84 static __rte_always_inline void
85 otx2_ssogws_dual_add_work(struct otx2_ssogws_dual *ws, const uint64_t event_ptr,
86                           const uint32_t tag, const uint8_t new_tt,
87                           const uint16_t grp)
88 {
89         uint64_t add_work0;
90
91         add_work0 = tag | ((uint64_t)(new_tt) << 32);
92         otx2_store_pair(add_work0, event_ptr, ws->grps_base[grp]);
93 }
94
95 #endif