drivers/net/sfc/sfc_ev.c

   1 /*-
   2  * Copyright (c) 2016 Solarflare Communications Inc.
   3  * All rights reserved.
   4  *
   5  * This software was jointly developed between OKTET Labs (under contract
   6  * for Solarflare) and Solarflare Communications, Inc.
   7  *
   8  * Redistribution and use in source and binary forms, with or without
   9  * modification, are permitted provided that the following conditions are met:
  10  *
  11  * 1. Redistributions of source code must retain the above copyright notice,
  12  *    this list of conditions and the following disclaimer.
  13  * 2. Redistributions in binary form must reproduce the above copyright notice,
  14  *    this list of conditions and the following disclaimer in the documentation
  15  *    and/or other materials provided with the distribution.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  18  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
  19  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  20  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
  21  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
  22  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  23  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
  24  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  25  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
  26  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
  27  * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  28  */
  29
  30 #include <rte_debug.h>
  31 #include <rte_cycles.h>
  32 #include <rte_alarm.h>
  33 #include <rte_branch_prediction.h>
  34
  35 #include "efx.h"
  36
  37 #include "sfc.h"
  38 #include "sfc_debug.h"
  39 #include "sfc_log.h"
  40 #include "sfc_ev.h"
  41 #include "sfc_rx.h"
  42 #include "sfc_tx.h"
  43 #include "sfc_kvargs.h"
  44
  45
  46 /* Initial delay when waiting for event queue init complete event */
  47 #define SFC_EVQ_INIT_BACKOFF_START_US   (1)
  48 /* Maximum delay between event queue polling attempts */
  49 #define SFC_EVQ_INIT_BACKOFF_MAX_US     (10 * 1000)
  50 /* Event queue init approx timeout */
  51 #define SFC_EVQ_INIT_TIMEOUT_US         (2 * US_PER_S)
  52
  53 /* Management event queue polling period in microseconds */
  54 #define SFC_MGMT_EV_QPOLL_PERIOD_US     (US_PER_S)
  55
  56
  57 static boolean_t
  58 sfc_ev_initialized(void *arg)
  59 {
  60         struct sfc_evq *evq = arg;
  61
  62         /* Init done events may be duplicated on SFN7xxx (SFC bug 31631) */
  63         SFC_ASSERT(evq->init_state == SFC_EVQ_STARTING ||
  64                    evq->init_state == SFC_EVQ_STARTED);
  65
  66         evq->init_state = SFC_EVQ_STARTED;
  67
  68         return B_FALSE;
  69 }
  70
  71 static boolean_t
  72 sfc_ev_rx(void *arg, __rte_unused uint32_t label, uint32_t id,
  73           uint32_t size, uint16_t flags)
  74 {
  75         struct sfc_evq *evq = arg;
  76         struct sfc_rxq *rxq;
  77         unsigned int stop;
  78         unsigned int pending_id;
  79         unsigned int delta;
  80         unsigned int i;
  81         struct sfc_rx_sw_desc *rxd;
  82
  83         if (unlikely(evq->exception))
  84                 goto done;
  85
  86         rxq = evq->rxq;
  87
  88         SFC_ASSERT(rxq != NULL);
  89         SFC_ASSERT(rxq->evq == evq);
  90         SFC_ASSERT(rxq->state & SFC_RXQ_STARTED);
  91
  92         stop = (id + 1) & rxq->ptr_mask;
  93         pending_id = rxq->pending & rxq->ptr_mask;
  94         delta = (stop >= pending_id) ? (stop - pending_id) :
  95                 (rxq->ptr_mask + 1 - pending_id + stop);
  96
  97         if (delta == 0) {
  98                 /*
  99                  * Rx event with no new descriptors done and zero length
 100                  * is used to abort scattered packet when there is no room
 101                  * for the tail.
 102                  */
 103                 if (unlikely(size != 0)) {
 104                         evq->exception = B_TRUE;
 105                         sfc_err(evq->sa,
 106                                 "EVQ %u RxQ %u invalid RX abort "
 107                                 "(id=%#x size=%u flags=%#x); needs restart\n",
 108                                 evq->evq_index, sfc_rxq_sw_index(rxq),
 109                                 id, size, flags);
 110                         goto done;
 111                 }
 112
 113                 /* Add discard flag to the first fragment */
 114                 rxq->sw_desc[pending_id].flags |= EFX_DISCARD;
 115                 /* Remove continue flag from the last fragment */
 116                 rxq->sw_desc[id].flags &= ~EFX_PKT_CONT;
 117         } else if (unlikely(delta > rxq->batch_max)) {
 118                 evq->exception = B_TRUE;
 119
 120                 sfc_err(evq->sa,
 121                         "EVQ %u RxQ %u completion out of order "
 122                         "(id=%#x delta=%u flags=%#x); needs restart\n",
 123                         evq->evq_index, sfc_rxq_sw_index(rxq), id, delta,
 124                         flags);
 125
 126                 goto done;
 127         }
 128
 129         for (i = pending_id; i != stop; i = (i + 1) & rxq->ptr_mask) {
 130                 rxd = &rxq->sw_desc[i];
 131
 132                 rxd->flags = flags;
 133
 134                 SFC_ASSERT(size < (1 << 16));
 135                 rxd->size = (uint16_t)size;
 136         }
 137
 138         rxq->pending += delta;
 139
 140 done:
 141         return B_FALSE;
 142 }
 143
 144 static boolean_t
 145 sfc_ev_tx(void *arg, __rte_unused uint32_t label, uint32_t id)
 146 {
 147         struct sfc_evq *evq = arg;
 148         struct sfc_txq *txq;
 149         unsigned int stop;
 150         unsigned int delta;
 151
 152         txq = evq->txq;
 153
 154         SFC_ASSERT(txq != NULL);
 155         SFC_ASSERT(txq->evq == evq);
 156
 157         if (unlikely((txq->state & SFC_TXQ_STARTED) == 0))
 158                 goto done;
 159
 160         stop = (id + 1) & txq->ptr_mask;
 161         id = txq->pending & txq->ptr_mask;
 162
 163         delta = (stop >= id) ? (stop - id) : (txq->ptr_mask + 1 - id + stop);
 164
 165         txq->pending += delta;
 166
 167 done:
 168         return B_FALSE;
 169 }
 170
 171 static boolean_t
 172 sfc_ev_exception(void *arg, __rte_unused uint32_t code,
 173                  __rte_unused uint32_t data)
 174 {
 175         struct sfc_evq *evq = arg;
 176
 177         if (code == EFX_EXCEPTION_UNKNOWN_SENSOREVT)
 178                 return B_FALSE;
 179
 180         evq->exception = B_TRUE;
 181         sfc_warn(evq->sa,
 182                  "hardware exception %s (code=%u, data=%#x) on EVQ %u;"
 183                  " needs recovery",
 184                  (code == EFX_EXCEPTION_RX_RECOVERY) ? "RX_RECOVERY" :
 185                  (code == EFX_EXCEPTION_RX_DSC_ERROR) ? "RX_DSC_ERROR" :
 186                  (code == EFX_EXCEPTION_TX_DSC_ERROR) ? "TX_DSC_ERROR" :
 187                  (code == EFX_EXCEPTION_FWALERT_SRAM) ? "FWALERT_SRAM" :
 188                  (code == EFX_EXCEPTION_UNKNOWN_FWALERT) ? "UNKNOWN_FWALERT" :
 189                  (code == EFX_EXCEPTION_RX_ERROR) ? "RX_ERROR" :
 190                  (code == EFX_EXCEPTION_TX_ERROR) ? "TX_ERROR" :
 191                  (code == EFX_EXCEPTION_EV_ERROR) ? "EV_ERROR" :
 192                  "UNKNOWN",
 193                  code, data, evq->evq_index);
 194
 195         return B_TRUE;
 196 }
 197
 198 static boolean_t
 199 sfc_ev_rxq_flush_done(void *arg, __rte_unused uint32_t rxq_hw_index)
 200 {
 201         struct sfc_evq *evq = arg;
 202         struct sfc_rxq *rxq;
 203
 204         rxq = evq->rxq;
 205         SFC_ASSERT(rxq != NULL);
 206         SFC_ASSERT(rxq->hw_index == rxq_hw_index);
 207         SFC_ASSERT(rxq->evq == evq);
 208         sfc_rx_qflush_done(rxq);
 209
 210         return B_FALSE;
 211 }
 212
 213 static boolean_t
 214 sfc_ev_rxq_flush_failed(void *arg, __rte_unused uint32_t rxq_hw_index)
 215 {
 216         struct sfc_evq *evq = arg;
 217         struct sfc_rxq *rxq;
 218
 219         rxq = evq->rxq;
 220         SFC_ASSERT(rxq != NULL);
 221         SFC_ASSERT(rxq->hw_index == rxq_hw_index);
 222         SFC_ASSERT(rxq->evq == evq);
 223         sfc_rx_qflush_failed(rxq);
 224
 225         return B_FALSE;
 226 }
 227
 228 static boolean_t
 229 sfc_ev_txq_flush_done(void *arg, __rte_unused uint32_t txq_hw_index)
 230 {
 231         struct sfc_evq *evq = arg;
 232         struct sfc_txq *txq;
 233
 234         txq = evq->txq;
 235         SFC_ASSERT(txq != NULL);
 236         SFC_ASSERT(txq->hw_index == txq_hw_index);
 237         SFC_ASSERT(txq->evq == evq);
 238         sfc_tx_qflush_done(txq);
 239
 240         return B_FALSE;
 241 }
 242
 243 static boolean_t
 244 sfc_ev_software(void *arg, uint16_t magic)
 245 {
 246         struct sfc_evq *evq = arg;
 247
 248         sfc_err(evq->sa, "EVQ %u unexpected software event magic=%#.4x",
 249                 evq->evq_index, magic);
 250         return B_TRUE;
 251 }
 252
 253 static boolean_t
 254 sfc_ev_sram(void *arg, uint32_t code)
 255 {
 256         struct sfc_evq *evq = arg;
 257
 258         sfc_err(evq->sa, "EVQ %u unexpected SRAM event code=%u",
 259                 evq->evq_index, code);
 260         return B_TRUE;
 261 }
 262
 263 static boolean_t
 264 sfc_ev_wake_up(void *arg, uint32_t index)
 265 {
 266         struct sfc_evq *evq = arg;
 267
 268         sfc_err(evq->sa, "EVQ %u unexpected wake up event index=%u",
 269                 evq->evq_index, index);
 270         return B_TRUE;
 271 }
 272
 273 static boolean_t
 274 sfc_ev_timer(void *arg, uint32_t index)
 275 {
 276         struct sfc_evq *evq = arg;
 277
 278         sfc_err(evq->sa, "EVQ %u unexpected timer event index=%u",
 279                 evq->evq_index, index);
 280         return B_TRUE;
 281 }
 282
 283 static boolean_t
 284 sfc_ev_link_change(void *arg, efx_link_mode_t link_mode)
 285 {
 286         struct sfc_evq *evq = arg;
 287         struct sfc_adapter *sa = evq->sa;
 288         struct rte_eth_link *dev_link = &sa->eth_dev->data->dev_link;
 289         struct rte_eth_link new_link;
 290
 291         EFX_STATIC_ASSERT(sizeof(*dev_link) == sizeof(rte_atomic64_t));
 292
 293         sfc_port_link_mode_to_info(link_mode, &new_link);
 294         rte_atomic64_set((rte_atomic64_t *)dev_link, *(uint64_t *)&new_link);
 295
 296         return B_FALSE;
 297 }
 298
 299 static const efx_ev_callbacks_t sfc_ev_callbacks = {
 300         .eec_initialized        = sfc_ev_initialized,
 301         .eec_rx                 = sfc_ev_rx,
 302         .eec_tx                 = sfc_ev_tx,
 303         .eec_exception          = sfc_ev_exception,
 304         .eec_rxq_flush_done     = sfc_ev_rxq_flush_done,
 305         .eec_rxq_flush_failed   = sfc_ev_rxq_flush_failed,
 306         .eec_txq_flush_done     = sfc_ev_txq_flush_done,
 307         .eec_software           = sfc_ev_software,
 308         .eec_sram               = sfc_ev_sram,
 309         .eec_wake_up            = sfc_ev_wake_up,
 310         .eec_timer              = sfc_ev_timer,
 311         .eec_link_change        = sfc_ev_link_change,
 312 };
 313
 314
 315 void
 316 sfc_ev_qpoll(struct sfc_evq *evq)
 317 {
 318         SFC_ASSERT(evq->init_state == SFC_EVQ_STARTED ||
 319                    evq->init_state == SFC_EVQ_STARTING);
 320
 321         /* Synchronize the DMA memory for reading not required */
 322
 323         efx_ev_qpoll(evq->common, &evq->read_ptr, &sfc_ev_callbacks, evq);
 324
 325         if (unlikely(evq->exception) && sfc_adapter_trylock(evq->sa)) {
 326                 struct sfc_adapter *sa = evq->sa;
 327                 int rc;
 328
 329                 if ((evq->rxq != NULL) && (evq->rxq->state & SFC_RXQ_RUNNING)) {
 330                         unsigned int rxq_sw_index = sfc_rxq_sw_index(evq->rxq);
 331
 332                         sfc_warn(sa,
 333                                  "restart RxQ %u because of exception on its EvQ %u",
 334                                  rxq_sw_index, evq->evq_index);
 335
 336                         sfc_rx_qstop(sa, rxq_sw_index);
 337                         rc = sfc_rx_qstart(sa, rxq_sw_index);
 338                         if (rc != 0)
 339                                 sfc_err(sa, "cannot restart RxQ %u",
 340                                         rxq_sw_index);
 341                 }
 342
 343                 if (evq->txq != NULL) {
 344                         unsigned int txq_sw_index = sfc_txq_sw_index(evq->txq);
 345
 346                         sfc_warn(sa,
 347                                  "restart TxQ %u because of exception on its EvQ %u",
 348                                  txq_sw_index, evq->evq_index);
 349
 350                         sfc_tx_qstop(sa, txq_sw_index);
 351                         rc = sfc_tx_qstart(sa, txq_sw_index);
 352                         if (rc != 0)
 353                                 sfc_err(sa, "cannot restart TxQ %u",
 354                                         txq_sw_index);
 355                 }
 356
 357                 if (evq->exception)
 358                         sfc_panic(sa, "unrecoverable exception on EvQ %u",
 359                                   evq->evq_index);
 360
 361                 sfc_adapter_unlock(sa);
 362         }
 363
 364         /* Poll-mode driver does not re-prime the event queue for interrupts */
 365 }
 366
 367 void
 368 sfc_ev_mgmt_qpoll(struct sfc_adapter *sa)
 369 {
 370         if (rte_spinlock_trylock(&sa->mgmt_evq_lock)) {
 371                 struct sfc_evq *mgmt_evq = sa->evq_info[sa->mgmt_evq_index].evq;
 372
 373                 if (mgmt_evq->init_state == SFC_EVQ_STARTED)
 374                         sfc_ev_qpoll(mgmt_evq);
 375
 376                 rte_spinlock_unlock(&sa->mgmt_evq_lock);
 377         }
 378 }
 379
 380 int
 381 sfc_ev_qprime(struct sfc_evq *evq)
 382 {
 383         SFC_ASSERT(evq->init_state == SFC_EVQ_STARTED);
 384         return efx_ev_qprime(evq->common, evq->read_ptr);
 385 }
 386
 387 int
 388 sfc_ev_qstart(struct sfc_adapter *sa, unsigned int sw_index)
 389 {
 390         const struct sfc_evq_info *evq_info;
 391         struct sfc_evq *evq;
 392         efsys_mem_t *esmp;
 393         unsigned int total_delay_us;
 394         unsigned int delay_us;
 395         int rc;
 396
 397         sfc_log_init(sa, "sw_index=%u", sw_index);
 398
 399         evq_info = &sa->evq_info[sw_index];
 400         evq = evq_info->evq;
 401         esmp = &evq->mem;
 402
 403         /* Clear all events */
 404         (void)memset((void *)esmp->esm_base, 0xff,
 405                      EFX_EVQ_SIZE(evq_info->entries));
 406
 407         /* Create the common code event queue */
 408         rc = efx_ev_qcreate(sa->nic, sw_index, esmp, evq_info->entries,
 409                             0 /* unused on EF10 */, 0, evq_info->flags,
 410                             &evq->common);
 411         if (rc != 0)
 412                 goto fail_ev_qcreate;
 413
 414         evq->init_state = SFC_EVQ_STARTING;
 415
 416         /* Wait for the initialization event */
 417         total_delay_us = 0;
 418         delay_us = SFC_EVQ_INIT_BACKOFF_START_US;
 419         do {
 420                 (void)sfc_ev_qpoll(evq);
 421
 422                 /* Check to see if the initialization complete indication
 423                  * posted by the hardware.
 424                  */
 425                 if (evq->init_state == SFC_EVQ_STARTED)
 426                         goto done;
 427
 428                 /* Give event queue some time to init */
 429                 rte_delay_us(delay_us);
 430
 431                 total_delay_us += delay_us;
 432
 433                 /* Exponential backoff */
 434                 delay_us *= 2;
 435                 if (delay_us > SFC_EVQ_INIT_BACKOFF_MAX_US)
 436                         delay_us = SFC_EVQ_INIT_BACKOFF_MAX_US;
 437
 438         } while (total_delay_us < SFC_EVQ_INIT_TIMEOUT_US);
 439
 440         rc = ETIMEDOUT;
 441         goto fail_timedout;
 442
 443 done:
 444         return 0;
 445
 446 fail_timedout:
 447         evq->init_state = SFC_EVQ_INITIALIZED;
 448         efx_ev_qdestroy(evq->common);
 449
 450 fail_ev_qcreate:
 451         sfc_log_init(sa, "failed %d", rc);
 452         return rc;
 453 }
 454
 455 void
 456 sfc_ev_qstop(struct sfc_adapter *sa, unsigned int sw_index)
 457 {
 458         const struct sfc_evq_info *evq_info;
 459         struct sfc_evq *evq;
 460
 461         sfc_log_init(sa, "sw_index=%u", sw_index);
 462
 463         SFC_ASSERT(sw_index < sa->evq_count);
 464
 465         evq_info = &sa->evq_info[sw_index];
 466         evq = evq_info->evq;
 467
 468         if (evq == NULL || evq->init_state != SFC_EVQ_STARTED)
 469                 return;
 470
 471         evq->init_state = SFC_EVQ_INITIALIZED;
 472         evq->read_ptr = 0;
 473         evq->exception = B_FALSE;
 474
 475         efx_ev_qdestroy(evq->common);
 476 }
 477
 478 static void
 479 sfc_ev_mgmt_periodic_qpoll(void *arg)
 480 {
 481         struct sfc_adapter *sa = arg;
 482         int rc;
 483
 484         sfc_ev_mgmt_qpoll(sa);
 485
 486         rc = rte_eal_alarm_set(SFC_MGMT_EV_QPOLL_PERIOD_US,
 487                                sfc_ev_mgmt_periodic_qpoll, sa);
 488         if (rc != 0)
 489                 sfc_panic(sa,
 490                           "cannot rearm management EVQ polling alarm (rc=%d)",
 491                           rc);
 492 }
 493
 494 static void
 495 sfc_ev_mgmt_periodic_qpoll_start(struct sfc_adapter *sa)
 496 {
 497         sfc_ev_mgmt_periodic_qpoll(sa);
 498 }
 499
 500 static void
 501 sfc_ev_mgmt_periodic_qpoll_stop(struct sfc_adapter *sa)
 502 {
 503         rte_eal_alarm_cancel(sfc_ev_mgmt_periodic_qpoll, sa);
 504 }
 505
 506 int
 507 sfc_ev_start(struct sfc_adapter *sa)
 508 {
 509         int rc;
 510
 511         sfc_log_init(sa, "entry");
 512
 513         rc = efx_ev_init(sa->nic);
 514         if (rc != 0)
 515                 goto fail_ev_init;
 516
 517         /* Start management EVQ used for global events */
 518         rte_spinlock_lock(&sa->mgmt_evq_lock);
 519
 520         rc = sfc_ev_qstart(sa, sa->mgmt_evq_index);
 521         if (rc != 0)
 522                 goto fail_mgmt_evq_start;
 523
 524         rte_spinlock_unlock(&sa->mgmt_evq_lock);
 525
 526         /*
 527          * Start management EVQ polling. If interrupts are disabled
 528          * (not used), it is required to process link status change
 529          * and other device level events to avoid unrecoverable
 530          * error because the event queue overflow.
 531          */
 532         sfc_ev_mgmt_periodic_qpoll_start(sa);
 533
 534         /*
 535          * Rx/Tx event queues are started/stopped when corresponding
 536          * Rx/Tx queue is started/stopped.
 537          */
 538
 539         return 0;
 540
 541 fail_mgmt_evq_start:
 542         rte_spinlock_unlock(&sa->mgmt_evq_lock);
 543         efx_ev_fini(sa->nic);
 544
 545 fail_ev_init:
 546         sfc_log_init(sa, "failed %d", rc);
 547         return rc;
 548 }
 549
 550 void
 551 sfc_ev_stop(struct sfc_adapter *sa)
 552 {
 553         unsigned int sw_index;
 554
 555         sfc_log_init(sa, "entry");
 556
 557         sfc_ev_mgmt_periodic_qpoll_stop(sa);
 558
 559         /* Make sure that all event queues are stopped */
 560         sw_index = sa->evq_count;
 561         while (sw_index-- > 0) {
 562                 if (sw_index == sa->mgmt_evq_index) {
 563                         /* Locks are required for the management EVQ */
 564                         rte_spinlock_lock(&sa->mgmt_evq_lock);
 565                         sfc_ev_qstop(sa, sa->mgmt_evq_index);
 566                         rte_spinlock_unlock(&sa->mgmt_evq_lock);
 567                 } else {
 568                         sfc_ev_qstop(sa, sw_index);
 569                 }
 570         }
 571
 572         efx_ev_fini(sa->nic);
 573 }
 574
 575 int
 576 sfc_ev_qinit(struct sfc_adapter *sa, unsigned int sw_index,
 577              unsigned int entries, int socket_id)
 578 {
 579         struct sfc_evq_info *evq_info;
 580         struct sfc_evq *evq;
 581         int rc;
 582
 583         sfc_log_init(sa, "sw_index=%u", sw_index);
 584
 585         evq_info = &sa->evq_info[sw_index];
 586
 587         SFC_ASSERT(rte_is_power_of_2(entries));
 588         SFC_ASSERT(entries <= evq_info->max_entries);
 589         evq_info->entries = entries;
 590
 591         evq = rte_zmalloc_socket("sfc-evq", sizeof(*evq), RTE_CACHE_LINE_SIZE,
 592                                  socket_id);
 593         if (evq == NULL)
 594                 return ENOMEM;
 595
 596         evq->sa = sa;
 597         evq->evq_index = sw_index;
 598
 599         /* Allocate DMA space */
 600         rc = sfc_dma_alloc(sa, "evq", sw_index, EFX_EVQ_SIZE(evq_info->entries),
 601                            socket_id, &evq->mem);
 602         if (rc != 0)
 603                 return rc;
 604
 605         evq->init_state = SFC_EVQ_INITIALIZED;
 606
 607         evq_info->evq = evq;
 608
 609         return 0;
 610 }
 611
 612 void
 613 sfc_ev_qfini(struct sfc_adapter *sa, unsigned int sw_index)
 614 {
 615         struct sfc_evq *evq;
 616
 617         sfc_log_init(sa, "sw_index=%u", sw_index);
 618
 619         evq = sa->evq_info[sw_index].evq;
 620
 621         SFC_ASSERT(evq->init_state == SFC_EVQ_INITIALIZED);
 622
 623         sa->evq_info[sw_index].evq = NULL;
 624
 625         sfc_dma_free(sa, &evq->mem);
 626
 627         rte_free(evq);
 628 }
 629
 630 static int
 631 sfc_ev_qinit_info(struct sfc_adapter *sa, unsigned int sw_index)
 632 {
 633         struct sfc_evq_info *evq_info = &sa->evq_info[sw_index];
 634         unsigned int max_entries;
 635
 636         sfc_log_init(sa, "sw_index=%u", sw_index);
 637
 638         max_entries = sfc_evq_max_entries(sa, sw_index);
 639         SFC_ASSERT(rte_is_power_of_2(max_entries));
 640
 641         evq_info->max_entries = max_entries;
 642         evq_info->flags = sa->evq_flags | EFX_EVQ_FLAGS_NOTIFY_DISABLED;
 643
 644         return 0;
 645 }
 646
 647 static int
 648 sfc_kvarg_perf_profile_handler(__rte_unused const char *key,
 649                                const char *value_str, void *opaque)
 650 {
 651         uint64_t *value = opaque;
 652
 653         if (strcasecmp(value_str, SFC_KVARG_PERF_PROFILE_THROUGHPUT) == 0)
 654                 *value = EFX_EVQ_FLAGS_TYPE_THROUGHPUT;
 655         else if (strcasecmp(value_str, SFC_KVARG_PERF_PROFILE_LOW_LATENCY) == 0)
 656                 *value = EFX_EVQ_FLAGS_TYPE_LOW_LATENCY;
 657         else if (strcasecmp(value_str, SFC_KVARG_PERF_PROFILE_AUTO) == 0)
 658                 *value = EFX_EVQ_FLAGS_TYPE_AUTO;
 659         else
 660                 return -EINVAL;
 661
 662         return 0;
 663 }
 664
 665 static void
 666 sfc_ev_qfini_info(struct sfc_adapter *sa, unsigned int sw_index)
 667 {
 668         sfc_log_init(sa, "sw_index=%u", sw_index);
 669
 670         /* Nothing to cleanup */
 671 }
 672
 673 int
 674 sfc_ev_init(struct sfc_adapter *sa)
 675 {
 676         int rc;
 677         unsigned int sw_index;
 678
 679         sfc_log_init(sa, "entry");
 680
 681         sa->evq_flags = EFX_EVQ_FLAGS_TYPE_THROUGHPUT;
 682         rc = sfc_kvargs_process(sa, SFC_KVARG_PERF_PROFILE,
 683                                 sfc_kvarg_perf_profile_handler,
 684                                 &sa->evq_flags);
 685         if (rc != 0) {
 686                 sfc_err(sa, "invalid %s parameter value",
 687                         SFC_KVARG_PERF_PROFILE);
 688                 goto fail_kvarg_perf_profile;
 689         }
 690
 691         sa->evq_count = sfc_ev_qcount(sa);
 692         sa->mgmt_evq_index = 0;
 693         rte_spinlock_init(&sa->mgmt_evq_lock);
 694
 695         /* Allocate EVQ info array */
 696         rc = ENOMEM;
 697         sa->evq_info = rte_calloc_socket("sfc-evqs", sa->evq_count,
 698                                          sizeof(struct sfc_evq_info), 0,
 699                                          sa->socket_id);
 700         if (sa->evq_info == NULL)
 701                 goto fail_evqs_alloc;
 702
 703         for (sw_index = 0; sw_index < sa->evq_count; ++sw_index) {
 704                 rc = sfc_ev_qinit_info(sa, sw_index);
 705                 if (rc != 0)
 706                         goto fail_ev_qinit_info;
 707         }
 708
 709         rc = sfc_ev_qinit(sa, sa->mgmt_evq_index, SFC_MGMT_EVQ_ENTRIES,
 710                           sa->socket_id);
 711         if (rc != 0)
 712                 goto fail_mgmt_evq_init;
 713
 714         /*
 715          * Rx/Tx event queues are created/destroyed when corresponding
 716          * Rx/Tx queue is created/destroyed.
 717          */
 718
 719         return 0;
 720
 721 fail_mgmt_evq_init:
 722 fail_ev_qinit_info:
 723         while (sw_index-- > 0)
 724                 sfc_ev_qfini_info(sa, sw_index);
 725
 726         rte_free(sa->evq_info);
 727         sa->evq_info = NULL;
 728
 729 fail_evqs_alloc:
 730         sa->evq_count = 0;
 731
 732 fail_kvarg_perf_profile:
 733         sfc_log_init(sa, "failed %d", rc);
 734         return rc;
 735 }
 736
 737 void
 738 sfc_ev_fini(struct sfc_adapter *sa)
 739 {
 740         int sw_index;
 741
 742         sfc_log_init(sa, "entry");
 743
 744         /* Cleanup all event queues */
 745         sw_index = sa->evq_count;
 746         while (--sw_index >= 0) {
 747                 if (sa->evq_info[sw_index].evq != NULL)
 748                         sfc_ev_qfini(sa, sw_index);
 749                 sfc_ev_qfini_info(sa, sw_index);
 750         }
 751
 752         rte_free(sa->evq_info);
 753         sa->evq_info = NULL;
 754         sa->evq_count = 0;
 755 }