drivers/net/ark/ark_ethdev.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright (c) 2015-2018 Atomic Rules LLC
   3  */
   4
   5 #include <unistd.h>
   6 #include <sys/stat.h>
   7 #include <dlfcn.h>
   8
   9 #include <rte_bus_pci.h>
  10 #include <rte_ethdev_pci.h>
  11 #include <rte_kvargs.h>
  12
  13 #include "ark_global.h"
  14 #include "ark_logs.h"
  15 #include "ark_ethdev_tx.h"
  16 #include "ark_ethdev_rx.h"
  17 #include "ark_mpu.h"
  18 #include "ark_ddm.h"
  19 #include "ark_udm.h"
  20 #include "ark_rqp.h"
  21 #include "ark_pktdir.h"
  22 #include "ark_pktgen.h"
  23 #include "ark_pktchkr.h"
  24
  25 /*  Internal prototypes */
  26 static int eth_ark_check_args(struct ark_adapter *ark, const char *params);
  27 static int eth_ark_dev_init(struct rte_eth_dev *dev);
  28 static int ark_config_device(struct rte_eth_dev *dev);
  29 static int eth_ark_dev_uninit(struct rte_eth_dev *eth_dev);
  30 static int eth_ark_dev_configure(struct rte_eth_dev *dev);
  31 static int eth_ark_dev_start(struct rte_eth_dev *dev);
  32 static void eth_ark_dev_stop(struct rte_eth_dev *dev);
  33 static int eth_ark_dev_close(struct rte_eth_dev *dev);
  34 static int eth_ark_dev_info_get(struct rte_eth_dev *dev,
  35                                 struct rte_eth_dev_info *dev_info);
  36 static int eth_ark_dev_link_update(struct rte_eth_dev *dev,
  37                                    int wait_to_complete);
  38 static int eth_ark_dev_set_link_up(struct rte_eth_dev *dev);
  39 static int eth_ark_dev_set_link_down(struct rte_eth_dev *dev);
  40 static int eth_ark_dev_stats_get(struct rte_eth_dev *dev,
  41                                   struct rte_eth_stats *stats);
  42 static int eth_ark_dev_stats_reset(struct rte_eth_dev *dev);
  43 static int eth_ark_set_default_mac_addr(struct rte_eth_dev *dev,
  44                                          struct rte_ether_addr *mac_addr);
  45 static int eth_ark_macaddr_add(struct rte_eth_dev *dev,
  46                                struct rte_ether_addr *mac_addr,
  47                                uint32_t index,
  48                                uint32_t pool);
  49 static void eth_ark_macaddr_remove(struct rte_eth_dev *dev,
  50                                    uint32_t index);
  51 static int  eth_ark_set_mtu(struct rte_eth_dev *dev, uint16_t size);
  52
  53 /*
  54  * The packet generator is a functional block used to generate packet
  55  * patterns for testing.  It is not intended for nominal use.
  56  */
  57 #define ARK_PKTGEN_ARG "Pkt_gen"
  58
  59 /*
  60  * The packet checker is a functional block used to verify packet
  61  * patterns for testing.  It is not intended for nominal use.
  62  */
  63 #define ARK_PKTCHKR_ARG "Pkt_chkr"
  64
  65 /*
  66  * The packet director is used to select the internal ingress and
  67  * egress packets paths during testing.  It is not intended for
  68  * nominal use.
  69  */
  70 #define ARK_PKTDIR_ARG "Pkt_dir"
  71
  72 /* Devinfo configurations */
  73 #define ARK_RX_MAX_QUEUE (4096 * 4)
  74 #define ARK_RX_MIN_QUEUE (512)
  75 #define ARK_RX_MAX_PKT_LEN ((16 * 1024) - 128)
  76 #define ARK_RX_MIN_BUFSIZE (1024)
  77
  78 #define ARK_TX_MAX_QUEUE (4096 * 4)
  79 #define ARK_TX_MIN_QUEUE (256)
  80
  81 static const char * const valid_arguments[] = {
  82         ARK_PKTGEN_ARG,
  83         ARK_PKTCHKR_ARG,
  84         ARK_PKTDIR_ARG,
  85         NULL
  86 };
  87
  88 static const struct rte_pci_id pci_id_ark_map[] = {
  89         {RTE_PCI_DEVICE(0x1d6c, 0x100d)},
  90         {RTE_PCI_DEVICE(0x1d6c, 0x100e)},
  91         {.vendor_id = 0, /* sentinel */ },
  92 };
  93
  94 static int
  95 eth_ark_pci_probe(struct rte_pci_driver *pci_drv __rte_unused,
  96                 struct rte_pci_device *pci_dev)
  97 {
  98         struct rte_eth_dev *eth_dev;
  99         int ret;
 100
 101         eth_dev = rte_eth_dev_pci_allocate(pci_dev, sizeof(struct ark_adapter));
 102
 103         if (eth_dev == NULL)
 104                 return -ENOMEM;
 105
 106         ret = eth_ark_dev_init(eth_dev);
 107         if (ret)
 108                 rte_eth_dev_release_port(eth_dev);
 109
 110         return ret;
 111 }
 112
 113 static int
 114 eth_ark_pci_remove(struct rte_pci_device *pci_dev)
 115 {
 116         return rte_eth_dev_pci_generic_remove(pci_dev, eth_ark_dev_uninit);
 117 }
 118
 119 static struct rte_pci_driver rte_ark_pmd = {
 120         .id_table = pci_id_ark_map,
 121         .drv_flags = RTE_PCI_DRV_NEED_MAPPING | RTE_PCI_DRV_INTR_LSC,
 122         .probe = eth_ark_pci_probe,
 123         .remove = eth_ark_pci_remove,
 124 };
 125
 126 static const struct eth_dev_ops ark_eth_dev_ops = {
 127         .dev_configure = eth_ark_dev_configure,
 128         .dev_start = eth_ark_dev_start,
 129         .dev_stop = eth_ark_dev_stop,
 130         .dev_close = eth_ark_dev_close,
 131
 132         .dev_infos_get = eth_ark_dev_info_get,
 133
 134         .rx_queue_setup = eth_ark_dev_rx_queue_setup,
 135         .tx_queue_setup = eth_ark_tx_queue_setup,
 136
 137         .link_update = eth_ark_dev_link_update,
 138         .dev_set_link_up = eth_ark_dev_set_link_up,
 139         .dev_set_link_down = eth_ark_dev_set_link_down,
 140
 141         .rx_queue_start = eth_ark_rx_start_queue,
 142         .rx_queue_stop = eth_ark_rx_stop_queue,
 143
 144         .tx_queue_start = eth_ark_tx_queue_start,
 145         .tx_queue_stop = eth_ark_tx_queue_stop,
 146
 147         .stats_get = eth_ark_dev_stats_get,
 148         .stats_reset = eth_ark_dev_stats_reset,
 149
 150         .mac_addr_add = eth_ark_macaddr_add,
 151         .mac_addr_remove = eth_ark_macaddr_remove,
 152         .mac_addr_set = eth_ark_set_default_mac_addr,
 153
 154         .mtu_set = eth_ark_set_mtu,
 155 };
 156
 157 static int
 158 check_for_ext(struct ark_adapter *ark)
 159 {
 160         int found = 0;
 161
 162         /* Get the env */
 163         const char *dllpath = getenv("ARK_EXT_PATH");
 164
 165         if (dllpath == NULL) {
 166                 ARK_PMD_LOG(DEBUG, "EXT NO dll path specified\n");
 167                 return 0;
 168         }
 169         ARK_PMD_LOG(NOTICE, "EXT found dll path at %s\n", dllpath);
 170
 171         /* Open and load the .so */
 172         ark->d_handle = dlopen(dllpath, RTLD_LOCAL | RTLD_LAZY);
 173         if (ark->d_handle == NULL) {
 174                 ARK_PMD_LOG(ERR, "Could not load user extension %s\n",
 175                             dllpath);
 176                 return -1;
 177         }
 178         ARK_PMD_LOG(DEBUG, "SUCCESS: loaded user extension %s\n",
 179                             dllpath);
 180
 181         /* Get the entry points */
 182         ark->user_ext.dev_init =
 183                 (void *(*)(struct rte_eth_dev *, void *, int))
 184                 dlsym(ark->d_handle, "dev_init");
 185         ARK_PMD_LOG(DEBUG, "device ext init pointer = %p\n",
 186                       ark->user_ext.dev_init);
 187         ark->user_ext.dev_get_port_count =
 188                 (int (*)(struct rte_eth_dev *, void *))
 189                 dlsym(ark->d_handle, "dev_get_port_count");
 190         ark->user_ext.dev_uninit =
 191                 (void (*)(struct rte_eth_dev *, void *))
 192                 dlsym(ark->d_handle, "dev_uninit");
 193         ark->user_ext.dev_configure =
 194                 (int (*)(struct rte_eth_dev *, void *))
 195                 dlsym(ark->d_handle, "dev_configure");
 196         ark->user_ext.dev_start =
 197                 (int (*)(struct rte_eth_dev *, void *))
 198                 dlsym(ark->d_handle, "dev_start");
 199         ark->user_ext.dev_stop =
 200                 (void (*)(struct rte_eth_dev *, void *))
 201                 dlsym(ark->d_handle, "dev_stop");
 202         ark->user_ext.dev_close =
 203                 (void (*)(struct rte_eth_dev *, void *))
 204                 dlsym(ark->d_handle, "dev_close");
 205         ark->user_ext.link_update =
 206                 (int (*)(struct rte_eth_dev *, int, void *))
 207                 dlsym(ark->d_handle, "link_update");
 208         ark->user_ext.dev_set_link_up =
 209                 (int (*)(struct rte_eth_dev *, void *))
 210                 dlsym(ark->d_handle, "dev_set_link_up");
 211         ark->user_ext.dev_set_link_down =
 212                 (int (*)(struct rte_eth_dev *, void *))
 213                 dlsym(ark->d_handle, "dev_set_link_down");
 214         ark->user_ext.stats_get =
 215                 (int (*)(struct rte_eth_dev *, struct rte_eth_stats *,
 216                           void *))
 217                 dlsym(ark->d_handle, "stats_get");
 218         ark->user_ext.stats_reset =
 219                 (void (*)(struct rte_eth_dev *, void *))
 220                 dlsym(ark->d_handle, "stats_reset");
 221         ark->user_ext.mac_addr_add =
 222                 (void (*)(struct rte_eth_dev *, struct rte_ether_addr *,
 223                         uint32_t, uint32_t, void *))
 224                 dlsym(ark->d_handle, "mac_addr_add");
 225         ark->user_ext.mac_addr_remove =
 226                 (void (*)(struct rte_eth_dev *, uint32_t, void *))
 227                 dlsym(ark->d_handle, "mac_addr_remove");
 228         ark->user_ext.mac_addr_set =
 229                 (void (*)(struct rte_eth_dev *, struct rte_ether_addr *,
 230                           void *))
 231                 dlsym(ark->d_handle, "mac_addr_set");
 232         ark->user_ext.set_mtu =
 233                 (int (*)(struct rte_eth_dev *, uint16_t,
 234                           void *))
 235                 dlsym(ark->d_handle, "set_mtu");
 236
 237         return found;
 238 }
 239
 240 static int
 241 eth_ark_dev_init(struct rte_eth_dev *dev)
 242 {
 243         struct ark_adapter *ark = dev->data->dev_private;
 244         struct rte_pci_device *pci_dev;
 245         int ret;
 246         int port_count = 1;
 247         int p;
 248
 249         ark->eth_dev = dev;
 250
 251         ARK_PMD_LOG(DEBUG, "\n");
 252
 253         /* Check to see if there is an extension that we need to load */
 254         ret = check_for_ext(ark);
 255         if (ret)
 256                 return ret;
 257         pci_dev = RTE_ETH_DEV_TO_PCI(dev);
 258         rte_eth_copy_pci_info(dev, pci_dev);
 259
 260         /* Use dummy function until setup */
 261         dev->rx_pkt_burst = &eth_ark_recv_pkts_noop;
 262         dev->tx_pkt_burst = &eth_ark_xmit_pkts_noop;
 263
 264         ark->bar0 = (uint8_t *)pci_dev->mem_resource[0].addr;
 265         ark->a_bar = (uint8_t *)pci_dev->mem_resource[2].addr;
 266
 267         ark->sysctrl.v  = (void *)&ark->bar0[ARK_SYSCTRL_BASE];
 268         ark->mpurx.v  = (void *)&ark->bar0[ARK_MPU_RX_BASE];
 269         ark->udm.v  = (void *)&ark->bar0[ARK_UDM_BASE];
 270         ark->mputx.v  = (void *)&ark->bar0[ARK_MPU_TX_BASE];
 271         ark->ddm.v  = (void *)&ark->bar0[ARK_DDM_BASE];
 272         ark->cmac.v  = (void *)&ark->bar0[ARK_CMAC_BASE];
 273         ark->external.v  = (void *)&ark->bar0[ARK_EXTERNAL_BASE];
 274         ark->pktdir.v  = (void *)&ark->bar0[ARK_PKTDIR_BASE];
 275         ark->pktgen.v  = (void *)&ark->bar0[ARK_PKTGEN_BASE];
 276         ark->pktchkr.v  = (void *)&ark->bar0[ARK_PKTCHKR_BASE];
 277
 278         ark->rqpacing =
 279                 (struct ark_rqpace_t *)(ark->bar0 + ARK_RCPACING_BASE);
 280         ark->started = 0;
 281
 282         ARK_PMD_LOG(INFO, "Sys Ctrl Const = 0x%x  HW Commit_ID: %08x\n",
 283                       ark->sysctrl.t32[4],
 284                       rte_be_to_cpu_32(ark->sysctrl.t32[0x20 / 4]));
 285         ARK_PMD_LOG(NOTICE, "Arkville HW Commit_ID: %08x\n",
 286                     rte_be_to_cpu_32(ark->sysctrl.t32[0x20 / 4]));
 287
 288         /* If HW sanity test fails, return an error */
 289         if (ark->sysctrl.t32[4] != 0xcafef00d) {
 290                 ARK_PMD_LOG(ERR,
 291                             "HW Sanity test has failed, expected constant"
 292                             " 0x%x, read 0x%x (%s)\n",
 293                             0xcafef00d,
 294                             ark->sysctrl.t32[4], __func__);
 295                 return -1;
 296         }
 297         if (ark->sysctrl.t32[3] != 0) {
 298                 if (ark_rqp_lasped(ark->rqpacing)) {
 299                         ARK_PMD_LOG(ERR, "Arkville Evaluation System - "
 300                                     "Timer has Expired\n");
 301                         return -1;
 302                 }
 303                 ARK_PMD_LOG(WARNING, "Arkville Evaluation System - "
 304                             "Timer is Running\n");
 305         }
 306
 307         ARK_PMD_LOG(DEBUG,
 308                     "HW Sanity test has PASSED, expected constant"
 309                     " 0x%x, read 0x%x (%s)\n",
 310                     0xcafef00d, ark->sysctrl.t32[4], __func__);
 311
 312         /* We are a single function multi-port device. */
 313         ret = ark_config_device(dev);
 314         if (ret)
 315                 return -1;
 316
 317         dev->dev_ops = &ark_eth_dev_ops;
 318         dev->rx_queue_count = eth_ark_dev_rx_queue_count;
 319
 320         dev->data->mac_addrs = rte_zmalloc("ark", RTE_ETHER_ADDR_LEN, 0);
 321         if (!dev->data->mac_addrs) {
 322                 ARK_PMD_LOG(ERR,
 323                             "Failed to allocated memory for storing mac address"
 324                             );
 325         }
 326
 327         if (ark->user_ext.dev_init) {
 328                 ark->user_data[dev->data->port_id] =
 329                         ark->user_ext.dev_init(dev, ark->a_bar, 0);
 330                 if (!ark->user_data[dev->data->port_id]) {
 331                         ARK_PMD_LOG(WARNING,
 332                                     "Failed to initialize PMD extension!"
 333                                     " continuing without it\n");
 334                         memset(&ark->user_ext, 0, sizeof(struct ark_user_ext));
 335                         dlclose(ark->d_handle);
 336                 }
 337         }
 338
 339         if (pci_dev->device.devargs)
 340                 ret = eth_ark_check_args(ark, pci_dev->device.devargs->args);
 341         else
 342                 ARK_PMD_LOG(INFO, "No Device args found\n");
 343
 344         if (ret)
 345                 goto error;
 346         /*
 347          * We will create additional devices based on the number of requested
 348          * ports
 349          */
 350         if (ark->user_ext.dev_get_port_count)
 351                 port_count =
 352                         ark->user_ext.dev_get_port_count(dev,
 353                                  ark->user_data[dev->data->port_id]);
 354         ark->num_ports = port_count;
 355
 356         for (p = 0; p < port_count; p++) {
 357                 struct rte_eth_dev *eth_dev;
 358                 char name[RTE_ETH_NAME_MAX_LEN];
 359
 360                 snprintf(name, sizeof(name), "arketh%d",
 361                          dev->data->port_id + p);
 362
 363                 if (p == 0) {
 364                         /* First port is already allocated by DPDK */
 365                         eth_dev = ark->eth_dev;
 366                         rte_eth_dev_probing_finish(eth_dev);
 367                         continue;
 368                 }
 369
 370                 /* reserve an ethdev entry */
 371                 eth_dev = rte_eth_dev_allocate(name);
 372                 if (!eth_dev) {
 373                         ARK_PMD_LOG(ERR,
 374                                     "Could not allocate eth_dev for port %d\n",
 375                                     p);
 376                         goto error;
 377                 }
 378
 379                 eth_dev->device = &pci_dev->device;
 380                 eth_dev->data->dev_private = ark;
 381                 eth_dev->dev_ops = ark->eth_dev->dev_ops;
 382                 eth_dev->tx_pkt_burst = ark->eth_dev->tx_pkt_burst;
 383                 eth_dev->rx_pkt_burst = ark->eth_dev->rx_pkt_burst;
 384
 385                 rte_eth_copy_pci_info(eth_dev, pci_dev);
 386
 387                 eth_dev->data->mac_addrs = rte_zmalloc(name,
 388                                                 RTE_ETHER_ADDR_LEN, 0);
 389                 if (!eth_dev->data->mac_addrs) {
 390                         ARK_PMD_LOG(ERR,
 391                                     "Memory allocation for MAC failed!"
 392                                     " Exiting.\n");
 393                         goto error;
 394                 }
 395
 396                 if (ark->user_ext.dev_init) {
 397                         ark->user_data[eth_dev->data->port_id] =
 398                                 ark->user_ext.dev_init(dev, ark->a_bar, p);
 399                 }
 400
 401                 rte_eth_dev_probing_finish(eth_dev);
 402         }
 403
 404         return ret;
 405
 406 error:
 407         rte_free(dev->data->mac_addrs);
 408         dev->data->mac_addrs = NULL;
 409         return -1;
 410 }
 411
 412 /*
 413  *Initial device configuration when device is opened
 414  * setup the DDM, and UDM
 415  * Called once per PCIE device
 416  */
 417 static int
 418 ark_config_device(struct rte_eth_dev *dev)
 419 {
 420         struct ark_adapter *ark = dev->data->dev_private;
 421         uint16_t num_q, i;
 422         struct ark_mpu_t *mpu;
 423
 424         /*
 425          * Make sure that the packet director, generator and checker are in a
 426          * known state
 427          */
 428         ark->start_pg = 0;
 429         ark->pg = ark_pktgen_init(ark->pktgen.v, 0, 1);
 430         if (ark->pg == NULL)
 431                 return -1;
 432         ark_pktgen_reset(ark->pg);
 433         ark->pc = ark_pktchkr_init(ark->pktchkr.v, 0, 1);
 434         if (ark->pc == NULL)
 435                 return -1;
 436         ark_pktchkr_stop(ark->pc);
 437         ark->pd = ark_pktdir_init(ark->pktdir.v);
 438         if (ark->pd == NULL)
 439                 return -1;
 440
 441         /* Verify HW */
 442         if (ark_udm_verify(ark->udm.v))
 443                 return -1;
 444         if (ark_ddm_verify(ark->ddm.v))
 445                 return -1;
 446
 447         /* UDM */
 448         if (ark_udm_reset(ark->udm.v)) {
 449                 ARK_PMD_LOG(ERR, "Unable to stop and reset UDM\n");
 450                 return -1;
 451         }
 452         /* Keep in reset until the MPU are cleared */
 453
 454         /* MPU reset */
 455         mpu = ark->mpurx.v;
 456         num_q = ark_api_num_queues(mpu);
 457         ark->rx_queues = num_q;
 458         for (i = 0; i < num_q; i++) {
 459                 ark_mpu_reset(mpu);
 460                 mpu = RTE_PTR_ADD(mpu, ARK_MPU_QOFFSET);
 461         }
 462
 463         ark_udm_stop(ark->udm.v, 0);
 464         ark_udm_configure(ark->udm.v,
 465                           RTE_PKTMBUF_HEADROOM,
 466                           RTE_MBUF_DEFAULT_DATAROOM,
 467                           ARK_RX_WRITE_TIME_NS);
 468         ark_udm_stats_reset(ark->udm.v);
 469         ark_udm_stop(ark->udm.v, 0);
 470
 471         /* TX -- DDM */
 472         if (ark_ddm_stop(ark->ddm.v, 1))
 473                 ARK_PMD_LOG(ERR, "Unable to stop DDM\n");
 474
 475         mpu = ark->mputx.v;
 476         num_q = ark_api_num_queues(mpu);
 477         ark->tx_queues = num_q;
 478         for (i = 0; i < num_q; i++) {
 479                 ark_mpu_reset(mpu);
 480                 mpu = RTE_PTR_ADD(mpu, ARK_MPU_QOFFSET);
 481         }
 482
 483         ark_ddm_reset(ark->ddm.v);
 484         ark_ddm_stats_reset(ark->ddm.v);
 485
 486         ark_ddm_stop(ark->ddm.v, 0);
 487         ark_rqp_stats_reset(ark->rqpacing);
 488
 489         return 0;
 490 }
 491
 492 static int
 493 eth_ark_dev_uninit(struct rte_eth_dev *dev)
 494 {
 495         struct ark_adapter *ark = dev->data->dev_private;
 496
 497         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
 498                 return 0;
 499
 500         if (ark->user_ext.dev_uninit)
 501                 ark->user_ext.dev_uninit(dev,
 502                          ark->user_data[dev->data->port_id]);
 503
 504         ark_pktgen_uninit(ark->pg);
 505         ark_pktchkr_uninit(ark->pc);
 506
 507         dev->dev_ops = NULL;
 508         dev->rx_pkt_burst = NULL;
 509         dev->tx_pkt_burst = NULL;
 510         return 0;
 511 }
 512
 513 static int
 514 eth_ark_dev_configure(struct rte_eth_dev *dev)
 515 {
 516         struct ark_adapter *ark = dev->data->dev_private;
 517
 518         eth_ark_dev_set_link_up(dev);
 519         if (ark->user_ext.dev_configure)
 520                 return ark->user_ext.dev_configure(dev,
 521                            ark->user_data[dev->data->port_id]);
 522         return 0;
 523 }
 524
 525 static void *
 526 delay_pg_start(void *arg)
 527 {
 528         struct ark_adapter *ark = (struct ark_adapter *)arg;
 529
 530         /* This function is used exclusively for regression testing, We
 531          * perform a blind sleep here to ensure that the external test
 532          * application has time to setup the test before we generate packets
 533          */
 534         usleep(100000);
 535         ark_pktgen_run(ark->pg);
 536         return NULL;
 537 }
 538
 539 static int
 540 eth_ark_dev_start(struct rte_eth_dev *dev)
 541 {
 542         struct ark_adapter *ark = dev->data->dev_private;
 543         int i;
 544
 545         /* RX Side */
 546         /* start UDM */
 547         ark_udm_start(ark->udm.v);
 548
 549         for (i = 0; i < dev->data->nb_rx_queues; i++)
 550                 eth_ark_rx_start_queue(dev, i);
 551
 552         /* TX Side */
 553         for (i = 0; i < dev->data->nb_tx_queues; i++)
 554                 eth_ark_tx_queue_start(dev, i);
 555
 556         /* start DDM */
 557         ark_ddm_start(ark->ddm.v);
 558
 559         ark->started = 1;
 560         /* set xmit and receive function */
 561         dev->rx_pkt_burst = &eth_ark_recv_pkts;
 562         dev->tx_pkt_burst = &eth_ark_xmit_pkts;
 563
 564         if (ark->start_pg)
 565                 ark_pktchkr_run(ark->pc);
 566
 567         if (ark->start_pg && (dev->data->port_id == 0)) {
 568                 pthread_t thread;
 569
 570                 /* Delay packet generatpr start allow the hardware to be ready
 571                  * This is only used for sanity checking with internal generator
 572                  */
 573                 if (pthread_create(&thread, NULL, delay_pg_start, ark)) {
 574                         ARK_PMD_LOG(ERR, "Could not create pktgen "
 575                                     "starter thread\n");
 576                         return -1;
 577                 }
 578         }
 579
 580         if (ark->user_ext.dev_start)
 581                 ark->user_ext.dev_start(dev,
 582                         ark->user_data[dev->data->port_id]);
 583
 584         return 0;
 585 }
 586
 587 static void
 588 eth_ark_dev_stop(struct rte_eth_dev *dev)
 589 {
 590         uint16_t i;
 591         int status;
 592         struct ark_adapter *ark = dev->data->dev_private;
 593         struct ark_mpu_t *mpu;
 594
 595         if (ark->started == 0)
 596                 return;
 597         ark->started = 0;
 598
 599         /* Stop the extension first */
 600         if (ark->user_ext.dev_stop)
 601                 ark->user_ext.dev_stop(dev,
 602                        ark->user_data[dev->data->port_id]);
 603
 604         /* Stop the packet generator */
 605         if (ark->start_pg)
 606                 ark_pktgen_pause(ark->pg);
 607
 608         dev->rx_pkt_burst = &eth_ark_recv_pkts_noop;
 609         dev->tx_pkt_burst = &eth_ark_xmit_pkts_noop;
 610
 611         /* STOP TX Side */
 612         for (i = 0; i < dev->data->nb_tx_queues; i++) {
 613                 status = eth_ark_tx_queue_stop(dev, i);
 614                 if (status != 0) {
 615                         uint16_t port = dev->data->port_id;
 616                         ARK_PMD_LOG(ERR,
 617                                     "tx_queue stop anomaly"
 618                                     " port %u, queue %u\n",
 619                                     port, i);
 620                 }
 621         }
 622
 623         /* Stop DDM */
 624         /* Wait up to 0.1 second.  each stop is up to 1000 * 10 useconds */
 625         for (i = 0; i < 10; i++) {
 626                 status = ark_ddm_stop(ark->ddm.v, 1);
 627                 if (status == 0)
 628                         break;
 629         }
 630         if (status || i != 0) {
 631                 ARK_PMD_LOG(ERR, "DDM stop anomaly. status:"
 632                             " %d iter: %u. (%s)\n",
 633                             status,
 634                             i,
 635                             __func__);
 636                 ark_ddm_dump(ark->ddm.v, "Stop anomaly");
 637
 638                 mpu = ark->mputx.v;
 639                 for (i = 0; i < ark->tx_queues; i++) {
 640                         ark_mpu_dump(mpu, "DDM failure dump", i);
 641                         mpu = RTE_PTR_ADD(mpu, ARK_MPU_QOFFSET);
 642                 }
 643         }
 644
 645         /* STOP RX Side */
 646         /* Stop UDM  multiple tries attempted */
 647         for (i = 0; i < 10; i++) {
 648                 status = ark_udm_stop(ark->udm.v, 1);
 649                 if (status == 0)
 650                         break;
 651         }
 652         if (status || i != 0) {
 653                 ARK_PMD_LOG(ERR, "UDM stop anomaly. status %d iter: %u. (%s)\n",
 654                             status, i, __func__);
 655                 ark_udm_dump(ark->udm.v, "Stop anomaly");
 656
 657                 mpu = ark->mpurx.v;
 658                 for (i = 0; i < ark->rx_queues; i++) {
 659                         ark_mpu_dump(mpu, "UDM Stop anomaly", i);
 660                         mpu = RTE_PTR_ADD(mpu, ARK_MPU_QOFFSET);
 661                 }
 662         }
 663
 664         ark_udm_dump_stats(ark->udm.v, "Post stop");
 665         ark_udm_dump_perf(ark->udm.v, "Post stop");
 666
 667         for (i = 0; i < dev->data->nb_rx_queues; i++)
 668                 eth_ark_rx_dump_queue(dev, i, __func__);
 669
 670         /* Stop the packet checker if it is running */
 671         if (ark->start_pg) {
 672                 ark_pktchkr_dump_stats(ark->pc);
 673                 ark_pktchkr_stop(ark->pc);
 674         }
 675 }
 676
 677 static int
 678 eth_ark_dev_close(struct rte_eth_dev *dev)
 679 {
 680         struct ark_adapter *ark = dev->data->dev_private;
 681         uint16_t i;
 682
 683         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
 684                 return 0;
 685
 686         if (ark->user_ext.dev_close)
 687                 ark->user_ext.dev_close(dev,
 688                  ark->user_data[dev->data->port_id]);
 689
 690         eth_ark_dev_stop(dev);
 691         eth_ark_udm_force_close(dev);
 692
 693         /*
 694          * TODO This should only be called once for the device during shutdown
 695          */
 696         ark_rqp_dump(ark->rqpacing);
 697
 698         for (i = 0; i < dev->data->nb_tx_queues; i++) {
 699                 eth_ark_tx_queue_release(dev->data->tx_queues[i]);
 700                 dev->data->tx_queues[i] = 0;
 701         }
 702
 703         for (i = 0; i < dev->data->nb_rx_queues; i++) {
 704                 eth_ark_dev_rx_queue_release(dev->data->rx_queues[i]);
 705                 dev->data->rx_queues[i] = 0;
 706         }
 707
 708         rte_free(dev->data->mac_addrs);
 709         dev->data->mac_addrs = 0;
 710
 711         return 0;
 712 }
 713
 714 static int
 715 eth_ark_dev_info_get(struct rte_eth_dev *dev,
 716                      struct rte_eth_dev_info *dev_info)
 717 {
 718         struct ark_adapter *ark = dev->data->dev_private;
 719         struct ark_mpu_t *tx_mpu = RTE_PTR_ADD(ark->bar0, ARK_MPU_TX_BASE);
 720         struct ark_mpu_t *rx_mpu = RTE_PTR_ADD(ark->bar0, ARK_MPU_RX_BASE);
 721         uint16_t ports = ark->num_ports;
 722
 723         dev_info->max_rx_pktlen = ARK_RX_MAX_PKT_LEN;
 724         dev_info->min_rx_bufsize = ARK_RX_MIN_BUFSIZE;
 725
 726         dev_info->max_rx_queues = ark_api_num_queues_per_port(rx_mpu, ports);
 727         dev_info->max_tx_queues = ark_api_num_queues_per_port(tx_mpu, ports);
 728
 729         dev_info->rx_desc_lim = (struct rte_eth_desc_lim) {
 730                 .nb_max = ARK_RX_MAX_QUEUE,
 731                 .nb_min = ARK_RX_MIN_QUEUE,
 732                 .nb_align = ARK_RX_MIN_QUEUE}; /* power of 2 */
 733
 734         dev_info->tx_desc_lim = (struct rte_eth_desc_lim) {
 735                 .nb_max = ARK_TX_MAX_QUEUE,
 736                 .nb_min = ARK_TX_MIN_QUEUE,
 737                 .nb_align = ARK_TX_MIN_QUEUE}; /* power of 2 */
 738
 739         /* ARK PMD supports all line rates, how do we indicate that here ?? */
 740         dev_info->speed_capa = (ETH_LINK_SPEED_1G |
 741                                 ETH_LINK_SPEED_10G |
 742                                 ETH_LINK_SPEED_25G |
 743                                 ETH_LINK_SPEED_40G |
 744                                 ETH_LINK_SPEED_50G |
 745                                 ETH_LINK_SPEED_100G);
 746
 747         return 0;
 748 }
 749
 750 static int
 751 eth_ark_dev_link_update(struct rte_eth_dev *dev, int wait_to_complete)
 752 {
 753         ARK_PMD_LOG(DEBUG, "link status = %d\n",
 754                         dev->data->dev_link.link_status);
 755         struct ark_adapter *ark = dev->data->dev_private;
 756
 757         if (ark->user_ext.link_update) {
 758                 return ark->user_ext.link_update
 759                         (dev, wait_to_complete,
 760                          ark->user_data[dev->data->port_id]);
 761         }
 762         return 0;
 763 }
 764
 765 static int
 766 eth_ark_dev_set_link_up(struct rte_eth_dev *dev)
 767 {
 768         dev->data->dev_link.link_status = 1;
 769         struct ark_adapter *ark = dev->data->dev_private;
 770
 771         if (ark->user_ext.dev_set_link_up)
 772                 return ark->user_ext.dev_set_link_up(dev,
 773                              ark->user_data[dev->data->port_id]);
 774         return 0;
 775 }
 776
 777 static int
 778 eth_ark_dev_set_link_down(struct rte_eth_dev *dev)
 779 {
 780         dev->data->dev_link.link_status = 0;
 781         struct ark_adapter *ark = dev->data->dev_private;
 782
 783         if (ark->user_ext.dev_set_link_down)
 784                 return ark->user_ext.dev_set_link_down(dev,
 785                        ark->user_data[dev->data->port_id]);
 786         return 0;
 787 }
 788
 789 static int
 790 eth_ark_dev_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
 791 {
 792         uint16_t i;
 793         struct ark_adapter *ark = dev->data->dev_private;
 794
 795         stats->ipackets = 0;
 796         stats->ibytes = 0;
 797         stats->opackets = 0;
 798         stats->obytes = 0;
 799         stats->imissed = 0;
 800         stats->oerrors = 0;
 801
 802         for (i = 0; i < dev->data->nb_tx_queues; i++)
 803                 eth_tx_queue_stats_get(dev->data->tx_queues[i], stats);
 804         for (i = 0; i < dev->data->nb_rx_queues; i++)
 805                 eth_rx_queue_stats_get(dev->data->rx_queues[i], stats);
 806         if (ark->user_ext.stats_get)
 807                 return ark->user_ext.stats_get(dev, stats,
 808                         ark->user_data[dev->data->port_id]);
 809         return 0;
 810 }
 811
 812 static int
 813 eth_ark_dev_stats_reset(struct rte_eth_dev *dev)
 814 {
 815         uint16_t i;
 816         struct ark_adapter *ark = dev->data->dev_private;
 817
 818         for (i = 0; i < dev->data->nb_tx_queues; i++)
 819                 eth_tx_queue_stats_reset(dev->data->tx_queues[i]);
 820         for (i = 0; i < dev->data->nb_rx_queues; i++)
 821                 eth_rx_queue_stats_reset(dev->data->rx_queues[i]);
 822         if (ark->user_ext.stats_reset)
 823                 ark->user_ext.stats_reset(dev,
 824                           ark->user_data[dev->data->port_id]);
 825
 826         return 0;
 827 }
 828
 829 static int
 830 eth_ark_macaddr_add(struct rte_eth_dev *dev,
 831                     struct rte_ether_addr *mac_addr,
 832                     uint32_t index,
 833                     uint32_t pool)
 834 {
 835         struct ark_adapter *ark = dev->data->dev_private;
 836
 837         if (ark->user_ext.mac_addr_add) {
 838                 ark->user_ext.mac_addr_add(dev,
 839                                            mac_addr,
 840                                            index,
 841                                            pool,
 842                            ark->user_data[dev->data->port_id]);
 843                 return 0;
 844         }
 845         return -ENOTSUP;
 846 }
 847
 848 static void
 849 eth_ark_macaddr_remove(struct rte_eth_dev *dev, uint32_t index)
 850 {
 851         struct ark_adapter *ark = dev->data->dev_private;
 852
 853         if (ark->user_ext.mac_addr_remove)
 854                 ark->user_ext.mac_addr_remove(dev, index,
 855                               ark->user_data[dev->data->port_id]);
 856 }
 857
 858 static int
 859 eth_ark_set_default_mac_addr(struct rte_eth_dev *dev,
 860                              struct rte_ether_addr *mac_addr)
 861 {
 862         struct ark_adapter *ark = dev->data->dev_private;
 863
 864         if (ark->user_ext.mac_addr_set) {
 865                 ark->user_ext.mac_addr_set(dev, mac_addr,
 866                            ark->user_data[dev->data->port_id]);
 867                 return 0;
 868         }
 869         return -ENOTSUP;
 870 }
 871
 872 static int
 873 eth_ark_set_mtu(struct rte_eth_dev *dev, uint16_t  size)
 874 {
 875         struct ark_adapter *ark = dev->data->dev_private;
 876
 877         if (ark->user_ext.set_mtu)
 878                 return ark->user_ext.set_mtu(dev, size,
 879                              ark->user_data[dev->data->port_id]);
 880
 881         return -ENOTSUP;
 882 }
 883
 884 static inline int
 885 process_pktdir_arg(const char *key, const char *value,
 886                    void *extra_args)
 887 {
 888         ARK_PMD_LOG(DEBUG, "key = %s, value = %s\n",
 889                     key, value);
 890         struct ark_adapter *ark =
 891                 (struct ark_adapter *)extra_args;
 892
 893         ark->pkt_dir_v = strtol(value, NULL, 16);
 894         ARK_PMD_LOG(DEBUG, "pkt_dir_v = 0x%x\n", ark->pkt_dir_v);
 895         return 0;
 896 }
 897
 898 static inline int
 899 process_file_args(const char *key, const char *value, void *extra_args)
 900 {
 901         ARK_PMD_LOG(DEBUG, "key = %s, value = %s\n",
 902                     key, value);
 903         char *args = (char *)extra_args;
 904
 905         /* Open the configuration file */
 906         FILE *file = fopen(value, "r");
 907         char line[ARK_MAX_ARG_LEN];
 908         int  size = 0;
 909         int first = 1;
 910
 911         if (file == NULL) {
 912                 ARK_PMD_LOG(ERR, "Unable to open "
 913                             "config file %s\n", value);
 914                 return -1;
 915         }
 916
 917         while (fgets(line, sizeof(line), file)) {
 918                 size += strlen(line);
 919                 if (size >= ARK_MAX_ARG_LEN) {
 920                         ARK_PMD_LOG(ERR, "Unable to parse file %s args, "
 921                                     "parameter list is too long\n", value);
 922                         fclose(file);
 923                         return -1;
 924                 }
 925                 if (first) {
 926                         strncpy(args, line, ARK_MAX_ARG_LEN);
 927                         first = 0;
 928                 } else {
 929                         strncat(args, line, ARK_MAX_ARG_LEN);
 930                 }
 931         }
 932         ARK_PMD_LOG(DEBUG, "file = %s\n", args);
 933         fclose(file);
 934         return 0;
 935 }
 936
 937 static int
 938 eth_ark_check_args(struct ark_adapter *ark, const char *params)
 939 {
 940         struct rte_kvargs *kvlist;
 941         unsigned int k_idx;
 942         struct rte_kvargs_pair *pair = NULL;
 943         int ret = -1;
 944
 945         kvlist = rte_kvargs_parse(params, valid_arguments);
 946         if (kvlist == NULL)
 947                 return 0;
 948
 949         ark->pkt_gen_args[0] = 0;
 950         ark->pkt_chkr_args[0] = 0;
 951
 952         for (k_idx = 0; k_idx < kvlist->count; k_idx++) {
 953                 pair = &kvlist->pairs[k_idx];
 954                 ARK_PMD_LOG(DEBUG, "**** Arg passed to PMD = %s:%s\n",
 955                              pair->key,
 956                              pair->value);
 957         }
 958
 959         if (rte_kvargs_process(kvlist,
 960                                ARK_PKTDIR_ARG,
 961                                &process_pktdir_arg,
 962                                ark) != 0) {
 963                 ARK_PMD_LOG(ERR, "Unable to parse arg %s\n", ARK_PKTDIR_ARG);
 964                 goto free_kvlist;
 965         }
 966
 967         if (rte_kvargs_process(kvlist,
 968                                ARK_PKTGEN_ARG,
 969                                &process_file_args,
 970                                ark->pkt_gen_args) != 0) {
 971                 ARK_PMD_LOG(ERR, "Unable to parse arg %s\n", ARK_PKTGEN_ARG);
 972                 goto free_kvlist;
 973         }
 974
 975         if (rte_kvargs_process(kvlist,
 976                                ARK_PKTCHKR_ARG,
 977                                &process_file_args,
 978                                ark->pkt_chkr_args) != 0) {
 979                 ARK_PMD_LOG(ERR, "Unable to parse arg %s\n", ARK_PKTCHKR_ARG);
 980                 goto free_kvlist;
 981         }
 982
 983         ARK_PMD_LOG(INFO, "packet director set to 0x%x\n", ark->pkt_dir_v);
 984         /* Setup the packet director */
 985         ark_pktdir_setup(ark->pd, ark->pkt_dir_v);
 986
 987         /* Setup the packet generator */
 988         if (ark->pkt_gen_args[0]) {
 989                 ARK_PMD_LOG(DEBUG, "Setting up the packet generator\n");
 990                 ark_pktgen_parse(ark->pkt_gen_args);
 991                 ark_pktgen_reset(ark->pg);
 992                 ark_pktgen_setup(ark->pg);
 993                 ark->start_pg = 1;
 994         }
 995
 996         /* Setup the packet checker */
 997         if (ark->pkt_chkr_args[0]) {
 998                 ark_pktchkr_parse(ark->pkt_chkr_args);
 999                 ark_pktchkr_setup(ark->pc);
1000         }
1001
1002         ret = 0;
1003
1004 free_kvlist:
1005         rte_kvargs_free(kvlist);
1006
1007         return ret;
1008 }
1009
1010 RTE_PMD_REGISTER_PCI(net_ark, rte_ark_pmd);
1011 RTE_PMD_REGISTER_KMOD_DEP(net_ark, "* igb_uio | uio_pci_generic ");
1012 RTE_PMD_REGISTER_PCI_TABLE(net_ark, pci_id_ark_map);
1013 RTE_PMD_REGISTER_PARAM_STRING(net_ark,
1014                               ARK_PKTGEN_ARG "=<filename> "
1015                               ARK_PKTCHKR_ARG "=<filename> "
1016                               ARK_PKTDIR_ARG "=<bitmap>");
1017 RTE_LOG_REGISTER(ark_logtype, pmd.net.ark, NOTICE);