leandrof/linux
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

r8152: support pauseparam of ethtool_ops

Browse Source 
Support get_pauseparam and set_pauseparam of ethtool_ops.

Signed-off-by: Hayes Wang <hayeswang@realtek.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
Hayes Wang 2021-06-01 15:37:12 +08:00 committed by David S. Miller
parent 68b8c55a70
commit 163d01c56e
1 changed files with 75 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

75
drivers/net/usb/r8152.c
View File

@ -8967,6 +8967,79 @@ static int rtl8152_set_ringparam(struct net_device *netdev,
return 0;
}
static void rtl8152_get_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *pause)
{
struct r8152 *tp = netdev_priv(netdev);
u16 bmcr, lcladv, rmtadv;
u8 cap;
if (usb_autopm_get_interface(tp->intf) < 0)
return;
mutex_lock(&tp->control);
bmcr = r8152_mdio_read(tp, MII_BMCR);
lcladv = r8152_mdio_read(tp, MII_ADVERTISE);
rmtadv = r8152_mdio_read(tp, MII_LPA);
mutex_unlock(&tp->control);
usb_autopm_put_interface(tp->intf);
if (!(bmcr & BMCR_ANENABLE)) {
pause->autoneg = 0;
pause->rx_pause = 0;
pause->tx_pause = 0;
return;
}
pause->autoneg = 1;
cap = mii_resolve_flowctrl_fdx(lcladv, rmtadv);
if (cap & FLOW_CTRL_RX)
pause->rx_pause = 1;
if (cap & FLOW_CTRL_TX)
pause->tx_pause = 1;
}
static int rtl8152_set_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *pause)
{
struct r8152 *tp = netdev_priv(netdev);
u16 old, new1;
u8 cap = 0;
int ret;
ret = usb_autopm_get_interface(tp->intf);
if (ret < 0)
return ret;
mutex_lock(&tp->control);
if (pause->autoneg && !(r8152_mdio_read(tp, MII_BMCR) & BMCR_ANENABLE)) {
ret = -EINVAL;
goto out;
}
if (pause->rx_pause)
cap |= FLOW_CTRL_RX;
if (pause->tx_pause)
cap |= FLOW_CTRL_TX;
old = r8152_mdio_read(tp, MII_ADVERTISE);
new1 = (old & ~(ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM)) | mii_advertise_flowctrl(cap);
if (old != new1)
r8152_mdio_write(tp, MII_ADVERTISE, new1);
out:
mutex_unlock(&tp->control);
usb_autopm_put_interface(tp->intf);
return ret;
}
static const struct ethtool_ops ops = {
.supported_coalesce_params = ETHTOOL_COALESCE_USECS,
.get_drvinfo = rtl8152_get_drvinfo,
@ -8989,6 +9062,8 @@ static const struct ethtool_ops ops = {
.set_tunable = rtl8152_set_tunable,
.get_ringparam = rtl8152_get_ringparam,
.set_ringparam = rtl8152_set_ringparam,
.get_pauseparam = rtl8152_get_pauseparam,
.set_pauseparam = rtl8152_set_pauseparam,
};
static int rtl8152_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd)