drivers/net/ethernet/samsung/sxgbe/sxgbe_main.c

   1 /* 10G controller driver for Samsung SoCs
   2  *
   3  * Copyright (C) 2013 Samsung Electronics Co., Ltd.
   4  *              http://www.samsung.com
   5  *
   6  * Author: Siva Reddy Kallam <siva.kallam@samsung.com>
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License version 2 as
  10  * published by the Free Software Foundation.
  11  */
  12
  13 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  14
  15 #include <linux/clk.h>
  16 #include <linux/crc32.h>
  17 #include <linux/dma-mapping.h>
  18 #include <linux/etherdevice.h>
  19 #include <linux/ethtool.h>
  20 #include <linux/if.h>
  21 #include <linux/if_ether.h>
  22 #include <linux/if_vlan.h>
  23 #include <linux/init.h>
  24 #include <linux/interrupt.h>
  25 #include <linux/ip.h>
  26 #include <linux/kernel.h>
  27 #include <linux/mii.h>
  28 #include <linux/module.h>
  29 #include <linux/net_tstamp.h>
  30 #include <linux/netdevice.h>
  31 #include <linux/phy.h>
  32 #include <linux/platform_device.h>
  33 #include <linux/prefetch.h>
  34 #include <linux/skbuff.h>
  35 #include <linux/slab.h>
  36 #include <linux/tcp.h>
  37 #include <linux/sxgbe_platform.h>
  38
  39 #include "sxgbe_common.h"
  40 #include "sxgbe_desc.h"
  41 #include "sxgbe_dma.h"
  42 #include "sxgbe_mtl.h"
  43 #include "sxgbe_reg.h"
  44
  45 #define SXGBE_ALIGN(x)  L1_CACHE_ALIGN(x)
  46 #define JUMBO_LEN       9000
  47
  48 /* Module parameters */
  49 #define TX_TIMEO        5000
  50 #define DMA_TX_SIZE     512
  51 #define DMA_RX_SIZE     1024
  52 #define TC_DEFAULT      64
  53 #define DMA_BUFFER_SIZE BUF_SIZE_2KiB
  54 /* The default timer value as per the sxgbe specification 1 sec(1000 ms) */
  55 #define SXGBE_DEFAULT_LPI_TIMER 1000
  56
  57 static int debug = -1;
  58 static int eee_timer = SXGBE_DEFAULT_LPI_TIMER;
  59
  60 module_param(eee_timer, int, S_IRUGO | S_IWUSR);
  61
  62 module_param(debug, int, S_IRUGO | S_IWUSR);
  63 static const u32 default_msg_level = (NETIF_MSG_DRV | NETIF_MSG_PROBE |
  64                                       NETIF_MSG_LINK | NETIF_MSG_IFUP |
  65                                       NETIF_MSG_IFDOWN | NETIF_MSG_TIMER);
  66
  67 static irqreturn_t sxgbe_common_interrupt(int irq, void *dev_id);
  68 static irqreturn_t sxgbe_tx_interrupt(int irq, void *dev_id);
  69 static irqreturn_t sxgbe_rx_interrupt(int irq, void *dev_id);
  70
  71 #define SXGBE_COAL_TIMER(x) (jiffies + usecs_to_jiffies(x))
  72
  73 #define SXGBE_LPI_TIMER(x) (jiffies + msecs_to_jiffies(x))
  74
  75 /**
  76  * sxgbe_verify_args - verify the driver parameters.
  77  * Description: it verifies if some wrong parameter is passed to the driver.
  78  * Note that wrong parameters are replaced with the default values.
  79  */
  80 static void sxgbe_verify_args(void)
  81 {
  82         if (unlikely(eee_timer < 0))
  83                 eee_timer = SXGBE_DEFAULT_LPI_TIMER;
  84 }
  85
  86 static void sxgbe_enable_eee_mode(const struct sxgbe_priv_data *priv)
  87 {
  88         /* Check and enter in LPI mode */
  89         if (!priv->tx_path_in_lpi_mode)
  90                 priv->hw->mac->set_eee_mode(priv->ioaddr);
  91 }
  92
  93 void sxgbe_disable_eee_mode(struct sxgbe_priv_data * const priv)
  94 {
  95         /* Exit and disable EEE in case of we are are in LPI state. */
  96         priv->hw->mac->reset_eee_mode(priv->ioaddr);
  97         del_timer_sync(&priv->eee_ctrl_timer);
  98         priv->tx_path_in_lpi_mode = false;
  99 }
 100
 101 /**
 102  * sxgbe_eee_ctrl_timer
 103  * @arg : data hook
 104  * Description:
 105  *  If there is no data transfer and if we are not in LPI state,
 106  *  then MAC Transmitter can be moved to LPI state.
 107  */
 108 static void sxgbe_eee_ctrl_timer(unsigned long arg)
 109 {
 110         struct sxgbe_priv_data *priv = (struct sxgbe_priv_data *)arg;
 111
 112         sxgbe_enable_eee_mode(priv);
 113         mod_timer(&priv->eee_ctrl_timer, SXGBE_LPI_TIMER(eee_timer));
 114 }
 115
 116 /**
 117  * sxgbe_eee_init
 118  * @priv: private device pointer
 119  * Description:
 120  *  If the EEE support has been enabled while configuring the driver,
 121  *  if the GMAC actually supports the EEE (from the HW cap reg) and the
 122  *  phy can also manage EEE, so enable the LPI state and start the timer
 123  *  to verify if the tx path can enter in LPI state.
 124  */
 125 bool sxgbe_eee_init(struct sxgbe_priv_data * const priv)
 126 {
 127         bool ret = false;
 128
 129         /* MAC core supports the EEE feature. */
 130         if (priv->hw_cap.eee) {
 131                 /* Check if the PHY supports EEE */
 132                 if (phy_init_eee(priv->phydev, 1))
 133                         return false;
 134
 135                 priv->eee_active = 1;
 136                 init_timer(&priv->eee_ctrl_timer);
 137                 priv->eee_ctrl_timer.function = sxgbe_eee_ctrl_timer;
 138                 priv->eee_ctrl_timer.data = (unsigned long)priv;
 139                 priv->eee_ctrl_timer.expires = SXGBE_LPI_TIMER(eee_timer);
 140                 add_timer(&priv->eee_ctrl_timer);
 141
 142                 priv->hw->mac->set_eee_timer(priv->ioaddr,
 143                                              SXGBE_DEFAULT_LPI_TIMER,
 144                                              priv->tx_lpi_timer);
 145
 146                 pr_info("Energy-Efficient Ethernet initialized\n");
 147
 148                 ret = true;
 149         }
 150
 151         return ret;
 152 }
 153
 154 static void sxgbe_eee_adjust(const struct sxgbe_priv_data *priv)
 155 {
 156         /* When the EEE has been already initialised we have to
 157          * modify the PLS bit in the LPI ctrl & status reg according
 158          * to the PHY link status. For this reason.
 159          */
 160         if (priv->eee_enabled)
 161                 priv->hw->mac->set_eee_pls(priv->ioaddr, priv->phydev->link);
 162 }
 163
 164 /**
 165  * sxgbe_clk_csr_set - dynamically set the MDC clock
 166  * @priv: driver private structure
 167  * Description: this is to dynamically set the MDC clock according to the csr
 168  * clock input.
 169  */
 170 static void sxgbe_clk_csr_set(struct sxgbe_priv_data *priv)
 171 {
 172         u32 clk_rate = clk_get_rate(priv->sxgbe_clk);
 173
 174         /* assign the proper divider, this will be used during
 175          * mdio communication
 176          */
 177         if (clk_rate < SXGBE_CSR_F_150M)
 178                 priv->clk_csr = SXGBE_CSR_100_150M;
 179         else if (clk_rate <= SXGBE_CSR_F_250M)
 180                 priv->clk_csr = SXGBE_CSR_150_250M;
 181         else if (clk_rate <= SXGBE_CSR_F_300M)
 182                 priv->clk_csr = SXGBE_CSR_250_300M;
 183         else if (clk_rate <= SXGBE_CSR_F_350M)
 184                 priv->clk_csr = SXGBE_CSR_300_350M;
 185         else if (clk_rate <= SXGBE_CSR_F_400M)
 186                 priv->clk_csr = SXGBE_CSR_350_400M;
 187         else if (clk_rate <= SXGBE_CSR_F_500M)
 188                 priv->clk_csr = SXGBE_CSR_400_500M;
 189 }
 190
 191 /* minimum number of free TX descriptors required to wake up TX process */
 192 #define SXGBE_TX_THRESH(x)      (x->dma_tx_size/4)
 193
 194 static inline u32 sxgbe_tx_avail(struct sxgbe_tx_queue *queue, int tx_qsize)
 195 {
 196         return queue->dirty_tx + tx_qsize - queue->cur_tx - 1;
 197 }
 198
 199 /**
 200  * sxgbe_adjust_link
 201  * @dev: net device structure
 202  * Description: it adjusts the link parameters.
 203  */
 204 static void sxgbe_adjust_link(struct net_device *dev)
 205 {
 206         struct sxgbe_priv_data *priv = netdev_priv(dev);
 207         struct phy_device *phydev = priv->phydev;
 208         u8 new_state = 0;
 209         u8 speed = 0xff;
 210
 211         if (!phydev)
 212                 return;
 213
 214         /* SXGBE is not supporting auto-negotiation and
 215          * half duplex mode. so, not handling duplex change
 216          * in this function. only handling speed and link status
 217          */
 218         if (phydev->link) {
 219                 if (phydev->speed != priv->speed) {
 220                         new_state = 1;
 221                         switch (phydev->speed) {
 222                         case SPEED_10000:
 223                                 speed = SXGBE_SPEED_10G;
 224                                 break;
 225                         case SPEED_2500:
 226                                 speed = SXGBE_SPEED_2_5G;
 227                                 break;
 228                         case SPEED_1000:
 229                                 speed = SXGBE_SPEED_1G;
 230                                 break;
 231                         default:
 232                                 netif_err(priv, link, dev,
 233                                           "Speed (%d) not supported\n",
 234                                           phydev->speed);
 235                         }
 236
 237                         priv->speed = phydev->speed;
 238                         priv->hw->mac->set_speed(priv->ioaddr, speed);
 239                 }
 240
 241                 if (!priv->oldlink) {
 242                         new_state = 1;
 243                         priv->oldlink = 1;
 244                 }
 245         } else if (priv->oldlink) {
 246                 new_state = 1;
 247                 priv->oldlink = 0;
 248                 priv->speed = SPEED_UNKNOWN;
 249         }
 250
 251         if (new_state & netif_msg_link(priv))
 252                 phy_print_status(phydev);
 253
 254         /* Alter the MAC settings for EEE */
 255         sxgbe_eee_adjust(priv);
 256 }
 257
 258 /**
 259  * sxgbe_init_phy - PHY initialization
 260  * @dev: net device structure
 261  * Description: it initializes the driver's PHY state, and attaches the PHY
 262  * to the mac driver.
 263  *  Return value:
 264  *  0 on success
 265  */
 266 static int sxgbe_init_phy(struct net_device *ndev)
 267 {
 268         char phy_id_fmt[MII_BUS_ID_SIZE + 3];
 269         char bus_id[MII_BUS_ID_SIZE];
 270         struct phy_device *phydev;
 271         struct sxgbe_priv_data *priv = netdev_priv(ndev);
 272         int phy_iface = priv->plat->interface;
 273
 274         /* assign default link status */
 275         priv->oldlink = 0;
 276         priv->speed = SPEED_UNKNOWN;
 277         priv->oldduplex = DUPLEX_UNKNOWN;
 278
 279         if (priv->plat->phy_bus_name)
 280                 snprintf(bus_id, MII_BUS_ID_SIZE, "%s-%x",
 281                          priv->plat->phy_bus_name, priv->plat->bus_id);
 282         else
 283                 snprintf(bus_id, MII_BUS_ID_SIZE, "sxgbe-%x",
 284                          priv->plat->bus_id);
 285
 286         snprintf(phy_id_fmt, MII_BUS_ID_SIZE + 3, PHY_ID_FMT, bus_id,
 287                  priv->plat->phy_addr);
 288         netdev_dbg(ndev, "%s: trying to attach to %s\n", __func__, phy_id_fmt);
 289
 290         phydev = phy_connect(ndev, phy_id_fmt, &sxgbe_adjust_link, phy_iface);
 291
 292         if (IS_ERR(phydev)) {
 293                 netdev_err(ndev, "Could not attach to PHY\n");
 294                 return PTR_ERR(phydev);
 295         }
 296
 297         /* Stop Advertising 1000BASE Capability if interface is not GMII */
 298         if ((phy_iface == PHY_INTERFACE_MODE_MII) ||
 299             (phy_iface == PHY_INTERFACE_MODE_RMII))
 300                 phydev->advertising &= ~(SUPPORTED_1000baseT_Half |
 301                                          SUPPORTED_1000baseT_Full);
 302         if (phydev->phy_id == 0) {
 303                 phy_disconnect(phydev);
 304                 return -ENODEV;
 305         }
 306
 307         netdev_dbg(ndev, "%s: attached to PHY (UID 0x%x) Link = %d\n",
 308                    __func__, phydev->phy_id, phydev->link);
 309
 310         /* save phy device in private structure */
 311         priv->phydev = phydev;
 312
 313         return 0;
 314 }
 315
 316 /**
 317  * sxgbe_clear_descriptors: clear descriptors
 318  * @priv: driver private structure
 319  * Description: this function is called to clear the tx and rx descriptors
 320  * in case of both basic and extended descriptors are used.
 321  */
 322 static void sxgbe_clear_descriptors(struct sxgbe_priv_data *priv)
 323 {
 324         int i, j;
 325         unsigned int txsize = priv->dma_tx_size;
 326         unsigned int rxsize = priv->dma_rx_size;
 327
 328         /* Clear the Rx/Tx descriptors */
 329         for (j = 0; j < SXGBE_RX_QUEUES; j++) {
 330                 for (i = 0; i < rxsize; i++)
 331                         priv->hw->desc->init_rx_desc(&priv->rxq[j]->dma_rx[i],
 332                                                      priv->use_riwt, priv->mode,
 333                                                      (i == rxsize - 1));
 334         }
 335
 336         for (j = 0; j < SXGBE_TX_QUEUES; j++) {
 337                 for (i = 0; i < txsize; i++)
 338                         priv->hw->desc->init_tx_desc(&priv->txq[j]->dma_tx[i]);
 339         }
 340 }
 341
 342 static int sxgbe_init_rx_buffers(struct net_device *dev,
 343                                  struct sxgbe_rx_norm_desc *p, int i,
 344                                  unsigned int dma_buf_sz,
 345                                  struct sxgbe_rx_queue *rx_ring)
 346 {
 347         struct sxgbe_priv_data *priv = netdev_priv(dev);
 348         struct sk_buff *skb;
 349
 350         skb = __netdev_alloc_skb_ip_align(dev, dma_buf_sz, GFP_KERNEL);
 351         if (!skb)
 352                 return -ENOMEM;
 353
 354         rx_ring->rx_skbuff[i] = skb;
 355         rx_ring->rx_skbuff_dma[i] = dma_map_single(priv->device, skb->data,
 356                                                    dma_buf_sz, DMA_FROM_DEVICE);
 357
 358         if (dma_mapping_error(priv->device, rx_ring->rx_skbuff_dma[i])) {
 359                 netdev_err(dev, "%s: DMA mapping error\n", __func__);
 360                 dev_kfree_skb_any(skb);
 361                 return -EINVAL;
 362         }
 363
 364         p->rdes23.rx_rd_des23.buf2_addr = rx_ring->rx_skbuff_dma[i];
 365
 366         return 0;
 367 }
 368 /**
 369  * init_tx_ring - init the TX descriptor ring
 370  * @dev: net device structure
 371  * @tx_ring: ring to be intialised
 372  * @tx_rsize: ring size
 373  * Description:  this function initializes the DMA TX descriptor
 374  */
 375 static int init_tx_ring(struct device *dev, u8 queue_no,
 376                         struct sxgbe_tx_queue *tx_ring, int tx_rsize)
 377 {
 378         /* TX ring is not allcoated */
 379         if (!tx_ring) {
 380                 dev_err(dev, "No memory for TX queue of SXGBE\n");
 381                 return -ENOMEM;
 382         }
 383
 384         /* allocate memory for TX descriptors */
 385         tx_ring->dma_tx = dma_zalloc_coherent(dev,
 386                                               tx_rsize * sizeof(struct sxgbe_tx_norm_desc),
 387                                               &tx_ring->dma_tx_phy, GFP_KERNEL);
 388         if (!tx_ring->dma_tx)
 389                 return -ENOMEM;
 390
 391         /* allocate memory for TX skbuff array */
 392         tx_ring->tx_skbuff_dma = devm_kcalloc(dev, tx_rsize,
 393                                               sizeof(dma_addr_t), GFP_KERNEL);
 394         if (!tx_ring->tx_skbuff_dma)
 395                 goto dmamem_err;
 396
 397         tx_ring->tx_skbuff = devm_kcalloc(dev, tx_rsize,
 398                                           sizeof(struct sk_buff *), GFP_KERNEL);
 399
 400         if (!tx_ring->tx_skbuff)
 401                 goto dmamem_err;
 402
 403         /* assign queue number */
 404         tx_ring->queue_no = queue_no;
 405
 406         /* initalise counters */
 407         tx_ring->dirty_tx = 0;
 408         tx_ring->cur_tx = 0;
 409
 410         /* initalise TX queue lock */
 411         spin_lock_init(&tx_ring->tx_lock);
 412
 413         return 0;
 414
 415 dmamem_err:
 416         dma_free_coherent(dev, tx_rsize * sizeof(struct sxgbe_tx_norm_desc),
 417                           tx_ring->dma_tx, tx_ring->dma_tx_phy);
 418         return -ENOMEM;
 419 }
 420
 421 /**
 422  * free_rx_ring - free the RX descriptor ring
 423  * @dev: net device structure
 424  * @rx_ring: ring to be intialised
 425  * @rx_rsize: ring size
 426  * Description:  this function initializes the DMA RX descriptor
 427  */
 428 void free_rx_ring(struct device *dev, struct sxgbe_rx_queue *rx_ring,
 429                   int rx_rsize)
 430 {
 431         dma_free_coherent(dev, rx_rsize * sizeof(struct sxgbe_rx_norm_desc),
 432                           rx_ring->dma_rx, rx_ring->dma_rx_phy);
 433         kfree(rx_ring->rx_skbuff_dma);
 434         kfree(rx_ring->rx_skbuff);
 435 }
 436
 437 /**
 438  * init_rx_ring - init the RX descriptor ring
 439  * @dev: net device structure
 440  * @rx_ring: ring to be intialised
 441  * @rx_rsize: ring size
 442  * Description:  this function initializes the DMA RX descriptor
 443  */
 444 static int init_rx_ring(struct net_device *dev, u8 queue_no,
 445                         struct sxgbe_rx_queue *rx_ring, int rx_rsize)
 446 {
 447         struct sxgbe_priv_data *priv = netdev_priv(dev);
 448         int desc_index;
 449         unsigned int bfsize = 0;
 450         unsigned int ret = 0;
 451
 452         /* Set the max buffer size according to the MTU. */
 453         bfsize = ALIGN(dev->mtu + ETH_HLEN + ETH_FCS_LEN + NET_IP_ALIGN, 8);
 454
 455         netif_dbg(priv, probe, dev, "%s: bfsize %d\n", __func__, bfsize);
 456
 457         /* RX ring is not allcoated */
 458         if (rx_ring == NULL) {
 459                 netdev_err(dev, "No memory for RX queue\n");
 460                 goto error;
 461         }
 462
 463         /* assign queue number */
 464         rx_ring->queue_no = queue_no;
 465
 466         /* allocate memory for RX descriptors */
 467         rx_ring->dma_rx = dma_zalloc_coherent(priv->device,
 468                                               rx_rsize * sizeof(struct sxgbe_rx_norm_desc),
 469                                               &rx_ring->dma_rx_phy, GFP_KERNEL);
 470
 471         if (rx_ring->dma_rx == NULL)
 472                 goto error;
 473
 474         /* allocate memory for RX skbuff array */
 475         rx_ring->rx_skbuff_dma = kmalloc_array(rx_rsize,
 476                                                sizeof(dma_addr_t), GFP_KERNEL);
 477         if (rx_ring->rx_skbuff_dma == NULL)
 478                 goto dmamem_err;
 479
 480         rx_ring->rx_skbuff = kmalloc_array(rx_rsize,
 481                                            sizeof(struct sk_buff *), GFP_KERNEL);
 482         if (rx_ring->rx_skbuff == NULL)
 483                 goto rxbuff_err;
 484
 485         /* initialise the buffers */
 486         for (desc_index = 0; desc_index < rx_rsize; desc_index++) {
 487                 struct sxgbe_rx_norm_desc *p;
 488                 p = rx_ring->dma_rx + desc_index;
 489                 ret = sxgbe_init_rx_buffers(dev, p, desc_index,
 490                                             bfsize, rx_ring);
 491                 if (ret)
 492                         goto err_init_rx_buffers;
 493         }
 494
 495         /* initalise counters */
 496         rx_ring->cur_rx = 0;
 497         rx_ring->dirty_rx = (unsigned int)(desc_index - rx_rsize);
 498         priv->dma_buf_sz = bfsize;
 499
 500         return 0;
 501
 502 err_init_rx_buffers:
 503         while (--desc_index >= 0)
 504                 free_rx_ring(priv->device, rx_ring, desc_index);
 505         kfree(rx_ring->rx_skbuff);
 506 rxbuff_err:
 507         kfree(rx_ring->rx_skbuff_dma);
 508 dmamem_err:
 509         dma_free_coherent(priv->device,
 510                           rx_rsize * sizeof(struct sxgbe_rx_norm_desc),
 511                           rx_ring->dma_rx, rx_ring->dma_rx_phy);
 512 error:
 513         return -ENOMEM;
 514 }
 515 /**
 516  * free_tx_ring - free the TX descriptor ring
 517  * @dev: net device structure
 518  * @tx_ring: ring to be intialised
 519  * @tx_rsize: ring size
 520  * Description:  this function initializes the DMA TX descriptor
 521  */
 522 void free_tx_ring(struct device *dev, struct sxgbe_tx_queue *tx_ring,
 523                   int tx_rsize)
 524 {
 525         dma_free_coherent(dev, tx_rsize * sizeof(struct sxgbe_tx_norm_desc),
 526                           tx_ring->dma_tx, tx_ring->dma_tx_phy);
 527 }
 528
 529 /**
 530  * init_dma_desc_rings - init the RX/TX descriptor rings
 531  * @dev: net device structure
 532  * Description:  this function initializes the DMA RX/TX descriptors
 533  * and allocates the socket buffers. It suppors the chained and ring
 534  * modes.
 535  */
 536 static int init_dma_desc_rings(struct net_device *netd)
 537 {
 538         int queue_num, ret;
 539         struct sxgbe_priv_data *priv = netdev_priv(netd);
 540         int tx_rsize = priv->dma_tx_size;
 541         int rx_rsize = priv->dma_rx_size;
 542
 543         /* Allocate memory for queue structures and TX descs */
 544         SXGBE_FOR_EACH_QUEUE(SXGBE_TX_QUEUES, queue_num) {
 545                 ret = init_tx_ring(priv->device, queue_num,
 546                                    priv->txq[queue_num], tx_rsize);
 547                 if (ret) {
 548                         dev_err(&netd->dev, "TX DMA ring allocation failed!\n");
 549                         goto txalloc_err;
 550                 }
 551
 552                 /* save private pointer in each ring this
 553                  * pointer is needed during cleaing TX queue
 554                  */
 555                 priv->txq[queue_num]->priv_ptr = priv;
 556         }
 557
 558         /* Allocate memory for queue structures and RX descs */
 559         SXGBE_FOR_EACH_QUEUE(SXGBE_RX_QUEUES, queue_num) {
 560                 ret = init_rx_ring(netd, queue_num,
 561                                    priv->rxq[queue_num], rx_rsize);
 562                 if (ret) {
 563                         netdev_err(netd, "RX DMA ring allocation failed!!\n");
 564                         goto rxalloc_err;
 565                 }
 566
 567                 /* save private pointer in each ring this
 568                  * pointer is needed during cleaing TX queue
 569                  */
 570                 priv->rxq[queue_num]->priv_ptr = priv;
 571         }
 572
 573         sxgbe_clear_descriptors(priv);
 574
 575         return 0;
 576
 577 txalloc_err:
 578         while (queue_num--)
 579                 free_tx_ring(priv->device, priv->txq[queue_num], tx_rsize);
 580         return ret;
 581
 582 rxalloc_err:
 583         while (queue_num--)
 584                 free_rx_ring(priv->device, priv->rxq[queue_num], rx_rsize);
 585         return ret;
 586 }
 587
 588 static void tx_free_ring_skbufs(struct sxgbe_tx_queue *txqueue)
 589 {
 590         int dma_desc;
 591         struct sxgbe_priv_data *priv = txqueue->priv_ptr;
 592         int tx_rsize = priv->dma_tx_size;
 593
 594         for (dma_desc = 0; dma_desc < tx_rsize; dma_desc++) {
 595                 struct sxgbe_tx_norm_desc *tdesc = txqueue->dma_tx + dma_desc;
 596
 597                 if (txqueue->tx_skbuff_dma[dma_desc])
 598                         dma_unmap_single(priv->device,
 599                                          txqueue->tx_skbuff_dma[dma_desc],
 600                                          priv->hw->desc->get_tx_len(tdesc),
 601                                          DMA_TO_DEVICE);
 602
 603                 dev_kfree_skb_any(txqueue->tx_skbuff[dma_desc]);
 604                 txqueue->tx_skbuff[dma_desc] = NULL;
 605                 txqueue->tx_skbuff_dma[dma_desc] = 0;
 606         }
 607 }
 608
 609
 610 static void dma_free_tx_skbufs(struct sxgbe_priv_data *priv)
 611 {
 612         int queue_num;
 613
 614         SXGBE_FOR_EACH_QUEUE(SXGBE_TX_QUEUES, queue_num) {
 615                 struct sxgbe_tx_queue *tqueue = priv->txq[queue_num];
 616                 tx_free_ring_skbufs(tqueue);
 617         }
 618 }
 619
 620 static void free_dma_desc_resources(struct sxgbe_priv_data *priv)
 621 {
 622         int queue_num;
 623         int tx_rsize = priv->dma_tx_size;
 624         int rx_rsize = priv->dma_rx_size;
 625
 626         /* Release the DMA TX buffers */
 627         dma_free_tx_skbufs(priv);
 628
 629         /* Release the TX ring memory also */
 630         SXGBE_FOR_EACH_QUEUE(SXGBE_TX_QUEUES, queue_num) {
 631                 free_tx_ring(priv->device, priv->txq[queue_num], tx_rsize);
 632         }
 633
 634         /* Release the RX ring memory also */
 635         SXGBE_FOR_EACH_QUEUE(SXGBE_RX_QUEUES, queue_num) {
 636                 free_rx_ring(priv->device, priv->rxq[queue_num], rx_rsize);
 637         }
 638 }
 639
 640 static int txring_mem_alloc(struct sxgbe_priv_data *priv)
 641 {
 642         int queue_num;
 643
 644         SXGBE_FOR_EACH_QUEUE(SXGBE_TX_QUEUES, queue_num) {
 645                 priv->txq[queue_num] = devm_kmalloc(priv->device,
 646                                                     sizeof(struct sxgbe_tx_queue), GFP_KERNEL);
 647                 if (!priv->txq[queue_num])
 648                         return -ENOMEM;
 649         }
 650
 651         return 0;
 652 }
 653
 654 static int rxring_mem_alloc(struct sxgbe_priv_data *priv)
 655 {
 656         int queue_num;
 657
 658         SXGBE_FOR_EACH_QUEUE(SXGBE_RX_QUEUES, queue_num) {
 659                 priv->rxq[queue_num] = devm_kmalloc(priv->device,
 660                                                     sizeof(struct sxgbe_rx_queue), GFP_KERNEL);
 661                 if (!priv->rxq[queue_num])
 662                         return -ENOMEM;
 663         }
 664
 665         return 0;
 666 }
 667
 668 /**
 669  *  sxgbe_mtl_operation_mode - HW MTL operation mode
 670  *  @priv: driver private structure
 671  *  Description: it sets the MTL operation mode: tx/rx MTL thresholds
 672  *  or Store-And-Forward capability.
 673  */
 674 static void sxgbe_mtl_operation_mode(struct sxgbe_priv_data *priv)
 675 {
 676         int queue_num;
 677
 678         /* TX/RX threshold control */
 679         if (likely(priv->plat->force_sf_dma_mode)) {
 680                 /* set TC mode for TX QUEUES */
 681                 SXGBE_FOR_EACH_QUEUE(priv->hw_cap.tx_mtl_queues, queue_num)
 682                         priv->hw->mtl->set_tx_mtl_mode(priv->ioaddr, queue_num,
 683                                                        SXGBE_MTL_SFMODE);
 684                 priv->tx_tc = SXGBE_MTL_SFMODE;
 685
 686                 /* set TC mode for RX QUEUES */
 687                 SXGBE_FOR_EACH_QUEUE(priv->hw_cap.rx_mtl_queues, queue_num)
 688                         priv->hw->mtl->set_rx_mtl_mode(priv->ioaddr, queue_num,
 689                                                        SXGBE_MTL_SFMODE);
 690                 priv->rx_tc = SXGBE_MTL_SFMODE;
 691         } else if (unlikely(priv->plat->force_thresh_dma_mode)) {
 692                 /* set TC mode for TX QUEUES */
 693                 SXGBE_FOR_EACH_QUEUE(priv->hw_cap.tx_mtl_queues, queue_num)
 694                         priv->hw->mtl->set_tx_mtl_mode(priv->ioaddr, queue_num,
 695                                                        priv->tx_tc);
 696                 /* set TC mode for RX QUEUES */
 697                 SXGBE_FOR_EACH_QUEUE(priv->hw_cap.rx_mtl_queues, queue_num)
 698                         priv->hw->mtl->set_rx_mtl_mode(priv->ioaddr, queue_num,
 699                                                        priv->rx_tc);
 700         } else {
 701                 pr_err("ERROR: %s: Invalid TX threshold mode\n", __func__);
 702         }
 703 }
 704
 705 /**
 706  * sxgbe_tx_queue_clean:
 707  * @priv: driver private structure
 708  * Description: it reclaims resources after transmission completes.
 709  */
 710 static void sxgbe_tx_queue_clean(struct sxgbe_tx_queue *tqueue)
 711 {
 712         struct sxgbe_priv_data *priv = tqueue->priv_ptr;
 713         unsigned int tx_rsize = priv->dma_tx_size;
 714         struct netdev_queue *dev_txq;
 715         u8 queue_no = tqueue->queue_no;
 716
 717         dev_txq = netdev_get_tx_queue(priv->dev, queue_no);
 718
 719         spin_lock(&tqueue->tx_lock);
 720
 721         priv->xstats.tx_clean++;
 722         while (tqueue->dirty_tx != tqueue->cur_tx) {
 723                 unsigned int entry = tqueue->dirty_tx % tx_rsize;
 724                 struct sk_buff *skb = tqueue->tx_skbuff[entry];
 725                 struct sxgbe_tx_norm_desc *p;
 726
 727                 p = tqueue->dma_tx + entry;
 728
 729                 /* Check if the descriptor is owned by the DMA. */
 730                 if (priv->hw->desc->get_tx_owner(p))
 731                         break;
 732
 733                 if (netif_msg_tx_done(priv))
 734                         pr_debug("%s: curr %d, dirty %d\n",
 735                                  __func__, tqueue->cur_tx, tqueue->dirty_tx);
 736
 737                 if (likely(tqueue->tx_skbuff_dma[entry])) {
 738                         dma_unmap_single(priv->device,
 739                                          tqueue->tx_skbuff_dma[entry],
 740                                          priv->hw->desc->get_tx_len(p),
 741                                          DMA_TO_DEVICE);
 742                         tqueue->tx_skbuff_dma[entry] = 0;
 743                 }
 744
 745                 if (likely(skb)) {
 746                         dev_kfree_skb(skb);
 747                         tqueue->tx_skbuff[entry] = NULL;
 748                 }
 749
 750                 priv->hw->desc->release_tx_desc(p);
 751
 752                 tqueue->dirty_tx++;
 753         }
 754
 755         /* wake up queue */
 756         if (unlikely(netif_tx_queue_stopped(dev_txq) &&
 757                      sxgbe_tx_avail(tqueue, tx_rsize) > SXGBE_TX_THRESH(priv))) {
 758                 netif_tx_lock(priv->dev);
 759                 if (netif_tx_queue_stopped(dev_txq) &&
 760                     sxgbe_tx_avail(tqueue, tx_rsize) > SXGBE_TX_THRESH(priv)) {
 761                         if (netif_msg_tx_done(priv))
 762                                 pr_debug("%s: restart transmit\n", __func__);
 763                         netif_tx_wake_queue(dev_txq);
 764                 }
 765                 netif_tx_unlock(priv->dev);
 766         }
 767
 768         spin_unlock(&tqueue->tx_lock);
 769 }
 770
 771 /**
 772  * sxgbe_tx_clean:
 773  * @priv: driver private structure
 774  * Description: it reclaims resources after transmission completes.
 775  */
 776 static void sxgbe_tx_all_clean(struct sxgbe_priv_data * const priv)
 777 {
 778         u8 queue_num;
 779
 780         SXGBE_FOR_EACH_QUEUE(SXGBE_TX_QUEUES, queue_num) {
 781                 struct sxgbe_tx_queue *tqueue = priv->txq[queue_num];
 782
 783                 sxgbe_tx_queue_clean(tqueue);
 784         }
 785
 786         if ((priv->eee_enabled) && (!priv->tx_path_in_lpi_mode)) {
 787                 sxgbe_enable_eee_mode(priv);
 788                 mod_timer(&priv->eee_ctrl_timer, SXGBE_LPI_TIMER(eee_timer));
 789         }
 790 }
 791
 792 /**
 793  * sxgbe_restart_tx_queue: irq tx error mng function
 794  * @priv: driver private structure
 795  * Description: it cleans the descriptors and restarts the transmission
 796  * in case of errors.
 797  */
 798 static void sxgbe_restart_tx_queue(struct sxgbe_priv_data *priv, int queue_num)
 799 {
 800         struct sxgbe_tx_queue *tx_ring = priv->txq[queue_num];
 801         struct netdev_queue *dev_txq = netdev_get_tx_queue(priv->dev,
 802                                                            queue_num);
 803
 804         /* stop the queue */
 805         netif_tx_stop_queue(dev_txq);
 806
 807         /* stop the tx dma */
 808         priv->hw->dma->stop_tx_queue(priv->ioaddr, queue_num);
 809
 810         /* free the skbuffs of the ring */
 811         tx_free_ring_skbufs(tx_ring);
 812
 813         /* initalise counters */
 814         tx_ring->cur_tx = 0;
 815         tx_ring->dirty_tx = 0;
 816
 817         /* start the tx dma */
 818         priv->hw->dma->start_tx_queue(priv->ioaddr, queue_num);
 819
 820         priv->dev->stats.tx_errors++;
 821
 822         /* wakeup the queue */
 823         netif_tx_wake_queue(dev_txq);
 824 }
 825
 826 /**
 827  * sxgbe_reset_all_tx_queues: irq tx error mng function
 828  * @priv: driver private structure
 829  * Description: it cleans all the descriptors and
 830  * restarts the transmission on all queues in case of errors.
 831  */
 832 static void sxgbe_reset_all_tx_queues(struct sxgbe_priv_data *priv)
 833 {
 834         int queue_num;
 835
 836         /* On TX timeout of net device, resetting of all queues
 837          * may not be proper way, revisit this later if needed
 838          */
 839         SXGBE_FOR_EACH_QUEUE(SXGBE_TX_QUEUES, queue_num)
 840                 sxgbe_restart_tx_queue(priv, queue_num);
 841 }
 842
 843 /**
 844  * sxgbe_get_hw_features: get XMAC capabilities from the HW cap. register.
 845  * @priv: driver private structure
 846  * Description:
 847  *  new GMAC chip generations have a new register to indicate the
 848  *  presence of the optional feature/functions.
 849  *  This can be also used to override the value passed through the
 850  *  platform and necessary for old MAC10/100 and GMAC chips.
 851  */
 852 static int sxgbe_get_hw_features(struct sxgbe_priv_data * const priv)
 853 {
 854         int rval = 0;
 855         struct sxgbe_hw_features *features = &priv->hw_cap;
 856
 857         /* Read First Capability Register CAP[0] */
 858         rval = priv->hw->mac->get_hw_feature(priv->ioaddr, 0);
 859         if (rval) {
 860                 features->pmt_remote_wake_up =
 861                         SXGBE_HW_FEAT_PMT_TEMOTE_WOP(rval);
 862                 features->pmt_magic_frame = SXGBE_HW_FEAT_PMT_MAGIC_PKT(rval);
 863                 features->atime_stamp = SXGBE_HW_FEAT_IEEE1500_2008(rval);
 864                 features->tx_csum_offload =
 865                         SXGBE_HW_FEAT_TX_CSUM_OFFLOAD(rval);
 866                 features->rx_csum_offload =
 867                         SXGBE_HW_FEAT_RX_CSUM_OFFLOAD(rval);
 868                 features->multi_macaddr = SXGBE_HW_FEAT_MACADDR_COUNT(rval);
 869                 features->tstamp_srcselect = SXGBE_HW_FEAT_TSTMAP_SRC(rval);
 870                 features->sa_vlan_insert = SXGBE_HW_FEAT_SRCADDR_VLAN(rval);
 871                 features->eee = SXGBE_HW_FEAT_EEE(rval);
 872         }
 873
 874         /* Read First Capability Register CAP[1] */
 875         rval = priv->hw->mac->get_hw_feature(priv->ioaddr, 1);
 876         if (rval) {
 877                 features->rxfifo_size = SXGBE_HW_FEAT_RX_FIFO_SIZE(rval);
 878                 features->txfifo_size = SXGBE_HW_FEAT_TX_FIFO_SIZE(rval);
 879                 features->atstmap_hword = SXGBE_HW_FEAT_TX_FIFO_SIZE(rval);
 880                 features->dcb_enable = SXGBE_HW_FEAT_DCB(rval);
 881                 features->splithead_enable = SXGBE_HW_FEAT_SPLIT_HDR(rval);
 882                 features->tcpseg_offload = SXGBE_HW_FEAT_TSO(rval);
 883                 features->debug_mem = SXGBE_HW_FEAT_DEBUG_MEM_IFACE(rval);
 884                 features->rss_enable = SXGBE_HW_FEAT_RSS(rval);
 885                 features->hash_tsize = SXGBE_HW_FEAT_HASH_TABLE_SIZE(rval);
 886                 features->l3l4_filer_size = SXGBE_HW_FEAT_L3L4_FILTER_NUM(rval);
 887         }
 888
 889         /* Read First Capability Register CAP[2] */
 890         rval = priv->hw->mac->get_hw_feature(priv->ioaddr, 2);
 891         if (rval) {
 892                 features->rx_mtl_queues = SXGBE_HW_FEAT_RX_MTL_QUEUES(rval);
 893                 features->tx_mtl_queues = SXGBE_HW_FEAT_TX_MTL_QUEUES(rval);
 894                 features->rx_dma_channels = SXGBE_HW_FEAT_RX_DMA_CHANNELS(rval);
 895                 features->tx_dma_channels = SXGBE_HW_FEAT_TX_DMA_CHANNELS(rval);
 896                 features->pps_output_count = SXGBE_HW_FEAT_PPS_OUTPUTS(rval);
 897                 features->aux_input_count = SXGBE_HW_FEAT_AUX_SNAPSHOTS(rval);
 898         }
 899
 900         return rval;
 901 }
 902
 903 /**
 904  * sxgbe_check_ether_addr: check if the MAC addr is valid
 905  * @priv: driver private structure
 906  * Description:
 907  * it is to verify if the MAC address is valid, in case of failures it
 908  * generates a random MAC address
 909  */
 910 static void sxgbe_check_ether_addr(struct sxgbe_priv_data *priv)
 911 {
 912         if (!is_valid_ether_addr(priv->dev->dev_addr)) {
 913                 priv->hw->mac->get_umac_addr((void __iomem *)
 914                                              priv->ioaddr,
 915                                              priv->dev->dev_addr, 0);
 916                 if (!is_valid_ether_addr(priv->dev->dev_addr))
 917                         eth_hw_addr_random(priv->dev);
 918         }
 919         dev_info(priv->device, "device MAC address %pM\n",
 920                  priv->dev->dev_addr);
 921 }
 922
 923 /**
 924  * sxgbe_init_dma_engine: DMA init.
 925  * @priv: driver private structure
 926  * Description:
 927  * It inits the DMA invoking the specific SXGBE callback.
 928  * Some DMA parameters can be passed from the platform;
 929  * in case of these are not passed a default is kept for the MAC or GMAC.
 930  */
 931 static int sxgbe_init_dma_engine(struct sxgbe_priv_data *priv)
 932 {
 933         int pbl = DEFAULT_DMA_PBL, fixed_burst = 0, burst_map = 0;
 934         int queue_num;
 935
 936         if (priv->plat->dma_cfg) {
 937                 pbl = priv->plat->dma_cfg->pbl;
 938                 fixed_burst = priv->plat->dma_cfg->fixed_burst;
 939                 burst_map = priv->plat->dma_cfg->burst_map;
 940         }
 941
 942         SXGBE_FOR_EACH_QUEUE(SXGBE_TX_QUEUES, queue_num)
 943                 priv->hw->dma->cha_init(priv->ioaddr, queue_num,
 944                                         fixed_burst, pbl,
 945                                         (priv->txq[queue_num])->dma_tx_phy,
 946                                         (priv->rxq[queue_num])->dma_rx_phy,
 947                                         priv->dma_tx_size, priv->dma_rx_size);
 948
 949         return priv->hw->dma->init(priv->ioaddr, fixed_burst, burst_map);
 950 }
 951
 952 /**
 953  * sxgbe_init_mtl_engine: MTL init.
 954  * @priv: driver private structure
 955  * Description:
 956  * It inits the MTL invoking the specific SXGBE callback.
 957  */
 958 static void sxgbe_init_mtl_engine(struct sxgbe_priv_data *priv)
 959 {
 960         int queue_num;
 961
 962         SXGBE_FOR_EACH_QUEUE(SXGBE_TX_QUEUES, queue_num) {
 963                 priv->hw->mtl->mtl_set_txfifosize(priv->ioaddr, queue_num,
 964                                                   priv->hw_cap.tx_mtl_qsize);
 965                 priv->hw->mtl->mtl_enable_txqueue(priv->ioaddr, queue_num);
 966         }
 967 }
 968
 969 /**
 970  * sxgbe_disable_mtl_engine: MTL disable.
 971  * @priv: driver private structure
 972  * Description:
 973  * It disables the MTL queues by invoking the specific SXGBE callback.
 974  */
 975 static void sxgbe_disable_mtl_engine(struct sxgbe_priv_data *priv)
 976 {
 977         int queue_num;
 978
 979         SXGBE_FOR_EACH_QUEUE(SXGBE_TX_QUEUES, queue_num)
 980                 priv->hw->mtl->mtl_disable_txqueue(priv->ioaddr, queue_num);
 981 }
 982
 983
 984 /**
 985  * sxgbe_tx_timer: mitigation sw timer for tx.
 986  * @data: data pointer
 987  * Description:
 988  * This is the timer handler to directly invoke the sxgbe_tx_clean.
 989  */
 990 static void sxgbe_tx_timer(unsigned long data)
 991 {
 992         struct sxgbe_tx_queue *p = (struct sxgbe_tx_queue *)data;
 993         sxgbe_tx_queue_clean(p);
 994 }
 995
 996 /**
 997  * sxgbe_init_tx_coalesce: init tx mitigation options.
 998  * @priv: driver private structure
 999  * Description:
1000  * This inits the transmit coalesce parameters: i.e. timer rate,
1001  * timer handler and default threshold used for enabling the
1002  * interrupt on completion bit.
1003  */
1004 static void sxgbe_tx_init_coalesce(struct sxgbe_priv_data *priv)
1005 {
1006         u8 queue_num;
1007
1008         SXGBE_FOR_EACH_QUEUE(SXGBE_TX_QUEUES, queue_num) {
1009                 struct sxgbe_tx_queue *p = priv->txq[queue_num];
1010                 p->tx_coal_frames =  SXGBE_TX_FRAMES;
1011                 p->tx_coal_timer = SXGBE_COAL_TX_TIMER;
1012                 init_timer(&p->txtimer);
1013                 p->txtimer.expires = SXGBE_COAL_TIMER(p->tx_coal_timer);
1014                 p->txtimer.data = (unsigned long)&priv->txq[queue_num];
1015                 p->txtimer.function = sxgbe_tx_timer;
1016                 add_timer(&p->txtimer);
1017         }
1018 }
1019
1020 static void sxgbe_tx_del_timer(struct sxgbe_priv_data *priv)
1021 {
1022         u8 queue_num;
1023
1024         SXGBE_FOR_EACH_QUEUE(SXGBE_TX_QUEUES, queue_num) {
1025                 struct sxgbe_tx_queue *p = priv->txq[queue_num];
1026                 del_timer_sync(&p->txtimer);
1027         }
1028 }
1029
1030 /**
1031  *  sxgbe_open - open entry point of the driver
1032  *  @dev : pointer to the device structure.
1033  *  Description:
1034  *  This function is the open entry point of the driver.
1035  *  Return value:
1036  *  0 on success and an appropriate (-)ve integer as defined in errno.h
1037  *  file on failure.
1038  */
1039 static int sxgbe_open(struct net_device *dev)
1040 {
1041         struct sxgbe_priv_data *priv = netdev_priv(dev);
1042         int ret, queue_num;
1043
1044         clk_prepare_enable(priv->sxgbe_clk);
1045
1046         sxgbe_check_ether_addr(priv);
1047
1048         /* Init the phy */
1049         ret = sxgbe_init_phy(dev);
1050         if (ret) {
1051                 netdev_err(dev, "%s: Cannot attach to PHY (error: %d)\n",
1052                            __func__, ret);
1053                 goto phy_error;
1054         }
1055
1056         /* Create and initialize the TX/RX descriptors chains. */
1057         priv->dma_tx_size = SXGBE_ALIGN(DMA_TX_SIZE);
1058         priv->dma_rx_size = SXGBE_ALIGN(DMA_RX_SIZE);
1059         priv->dma_buf_sz = SXGBE_ALIGN(DMA_BUFFER_SIZE);
1060         priv->tx_tc = TC_DEFAULT;
1061         priv->rx_tc = TC_DEFAULT;
1062         init_dma_desc_rings(dev);
1063
1064         /* DMA initialization and SW reset */
1065         ret = sxgbe_init_dma_engine(priv);
1066         if (ret < 0) {
1067                 netdev_err(dev, "%s: DMA initialization failed\n", __func__);
1068                 goto init_error;
1069         }
1070
1071         /*  MTL initialization */
1072         sxgbe_init_mtl_engine(priv);
1073
1074         /* Copy the MAC addr into the HW  */
1075         priv->hw->mac->set_umac_addr(priv->ioaddr, dev->dev_addr, 0);
1076
1077         /* Initialize the MAC Core */
1078         priv->hw->mac->core_init(priv->ioaddr);
1079
1080         /* Request the IRQ lines */
1081         ret = devm_request_irq(priv->device, priv->irq, sxgbe_common_interrupt,
1082                                IRQF_SHARED, dev->name, dev);
1083         if (unlikely(ret < 0)) {
1084                 netdev_err(dev, "%s: ERROR: allocating the IRQ %d (error: %d)\n",
1085                            __func__, priv->irq, ret);
1086                 goto init_error;
1087         }
1088
1089         /* If the LPI irq is different from the mac irq
1090          * register a dedicated handler
1091          */
1092         if (priv->lpi_irq != dev->irq) {
1093                 ret = devm_request_irq(priv->device, priv->lpi_irq,
1094                                        sxgbe_common_interrupt,
1095                                        IRQF_SHARED, dev->name, dev);
1096                 if (unlikely(ret < 0)) {
1097                         netdev_err(dev, "%s: ERROR: allocating the LPI IRQ %d (%d)\n",
1098                                    __func__, priv->lpi_irq, ret);
1099                         goto init_error;
1100                 }
1101         }
1102
1103         /* Request TX DMA irq lines */
1104         SXGBE_FOR_EACH_QUEUE(SXGBE_TX_QUEUES, queue_num) {
1105                 ret = devm_request_irq(priv->device,
1106                                        (priv->txq[queue_num])->irq_no,
1107                                        sxgbe_tx_interrupt, 0,
1108                                        dev->name, priv->txq[queue_num]);
1109                 if (unlikely(ret < 0)) {
1110                         netdev_err(dev, "%s: ERROR: allocating TX IRQ %d (error: %d)\n",
1111                                    __func__, priv->irq, ret);
1112                         goto init_error;
1113                 }
1114         }
1115
1116         /* Request RX DMA irq lines */
1117         SXGBE_FOR_EACH_QUEUE(SXGBE_RX_QUEUES, queue_num) {
1118                 ret = devm_request_irq(priv->device,
1119                                        (priv->rxq[queue_num])->irq_no,
1120                                        sxgbe_rx_interrupt, 0,
1121                                        dev->name, priv->rxq[queue_num]);
1122                 if (unlikely(ret < 0)) {
1123                         netdev_err(dev, "%s: ERROR: allocating TX IRQ %d (error: %d)\n",
1124                                    __func__, priv->irq, ret);
1125                         goto init_error;
1126                 }
1127         }
1128
1129         /* Enable the MAC Rx/Tx */
1130         priv->hw->mac->enable_tx(priv->ioaddr, true);
1131         priv->hw->mac->enable_rx(priv->ioaddr, true);
1132
1133         /* Set the HW DMA mode and the COE */
1134         sxgbe_mtl_operation_mode(priv);
1135
1136         /* Extra statistics */
1137         memset(&priv->xstats, 0, sizeof(struct sxgbe_extra_stats));
1138
1139         priv->xstats.tx_threshold = priv->tx_tc;
1140         priv->xstats.rx_threshold = priv->rx_tc;
1141
1142         /* Start the ball rolling... */
1143         netdev_dbg(dev, "DMA RX/TX processes started...\n");
1144         priv->hw->dma->start_tx(priv->ioaddr, SXGBE_TX_QUEUES);
1145         priv->hw->dma->start_rx(priv->ioaddr, SXGBE_RX_QUEUES);
1146
1147         if (priv->phydev)
1148                 phy_start(priv->phydev);
1149
1150         /* initalise TX coalesce parameters */
1151         sxgbe_tx_init_coalesce(priv);
1152
1153         if ((priv->use_riwt) && (priv->hw->dma->rx_watchdog)) {
1154                 priv->rx_riwt = SXGBE_MAX_DMA_RIWT;
1155                 priv->hw->dma->rx_watchdog(priv->ioaddr, SXGBE_MAX_DMA_RIWT);
1156         }
1157
1158         priv->tx_lpi_timer = SXGBE_DEFAULT_LPI_TIMER;
1159         priv->eee_enabled = sxgbe_eee_init(priv);
1160
1161         napi_enable(&priv->napi);
1162         netif_start_queue(dev);
1163
1164         return 0;
1165
1166 init_error:
1167         free_dma_desc_resources(priv);
1168         if (priv->phydev)
1169                 phy_disconnect(priv->phydev);
1170 phy_error:
1171         clk_disable_unprepare(priv->sxgbe_clk);
1172
1173         return ret;
1174 }
1175
1176 /**
1177  *  sxgbe_release - close entry point of the driver
1178  *  @dev : device pointer.
1179  *  Description:
1180  *  This is the stop entry point of the driver.
1181  */
1182 static int sxgbe_release(struct net_device *dev)
1183 {
1184         struct sxgbe_priv_data *priv = netdev_priv(dev);
1185
1186         if (priv->eee_enabled)
1187                 del_timer_sync(&priv->eee_ctrl_timer);
1188
1189         /* Stop and disconnect the PHY */
1190         if (priv->phydev) {
1191                 phy_stop(priv->phydev);
1192                 phy_disconnect(priv->phydev);
1193                 priv->phydev = NULL;
1194         }
1195
1196         netif_tx_stop_all_queues(dev);
1197
1198         napi_disable(&priv->napi);
1199
1200         /* delete TX timers */
1201         sxgbe_tx_del_timer(priv);
1202
1203         /* Stop TX/RX DMA and clear the descriptors */
1204         priv->hw->dma->stop_tx(priv->ioaddr, SXGBE_TX_QUEUES);
1205         priv->hw->dma->stop_rx(priv->ioaddr, SXGBE_RX_QUEUES);
1206
1207         /* disable MTL queue */
1208         sxgbe_disable_mtl_engine(priv);
1209
1210         /* Release and free the Rx/Tx resources */
1211         free_dma_desc_resources(priv);
1212
1213         /* Disable the MAC Rx/Tx */
1214         priv->hw->mac->enable_tx(priv->ioaddr, false);
1215         priv->hw->mac->enable_rx(priv->ioaddr, false);
1216
1217         clk_disable_unprepare(priv->sxgbe_clk);
1218
1219         return 0;
1220 }
1221
1222 /* Prepare first Tx descriptor for doing TSO operation */
1223 void sxgbe_tso_prepare(struct sxgbe_priv_data *priv,
1224                        struct sxgbe_tx_norm_desc *first_desc,
1225                        struct sk_buff *skb)
1226 {
1227         unsigned int total_hdr_len, tcp_hdr_len;
1228
1229         /* Write first Tx descriptor with appropriate value */
1230         tcp_hdr_len = tcp_hdrlen(skb);
1231         total_hdr_len = skb_transport_offset(skb) + tcp_hdr_len;
1232
1233         first_desc->tdes01 = dma_map_single(priv->device, skb->data,
1234                                             total_hdr_len, DMA_TO_DEVICE);
1235         if (dma_mapping_error(priv->device, first_desc->tdes01))
1236                 pr_err("%s: TX dma mapping failed!!\n", __func__);
1237
1238         first_desc->tdes23.tx_rd_des23.first_desc = 1;
1239         priv->hw->desc->tx_desc_enable_tse(first_desc, 1, total_hdr_len,
1240                                            tcp_hdr_len,
1241                                            skb->len - total_hdr_len);
1242 }
1243
1244 /**
1245  *  sxgbe_xmit: Tx entry point of the driver
1246  *  @skb : the socket buffer
1247  *  @dev : device pointer
1248  *  Description : this is the tx entry point of the driver.
1249  *  It programs the chain or the ring and supports oversized frames
1250  *  and SG feature.
1251  */
1252 static netdev_tx_t sxgbe_xmit(struct sk_buff *skb, struct net_device *dev)
1253 {
1254         unsigned int entry, frag_num;
1255         int cksum_flag = 0;
1256         struct netdev_queue *dev_txq;
1257         unsigned txq_index = skb_get_queue_mapping(skb);
1258         struct sxgbe_priv_data *priv = netdev_priv(dev);
1259         unsigned int tx_rsize = priv->dma_tx_size;
1260         struct sxgbe_tx_queue *tqueue = priv->txq[txq_index];
1261         struct sxgbe_tx_norm_desc *tx_desc, *first_desc;
1262         struct sxgbe_tx_ctxt_desc *ctxt_desc = NULL;
1263         int nr_frags = skb_shinfo(skb)->nr_frags;
1264         int no_pagedlen = skb_headlen(skb);
1265         int is_jumbo = 0;
1266         u16 cur_mss = skb_shinfo(skb)->gso_size;
1267         u32 ctxt_desc_req = 0;
1268
1269         /* get the TX queue handle */
1270         dev_txq = netdev_get_tx_queue(dev, txq_index);
1271
1272         if (unlikely(skb_is_gso(skb) && tqueue->prev_mss != cur_mss))
1273                 ctxt_desc_req = 1;
1274
1275         if (unlikely(vlan_tx_tag_present(skb) ||
1276                      ((skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP) &&
1277                       tqueue->hwts_tx_en)))
1278                 ctxt_desc_req = 1;
1279
1280         /* get the spinlock */
1281         spin_lock(&tqueue->tx_lock);
1282
1283         if (priv->tx_path_in_lpi_mode)
1284                 sxgbe_disable_eee_mode(priv);
1285
1286         if (unlikely(sxgbe_tx_avail(tqueue, tx_rsize) < nr_frags + 1)) {
1287                 if (!netif_tx_queue_stopped(dev_txq)) {
1288                         netif_tx_stop_queue(dev_txq);
1289                         netdev_err(dev, "%s: Tx Ring is full when %d queue is awake\n",
1290                                    __func__, txq_index);
1291                 }
1292                 /* release the spin lock in case of BUSY */
1293                 spin_unlock(&tqueue->tx_lock);
1294                 return NETDEV_TX_BUSY;
1295         }
1296
1297         entry = tqueue->cur_tx % tx_rsize;
1298         tx_desc = tqueue->dma_tx + entry;
1299
1300         first_desc = tx_desc;
1301         if (ctxt_desc_req)
1302                 ctxt_desc = (struct sxgbe_tx_ctxt_desc *)first_desc;
1303
1304         /* save the skb address */
1305         tqueue->tx_skbuff[entry] = skb;
1306
1307         if (!is_jumbo) {
1308                 if (likely(skb_is_gso(skb))) {
1309                         /* TSO support */
1310                         if (unlikely(tqueue->prev_mss != cur_mss)) {
1311                                 priv->hw->desc->tx_ctxt_desc_set_mss(
1312                                                 ctxt_desc, cur_mss);
1313                                 priv->hw->desc->tx_ctxt_desc_set_tcmssv(
1314                                                 ctxt_desc);
1315                                 priv->hw->desc->tx_ctxt_desc_reset_ostc(
1316                                                 ctxt_desc);
1317                                 priv->hw->desc->tx_ctxt_desc_set_ctxt(
1318                                                 ctxt_desc);
1319                                 priv->hw->desc->tx_ctxt_desc_set_owner(
1320                                                 ctxt_desc);
1321
1322                                 entry = (++tqueue->cur_tx) % tx_rsize;
1323                                 first_desc = tqueue->dma_tx + entry;
1324
1325                                 tqueue->prev_mss = cur_mss;
1326                         }
1327                         sxgbe_tso_prepare(priv, first_desc, skb);
1328                 } else {
1329                         tx_desc->tdes01 = dma_map_single(priv->device,
1330                                                          skb->data, no_pagedlen, DMA_TO_DEVICE);
1331                         if (dma_mapping_error(priv->device, tx_desc->tdes01))
1332                                 netdev_err(dev, "%s: TX dma mapping failed!!\n",
1333                                            __func__);
1334
1335                         priv->hw->desc->prepare_tx_desc(tx_desc, 1, no_pagedlen,
1336                                                         no_pagedlen, cksum_flag);
1337                 }
1338         }
1339
1340         for (frag_num = 0; frag_num < nr_frags; frag_num++) {
1341                 const skb_frag_t *frag = &skb_shinfo(skb)->frags[frag_num];
1342                 int len = skb_frag_size(frag);
1343
1344                 entry = (++tqueue->cur_tx) % tx_rsize;
1345                 tx_desc = tqueue->dma_tx + entry;
1346                 tx_desc->tdes01 = skb_frag_dma_map(priv->device, frag, 0, len,
1347                                                    DMA_TO_DEVICE);
1348
1349                 tqueue->tx_skbuff_dma[entry] = tx_desc->tdes01;
1350                 tqueue->tx_skbuff[entry] = NULL;
1351
1352                 /* prepare the descriptor */
1353                 priv->hw->desc->prepare_tx_desc(tx_desc, 0, len,
1354                                                 len, cksum_flag);
1355                 /* memory barrier to flush descriptor */
1356                 wmb();
1357
1358                 /* set the owner */
1359                 priv->hw->desc->set_tx_owner(tx_desc);
1360         }
1361
1362         /* close the descriptors */
1363         priv->hw->desc->close_tx_desc(tx_desc);
1364
1365         /* memory barrier to flush descriptor */
1366         wmb();
1367
1368         tqueue->tx_count_frames += nr_frags + 1;
1369         if (tqueue->tx_count_frames > tqueue->tx_coal_frames) {
1370                 priv->hw->desc->clear_tx_ic(tx_desc);
1371                 priv->xstats.tx_reset_ic_bit++;
1372                 mod_timer(&tqueue->txtimer,
1373                           SXGBE_COAL_TIMER(tqueue->tx_coal_timer));
1374         } else {
1375                 tqueue->tx_count_frames = 0;
1376         }
1377
1378         /* set owner for first desc */
1379         priv->hw->desc->set_tx_owner(first_desc);
1380
1381         /* memory barrier to flush descriptor */
1382         wmb();
1383
1384         tqueue->cur_tx++;
1385
1386         /* display current ring */
1387         netif_dbg(priv, pktdata, dev, "%s: curr %d dirty=%d entry=%d, first=%p, nfrags=%d\n",
1388                   __func__, tqueue->cur_tx % tx_rsize,
1389                   tqueue->dirty_tx % tx_rsize, entry,
1390                   first_desc, nr_frags);
1391
1392         if (unlikely(sxgbe_tx_avail(tqueue, tx_rsize) <= (MAX_SKB_FRAGS + 1))) {
1393                 netif_dbg(priv, hw, dev, "%s: stop transmitted packets\n",
1394                           __func__);
1395                 netif_tx_stop_queue(dev_txq);
1396         }
1397
1398         dev->stats.tx_bytes += skb->len;
1399
1400         if (unlikely((skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP) &&
1401                      tqueue->hwts_tx_en)) {
1402                 /* declare that device is doing timestamping */
1403                 skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
1404                 priv->hw->desc->tx_enable_tstamp(first_desc);
1405         }
1406
1407         if (!tqueue->hwts_tx_en)
1408                 skb_tx_timestamp(skb);
1409
1410         priv->hw->dma->enable_dma_transmission(priv->ioaddr, txq_index);
1411
1412         spin_unlock(&tqueue->tx_lock);
1413
1414         return NETDEV_TX_OK;
1415 }
1416
1417 /**
1418  * sxgbe_rx_refill: refill used skb preallocated buffers
1419  * @priv: driver private structure
1420  * Description : this is to reallocate the skb for the reception process
1421  * that is based on zero-copy.
1422  */
1423 static void sxgbe_rx_refill(struct sxgbe_priv_data *priv)
1424 {
1425         unsigned int rxsize = priv->dma_rx_size;
1426         int bfsize = priv->dma_buf_sz;
1427         u8 qnum = priv->cur_rx_qnum;
1428
1429         for (; priv->rxq[qnum]->cur_rx - priv->rxq[qnum]->dirty_rx > 0;
1430              priv->rxq[qnum]->dirty_rx++) {
1431                 unsigned int entry = priv->rxq[qnum]->dirty_rx % rxsize;
1432                 struct sxgbe_rx_norm_desc *p;
1433
1434                 p = priv->rxq[qnum]->dma_rx + entry;
1435
1436                 if (likely(priv->rxq[qnum]->rx_skbuff[entry] == NULL)) {
1437                         struct sk_buff *skb;
1438
1439                         skb = netdev_alloc_skb_ip_align(priv->dev, bfsize);
1440
1441                         if (unlikely(skb == NULL))
1442                                 break;
1443
1444                         priv->rxq[qnum]->rx_skbuff[entry] = skb;
1445                         priv->rxq[qnum]->rx_skbuff_dma[entry] =
1446                                 dma_map_single(priv->device, skb->data, bfsize,
1447                                                DMA_FROM_DEVICE);
1448
1449                         p->rdes23.rx_rd_des23.buf2_addr =
1450                                 priv->rxq[qnum]->rx_skbuff_dma[entry];
1451                 }
1452
1453                 /* Added memory barrier for RX descriptor modification */
1454                 wmb();
1455                 priv->hw->desc->set_rx_owner(p);
1456                 /* Added memory barrier for RX descriptor modification */
1457                 wmb();
1458         }
1459 }
1460
1461 /**
1462  * sxgbe_rx: receive the frames from the remote host
1463  * @priv: driver private structure
1464  * @limit: napi bugget.
1465  * Description :  this the function called by the napi poll method.
1466  * It gets all the frames inside the ring.
1467  */
1468 static int sxgbe_rx(struct sxgbe_priv_data *priv, int limit)
1469 {
1470         u8 qnum = priv->cur_rx_qnum;
1471         unsigned int rxsize = priv->dma_rx_size;
1472         unsigned int entry = priv->rxq[qnum]->cur_rx;
1473         unsigned int next_entry = 0;
1474         unsigned int count = 0;
1475         int checksum;
1476         int status;
1477
1478         while (count < limit) {
1479                 struct sxgbe_rx_norm_desc *p;
1480                 struct sk_buff *skb;
1481                 int frame_len;
1482
1483                 p = priv->rxq[qnum]->dma_rx + entry;
1484
1485                 if (priv->hw->desc->get_rx_owner(p))
1486                         break;
1487
1488                 count++;
1489
1490                 next_entry = (++priv->rxq[qnum]->cur_rx) % rxsize;
1491                 prefetch(priv->rxq[qnum]->dma_rx + next_entry);
1492
1493                 /* Read the status of the incoming frame and also get checksum
1494                  * value based on whether it is enabled in SXGBE hardware or
1495                  * not.
1496                  */
1497                 status = priv->hw->desc->rx_wbstatus(p, &priv->xstats,
1498                                                      &checksum);
1499                 if (unlikely(status < 0)) {
1500                         entry = next_entry;
1501                         continue;
1502                 }
1503                 if (unlikely(!priv->rxcsum_insertion))
1504                         checksum = CHECKSUM_NONE;
1505
1506                 skb = priv->rxq[qnum]->rx_skbuff[entry];
1507
1508                 if (unlikely(!skb))
1509                         netdev_err(priv->dev, "rx descriptor is not consistent\n");
1510
1511                 prefetch(skb->data - NET_IP_ALIGN);
1512                 priv->rxq[qnum]->rx_skbuff[entry] = NULL;
1513
1514                 frame_len = priv->hw->desc->get_rx_frame_len(p);
1515
1516                 skb_put(skb, frame_len);
1517
1518                 skb->ip_summed = checksum;
1519                 if (checksum == CHECKSUM_NONE)
1520                         netif_receive_skb(skb);
1521                 else
1522                         napi_gro_receive(&priv->napi, skb);
1523
1524                 entry = next_entry;
1525         }
1526
1527         sxgbe_rx_refill(priv);
1528
1529         return count;
1530 }
1531
1532 /**
1533  *  sxgbe_poll - sxgbe poll method (NAPI)
1534  *  @napi : pointer to the napi structure.
1535  *  @budget : maximum number of packets that the current CPU can receive from
1536  *            all interfaces.
1537  *  Description :
1538  *  To look at the incoming frames and clear the tx resources.
1539  */
1540 static int sxgbe_poll(struct napi_struct *napi, int budget)
1541 {
1542         struct sxgbe_priv_data *priv = container_of(napi,
1543                                                     struct sxgbe_priv_data, napi);
1544         int work_done = 0;
1545         u8 qnum = priv->cur_rx_qnum;
1546
1547         priv->xstats.napi_poll++;
1548         /* first, clean the tx queues */
1549         sxgbe_tx_all_clean(priv);
1550
1551         work_done = sxgbe_rx(priv, budget);
1552         if (work_done < budget) {
1553                 napi_complete(napi);
1554                 priv->hw->dma->enable_dma_irq(priv->ioaddr, qnum);
1555         }
1556
1557         return work_done;
1558 }
1559
1560 /**
1561  *  sxgbe_tx_timeout
1562  *  @dev : Pointer to net device structure
1563  *  Description: this function is called when a packet transmission fails to
1564  *   complete within a reasonable time. The driver will mark the error in the
1565  *   netdev structure and arrange for the device to be reset to a sane state
1566  *   in order to transmit a new packet.
1567  */
1568 static void sxgbe_tx_timeout(struct net_device *dev)
1569 {
1570         struct sxgbe_priv_data *priv = netdev_priv(dev);
1571
1572         sxgbe_reset_all_tx_queues(priv);
1573 }
1574
1575 /**
1576  *  sxgbe_common_interrupt - main ISR
1577  *  @irq: interrupt number.
1578  *  @dev_id: to pass the net device pointer.
1579  *  Description: this is the main driver interrupt service routine.
1580  *  It calls the DMA ISR and also the core ISR to manage PMT, MMC, LPI
1581  *  interrupts.
1582  */
1583 static irqreturn_t sxgbe_common_interrupt(int irq, void *dev_id)
1584 {
1585         struct net_device *netdev = (struct net_device *)dev_id;
1586         struct sxgbe_priv_data *priv = netdev_priv(netdev);
1587         int status;
1588
1589         status = priv->hw->mac->host_irq_status(priv->ioaddr, &priv->xstats);
1590         /* For LPI we need to save the tx status */
1591         if (status & TX_ENTRY_LPI_MODE) {
1592                 priv->xstats.tx_lpi_entry_n++;
1593                 priv->tx_path_in_lpi_mode = true;
1594         }
1595         if (status & TX_EXIT_LPI_MODE) {
1596                 priv->xstats.tx_lpi_exit_n++;
1597                 priv->tx_path_in_lpi_mode = false;
1598         }
1599         if (status & RX_ENTRY_LPI_MODE)
1600                 priv->xstats.rx_lpi_entry_n++;
1601         if (status & RX_EXIT_LPI_MODE)
1602                 priv->xstats.rx_lpi_exit_n++;
1603
1604         return IRQ_HANDLED;
1605 }
1606
1607 /**
1608  *  sxgbe_tx_interrupt - TX DMA ISR
1609  *  @irq: interrupt number.
1610  *  @dev_id: to pass the net device pointer.
1611  *  Description: this is the tx dma interrupt service routine.
1612  */
1613 static irqreturn_t sxgbe_tx_interrupt(int irq, void *dev_id)
1614 {
1615         int status;
1616         struct sxgbe_tx_queue *txq = (struct sxgbe_tx_queue *)dev_id;
1617         struct sxgbe_priv_data *priv = txq->priv_ptr;
1618
1619         /* get the channel status */
1620         status = priv->hw->dma->tx_dma_int_status(priv->ioaddr, txq->queue_no,
1621                                                   &priv->xstats);
1622         /* check for normal path */
1623         if (likely((status & handle_tx)))
1624                 napi_schedule(&priv->napi);
1625
1626         /* check for unrecoverable error */
1627         if (unlikely((status & tx_hard_error)))
1628                 sxgbe_restart_tx_queue(priv, txq->queue_no);
1629
1630         /* check for TC configuration change */
1631         if (unlikely((status & tx_bump_tc) &&
1632                      (priv->tx_tc != SXGBE_MTL_SFMODE) &&
1633                      (priv->tx_tc < 512))) {
1634                 /* step of TX TC is 32 till 128, otherwise 64 */
1635                 priv->tx_tc += (priv->tx_tc < 128) ? 32 : 64;
1636                 priv->hw->mtl->set_tx_mtl_mode(priv->ioaddr,
1637                                                txq->queue_no, priv->tx_tc);
1638                 priv->xstats.tx_threshold = priv->tx_tc;
1639         }
1640
1641         return IRQ_HANDLED;
1642 }
1643
1644 /**
1645  *  sxgbe_rx_interrupt - RX DMA ISR
1646  *  @irq: interrupt number.
1647  *  @dev_id: to pass the net device pointer.
1648  *  Description: this is the rx dma interrupt service routine.
1649  */
1650 static irqreturn_t sxgbe_rx_interrupt(int irq, void *dev_id)
1651 {
1652         int status;
1653         struct sxgbe_rx_queue *rxq = (struct sxgbe_rx_queue *)dev_id;
1654         struct sxgbe_priv_data *priv = rxq->priv_ptr;
1655
1656         /* get the channel status */
1657         status = priv->hw->dma->rx_dma_int_status(priv->ioaddr, rxq->queue_no,
1658                                                   &priv->xstats);
1659
1660         if (likely((status & handle_rx) && (napi_schedule_prep(&priv->napi)))) {
1661                 priv->hw->dma->disable_dma_irq(priv->ioaddr, rxq->queue_no);
1662                 __napi_schedule(&priv->napi);
1663         }
1664
1665         /* check for TC configuration change */
1666         if (unlikely((status & rx_bump_tc) &&
1667                      (priv->rx_tc != SXGBE_MTL_SFMODE) &&
1668                      (priv->rx_tc < 128))) {
1669                 /* step of TC is 32 */
1670                 priv->rx_tc += 32;
1671                 priv->hw->mtl->set_rx_mtl_mode(priv->ioaddr,
1672                                                rxq->queue_no, priv->rx_tc);
1673                 priv->xstats.rx_threshold = priv->rx_tc;
1674         }
1675
1676         return IRQ_HANDLED;
1677 }
1678
1679 static inline u64 sxgbe_get_stat64(void __iomem *ioaddr, int reg_lo, int reg_hi)
1680 {
1681         u64 val = readl(ioaddr + reg_lo);
1682
1683         val |= ((u64)readl(ioaddr + reg_hi)) << 32;
1684
1685         return val;
1686 }
1687
1688
1689 /*  sxgbe_get_stats64 - entry point to see statistical information of device
1690  *  @dev : device pointer.
1691  *  @stats : pointer to hold all the statistical information of device.
1692  *  Description:
1693  *  This function is a driver entry point whenever ifconfig command gets
1694  *  executed to see device statistics. Statistics are number of
1695  *  bytes sent or received, errors occured etc.
1696  *  Return value:
1697  *  This function returns various statistical information of device.
1698  */
1699 static struct rtnl_link_stats64 *sxgbe_get_stats64(struct net_device *dev,
1700                                                    struct rtnl_link_stats64 *stats)
1701 {
1702         struct sxgbe_priv_data *priv = netdev_priv(dev);
1703         void __iomem *ioaddr = priv->ioaddr;
1704         u64 count;
1705
1706         spin_lock(&priv->stats_lock);
1707         /* Freeze the counter registers before reading value otherwise it may
1708          * get updated by hardware while we are reading them
1709          */
1710         writel(SXGBE_MMC_CTRL_CNT_FRZ, ioaddr + SXGBE_MMC_CTL_REG);
1711
1712         stats->rx_bytes = sxgbe_get_stat64(ioaddr,
1713                                            SXGBE_MMC_RXOCTETLO_GCNT_REG,
1714                                            SXGBE_MMC_RXOCTETHI_GCNT_REG);
1715
1716         stats->rx_packets = sxgbe_get_stat64(ioaddr,
1717                                              SXGBE_MMC_RXFRAMELO_GBCNT_REG,
1718                                              SXGBE_MMC_RXFRAMEHI_GBCNT_REG);
1719
1720         stats->multicast = sxgbe_get_stat64(ioaddr,
1721                                             SXGBE_MMC_RXMULTILO_GCNT_REG,
1722                                             SXGBE_MMC_RXMULTIHI_GCNT_REG);
1723
1724         stats->rx_crc_errors = sxgbe_get_stat64(ioaddr,
1725                                                 SXGBE_MMC_RXCRCERRLO_REG,
1726                                                 SXGBE_MMC_RXCRCERRHI_REG);
1727
1728         stats->rx_length_errors = sxgbe_get_stat64(ioaddr,
1729                                                   SXGBE_MMC_RXLENERRLO_REG,
1730                                                   SXGBE_MMC_RXLENERRHI_REG);
1731
1732         stats->rx_missed_errors = sxgbe_get_stat64(ioaddr,
1733                                                    SXGBE_MMC_RXFIFOOVERFLOWLO_GBCNT_REG,
1734                                                    SXGBE_MMC_RXFIFOOVERFLOWHI_GBCNT_REG);
1735
1736         stats->tx_bytes = sxgbe_get_stat64(ioaddr,
1737                                            SXGBE_MMC_TXOCTETLO_GCNT_REG,
1738                                            SXGBE_MMC_TXOCTETHI_GCNT_REG);
1739
1740         count = sxgbe_get_stat64(ioaddr, SXGBE_MMC_TXFRAMELO_GBCNT_REG,
1741                                  SXGBE_MMC_TXFRAMEHI_GBCNT_REG);
1742
1743         stats->tx_errors = sxgbe_get_stat64(ioaddr, SXGBE_MMC_TXFRAMELO_GCNT_REG,
1744                                             SXGBE_MMC_TXFRAMEHI_GCNT_REG);
1745         stats->tx_errors = count - stats->tx_errors;
1746         stats->tx_packets = count;
1747         stats->tx_fifo_errors = sxgbe_get_stat64(ioaddr, SXGBE_MMC_TXUFLWLO_GBCNT_REG,
1748                                                  SXGBE_MMC_TXUFLWHI_GBCNT_REG);
1749         writel(0, ioaddr + SXGBE_MMC_CTL_REG);
1750         spin_unlock(&priv->stats_lock);
1751
1752         return stats;
1753 }
1754
1755 /*  sxgbe_set_features - entry point to set offload features of the device.
1756  *  @dev : device pointer.
1757  *  @features : features which are required to be set.
1758  *  Description:
1759  *  This function is a driver entry point and called by Linux kernel whenever
1760  *  any device features are set or reset by user.
1761  *  Return value:
1762  *  This function returns 0 after setting or resetting device features.
1763  */
1764 static int sxgbe_set_features(struct net_device *dev,
1765                               netdev_features_t features)
1766 {
1767         struct sxgbe_priv_data *priv = netdev_priv(dev);
1768         netdev_features_t changed = dev->features ^ features;
1769
1770         if (changed & NETIF_F_RXCSUM) {
1771                 if (features & NETIF_F_RXCSUM) {
1772                         priv->hw->mac->enable_rx_csum(priv->ioaddr);
1773                         priv->rxcsum_insertion = true;
1774                 } else {
1775                         priv->hw->mac->disable_rx_csum(priv->ioaddr);
1776                         priv->rxcsum_insertion = false;
1777                 }
1778         }
1779
1780         return 0;
1781 }
1782
1783 /*  sxgbe_change_mtu - entry point to change MTU size for the device.
1784  *  @dev : device pointer.
1785  *  @new_mtu : the new MTU size for the device.
1786  *  Description: the Maximum Transfer Unit (MTU) is used by the network layer
1787  *  to drive packet transmission. Ethernet has an MTU of 1500 octets
1788  *  (ETH_DATA_LEN). This value can be changed with ifconfig.
1789  *  Return value:
1790  *  0 on success and an appropriate (-)ve integer as defined in errno.h
1791  *  file on failure.
1792  */
1793 static int sxgbe_change_mtu(struct net_device *dev, int new_mtu)
1794 {
1795         /* RFC 791, page 25, "Every internet module must be able to forward
1796          * a datagram of 68 octets without further fragmentation."
1797          */
1798         if (new_mtu < MIN_MTU || (new_mtu > MAX_MTU)) {
1799                 netdev_err(dev, "invalid MTU, MTU should be in between %d and %d\n",
1800                            MIN_MTU, MAX_MTU);
1801                 return -EINVAL;
1802         }
1803
1804         /* Return if the buffer sizes will not change */
1805         if (dev->mtu == new_mtu)
1806                 return 0;
1807
1808         dev->mtu = new_mtu;
1809
1810         if (!netif_running(dev))
1811                 return 0;
1812
1813         /* Recevice ring buffer size is needed to be set based on MTU. If MTU is
1814          * changed then reinitilisation of the receive ring buffers need to be
1815          * done. Hence bring interface down and bring interface back up
1816          */
1817         sxgbe_release(dev);
1818         return sxgbe_open(dev);
1819 }
1820
1821 static void sxgbe_set_umac_addr(void __iomem *ioaddr, unsigned char *addr,
1822                                 unsigned int reg_n)
1823 {
1824         unsigned long data;
1825
1826         data = (addr[5] << 8) | addr[4];
1827         /* For MAC Addr registers se have to set the Address Enable (AE)
1828          * bit that has no effect on the High Reg 0 where the bit 31 (MO)
1829          * is RO.
1830          */
1831         writel(data | SXGBE_HI_REG_AE, ioaddr + SXGBE_ADDR_HIGH(reg_n));
1832         data = (addr[3] << 24) | (addr[2] << 16) | (addr[1] << 8) | addr[0];
1833         writel(data, ioaddr + SXGBE_ADDR_LOW(reg_n));
1834 }
1835
1836 /**
1837  * sxgbe_set_rx_mode - entry point for setting different receive mode of
1838  * a device. unicast, multicast addressing
1839  * @dev : pointer to the device structure
1840  * Description:
1841  * This function is a driver entry point which gets called by the kernel
1842  * whenever different receive mode like unicast, multicast and promiscuous
1843  * must be enabled/disabled.
1844  * Return value:
1845  * void.
1846  */
1847 static void sxgbe_set_rx_mode(struct net_device *dev)
1848 {
1849         struct sxgbe_priv_data *priv = netdev_priv(dev);
1850         void __iomem *ioaddr = (void __iomem *)priv->ioaddr;
1851         unsigned int value = 0;
1852         u32 mc_filter[2];
1853         struct netdev_hw_addr *ha;
1854         int reg = 1;
1855
1856         netdev_dbg(dev, "%s: # mcasts %d, # unicast %d\n",
1857                    __func__, netdev_mc_count(dev), netdev_uc_count(dev));
1858
1859         if (dev->flags & IFF_PROMISC) {
1860                 value = SXGBE_FRAME_FILTER_PR;
1861
1862         } else if ((netdev_mc_count(dev) > SXGBE_HASH_TABLE_SIZE) ||
1863                    (dev->flags & IFF_ALLMULTI)) {
1864                 value = SXGBE_FRAME_FILTER_PM;  /* pass all multi */
1865                 writel(0xffffffff, ioaddr + SXGBE_HASH_HIGH);
1866                 writel(0xffffffff, ioaddr + SXGBE_HASH_LOW);
1867
1868         } else if (!netdev_mc_empty(dev)) {
1869                 /* Hash filter for multicast */
1870                 value = SXGBE_FRAME_FILTER_HMC;
1871
1872                 memset(mc_filter, 0, sizeof(mc_filter));
1873                 netdev_for_each_mc_addr(ha, dev) {
1874                         /* The upper 6 bits of the calculated CRC are used to
1875                          * index the contens of the hash table
1876                          */
1877                         int bit_nr = bitrev32(~crc32_le(~0, ha->addr, 6)) >> 26;
1878
1879                         /* The most significant bit determines the register to
1880                          * use (H/L) while the other 5 bits determine the bit
1881                          * within the register.
1882                          */
1883                         mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31);
1884                 }
1885                 writel(mc_filter[0], ioaddr + SXGBE_HASH_LOW);
1886                 writel(mc_filter[1], ioaddr + SXGBE_HASH_HIGH);
1887         }
1888
1889         /* Handle multiple unicast addresses (perfect filtering) */
1890         if (netdev_uc_count(dev) > SXGBE_MAX_PERFECT_ADDRESSES)
1891                 /* Switch to promiscuous mode if more than 16 addrs
1892                  * are required
1893                  */
1894                 value |= SXGBE_FRAME_FILTER_PR;
1895         else {
1896                 netdev_for_each_uc_addr(ha, dev) {
1897                         sxgbe_set_umac_addr(ioaddr, ha->addr, reg);
1898                         reg++;
1899                 }
1900         }
1901 #ifdef FRAME_FILTER_DEBUG
1902         /* Enable Receive all mode (to debug filtering_fail errors) */
1903         value |= SXGBE_FRAME_FILTER_RA;
1904 #endif
1905         writel(value, ioaddr + SXGBE_FRAME_FILTER);
1906
1907         netdev_dbg(dev, "Filter: 0x%08x\n\tHash: HI 0x%08x, LO 0x%08x\n",
1908                    readl(ioaddr + SXGBE_FRAME_FILTER),
1909                    readl(ioaddr + SXGBE_HASH_HIGH),
1910                    readl(ioaddr + SXGBE_HASH_LOW));
1911 }
1912
1913 /**
1914  * sxgbe_config - entry point for changing configuration mode passed on by
1915  * ifconfig
1916  * @dev : pointer to the device structure
1917  * @map : pointer to the device mapping structure
1918  * Description:
1919  * This function is a driver entry point which gets called by the kernel
1920  * whenever some device configuration is changed.
1921  * Return value:
1922  * This function returns 0 if success and appropriate error otherwise.
1923  */
1924 static int sxgbe_config(struct net_device *dev, struct ifmap *map)
1925 {
1926         struct sxgbe_priv_data *priv = netdev_priv(dev);
1927
1928         /* Can't act on a running interface */
1929         if (dev->flags & IFF_UP)
1930                 return -EBUSY;
1931
1932         /* Don't allow changing the I/O address */
1933         if (map->base_addr != (unsigned long)priv->ioaddr) {
1934                 netdev_warn(dev, "can't change I/O address\n");
1935                 return -EOPNOTSUPP;
1936         }
1937
1938         /* Don't allow changing the IRQ */
1939         if (map->irq != priv->irq) {
1940                 netdev_warn(dev, "not change IRQ number %d\n", priv->irq);
1941                 return -EOPNOTSUPP;
1942         }
1943
1944         return 0;
1945 }
1946
1947 #ifdef CONFIG_NET_POLL_CONTROLLER
1948 /**
1949  * sxgbe_poll_controller - entry point for polling receive by device
1950  * @dev : pointer to the device structure
1951  * Description:
1952  * This function is used by NETCONSOLE and other diagnostic tools
1953  * to allow network I/O with interrupts disabled.
1954  * Return value:
1955  * Void.
1956  */
1957 static void sxgbe_poll_controller(struct net_device *dev)
1958 {
1959         struct sxgbe_priv_data *priv = netdev_priv(dev);
1960
1961         disable_irq(priv->irq);
1962         sxgbe_rx_interrupt(priv->irq, dev);
1963         enable_irq(priv->irq);
1964 }
1965 #endif
1966
1967 /*  sxgbe_ioctl - Entry point for the Ioctl
1968  *  @dev: Device pointer.
1969  *  @rq: An IOCTL specefic structure, that can contain a pointer to
1970  *  a proprietary structure used to pass information to the driver.
1971  *  @cmd: IOCTL command
1972  *  Description:
1973  *  Currently it supports the phy_mii_ioctl(...) and HW time stamping.
1974  */
1975 static int sxgbe_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
1976 {
1977         struct sxgbe_priv_data *priv = netdev_priv(dev);
1978         int ret = -EOPNOTSUPP;
1979
1980         if (!netif_running(dev))
1981                 return -EINVAL;
1982
1983         switch (cmd) {
1984         case SIOCGMIIPHY:
1985         case SIOCGMIIREG:
1986         case SIOCSMIIREG:
1987                 if (!priv->phydev)
1988                         return -EINVAL;
1989                 ret = phy_mii_ioctl(priv->phydev, rq, cmd);
1990                 break;
1991         default:
1992                 break;
1993         }
1994
1995         return ret;
1996 }
1997
1998 static const struct net_device_ops sxgbe_netdev_ops = {
1999         .ndo_open               = sxgbe_open,
2000         .ndo_start_xmit         = sxgbe_xmit,
2001         .ndo_stop               = sxgbe_release,
2002         .ndo_get_stats64        = sxgbe_get_stats64,
2003         .ndo_change_mtu         = sxgbe_change_mtu,
2004         .ndo_set_features       = sxgbe_set_features,
2005         .ndo_set_rx_mode        = sxgbe_set_rx_mode,
2006         .ndo_tx_timeout         = sxgbe_tx_timeout,
2007         .ndo_do_ioctl           = sxgbe_ioctl,
2008         .ndo_set_config         = sxgbe_config,
2009 #ifdef CONFIG_NET_POLL_CONTROLLER
2010         .ndo_poll_controller    = sxgbe_poll_controller,
2011 #endif
2012         .ndo_set_mac_address    = eth_mac_addr,
2013 };
2014
2015 /* Get the hardware ops */
2016 static void sxgbe_get_ops(struct sxgbe_ops * const ops_ptr)
2017 {
2018         ops_ptr->mac            = sxgbe_get_core_ops();
2019         ops_ptr->desc           = sxgbe_get_desc_ops();
2020         ops_ptr->dma            = sxgbe_get_dma_ops();
2021         ops_ptr->mtl            = sxgbe_get_mtl_ops();
2022
2023         /* set the MDIO communication Address/Data regisers */
2024         ops_ptr->mii.addr       = SXGBE_MDIO_SCMD_ADD_REG;
2025         ops_ptr->mii.data       = SXGBE_MDIO_SCMD_DATA_REG;
2026
2027         /* Assigning the default link settings
2028          * no SXGBE defined default values to be set in registers,
2029          * so assigning as 0 for port and duplex
2030          */
2031         ops_ptr->link.port      = 0;
2032         ops_ptr->link.duplex    = 0;
2033         ops_ptr->link.speed     = SXGBE_SPEED_10G;
2034 }
2035
2036 /**
2037  *  sxgbe_hw_init - Init the GMAC device
2038  *  @priv: driver private structure
2039  *  Description: this function checks the HW capability
2040  *  (if supported) and sets the driver's features.
2041  */
2042 static int sxgbe_hw_init(struct sxgbe_priv_data * const priv)
2043 {
2044         u32 ctrl_ids;
2045
2046         priv->hw = kmalloc(sizeof(*priv->hw), GFP_KERNEL);
2047         if(!priv->hw)
2048                 return -ENOMEM;
2049
2050         /* get the hardware ops */
2051         sxgbe_get_ops(priv->hw);
2052
2053         /* get the controller id */
2054         ctrl_ids = priv->hw->mac->get_controller_version(priv->ioaddr);
2055         priv->hw->ctrl_uid = (ctrl_ids & 0x00ff0000) >> 16;
2056         priv->hw->ctrl_id = (ctrl_ids & 0x000000ff);
2057         pr_info("user ID: 0x%x, Controller ID: 0x%x\n",
2058                 priv->hw->ctrl_uid, priv->hw->ctrl_id);
2059
2060         /* get the H/W features */
2061         if (!sxgbe_get_hw_features(priv))
2062                 pr_info("Hardware features not found\n");
2063
2064         if (priv->hw_cap.tx_csum_offload)
2065                 pr_info("TX Checksum offload supported\n");
2066
2067         if (priv->hw_cap.rx_csum_offload)
2068                 pr_info("RX Checksum offload supported\n");
2069
2070         return 0;
2071 }
2072
2073 static int sxgbe_sw_reset(void __iomem *addr)
2074 {
2075         int retry_count = 10;
2076
2077         writel(SXGBE_DMA_SOFT_RESET, addr + SXGBE_DMA_MODE_REG);
2078         while (retry_count--) {
2079                 if (!(readl(addr + SXGBE_DMA_MODE_REG) &
2080                       SXGBE_DMA_SOFT_RESET))
2081                         break;
2082                 mdelay(10);
2083         }
2084
2085         if (retry_count < 0)
2086                 return -EBUSY;
2087
2088         return 0;
2089 }
2090
2091 /**
2092  * sxgbe_drv_probe
2093  * @device: device pointer
2094  * @plat_dat: platform data pointer
2095  * @addr: iobase memory address
2096  * Description: this is the main probe function used to
2097  * call the alloc_etherdev, allocate the priv structure.
2098  */
2099 struct sxgbe_priv_data *sxgbe_drv_probe(struct device *device,
2100                                         struct sxgbe_plat_data *plat_dat,
2101                                         void __iomem *addr)
2102 {
2103         struct sxgbe_priv_data *priv;
2104         struct net_device *ndev;
2105         int ret;
2106         u8 queue_num;
2107
2108         ndev = alloc_etherdev_mqs(sizeof(struct sxgbe_priv_data),
2109                                   SXGBE_TX_QUEUES, SXGBE_RX_QUEUES);
2110         if (!ndev)
2111                 return NULL;
2112
2113         SET_NETDEV_DEV(ndev, device);
2114
2115         priv = netdev_priv(ndev);
2116         priv->device = device;
2117         priv->dev = ndev;
2118
2119         sxgbe_set_ethtool_ops(ndev);
2120         priv->plat = plat_dat;
2121         priv->ioaddr = addr;
2122
2123         ret = sxgbe_sw_reset(priv->ioaddr);
2124         if (ret)
2125                 goto error_free_netdev;
2126
2127         /* Verify driver arguments */
2128         sxgbe_verify_args();
2129
2130         /* Init MAC and get the capabilities */
2131         ret = sxgbe_hw_init(priv);
2132         if (ret)
2133                 goto error_free_netdev;
2134
2135         /* allocate memory resources for Descriptor rings */
2136         ret = txring_mem_alloc(priv);
2137         if (ret)
2138                 goto error_free_hw;
2139
2140         ret = rxring_mem_alloc(priv);
2141         if (ret)
2142                 goto error_free_hw;
2143
2144         ndev->netdev_ops = &sxgbe_netdev_ops;
2145
2146         ndev->hw_features = NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
2147                 NETIF_F_RXCSUM | NETIF_F_TSO | NETIF_F_TSO6 |
2148                 NETIF_F_GRO;
2149         ndev->features |= ndev->hw_features | NETIF_F_HIGHDMA;
2150         ndev->watchdog_timeo = msecs_to_jiffies(TX_TIMEO);
2151
2152         /* assign filtering support */
2153         ndev->priv_flags |= IFF_UNICAST_FLT;
2154
2155         priv->msg_enable = netif_msg_init(debug, default_msg_level);
2156
2157         /* Enable TCP segmentation offload for all DMA channels */
2158         if (priv->hw_cap.tcpseg_offload) {
2159                 SXGBE_FOR_EACH_QUEUE(SXGBE_TX_QUEUES, queue_num) {
2160                         priv->hw->dma->enable_tso(priv->ioaddr, queue_num);
2161                 }
2162         }
2163
2164         /* Enable Rx checksum offload */
2165         if (priv->hw_cap.rx_csum_offload) {
2166                 priv->hw->mac->enable_rx_csum(priv->ioaddr);
2167                 priv->rxcsum_insertion = true;
2168         }
2169
2170         /* Initialise pause frame settings */
2171         priv->rx_pause = 1;
2172         priv->tx_pause = 1;
2173
2174         /* Rx Watchdog is available, enable depend on platform data */
2175         if (!priv->plat->riwt_off) {
2176                 priv->use_riwt = 1;
2177                 pr_info("Enable RX Mitigation via HW Watchdog Timer\n");
2178         }
2179
2180         netif_napi_add(ndev, &priv->napi, sxgbe_poll, 64);
2181
2182         spin_lock_init(&priv->stats_lock);
2183
2184         priv->sxgbe_clk = clk_get(priv->device, SXGBE_RESOURCE_NAME);
2185         if (IS_ERR(priv->sxgbe_clk)) {
2186                 netdev_warn(ndev, "%s: warning: cannot get CSR clock\n",
2187                             __func__);
2188                 goto error_napi_del;
2189         }
2190
2191         /* If a specific clk_csr value is passed from the platform
2192          * this means that the CSR Clock Range selection cannot be
2193          * changed at run-time and it is fixed. Viceversa the driver'll try to
2194          * set the MDC clock dynamically according to the csr actual
2195          * clock input.
2196          */
2197         if (!priv->plat->clk_csr)
2198                 sxgbe_clk_csr_set(priv);
2199         else
2200                 priv->clk_csr = priv->plat->clk_csr;
2201
2202         /* MDIO bus Registration */
2203         ret = sxgbe_mdio_register(ndev);
2204         if (ret < 0) {
2205                 netdev_dbg(ndev, "%s: MDIO bus (id: %d) registration failed\n",
2206                            __func__, priv->plat->bus_id);
2207                 goto error_clk_put;
2208         }
2209
2210         ret = register_netdev(ndev);
2211         if (ret) {
2212                 pr_err("%s: ERROR %i registering the device\n", __func__, ret);
2213                 goto error_mdio_unregister;
2214         }
2215
2216         sxgbe_check_ether_addr(priv);
2217
2218         return priv;
2219
2220 error_mdio_unregister:
2221         sxgbe_mdio_unregister(ndev);
2222 error_clk_put:
2223         clk_put(priv->sxgbe_clk);
2224 error_napi_del:
2225         netif_napi_del(&priv->napi);
2226 error_free_hw:
2227         kfree(priv->hw);
2228 error_free_netdev:
2229         free_netdev(ndev);
2230
2231         return NULL;
2232 }
2233
2234 /**
2235  * sxgbe_drv_remove
2236  * @ndev: net device pointer
2237  * Description: this function resets the TX/RX processes, disables the MAC RX/TX
2238  * changes the link status, releases the DMA descriptor rings.
2239  */
2240 int sxgbe_drv_remove(struct net_device *ndev)
2241 {
2242         struct sxgbe_priv_data *priv = netdev_priv(ndev);
2243
2244         netdev_info(ndev, "%s: removing driver\n", __func__);
2245
2246         priv->hw->dma->stop_rx(priv->ioaddr, SXGBE_RX_QUEUES);
2247         priv->hw->dma->stop_tx(priv->ioaddr, SXGBE_TX_QUEUES);
2248
2249         priv->hw->mac->enable_tx(priv->ioaddr, false);
2250         priv->hw->mac->enable_rx(priv->ioaddr, false);
2251
2252         unregister_netdev(ndev);
2253
2254         sxgbe_mdio_unregister(ndev);
2255
2256         clk_put(priv->sxgbe_clk);
2257
2258         netif_napi_del(&priv->napi);
2259
2260         kfree(priv->hw);
2261
2262         free_netdev(ndev);
2263
2264         return 0;
2265 }
2266
2267 #ifdef CONFIG_PM
2268 int sxgbe_suspend(struct net_device *ndev)
2269 {
2270         return 0;
2271 }
2272
2273 int sxgbe_resume(struct net_device *ndev)
2274 {
2275         return 0;
2276 }
2277
2278 int sxgbe_freeze(struct net_device *ndev)
2279 {
2280         return -ENOSYS;
2281 }
2282
2283 int sxgbe_restore(struct net_device *ndev)
2284 {
2285         return -ENOSYS;
2286 }
2287 #endif /* CONFIG_PM */
2288
2289 /* Driver is configured as Platform driver */
2290 static int __init sxgbe_init(void)
2291 {
2292         int ret;
2293
2294         ret = sxgbe_register_platform();
2295         if (ret)
2296                 goto err;
2297         return 0;
2298 err:
2299         pr_err("driver registration failed\n");
2300         return ret;
2301 }
2302
2303 static void __exit sxgbe_exit(void)
2304 {
2305         sxgbe_unregister_platform();
2306 }
2307
2308 module_init(sxgbe_init);
2309 module_exit(sxgbe_exit);
2310
2311 #ifndef MODULE
2312 static int __init sxgbe_cmdline_opt(char *str)
2313 {
2314         char *opt;
2315
2316         if (!str || !*str)
2317                 return -EINVAL;
2318         while ((opt = strsep(&str, ",")) != NULL) {
2319                 if (!strncmp(opt, "eee_timer:", 6)) {
2320                         if (kstrtoint(opt + 10, 0, &eee_timer))
2321                                 goto err;
2322                 }
2323         }
2324         return 0;
2325
2326 err:
2327         pr_err("%s: ERROR broken module parameter conversion\n", __func__);
2328         return -EINVAL;
2329 }
2330
2331 __setup("sxgbeeth=", sxgbe_cmdline_opt);
2332 #endif /* MODULE */
2333
2334
2335
2336 MODULE_DESCRIPTION("SAMSUNG 10G/2.5G/1G Ethernet PLATFORM driver");
2337
2338 MODULE_PARM_DESC(debug, "Message Level (-1: default, 0: no output, 16: all)");
2339 MODULE_PARM_DESC(eee_timer, "EEE-LPI Default LS timer value");
2340
2341 MODULE_AUTHOR("Siva Reddy Kallam <siva.kallam@samsung.com>");
2342 MODULE_AUTHOR("ByungHo An <bh74.an@samsung.com>");
2343 MODULE_AUTHOR("Girish K S <ks.giri@samsung.com>");
2344 MODULE_AUTHOR("Vipul Pandya <vipul.pandya@samsung.com>");
2345
2346 MODULE_LICENSE("GPL");