drivers/event/octeontx2/otx2_tim_evdev.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(C) 2019 Marvell International Ltd.
   3  */
   4
   5 #include <rte_kvargs.h>
   6 #include <rte_malloc.h>
   7 #include <rte_mbuf_pool_ops.h>
   8
   9 #include "otx2_evdev.h"
  10 #include "otx2_tim_evdev.h"
  11
  12 static struct rte_event_timer_adapter_ops otx2_tim_ops;
  13
  14 static inline int
  15 tim_get_msix_offsets(void)
  16 {
  17         struct otx2_tim_evdev *dev = tim_priv_get();
  18         struct otx2_mbox *mbox = dev->mbox;
  19         struct msix_offset_rsp *msix_rsp;
  20         int i, rc;
  21
  22         /* Get TIM MSIX vector offsets */
  23         otx2_mbox_alloc_msg_msix_offset(mbox);
  24         rc = otx2_mbox_process_msg(mbox, (void *)&msix_rsp);
  25
  26         for (i = 0; i < dev->nb_rings; i++)
  27                 dev->tim_msixoff[i] = msix_rsp->timlf_msixoff[i];
  28
  29         return rc;
  30 }
  31
  32 static void
  33 tim_set_fp_ops(struct otx2_tim_ring *tim_ring)
  34 {
  35         uint8_t prod_flag = !tim_ring->prod_type_sp;
  36
  37         /* [DFB/FB] [SP][MP]*/
  38         const rte_event_timer_arm_burst_t arm_burst[2][2][2] = {
  39 #define FP(_name, _f3, _f2, _f1, flags)                                        \
  40         [_f3][_f2][_f1] = otx2_tim_arm_burst_##_name,
  41                 TIM_ARM_FASTPATH_MODES
  42 #undef FP
  43         };
  44
  45         const rte_event_timer_arm_tmo_tick_burst_t arm_tmo_burst[2][2] = {
  46 #define FP(_name, _f2, _f1, flags)                                             \
  47         [_f2][_f1] = otx2_tim_arm_tmo_tick_burst_##_name,
  48                 TIM_ARM_TMO_FASTPATH_MODES
  49 #undef FP
  50         };
  51
  52         otx2_tim_ops.arm_burst =
  53                 arm_burst[tim_ring->enable_stats][tim_ring->ena_dfb][prod_flag];
  54         otx2_tim_ops.arm_tmo_tick_burst =
  55                 arm_tmo_burst[tim_ring->enable_stats][tim_ring->ena_dfb];
  56         otx2_tim_ops.cancel_burst = otx2_tim_timer_cancel_burst;
  57 }
  58
  59 static void
  60 otx2_tim_ring_info_get(const struct rte_event_timer_adapter *adptr,
  61                        struct rte_event_timer_adapter_info *adptr_info)
  62 {
  63         struct otx2_tim_ring *tim_ring = adptr->data->adapter_priv;
  64
  65         adptr_info->max_tmo_ns = tim_ring->max_tout;
  66         adptr_info->min_resolution_ns = tim_ring->ena_periodic ?
  67                 tim_ring->max_tout : tim_ring->tck_nsec;
  68         rte_memcpy(&adptr_info->conf, &adptr->data->conf,
  69                    sizeof(struct rte_event_timer_adapter_conf));
  70 }
  71
  72 static int
  73 tim_chnk_pool_create(struct otx2_tim_ring *tim_ring,
  74                      struct rte_event_timer_adapter_conf *rcfg)
  75 {
  76         unsigned int cache_sz = (tim_ring->nb_chunks / 1.5);
  77         unsigned int mp_flags = 0;
  78         char pool_name[25];
  79         int rc;
  80
  81         cache_sz /= rte_lcore_count();
  82         /* Create chunk pool. */
  83         if (rcfg->flags & RTE_EVENT_TIMER_ADAPTER_F_SP_PUT) {
  84                 mp_flags = MEMPOOL_F_SP_PUT | MEMPOOL_F_SC_GET;
  85                 otx2_tim_dbg("Using single producer mode");
  86                 tim_ring->prod_type_sp = true;
  87         }
  88
  89         snprintf(pool_name, sizeof(pool_name), "otx2_tim_chunk_pool%d",
  90                  tim_ring->ring_id);
  91
  92         if (cache_sz > RTE_MEMPOOL_CACHE_MAX_SIZE)
  93                 cache_sz = RTE_MEMPOOL_CACHE_MAX_SIZE;
  94
  95         cache_sz = cache_sz != 0 ? cache_sz : 2;
  96         tim_ring->nb_chunks += (cache_sz * rte_lcore_count());
  97         if (!tim_ring->disable_npa) {
  98                 tim_ring->chunk_pool = rte_mempool_create_empty(pool_name,
  99                                 tim_ring->nb_chunks, tim_ring->chunk_sz,
 100                                 cache_sz, 0, rte_socket_id(), mp_flags);
 101
 102                 if (tim_ring->chunk_pool == NULL) {
 103                         otx2_err("Unable to create chunkpool.");
 104                         return -ENOMEM;
 105                 }
 106
 107                 rc = rte_mempool_set_ops_byname(tim_ring->chunk_pool,
 108                                                 rte_mbuf_platform_mempool_ops(),
 109                                                 NULL);
 110                 if (rc < 0) {
 111                         otx2_err("Unable to set chunkpool ops");
 112                         goto free;
 113                 }
 114
 115                 rc = rte_mempool_populate_default(tim_ring->chunk_pool);
 116                 if (rc < 0) {
 117                         otx2_err("Unable to set populate chunkpool.");
 118                         goto free;
 119                 }
 120                 tim_ring->aura = npa_lf_aura_handle_to_aura(
 121                                 tim_ring->chunk_pool->pool_id);
 122                 tim_ring->ena_dfb = tim_ring->ena_periodic ? 1 : 0;
 123         } else {
 124                 tim_ring->chunk_pool = rte_mempool_create(pool_name,
 125                                 tim_ring->nb_chunks, tim_ring->chunk_sz,
 126                                 cache_sz, 0, NULL, NULL, NULL, NULL,
 127                                 rte_socket_id(),
 128                                 mp_flags);
 129                 if (tim_ring->chunk_pool == NULL) {
 130                         otx2_err("Unable to create chunkpool.");
 131                         return -ENOMEM;
 132                 }
 133                 tim_ring->ena_dfb = 1;
 134         }
 135
 136         return 0;
 137
 138 free:
 139         rte_mempool_free(tim_ring->chunk_pool);
 140         return rc;
 141 }
 142
 143 static void
 144 tim_err_desc(int rc)
 145 {
 146         switch (rc) {
 147         case TIM_AF_NO_RINGS_LEFT:
 148                 otx2_err("Unable to allocat new TIM ring.");
 149                 break;
 150         case TIM_AF_INVALID_NPA_PF_FUNC:
 151                 otx2_err("Invalid NPA pf func.");
 152                 break;
 153         case TIM_AF_INVALID_SSO_PF_FUNC:
 154                 otx2_err("Invalid SSO pf func.");
 155                 break;
 156         case TIM_AF_RING_STILL_RUNNING:
 157                 otx2_tim_dbg("Ring busy.");
 158                 break;
 159         case TIM_AF_LF_INVALID:
 160                 otx2_err("Invalid Ring id.");
 161                 break;
 162         case TIM_AF_CSIZE_NOT_ALIGNED:
 163                 otx2_err("Chunk size specified needs to be multiple of 16.");
 164                 break;
 165         case TIM_AF_CSIZE_TOO_SMALL:
 166                 otx2_err("Chunk size too small.");
 167                 break;
 168         case TIM_AF_CSIZE_TOO_BIG:
 169                 otx2_err("Chunk size too big.");
 170                 break;
 171         case TIM_AF_INTERVAL_TOO_SMALL:
 172                 otx2_err("Bucket traversal interval too small.");
 173                 break;
 174         case TIM_AF_INVALID_BIG_ENDIAN_VALUE:
 175                 otx2_err("Invalid Big endian value.");
 176                 break;
 177         case TIM_AF_INVALID_CLOCK_SOURCE:
 178                 otx2_err("Invalid Clock source specified.");
 179                 break;
 180         case TIM_AF_GPIO_CLK_SRC_NOT_ENABLED:
 181                 otx2_err("GPIO clock source not enabled.");
 182                 break;
 183         case TIM_AF_INVALID_BSIZE:
 184                 otx2_err("Invalid bucket size.");
 185                 break;
 186         case TIM_AF_INVALID_ENABLE_PERIODIC:
 187                 otx2_err("Invalid bucket size.");
 188                 break;
 189         case TIM_AF_INVALID_ENABLE_DONTFREE:
 190                 otx2_err("Invalid Don't free value.");
 191                 break;
 192         case TIM_AF_ENA_DONTFRE_NSET_PERIODIC:
 193                 otx2_err("Don't free bit not set when periodic is enabled.");
 194                 break;
 195         case TIM_AF_RING_ALREADY_DISABLED:
 196                 otx2_err("Ring already stopped");
 197                 break;
 198         default:
 199                 otx2_err("Unknown Error.");
 200         }
 201 }
 202
 203 static int
 204 otx2_tim_ring_create(struct rte_event_timer_adapter *adptr)
 205 {
 206         struct rte_event_timer_adapter_conf *rcfg = &adptr->data->conf;
 207         struct otx2_tim_evdev *dev = tim_priv_get();
 208         struct otx2_tim_ring *tim_ring;
 209         struct tim_config_req *cfg_req;
 210         struct tim_ring_req *free_req;
 211         struct tim_lf_alloc_req *req;
 212         struct tim_lf_alloc_rsp *rsp;
 213         uint8_t is_periodic;
 214         int i, rc;
 215
 216         if (dev == NULL)
 217                 return -ENODEV;
 218
 219         if (adptr->data->id >= dev->nb_rings)
 220                 return -ENODEV;
 221
 222         req = otx2_mbox_alloc_msg_tim_lf_alloc(dev->mbox);
 223         req->npa_pf_func = otx2_npa_pf_func_get();
 224         req->sso_pf_func = otx2_sso_pf_func_get();
 225         req->ring = adptr->data->id;
 226
 227         rc = otx2_mbox_process_msg(dev->mbox, (void **)&rsp);
 228         if (rc < 0) {
 229                 tim_err_desc(rc);
 230                 return -ENODEV;
 231         }
 232
 233         if (NSEC2TICK(RTE_ALIGN_MUL_CEIL(rcfg->timer_tick_ns, 10),
 234                       rsp->tenns_clk) < OTX2_TIM_MIN_TMO_TKS) {
 235                 if (rcfg->flags & RTE_EVENT_TIMER_ADAPTER_F_ADJUST_RES)
 236                         rcfg->timer_tick_ns = TICK2NSEC(OTX2_TIM_MIN_TMO_TKS,
 237                                         rsp->tenns_clk);
 238                 else {
 239                         rc = -ERANGE;
 240                         goto rng_mem_err;
 241                 }
 242         }
 243
 244         is_periodic = 0;
 245         if (rcfg->flags & RTE_EVENT_TIMER_ADAPTER_F_PERIODIC) {
 246                 if (rcfg->max_tmo_ns &&
 247                     rcfg->max_tmo_ns != rcfg->timer_tick_ns) {
 248                         rc = -ERANGE;
 249                         goto rng_mem_err;
 250                 }
 251
 252                 /* Use 2 buckets to avoid contention */
 253                 rcfg->max_tmo_ns = rcfg->timer_tick_ns;
 254                 rcfg->timer_tick_ns /= 2;
 255                 is_periodic = 1;
 256         }
 257
 258         tim_ring = rte_zmalloc("otx2_tim_prv", sizeof(struct otx2_tim_ring), 0);
 259         if (tim_ring == NULL) {
 260                 rc =  -ENOMEM;
 261                 goto rng_mem_err;
 262         }
 263
 264         adptr->data->adapter_priv = tim_ring;
 265
 266         tim_ring->tenns_clk_freq = rsp->tenns_clk;
 267         tim_ring->clk_src = (int)rcfg->clk_src;
 268         tim_ring->ring_id = adptr->data->id;
 269         tim_ring->tck_nsec = RTE_ALIGN_MUL_CEIL(rcfg->timer_tick_ns, 10);
 270         tim_ring->max_tout = is_periodic ?
 271                 rcfg->timer_tick_ns * 2 : rcfg->max_tmo_ns;
 272         tim_ring->nb_bkts = (tim_ring->max_tout / tim_ring->tck_nsec);
 273         tim_ring->chunk_sz = dev->chunk_sz;
 274         tim_ring->nb_timers = rcfg->nb_timers;
 275         tim_ring->disable_npa = dev->disable_npa;
 276         tim_ring->ena_periodic = is_periodic;
 277         tim_ring->enable_stats = dev->enable_stats;
 278
 279         for (i = 0; i < dev->ring_ctl_cnt ; i++) {
 280                 struct otx2_tim_ctl *ring_ctl = &dev->ring_ctl_data[i];
 281
 282                 if (ring_ctl->ring == tim_ring->ring_id) {
 283                         tim_ring->chunk_sz = ring_ctl->chunk_slots ?
 284                                 ((uint32_t)(ring_ctl->chunk_slots + 1) *
 285                                  OTX2_TIM_CHUNK_ALIGNMENT) : tim_ring->chunk_sz;
 286                         tim_ring->enable_stats = ring_ctl->enable_stats;
 287                         tim_ring->disable_npa = ring_ctl->disable_npa;
 288                 }
 289         }
 290
 291         if (tim_ring->disable_npa) {
 292                 tim_ring->nb_chunks =
 293                         tim_ring->nb_timers /
 294                         OTX2_TIM_NB_CHUNK_SLOTS(tim_ring->chunk_sz);
 295                 tim_ring->nb_chunks = tim_ring->nb_chunks * tim_ring->nb_bkts;
 296         } else {
 297                 tim_ring->nb_chunks = tim_ring->nb_timers;
 298         }
 299         tim_ring->nb_chunk_slots = OTX2_TIM_NB_CHUNK_SLOTS(tim_ring->chunk_sz);
 300         tim_ring->bkt = rte_zmalloc("otx2_tim_bucket", (tim_ring->nb_bkts) *
 301                                     sizeof(struct otx2_tim_bkt),
 302                                     RTE_CACHE_LINE_SIZE);
 303         if (tim_ring->bkt == NULL)
 304                 goto bkt_mem_err;
 305
 306         rc = tim_chnk_pool_create(tim_ring, rcfg);
 307         if (rc < 0)
 308                 goto chnk_mem_err;
 309
 310         cfg_req = otx2_mbox_alloc_msg_tim_config_ring(dev->mbox);
 311
 312         cfg_req->ring = tim_ring->ring_id;
 313         cfg_req->bigendian = false;
 314         cfg_req->clocksource = tim_ring->clk_src;
 315         cfg_req->enableperiodic = tim_ring->ena_periodic;
 316         cfg_req->enabledontfreebuffer = tim_ring->ena_dfb;
 317         cfg_req->bucketsize = tim_ring->nb_bkts;
 318         cfg_req->chunksize = tim_ring->chunk_sz;
 319         cfg_req->interval = NSEC2TICK(tim_ring->tck_nsec,
 320                                       tim_ring->tenns_clk_freq);
 321
 322         rc = otx2_mbox_process(dev->mbox);
 323         if (rc < 0) {
 324                 tim_err_desc(rc);
 325                 goto chnk_mem_err;
 326         }
 327
 328         tim_ring->base = dev->bar2 +
 329                 (RVU_BLOCK_ADDR_TIM << 20 | tim_ring->ring_id << 12);
 330
 331         rc = tim_register_irq(tim_ring->ring_id);
 332         if (rc < 0)
 333                 goto chnk_mem_err;
 334
 335         otx2_write64((uint64_t)tim_ring->bkt,
 336                      tim_ring->base + TIM_LF_RING_BASE);
 337         otx2_write64(tim_ring->aura, tim_ring->base + TIM_LF_RING_AURA);
 338
 339         /* Set fastpath ops. */
 340         tim_set_fp_ops(tim_ring);
 341
 342         /* Update SSO xae count. */
 343         sso_updt_xae_cnt(sso_pmd_priv(dev->event_dev), (void *)tim_ring,
 344                          RTE_EVENT_TYPE_TIMER);
 345         sso_xae_reconfigure(dev->event_dev);
 346
 347         otx2_tim_dbg("Total memory used %"PRIu64"MB\n",
 348                         (uint64_t)(((tim_ring->nb_chunks * tim_ring->chunk_sz)
 349                         + (tim_ring->nb_bkts * sizeof(struct otx2_tim_bkt))) /
 350                         BIT_ULL(20)));
 351
 352         return rc;
 353
 354 chnk_mem_err:
 355         rte_free(tim_ring->bkt);
 356 bkt_mem_err:
 357         rte_free(tim_ring);
 358 rng_mem_err:
 359         free_req = otx2_mbox_alloc_msg_tim_lf_free(dev->mbox);
 360         free_req->ring = adptr->data->id;
 361         otx2_mbox_process(dev->mbox);
 362         return rc;
 363 }
 364
 365 static void
 366 otx2_tim_calibrate_start_tsc(struct otx2_tim_ring *tim_ring)
 367 {
 368 #define OTX2_TIM_CALIB_ITER     1E6
 369         uint32_t real_bkt, bucket;
 370         int icount, ecount = 0;
 371         uint64_t bkt_cyc;
 372
 373         for (icount = 0; icount < OTX2_TIM_CALIB_ITER; icount++) {
 374                 real_bkt = otx2_read64(tim_ring->base + TIM_LF_RING_REL) >> 44;
 375                 bkt_cyc = rte_rdtsc();
 376                 bucket = (bkt_cyc - tim_ring->ring_start_cyc) /
 377                                                         tim_ring->tck_int;
 378                 bucket = bucket % (tim_ring->nb_bkts);
 379                 tim_ring->ring_start_cyc = bkt_cyc - (real_bkt *
 380                                                         tim_ring->tck_int);
 381                 if (bucket != real_bkt)
 382                         ecount++;
 383         }
 384         tim_ring->last_updt_cyc = bkt_cyc;
 385         otx2_tim_dbg("Bucket mispredict %3.2f distance %d\n",
 386                      100 - (((double)(icount - ecount) / (double)icount) * 100),
 387                      bucket - real_bkt);
 388 }
 389
 390 static int
 391 otx2_tim_ring_start(const struct rte_event_timer_adapter *adptr)
 392 {
 393         struct otx2_tim_ring *tim_ring = adptr->data->adapter_priv;
 394         struct otx2_tim_evdev *dev = tim_priv_get();
 395         struct tim_enable_rsp *rsp;
 396         struct tim_ring_req *req;
 397         int rc;
 398
 399         if (dev == NULL)
 400                 return -ENODEV;
 401
 402         req = otx2_mbox_alloc_msg_tim_enable_ring(dev->mbox);
 403         req->ring = tim_ring->ring_id;
 404
 405         rc = otx2_mbox_process_msg(dev->mbox, (void **)&rsp);
 406         if (rc < 0) {
 407                 tim_err_desc(rc);
 408                 goto fail;
 409         }
 410 #ifdef RTE_ARM_EAL_RDTSC_USE_PMU
 411         uint64_t tenns_stmp, tenns_diff;
 412         uint64_t pmu_stmp;
 413
 414         pmu_stmp = rte_rdtsc();
 415         asm volatile("mrs %0, cntvct_el0" : "=r" (tenns_stmp));
 416
 417         tenns_diff = tenns_stmp - rsp->timestarted;
 418         pmu_stmp = pmu_stmp - (NSEC2TICK(tenns_diff  * 10, rte_get_timer_hz()));
 419         tim_ring->ring_start_cyc = pmu_stmp;
 420 #else
 421         tim_ring->ring_start_cyc = rsp->timestarted;
 422 #endif
 423         tim_ring->tck_int = NSEC2TICK(tim_ring->tck_nsec, rte_get_timer_hz());
 424         tim_ring->tot_int = tim_ring->tck_int * tim_ring->nb_bkts;
 425         tim_ring->fast_div = rte_reciprocal_value_u64(tim_ring->tck_int);
 426         tim_ring->fast_bkt = rte_reciprocal_value_u64(tim_ring->nb_bkts);
 427
 428         otx2_tim_calibrate_start_tsc(tim_ring);
 429
 430 fail:
 431         return rc;
 432 }
 433
 434 static int
 435 otx2_tim_ring_stop(const struct rte_event_timer_adapter *adptr)
 436 {
 437         struct otx2_tim_ring *tim_ring = adptr->data->adapter_priv;
 438         struct otx2_tim_evdev *dev = tim_priv_get();
 439         struct tim_ring_req *req;
 440         int rc;
 441
 442         if (dev == NULL)
 443                 return -ENODEV;
 444
 445         req = otx2_mbox_alloc_msg_tim_disable_ring(dev->mbox);
 446         req->ring = tim_ring->ring_id;
 447
 448         rc = otx2_mbox_process(dev->mbox);
 449         if (rc < 0) {
 450                 tim_err_desc(rc);
 451                 rc = -EBUSY;
 452         }
 453
 454         return rc;
 455 }
 456
 457 static int
 458 otx2_tim_ring_free(struct rte_event_timer_adapter *adptr)
 459 {
 460         struct otx2_tim_ring *tim_ring = adptr->data->adapter_priv;
 461         struct otx2_tim_evdev *dev = tim_priv_get();
 462         struct tim_ring_req *req;
 463         int rc;
 464
 465         if (dev == NULL)
 466                 return -ENODEV;
 467
 468         tim_unregister_irq(tim_ring->ring_id);
 469
 470         req = otx2_mbox_alloc_msg_tim_lf_free(dev->mbox);
 471         req->ring = tim_ring->ring_id;
 472
 473         rc = otx2_mbox_process(dev->mbox);
 474         if (rc < 0) {
 475                 tim_err_desc(rc);
 476                 return -EBUSY;
 477         }
 478
 479         rte_free(tim_ring->bkt);
 480         rte_mempool_free(tim_ring->chunk_pool);
 481         rte_free(adptr->data->adapter_priv);
 482
 483         return 0;
 484 }
 485
 486 static int
 487 otx2_tim_stats_get(const struct rte_event_timer_adapter *adapter,
 488                    struct rte_event_timer_adapter_stats *stats)
 489 {
 490         struct otx2_tim_ring *tim_ring = adapter->data->adapter_priv;
 491         uint64_t bkt_cyc = rte_rdtsc() - tim_ring->ring_start_cyc;
 492
 493
 494         stats->evtim_exp_count = __atomic_load_n(&tim_ring->arm_cnt,
 495                                                  __ATOMIC_RELAXED);
 496         stats->ev_enq_count = stats->evtim_exp_count;
 497         stats->adapter_tick_count = rte_reciprocal_divide_u64(bkt_cyc,
 498                                 &tim_ring->fast_div);
 499         return 0;
 500 }
 501
 502 static int
 503 otx2_tim_stats_reset(const struct rte_event_timer_adapter *adapter)
 504 {
 505         struct otx2_tim_ring *tim_ring = adapter->data->adapter_priv;
 506
 507         __atomic_store_n(&tim_ring->arm_cnt, 0, __ATOMIC_RELAXED);
 508         return 0;
 509 }
 510
 511 int
 512 otx2_tim_caps_get(const struct rte_eventdev *evdev, uint64_t flags,
 513                   uint32_t *caps,
 514                   const struct rte_event_timer_adapter_ops **ops)
 515 {
 516         struct otx2_tim_evdev *dev = tim_priv_get();
 517
 518         RTE_SET_USED(flags);
 519
 520         if (dev == NULL)
 521                 return -ENODEV;
 522
 523         otx2_tim_ops.init = otx2_tim_ring_create;
 524         otx2_tim_ops.uninit = otx2_tim_ring_free;
 525         otx2_tim_ops.start = otx2_tim_ring_start;
 526         otx2_tim_ops.stop = otx2_tim_ring_stop;
 527         otx2_tim_ops.get_info   = otx2_tim_ring_info_get;
 528
 529         if (dev->enable_stats) {
 530                 otx2_tim_ops.stats_get   = otx2_tim_stats_get;
 531                 otx2_tim_ops.stats_reset = otx2_tim_stats_reset;
 532         }
 533
 534         /* Store evdev pointer for later use. */
 535         dev->event_dev = (struct rte_eventdev *)(uintptr_t)evdev;
 536         *caps = RTE_EVENT_TIMER_ADAPTER_CAP_INTERNAL_PORT |
 537                 RTE_EVENT_TIMER_ADAPTER_CAP_PERIODIC;
 538         *ops = &otx2_tim_ops;
 539
 540         return 0;
 541 }
 542
 543 #define OTX2_TIM_DISABLE_NPA    "tim_disable_npa"
 544 #define OTX2_TIM_CHNK_SLOTS     "tim_chnk_slots"
 545 #define OTX2_TIM_STATS_ENA      "tim_stats_ena"
 546 #define OTX2_TIM_RINGS_LMT      "tim_rings_lmt"
 547 #define OTX2_TIM_RING_CTL       "tim_ring_ctl"
 548
 549 static void
 550 tim_parse_ring_param(char *value, void *opaque)
 551 {
 552         struct otx2_tim_evdev *dev = opaque;
 553         struct otx2_tim_ctl ring_ctl = {0};
 554         char *tok = strtok(value, "-");
 555         struct otx2_tim_ctl *old_ptr;
 556         uint16_t *val;
 557
 558         val = (uint16_t *)&ring_ctl;
 559
 560         if (!strlen(value))
 561                 return;
 562
 563         while (tok != NULL) {
 564                 *val = atoi(tok);
 565                 tok = strtok(NULL, "-");
 566                 val++;
 567         }
 568
 569         if (val != (&ring_ctl.enable_stats + 1)) {
 570                 otx2_err(
 571                 "Invalid ring param expected [ring-chunk_sz-disable_npa-enable_stats]");
 572                 return;
 573         }
 574
 575         dev->ring_ctl_cnt++;
 576         old_ptr = dev->ring_ctl_data;
 577         dev->ring_ctl_data = rte_realloc(dev->ring_ctl_data,
 578                                          sizeof(struct otx2_tim_ctl) *
 579                                          dev->ring_ctl_cnt, 0);
 580         if (dev->ring_ctl_data == NULL) {
 581                 dev->ring_ctl_data = old_ptr;
 582                 dev->ring_ctl_cnt--;
 583                 return;
 584         }
 585
 586         dev->ring_ctl_data[dev->ring_ctl_cnt - 1] = ring_ctl;
 587 }
 588
 589 static void
 590 tim_parse_ring_ctl_list(const char *value, void *opaque)
 591 {
 592         char *s = strdup(value);
 593         char *start = NULL;
 594         char *end = NULL;
 595         char *f = s;
 596
 597         while (*s) {
 598                 if (*s == '[')
 599                         start = s;
 600                 else if (*s == ']')
 601                         end = s;
 602
 603                 if (start && start < end) {
 604                         *end = 0;
 605                         tim_parse_ring_param(start + 1, opaque);
 606                         start = end;
 607                         s = end;
 608                 }
 609                 s++;
 610         }
 611
 612         free(f);
 613 }
 614
 615 static int
 616 tim_parse_kvargs_dict(const char *key, const char *value, void *opaque)
 617 {
 618         RTE_SET_USED(key);
 619
 620         /* Dict format [ring-chunk_sz-disable_npa-enable_stats] use '-' as ','
 621          * isn't allowed. 0 represents default.
 622          */
 623         tim_parse_ring_ctl_list(value, opaque);
 624
 625         return 0;
 626 }
 627
 628 static void
 629 tim_parse_devargs(struct rte_devargs *devargs, struct otx2_tim_evdev *dev)
 630 {
 631         struct rte_kvargs *kvlist;
 632
 633         if (devargs == NULL)
 634                 return;
 635
 636         kvlist = rte_kvargs_parse(devargs->args, NULL);
 637         if (kvlist == NULL)
 638                 return;
 639
 640         rte_kvargs_process(kvlist, OTX2_TIM_DISABLE_NPA,
 641                            &parse_kvargs_flag, &dev->disable_npa);
 642         rte_kvargs_process(kvlist, OTX2_TIM_CHNK_SLOTS,
 643                            &parse_kvargs_value, &dev->chunk_slots);
 644         rte_kvargs_process(kvlist, OTX2_TIM_STATS_ENA, &parse_kvargs_flag,
 645                            &dev->enable_stats);
 646         rte_kvargs_process(kvlist, OTX2_TIM_RINGS_LMT, &parse_kvargs_value,
 647                            &dev->min_ring_cnt);
 648         rte_kvargs_process(kvlist, OTX2_TIM_RING_CTL,
 649                            &tim_parse_kvargs_dict, &dev);
 650
 651         rte_kvargs_free(kvlist);
 652 }
 653
 654 void
 655 otx2_tim_init(struct rte_pci_device *pci_dev, struct otx2_dev *cmn_dev)
 656 {
 657         struct rsrc_attach_req *atch_req;
 658         struct rsrc_detach_req *dtch_req;
 659         struct free_rsrcs_rsp *rsrc_cnt;
 660         const struct rte_memzone *mz;
 661         struct otx2_tim_evdev *dev;
 662         int rc;
 663
 664         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
 665                 return;
 666
 667         mz = rte_memzone_reserve(RTE_STR(OTX2_TIM_EVDEV_NAME),
 668                                  sizeof(struct otx2_tim_evdev),
 669                                  rte_socket_id(), 0);
 670         if (mz == NULL) {
 671                 otx2_tim_dbg("Unable to allocate memory for TIM Event device");
 672                 return;
 673         }
 674
 675         dev = mz->addr;
 676         dev->pci_dev = pci_dev;
 677         dev->mbox = cmn_dev->mbox;
 678         dev->bar2 = cmn_dev->bar2;
 679
 680         tim_parse_devargs(pci_dev->device.devargs, dev);
 681
 682         otx2_mbox_alloc_msg_free_rsrc_cnt(dev->mbox);
 683         rc = otx2_mbox_process_msg(dev->mbox, (void *)&rsrc_cnt);
 684         if (rc < 0) {
 685                 otx2_err("Unable to get free rsrc count.");
 686                 goto mz_free;
 687         }
 688
 689         dev->nb_rings = dev->min_ring_cnt ?
 690                 RTE_MIN(dev->min_ring_cnt, rsrc_cnt->tim) : rsrc_cnt->tim;
 691
 692         if (!dev->nb_rings) {
 693                 otx2_tim_dbg("No TIM Logical functions provisioned.");
 694                 goto mz_free;
 695         }
 696
 697         atch_req = otx2_mbox_alloc_msg_attach_resources(dev->mbox);
 698         atch_req->modify = true;
 699         atch_req->timlfs = dev->nb_rings;
 700
 701         rc = otx2_mbox_process(dev->mbox);
 702         if (rc < 0) {
 703                 otx2_err("Unable to attach TIM rings.");
 704                 goto mz_free;
 705         }
 706
 707         rc = tim_get_msix_offsets();
 708         if (rc < 0) {
 709                 otx2_err("Unable to get MSIX offsets for TIM.");
 710                 goto detach;
 711         }
 712
 713         if (dev->chunk_slots &&
 714             dev->chunk_slots <= OTX2_TIM_MAX_CHUNK_SLOTS &&
 715             dev->chunk_slots >= OTX2_TIM_MIN_CHUNK_SLOTS) {
 716                 dev->chunk_sz = (dev->chunk_slots + 1) *
 717                         OTX2_TIM_CHUNK_ALIGNMENT;
 718         } else {
 719                 dev->chunk_sz = OTX2_TIM_RING_DEF_CHUNK_SZ;
 720         }
 721
 722         return;
 723
 724 detach:
 725         dtch_req = otx2_mbox_alloc_msg_detach_resources(dev->mbox);
 726         dtch_req->partial = true;
 727         dtch_req->timlfs = true;
 728
 729         otx2_mbox_process(dev->mbox);
 730 mz_free:
 731         rte_memzone_free(mz);
 732 }
 733
 734 void
 735 otx2_tim_fini(void)
 736 {
 737         struct otx2_tim_evdev *dev = tim_priv_get();
 738         struct rsrc_detach_req *dtch_req;
 739
 740         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
 741                 return;
 742
 743         dtch_req = otx2_mbox_alloc_msg_detach_resources(dev->mbox);
 744         dtch_req->partial = true;
 745         dtch_req->timlfs = true;
 746
 747         otx2_mbox_process(dev->mbox);
 748         rte_memzone_free(rte_memzone_lookup(RTE_STR(OTX2_TIM_EVDEV_NAME)));
 749 }