target/linux/ath79/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         return phy_ethtool_ioctl(phydev, cmd);
  26 }
  27
  28 static int ag71xx_ethtool_set_settings(struct net_device *dev,
  29                                        struct ethtool_cmd *cmd)
  30 {
  31         struct ag71xx *ag = netdev_priv(dev);
  32         struct phy_device *phydev = ag->phy_dev;
  33
  34         if (!phydev)
  35                 return -ENODEV;
  36
  37         return phy_ethtool_ioctl(phydev, cmd);
  38 }
  39
  40 static u32 ag71xx_ethtool_get_msglevel(struct net_device *dev)
  41 {
  42         struct ag71xx *ag = netdev_priv(dev);
  43
  44         return ag->msg_enable;
  45 }
  46
  47 static void ag71xx_ethtool_set_msglevel(struct net_device *dev, u32 msg_level)
  48 {
  49         struct ag71xx *ag = netdev_priv(dev);
  50
  51         ag->msg_enable = msg_level;
  52 }
  53
  54 static void ag71xx_ethtool_get_ringparam(struct net_device *dev,
  55                                          struct ethtool_ringparam *er)
  56 {
  57         struct ag71xx *ag = netdev_priv(dev);
  58
  59         er->tx_max_pending = AG71XX_TX_RING_SIZE_MAX;
  60         er->rx_max_pending = AG71XX_RX_RING_SIZE_MAX;
  61         er->rx_mini_max_pending = 0;
  62         er->rx_jumbo_max_pending = 0;
  63
  64         er->tx_pending = BIT(ag->tx_ring.order);
  65         er->rx_pending = BIT(ag->rx_ring.order);
  66         er->rx_mini_pending = 0;
  67         er->rx_jumbo_pending = 0;
  68
  69         if (ag->tx_ring.desc_split)
  70                 er->tx_pending /= AG71XX_TX_RING_DS_PER_PKT;
  71 }
  72
  73 static int ag71xx_ethtool_set_ringparam(struct net_device *dev,
  74                                         struct ethtool_ringparam *er)
  75 {
  76         struct ag71xx *ag = netdev_priv(dev);
  77         unsigned tx_size;
  78         unsigned rx_size;
  79         int err = 0;
  80
  81         if (er->rx_mini_pending != 0||
  82             er->rx_jumbo_pending != 0 ||
  83             er->rx_pending == 0 ||
  84             er->tx_pending == 0)
  85                 return -EINVAL;
  86
  87         tx_size = er->tx_pending < AG71XX_TX_RING_SIZE_MAX ?
  88                   er->tx_pending : AG71XX_TX_RING_SIZE_MAX;
  89
  90         rx_size = er->rx_pending < AG71XX_RX_RING_SIZE_MAX ?
  91                   er->rx_pending : AG71XX_RX_RING_SIZE_MAX;
  92
  93         if (netif_running(dev)) {
  94                 err = dev->netdev_ops->ndo_stop(dev);
  95                 if (err)
  96                         return err;
  97         }
  98
  99         if (ag->tx_ring.desc_split)
 100                 tx_size *= AG71XX_TX_RING_DS_PER_PKT;
 101
 102         ag->tx_ring.order = ag71xx_ring_size_order(tx_size);
 103         ag->rx_ring.order = ag71xx_ring_size_order(rx_size);
 104
 105         if (netif_running(dev))
 106                 err = dev->netdev_ops->ndo_open(dev);
 107
 108         return err;
 109 }
 110
 111 struct ethtool_ops ag71xx_ethtool_ops = {
 112         .set_settings   = ag71xx_ethtool_set_settings,
 113         .get_settings   = ag71xx_ethtool_get_settings,
 114         .get_msglevel   = ag71xx_ethtool_get_msglevel,
 115         .set_msglevel   = ag71xx_ethtool_set_msglevel,
 116         .get_ringparam  = ag71xx_ethtool_get_ringparam,
 117         .set_ringparam  = ag71xx_ethtool_set_ringparam,
 118         .get_link       = ethtool_op_get_link,
 119         .get_ts_info    = ethtool_op_get_ts_info,
 120 };