forked from Minki/linux
bnx2x: Added EEE Ethtool support.
This patch extends the bnx2x's ethtool interface to enable control in the eee feature, as well as report statistic information about it. Signed-off-by: Yuval Mintz <yuvalmin@broadcom.com> Signed-off-by: Eilon Greenstein <eilong@broadcom.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
Yuval Mintz
David S. Miller
parent
c8c60d88c5
commit
e9939c80e9
@ -177,6 +177,8 @@ static const struct {
|
||||
4, STATS_FLAGS_FUNC, "recoverable_errors" },
|
||||
{ STATS_OFFSET32(unrecoverable_error),
|
||||
4, STATS_FLAGS_FUNC, "unrecoverable_errors" },
|
||||
{ STATS_OFFSET32(eee_tx_lpi),
|
||||
4, STATS_FLAGS_PORT, "Tx LPI entry count"}
|
||||
};
|
||||
|
||||
#define BNX2X_NUM_STATS ARRAY_SIZE(bnx2x_stats_arr)
|
||||
@ -1543,6 +1545,136 @@ static const struct {
|
||||
{ "idle check (online)" }
|
||||
};
|
||||
|
||||
static u32 bnx2x_eee_to_adv(u32 eee_adv)
|
||||
{
|
||||
u32 modes = 0;
|
||||
|
||||
if (eee_adv & SHMEM_EEE_100M_ADV)
|
||||
modes |= ADVERTISED_100baseT_Full;
|
||||
if (eee_adv & SHMEM_EEE_1G_ADV)
|
||||
modes |= ADVERTISED_1000baseT_Full;
|
||||
if (eee_adv & SHMEM_EEE_10G_ADV)
|
||||
modes |= ADVERTISED_10000baseT_Full;
|
||||
|
||||
return modes;
|
||||
}
|
||||
|
||||
static u32 bnx2x_adv_to_eee(u32 modes, u32 shift)
|
||||
{
|
||||
u32 eee_adv = 0;
|
||||
if (modes & ADVERTISED_100baseT_Full)
|
||||
eee_adv |= SHMEM_EEE_100M_ADV;
|
||||
if (modes & ADVERTISED_1000baseT_Full)
|
||||
eee_adv |= SHMEM_EEE_1G_ADV;
|
||||
if (modes & ADVERTISED_10000baseT_Full)
|
||||
eee_adv |= SHMEM_EEE_10G_ADV;
|
||||
|
||||
return eee_adv << shift;
|
||||
}
|
||||
|
||||
static int bnx2x_get_eee(struct net_device *dev, struct ethtool_eee *edata)
|
||||
{
|
||||
struct bnx2x *bp = netdev_priv(dev);
|
||||
u32 eee_cfg;
|
||||
|
||||
if (!SHMEM2_HAS(bp, eee_status[BP_PORT(bp)])) {
|
||||
DP(BNX2X_MSG_ETHTOOL, "BC Version does not support EEE\n");
|
||||
return -EOPNOTSUPP;
|
||||
}
|
||||
|
||||
eee_cfg = SHMEM2_RD(bp, eee_status[BP_PORT(bp)]);
|
||||
|
||||
edata->supported =
|
||||
bnx2x_eee_to_adv((eee_cfg & SHMEM_EEE_SUPPORTED_MASK) >>
|
||||
SHMEM_EEE_SUPPORTED_SHIFT);
|
||||
|
||||
edata->advertised =
|
||||
bnx2x_eee_to_adv((eee_cfg & SHMEM_EEE_ADV_STATUS_MASK) >>
|
||||
SHMEM_EEE_ADV_STATUS_SHIFT);
|
||||
edata->lp_advertised =
|
||||
bnx2x_eee_to_adv((eee_cfg & SHMEM_EEE_LP_ADV_STATUS_MASK) >>
|
||||
SHMEM_EEE_LP_ADV_STATUS_SHIFT);
|
||||
|
||||
/* SHMEM value is in 16u units --> Convert to 1u units. */
|
||||
edata->tx_lpi_timer = (eee_cfg & SHMEM_EEE_TIMER_MASK) << 4;
|
||||
|
||||
edata->eee_enabled = (eee_cfg & SHMEM_EEE_REQUESTED_BIT) ? 1 : 0;
|
||||
edata->eee_active = (eee_cfg & SHMEM_EEE_ACTIVE_BIT) ? 1 : 0;
|
||||
edata->tx_lpi_enabled = (eee_cfg & SHMEM_EEE_LPI_REQUESTED_BIT) ? 1 : 0;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int bnx2x_set_eee(struct net_device *dev, struct ethtool_eee *edata)
|
||||
{
|
||||
struct bnx2x *bp = netdev_priv(dev);
|
||||
u32 eee_cfg;
|
||||
u32 advertised;
|
||||
|
||||
if (IS_MF(bp))
|
||||
return 0;
|
||||
|
||||
if (!SHMEM2_HAS(bp, eee_status[BP_PORT(bp)])) {
|
||||
DP(BNX2X_MSG_ETHTOOL, "BC Version does not support EEE\n");
|
||||
return -EOPNOTSUPP;
|
||||
}
|
||||
|
||||
eee_cfg = SHMEM2_RD(bp, eee_status[BP_PORT(bp)]);
|
||||
|
||||
if (!(eee_cfg & SHMEM_EEE_SUPPORTED_MASK)) {
|
||||
DP(BNX2X_MSG_ETHTOOL, "Board does not support EEE!\n");
|
||||
return -EOPNOTSUPP;
|
||||
}
|
||||
|
||||
advertised = bnx2x_adv_to_eee(edata->advertised,
|
||||
SHMEM_EEE_ADV_STATUS_SHIFT);
|
||||
if ((advertised != (eee_cfg & SHMEM_EEE_ADV_STATUS_MASK))) {
|
||||
DP(BNX2X_MSG_ETHTOOL,
|
||||
"Direct manipulation of EEE advertisment is not supported\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (edata->tx_lpi_timer > EEE_MODE_TIMER_MASK) {
|
||||
DP(BNX2X_MSG_ETHTOOL,
|
||||
"Maximal Tx Lpi timer supported is %x(u)\n",
|
||||
EEE_MODE_TIMER_MASK);
|
||||
return -EINVAL;
|
||||
}
|
||||
if (edata->tx_lpi_enabled &&
|
||||
(edata->tx_lpi_timer < EEE_MODE_NVRAM_AGGRESSIVE_TIME)) {
|
||||
DP(BNX2X_MSG_ETHTOOL,
|
||||
"Minimal Tx Lpi timer supported is %d(u)\n",
|
||||
EEE_MODE_NVRAM_AGGRESSIVE_TIME);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
/* All is well; Apply changes*/
|
||||
if (edata->eee_enabled)
|
||||
bp->link_params.eee_mode |= EEE_MODE_ADV_LPI;
|
||||
else
|
||||
bp->link_params.eee_mode &= ~EEE_MODE_ADV_LPI;
|
||||
|
||||
if (edata->tx_lpi_enabled)
|
||||
bp->link_params.eee_mode |= EEE_MODE_ENABLE_LPI;
|
||||
else
|
||||
bp->link_params.eee_mode &= ~EEE_MODE_ENABLE_LPI;
|
||||
|
||||
bp->link_params.eee_mode &= ~EEE_MODE_TIMER_MASK;
|
||||
bp->link_params.eee_mode |= (edata->tx_lpi_timer &
|
||||
EEE_MODE_TIMER_MASK) |
|
||||
EEE_MODE_OVERRIDE_NVRAM |
|
||||
EEE_MODE_OUTPUT_TIME;
|
||||
|
||||
/* Restart link to propogate changes */
|
||||
if (netif_running(dev)) {
|
||||
bnx2x_stats_handle(bp, STATS_EVENT_STOP);
|
||||
bnx2x_link_set(bp);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
enum {
|
||||
BNX2X_CHIP_E1_OFST = 0,
|
||||
BNX2X_CHIP_E1H_OFST,
|
||||
@ -2472,6 +2604,8 @@ static const struct ethtool_ops bnx2x_ethtool_ops = {
|
||||
.get_rxfh_indir_size = bnx2x_get_rxfh_indir_size,
|
||||
.get_rxfh_indir = bnx2x_get_rxfh_indir,
|
||||
.set_rxfh_indir = bnx2x_set_rxfh_indir,
|
||||
.get_eee = bnx2x_get_eee,
|
||||
.set_eee = bnx2x_set_eee,
|
||||
};
|
||||
|
||||
void bnx2x_set_ethtool_ops(struct net_device *netdev)
|
||||
|
||||
Loading…
Reference in New Issue
Block a user