drivers/event/octeontx2/otx2_evdev.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(C) 2019 Marvell International Ltd.
   3  */
   4
   5 #include <inttypes.h>
   6
   7 #include <rte_bus_pci.h>
   8 #include <rte_common.h>
   9 #include <rte_eal.h>
  10 #include <eventdev_pmd_pci.h>
  11 #include <rte_kvargs.h>
  12 #include <rte_mbuf_pool_ops.h>
  13 #include <rte_pci.h>
  14
  15 #include "otx2_evdev_stats.h"
  16 #include "otx2_evdev.h"
  17 #include "otx2_irq.h"
  18 #include "otx2_tim_evdev.h"
  19
  20 static inline int
  21 sso_get_msix_offsets(const struct rte_eventdev *event_dev)
  22 {
  23         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
  24         uint8_t nb_ports = dev->nb_event_ports * (dev->dual_ws ? 2 : 1);
  25         struct otx2_mbox *mbox = dev->mbox;
  26         struct msix_offset_rsp *msix_rsp;
  27         int i, rc;
  28
  29         /* Get SSO and SSOW MSIX vector offsets */
  30         otx2_mbox_alloc_msg_msix_offset(mbox);
  31         rc = otx2_mbox_process_msg(mbox, (void *)&msix_rsp);
  32
  33         for (i = 0; i < nb_ports; i++)
  34                 dev->ssow_msixoff[i] = msix_rsp->ssow_msixoff[i];
  35
  36         for (i = 0; i < dev->nb_event_queues; i++)
  37                 dev->sso_msixoff[i] = msix_rsp->sso_msixoff[i];
  38
  39         return rc;
  40 }
  41
  42 void
  43 sso_fastpath_fns_set(struct rte_eventdev *event_dev)
  44 {
  45         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
  46         /* Single WS modes */
  47         const event_dequeue_t ssogws_deq[2][2][2][2][2][2][2] = {
  48 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
  49                 [f6][f5][f4][f3][f2][f1][f0] = otx2_ssogws_deq_ ##name,
  50 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
  51 #undef R
  52         };
  53
  54         const event_dequeue_burst_t ssogws_deq_burst[2][2][2][2][2][2][2] = {
  55 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
  56                 [f6][f5][f4][f3][f2][f1][f0] = otx2_ssogws_deq_burst_ ##name,
  57 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
  58 #undef R
  59         };
  60
  61         const event_dequeue_t ssogws_deq_timeout[2][2][2][2][2][2][2] = {
  62 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
  63                 [f6][f5][f4][f3][f2][f1][f0] = otx2_ssogws_deq_timeout_ ##name,
  64 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
  65 #undef R
  66         };
  67
  68         const event_dequeue_burst_t
  69                 ssogws_deq_timeout_burst[2][2][2][2][2][2][2] = {
  70 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
  71                 [f6][f5][f4][f3][f2][f1][f0] =                          \
  72                         otx2_ssogws_deq_timeout_burst_ ##name,
  73 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
  74 #undef R
  75         };
  76
  77         const event_dequeue_t ssogws_deq_seg[2][2][2][2][2][2][2] = {
  78 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
  79                 [f6][f5][f4][f3][f2][f1][f0] = otx2_ssogws_deq_seg_ ##name,
  80 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
  81 #undef R
  82         };
  83
  84         const event_dequeue_burst_t
  85                 ssogws_deq_seg_burst[2][2][2][2][2][2][2] = {
  86 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
  87                 [f6][f5][f4][f3][f2][f1][f0] =                          \
  88                         otx2_ssogws_deq_seg_burst_ ##name,
  89 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
  90 #undef R
  91         };
  92
  93         const event_dequeue_t ssogws_deq_seg_timeout[2][2][2][2][2][2][2] = {
  94 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
  95                 [f6][f5][f4][f3][f2][f1][f0] =                          \
  96                         otx2_ssogws_deq_seg_timeout_ ##name,
  97 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
  98 #undef R
  99         };
 100
 101         const event_dequeue_burst_t
 102                 ssogws_deq_seg_timeout_burst[2][2][2][2][2][2][2] = {
 103 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
 104                 [f6][f5][f4][f3][f2][f1][f0] =                          \
 105                                 otx2_ssogws_deq_seg_timeout_burst_ ##name,
 106 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
 107 #undef R
 108         };
 109
 110
 111         /* Dual WS modes */
 112         const event_dequeue_t ssogws_dual_deq[2][2][2][2][2][2][2] = {
 113 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
 114                 [f6][f5][f4][f3][f2][f1][f0] = otx2_ssogws_dual_deq_ ##name,
 115 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
 116 #undef R
 117         };
 118
 119         const event_dequeue_burst_t
 120                 ssogws_dual_deq_burst[2][2][2][2][2][2][2] = {
 121 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
 122                 [f6][f5][f4][f3][f2][f1][f0] =                          \
 123                         otx2_ssogws_dual_deq_burst_ ##name,
 124 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
 125 #undef R
 126         };
 127
 128         const event_dequeue_t ssogws_dual_deq_timeout[2][2][2][2][2][2][2] = {
 129 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
 130                 [f6][f5][f4][f3][f2][f1][f0] =                          \
 131                         otx2_ssogws_dual_deq_timeout_ ##name,
 132 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
 133 #undef R
 134         };
 135
 136         const event_dequeue_burst_t
 137                 ssogws_dual_deq_timeout_burst[2][2][2][2][2][2][2] = {
 138 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
 139         [f6][f5][f4][f3][f2][f1][f0] =                                  \
 140                         otx2_ssogws_dual_deq_timeout_burst_ ##name,
 141 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
 142 #undef R
 143         };
 144
 145         const event_dequeue_t ssogws_dual_deq_seg[2][2][2][2][2][2][2] = {
 146 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
 147                 [f6][f5][f4][f3][f2][f1][f0] = otx2_ssogws_dual_deq_seg_ ##name,
 148 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
 149 #undef R
 150         };
 151
 152         const event_dequeue_burst_t
 153                 ssogws_dual_deq_seg_burst[2][2][2][2][2][2][2] = {
 154 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
 155                 [f6][f5][f4][f3][f2][f1][f0] =                          \
 156                         otx2_ssogws_dual_deq_seg_burst_ ##name,
 157 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
 158 #undef R
 159         };
 160
 161         const event_dequeue_t
 162                 ssogws_dual_deq_seg_timeout[2][2][2][2][2][2][2] = {
 163 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
 164                 [f6][f5][f4][f3][f2][f1][f0] =                          \
 165                         otx2_ssogws_dual_deq_seg_timeout_ ##name,
 166 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
 167 #undef R
 168         };
 169
 170         const event_dequeue_burst_t
 171                 ssogws_dual_deq_seg_timeout_burst[2][2][2][2][2][2][2] = {
 172 #define R(name, f6, f5, f4, f3, f2, f1, f0, flags)                      \
 173                 [f6][f5][f4][f3][f2][f1][f0] =                          \
 174                         otx2_ssogws_dual_deq_seg_timeout_burst_ ##name,
 175 SSO_RX_ADPTR_ENQ_FASTPATH_FUNC
 176 #undef R
 177         };
 178
 179         /* Tx modes */
 180         const event_tx_adapter_enqueue
 181                 ssogws_tx_adptr_enq[2][2][2][2][2][2][2] = {
 182 #define T(name, f6, f5, f4, f3, f2, f1, f0, sz, flags)                  \
 183                 [f6][f5][f4][f3][f2][f1][f0] =                          \
 184                         otx2_ssogws_tx_adptr_enq_ ## name,
 185 SSO_TX_ADPTR_ENQ_FASTPATH_FUNC
 186 #undef T
 187         };
 188
 189         const event_tx_adapter_enqueue
 190                 ssogws_tx_adptr_enq_seg[2][2][2][2][2][2][2] = {
 191 #define T(name, f6, f5, f4, f3, f2, f1, f0, sz, flags)                  \
 192                 [f6][f5][f4][f3][f2][f1][f0] =                          \
 193                         otx2_ssogws_tx_adptr_enq_seg_ ## name,
 194 SSO_TX_ADPTR_ENQ_FASTPATH_FUNC
 195 #undef T
 196         };
 197
 198         const event_tx_adapter_enqueue
 199                 ssogws_dual_tx_adptr_enq[2][2][2][2][2][2][2] = {
 200 #define T(name, f6, f5, f4, f3, f2, f1, f0, sz, flags)                  \
 201                 [f6][f5][f4][f3][f2][f1][f0] =                          \
 202                         otx2_ssogws_dual_tx_adptr_enq_ ## name,
 203 SSO_TX_ADPTR_ENQ_FASTPATH_FUNC
 204 #undef T
 205         };
 206
 207         const event_tx_adapter_enqueue
 208                 ssogws_dual_tx_adptr_enq_seg[2][2][2][2][2][2][2] = {
 209 #define T(name, f6, f5, f4, f3, f2, f1, f0, sz, flags)                  \
 210                 [f6][f5][f4][f3][f2][f1][f0] =                          \
 211                         otx2_ssogws_dual_tx_adptr_enq_seg_ ## name,
 212 SSO_TX_ADPTR_ENQ_FASTPATH_FUNC
 213 #undef T
 214         };
 215
 216         event_dev->enqueue                      = otx2_ssogws_enq;
 217         event_dev->enqueue_burst                = otx2_ssogws_enq_burst;
 218         event_dev->enqueue_new_burst            = otx2_ssogws_enq_new_burst;
 219         event_dev->enqueue_forward_burst        = otx2_ssogws_enq_fwd_burst;
 220         if (dev->rx_offloads & NIX_RX_MULTI_SEG_F) {
 221                 event_dev->dequeue              = ssogws_deq_seg
 222                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_SECURITY_F)]
 223                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_TSTAMP_F)]
 224                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 225                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 226                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_CHECKSUM_F)]
 227                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_PTYPE_F)]
 228                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_RSS_F)];
 229                 event_dev->dequeue_burst        = ssogws_deq_seg_burst
 230                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_SECURITY_F)]
 231                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_TSTAMP_F)]
 232                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 233                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 234                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_CHECKSUM_F)]
 235                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_PTYPE_F)]
 236                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_RSS_F)];
 237                 if (dev->is_timeout_deq) {
 238                         event_dev->dequeue      = ssogws_deq_seg_timeout
 239                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_SECURITY_F)]
 240                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_TSTAMP_F)]
 241                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 242                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 243                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_CHECKSUM_F)]
 244                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_PTYPE_F)]
 245                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_RSS_F)];
 246                         event_dev->dequeue_burst        =
 247                                 ssogws_deq_seg_timeout_burst
 248                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_SECURITY_F)]
 249                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_TSTAMP_F)]
 250                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 251                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 252                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_CHECKSUM_F)]
 253                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_PTYPE_F)]
 254                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_RSS_F)];
 255                 }
 256         } else {
 257                 event_dev->dequeue                      = ssogws_deq
 258                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_SECURITY_F)]
 259                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_TSTAMP_F)]
 260                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 261                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 262                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_CHECKSUM_F)]
 263                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_PTYPE_F)]
 264                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_RSS_F)];
 265                 event_dev->dequeue_burst                = ssogws_deq_burst
 266                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_SECURITY_F)]
 267                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_TSTAMP_F)]
 268                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 269                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 270                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_CHECKSUM_F)]
 271                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_PTYPE_F)]
 272                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_RSS_F)];
 273                 if (dev->is_timeout_deq) {
 274                         event_dev->dequeue              = ssogws_deq_timeout
 275                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_SECURITY_F)]
 276                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_TSTAMP_F)]
 277                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 278                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 279                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_CHECKSUM_F)]
 280                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_PTYPE_F)]
 281                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_RSS_F)];
 282                         event_dev->dequeue_burst        =
 283                                 ssogws_deq_timeout_burst
 284                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_SECURITY_F)]
 285                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_TSTAMP_F)]
 286                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 287                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 288                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_CHECKSUM_F)]
 289                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_PTYPE_F)]
 290                         [!!(dev->rx_offloads & NIX_RX_OFFLOAD_RSS_F)];
 291                 }
 292         }
 293
 294         if (dev->tx_offloads & NIX_TX_MULTI_SEG_F) {
 295                 /* [SEC] [TSMP] [MBUF_NOFF] [VLAN] [OL3_L4_CSUM] [L3_L4_CSUM] */
 296                 event_dev->txa_enqueue = ssogws_tx_adptr_enq_seg
 297                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_SECURITY_F)]
 298                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_TSO_F)]
 299                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_TSTAMP_F)]
 300                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_MBUF_NOFF_F)]
 301                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_VLAN_QINQ_F)]
 302                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_OL3_OL4_CSUM_F)]
 303                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_L3_L4_CSUM_F)];
 304         } else {
 305                 event_dev->txa_enqueue = ssogws_tx_adptr_enq
 306                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_SECURITY_F)]
 307                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_TSO_F)]
 308                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_TSTAMP_F)]
 309                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_MBUF_NOFF_F)]
 310                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_VLAN_QINQ_F)]
 311                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_OL3_OL4_CSUM_F)]
 312                         [!!(dev->tx_offloads & NIX_TX_OFFLOAD_L3_L4_CSUM_F)];
 313         }
 314
 315         if (dev->dual_ws) {
 316                 event_dev->enqueue              = otx2_ssogws_dual_enq;
 317                 event_dev->enqueue_burst        = otx2_ssogws_dual_enq_burst;
 318                 event_dev->enqueue_new_burst    =
 319                                         otx2_ssogws_dual_enq_new_burst;
 320                 event_dev->enqueue_forward_burst =
 321                                         otx2_ssogws_dual_enq_fwd_burst;
 322
 323                 if (dev->rx_offloads & NIX_RX_MULTI_SEG_F) {
 324                         event_dev->dequeue      = ssogws_dual_deq_seg
 325                                 [!!(dev->rx_offloads &
 326                                                 NIX_RX_OFFLOAD_SECURITY_F)]
 327                                 [!!(dev->rx_offloads &
 328                                                 NIX_RX_OFFLOAD_TSTAMP_F)]
 329                                 [!!(dev->rx_offloads &
 330                                                 NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 331                                 [!!(dev->rx_offloads &
 332                                                 NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 333                                 [!!(dev->rx_offloads &
 334                                                 NIX_RX_OFFLOAD_CHECKSUM_F)]
 335                                 [!!(dev->rx_offloads & NIX_RX_OFFLOAD_PTYPE_F)]
 336                                 [!!(dev->rx_offloads & NIX_RX_OFFLOAD_RSS_F)];
 337                         event_dev->dequeue_burst = ssogws_dual_deq_seg_burst
 338                                 [!!(dev->rx_offloads &
 339                                                 NIX_RX_OFFLOAD_SECURITY_F)]
 340                                 [!!(dev->rx_offloads & NIX_RX_OFFLOAD_TSTAMP_F)]
 341                                 [!!(dev->rx_offloads &
 342                                                 NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 343                                 [!!(dev->rx_offloads &
 344                                                 NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 345                                 [!!(dev->rx_offloads &
 346                                                 NIX_RX_OFFLOAD_CHECKSUM_F)]
 347                                 [!!(dev->rx_offloads & NIX_RX_OFFLOAD_PTYPE_F)]
 348                                 [!!(dev->rx_offloads & NIX_RX_OFFLOAD_RSS_F)];
 349                         if (dev->is_timeout_deq) {
 350                                 event_dev->dequeue      =
 351                                         ssogws_dual_deq_seg_timeout
 352                                         [!!(dev->rx_offloads &
 353                                                 NIX_RX_OFFLOAD_SECURITY_F)]
 354                                         [!!(dev->rx_offloads &
 355                                                 NIX_RX_OFFLOAD_TSTAMP_F)]
 356                                         [!!(dev->rx_offloads &
 357                                                 NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 358                                         [!!(dev->rx_offloads &
 359                                                 NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 360                                         [!!(dev->rx_offloads &
 361                                                 NIX_RX_OFFLOAD_CHECKSUM_F)]
 362                                         [!!(dev->rx_offloads &
 363                                                         NIX_RX_OFFLOAD_PTYPE_F)]
 364                                         [!!(dev->rx_offloads &
 365                                                         NIX_RX_OFFLOAD_RSS_F)];
 366                                 event_dev->dequeue_burst =
 367                                         ssogws_dual_deq_seg_timeout_burst
 368                                         [!!(dev->rx_offloads &
 369                                                 NIX_RX_OFFLOAD_SECURITY_F)]
 370                                         [!!(dev->rx_offloads &
 371                                                 NIX_RX_OFFLOAD_TSTAMP_F)]
 372                                         [!!(dev->rx_offloads &
 373                                                 NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 374                                         [!!(dev->rx_offloads &
 375                                                 NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 376                                         [!!(dev->rx_offloads &
 377                                                 NIX_RX_OFFLOAD_CHECKSUM_F)]
 378                                         [!!(dev->rx_offloads &
 379                                                         NIX_RX_OFFLOAD_PTYPE_F)]
 380                                         [!!(dev->rx_offloads &
 381                                                         NIX_RX_OFFLOAD_RSS_F)];
 382                         }
 383                 } else {
 384                         event_dev->dequeue              = ssogws_dual_deq
 385                                 [!!(dev->rx_offloads &
 386                                                 NIX_RX_OFFLOAD_SECURITY_F)]
 387                                 [!!(dev->rx_offloads &
 388                                                 NIX_RX_OFFLOAD_TSTAMP_F)]
 389                                 [!!(dev->rx_offloads &
 390                                                 NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 391                                 [!!(dev->rx_offloads &
 392                                                 NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 393                                 [!!(dev->rx_offloads &
 394                                                 NIX_RX_OFFLOAD_CHECKSUM_F)]
 395                                 [!!(dev->rx_offloads & NIX_RX_OFFLOAD_PTYPE_F)]
 396                                 [!!(dev->rx_offloads & NIX_RX_OFFLOAD_RSS_F)];
 397                         event_dev->dequeue_burst        = ssogws_dual_deq_burst
 398                                 [!!(dev->rx_offloads &
 399                                                 NIX_RX_OFFLOAD_SECURITY_F)]
 400                                 [!!(dev->rx_offloads &
 401                                                 NIX_RX_OFFLOAD_TSTAMP_F)]
 402                                 [!!(dev->rx_offloads &
 403                                                 NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 404                                 [!!(dev->rx_offloads &
 405                                                 NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 406                                 [!!(dev->rx_offloads &
 407                                                 NIX_RX_OFFLOAD_CHECKSUM_F)]
 408                                 [!!(dev->rx_offloads & NIX_RX_OFFLOAD_PTYPE_F)]
 409                                 [!!(dev->rx_offloads & NIX_RX_OFFLOAD_RSS_F)];
 410                         if (dev->is_timeout_deq) {
 411                                 event_dev->dequeue      =
 412                                         ssogws_dual_deq_timeout
 413                                         [!!(dev->rx_offloads &
 414                                                 NIX_RX_OFFLOAD_SECURITY_F)]
 415                                         [!!(dev->rx_offloads &
 416                                                 NIX_RX_OFFLOAD_TSTAMP_F)]
 417                                         [!!(dev->rx_offloads &
 418                                                 NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 419                                         [!!(dev->rx_offloads &
 420                                                 NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 421                                         [!!(dev->rx_offloads &
 422                                                 NIX_RX_OFFLOAD_CHECKSUM_F)]
 423                                         [!!(dev->rx_offloads &
 424                                                         NIX_RX_OFFLOAD_PTYPE_F)]
 425                                         [!!(dev->rx_offloads &
 426                                                         NIX_RX_OFFLOAD_RSS_F)];
 427                                 event_dev->dequeue_burst =
 428                                         ssogws_dual_deq_timeout_burst
 429                                         [!!(dev->rx_offloads &
 430                                                 NIX_RX_OFFLOAD_SECURITY_F)]
 431                                         [!!(dev->rx_offloads &
 432                                                 NIX_RX_OFFLOAD_TSTAMP_F)]
 433                                         [!!(dev->rx_offloads &
 434                                                 NIX_RX_OFFLOAD_MARK_UPDATE_F)]
 435                                         [!!(dev->rx_offloads &
 436                                                 NIX_RX_OFFLOAD_VLAN_STRIP_F)]
 437                                         [!!(dev->rx_offloads &
 438                                                 NIX_RX_OFFLOAD_CHECKSUM_F)]
 439                                         [!!(dev->rx_offloads &
 440                                                         NIX_RX_OFFLOAD_PTYPE_F)]
 441                                         [!!(dev->rx_offloads &
 442                                                         NIX_RX_OFFLOAD_RSS_F)];
 443                         }
 444                 }
 445
 446                 if (dev->tx_offloads & NIX_TX_MULTI_SEG_F) {
 447                 /* [SEC] [TSMP] [MBUF_NOFF] [VLAN] [OL3_L4_CSUM] [L3_L4_CSUM] */
 448                         event_dev->txa_enqueue = ssogws_dual_tx_adptr_enq_seg
 449                                 [!!(dev->tx_offloads &
 450                                                 NIX_TX_OFFLOAD_SECURITY_F)]
 451                                 [!!(dev->tx_offloads & NIX_TX_OFFLOAD_TSO_F)]
 452                                 [!!(dev->tx_offloads & NIX_TX_OFFLOAD_TSTAMP_F)]
 453                                 [!!(dev->tx_offloads &
 454                                                 NIX_TX_OFFLOAD_MBUF_NOFF_F)]
 455                                 [!!(dev->tx_offloads &
 456                                                 NIX_TX_OFFLOAD_VLAN_QINQ_F)]
 457                                 [!!(dev->tx_offloads &
 458                                                 NIX_TX_OFFLOAD_OL3_OL4_CSUM_F)]
 459                                 [!!(dev->tx_offloads &
 460                                                 NIX_TX_OFFLOAD_L3_L4_CSUM_F)];
 461                 } else {
 462                         event_dev->txa_enqueue = ssogws_dual_tx_adptr_enq
 463                                 [!!(dev->tx_offloads &
 464                                                 NIX_TX_OFFLOAD_SECURITY_F)]
 465                                 [!!(dev->tx_offloads & NIX_TX_OFFLOAD_TSO_F)]
 466                                 [!!(dev->tx_offloads & NIX_TX_OFFLOAD_TSTAMP_F)]
 467                                 [!!(dev->tx_offloads &
 468                                                 NIX_TX_OFFLOAD_MBUF_NOFF_F)]
 469                                 [!!(dev->tx_offloads &
 470                                                 NIX_TX_OFFLOAD_VLAN_QINQ_F)]
 471                                 [!!(dev->tx_offloads &
 472                                                 NIX_TX_OFFLOAD_OL3_OL4_CSUM_F)]
 473                                 [!!(dev->tx_offloads &
 474                                                 NIX_TX_OFFLOAD_L3_L4_CSUM_F)];
 475                 }
 476         }
 477
 478         event_dev->txa_enqueue_same_dest = event_dev->txa_enqueue;
 479         rte_mb();
 480 }
 481
 482 static void
 483 otx2_sso_info_get(struct rte_eventdev *event_dev,
 484                   struct rte_event_dev_info *dev_info)
 485 {
 486         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
 487
 488         dev_info->driver_name = RTE_STR(EVENTDEV_NAME_OCTEONTX2_PMD);
 489         dev_info->min_dequeue_timeout_ns = dev->min_dequeue_timeout_ns;
 490         dev_info->max_dequeue_timeout_ns = dev->max_dequeue_timeout_ns;
 491         dev_info->max_event_queues = dev->max_event_queues;
 492         dev_info->max_event_queue_flows = (1ULL << 20);
 493         dev_info->max_event_queue_priority_levels = 8;
 494         dev_info->max_event_priority_levels = 1;
 495         dev_info->max_event_ports = dev->max_event_ports;
 496         dev_info->max_event_port_dequeue_depth = 1;
 497         dev_info->max_event_port_enqueue_depth = 1;
 498         dev_info->max_num_events =  dev->max_num_events;
 499         dev_info->event_dev_cap = RTE_EVENT_DEV_CAP_QUEUE_QOS |
 500                                         RTE_EVENT_DEV_CAP_DISTRIBUTED_SCHED |
 501                                         RTE_EVENT_DEV_CAP_QUEUE_ALL_TYPES |
 502                                         RTE_EVENT_DEV_CAP_RUNTIME_PORT_LINK |
 503                                         RTE_EVENT_DEV_CAP_MULTIPLE_QUEUE_PORT |
 504                                         RTE_EVENT_DEV_CAP_NONSEQ_MODE |
 505                                         RTE_EVENT_DEV_CAP_CARRY_FLOW_ID;
 506 }
 507
 508 static void
 509 sso_port_link_modify(struct otx2_ssogws *ws, uint8_t queue, uint8_t enable)
 510 {
 511         uintptr_t base = OTX2_SSOW_GET_BASE_ADDR(ws->getwrk_op);
 512         uint64_t val;
 513
 514         val = queue;
 515         val |= 0ULL << 12; /* SET 0 */
 516         val |= 0x8000800080000000; /* Dont modify rest of the masks */
 517         val |= (uint64_t)enable << 14;   /* Enable/Disable Membership. */
 518
 519         otx2_write64(val, base + SSOW_LF_GWS_GRPMSK_CHG);
 520 }
 521
 522 static int
 523 otx2_sso_port_link(struct rte_eventdev *event_dev, void *port,
 524                    const uint8_t queues[], const uint8_t priorities[],
 525                    uint16_t nb_links)
 526 {
 527         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
 528         uint8_t port_id = 0;
 529         uint16_t link;
 530
 531         RTE_SET_USED(priorities);
 532         for (link = 0; link < nb_links; link++) {
 533                 if (dev->dual_ws) {
 534                         struct otx2_ssogws_dual *ws = port;
 535
 536                         port_id = ws->port;
 537                         sso_port_link_modify((struct otx2_ssogws *)
 538                                         &ws->ws_state[0], queues[link], true);
 539                         sso_port_link_modify((struct otx2_ssogws *)
 540                                         &ws->ws_state[1], queues[link], true);
 541                 } else {
 542                         struct otx2_ssogws *ws = port;
 543
 544                         port_id = ws->port;
 545                         sso_port_link_modify(ws, queues[link], true);
 546                 }
 547         }
 548         sso_func_trace("Port=%d nb_links=%d", port_id, nb_links);
 549
 550         return (int)nb_links;
 551 }
 552
 553 static int
 554 otx2_sso_port_unlink(struct rte_eventdev *event_dev, void *port,
 555                      uint8_t queues[], uint16_t nb_unlinks)
 556 {
 557         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
 558         uint8_t port_id = 0;
 559         uint16_t unlink;
 560
 561         for (unlink = 0; unlink < nb_unlinks; unlink++) {
 562                 if (dev->dual_ws) {
 563                         struct otx2_ssogws_dual *ws = port;
 564
 565                         port_id = ws->port;
 566                         sso_port_link_modify((struct otx2_ssogws *)
 567                                         &ws->ws_state[0], queues[unlink],
 568                                         false);
 569                         sso_port_link_modify((struct otx2_ssogws *)
 570                                         &ws->ws_state[1], queues[unlink],
 571                                         false);
 572                 } else {
 573                         struct otx2_ssogws *ws = port;
 574
 575                         port_id = ws->port;
 576                         sso_port_link_modify(ws, queues[unlink], false);
 577                 }
 578         }
 579         sso_func_trace("Port=%d nb_unlinks=%d", port_id, nb_unlinks);
 580
 581         return (int)nb_unlinks;
 582 }
 583
 584 static int
 585 sso_hw_lf_cfg(struct otx2_mbox *mbox, enum otx2_sso_lf_type type,
 586               uint16_t nb_lf, uint8_t attach)
 587 {
 588         if (attach) {
 589                 struct rsrc_attach_req *req;
 590
 591                 req = otx2_mbox_alloc_msg_attach_resources(mbox);
 592                 switch (type) {
 593                 case SSO_LF_GGRP:
 594                         req->sso = nb_lf;
 595                         break;
 596                 case SSO_LF_GWS:
 597                         req->ssow = nb_lf;
 598                         break;
 599                 default:
 600                         return -EINVAL;
 601                 }
 602                 req->modify = true;
 603                 if (otx2_mbox_process(mbox) < 0)
 604                         return -EIO;
 605         } else {
 606                 struct rsrc_detach_req *req;
 607
 608                 req = otx2_mbox_alloc_msg_detach_resources(mbox);
 609                 switch (type) {
 610                 case SSO_LF_GGRP:
 611                         req->sso = true;
 612                         break;
 613                 case SSO_LF_GWS:
 614                         req->ssow = true;
 615                         break;
 616                 default:
 617                         return -EINVAL;
 618                 }
 619                 req->partial = true;
 620                 if (otx2_mbox_process(mbox) < 0)
 621                         return -EIO;
 622         }
 623
 624         return 0;
 625 }
 626
 627 static int
 628 sso_lf_cfg(struct otx2_sso_evdev *dev, struct otx2_mbox *mbox,
 629            enum otx2_sso_lf_type type, uint16_t nb_lf, uint8_t alloc)
 630 {
 631         void *rsp;
 632         int rc;
 633
 634         if (alloc) {
 635                 switch (type) {
 636                 case SSO_LF_GGRP:
 637                         {
 638                         struct sso_lf_alloc_req *req_ggrp;
 639                         req_ggrp = otx2_mbox_alloc_msg_sso_lf_alloc(mbox);
 640                         req_ggrp->hwgrps = nb_lf;
 641                         }
 642                         break;
 643                 case SSO_LF_GWS:
 644                         {
 645                         struct ssow_lf_alloc_req *req_hws;
 646                         req_hws = otx2_mbox_alloc_msg_ssow_lf_alloc(mbox);
 647                         req_hws->hws = nb_lf;
 648                         }
 649                         break;
 650                 default:
 651                         return -EINVAL;
 652                 }
 653         } else {
 654                 switch (type) {
 655                 case SSO_LF_GGRP:
 656                         {
 657                         struct sso_lf_free_req *req_ggrp;
 658                         req_ggrp = otx2_mbox_alloc_msg_sso_lf_free(mbox);
 659                         req_ggrp->hwgrps = nb_lf;
 660                         }
 661                         break;
 662                 case SSO_LF_GWS:
 663                         {
 664                         struct ssow_lf_free_req *req_hws;
 665                         req_hws = otx2_mbox_alloc_msg_ssow_lf_free(mbox);
 666                         req_hws->hws = nb_lf;
 667                         }
 668                         break;
 669                 default:
 670                         return -EINVAL;
 671                 }
 672         }
 673
 674         rc = otx2_mbox_process_msg_tmo(mbox, (void **)&rsp, ~0);
 675         if (rc < 0)
 676                 return rc;
 677
 678         if (alloc && type == SSO_LF_GGRP) {
 679                 struct sso_lf_alloc_rsp *rsp_ggrp = rsp;
 680
 681                 dev->xaq_buf_size = rsp_ggrp->xaq_buf_size;
 682                 dev->xae_waes = rsp_ggrp->xaq_wq_entries;
 683                 dev->iue = rsp_ggrp->in_unit_entries;
 684         }
 685
 686         return 0;
 687 }
 688
 689 static void
 690 otx2_sso_port_release(void *port)
 691 {
 692         struct otx2_ssogws_cookie *gws_cookie = ssogws_get_cookie(port);
 693         struct otx2_sso_evdev *dev;
 694         int i;
 695
 696         if (!gws_cookie->configured)
 697                 goto free;
 698
 699         dev = sso_pmd_priv(gws_cookie->event_dev);
 700         if (dev->dual_ws) {
 701                 struct otx2_ssogws_dual *ws = port;
 702
 703                 for (i = 0; i < dev->nb_event_queues; i++) {
 704                         sso_port_link_modify((struct otx2_ssogws *)
 705                                              &ws->ws_state[0], i, false);
 706                         sso_port_link_modify((struct otx2_ssogws *)
 707                                              &ws->ws_state[1], i, false);
 708                 }
 709                 memset(ws, 0, sizeof(*ws));
 710         } else {
 711                 struct otx2_ssogws *ws = port;
 712
 713                 for (i = 0; i < dev->nb_event_queues; i++)
 714                         sso_port_link_modify(ws, i, false);
 715                 memset(ws, 0, sizeof(*ws));
 716         }
 717
 718         memset(gws_cookie, 0, sizeof(*gws_cookie));
 719
 720 free:
 721         rte_free(gws_cookie);
 722 }
 723
 724 static void
 725 otx2_sso_queue_release(struct rte_eventdev *event_dev, uint8_t queue_id)
 726 {
 727         RTE_SET_USED(event_dev);
 728         RTE_SET_USED(queue_id);
 729 }
 730
 731 static void
 732 sso_restore_links(const struct rte_eventdev *event_dev)
 733 {
 734         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
 735         uint16_t *links_map;
 736         int i, j;
 737
 738         for (i = 0; i < dev->nb_event_ports; i++) {
 739                 links_map = event_dev->data->links_map;
 740                 /* Point links_map to this port specific area */
 741                 links_map += (i * RTE_EVENT_MAX_QUEUES_PER_DEV);
 742                 if (dev->dual_ws) {
 743                         struct otx2_ssogws_dual *ws;
 744
 745                         ws = event_dev->data->ports[i];
 746                         for (j = 0; j < dev->nb_event_queues; j++) {
 747                                 if (links_map[j] == 0xdead)
 748                                         continue;
 749                                 sso_port_link_modify((struct otx2_ssogws *)
 750                                                 &ws->ws_state[0], j, true);
 751                                 sso_port_link_modify((struct otx2_ssogws *)
 752                                                 &ws->ws_state[1], j, true);
 753                                 sso_func_trace("Restoring port %d queue %d "
 754                                                 "link", i, j);
 755                         }
 756                 } else {
 757                         struct otx2_ssogws *ws;
 758
 759                         ws = event_dev->data->ports[i];
 760                         for (j = 0; j < dev->nb_event_queues; j++) {
 761                                 if (links_map[j] == 0xdead)
 762                                         continue;
 763                                 sso_port_link_modify(ws, j, true);
 764                                 sso_func_trace("Restoring port %d queue %d "
 765                                                 "link", i, j);
 766                         }
 767                 }
 768         }
 769 }
 770
 771 static void
 772 sso_set_port_ops(struct otx2_ssogws *ws, uintptr_t base)
 773 {
 774         ws->tag_op              = base + SSOW_LF_GWS_TAG;
 775         ws->wqp_op              = base + SSOW_LF_GWS_WQP;
 776         ws->getwrk_op           = base + SSOW_LF_GWS_OP_GET_WORK;
 777         ws->swtag_flush_op      = base + SSOW_LF_GWS_OP_SWTAG_FLUSH;
 778         ws->swtag_norm_op       = base + SSOW_LF_GWS_OP_SWTAG_NORM;
 779         ws->swtag_desched_op    = base + SSOW_LF_GWS_OP_SWTAG_DESCHED;
 780 }
 781
 782 static int
 783 sso_configure_dual_ports(const struct rte_eventdev *event_dev)
 784 {
 785         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
 786         struct otx2_mbox *mbox = dev->mbox;
 787         uint8_t vws = 0;
 788         uint8_t nb_lf;
 789         int i, rc;
 790
 791         otx2_sso_dbg("Configuring event ports %d", dev->nb_event_ports);
 792
 793         nb_lf = dev->nb_event_ports * 2;
 794         /* Ask AF to attach required LFs. */
 795         rc = sso_hw_lf_cfg(mbox, SSO_LF_GWS, nb_lf, true);
 796         if (rc < 0) {
 797                 otx2_err("Failed to attach SSO GWS LF");
 798                 return -ENODEV;
 799         }
 800
 801         if (sso_lf_cfg(dev, mbox, SSO_LF_GWS, nb_lf, true) < 0) {
 802                 sso_hw_lf_cfg(mbox, SSO_LF_GWS, nb_lf, false);
 803                 otx2_err("Failed to init SSO GWS LF");
 804                 return -ENODEV;
 805         }
 806
 807         for (i = 0; i < dev->nb_event_ports; i++) {
 808                 struct otx2_ssogws_cookie *gws_cookie;
 809                 struct otx2_ssogws_dual *ws;
 810                 uintptr_t base;
 811
 812                 if (event_dev->data->ports[i] != NULL) {
 813                         ws = event_dev->data->ports[i];
 814                 } else {
 815                         /* Allocate event port memory */
 816                         ws = rte_zmalloc_socket("otx2_sso_ws",
 817                                         sizeof(struct otx2_ssogws_dual) +
 818                                         RTE_CACHE_LINE_SIZE,
 819                                         RTE_CACHE_LINE_SIZE,
 820                                         event_dev->data->socket_id);
 821                         if (ws == NULL) {
 822                                 otx2_err("Failed to alloc memory for port=%d",
 823                                          i);
 824                                 rc = -ENOMEM;
 825                                 break;
 826                         }
 827
 828                         /* First cache line is reserved for cookie */
 829                         ws = (struct otx2_ssogws_dual *)
 830                                 ((uint8_t *)ws + RTE_CACHE_LINE_SIZE);
 831                 }
 832
 833                 ws->port = i;
 834                 base = dev->bar2 + (RVU_BLOCK_ADDR_SSOW << 20 | vws << 12);
 835                 sso_set_port_ops((struct otx2_ssogws *)&ws->ws_state[0], base);
 836                 ws->base[0] = base;
 837                 vws++;
 838
 839                 base = dev->bar2 + (RVU_BLOCK_ADDR_SSOW << 20 | vws << 12);
 840                 sso_set_port_ops((struct otx2_ssogws *)&ws->ws_state[1], base);
 841                 ws->base[1] = base;
 842                 vws++;
 843
 844                 gws_cookie = ssogws_get_cookie(ws);
 845                 gws_cookie->event_dev = event_dev;
 846                 gws_cookie->configured = 1;
 847
 848                 event_dev->data->ports[i] = ws;
 849         }
 850
 851         if (rc < 0) {
 852                 sso_lf_cfg(dev, mbox, SSO_LF_GWS, nb_lf, false);
 853                 sso_hw_lf_cfg(mbox, SSO_LF_GWS, nb_lf, false);
 854         }
 855
 856         return rc;
 857 }
 858
 859 static int
 860 sso_configure_ports(const struct rte_eventdev *event_dev)
 861 {
 862         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
 863         struct otx2_mbox *mbox = dev->mbox;
 864         uint8_t nb_lf;
 865         int i, rc;
 866
 867         otx2_sso_dbg("Configuring event ports %d", dev->nb_event_ports);
 868
 869         nb_lf = dev->nb_event_ports;
 870         /* Ask AF to attach required LFs. */
 871         rc = sso_hw_lf_cfg(mbox, SSO_LF_GWS, nb_lf, true);
 872         if (rc < 0) {
 873                 otx2_err("Failed to attach SSO GWS LF");
 874                 return -ENODEV;
 875         }
 876
 877         if (sso_lf_cfg(dev, mbox, SSO_LF_GWS, nb_lf, true) < 0) {
 878                 sso_hw_lf_cfg(mbox, SSO_LF_GWS, nb_lf, false);
 879                 otx2_err("Failed to init SSO GWS LF");
 880                 return -ENODEV;
 881         }
 882
 883         for (i = 0; i < nb_lf; i++) {
 884                 struct otx2_ssogws_cookie *gws_cookie;
 885                 struct otx2_ssogws *ws;
 886                 uintptr_t base;
 887
 888                 /* Free memory prior to re-allocation if needed */
 889                 if (event_dev->data->ports[i] != NULL) {
 890                         ws = event_dev->data->ports[i];
 891                         rte_free(ssogws_get_cookie(ws));
 892                         ws = NULL;
 893                 }
 894
 895                 /* Allocate event port memory */
 896                 ws = rte_zmalloc_socket("otx2_sso_ws",
 897                                         sizeof(struct otx2_ssogws) +
 898                                         RTE_CACHE_LINE_SIZE,
 899                                         RTE_CACHE_LINE_SIZE,
 900                                         event_dev->data->socket_id);
 901                 if (ws == NULL) {
 902                         otx2_err("Failed to alloc memory for port=%d", i);
 903                         rc = -ENOMEM;
 904                         break;
 905                 }
 906
 907                 /* First cache line is reserved for cookie */
 908                 ws = (struct otx2_ssogws *)
 909                         ((uint8_t *)ws + RTE_CACHE_LINE_SIZE);
 910
 911                 ws->port = i;
 912                 base = dev->bar2 + (RVU_BLOCK_ADDR_SSOW << 20 | i << 12);
 913                 sso_set_port_ops(ws, base);
 914                 ws->base = base;
 915
 916                 gws_cookie = ssogws_get_cookie(ws);
 917                 gws_cookie->event_dev = event_dev;
 918                 gws_cookie->configured = 1;
 919
 920                 event_dev->data->ports[i] = ws;
 921         }
 922
 923         if (rc < 0) {
 924                 sso_lf_cfg(dev, mbox, SSO_LF_GWS, nb_lf, false);
 925                 sso_hw_lf_cfg(mbox, SSO_LF_GWS, nb_lf, false);
 926         }
 927
 928         return rc;
 929 }
 930
 931 static int
 932 sso_configure_queues(const struct rte_eventdev *event_dev)
 933 {
 934         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
 935         struct otx2_mbox *mbox = dev->mbox;
 936         uint8_t nb_lf;
 937         int rc;
 938
 939         otx2_sso_dbg("Configuring event queues %d", dev->nb_event_queues);
 940
 941         nb_lf = dev->nb_event_queues;
 942         /* Ask AF to attach required LFs. */
 943         rc = sso_hw_lf_cfg(mbox, SSO_LF_GGRP, nb_lf, true);
 944         if (rc < 0) {
 945                 otx2_err("Failed to attach SSO GGRP LF");
 946                 return -ENODEV;
 947         }
 948
 949         if (sso_lf_cfg(dev, mbox, SSO_LF_GGRP, nb_lf, true) < 0) {
 950                 sso_hw_lf_cfg(mbox, SSO_LF_GGRP, nb_lf, false);
 951                 otx2_err("Failed to init SSO GGRP LF");
 952                 return -ENODEV;
 953         }
 954
 955         return rc;
 956 }
 957
 958 static int
 959 sso_xaq_allocate(struct otx2_sso_evdev *dev)
 960 {
 961         const struct rte_memzone *mz;
 962         struct npa_aura_s *aura;
 963         static int reconfig_cnt;
 964         char pool_name[RTE_MEMZONE_NAMESIZE];
 965         uint32_t xaq_cnt;
 966         int rc;
 967
 968         if (dev->xaq_pool)
 969                 rte_mempool_free(dev->xaq_pool);
 970
 971         /*
 972          * Allocate memory for Add work backpressure.
 973          */
 974         mz = rte_memzone_lookup(OTX2_SSO_FC_NAME);
 975         if (mz == NULL)
 976                 mz = rte_memzone_reserve_aligned(OTX2_SSO_FC_NAME,
 977                                                  OTX2_ALIGN +
 978                                                  sizeof(struct npa_aura_s),
 979                                                  rte_socket_id(),
 980                                                  RTE_MEMZONE_IOVA_CONTIG,
 981                                                  OTX2_ALIGN);
 982         if (mz == NULL) {
 983                 otx2_err("Failed to allocate mem for fcmem");
 984                 return -ENOMEM;
 985         }
 986
 987         dev->fc_iova = mz->iova;
 988         dev->fc_mem = mz->addr;
 989
 990         aura = (struct npa_aura_s *)((uintptr_t)dev->fc_mem + OTX2_ALIGN);
 991         memset(aura, 0, sizeof(struct npa_aura_s));
 992
 993         aura->fc_ena = 1;
 994         aura->fc_addr = dev->fc_iova;
 995         aura->fc_hyst_bits = 0; /* Store count on all updates */
 996
 997         /* Taken from HRM 14.3.3(4) */
 998         xaq_cnt = dev->nb_event_queues * OTX2_SSO_XAQ_CACHE_CNT;
 999         if (dev->xae_cnt)
1000                 xaq_cnt += dev->xae_cnt / dev->xae_waes;
1001         else if (dev->adptr_xae_cnt)
1002                 xaq_cnt += (dev->adptr_xae_cnt / dev->xae_waes) +
1003                         (OTX2_SSO_XAQ_SLACK * dev->nb_event_queues);
1004         else
1005                 xaq_cnt += (dev->iue / dev->xae_waes) +
1006                         (OTX2_SSO_XAQ_SLACK * dev->nb_event_queues);
1007
1008         otx2_sso_dbg("Configuring %d xaq buffers", xaq_cnt);
1009         /* Setup XAQ based on number of nb queues. */
1010         snprintf(pool_name, 30, "otx2_xaq_buf_pool_%d", reconfig_cnt);
1011         dev->xaq_pool = (void *)rte_mempool_create_empty(pool_name,
1012                         xaq_cnt, dev->xaq_buf_size, 0, 0,
1013                         rte_socket_id(), 0);
1014
1015         if (dev->xaq_pool == NULL) {
1016                 otx2_err("Unable to create empty mempool.");
1017                 rte_memzone_free(mz);
1018                 return -ENOMEM;
1019         }
1020
1021         rc = rte_mempool_set_ops_byname(dev->xaq_pool,
1022                                         rte_mbuf_platform_mempool_ops(), aura);
1023         if (rc != 0) {
1024                 otx2_err("Unable to set xaqpool ops.");
1025                 goto alloc_fail;
1026         }
1027
1028         rc = rte_mempool_populate_default(dev->xaq_pool);
1029         if (rc < 0) {
1030                 otx2_err("Unable to set populate xaqpool.");
1031                 goto alloc_fail;
1032         }
1033         reconfig_cnt++;
1034         /* When SW does addwork (enqueue) check if there is space in XAQ by
1035          * comparing fc_addr above against the xaq_lmt calculated below.
1036          * There should be a minimum headroom (OTX2_SSO_XAQ_SLACK / 2) for SSO
1037          * to request XAQ to cache them even before enqueue is called.
1038          */
1039         dev->xaq_lmt = xaq_cnt - (OTX2_SSO_XAQ_SLACK / 2 *
1040                                   dev->nb_event_queues);
1041         dev->nb_xaq_cfg = xaq_cnt;
1042
1043         return 0;
1044 alloc_fail:
1045         rte_mempool_free(dev->xaq_pool);
1046         rte_memzone_free(mz);
1047         return rc;
1048 }
1049
1050 static int
1051 sso_ggrp_alloc_xaq(struct otx2_sso_evdev *dev)
1052 {
1053         struct otx2_mbox *mbox = dev->mbox;
1054         struct sso_hw_setconfig *req;
1055
1056         otx2_sso_dbg("Configuring XAQ for GGRPs");
1057         req = otx2_mbox_alloc_msg_sso_hw_setconfig(mbox);
1058         req->npa_pf_func = otx2_npa_pf_func_get();
1059         req->npa_aura_id = npa_lf_aura_handle_to_aura(dev->xaq_pool->pool_id);
1060         req->hwgrps = dev->nb_event_queues;
1061
1062         return otx2_mbox_process(mbox);
1063 }
1064
1065 static void
1066 sso_lf_teardown(struct otx2_sso_evdev *dev,
1067                 enum otx2_sso_lf_type lf_type)
1068 {
1069         uint8_t nb_lf;
1070
1071         switch (lf_type) {
1072         case SSO_LF_GGRP:
1073                 nb_lf = dev->nb_event_queues;
1074                 break;
1075         case SSO_LF_GWS:
1076                 nb_lf = dev->nb_event_ports;
1077                 nb_lf *= dev->dual_ws ? 2 : 1;
1078                 break;
1079         default:
1080                 return;
1081         }
1082
1083         sso_lf_cfg(dev, dev->mbox, lf_type, nb_lf, false);
1084         sso_hw_lf_cfg(dev->mbox, lf_type, nb_lf, false);
1085 }
1086
1087 static int
1088 otx2_sso_configure(const struct rte_eventdev *event_dev)
1089 {
1090         struct rte_event_dev_config *conf = &event_dev->data->dev_conf;
1091         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
1092         uint32_t deq_tmo_ns;
1093         int rc;
1094
1095         sso_func_trace();
1096         deq_tmo_ns = conf->dequeue_timeout_ns;
1097
1098         if (deq_tmo_ns == 0)
1099                 deq_tmo_ns = dev->min_dequeue_timeout_ns;
1100
1101         if (deq_tmo_ns < dev->min_dequeue_timeout_ns ||
1102             deq_tmo_ns > dev->max_dequeue_timeout_ns) {
1103                 otx2_err("Unsupported dequeue timeout requested");
1104                 return -EINVAL;
1105         }
1106
1107         if (conf->event_dev_cfg & RTE_EVENT_DEV_CFG_PER_DEQUEUE_TIMEOUT)
1108                 dev->is_timeout_deq = 1;
1109
1110         dev->deq_tmo_ns = deq_tmo_ns;
1111
1112         if (conf->nb_event_ports > dev->max_event_ports ||
1113             conf->nb_event_queues > dev->max_event_queues) {
1114                 otx2_err("Unsupported event queues/ports requested");
1115                 return -EINVAL;
1116         }
1117
1118         if (conf->nb_event_port_dequeue_depth > 1) {
1119                 otx2_err("Unsupported event port deq depth requested");
1120                 return -EINVAL;
1121         }
1122
1123         if (conf->nb_event_port_enqueue_depth > 1) {
1124                 otx2_err("Unsupported event port enq depth requested");
1125                 return -EINVAL;
1126         }
1127
1128         if (dev->configured)
1129                 sso_unregister_irqs(event_dev);
1130
1131         if (dev->nb_event_queues) {
1132                 /* Finit any previous queues. */
1133                 sso_lf_teardown(dev, SSO_LF_GGRP);
1134         }
1135         if (dev->nb_event_ports) {
1136                 /* Finit any previous ports. */
1137                 sso_lf_teardown(dev, SSO_LF_GWS);
1138         }
1139
1140         dev->nb_event_queues = conf->nb_event_queues;
1141         dev->nb_event_ports = conf->nb_event_ports;
1142
1143         if (dev->dual_ws)
1144                 rc = sso_configure_dual_ports(event_dev);
1145         else
1146                 rc = sso_configure_ports(event_dev);
1147
1148         if (rc < 0) {
1149                 otx2_err("Failed to configure event ports");
1150                 return -ENODEV;
1151         }
1152
1153         if (sso_configure_queues(event_dev) < 0) {
1154                 otx2_err("Failed to configure event queues");
1155                 rc = -ENODEV;
1156                 goto teardown_hws;
1157         }
1158
1159         if (sso_xaq_allocate(dev) < 0) {
1160                 rc = -ENOMEM;
1161                 goto teardown_hwggrp;
1162         }
1163
1164         /* Restore any prior port-queue mapping. */
1165         sso_restore_links(event_dev);
1166         rc = sso_ggrp_alloc_xaq(dev);
1167         if (rc < 0) {
1168                 otx2_err("Failed to alloc xaq to ggrp %d", rc);
1169                 goto teardown_hwggrp;
1170         }
1171
1172         rc = sso_get_msix_offsets(event_dev);
1173         if (rc < 0) {
1174                 otx2_err("Failed to get msix offsets %d", rc);
1175                 goto teardown_hwggrp;
1176         }
1177
1178         rc = sso_register_irqs(event_dev);
1179         if (rc < 0) {
1180                 otx2_err("Failed to register irq %d", rc);
1181                 goto teardown_hwggrp;
1182         }
1183
1184         dev->configured = 1;
1185         rte_mb();
1186
1187         return 0;
1188 teardown_hwggrp:
1189         sso_lf_teardown(dev, SSO_LF_GGRP);
1190 teardown_hws:
1191         sso_lf_teardown(dev, SSO_LF_GWS);
1192         dev->nb_event_queues = 0;
1193         dev->nb_event_ports = 0;
1194         dev->configured = 0;
1195         return rc;
1196 }
1197
1198 static void
1199 otx2_sso_queue_def_conf(struct rte_eventdev *event_dev, uint8_t queue_id,
1200                         struct rte_event_queue_conf *queue_conf)
1201 {
1202         RTE_SET_USED(event_dev);
1203         RTE_SET_USED(queue_id);
1204
1205         queue_conf->nb_atomic_flows = (1ULL << 20);
1206         queue_conf->nb_atomic_order_sequences = (1ULL << 20);
1207         queue_conf->event_queue_cfg = RTE_EVENT_QUEUE_CFG_ALL_TYPES;
1208         queue_conf->priority = RTE_EVENT_DEV_PRIORITY_NORMAL;
1209 }
1210
1211 static int
1212 otx2_sso_queue_setup(struct rte_eventdev *event_dev, uint8_t queue_id,
1213                      const struct rte_event_queue_conf *queue_conf)
1214 {
1215         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
1216         struct otx2_mbox *mbox = dev->mbox;
1217         struct sso_grp_priority *req;
1218         int rc;
1219
1220         sso_func_trace("Queue=%d prio=%d", queue_id, queue_conf->priority);
1221
1222         req = otx2_mbox_alloc_msg_sso_grp_set_priority(dev->mbox);
1223         req->grp = queue_id;
1224         req->weight = 0xFF;
1225         req->affinity = 0xFF;
1226         /* Normalize <0-255> to <0-7> */
1227         req->priority = queue_conf->priority / 32;
1228
1229         rc = otx2_mbox_process(mbox);
1230         if (rc < 0) {
1231                 otx2_err("Failed to set priority queue=%d", queue_id);
1232                 return rc;
1233         }
1234
1235         return 0;
1236 }
1237
1238 static void
1239 otx2_sso_port_def_conf(struct rte_eventdev *event_dev, uint8_t port_id,
1240                        struct rte_event_port_conf *port_conf)
1241 {
1242         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
1243
1244         RTE_SET_USED(port_id);
1245         port_conf->new_event_threshold = dev->max_num_events;
1246         port_conf->dequeue_depth = 1;
1247         port_conf->enqueue_depth = 1;
1248 }
1249
1250 static int
1251 otx2_sso_port_setup(struct rte_eventdev *event_dev, uint8_t port_id,
1252                     const struct rte_event_port_conf *port_conf)
1253 {
1254         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
1255         uintptr_t grps_base[OTX2_SSO_MAX_VHGRP] = {0};
1256         uint64_t val;
1257         uint16_t q;
1258
1259         sso_func_trace("Port=%d", port_id);
1260         RTE_SET_USED(port_conf);
1261
1262         if (event_dev->data->ports[port_id] == NULL) {
1263                 otx2_err("Invalid port Id %d", port_id);
1264                 return -EINVAL;
1265         }
1266
1267         for (q = 0; q < dev->nb_event_queues; q++) {
1268                 grps_base[q] = dev->bar2 + (RVU_BLOCK_ADDR_SSO << 20 | q << 12);
1269                 if (grps_base[q] == 0) {
1270                         otx2_err("Failed to get grp[%d] base addr", q);
1271                         return -EINVAL;
1272                 }
1273         }
1274
1275         /* Set get_work timeout for HWS */
1276         val = NSEC2USEC(dev->deq_tmo_ns) - 1;
1277
1278         if (dev->dual_ws) {
1279                 struct otx2_ssogws_dual *ws = event_dev->data->ports[port_id];
1280
1281                 rte_memcpy(ws->grps_base, grps_base,
1282                            sizeof(uintptr_t) * OTX2_SSO_MAX_VHGRP);
1283                 ws->fc_mem = dev->fc_mem;
1284                 ws->xaq_lmt = dev->xaq_lmt;
1285                 ws->tstamp = dev->tstamp;
1286                 otx2_write64(val, OTX2_SSOW_GET_BASE_ADDR(
1287                              ws->ws_state[0].getwrk_op) + SSOW_LF_GWS_NW_TIM);
1288                 otx2_write64(val, OTX2_SSOW_GET_BASE_ADDR(
1289                              ws->ws_state[1].getwrk_op) + SSOW_LF_GWS_NW_TIM);
1290         } else {
1291                 struct otx2_ssogws *ws = event_dev->data->ports[port_id];
1292                 uintptr_t base = OTX2_SSOW_GET_BASE_ADDR(ws->getwrk_op);
1293
1294                 rte_memcpy(ws->grps_base, grps_base,
1295                            sizeof(uintptr_t) * OTX2_SSO_MAX_VHGRP);
1296                 ws->fc_mem = dev->fc_mem;
1297                 ws->xaq_lmt = dev->xaq_lmt;
1298                 ws->tstamp = dev->tstamp;
1299                 otx2_write64(val, base + SSOW_LF_GWS_NW_TIM);
1300         }
1301
1302         otx2_sso_dbg("Port=%d ws=%p", port_id, event_dev->data->ports[port_id]);
1303
1304         return 0;
1305 }
1306
1307 static int
1308 otx2_sso_timeout_ticks(struct rte_eventdev *event_dev, uint64_t ns,
1309                        uint64_t *tmo_ticks)
1310 {
1311         RTE_SET_USED(event_dev);
1312         *tmo_ticks = NSEC2TICK(ns, rte_get_timer_hz());
1313
1314         return 0;
1315 }
1316
1317 static void
1318 ssogws_dump(struct otx2_ssogws *ws, FILE *f)
1319 {
1320         uintptr_t base = OTX2_SSOW_GET_BASE_ADDR(ws->getwrk_op);
1321
1322         fprintf(f, "SSOW_LF_GWS Base addr   0x%" PRIx64 "\n", (uint64_t)base);
1323         fprintf(f, "SSOW_LF_GWS_LINKS       0x%" PRIx64 "\n",
1324                 otx2_read64(base + SSOW_LF_GWS_LINKS));
1325         fprintf(f, "SSOW_LF_GWS_PENDWQP     0x%" PRIx64 "\n",
1326                 otx2_read64(base + SSOW_LF_GWS_PENDWQP));
1327         fprintf(f, "SSOW_LF_GWS_PENDSTATE   0x%" PRIx64 "\n",
1328                 otx2_read64(base + SSOW_LF_GWS_PENDSTATE));
1329         fprintf(f, "SSOW_LF_GWS_NW_TIM      0x%" PRIx64 "\n",
1330                 otx2_read64(base + SSOW_LF_GWS_NW_TIM));
1331         fprintf(f, "SSOW_LF_GWS_TAG         0x%" PRIx64 "\n",
1332                 otx2_read64(base + SSOW_LF_GWS_TAG));
1333         fprintf(f, "SSOW_LF_GWS_WQP         0x%" PRIx64 "\n",
1334                 otx2_read64(base + SSOW_LF_GWS_TAG));
1335         fprintf(f, "SSOW_LF_GWS_SWTP        0x%" PRIx64 "\n",
1336                 otx2_read64(base + SSOW_LF_GWS_SWTP));
1337         fprintf(f, "SSOW_LF_GWS_PENDTAG     0x%" PRIx64 "\n",
1338                 otx2_read64(base + SSOW_LF_GWS_PENDTAG));
1339 }
1340
1341 static void
1342 ssoggrp_dump(uintptr_t base, FILE *f)
1343 {
1344         fprintf(f, "SSO_LF_GGRP Base addr   0x%" PRIx64 "\n", (uint64_t)base);
1345         fprintf(f, "SSO_LF_GGRP_QCTL        0x%" PRIx64 "\n",
1346                 otx2_read64(base + SSO_LF_GGRP_QCTL));
1347         fprintf(f, "SSO_LF_GGRP_XAQ_CNT     0x%" PRIx64 "\n",
1348                 otx2_read64(base + SSO_LF_GGRP_XAQ_CNT));
1349         fprintf(f, "SSO_LF_GGRP_INT_THR     0x%" PRIx64 "\n",
1350                 otx2_read64(base + SSO_LF_GGRP_INT_THR));
1351         fprintf(f, "SSO_LF_GGRP_INT_CNT     0x%" PRIX64 "\n",
1352                 otx2_read64(base + SSO_LF_GGRP_INT_CNT));
1353         fprintf(f, "SSO_LF_GGRP_AQ_CNT      0x%" PRIX64 "\n",
1354                 otx2_read64(base + SSO_LF_GGRP_AQ_CNT));
1355         fprintf(f, "SSO_LF_GGRP_AQ_THR      0x%" PRIX64 "\n",
1356                 otx2_read64(base + SSO_LF_GGRP_AQ_THR));
1357         fprintf(f, "SSO_LF_GGRP_MISC_CNT    0x%" PRIx64 "\n",
1358                 otx2_read64(base + SSO_LF_GGRP_MISC_CNT));
1359 }
1360
1361 static void
1362 otx2_sso_dump(struct rte_eventdev *event_dev, FILE *f)
1363 {
1364         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
1365         uint8_t queue;
1366         uint8_t port;
1367
1368         fprintf(f, "[%s] SSO running in [%s] mode\n", __func__, dev->dual_ws ?
1369                 "dual_ws" : "single_ws");
1370         /* Dump SSOW registers */
1371         for (port = 0; port < dev->nb_event_ports; port++) {
1372                 if (dev->dual_ws) {
1373                         struct otx2_ssogws_dual *ws =
1374                                 event_dev->data->ports[port];
1375
1376                         fprintf(f, "[%s] SSO dual workslot[%d] vws[%d] dump\n",
1377                                 __func__, port, 0);
1378                         ssogws_dump((struct otx2_ssogws *)&ws->ws_state[0], f);
1379                         fprintf(f, "[%s]SSO dual workslot[%d] vws[%d] dump\n",
1380                                 __func__, port, 1);
1381                         ssogws_dump((struct otx2_ssogws *)&ws->ws_state[1], f);
1382                 } else {
1383                         fprintf(f, "[%s]SSO single workslot[%d] dump\n",
1384                                 __func__, port);
1385                         ssogws_dump(event_dev->data->ports[port], f);
1386                 }
1387         }
1388
1389         /* Dump SSO registers */
1390         for (queue = 0; queue < dev->nb_event_queues; queue++) {
1391                 fprintf(f, "[%s]SSO group[%d] dump\n", __func__, queue);
1392                 if (dev->dual_ws) {
1393                         struct otx2_ssogws_dual *ws = event_dev->data->ports[0];
1394                         ssoggrp_dump(ws->grps_base[queue], f);
1395                 } else {
1396                         struct otx2_ssogws *ws = event_dev->data->ports[0];
1397                         ssoggrp_dump(ws->grps_base[queue], f);
1398                 }
1399         }
1400 }
1401
1402 static void
1403 otx2_handle_event(void *arg, struct rte_event event)
1404 {
1405         struct rte_eventdev *event_dev = arg;
1406
1407         if (event_dev->dev_ops->dev_stop_flush != NULL)
1408                 event_dev->dev_ops->dev_stop_flush(event_dev->data->dev_id,
1409                                 event, event_dev->data->dev_stop_flush_arg);
1410 }
1411
1412 static void
1413 sso_qos_cfg(struct rte_eventdev *event_dev)
1414 {
1415         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
1416         struct sso_grp_qos_cfg *req;
1417         uint16_t i;
1418
1419         for (i = 0; i < dev->qos_queue_cnt; i++) {
1420                 uint8_t xaq_prcnt = dev->qos_parse_data[i].xaq_prcnt;
1421                 uint8_t iaq_prcnt = dev->qos_parse_data[i].iaq_prcnt;
1422                 uint8_t taq_prcnt = dev->qos_parse_data[i].taq_prcnt;
1423
1424                 if (dev->qos_parse_data[i].queue >= dev->nb_event_queues)
1425                         continue;
1426
1427                 req = otx2_mbox_alloc_msg_sso_grp_qos_config(dev->mbox);
1428                 req->xaq_limit = (dev->nb_xaq_cfg *
1429                                   (xaq_prcnt ? xaq_prcnt : 100)) / 100;
1430                 req->taq_thr = (SSO_HWGRP_IAQ_MAX_THR_MASK *
1431                                 (iaq_prcnt ? iaq_prcnt : 100)) / 100;
1432                 req->iaq_thr = (SSO_HWGRP_TAQ_MAX_THR_MASK *
1433                                 (taq_prcnt ? taq_prcnt : 100)) / 100;
1434         }
1435
1436         if (dev->qos_queue_cnt)
1437                 otx2_mbox_process(dev->mbox);
1438 }
1439
1440 static void
1441 sso_cleanup(struct rte_eventdev *event_dev, uint8_t enable)
1442 {
1443         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
1444         uint16_t i;
1445
1446         for (i = 0; i < dev->nb_event_ports; i++) {
1447                 if (dev->dual_ws) {
1448                         struct otx2_ssogws_dual *ws;
1449
1450                         ws = event_dev->data->ports[i];
1451                         ssogws_reset((struct otx2_ssogws *)&ws->ws_state[0]);
1452                         ssogws_reset((struct otx2_ssogws *)&ws->ws_state[1]);
1453                         ws->swtag_req = 0;
1454                         ws->vws = 0;
1455                 } else {
1456                         struct otx2_ssogws *ws;
1457
1458                         ws = event_dev->data->ports[i];
1459                         ssogws_reset(ws);
1460                         ws->swtag_req = 0;
1461                 }
1462         }
1463
1464         rte_mb();
1465         if (dev->dual_ws) {
1466                 struct otx2_ssogws_dual *ws = event_dev->data->ports[0];
1467                 struct otx2_ssogws temp_ws;
1468
1469                 memcpy(&temp_ws, &ws->ws_state[0],
1470                        sizeof(struct otx2_ssogws_state));
1471                 for (i = 0; i < dev->nb_event_queues; i++) {
1472                         /* Consume all the events through HWS0 */
1473                         ssogws_flush_events(&temp_ws, i, ws->grps_base[i],
1474                                             otx2_handle_event, event_dev);
1475                         /* Enable/Disable SSO GGRP */
1476                         otx2_write64(enable, ws->grps_base[i] +
1477                                      SSO_LF_GGRP_QCTL);
1478                 }
1479         } else {
1480                 struct otx2_ssogws *ws = event_dev->data->ports[0];
1481
1482                 for (i = 0; i < dev->nb_event_queues; i++) {
1483                         /* Consume all the events through HWS0 */
1484                         ssogws_flush_events(ws, i, ws->grps_base[i],
1485                                             otx2_handle_event, event_dev);
1486                         /* Enable/Disable SSO GGRP */
1487                         otx2_write64(enable, ws->grps_base[i] +
1488                                      SSO_LF_GGRP_QCTL);
1489                 }
1490         }
1491
1492         /* reset SSO GWS cache */
1493         otx2_mbox_alloc_msg_sso_ws_cache_inv(dev->mbox);
1494         otx2_mbox_process(dev->mbox);
1495 }
1496
1497 int
1498 sso_xae_reconfigure(struct rte_eventdev *event_dev)
1499 {
1500         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
1501         struct rte_mempool *prev_xaq_pool;
1502         int rc = 0;
1503
1504         if (event_dev->data->dev_started)
1505                 sso_cleanup(event_dev, 0);
1506
1507         prev_xaq_pool = dev->xaq_pool;
1508         dev->xaq_pool = NULL;
1509         rc = sso_xaq_allocate(dev);
1510         if (rc < 0) {
1511                 otx2_err("Failed to alloc xaq pool %d", rc);
1512                 rte_mempool_free(prev_xaq_pool);
1513                 return rc;
1514         }
1515         rc = sso_ggrp_alloc_xaq(dev);
1516         if (rc < 0) {
1517                 otx2_err("Failed to alloc xaq to ggrp %d", rc);
1518                 rte_mempool_free(prev_xaq_pool);
1519                 return rc;
1520         }
1521
1522         rte_mempool_free(prev_xaq_pool);
1523         rte_mb();
1524         if (event_dev->data->dev_started)
1525                 sso_cleanup(event_dev, 1);
1526
1527         return 0;
1528 }
1529
1530 static int
1531 otx2_sso_start(struct rte_eventdev *event_dev)
1532 {
1533         sso_func_trace();
1534         sso_qos_cfg(event_dev);
1535         sso_cleanup(event_dev, 1);
1536         sso_fastpath_fns_set(event_dev);
1537
1538         return 0;
1539 }
1540
1541 static void
1542 otx2_sso_stop(struct rte_eventdev *event_dev)
1543 {
1544         sso_func_trace();
1545         sso_cleanup(event_dev, 0);
1546         rte_mb();
1547 }
1548
1549 static int
1550 otx2_sso_close(struct rte_eventdev *event_dev)
1551 {
1552         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
1553         uint8_t all_queues[RTE_EVENT_MAX_QUEUES_PER_DEV];
1554         uint16_t i;
1555
1556         if (!dev->configured)
1557                 return 0;
1558
1559         sso_unregister_irqs(event_dev);
1560
1561         for (i = 0; i < dev->nb_event_queues; i++)
1562                 all_queues[i] = i;
1563
1564         for (i = 0; i < dev->nb_event_ports; i++)
1565                 otx2_sso_port_unlink(event_dev, event_dev->data->ports[i],
1566                                      all_queues, dev->nb_event_queues);
1567
1568         sso_lf_teardown(dev, SSO_LF_GGRP);
1569         sso_lf_teardown(dev, SSO_LF_GWS);
1570         dev->nb_event_ports = 0;
1571         dev->nb_event_queues = 0;
1572         rte_mempool_free(dev->xaq_pool);
1573         rte_memzone_free(rte_memzone_lookup(OTX2_SSO_FC_NAME));
1574
1575         return 0;
1576 }
1577
1578 /* Initialize and register event driver with DPDK Application */
1579 static struct rte_eventdev_ops otx2_sso_ops = {
1580         .dev_infos_get    = otx2_sso_info_get,
1581         .dev_configure    = otx2_sso_configure,
1582         .queue_def_conf   = otx2_sso_queue_def_conf,
1583         .queue_setup      = otx2_sso_queue_setup,
1584         .queue_release    = otx2_sso_queue_release,
1585         .port_def_conf    = otx2_sso_port_def_conf,
1586         .port_setup       = otx2_sso_port_setup,
1587         .port_release     = otx2_sso_port_release,
1588         .port_link        = otx2_sso_port_link,
1589         .port_unlink      = otx2_sso_port_unlink,
1590         .timeout_ticks    = otx2_sso_timeout_ticks,
1591
1592         .eth_rx_adapter_caps_get  = otx2_sso_rx_adapter_caps_get,
1593         .eth_rx_adapter_queue_add = otx2_sso_rx_adapter_queue_add,
1594         .eth_rx_adapter_queue_del = otx2_sso_rx_adapter_queue_del,
1595         .eth_rx_adapter_start = otx2_sso_rx_adapter_start,
1596         .eth_rx_adapter_stop = otx2_sso_rx_adapter_stop,
1597
1598         .eth_tx_adapter_caps_get = otx2_sso_tx_adapter_caps_get,
1599         .eth_tx_adapter_queue_add = otx2_sso_tx_adapter_queue_add,
1600         .eth_tx_adapter_queue_del = otx2_sso_tx_adapter_queue_del,
1601
1602         .timer_adapter_caps_get = otx2_tim_caps_get,
1603
1604         .crypto_adapter_caps_get = otx2_ca_caps_get,
1605         .crypto_adapter_queue_pair_add = otx2_ca_qp_add,
1606         .crypto_adapter_queue_pair_del = otx2_ca_qp_del,
1607
1608         .xstats_get       = otx2_sso_xstats_get,
1609         .xstats_reset     = otx2_sso_xstats_reset,
1610         .xstats_get_names = otx2_sso_xstats_get_names,
1611
1612         .dump             = otx2_sso_dump,
1613         .dev_start        = otx2_sso_start,
1614         .dev_stop         = otx2_sso_stop,
1615         .dev_close        = otx2_sso_close,
1616         .dev_selftest     = otx2_sso_selftest,
1617 };
1618
1619 #define OTX2_SSO_XAE_CNT        "xae_cnt"
1620 #define OTX2_SSO_SINGLE_WS      "single_ws"
1621 #define OTX2_SSO_GGRP_QOS       "qos"
1622
1623 static void
1624 parse_queue_param(char *value, void *opaque)
1625 {
1626         struct otx2_sso_qos queue_qos = {0};
1627         uint8_t *val = (uint8_t *)&queue_qos;
1628         struct otx2_sso_evdev *dev = opaque;
1629         char *tok = strtok(value, "-");
1630         struct otx2_sso_qos *old_ptr;
1631
1632         if (!strlen(value))
1633                 return;
1634
1635         while (tok != NULL) {
1636                 *val = atoi(tok);
1637                 tok = strtok(NULL, "-");
1638                 val++;
1639         }
1640
1641         if (val != (&queue_qos.iaq_prcnt + 1)) {
1642                 otx2_err("Invalid QoS parameter expected [Qx-XAQ-TAQ-IAQ]");
1643                 return;
1644         }
1645
1646         dev->qos_queue_cnt++;
1647         old_ptr = dev->qos_parse_data;
1648         dev->qos_parse_data = rte_realloc(dev->qos_parse_data,
1649                                           sizeof(struct otx2_sso_qos) *
1650                                           dev->qos_queue_cnt, 0);
1651         if (dev->qos_parse_data == NULL) {
1652                 dev->qos_parse_data = old_ptr;
1653                 dev->qos_queue_cnt--;
1654                 return;
1655         }
1656         dev->qos_parse_data[dev->qos_queue_cnt - 1] = queue_qos;
1657 }
1658
1659 static void
1660 parse_qos_list(const char *value, void *opaque)
1661 {
1662         char *s = strdup(value);
1663         char *start = NULL;
1664         char *end = NULL;
1665         char *f = s;
1666
1667         while (*s) {
1668                 if (*s == '[')
1669                         start = s;
1670                 else if (*s == ']')
1671                         end = s;
1672
1673                 if (start && start < end) {
1674                         *end = 0;
1675                         parse_queue_param(start + 1, opaque);
1676                         s = end;
1677                         start = end;
1678                 }
1679                 s++;
1680         }
1681
1682         free(f);
1683 }
1684
1685 static int
1686 parse_sso_kvargs_dict(const char *key, const char *value, void *opaque)
1687 {
1688         RTE_SET_USED(key);
1689
1690         /* Dict format [Qx-XAQ-TAQ-IAQ][Qz-XAQ-TAQ-IAQ] use '-' cause ','
1691          * isn't allowed. Everything is expressed in percentages, 0 represents
1692          * default.
1693          */
1694         parse_qos_list(value, opaque);
1695
1696         return 0;
1697 }
1698
1699 static void
1700 sso_parse_devargs(struct otx2_sso_evdev *dev, struct rte_devargs *devargs)
1701 {
1702         struct rte_kvargs *kvlist;
1703         uint8_t single_ws = 0;
1704
1705         if (devargs == NULL)
1706                 return;
1707         kvlist = rte_kvargs_parse(devargs->args, NULL);
1708         if (kvlist == NULL)
1709                 return;
1710
1711         rte_kvargs_process(kvlist, OTX2_SSO_XAE_CNT, &parse_kvargs_value,
1712                            &dev->xae_cnt);
1713         rte_kvargs_process(kvlist, OTX2_SSO_SINGLE_WS, &parse_kvargs_flag,
1714                            &single_ws);
1715         rte_kvargs_process(kvlist, OTX2_SSO_GGRP_QOS, &parse_sso_kvargs_dict,
1716                            dev);
1717         otx2_parse_common_devargs(kvlist);
1718         dev->dual_ws = !single_ws;
1719         rte_kvargs_free(kvlist);
1720 }
1721
1722 static int
1723 otx2_sso_probe(struct rte_pci_driver *pci_drv, struct rte_pci_device *pci_dev)
1724 {
1725         return rte_event_pmd_pci_probe(pci_drv, pci_dev,
1726                                        sizeof(struct otx2_sso_evdev),
1727                                        otx2_sso_init);
1728 }
1729
1730 static int
1731 otx2_sso_remove(struct rte_pci_device *pci_dev)
1732 {
1733         return rte_event_pmd_pci_remove(pci_dev, otx2_sso_fini);
1734 }
1735
1736 static const struct rte_pci_id pci_sso_map[] = {
1737         {
1738                 RTE_PCI_DEVICE(PCI_VENDOR_ID_CAVIUM,
1739                                PCI_DEVID_OCTEONTX2_RVU_SSO_TIM_PF)
1740         },
1741         {
1742                 .vendor_id = 0,
1743         },
1744 };
1745
1746 static struct rte_pci_driver pci_sso = {
1747         .id_table = pci_sso_map,
1748         .drv_flags = RTE_PCI_DRV_NEED_MAPPING | RTE_PCI_DRV_NEED_IOVA_AS_VA,
1749         .probe = otx2_sso_probe,
1750         .remove = otx2_sso_remove,
1751 };
1752
1753 int
1754 otx2_sso_init(struct rte_eventdev *event_dev)
1755 {
1756         struct free_rsrcs_rsp *rsrc_cnt;
1757         struct rte_pci_device *pci_dev;
1758         struct otx2_sso_evdev *dev;
1759         int rc;
1760
1761         event_dev->dev_ops = &otx2_sso_ops;
1762         /* For secondary processes, the primary has done all the work */
1763         if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
1764                 sso_fastpath_fns_set(event_dev);
1765                 return 0;
1766         }
1767
1768         dev = sso_pmd_priv(event_dev);
1769
1770         pci_dev = container_of(event_dev->dev, struct rte_pci_device, device);
1771
1772         /* Initialize the base otx2_dev object */
1773         rc = otx2_dev_init(pci_dev, dev);
1774         if (rc < 0) {
1775                 otx2_err("Failed to initialize otx2_dev rc=%d", rc);
1776                 goto error;
1777         }
1778
1779         /* Get SSO and SSOW MSIX rsrc cnt */
1780         otx2_mbox_alloc_msg_free_rsrc_cnt(dev->mbox);
1781         rc = otx2_mbox_process_msg(dev->mbox, (void *)&rsrc_cnt);
1782         if (rc < 0) {
1783                 otx2_err("Unable to get free rsrc count");
1784                 goto otx2_dev_uninit;
1785         }
1786         otx2_sso_dbg("SSO %d SSOW %d NPA %d provisioned", rsrc_cnt->sso,
1787                      rsrc_cnt->ssow, rsrc_cnt->npa);
1788
1789         dev->max_event_ports = RTE_MIN(rsrc_cnt->ssow, OTX2_SSO_MAX_VHWS);
1790         dev->max_event_queues = RTE_MIN(rsrc_cnt->sso, OTX2_SSO_MAX_VHGRP);
1791         /* Grab the NPA LF if required */
1792         rc = otx2_npa_lf_init(pci_dev, dev);
1793         if (rc < 0) {
1794                 otx2_err("Unable to init NPA lf. It might not be provisioned");
1795                 goto otx2_dev_uninit;
1796         }
1797
1798         dev->drv_inited = true;
1799         dev->is_timeout_deq = 0;
1800         dev->min_dequeue_timeout_ns = USEC2NSEC(1);
1801         dev->max_dequeue_timeout_ns = USEC2NSEC(0x3FF);
1802         dev->max_num_events = -1;
1803         dev->nb_event_queues = 0;
1804         dev->nb_event_ports = 0;
1805
1806         if (!dev->max_event_ports || !dev->max_event_queues) {
1807                 otx2_err("Not enough eventdev resource queues=%d ports=%d",
1808                          dev->max_event_queues, dev->max_event_ports);
1809                 rc = -ENODEV;
1810                 goto otx2_npa_lf_uninit;
1811         }
1812
1813         dev->dual_ws = 1;
1814         sso_parse_devargs(dev, pci_dev->device.devargs);
1815         if (dev->dual_ws) {
1816                 otx2_sso_dbg("Using dual workslot mode");
1817                 dev->max_event_ports = dev->max_event_ports / 2;
1818         } else {
1819                 otx2_sso_dbg("Using single workslot mode");
1820         }
1821
1822         otx2_sso_pf_func_set(dev->pf_func);
1823         otx2_sso_dbg("Initializing %s max_queues=%d max_ports=%d",
1824                      event_dev->data->name, dev->max_event_queues,
1825                      dev->max_event_ports);
1826
1827         otx2_tim_init(pci_dev, (struct otx2_dev *)dev);
1828
1829         return 0;
1830
1831 otx2_npa_lf_uninit:
1832         otx2_npa_lf_fini();
1833 otx2_dev_uninit:
1834         otx2_dev_fini(pci_dev, dev);
1835 error:
1836         return rc;
1837 }
1838
1839 int
1840 otx2_sso_fini(struct rte_eventdev *event_dev)
1841 {
1842         struct otx2_sso_evdev *dev = sso_pmd_priv(event_dev);
1843         struct rte_pci_device *pci_dev;
1844
1845         /* For secondary processes, nothing to be done */
1846         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
1847                 return 0;
1848
1849         pci_dev = container_of(event_dev->dev, struct rte_pci_device, device);
1850
1851         if (!dev->drv_inited)
1852                 goto dev_fini;
1853
1854         dev->drv_inited = false;
1855         otx2_npa_lf_fini();
1856
1857 dev_fini:
1858         if (otx2_npa_lf_active(dev)) {
1859                 otx2_info("Common resource in use by other devices");
1860                 return -EAGAIN;
1861         }
1862
1863         otx2_tim_fini();
1864         otx2_dev_fini(pci_dev, dev);
1865
1866         return 0;
1867 }
1868
1869 RTE_PMD_REGISTER_PCI(event_octeontx2, pci_sso);
1870 RTE_PMD_REGISTER_PCI_TABLE(event_octeontx2, pci_sso_map);
1871 RTE_PMD_REGISTER_KMOD_DEP(event_octeontx2, "vfio-pci");
1872 RTE_PMD_REGISTER_PARAM_STRING(event_octeontx2, OTX2_SSO_XAE_CNT "=<int>"
1873                               OTX2_SSO_SINGLE_WS "=1"
1874                               OTX2_SSO_GGRP_QOS "=<string>"
1875                               OTX2_NPA_LOCK_MASK "=<1-65535>");