drivers/net/ethernet/atheros/alx/ethtool.c - linux - Git at Google

 /*
  * Copyright (c) 2013 Johannes Berg <johannes@sipsolutions.net>
  *
  *  This file is free software: you may copy, redistribute and/or modify it
  *  under the terms of the GNU General Public License as published by the
  *  Free Software Foundation, either version 2 of the License, or (at your
  *  option) any later version.
  *
  *  This file is distributed in the hope that it will be useful, but
  *  WITHOUT ANY WARRANTY; without even the implied warranty of
  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  *  General Public License for more details.
  *
  *  You should have received a copy of the GNU General Public License
  *  along with this program.  If not, see <http://www.gnu.org/licenses/>.
  *
  * This file incorporates work covered by the following copyright and
  * permission notice:
  *
  * Copyright (c) 2012 Qualcomm Atheros, Inc.
  *
  * Permission to use, copy, modify, and/or distribute this software for any
  * purpose with or without fee is hereby granted, provided that the above
  * copyright notice and this permission notice appear in all copies.
  *
  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  */

 #include <linux/pci.h>
 #include <linux/ip.h>
 #include <linux/tcp.h>
 #include <linux/netdevice.h>
 #include <linux/etherdevice.h>
 #include <linux/ethtool.h>
 #include <linux/mdio.h>
 #include <linux/interrupt.h>
 #include <asm/byteorder.h>

 #include "alx.h"
 #include "reg.h"
 #include "hw.h"

 /* The order of these strings must match the order of the fields in
  * struct alx_hw_stats
  * See hw.h
  */
 static const char alx_gstrings_stats[][ETH_GSTRING_LEN] = {
 	"rx_packets",
 	"rx_bcast_packets",
 	"rx_mcast_packets",
 	"rx_pause_packets",
 	"rx_ctrl_packets",
 	"rx_fcs_errors",
 	"rx_length_errors",
 	"rx_bytes",
 	"rx_runt_packets",
 	"rx_fragments",
 	"rx_64B_or_less_packets",
 	"rx_65B_to_127B_packets",
 	"rx_128B_to_255B_packets",
 	"rx_256B_to_511B_packets",
 	"rx_512B_to_1023B_packets",
 	"rx_1024B_to_1518B_packets",
 	"rx_1519B_to_mtu_packets",
 	"rx_oversize_packets",
 	"rx_rxf_ov_drop_packets",
 	"rx_rrd_ov_drop_packets",
 	"rx_align_errors",
 	"rx_bcast_bytes",
 	"rx_mcast_bytes",
 	"rx_address_errors",
 	"tx_packets",
 	"tx_bcast_packets",
 	"tx_mcast_packets",
 	"tx_pause_packets",
 	"tx_exc_defer_packets",
 	"tx_ctrl_packets",
 	"tx_defer_packets",
 	"tx_bytes",
 	"tx_64B_or_less_packets",
 	"tx_65B_to_127B_packets",
 	"tx_128B_to_255B_packets",
 	"tx_256B_to_511B_packets",
 	"tx_512B_to_1023B_packets",
 	"tx_1024B_to_1518B_packets",
 	"tx_1519B_to_mtu_packets",
 	"tx_single_collision",
 	"tx_multiple_collisions",
 	"tx_late_collision",
 	"tx_abort_collision",
 	"tx_underrun",
 	"tx_trd_eop",
 	"tx_length_errors",
 	"tx_trunc_packets",
 	"tx_bcast_bytes",
 	"tx_mcast_bytes",
 	"tx_update",
 };

 #define ALX_NUM_STATS ARRAY_SIZE(alx_gstrings_stats)


 static u32 alx_get_supported_speeds(struct alx_hw *hw)
 {
 	u32 supported = SUPPORTED_10baseT_Half |
 			SUPPORTED_10baseT_Full |
 			SUPPORTED_100baseT_Half |
 			SUPPORTED_100baseT_Full;

 	if (alx_hw_giga(hw))
 		supported |= SUPPORTED_1000baseT_Full;

 	BUILD_BUG_ON(SUPPORTED_10baseT_Half != ADVERTISED_10baseT_Half);
 	BUILD_BUG_ON(SUPPORTED_10baseT_Full != ADVERTISED_10baseT_Full);
 	BUILD_BUG_ON(SUPPORTED_100baseT_Half != ADVERTISED_100baseT_Half);
 	BUILD_BUG_ON(SUPPORTED_100baseT_Full != ADVERTISED_100baseT_Full);
 	BUILD_BUG_ON(SUPPORTED_1000baseT_Full != ADVERTISED_1000baseT_Full);

 	return supported;
 }

 static int alx_get_link_ksettings(struct net_device *netdev,
 				  struct ethtool_link_ksettings *cmd)
 {
 	struct alx_priv *alx = netdev_priv(netdev);
 	struct alx_hw *hw = &alx->hw;
 	u32 supported, advertising;

 	supported = SUPPORTED_Autoneg |
 			  SUPPORTED_TP |
 			  SUPPORTED_Pause |
 			  SUPPORTED_Asym_Pause;
 	if (alx_hw_giga(hw))
 		supported |= SUPPORTED_1000baseT_Full;
 	supported |= alx_get_supported_speeds(hw);

 	advertising = ADVERTISED_TP;
 	if (hw->adv_cfg & ADVERTISED_Autoneg)
 		advertising |= hw->adv_cfg;

 	cmd->base.port = PORT_TP;
 	cmd->base.phy_address = 0;

 	if (hw->adv_cfg & ADVERTISED_Autoneg)
 		cmd->base.autoneg = AUTONEG_ENABLE;
 	else
 		cmd->base.autoneg = AUTONEG_DISABLE;

 	if (hw->flowctrl & ALX_FC_ANEG && hw->adv_cfg & ADVERTISED_Autoneg) {
 		if (hw->flowctrl & ALX_FC_RX) {
 			advertising |= ADVERTISED_Pause;

 			if (!(hw->flowctrl & ALX_FC_TX))
 				advertising |= ADVERTISED_Asym_Pause;
 		} else if (hw->flowctrl & ALX_FC_TX) {
 			advertising |= ADVERTISED_Asym_Pause;
 		}
 	}

 	cmd->base.speed = hw->link_speed;
 	cmd->base.duplex = hw->duplex;

 	ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.supported,
 						supported);
 	ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.advertising,
 						advertising);

 	return 0;
 }

 static int alx_set_link_ksettings(struct net_device *netdev,
 				  const struct ethtool_link_ksettings *cmd)
 {
 	struct alx_priv *alx = netdev_priv(netdev);
 	struct alx_hw *hw = &alx->hw;
 	u32 adv_cfg;
 	u32 advertising;

 	ASSERT_RTNL();

 	ethtool_convert_link_mode_to_legacy_u32(&advertising,
 						cmd->link_modes.advertising);

 	if (cmd->base.autoneg == AUTONEG_ENABLE) {
 		if (advertising & ~alx_get_supported_speeds(hw))
 			return -EINVAL;
 		adv_cfg = advertising | ADVERTISED_Autoneg;
 	} else {
 		adv_cfg = alx_speed_to_ethadv(cmd->base.speed,
 					      cmd->base.duplex);

 		if (!adv_cfg || adv_cfg == ADVERTISED_1000baseT_Full)
 			return -EINVAL;
 	}

 	hw->adv_cfg = adv_cfg;
 	return alx_setup_speed_duplex(hw, adv_cfg, hw->flowctrl);
 }

 static void alx_get_pauseparam(struct net_device *netdev,
 			       struct ethtool_pauseparam *pause)
 {
 	struct alx_priv *alx = netdev_priv(netdev);
 	struct alx_hw *hw = &alx->hw;

 	pause->autoneg = !!(hw->flowctrl & ALX_FC_ANEG &&
 			    hw->adv_cfg & ADVERTISED_Autoneg);
 	pause->tx_pause = !!(hw->flowctrl & ALX_FC_TX);
 	pause->rx_pause = !!(hw->flowctrl & ALX_FC_RX);
 }


 static int alx_set_pauseparam(struct net_device *netdev,
 			      struct ethtool_pauseparam *pause)
 {
 	struct alx_priv *alx = netdev_priv(netdev);
 	struct alx_hw *hw = &alx->hw;
 	int err = 0;
 	bool reconfig_phy = false;
 	u8 fc = 0;

 	if (pause->tx_pause)
 		fc |= ALX_FC_TX;
 	if (pause->rx_pause)
 		fc |= ALX_FC_RX;
 	if (pause->autoneg)
 		fc |= ALX_FC_ANEG;

 	ASSERT_RTNL();

 	/* restart auto-neg for auto-mode */
 	if (hw->adv_cfg & ADVERTISED_Autoneg) {
 		if (!((fc ^ hw->flowctrl) & ALX_FC_ANEG))
 			reconfig_phy = true;
 		if (fc & hw->flowctrl & ALX_FC_ANEG &&
 		    (fc ^ hw->flowctrl) & (ALX_FC_RX | ALX_FC_TX))
 			reconfig_phy = true;
 	}

 	if (reconfig_phy) {
 		err = alx_setup_speed_duplex(hw, hw->adv_cfg, fc);
 		if (err)
 			return err;
 	}

 	/* flow control on mac */
 	if ((fc ^ hw->flowctrl) & (ALX_FC_RX | ALX_FC_TX))
 		alx_cfg_mac_flowcontrol(hw, fc);

 	hw->flowctrl = fc;

 	return 0;
 }

 static u32 alx_get_msglevel(struct net_device *netdev)
 {
 	struct alx_priv *alx = netdev_priv(netdev);

 	return alx->msg_enable;
 }

 static void alx_set_msglevel(struct net_device *netdev, u32 data)
 {
 	struct alx_priv *alx = netdev_priv(netdev);

 	alx->msg_enable = data;
 }

 static void alx_get_ethtool_stats(struct net_device *netdev,
 				  struct ethtool_stats *estats, u64 *data)
 {
 	struct alx_priv *alx = netdev_priv(netdev);
 	struct alx_hw *hw = &alx->hw;

 	spin_lock(&alx->stats_lock);

 	alx_update_hw_stats(hw);
 	BUILD_BUG_ON(sizeof(hw->stats) - offsetof(struct alx_hw_stats, rx_ok) <
 		     ALX_NUM_STATS * sizeof(u64));
 	memcpy(data, &hw->stats.rx_ok, ALX_NUM_STATS * sizeof(u64));

 	spin_unlock(&alx->stats_lock);
 }

 static void alx_get_strings(struct net_device *netdev, u32 stringset, u8 *buf)
 {
 	switch (stringset) {
 	case ETH_SS_STATS:
 		memcpy(buf, &alx_gstrings_stats, sizeof(alx_gstrings_stats));
 		break;
 	default:
 		WARN_ON(1);
 		break;
 	}
 }

 static int alx_get_sset_count(struct net_device *netdev, int sset)
 {
 	switch (sset) {
 	case ETH_SS_STATS:
 		return ALX_NUM_STATS;
 	default:
 		return -EINVAL;
 	}
 }

 const struct ethtool_ops alx_ethtool_ops = {
 	.get_pauseparam	= alx_get_pauseparam,
 	.set_pauseparam	= alx_set_pauseparam,
 	.get_msglevel	= alx_get_msglevel,
 	.set_msglevel	= alx_set_msglevel,
 	.get_link	= ethtool_op_get_link,
 	.get_strings	= alx_get_strings,
 	.get_sset_count	= alx_get_sset_count,
 	.get_ethtool_stats	= alx_get_ethtool_stats,
 	.get_link_ksettings	= alx_get_link_ksettings,
 	.set_link_ksettings	= alx_set_link_ksettings,
 };
	/*
	* Copyright (c) 2013 Johannes Berg <johannes@sipsolutions.net>
	*
	* This file is free software: you may copy, redistribute and/or modify it
	* under the terms of the GNU General Public License as published by the
	* Free Software Foundation, either version 2 of the License, or (at your
	* option) any later version.
	*
	* This file is distributed in the hope that it will be useful, but
	* WITHOUT ANY WARRANTY; without even the implied warranty of
	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	* General Public License for more details.
	*
	* You should have received a copy of the GNU General Public License
	* along with this program. If not, see <http://www.gnu.org/licenses/>.
	*
	* This file incorporates work covered by the following copyright and
	* permission notice:
	*
	* Copyright (c) 2012 Qualcomm Atheros, Inc.
	*
	* Permission to use, copy, modify, and/or distribute this software for any
	* purpose with or without fee is hereby granted, provided that the above
	* copyright notice and this permission notice appear in all copies.
	*
	* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
	* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
	* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
	* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
	* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
	* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
	* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
	*/

	#include <linux/pci.h>
	#include <linux/ip.h>
	#include <linux/tcp.h>
	#include <linux/netdevice.h>
	#include <linux/etherdevice.h>
	#include <linux/ethtool.h>
	#include <linux/mdio.h>
	#include <linux/interrupt.h>
	#include <asm/byteorder.h>

	#include "alx.h"
	#include "reg.h"
	#include "hw.h"

	/* The order of these strings must match the order of the fields in
	* struct alx_hw_stats
	* See hw.h
	*/
	static const char alx_gstrings_stats[][ETH_GSTRING_LEN] = {
	"rx_packets",
	"rx_bcast_packets",
	"rx_mcast_packets",
	"rx_pause_packets",
	"rx_ctrl_packets",
	"rx_fcs_errors",
	"rx_length_errors",
	"rx_bytes",
	"rx_runt_packets",
	"rx_fragments",
	"rx_64B_or_less_packets",
	"rx_65B_to_127B_packets",
	"rx_128B_to_255B_packets",
	"rx_256B_to_511B_packets",
	"rx_512B_to_1023B_packets",
	"rx_1024B_to_1518B_packets",
	"rx_1519B_to_mtu_packets",
	"rx_oversize_packets",
	"rx_rxf_ov_drop_packets",
	"rx_rrd_ov_drop_packets",
	"rx_align_errors",
	"rx_bcast_bytes",
	"rx_mcast_bytes",
	"rx_address_errors",
	"tx_packets",
	"tx_bcast_packets",
	"tx_mcast_packets",
	"tx_pause_packets",
	"tx_exc_defer_packets",
	"tx_ctrl_packets",
	"tx_defer_packets",
	"tx_bytes",
	"tx_64B_or_less_packets",
	"tx_65B_to_127B_packets",
	"tx_128B_to_255B_packets",
	"tx_256B_to_511B_packets",
	"tx_512B_to_1023B_packets",
	"tx_1024B_to_1518B_packets",
	"tx_1519B_to_mtu_packets",
	"tx_single_collision",
	"tx_multiple_collisions",
	"tx_late_collision",
	"tx_abort_collision",
	"tx_underrun",
	"tx_trd_eop",
	"tx_length_errors",
	"tx_trunc_packets",
	"tx_bcast_bytes",
	"tx_mcast_bytes",
	"tx_update",
	};

	#define ALX_NUM_STATS ARRAY_SIZE(alx_gstrings_stats)


	static u32 alx_get_supported_speeds(struct alx_hw *hw)
	{
	u32 supported = SUPPORTED_10baseT_Half \|
	SUPPORTED_10baseT_Full \|
	SUPPORTED_100baseT_Half \|
	SUPPORTED_100baseT_Full;

	if (alx_hw_giga(hw))
	supported \|= SUPPORTED_1000baseT_Full;

	BUILD_BUG_ON(SUPPORTED_10baseT_Half != ADVERTISED_10baseT_Half);
	BUILD_BUG_ON(SUPPORTED_10baseT_Full != ADVERTISED_10baseT_Full);
	BUILD_BUG_ON(SUPPORTED_100baseT_Half != ADVERTISED_100baseT_Half);
	BUILD_BUG_ON(SUPPORTED_100baseT_Full != ADVERTISED_100baseT_Full);
	BUILD_BUG_ON(SUPPORTED_1000baseT_Full != ADVERTISED_1000baseT_Full);

	return supported;
	}

	static int alx_get_link_ksettings(struct net_device *netdev,
	struct ethtool_link_ksettings *cmd)
	{
	struct alx_priv *alx = netdev_priv(netdev);
	struct alx_hw *hw = &alx->hw;
	u32 supported, advertising;

	supported = SUPPORTED_Autoneg \|
	SUPPORTED_TP \|
	SUPPORTED_Pause \|
	SUPPORTED_Asym_Pause;
	if (alx_hw_giga(hw))
	supported \|= SUPPORTED_1000baseT_Full;
	supported \|= alx_get_supported_speeds(hw);

	advertising = ADVERTISED_TP;
	if (hw->adv_cfg & ADVERTISED_Autoneg)
	advertising \|= hw->adv_cfg;

	cmd->base.port = PORT_TP;
	cmd->base.phy_address = 0;

	if (hw->adv_cfg & ADVERTISED_Autoneg)
	cmd->base.autoneg = AUTONEG_ENABLE;
	else
	cmd->base.autoneg = AUTONEG_DISABLE;

	if (hw->flowctrl & ALX_FC_ANEG && hw->adv_cfg & ADVERTISED_Autoneg) {
	if (hw->flowctrl & ALX_FC_RX) {
	advertising \|= ADVERTISED_Pause;

	if (!(hw->flowctrl & ALX_FC_TX))
	advertising \|= ADVERTISED_Asym_Pause;
	} else if (hw->flowctrl & ALX_FC_TX) {
	advertising \|= ADVERTISED_Asym_Pause;
	}
	}

	cmd->base.speed = hw->link_speed;
	cmd->base.duplex = hw->duplex;

	ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.supported,
	supported);
	ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.advertising,
	advertising);

	return 0;
	}

	static int alx_set_link_ksettings(struct net_device *netdev,
	const struct ethtool_link_ksettings *cmd)
	{
	struct alx_priv *alx = netdev_priv(netdev);
	struct alx_hw *hw = &alx->hw;
	u32 adv_cfg;
	u32 advertising;

	ASSERT_RTNL();

	ethtool_convert_link_mode_to_legacy_u32(&advertising,
	cmd->link_modes.advertising);

	if (cmd->base.autoneg == AUTONEG_ENABLE) {
	if (advertising & ~alx_get_supported_speeds(hw))
	return -EINVAL;
	adv_cfg = advertising \| ADVERTISED_Autoneg;
	} else {
	adv_cfg = alx_speed_to_ethadv(cmd->base.speed,
	cmd->base.duplex);

	if (!adv_cfg \|\| adv_cfg == ADVERTISED_1000baseT_Full)
	return -EINVAL;
	}

	hw->adv_cfg = adv_cfg;
	return alx_setup_speed_duplex(hw, adv_cfg, hw->flowctrl);
	}

	static void alx_get_pauseparam(struct net_device *netdev,
	struct ethtool_pauseparam *pause)
	{
	struct alx_priv *alx = netdev_priv(netdev);
	struct alx_hw *hw = &alx->hw;

	pause->autoneg = !!(hw->flowctrl & ALX_FC_ANEG &&
	hw->adv_cfg & ADVERTISED_Autoneg);
	pause->tx_pause = !!(hw->flowctrl & ALX_FC_TX);
	pause->rx_pause = !!(hw->flowctrl & ALX_FC_RX);
	}


	static int alx_set_pauseparam(struct net_device *netdev,
	struct ethtool_pauseparam *pause)
	{
	struct alx_priv *alx = netdev_priv(netdev);
	struct alx_hw *hw = &alx->hw;
	int err = 0;
	bool reconfig_phy = false;
	u8 fc = 0;

	if (pause->tx_pause)
	fc \|= ALX_FC_TX;
	if (pause->rx_pause)
	fc \|= ALX_FC_RX;
	if (pause->autoneg)
	fc \|= ALX_FC_ANEG;

	ASSERT_RTNL();

	/* restart auto-neg for auto-mode */
	if (hw->adv_cfg & ADVERTISED_Autoneg) {
	if (!((fc ^ hw->flowctrl) & ALX_FC_ANEG))
	reconfig_phy = true;
	if (fc & hw->flowctrl & ALX_FC_ANEG &&
	(fc ^ hw->flowctrl) & (ALX_FC_RX \| ALX_FC_TX))
	reconfig_phy = true;
	}

	if (reconfig_phy) {
	err = alx_setup_speed_duplex(hw, hw->adv_cfg, fc);
	if (err)
	return err;
	}

	/* flow control on mac */
	if ((fc ^ hw->flowctrl) & (ALX_FC_RX \| ALX_FC_TX))
	alx_cfg_mac_flowcontrol(hw, fc);

	hw->flowctrl = fc;

	return 0;
	}

	static u32 alx_get_msglevel(struct net_device *netdev)
	{
	struct alx_priv *alx = netdev_priv(netdev);

	return alx->msg_enable;
	}

	static void alx_set_msglevel(struct net_device *netdev, u32 data)
	{
	struct alx_priv *alx = netdev_priv(netdev);

	alx->msg_enable = data;
	}

	static void alx_get_ethtool_stats(struct net_device *netdev,
	struct ethtool_stats estats, u64 data)
	{
	struct alx_priv *alx = netdev_priv(netdev);
	struct alx_hw *hw = &alx->hw;

	spin_lock(&alx->stats_lock);

	alx_update_hw_stats(hw);
	BUILD_BUG_ON(sizeof(hw->stats) - offsetof(struct alx_hw_stats, rx_ok) <
	ALX_NUM_STATS * sizeof(u64));
	memcpy(data, &hw->stats.rx_ok, ALX_NUM_STATS * sizeof(u64));

	spin_unlock(&alx->stats_lock);
	}

	static void alx_get_strings(struct net_device netdev, u32 stringset, u8 buf)
	{
	switch (stringset) {
	case ETH_SS_STATS:
	memcpy(buf, &alx_gstrings_stats, sizeof(alx_gstrings_stats));
	break;
	default:
	WARN_ON(1);
	break;
	}
	}

	static int alx_get_sset_count(struct net_device *netdev, int sset)
	{
	switch (sset) {
	case ETH_SS_STATS:
	return ALX_NUM_STATS;
	default:
	return -EINVAL;
	}
	}

	const struct ethtool_ops alx_ethtool_ops = {
	.get_pauseparam = alx_get_pauseparam,
	.set_pauseparam = alx_set_pauseparam,
	.get_msglevel = alx_get_msglevel,
	.set_msglevel = alx_set_msglevel,
	.get_link = ethtool_op_get_link,
	.get_strings = alx_get_strings,
	.get_sset_count = alx_get_sset_count,
	.get_ethtool_stats = alx_get_ethtool_stats,
	.get_link_ksettings = alx_get_link_ksettings,
	.set_link_ksettings = alx_set_link_ksettings,
	};