target/linux/ar71xx/files/drivers/net/ethernet/atheros/ag71xx/ag71xx_ethtool.c

   1 /*
   2  *  Atheros AR71xx built-in ethernet mac driver
   3  *
   4  *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>
   5  *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>
   6  *
   7  *  Based on Atheros' AG7100 driver
   8  *
   9  *  This program is free software; you can redistribute it and/or modify it
  10  *  under the terms of the GNU General Public License version 2 as published
  11  *  by the Free Software Foundation.
  12  */
  13
  14 #include "ag71xx.h"
  15
  16 static int ag71xx_ethtool_get_settings(struct net_device *dev,
  17                                        struct ethtool_cmd *cmd)
  18 {
  19         struct ag71xx *ag = netdev_priv(dev);
  20         struct phy_device *phydev = ag->phy_dev;
  21
  22         if (!phydev)
  23                 return -ENODEV;
  24
  25 #if LINUX_VERSION_CODE < KERNEL_VERSION(4,14,0)
  26         return phy_ethtool_gset(phydev, cmd);
  27 #else
  28         return phy_ethtool_ioctl(phydev, cmd);
  29 #endif
  30 }
  31
  32 static int ag71xx_ethtool_set_settings(struct net_device *dev,
  33                                        struct ethtool_cmd *cmd)
  34 {
  35         struct ag71xx *ag = netdev_priv(dev);
  36         struct phy_device *phydev = ag->phy_dev;
  37
  38         if (!phydev)
  39                 return -ENODEV;
  40
  41 #if LINUX_VERSION_CODE < KERNEL_VERSION(4,14,0)
  42         return phy_ethtool_sset(phydev, cmd);
  43 #else
  44         return phy_ethtool_ioctl(phydev, cmd);
  45 #endif
  46 }
  47
  48 static void ag71xx_ethtool_get_drvinfo(struct net_device *dev,
  49                                        struct ethtool_drvinfo *info)
  50 {
  51         struct ag71xx *ag = netdev_priv(dev);
  52
  53         strcpy(info->driver, ag->pdev->dev.driver->name);
  54         strcpy(info->version, AG71XX_DRV_VERSION);
  55         strcpy(info->bus_info, dev_name(&ag->pdev->dev));
  56 }
  57
  58 static u32 ag71xx_ethtool_get_msglevel(struct net_device *dev)
  59 {
  60         struct ag71xx *ag = netdev_priv(dev);
  61
  62         return ag->msg_enable;
  63 }
  64
  65 static void ag71xx_ethtool_set_msglevel(struct net_device *dev, u32 msg_level)
  66 {
  67         struct ag71xx *ag = netdev_priv(dev);
  68
  69         ag->msg_enable = msg_level;
  70 }
  71
  72 static void ag71xx_ethtool_get_ringparam(struct net_device *dev,
  73                                          struct ethtool_ringparam *er)
  74 {
  75         struct ag71xx *ag = netdev_priv(dev);
  76
  77         er->tx_max_pending = AG71XX_TX_RING_SIZE_MAX;
  78         er->rx_max_pending = AG71XX_RX_RING_SIZE_MAX;
  79         er->rx_mini_max_pending = 0;
  80         er->rx_jumbo_max_pending = 0;
  81
  82         er->tx_pending = BIT(ag->tx_ring.order);
  83         er->rx_pending = BIT(ag->rx_ring.order);
  84         er->rx_mini_pending = 0;
  85         er->rx_jumbo_pending = 0;
  86
  87         if (ag->tx_ring.desc_split)
  88                 er->tx_pending /= AG71XX_TX_RING_DS_PER_PKT;
  89 }
  90
  91 static int ag71xx_ethtool_set_ringparam(struct net_device *dev,
  92                                         struct ethtool_ringparam *er)
  93 {
  94         struct ag71xx *ag = netdev_priv(dev);
  95         unsigned tx_size;
  96         unsigned rx_size;
  97         int err = 0;
  98
  99         if (er->rx_mini_pending != 0||
 100             er->rx_jumbo_pending != 0 ||
 101             er->rx_pending == 0 ||
 102             er->tx_pending == 0)
 103                 return -EINVAL;
 104
 105         tx_size = er->tx_pending < AG71XX_TX_RING_SIZE_MAX ?
 106                   er->tx_pending : AG71XX_TX_RING_SIZE_MAX;
 107
 108         rx_size = er->rx_pending < AG71XX_RX_RING_SIZE_MAX ?
 109                   er->rx_pending : AG71XX_RX_RING_SIZE_MAX;
 110
 111         if (netif_running(dev)) {
 112                 err = dev->netdev_ops->ndo_stop(dev);
 113                 if (err)
 114                         return err;
 115         }
 116
 117         if (ag->tx_ring.desc_split)
 118                 tx_size *= AG71XX_TX_RING_DS_PER_PKT;
 119
 120         ag->tx_ring.order = ag71xx_ring_size_order(tx_size);
 121         ag->rx_ring.order = ag71xx_ring_size_order(rx_size);
 122
 123         if (netif_running(dev))
 124                 err = dev->netdev_ops->ndo_open(dev);
 125
 126         return err;
 127 }
 128
 129 struct ethtool_ops ag71xx_ethtool_ops = {
 130         .set_settings   = ag71xx_ethtool_set_settings,
 131         .get_settings   = ag71xx_ethtool_get_settings,
 132         .get_drvinfo    = ag71xx_ethtool_get_drvinfo,
 133         .get_msglevel   = ag71xx_ethtool_get_msglevel,
 134         .set_msglevel   = ag71xx_ethtool_set_msglevel,
 135         .get_ringparam  = ag71xx_ethtool_get_ringparam,
 136         .set_ringparam  = ag71xx_ethtool_set_ringparam,
 137         .get_link       = ethtool_op_get_link,
 138         .get_ts_info    = ethtool_op_get_ts_info,
 139 };