1 /* SPDX-License-Identifier: BSD-3-Clause 2 * Copyright(c) 2017 Cavium, Inc 3 */ 4 5 #include "ssovf_worker.h" 6 7 static __rte_always_inline void 8 ssows_new_event(struct ssows *ws, const struct rte_event *ev) 9 { 10 const uint64_t event_ptr = ev->u64; 11 const uint32_t tag = (uint32_t)ev->event; 12 const uint8_t new_tt = ev->sched_type; 13 const uint8_t grp = ev->queue_id; 14 15 ssows_add_work(ws, event_ptr, tag, new_tt, grp); 16 } 17 18 static __rte_always_inline void 19 ssows_fwd_swtag(struct ssows *ws, const struct rte_event *ev, const uint8_t grp) 20 { 21 const uint8_t cur_tt = ws->cur_tt; 22 const uint8_t new_tt = ev->sched_type; 23 const uint32_t tag = (uint32_t)ev->event; 24 /* 25 * cur_tt/new_tt SSO_SYNC_ORDERED SSO_SYNC_ATOMIC SSO_SYNC_UNTAGGED 26 * 27 * SSO_SYNC_ORDERED norm norm untag 28 * SSO_SYNC_ATOMIC norm norm untag 29 * SSO_SYNC_UNTAGGED full full NOOP 30 */ 31 if (unlikely(cur_tt == SSO_SYNC_UNTAGGED)) { 32 if (new_tt != SSO_SYNC_UNTAGGED) { 33 ssows_swtag_full(ws, ev->u64, tag, 34 new_tt, grp); 35 } 36 } else { 37 if (likely(new_tt != SSO_SYNC_UNTAGGED)) 38 ssows_swtag_norm(ws, tag, new_tt); 39 else 40 ssows_swtag_untag(ws); 41 } 42 ws->swtag_req = 1; 43 } 44 45 #define OCT_EVENT_TYPE_GRP_FWD (RTE_EVENT_TYPE_MAX - 1) 46 47 static __rte_always_inline void 48 ssows_fwd_group(struct ssows *ws, const struct rte_event *ev, const uint8_t grp) 49 { 50 const uint64_t event_ptr = ev->u64; 51 const uint32_t tag = (uint32_t)ev->event; 52 const uint8_t cur_tt = ws->cur_tt; 53 const uint8_t new_tt = ev->sched_type; 54 55 if (cur_tt == SSO_SYNC_ORDERED) { 56 /* Create unique tag based on custom event type and new grp */ 57 uint32_t newtag = OCT_EVENT_TYPE_GRP_FWD << 28; 58 59 newtag |= grp << 20; 60 newtag |= tag; 61 ssows_swtag_norm(ws, newtag, SSO_SYNC_ATOMIC); 62 rte_smp_wmb(); 63 ssows_swtag_wait(ws); 64 } else { 65 rte_smp_wmb(); 66 } 67 ssows_add_work(ws, event_ptr, tag, new_tt, grp); 68 } 69 70 static __rte_always_inline void 71 ssows_forward_event(struct ssows *ws, const struct rte_event *ev) 72 { 73 const uint8_t grp = ev->queue_id; 74 75 /* Group hasn't changed, Use SWTAG to forward the event */ 76 if (ws->cur_grp == grp) 77 ssows_fwd_swtag(ws, ev, grp); 78 else 79 /* 80 * Group has been changed for group based work pipelining, 81 * Use deschedule/add_work operation to transfer the event to 82 * new group/core 83 */ 84 ssows_fwd_group(ws, ev, grp); 85 } 86 87 static __rte_always_inline void 88 ssows_release_event(struct ssows *ws) 89 { 90 if (likely(ws->cur_tt != SSO_SYNC_UNTAGGED)) 91 ssows_swtag_untag(ws); 92 } 93 94 #define R(name, f2, f1, f0, flags) \ 95 static uint16_t __rte_noinline __rte_hot \ 96 ssows_deq_ ##name(void *port, struct rte_event *ev, uint64_t timeout_ticks) \ 97 { \ 98 struct ssows *ws = port; \ 99 \ 100 RTE_SET_USED(timeout_ticks); \ 101 \ 102 if (ws->swtag_req) { \ 103 ws->swtag_req = 0; \ 104 ssows_swtag_wait(ws); \ 105 return 1; \ 106 } else { \ 107 return ssows_get_work(ws, ev, flags); \ 108 } \ 109 } \ 110 \ 111 static uint16_t __rte_hot \ 112 ssows_deq_burst_ ##name(void *port, struct rte_event ev[], \ 113 uint16_t nb_events, uint64_t timeout_ticks) \ 114 { \ 115 RTE_SET_USED(nb_events); \ 116 \ 117 return ssows_deq_ ##name(port, ev, timeout_ticks); \ 118 } \ 119 \ 120 static uint16_t __rte_hot \ 121 ssows_deq_timeout_ ##name(void *port, struct rte_event *ev, \ 122 uint64_t timeout_ticks) \ 123 { \ 124 struct ssows *ws = port; \ 125 uint64_t iter; \ 126 uint16_t ret = 1; \ 127 \ 128 if (ws->swtag_req) { \ 129 ws->swtag_req = 0; \ 130 ssows_swtag_wait(ws); \ 131 } else { \ 132 ret = ssows_get_work(ws, ev, flags); \ 133 for (iter = 1; iter < timeout_ticks && (ret == 0); iter++) \ 134 ret = ssows_get_work(ws, ev, flags); \ 135 } \ 136 return ret; \ 137 } \ 138 \ 139 static uint16_t __rte_hot \ 140 ssows_deq_timeout_burst_ ##name(void *port, struct rte_event ev[], \ 141 uint16_t nb_events, uint64_t timeout_ticks) \ 142 { \ 143 RTE_SET_USED(nb_events); \ 144 \ 145 return ssows_deq_timeout_ ##name(port, ev, timeout_ticks); \ 146 } 147 148 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC 149 #undef R 150 151 __rte_always_inline uint16_t __rte_hot 152 ssows_enq(void *port, const struct rte_event *ev) 153 { 154 struct ssows *ws = port; 155 uint16_t ret = 1; 156 157 switch (ev->op) { 158 case RTE_EVENT_OP_NEW: 159 rte_smp_wmb(); 160 ssows_new_event(ws, ev); 161 break; 162 case RTE_EVENT_OP_FORWARD: 163 ssows_forward_event(ws, ev); 164 break; 165 case RTE_EVENT_OP_RELEASE: 166 ssows_release_event(ws); 167 break; 168 default: 169 ret = 0; 170 } 171 return ret; 172 } 173 174 uint16_t __rte_hot 175 ssows_enq_burst(void *port, const struct rte_event ev[], uint16_t nb_events) 176 { 177 RTE_SET_USED(nb_events); 178 return ssows_enq(port, ev); 179 } 180 181 uint16_t __rte_hot 182 ssows_enq_new_burst(void *port, const struct rte_event ev[], uint16_t nb_events) 183 { 184 uint16_t i; 185 struct ssows *ws = port; 186 187 rte_smp_wmb(); 188 for (i = 0; i < nb_events; i++) 189 ssows_new_event(ws, &ev[i]); 190 191 return nb_events; 192 } 193 194 uint16_t __rte_hot 195 ssows_enq_fwd_burst(void *port, const struct rte_event ev[], uint16_t nb_events) 196 { 197 struct ssows *ws = port; 198 RTE_SET_USED(nb_events); 199 200 ssows_forward_event(ws, ev); 201 202 return 1; 203 } 204 205 void 206 ssows_flush_events(struct ssows *ws, uint8_t queue_id, 207 ssows_handle_event_t fn, void *arg) 208 { 209 uint32_t reg_off; 210 struct rte_event ev; 211 uint64_t enable, aq_cnt = 1, cq_ds_cnt = 1; 212 uint64_t get_work0, get_work1; 213 uint64_t sched_type_queue; 214 uint8_t *base = ssovf_bar(OCTEONTX_SSO_GROUP, queue_id, 0); 215 216 enable = ssovf_read64(base + SSO_VHGRP_QCTL); 217 if (!enable) 218 return; 219 220 reg_off = SSOW_VHWS_OP_GET_WORK0; 221 reg_off |= 1 << 17; /* Grouped */ 222 reg_off |= 1 << 16; /* WAIT */ 223 reg_off |= queue_id << 4; /* INDEX_GGRP_MASK(group number) */ 224 while (aq_cnt || cq_ds_cnt) { 225 aq_cnt = ssovf_read64(base + SSO_VHGRP_AQ_CNT); 226 cq_ds_cnt = ssovf_read64(base + SSO_VHGRP_INT_CNT); 227 /* Extract cq and ds count */ 228 cq_ds_cnt &= 0x1FFF1FFF0000; 229 230 ssovf_load_pair(get_work0, get_work1, ws->base + reg_off); 231 232 sched_type_queue = (get_work0 >> 32) & 0xfff; 233 ws->cur_tt = sched_type_queue & 0x3; 234 ws->cur_grp = sched_type_queue >> 2; 235 sched_type_queue = sched_type_queue << 38; 236 ev.event = sched_type_queue | (get_work0 & 0xffffffff); 237 if (get_work1 && ev.event_type == RTE_EVENT_TYPE_ETHDEV) 238 ev.mbuf = ssovf_octeontx_wqe_to_pkt(get_work1, 239 (ev.event >> 20) & 0x7F, 240 OCCTX_RX_OFFLOAD_NONE | 241 OCCTX_RX_MULTI_SEG_F, 242 ws->lookup_mem); 243 else 244 ev.u64 = get_work1; 245 246 if (fn != NULL && ev.u64 != 0) 247 fn(arg, ev); 248 } 249 } 250 251 void 252 ssows_reset(struct ssows *ws) 253 { 254 uint64_t tag; 255 uint64_t pend_tag; 256 uint8_t pend_tt; 257 uint8_t tt; 258 259 tag = ssovf_read64(ws->base + SSOW_VHWS_TAG); 260 pend_tag = ssovf_read64(ws->base + SSOW_VHWS_PENDTAG); 261 262 if (pend_tag & (1ULL << 63)) { /* Tagswitch pending */ 263 pend_tt = (pend_tag >> 32) & 0x3; 264 if (pend_tt == SSO_SYNC_ORDERED || pend_tt == SSO_SYNC_ATOMIC) 265 ssows_desched(ws); 266 } else { 267 tt = (tag >> 32) & 0x3; 268 if (tt == SSO_SYNC_ORDERED || tt == SSO_SYNC_ATOMIC) 269 ssows_swtag_untag(ws); 270 } 271 } 272 273 static __rte_always_inline uint16_t 274 __sso_event_tx_adapter_enqueue(void *port, struct rte_event ev[], 275 uint16_t nb_events, uint64_t *cmd, 276 const uint16_t flag) 277 { 278 uint16_t port_id; 279 uint16_t queue_id; 280 struct rte_mbuf *m; 281 struct rte_eth_dev *ethdev; 282 struct ssows *ws = port; 283 struct octeontx_txq *txq; 284 285 RTE_SET_USED(nb_events); 286 switch (ev->sched_type) { 287 case SSO_SYNC_ORDERED: 288 ssows_swtag_norm(ws, ev->event, SSO_SYNC_ATOMIC); 289 rte_io_wmb(); 290 ssows_swtag_wait(ws); 291 break; 292 case SSO_SYNC_UNTAGGED: 293 ssows_swtag_full(ws, ev->u64, ev->event, SSO_SYNC_ATOMIC, 294 ev->queue_id); 295 rte_io_wmb(); 296 ssows_swtag_wait(ws); 297 break; 298 case SSO_SYNC_ATOMIC: 299 rte_io_wmb(); 300 break; 301 } 302 303 m = ev[0].mbuf; 304 port_id = m->port; 305 queue_id = rte_event_eth_tx_adapter_txq_get(m); 306 ethdev = &rte_eth_devices[port_id]; 307 txq = ethdev->data->tx_queues[queue_id]; 308 309 return __octeontx_xmit_pkts(txq, &m, 1, cmd, flag); 310 } 311 312 #define T(name, f3, f2, f1, f0, sz, flags) \ 313 static uint16_t __rte_noinline __rte_hot \ 314 sso_event_tx_adapter_enqueue_ ## name(void *port, struct rte_event ev[], \ 315 uint16_t nb_events) \ 316 { \ 317 uint64_t cmd[sz]; \ 318 return __sso_event_tx_adapter_enqueue(port, ev, nb_events, cmd, \ 319 flags); \ 320 } 321 322 SSO_TX_ADPTR_ENQ_FASTPATH_FUNC 323 #undef T 324 325 void 326 ssovf_fastpath_fns_set(struct rte_eventdev *dev) 327 { 328 struct ssovf_evdev *edev = ssovf_pmd_priv(dev); 329 330 dev->enqueue = ssows_enq; 331 dev->enqueue_burst = ssows_enq_burst; 332 dev->enqueue_new_burst = ssows_enq_new_burst; 333 dev->enqueue_forward_burst = ssows_enq_fwd_burst; 334 335 const event_tx_adapter_enqueue ssow_txa_enqueue[2][2][2][2] = { 336 #define T(name, f3, f2, f1, f0, sz, flags) \ 337 [f3][f2][f1][f0] = sso_event_tx_adapter_enqueue_ ##name, 338 339 SSO_TX_ADPTR_ENQ_FASTPATH_FUNC 340 #undef T 341 }; 342 343 dev->txa_enqueue = ssow_txa_enqueue 344 [!!(edev->tx_offload_flags & OCCTX_TX_OFFLOAD_MBUF_NOFF_F)] 345 [!!(edev->tx_offload_flags & OCCTX_TX_OFFLOAD_OL3_OL4_CSUM_F)] 346 [!!(edev->tx_offload_flags & OCCTX_TX_OFFLOAD_L3_L4_CSUM_F)] 347 [!!(edev->tx_offload_flags & OCCTX_TX_MULTI_SEG_F)]; 348 349 dev->txa_enqueue_same_dest = dev->txa_enqueue; 350 351 /* Assigning dequeue func pointers */ 352 const event_dequeue_t ssow_deq[2][2][2] = { 353 #define R(name, f2, f1, f0, flags) \ 354 [f2][f1][f0] = ssows_deq_ ##name, 355 356 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC 357 #undef R 358 }; 359 360 dev->dequeue = ssow_deq 361 [!!(edev->rx_offload_flags & OCCTX_RX_VLAN_FLTR_F)] 362 [!!(edev->rx_offload_flags & OCCTX_RX_OFFLOAD_CSUM_F)] 363 [!!(edev->rx_offload_flags & OCCTX_RX_MULTI_SEG_F)]; 364 365 const event_dequeue_burst_t ssow_deq_burst[2][2][2] = { 366 #define R(name, f2, f1, f0, flags) \ 367 [f2][f1][f0] = ssows_deq_burst_ ##name, 368 369 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC 370 #undef R 371 }; 372 373 dev->dequeue_burst = ssow_deq_burst 374 [!!(edev->rx_offload_flags & OCCTX_RX_VLAN_FLTR_F)] 375 [!!(edev->rx_offload_flags & OCCTX_RX_OFFLOAD_CSUM_F)] 376 [!!(edev->rx_offload_flags & OCCTX_RX_MULTI_SEG_F)]; 377 378 if (edev->is_timeout_deq) { 379 const event_dequeue_t ssow_deq_timeout[2][2][2] = { 380 #define R(name, f2, f1, f0, flags) \ 381 [f2][f1][f0] = ssows_deq_timeout_ ##name, 382 383 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC 384 #undef R 385 }; 386 387 dev->dequeue = ssow_deq_timeout 388 [!!(edev->rx_offload_flags & OCCTX_RX_VLAN_FLTR_F)] 389 [!!(edev->rx_offload_flags & OCCTX_RX_OFFLOAD_CSUM_F)] 390 [!!(edev->rx_offload_flags & OCCTX_RX_MULTI_SEG_F)]; 391 392 const event_dequeue_burst_t ssow_deq_timeout_burst[2][2][2] = { 393 #define R(name, f2, f1, f0, flags) \ 394 [f2][f1][f0] = ssows_deq_timeout_burst_ ##name, 395 396 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC 397 #undef R 398 }; 399 400 dev->dequeue_burst = ssow_deq_timeout_burst 401 [!!(edev->rx_offload_flags & OCCTX_RX_VLAN_FLTR_F)] 402 [!!(edev->rx_offload_flags & OCCTX_RX_OFFLOAD_CSUM_F)] 403 [!!(edev->rx_offload_flags & OCCTX_RX_MULTI_SEG_F)]; 404 } 405 } 406 407 static void 408 octeontx_create_rx_ol_flags_array(void *mem) 409 { 410 uint16_t idx, errcode, errlev; 411 uint32_t val, *ol_flags; 412 413 /* Skip ptype array memory */ 414 ol_flags = (uint32_t *)mem; 415 416 for (idx = 0; idx < BIT(ERRCODE_ERRLEN_WIDTH); idx++) { 417 errcode = idx & 0xff; 418 errlev = (idx & 0x700) >> 8; 419 420 val = PKT_RX_IP_CKSUM_UNKNOWN; 421 val |= PKT_RX_L4_CKSUM_UNKNOWN; 422 val |= PKT_RX_OUTER_L4_CKSUM_UNKNOWN; 423 424 switch (errlev) { 425 case OCCTX_ERRLEV_RE: 426 if (errcode) { 427 val |= PKT_RX_IP_CKSUM_BAD; 428 val |= PKT_RX_L4_CKSUM_BAD; 429 } else { 430 val |= PKT_RX_IP_CKSUM_GOOD; 431 val |= PKT_RX_L4_CKSUM_GOOD; 432 } 433 break; 434 case OCCTX_ERRLEV_LC: 435 if (errcode == OCCTX_EC_IP4_CSUM) { 436 val |= PKT_RX_IP_CKSUM_BAD; 437 val |= PKT_RX_EIP_CKSUM_BAD; 438 } else { 439 val |= PKT_RX_IP_CKSUM_GOOD; 440 } 441 break; 442 case OCCTX_ERRLEV_LD: 443 /* Check if parsed packet is neither IPv4 or IPV6 */ 444 if (errcode == OCCTX_EC_IP4_NOT) 445 break; 446 val |= PKT_RX_IP_CKSUM_GOOD; 447 if (errcode == OCCTX_EC_L4_CSUM) 448 val |= PKT_RX_OUTER_L4_CKSUM_BAD; 449 else 450 val |= PKT_RX_L4_CKSUM_GOOD; 451 break; 452 case OCCTX_ERRLEV_LE: 453 if (errcode == OCCTX_EC_IP4_CSUM) 454 val |= PKT_RX_IP_CKSUM_BAD; 455 else 456 val |= PKT_RX_IP_CKSUM_GOOD; 457 break; 458 case OCCTX_ERRLEV_LF: 459 /* Check if parsed packet is neither IPv4 or IPV6 */ 460 if (errcode == OCCTX_EC_IP4_NOT) 461 break; 462 val |= PKT_RX_IP_CKSUM_GOOD; 463 if (errcode == OCCTX_EC_L4_CSUM) 464 val |= PKT_RX_L4_CKSUM_BAD; 465 else 466 val |= PKT_RX_L4_CKSUM_GOOD; 467 break; 468 } 469 470 ol_flags[idx] = val; 471 } 472 } 473 474 void * 475 octeontx_fastpath_lookup_mem_get(void) 476 { 477 const char name[] = OCCTX_FASTPATH_LOOKUP_MEM; 478 const struct rte_memzone *mz; 479 void *mem; 480 481 mz = rte_memzone_lookup(name); 482 if (mz != NULL) 483 return mz->addr; 484 485 /* Request for the first time */ 486 mz = rte_memzone_reserve_aligned(name, LOOKUP_ARRAY_SZ, 487 SOCKET_ID_ANY, 0, OCCTX_ALIGN); 488 if (mz != NULL) { 489 mem = mz->addr; 490 /* Form the rx ol_flags based on errcode */ 491 octeontx_create_rx_ol_flags_array(mem); 492 return mem; 493 } 494 return NULL; 495 } 496