Commit cdc04540 authored by Raju Lakkaraju's avatar Raju Lakkaraju Committed by Jakub Kicinski
Browse files

net: lan743x: Add support for get_pauseparam and set_pauseparam 



Add pause get and set functions

Signed-off-by: default avatarRaju Lakkaraju <Raju.Lakkaraju@microchip.com>
Reviewed-by: default avatarAndrew Lunn <andrew@lunn.ch>
Signed-off-by: default avatarJakub Kicinski <kuba@kernel.org>
parent b5f0de6d

drivers/net/ethernet/microchip/lan743x_ethtool.c

+46 −0
Original line number Diff line number Diff line
@@ -1233,6 +1233,50 @@ static void lan743x_get_regs(struct net_device *dev, 
	lan743x_common_regs(dev, regs, p);

}



static void lan743x_get_pauseparam(struct net_device *dev,

				   struct ethtool_pauseparam *pause)

{

	struct lan743x_adapter *adapter = netdev_priv(dev);

	struct lan743x_phy *phy = &adapter->phy;



	if (phy->fc_request_control & FLOW_CTRL_TX)

		pause->tx_pause = 1;

	if (phy->fc_request_control & FLOW_CTRL_RX)

		pause->rx_pause = 1;

	pause->autoneg = phy->fc_autoneg;

}



static int lan743x_set_pauseparam(struct net_device *dev,

				  struct ethtool_pauseparam *pause)

{

	struct lan743x_adapter *adapter = netdev_priv(dev);

	struct phy_device *phydev = dev->phydev;

	struct lan743x_phy *phy = &adapter->phy;



	if (!phydev)

		return -ENODEV;



	if (!phy_validate_pause(phydev, pause))

		return -EINVAL;



	phy->fc_request_control = 0;

	if (pause->rx_pause)

		phy->fc_request_control |= FLOW_CTRL_RX;



	if (pause->tx_pause)

		phy->fc_request_control |= FLOW_CTRL_TX;



	phy->fc_autoneg = pause->autoneg;



	if (pause->autoneg == AUTONEG_DISABLE)

		lan743x_mac_flow_ctrl_set_enables(adapter, pause->tx_pause,

						  pause->rx_pause);

	else

		phy_set_asym_pause(phydev, pause->rx_pause,  pause->tx_pause);



	return 0;

}



const struct ethtool_ops lan743x_ethtool_ops = {

	.get_drvinfo = lan743x_ethtool_get_drvinfo,

	.get_msglevel = lan743x_ethtool_get_msglevel,
@@ -1259,6 +1303,8 @@ const struct ethtool_ops lan743x_ethtool_ops = { 
	.set_link_ksettings = phy_ethtool_set_link_ksettings,

	.get_regs_len = lan743x_get_regs_len,

	.get_regs = lan743x_get_regs,

	.get_pauseparam = lan743x_get_pauseparam,

	.set_pauseparam = lan743x_set_pauseparam,

#ifdef CONFIG_PM

	.get_wol = lan743x_ethtool_get_wol,

	.set_wol = lan743x_ethtool_set_wol,

drivers/net/ethernet/microchip/lan743x_main.c

+2 −2
Original line number Diff line number Diff line
@@ -1326,7 +1326,7 @@ static void lan743x_mac_close(struct lan743x_adapter *adapter) 
				 1, 1000, 20000, 100);

}



static void lan743x_mac_flow_ctrl_set_enables(struct lan743x_adapter *adapter,

void lan743x_mac_flow_ctrl_set_enables(struct lan743x_adapter *adapter,

				       bool tx_enable, bool rx_enable)

{

	u32 flow_setting = 0;

drivers/net/ethernet/microchip/lan743x_main.h

+2 −0
Original line number Diff line number Diff line
@@ -1159,5 +1159,7 @@ u32 lan743x_csr_read(struct lan743x_adapter *adapter, int offset); 
void lan743x_csr_write(struct lan743x_adapter *adapter, int offset, u32 data);

int lan743x_hs_syslock_acquire(struct lan743x_adapter *adapter, u16 timeout);

void lan743x_hs_syslock_release(struct lan743x_adapter *adapter);

void lan743x_mac_flow_ctrl_set_enables(struct lan743x_adapter *adapter,

				       bool tx_enable, bool rx_enable);



#endif /* _LAN743X_H */