drivers/net/dpaa/dpaa_ethdev.c

   1 /*-
   2  *   BSD LICENSE
   3  *
   4  *   Copyright 2016 Freescale Semiconductor, Inc. All rights reserved.
   5  *   Copyright 2017 NXP.
   6  *
   7  *   Redistribution and use in source and binary forms, with or without
   8  *   modification, are permitted provided that the following conditions
   9  *   are met:
  10  *
  11  *     * Redistributions of source code must retain the above copyright
  12  *       notice, this list of conditions and the following disclaimer.
  13  *     * Redistributions in binary form must reproduce the above copyright
  14  *       notice, this list of conditions and the following disclaimer in
  15  *       the documentation and/or other materials provided with the
  16  *       distribution.
  17  *     * Neither the name of  Freescale Semiconductor, Inc nor the names of its
  18  *       contributors may be used to endorse or promote products derived
  19  *       from this software without specific prior written permission.
  20  *
  21  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  22  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  23  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  24  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  25  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  26  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  27  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  28  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  29  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  30  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  31  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  32  */
  33 /* System headers */
  34 #include <stdio.h>
  35 #include <inttypes.h>
  36 #include <unistd.h>
  37 #include <limits.h>
  38 #include <sched.h>
  39 #include <signal.h>
  40 #include <pthread.h>
  41 #include <sys/types.h>
  42 #include <sys/syscall.h>
  43
  44 #include <rte_config.h>
  45 #include <rte_byteorder.h>
  46 #include <rte_common.h>
  47 #include <rte_interrupts.h>
  48 #include <rte_log.h>
  49 #include <rte_debug.h>
  50 #include <rte_pci.h>
  51 #include <rte_atomic.h>
  52 #include <rte_branch_prediction.h>
  53 #include <rte_memory.h>
  54 #include <rte_memzone.h>
  55 #include <rte_tailq.h>
  56 #include <rte_eal.h>
  57 #include <rte_alarm.h>
  58 #include <rte_ether.h>
  59 #include <rte_ethdev.h>
  60 #include <rte_malloc.h>
  61 #include <rte_ring.h>
  62
  63 #include <rte_dpaa_bus.h>
  64 #include <rte_dpaa_logs.h>
  65 #include <dpaa_mempool.h>
  66
  67 #include <dpaa_ethdev.h>
  68 #include <dpaa_rxtx.h>
  69
  70 #include <fsl_usd.h>
  71 #include <fsl_qman.h>
  72 #include <fsl_bman.h>
  73 #include <fsl_fman.h>
  74
  75 /* Keep track of whether QMAN and BMAN have been globally initialized */
  76 static int is_global_init;
  77
  78 static int
  79 dpaa_mtu_set(struct rte_eth_dev *dev, uint16_t mtu)
  80 {
  81         struct dpaa_if *dpaa_intf = dev->data->dev_private;
  82
  83         PMD_INIT_FUNC_TRACE();
  84
  85         if (mtu < ETHER_MIN_MTU)
  86                 return -EINVAL;
  87         if (mtu > ETHER_MAX_LEN)
  88                 dev->data->dev_conf.rxmode.jumbo_frame = 1;
  89         else
  90                 dev->data->dev_conf.rxmode.jumbo_frame = 0;
  91
  92         dev->data->dev_conf.rxmode.max_rx_pkt_len = mtu;
  93
  94         fman_if_set_maxfrm(dpaa_intf->fif, mtu);
  95
  96         return 0;
  97 }
  98
  99 static int
 100 dpaa_eth_dev_configure(struct rte_eth_dev *dev __rte_unused)
 101 {
 102         PMD_INIT_FUNC_TRACE();
 103
 104         if (dev->data->dev_conf.rxmode.jumbo_frame == 1) {
 105                 if (dev->data->dev_conf.rxmode.max_rx_pkt_len <=
 106                     DPAA_MAX_RX_PKT_LEN)
 107                         return dpaa_mtu_set(dev,
 108                                 dev->data->dev_conf.rxmode.max_rx_pkt_len);
 109                 else
 110                         return -1;
 111         }
 112         return 0;
 113 }
 114
 115 static int dpaa_eth_dev_start(struct rte_eth_dev *dev)
 116 {
 117         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 118
 119         PMD_INIT_FUNC_TRACE();
 120
 121         /* Change tx callback to the real one */
 122         dev->tx_pkt_burst = dpaa_eth_queue_tx;
 123         fman_if_enable_rx(dpaa_intf->fif);
 124
 125         return 0;
 126 }
 127
 128 static void dpaa_eth_dev_stop(struct rte_eth_dev *dev)
 129 {
 130         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 131
 132         PMD_INIT_FUNC_TRACE();
 133
 134         fman_if_disable_rx(dpaa_intf->fif);
 135         dev->tx_pkt_burst = dpaa_eth_tx_drop_all;
 136 }
 137
 138 static void dpaa_eth_dev_close(struct rte_eth_dev *dev)
 139 {
 140         PMD_INIT_FUNC_TRACE();
 141
 142         dpaa_eth_dev_stop(dev);
 143 }
 144
 145 static void dpaa_eth_dev_info(struct rte_eth_dev *dev,
 146                               struct rte_eth_dev_info *dev_info)
 147 {
 148         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 149
 150         PMD_INIT_FUNC_TRACE();
 151
 152         dev_info->max_rx_queues = dpaa_intf->nb_rx_queues;
 153         dev_info->max_tx_queues = dpaa_intf->nb_tx_queues;
 154         dev_info->min_rx_bufsize = DPAA_MIN_RX_BUF_SIZE;
 155         dev_info->max_rx_pktlen = DPAA_MAX_RX_PKT_LEN;
 156         dev_info->max_mac_addrs = DPAA_MAX_MAC_FILTER;
 157         dev_info->max_hash_mac_addrs = 0;
 158         dev_info->max_vfs = 0;
 159         dev_info->max_vmdq_pools = ETH_16_POOLS;
 160         dev_info->speed_capa = (ETH_LINK_SPEED_1G |
 161                                 ETH_LINK_SPEED_10G);
 162 }
 163
 164 static int dpaa_eth_link_update(struct rte_eth_dev *dev,
 165                                 int wait_to_complete __rte_unused)
 166 {
 167         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 168         struct rte_eth_link *link = &dev->data->dev_link;
 169
 170         PMD_INIT_FUNC_TRACE();
 171
 172         if (dpaa_intf->fif->mac_type == fman_mac_1g)
 173                 link->link_speed = 1000;
 174         else if (dpaa_intf->fif->mac_type == fman_mac_10g)
 175                 link->link_speed = 10000;
 176         else
 177                 DPAA_PMD_ERR("invalid link_speed: %s, %d",
 178                              dpaa_intf->name, dpaa_intf->fif->mac_type);
 179
 180         link->link_status = dpaa_intf->valid;
 181         link->link_duplex = ETH_LINK_FULL_DUPLEX;
 182         link->link_autoneg = ETH_LINK_AUTONEG;
 183         return 0;
 184 }
 185
 186 static void dpaa_eth_stats_get(struct rte_eth_dev *dev,
 187                                struct rte_eth_stats *stats)
 188 {
 189         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 190
 191         PMD_INIT_FUNC_TRACE();
 192
 193         fman_if_stats_get(dpaa_intf->fif, stats);
 194 }
 195
 196 static void dpaa_eth_stats_reset(struct rte_eth_dev *dev)
 197 {
 198         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 199
 200         PMD_INIT_FUNC_TRACE();
 201
 202         fman_if_stats_reset(dpaa_intf->fif);
 203 }
 204
 205 static void dpaa_eth_promiscuous_enable(struct rte_eth_dev *dev)
 206 {
 207         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 208
 209         PMD_INIT_FUNC_TRACE();
 210
 211         fman_if_promiscuous_enable(dpaa_intf->fif);
 212 }
 213
 214 static void dpaa_eth_promiscuous_disable(struct rte_eth_dev *dev)
 215 {
 216         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 217
 218         PMD_INIT_FUNC_TRACE();
 219
 220         fman_if_promiscuous_disable(dpaa_intf->fif);
 221 }
 222
 223 static void dpaa_eth_multicast_enable(struct rte_eth_dev *dev)
 224 {
 225         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 226
 227         PMD_INIT_FUNC_TRACE();
 228
 229         fman_if_set_mcast_filter_table(dpaa_intf->fif);
 230 }
 231
 232 static void dpaa_eth_multicast_disable(struct rte_eth_dev *dev)
 233 {
 234         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 235
 236         PMD_INIT_FUNC_TRACE();
 237
 238         fman_if_reset_mcast_filter_table(dpaa_intf->fif);
 239 }
 240
 241 static
 242 int dpaa_eth_rx_queue_setup(struct rte_eth_dev *dev, uint16_t queue_idx,
 243                             uint16_t nb_desc __rte_unused,
 244                             unsigned int socket_id __rte_unused,
 245                             const struct rte_eth_rxconf *rx_conf __rte_unused,
 246                             struct rte_mempool *mp)
 247 {
 248         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 249
 250         PMD_INIT_FUNC_TRACE();
 251
 252         DPAA_PMD_INFO("Rx queue setup for queue index: %d", queue_idx);
 253
 254         if (!dpaa_intf->bp_info || dpaa_intf->bp_info->mp != mp) {
 255                 struct fman_if_ic_params icp;
 256                 uint32_t fd_offset;
 257                 uint32_t bp_size;
 258
 259                 if (!mp->pool_data) {
 260                         DPAA_PMD_ERR("Not an offloaded buffer pool!");
 261                         return -1;
 262                 }
 263                 dpaa_intf->bp_info = DPAA_MEMPOOL_TO_POOL_INFO(mp);
 264
 265                 memset(&icp, 0, sizeof(icp));
 266                 /* set ICEOF for to the default value , which is 0*/
 267                 icp.iciof = DEFAULT_ICIOF;
 268                 icp.iceof = DEFAULT_RX_ICEOF;
 269                 icp.icsz = DEFAULT_ICSZ;
 270                 fman_if_set_ic_params(dpaa_intf->fif, &icp);
 271
 272                 fd_offset = RTE_PKTMBUF_HEADROOM + DPAA_HW_BUF_RESERVE;
 273                 fman_if_set_fdoff(dpaa_intf->fif, fd_offset);
 274
 275                 /* Buffer pool size should be equal to Dataroom Size*/
 276                 bp_size = rte_pktmbuf_data_room_size(mp);
 277                 fman_if_set_bp(dpaa_intf->fif, mp->size,
 278                                dpaa_intf->bp_info->bpid, bp_size);
 279                 dpaa_intf->valid = 1;
 280                 DPAA_PMD_INFO("if =%s - fd_offset = %d offset = %d",
 281                             dpaa_intf->name, fd_offset,
 282                         fman_if_get_fdoff(dpaa_intf->fif));
 283         }
 284         dev->data->rx_queues[queue_idx] = &dpaa_intf->rx_queues[queue_idx];
 285
 286         return 0;
 287 }
 288
 289 static
 290 void dpaa_eth_rx_queue_release(void *rxq __rte_unused)
 291 {
 292         PMD_INIT_FUNC_TRACE();
 293 }
 294
 295 static
 296 int dpaa_eth_tx_queue_setup(struct rte_eth_dev *dev, uint16_t queue_idx,
 297                             uint16_t nb_desc __rte_unused,
 298                 unsigned int socket_id __rte_unused,
 299                 const struct rte_eth_txconf *tx_conf __rte_unused)
 300 {
 301         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 302
 303         PMD_INIT_FUNC_TRACE();
 304
 305         DPAA_PMD_INFO("Tx queue setup for queue index: %d", queue_idx);
 306         dev->data->tx_queues[queue_idx] = &dpaa_intf->tx_queues[queue_idx];
 307         return 0;
 308 }
 309
 310 static void dpaa_eth_tx_queue_release(void *txq __rte_unused)
 311 {
 312         PMD_INIT_FUNC_TRACE();
 313 }
 314
 315 static int dpaa_link_down(struct rte_eth_dev *dev)
 316 {
 317         PMD_INIT_FUNC_TRACE();
 318
 319         dpaa_eth_dev_stop(dev);
 320         return 0;
 321 }
 322
 323 static int dpaa_link_up(struct rte_eth_dev *dev)
 324 {
 325         PMD_INIT_FUNC_TRACE();
 326
 327         dpaa_eth_dev_start(dev);
 328         return 0;
 329 }
 330
 331 static int
 332 dpaa_dev_add_mac_addr(struct rte_eth_dev *dev,
 333                              struct ether_addr *addr,
 334                              uint32_t index,
 335                              __rte_unused uint32_t pool)
 336 {
 337         int ret;
 338         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 339
 340         PMD_INIT_FUNC_TRACE();
 341
 342         ret = fman_if_add_mac_addr(dpaa_intf->fif, addr->addr_bytes, index);
 343
 344         if (ret)
 345                 RTE_LOG(ERR, PMD, "error: Adding the MAC ADDR failed:"
 346                         " err = %d", ret);
 347         return 0;
 348 }
 349
 350 static void
 351 dpaa_dev_remove_mac_addr(struct rte_eth_dev *dev,
 352                           uint32_t index)
 353 {
 354         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 355
 356         PMD_INIT_FUNC_TRACE();
 357
 358         fman_if_clear_mac_addr(dpaa_intf->fif, index);
 359 }
 360
 361 static void
 362 dpaa_dev_set_mac_addr(struct rte_eth_dev *dev,
 363                        struct ether_addr *addr)
 364 {
 365         int ret;
 366         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 367
 368         PMD_INIT_FUNC_TRACE();
 369
 370         ret = fman_if_add_mac_addr(dpaa_intf->fif, addr->addr_bytes, 0);
 371         if (ret)
 372                 RTE_LOG(ERR, PMD, "error: Setting the MAC ADDR failed %d", ret);
 373 }
 374
 375 static struct eth_dev_ops dpaa_devops = {
 376         .dev_configure            = dpaa_eth_dev_configure,
 377         .dev_start                = dpaa_eth_dev_start,
 378         .dev_stop                 = dpaa_eth_dev_stop,
 379         .dev_close                = dpaa_eth_dev_close,
 380         .dev_infos_get            = dpaa_eth_dev_info,
 381
 382         .rx_queue_setup           = dpaa_eth_rx_queue_setup,
 383         .tx_queue_setup           = dpaa_eth_tx_queue_setup,
 384         .rx_queue_release         = dpaa_eth_rx_queue_release,
 385         .tx_queue_release         = dpaa_eth_tx_queue_release,
 386
 387         .link_update              = dpaa_eth_link_update,
 388         .stats_get                = dpaa_eth_stats_get,
 389         .stats_reset              = dpaa_eth_stats_reset,
 390         .promiscuous_enable       = dpaa_eth_promiscuous_enable,
 391         .promiscuous_disable      = dpaa_eth_promiscuous_disable,
 392         .allmulticast_enable      = dpaa_eth_multicast_enable,
 393         .allmulticast_disable     = dpaa_eth_multicast_disable,
 394         .mtu_set                  = dpaa_mtu_set,
 395         .dev_set_link_down        = dpaa_link_down,
 396         .dev_set_link_up          = dpaa_link_up,
 397         .mac_addr_add             = dpaa_dev_add_mac_addr,
 398         .mac_addr_remove          = dpaa_dev_remove_mac_addr,
 399         .mac_addr_set             = dpaa_dev_set_mac_addr,
 400
 401 };
 402
 403 /* Initialise an Rx FQ */
 404 static int dpaa_rx_queue_init(struct qman_fq *fq,
 405                               uint32_t fqid)
 406 {
 407         struct qm_mcc_initfq opts;
 408         int ret;
 409
 410         PMD_INIT_FUNC_TRACE();
 411
 412         ret = qman_reserve_fqid(fqid);
 413         if (ret) {
 414                 DPAA_PMD_ERR("reserve rx fqid %d failed with ret: %d",
 415                              fqid, ret);
 416                 return -EINVAL;
 417         }
 418
 419         DPAA_PMD_DEBUG("creating rx fq %p, fqid %d", fq, fqid);
 420         ret = qman_create_fq(fqid, QMAN_FQ_FLAG_NO_ENQUEUE, fq);
 421         if (ret) {
 422                 DPAA_PMD_ERR("create rx fqid %d failed with ret: %d",
 423                         fqid, ret);
 424                 return ret;
 425         }
 426
 427         opts.we_mask = QM_INITFQ_WE_DESTWQ | QM_INITFQ_WE_FQCTRL |
 428                        QM_INITFQ_WE_CONTEXTA;
 429
 430         opts.fqd.dest.wq = DPAA_IF_RX_PRIORITY;
 431         opts.fqd.fq_ctrl = QM_FQCTRL_AVOIDBLOCK | QM_FQCTRL_CTXASTASHING |
 432                            QM_FQCTRL_PREFERINCACHE;
 433         opts.fqd.context_a.stashing.exclusive = 0;
 434         opts.fqd.context_a.stashing.annotation_cl = DPAA_IF_RX_ANNOTATION_STASH;
 435         opts.fqd.context_a.stashing.data_cl = DPAA_IF_RX_DATA_STASH;
 436         opts.fqd.context_a.stashing.context_cl = DPAA_IF_RX_CONTEXT_STASH;
 437
 438         /*Enable tail drop */
 439         opts.we_mask = opts.we_mask | QM_INITFQ_WE_TDTHRESH;
 440         opts.fqd.fq_ctrl = opts.fqd.fq_ctrl | QM_FQCTRL_TDE;
 441         qm_fqd_taildrop_set(&opts.fqd.td, CONG_THRESHOLD_RX_Q, 1);
 442
 443         ret = qman_init_fq(fq, 0, &opts);
 444         if (ret)
 445                 DPAA_PMD_ERR("init rx fqid %d failed with ret: %d", fqid, ret);
 446         return ret;
 447 }
 448
 449 /* Initialise a Tx FQ */
 450 static int dpaa_tx_queue_init(struct qman_fq *fq,
 451                               struct fman_if *fman_intf)
 452 {
 453         struct qm_mcc_initfq opts;
 454         int ret;
 455
 456         PMD_INIT_FUNC_TRACE();
 457
 458         ret = qman_create_fq(0, QMAN_FQ_FLAG_DYNAMIC_FQID |
 459                              QMAN_FQ_FLAG_TO_DCPORTAL, fq);
 460         if (ret) {
 461                 DPAA_PMD_ERR("create tx fq failed with ret: %d", ret);
 462                 return ret;
 463         }
 464         opts.we_mask = QM_INITFQ_WE_DESTWQ | QM_INITFQ_WE_FQCTRL |
 465                        QM_INITFQ_WE_CONTEXTB | QM_INITFQ_WE_CONTEXTA;
 466         opts.fqd.dest.channel = fman_intf->tx_channel_id;
 467         opts.fqd.dest.wq = DPAA_IF_TX_PRIORITY;
 468         opts.fqd.fq_ctrl = QM_FQCTRL_PREFERINCACHE;
 469         opts.fqd.context_b = 0;
 470         /* no tx-confirmation */
 471         opts.fqd.context_a.hi = 0x80000000 | fman_dealloc_bufs_mask_hi;
 472         opts.fqd.context_a.lo = 0 | fman_dealloc_bufs_mask_lo;
 473         DPAA_PMD_DEBUG("init tx fq %p, fqid %d", fq, fq->fqid);
 474         ret = qman_init_fq(fq, QMAN_INITFQ_FLAG_SCHED, &opts);
 475         if (ret)
 476                 DPAA_PMD_ERR("init tx fqid %d failed %d", fq->fqid, ret);
 477         return ret;
 478 }
 479
 480 /* Initialise a network interface */
 481 static int
 482 dpaa_dev_init(struct rte_eth_dev *eth_dev)
 483 {
 484         int num_cores, num_rx_fqs, fqid;
 485         int loop, ret = 0;
 486         int dev_id;
 487         struct rte_dpaa_device *dpaa_device;
 488         struct dpaa_if *dpaa_intf;
 489         struct fm_eth_port_cfg *cfg;
 490         struct fman_if *fman_intf;
 491         struct fman_if_bpool *bp, *tmp_bp;
 492
 493         PMD_INIT_FUNC_TRACE();
 494
 495         /* For secondary processes, the primary has done all the work */
 496         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
 497                 return 0;
 498
 499         dpaa_device = DEV_TO_DPAA_DEVICE(eth_dev->device);
 500         dev_id = dpaa_device->id.dev_id;
 501         dpaa_intf = eth_dev->data->dev_private;
 502         cfg = &dpaa_netcfg->port_cfg[dev_id];
 503         fman_intf = cfg->fman_if;
 504
 505         dpaa_intf->name = dpaa_device->name;
 506
 507         /* save fman_if & cfg in the interface struture */
 508         dpaa_intf->fif = fman_intf;
 509         dpaa_intf->ifid = dev_id;
 510         dpaa_intf->cfg = cfg;
 511
 512         /* Initialize Rx FQ's */
 513         if (getenv("DPAA_NUM_RX_QUEUES"))
 514                 num_rx_fqs = atoi(getenv("DPAA_NUM_RX_QUEUES"));
 515         else
 516                 num_rx_fqs = DPAA_DEFAULT_NUM_PCD_QUEUES;
 517
 518         /* Each device can not have more than DPAA_PCD_FQID_MULTIPLIER RX
 519          * queues.
 520          */
 521         if (num_rx_fqs <= 0 || num_rx_fqs > DPAA_PCD_FQID_MULTIPLIER) {
 522                 DPAA_PMD_ERR("Invalid number of RX queues\n");
 523                 return -EINVAL;
 524         }
 525
 526         dpaa_intf->rx_queues = rte_zmalloc(NULL,
 527                 sizeof(struct qman_fq) * num_rx_fqs, MAX_CACHELINE);
 528         for (loop = 0; loop < num_rx_fqs; loop++) {
 529                 fqid = DPAA_PCD_FQID_START + dpaa_intf->ifid *
 530                         DPAA_PCD_FQID_MULTIPLIER + loop;
 531                 ret = dpaa_rx_queue_init(&dpaa_intf->rx_queues[loop], fqid);
 532                 if (ret)
 533                         return ret;
 534                 dpaa_intf->rx_queues[loop].dpaa_intf = dpaa_intf;
 535         }
 536         dpaa_intf->nb_rx_queues = num_rx_fqs;
 537
 538         /* Initialise Tx FQs. Have as many Tx FQ's as number of cores */
 539         num_cores = rte_lcore_count();
 540         dpaa_intf->tx_queues = rte_zmalloc(NULL, sizeof(struct qman_fq) *
 541                 num_cores, MAX_CACHELINE);
 542         if (!dpaa_intf->tx_queues)
 543                 return -ENOMEM;
 544
 545         for (loop = 0; loop < num_cores; loop++) {
 546                 ret = dpaa_tx_queue_init(&dpaa_intf->tx_queues[loop],
 547                                          fman_intf);
 548                 if (ret)
 549                         return ret;
 550                 dpaa_intf->tx_queues[loop].dpaa_intf = dpaa_intf;
 551         }
 552         dpaa_intf->nb_tx_queues = num_cores;
 553
 554         DPAA_PMD_DEBUG("All frame queues created");
 555
 556         /* reset bpool list, initialize bpool dynamically */
 557         list_for_each_entry_safe(bp, tmp_bp, &cfg->fman_if->bpool_list, node) {
 558                 list_del(&bp->node);
 559                 rte_free(bp);
 560         }
 561
 562         /* Populate ethdev structure */
 563         eth_dev->dev_ops = &dpaa_devops;
 564         eth_dev->rx_pkt_burst = dpaa_eth_queue_rx;
 565         eth_dev->tx_pkt_burst = dpaa_eth_tx_drop_all;
 566
 567         /* Allocate memory for storing MAC addresses */
 568         eth_dev->data->mac_addrs = rte_zmalloc("mac_addr",
 569                 ETHER_ADDR_LEN * DPAA_MAX_MAC_FILTER, 0);
 570         if (eth_dev->data->mac_addrs == NULL) {
 571                 DPAA_PMD_ERR("Failed to allocate %d bytes needed to "
 572                                                 "store MAC addresses",
 573                                 ETHER_ADDR_LEN * DPAA_MAX_MAC_FILTER);
 574                 rte_free(dpaa_intf->rx_queues);
 575                 rte_free(dpaa_intf->tx_queues);
 576                 dpaa_intf->rx_queues = NULL;
 577                 dpaa_intf->tx_queues = NULL;
 578                 dpaa_intf->nb_rx_queues = 0;
 579                 dpaa_intf->nb_tx_queues = 0;
 580                 return -ENOMEM;
 581         }
 582
 583         /* copy the primary mac address */
 584         ether_addr_copy(&fman_intf->mac_addr, &eth_dev->data->mac_addrs[0]);
 585
 586         RTE_LOG(INFO, PMD, "net: dpaa: %s: %02x:%02x:%02x:%02x:%02x:%02x\n",
 587                 dpaa_device->name,
 588                 fman_intf->mac_addr.addr_bytes[0],
 589                 fman_intf->mac_addr.addr_bytes[1],
 590                 fman_intf->mac_addr.addr_bytes[2],
 591                 fman_intf->mac_addr.addr_bytes[3],
 592                 fman_intf->mac_addr.addr_bytes[4],
 593                 fman_intf->mac_addr.addr_bytes[5]);
 594
 595         /* Disable RX mode */
 596         fman_if_discard_rx_errors(fman_intf);
 597         fman_if_disable_rx(fman_intf);
 598         /* Disable promiscuous mode */
 599         fman_if_promiscuous_disable(fman_intf);
 600         /* Disable multicast */
 601         fman_if_reset_mcast_filter_table(fman_intf);
 602         /* Reset interface statistics */
 603         fman_if_stats_reset(fman_intf);
 604
 605         return 0;
 606 }
 607
 608 static int
 609 dpaa_dev_uninit(struct rte_eth_dev *dev)
 610 {
 611         struct dpaa_if *dpaa_intf = dev->data->dev_private;
 612
 613         PMD_INIT_FUNC_TRACE();
 614
 615         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
 616                 return -EPERM;
 617
 618         if (!dpaa_intf) {
 619                 DPAA_PMD_WARN("Already closed or not started");
 620                 return -1;
 621         }
 622
 623         dpaa_eth_dev_close(dev);
 624
 625         /* release configuration memory */
 626         if (dpaa_intf->fc_conf)
 627                 rte_free(dpaa_intf->fc_conf);
 628
 629         rte_free(dpaa_intf->rx_queues);
 630         dpaa_intf->rx_queues = NULL;
 631
 632         rte_free(dpaa_intf->tx_queues);
 633         dpaa_intf->tx_queues = NULL;
 634
 635         /* free memory for storing MAC addresses */
 636         rte_free(dev->data->mac_addrs);
 637         dev->data->mac_addrs = NULL;
 638
 639         dev->dev_ops = NULL;
 640         dev->rx_pkt_burst = NULL;
 641         dev->tx_pkt_burst = NULL;
 642
 643         return 0;
 644 }
 645
 646 static int
 647 rte_dpaa_probe(struct rte_dpaa_driver *dpaa_drv,
 648                struct rte_dpaa_device *dpaa_dev)
 649 {
 650         int diag;
 651         int ret;
 652         struct rte_eth_dev *eth_dev;
 653
 654         PMD_INIT_FUNC_TRACE();
 655
 656         /* In case of secondary process, the device is already configured
 657          * and no further action is required, except portal initialization
 658          * and verifying secondary attachment to port name.
 659          */
 660         if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
 661                 eth_dev = rte_eth_dev_attach_secondary(dpaa_dev->name);
 662                 if (!eth_dev)
 663                         return -ENOMEM;
 664                 return 0;
 665         }
 666
 667         if (!is_global_init) {
 668                 /* One time load of Qman/Bman drivers */
 669                 ret = qman_global_init();
 670                 if (ret) {
 671                         DPAA_PMD_ERR("QMAN initialization failed: %d",
 672                                      ret);
 673                         return ret;
 674                 }
 675                 ret = bman_global_init();
 676                 if (ret) {
 677                         DPAA_PMD_ERR("BMAN initialization failed: %d",
 678                                      ret);
 679                         return ret;
 680                 }
 681
 682                 is_global_init = 1;
 683         }
 684
 685         ret = rte_dpaa_portal_init((void *)1);
 686         if (ret) {
 687                 DPAA_PMD_ERR("Unable to initialize portal");
 688                 return ret;
 689         }
 690
 691         eth_dev = rte_eth_dev_allocate(dpaa_dev->name);
 692         if (eth_dev == NULL)
 693                 return -ENOMEM;
 694
 695         eth_dev->data->dev_private = rte_zmalloc(
 696                                         "ethdev private structure",
 697                                         sizeof(struct dpaa_if),
 698                                         RTE_CACHE_LINE_SIZE);
 699         if (!eth_dev->data->dev_private) {
 700                 DPAA_PMD_ERR("Cannot allocate memzone for port data");
 701                 rte_eth_dev_release_port(eth_dev);
 702                 return -ENOMEM;
 703         }
 704
 705         eth_dev->device = &dpaa_dev->device;
 706         eth_dev->device->driver = &dpaa_drv->driver;
 707         dpaa_dev->eth_dev = eth_dev;
 708
 709         /* Invoke PMD device initialization function */
 710         diag = dpaa_dev_init(eth_dev);
 711         if (diag == 0)
 712                 return 0;
 713
 714         if (rte_eal_process_type() == RTE_PROC_PRIMARY)
 715                 rte_free(eth_dev->data->dev_private);
 716
 717         rte_eth_dev_release_port(eth_dev);
 718         return diag;
 719 }
 720
 721 static int
 722 rte_dpaa_remove(struct rte_dpaa_device *dpaa_dev)
 723 {
 724         struct rte_eth_dev *eth_dev;
 725
 726         PMD_INIT_FUNC_TRACE();
 727
 728         eth_dev = dpaa_dev->eth_dev;
 729         dpaa_dev_uninit(eth_dev);
 730
 731         if (rte_eal_process_type() == RTE_PROC_PRIMARY)
 732                 rte_free(eth_dev->data->dev_private);
 733
 734         rte_eth_dev_release_port(eth_dev);
 735
 736         return 0;
 737 }
 738
 739 static struct rte_dpaa_driver rte_dpaa_pmd = {
 740         .drv_type = FSL_DPAA_ETH,
 741         .probe = rte_dpaa_probe,
 742         .remove = rte_dpaa_remove,
 743 };
 744
 745 RTE_PMD_REGISTER_DPAA(net_dpaa, rte_dpaa_pmd);