1 /* SPDX-License-Identifier: BSD-3-Clause
2 * Copyright(c) 2017 Cavium, Inc
5 #include <rte_common.h>
6 #include <rte_branch_prediction.h>
8 #include <octeontx_mbox.h>
10 #include "ssovf_evdev.h"
11 #include "octeontx_rxtx.h"
14 #define OCCTX_ALIGN 128
17 #define OCCTX_FASTPATH_LOOKUP_MEM "octeontx_fastpath_lookup_mem"
19 /* WQE's ERRCODE + ERRLEV (11 bits) */
20 #define ERRCODE_ERRLEN_WIDTH 11
21 #define ERR_ARRAY_SZ ((BIT(ERRCODE_ERRLEN_WIDTH)) *\
24 #define LOOKUP_ARRAY_SZ (ERR_ARRAY_SZ)
26 #define OCCTX_EC_IP4_NOT 0x41
27 #define OCCTX_EC_IP4_CSUM 0x42
28 #define OCCTX_EC_L4_CSUM 0x62
50 static __rte_always_inline uint32_t
51 ssovf_octeontx_rx_olflags_get(const void * const lookup_mem, const uint64_t in)
53 const uint32_t * const ol_flags = (const uint32_t *)lookup_mem;
55 return ol_flags[(in & 0x7ff)];
58 static __rte_always_inline void
59 ssovf_octeontx_wqe_xtract_mseg(octtx_wqe_t *wqe,
60 struct rte_mbuf *mbuf)
62 octtx_pki_buflink_t *buflink;
63 rte_iova_t *iova_list;
65 uint64_t bytes_left = wqe->s.w1.len - wqe->s.w5.size;
67 nb_segs = wqe->s.w0.bufs;
69 buflink = (octtx_pki_buflink_t *)((uintptr_t)wqe->s.w3.addr -
70 sizeof(octtx_pki_buflink_t));
73 iova_list = (rte_iova_t *)(uintptr_t)(buflink->w1.s.addr);
74 mbuf->next = (struct rte_mbuf *)(rte_iova_t *)(iova_list - 2)
75 - (OCTTX_PACKET_LATER_SKIP / 128);
78 mbuf->data_off = sizeof(octtx_pki_buflink_t);
80 __mempool_check_cookies(mbuf->pool, (void **)&mbuf, 1, 1);
82 mbuf->data_len = bytes_left;
84 mbuf->data_len = buflink->w0.s.size;
86 bytes_left = bytes_left - buflink->w0.s.size;
87 buflink = (octtx_pki_buflink_t *)(rte_iova_t *)(iova_list - 2);
92 static __rte_always_inline struct rte_mbuf *
93 ssovf_octeontx_wqe_to_pkt(uint64_t work, uint16_t port_info,
94 const uint16_t flag, const void *lookup_mem)
96 struct rte_mbuf *mbuf;
97 octtx_wqe_t *wqe = (octtx_wqe_t *)(uintptr_t)work;
99 /* Get mbuf from wqe */
100 mbuf = (struct rte_mbuf *)((uintptr_t)wqe - OCTTX_PACKET_WQE_SKIP);
101 rte_prefetch_non_temporal(mbuf);
103 ptype_table[wqe->s.w2.lcty][wqe->s.w2.lety][wqe->s.w2.lfty];
104 mbuf->data_off = RTE_PTR_DIFF(wqe->s.w3.addr, mbuf->buf_addr);
106 mbuf->pkt_len = wqe->s.w1.len;
108 if (!!(flag & OCCTX_RX_OFFLOAD_CSUM_F))
109 mbuf->ol_flags = ssovf_octeontx_rx_olflags_get(lookup_mem,
112 if (!!(flag & OCCTX_RX_MULTI_SEG_F)) {
113 mbuf->nb_segs = wqe->s.w0.bufs;
114 mbuf->data_len = wqe->s.w5.size;
115 ssovf_octeontx_wqe_xtract_mseg(wqe, mbuf);
118 mbuf->data_len = mbuf->pkt_len;
121 if (!!(flag & OCCTX_RX_VLAN_FLTR_F)) {
122 if (likely(wqe->s.w2.vv)) {
123 mbuf->ol_flags |= PKT_RX_VLAN;
125 ntohs(*((uint16_t *)((char *)mbuf->buf_addr +
126 mbuf->data_off + wqe->s.w4.vlptr + 2)));
130 mbuf->port = rte_octeontx_pchan_map[port_info >> 4][port_info & 0xF];
131 rte_mbuf_refcnt_set(mbuf, 1);
136 static __rte_always_inline void
137 ssovf_octeontx_wqe_free(uint64_t work)
139 octtx_wqe_t *wqe = (octtx_wqe_t *)(uintptr_t)work;
140 uint8_t nb_segs = wqe->s.w0.bufs;
141 octtx_pki_buflink_t *buflink;
142 struct rte_mbuf *mbuf, *head;
143 rte_iova_t *iova_list;
145 mbuf = (struct rte_mbuf *)((uintptr_t)wqe - OCTTX_PACKET_WQE_SKIP);
146 buflink = (octtx_pki_buflink_t *)((uintptr_t)wqe->s.w3.addr -
147 sizeof(octtx_pki_buflink_t));
150 iova_list = (rte_iova_t *)(uintptr_t)(buflink->w1.s.addr);
151 mbuf = (struct rte_mbuf *)(rte_iova_t *)(iova_list - 2)
152 - (OCTTX_PACKET_LATER_SKIP / 128);
155 rte_pktmbuf_free(mbuf);
156 buflink = (octtx_pki_buflink_t *)(rte_iova_t *)(iova_list - 2);
158 rte_pktmbuf_free(head);
161 static __rte_always_inline uint16_t
162 ssows_get_work(struct ssows *ws, struct rte_event *ev, const uint16_t flag)
164 uint64_t get_work0, get_work1;
165 uint64_t sched_type_queue;
167 ssovf_load_pair(get_work0, get_work1, ws->getwork);
169 sched_type_queue = (get_work0 >> 32) & 0xfff;
170 ws->cur_tt = sched_type_queue & 0x3;
171 ws->cur_grp = sched_type_queue >> 2;
172 sched_type_queue = sched_type_queue << 38;
173 ev->event = sched_type_queue | (get_work0 & 0xffffffff);
175 if (get_work1 && ev->event_type == RTE_EVENT_TYPE_ETHDEV) {
176 ev->mbuf = ssovf_octeontx_wqe_to_pkt(get_work1,
177 (ev->event >> 20) & 0x7F, flag, ws->lookup_mem);
178 } else if (unlikely((get_work0 & 0xFFFFFFFF) == 0xFFFFFFFF)) {
179 ssovf_octeontx_wqe_free(get_work1);
188 static __rte_always_inline void
189 ssows_add_work(struct ssows *ws, const uint64_t event_ptr, const uint32_t tag,
190 const uint8_t new_tt, const uint8_t grp)
194 add_work0 = tag | ((uint64_t)(new_tt) << 32);
195 ssovf_store_pair(add_work0, event_ptr, ws->grps[grp]);
198 static __rte_always_inline void
199 ssows_swtag_full(struct ssows *ws, const uint64_t event_ptr, const uint32_t tag,
200 const uint8_t new_tt, const uint8_t grp)
202 uint64_t swtag_full0;
204 swtag_full0 = tag | ((uint64_t)(new_tt & 0x3) << 32) |
205 ((uint64_t)grp << 34);
206 ssovf_store_pair(swtag_full0, event_ptr, (ws->base +
207 SSOW_VHWS_OP_SWTAG_FULL0));
210 static __rte_always_inline void
211 ssows_swtag_desched(struct ssows *ws, uint32_t tag, uint8_t new_tt, uint8_t grp)
215 val = tag | ((uint64_t)(new_tt & 0x3) << 32) | ((uint64_t)grp << 34);
216 ssovf_write64(val, ws->base + SSOW_VHWS_OP_SWTAG_DESCHED);
219 static __rte_always_inline void
220 ssows_swtag_norm(struct ssows *ws, uint32_t tag, uint8_t new_tt)
224 val = tag | ((uint64_t)(new_tt & 0x3) << 32);
225 ssovf_write64(val, ws->base + SSOW_VHWS_OP_SWTAG_NORM);
228 static __rte_always_inline void
229 ssows_swtag_untag(struct ssows *ws)
231 ssovf_write64(0, ws->base + SSOW_VHWS_OP_SWTAG_UNTAG);
232 ws->cur_tt = SSO_SYNC_UNTAGGED;
235 static __rte_always_inline void
236 ssows_upd_wqp(struct ssows *ws, uint8_t grp, uint64_t event_ptr)
238 ssovf_store_pair((uint64_t)grp << 34, event_ptr, (ws->base +
239 SSOW_VHWS_OP_UPD_WQP_GRP0));
242 static __rte_always_inline void
243 ssows_desched(struct ssows *ws)
245 ssovf_write64(0, ws->base + SSOW_VHWS_OP_DESCHED);
248 static __rte_always_inline void
249 ssows_swtag_wait(struct ssows *ws)
251 /* Wait for the SWTAG/SWTAG_FULL operation */
252 while (ssovf_read64(ws->base + SSOW_VHWS_SWTP))