Skip to content

L
linux
Commit 17c5cde7 authored by Jeff Garzik's avatar Jeff Garzik
Browse files
Options

[netdrvr b44] ethtool_ops support

parent 4003ce2e
Hide whitespace changes
Inline Side-by-side
Showing with 199 additions and 214 deletions
drivers/net/b44.c
View file @ 17c5cde7
...@@ -27,8 +27,8 @@ ...@@ -27,8 +27,8 @@
#define DRV_MODULE_NAME "b44" #define DRV_MODULE_NAME "b44"
#define PFX DRV_MODULE_NAME ": " #define PFX DRV_MODULE_NAME ": "
#define DRV_MODULE_VERSION "0.93" #define DRV_MODULE_VERSION "0.94"
#define DRV_MODULE_RELDATE "Mar, 2004" #define DRV_MODULE_RELDATE "May 4, 2004"
#define B44_DEF_MSG_ENABLE \ #define B44_DEF_MSG_ENABLE \
(NETIF_MSG_DRV | \ (NETIF_MSG_DRV | \
...@@ -1373,247 +1373,234 @@ static void b44_set_rx_mode(struct net_device *dev) ...@@ -1373,247 +1373,234 @@ static void b44_set_rx_mode(struct net_device *dev)
spin_unlock_irq(&bp->lock); spin_unlock_irq(&bp->lock);
} }
static int b44_ethtool_ioctl (struct net_device *dev, void __user *useraddr) static u32 b44_get_msglevel(struct net_device *dev)
{ {
struct b44 *bp = dev->priv; struct b44 *bp = netdev_priv(dev);
return bp->msg_enable;
}
static void b44_set_msglevel(struct net_device *dev, u32 value)
{
struct b44 *bp = netdev_priv(dev);
bp->msg_enable = value;
}
static void b44_get_drvinfo (struct net_device *dev, struct ethtool_drvinfo *info)
{
struct b44 *bp = netdev_priv(dev);
struct pci_dev *pci_dev = bp->pdev; struct pci_dev *pci_dev = bp->pdev;
u32 ethcmd;
if (copy_from_user (&ethcmd, useraddr, sizeof (ethcmd)))
return -EFAULT;
switch (ethcmd) {
case ETHTOOL_GDRVINFO: {
struct ethtool_drvinfo info = { ETHTOOL_GDRVINFO };
strcpy (info.driver, DRV_MODULE_NAME);
strcpy (info.version, DRV_MODULE_VERSION);
memset(&info.fw_version, 0, sizeof(info.fw_version));
strcpy (info.bus_info, pci_name(pci_dev));
info.eedump_len = 0;
info.regdump_len = 0;
if (copy_to_user (useraddr, &info, sizeof (info)))
return -EFAULT;
return 0;
}
case ETHTOOL_GSET: { strcpy (info->driver, DRV_MODULE_NAME);
struct ethtool_cmd cmd = { ETHTOOL_GSET }; strcpy (info->version, DRV_MODULE_VERSION);
strcpy (info->bus_info, pci_name(pci_dev));
}
if (!(bp->flags & B44_FLAG_INIT_COMPLETE)) static int b44_nway_reset(struct net_device *dev)
return -EAGAIN; {
cmd.supported = (SUPPORTED_Autoneg); struct b44 *bp = netdev_priv(dev);
cmd.supported |= (SUPPORTED_100baseT_Half | u32 bmcr;
SUPPORTED_100baseT_Full | int r;
SUPPORTED_10baseT_Half |
SUPPORTED_10baseT_Full |
SUPPORTED_MII);
cmd.advertising = 0; spin_lock_irq(&bp->lock);
if (bp->flags & B44_FLAG_ADV_10HALF) b44_readphy(bp, MII_BMCR, &bmcr);
cmd.advertising |= ADVERTISE_10HALF; b44_readphy(bp, MII_BMCR, &bmcr);
if (bp->flags & B44_FLAG_ADV_10FULL) r = -EINVAL;
cmd.advertising |= ADVERTISE_10FULL; if (bmcr & BMCR_ANENABLE) {
if (bp->flags & B44_FLAG_ADV_100HALF) b44_writephy(bp, MII_BMCR,
cmd.advertising |= ADVERTISE_100HALF; bmcr | BMCR_ANRESTART);
if (bp->flags & B44_FLAG_ADV_100FULL) r = 0;
cmd.advertising |= ADVERTISE_100FULL;
cmd.advertising |= ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;
cmd.speed = (bp->flags & B44_FLAG_100_BASE_T) ?
SPEED_100 : SPEED_10;
cmd.duplex = (bp->flags & B44_FLAG_FULL_DUPLEX) ?
DUPLEX_FULL : DUPLEX_HALF;
cmd.port = 0;
cmd.phy_address = bp->phy_addr;
cmd.transceiver = (bp->flags & B44_FLAG_INTERNAL_PHY) ?
XCVR_INTERNAL : XCVR_EXTERNAL;
cmd.autoneg = (bp->flags & B44_FLAG_FORCE_LINK) ?
AUTONEG_DISABLE : AUTONEG_ENABLE;
cmd.maxtxpkt = 0;
cmd.maxrxpkt = 0;
if (copy_to_user(useraddr, &cmd, sizeof(cmd)))
return -EFAULT;
return 0;
} }
case ETHTOOL_SSET: { spin_unlock_irq(&bp->lock);
struct ethtool_cmd cmd;
if (!(bp->flags & B44_FLAG_INIT_COMPLETE))
return -EAGAIN;
if (copy_from_user(&cmd, useraddr, sizeof(cmd)))
return -EFAULT;
/* We do not support gigabit. */
if (cmd.autoneg == AUTONEG_ENABLE) {
if (cmd.advertising &
(ADVERTISED_1000baseT_Half |
ADVERTISED_1000baseT_Full))
return -EINVAL;
} else if ((cmd.speed != SPEED_100 &&
cmd.speed != SPEED_10) ||
(cmd.duplex != DUPLEX_HALF &&
cmd.duplex != DUPLEX_FULL)) {
return -EINVAL;
}
spin_lock_irq(&bp->lock); return r;
}
if (cmd.autoneg == AUTONEG_ENABLE) { static int b44_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
bp->flags &= ~B44_FLAG_FORCE_LINK; {
bp->flags &= ~(B44_FLAG_ADV_10HALF | struct b44 *bp = netdev_priv(dev);
B44_FLAG_ADV_10FULL |
B44_FLAG_ADV_100HALF | if (!(bp->flags & B44_FLAG_INIT_COMPLETE))
B44_FLAG_ADV_100FULL); return -EAGAIN;
if (cmd.advertising & ADVERTISE_10HALF) cmd->supported = (SUPPORTED_Autoneg);
bp->flags |= B44_FLAG_ADV_10HALF; cmd->supported |= (SUPPORTED_100baseT_Half |
if (cmd.advertising & ADVERTISE_10FULL) SUPPORTED_100baseT_Full |
bp->flags |= B44_FLAG_ADV_10FULL; SUPPORTED_10baseT_Half |
if (cmd.advertising & ADVERTISE_100HALF) SUPPORTED_10baseT_Full |
bp->flags |= B44_FLAG_ADV_100HALF; SUPPORTED_MII);
if (cmd.advertising & ADVERTISE_100FULL)
bp->flags |= B44_FLAG_ADV_100FULL; cmd->advertising = 0;
} else { if (bp->flags & B44_FLAG_ADV_10HALF)
bp->flags |= B44_FLAG_FORCE_LINK; cmd->advertising |= ADVERTISE_10HALF;
if (cmd.speed == SPEED_100) if (bp->flags & B44_FLAG_ADV_10FULL)
bp->flags |= B44_FLAG_100_BASE_T; cmd->advertising |= ADVERTISE_10FULL;
if (cmd.duplex == DUPLEX_FULL) if (bp->flags & B44_FLAG_ADV_100HALF)
bp->flags |= B44_FLAG_FULL_DUPLEX; cmd->advertising |= ADVERTISE_100HALF;
} if (bp->flags & B44_FLAG_ADV_100FULL)
cmd->advertising |= ADVERTISE_100FULL;
cmd->advertising |= ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;
cmd->speed = (bp->flags & B44_FLAG_100_BASE_T) ?
SPEED_100 : SPEED_10;
cmd->duplex = (bp->flags & B44_FLAG_FULL_DUPLEX) ?
DUPLEX_FULL : DUPLEX_HALF;
cmd->port = 0;
cmd->phy_address = bp->phy_addr;
cmd->transceiver = (bp->flags & B44_FLAG_INTERNAL_PHY) ?
XCVR_INTERNAL : XCVR_EXTERNAL;
cmd->autoneg = (bp->flags & B44_FLAG_FORCE_LINK) ?
AUTONEG_DISABLE : AUTONEG_ENABLE;
cmd->maxtxpkt = 0;
cmd->maxrxpkt = 0;
return 0;
}
b44_setup_phy(bp); static int b44_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
{
struct b44 *bp = netdev_priv(dev);
spin_unlock_irq(&bp->lock); if (!(bp->flags & B44_FLAG_INIT_COMPLETE))
return -EAGAIN;
return 0; /* We do not support gigabit. */
if (cmd->autoneg == AUTONEG_ENABLE) {
if (cmd->advertising &
(ADVERTISED_1000baseT_Half |
ADVERTISED_1000baseT_Full))
return -EINVAL;
} else if ((cmd->speed != SPEED_100 &&
cmd->speed != SPEED_10) ||
(cmd->duplex != DUPLEX_HALF &&
cmd->duplex != DUPLEX_FULL)) {
return -EINVAL;
} }
case ETHTOOL_GMSGLVL: { spin_lock_irq(&bp->lock);
struct ethtool_value edata = { ETHTOOL_GMSGLVL };
edata.data = bp->msg_enable; if (cmd->autoneg == AUTONEG_ENABLE) {
if (copy_to_user(useraddr, &edata, sizeof(edata))) bp->flags &= ~B44_FLAG_FORCE_LINK;
return -EFAULT; bp->flags &= ~(B44_FLAG_ADV_10HALF |
return 0; B44_FLAG_ADV_10FULL |
} B44_FLAG_ADV_100HALF |
case ETHTOOL_SMSGLVL: { B44_FLAG_ADV_100FULL);
struct ethtool_value edata; if (cmd->advertising & ADVERTISE_10HALF)
if (copy_from_user(&edata, useraddr, sizeof(edata))) bp->flags |= B44_FLAG_ADV_10HALF;
return -EFAULT; if (cmd->advertising & ADVERTISE_10FULL)
bp->msg_enable = edata.data; bp->flags |= B44_FLAG_ADV_10FULL;
return 0; if (cmd->advertising & ADVERTISE_100HALF)
bp->flags |= B44_FLAG_ADV_100HALF;
if (cmd->advertising & ADVERTISE_100FULL)
bp->flags |= B44_FLAG_ADV_100FULL;
} else {
bp->flags |= B44_FLAG_FORCE_LINK;
if (cmd->speed == SPEED_100)
bp->flags |= B44_FLAG_100_BASE_T;
if (cmd->duplex == DUPLEX_FULL)
bp->flags |= B44_FLAG_FULL_DUPLEX;
} }
case ETHTOOL_NWAY_RST: {
u32 bmcr;
int r;
spin_lock_irq(&bp->lock); b44_setup_phy(bp);
b44_readphy(bp, MII_BMCR, &bmcr);
b44_readphy(bp, MII_BMCR, &bmcr);
r = -EINVAL;
if (bmcr & BMCR_ANENABLE) {
b44_writephy(bp, MII_BMCR,
bmcr | BMCR_ANRESTART);
r = 0;
}
spin_unlock_irq(&bp->lock);
return r; spin_unlock_irq(&bp->lock);
}
case ETHTOOL_GLINK: {
struct ethtool_value edata = { ETHTOOL_GLINK };
edata.data = netif_carrier_ok(bp->dev) ? 1 : 0;
if (copy_to_user(useraddr, &edata, sizeof(edata)))
return -EFAULT;
return 0;
}
case ETHTOOL_GRINGPARAM: {
struct ethtool_ringparam ering = { ETHTOOL_GRINGPARAM };
ering.rx_max_pending = B44_RX_RING_SIZE - 1; return 0;
ering.rx_pending = bp->rx_pending; }
/* XXX ethtool lacks a tx_max_pending, oops... */ static void b44_get_ringparam(struct net_device *dev,
struct ethtool_ringparam *ering)
{
struct b44 *bp = netdev_priv(dev);
if (copy_to_user(useraddr, &ering, sizeof(ering))) ering->rx_max_pending = B44_RX_RING_SIZE - 1;
return -EFAULT; ering->rx_pending = bp->rx_pending;
return 0;
}
case ETHTOOL_SRINGPARAM: {
struct ethtool_ringparam ering;
if (copy_from_user(&ering, useraddr, sizeof(ering))) /* XXX ethtool lacks a tx_max_pending, oops... */
return -EFAULT; }
if ((ering.rx_pending > B44_RX_RING_SIZE - 1) || static int b44_set_ringparam(struct net_device *dev,
(ering.rx_mini_pending != 0) || struct ethtool_ringparam *ering)
(ering.rx_jumbo_pending != 0) || {
(ering.tx_pending > B44_TX_RING_SIZE - 1)) struct b44 *bp = netdev_priv(dev);
return -EINVAL;
spin_lock_irq(&bp->lock); if ((ering->rx_pending > B44_RX_RING_SIZE - 1) ||
(ering->rx_mini_pending != 0) ||
(ering->rx_jumbo_pending != 0) ||
(ering->tx_pending > B44_TX_RING_SIZE - 1))
return -EINVAL;
bp->rx_pending = ering.rx_pending; spin_lock_irq(&bp->lock);
bp->tx_pending = ering.tx_pending;
b44_halt(bp); bp->rx_pending = ering->rx_pending;
b44_init_rings(bp); bp->tx_pending = ering->tx_pending;
b44_init_hw(bp);
netif_wake_queue(bp->dev);
spin_unlock_irq(&bp->lock);
b44_enable_ints(bp); b44_halt(bp);
b44_init_rings(bp);
return 0; b44_init_hw(bp);
} netif_wake_queue(bp->dev);
case ETHTOOL_GPAUSEPARAM: { spin_unlock_irq(&bp->lock);
struct ethtool_pauseparam epause = { ETHTOOL_GPAUSEPARAM };
epause.autoneg =
(bp->flags & B44_FLAG_PAUSE_AUTO) != 0;
epause.rx_pause =
(bp->flags & B44_FLAG_RX_PAUSE) != 0;
epause.tx_pause =
(bp->flags & B44_FLAG_TX_PAUSE) != 0;
if (copy_to_user(useraddr, &epause, sizeof(epause)))
return -EFAULT;
return 0;
}
case ETHTOOL_SPAUSEPARAM: {
struct ethtool_pauseparam epause;
if (copy_from_user(&epause, useraddr, sizeof(epause))) b44_enable_ints(bp);
return -EFAULT;
return 0;
}
spin_lock_irq(&bp->lock); static void b44_get_pauseparam(struct net_device *dev,
if (epause.autoneg) struct ethtool_pauseparam *epause)
bp->flags |= B44_FLAG_PAUSE_AUTO; {
else struct b44 *bp = netdev_priv(dev);
bp->flags &= ~B44_FLAG_PAUSE_AUTO;
if (epause.rx_pause) epause->autoneg =
bp->flags |= B44_FLAG_RX_PAUSE; (bp->flags & B44_FLAG_PAUSE_AUTO) != 0;
else epause->rx_pause =
bp->flags &= ~B44_FLAG_RX_PAUSE; (bp->flags & B44_FLAG_RX_PAUSE) != 0;
if (epause.tx_pause) epause->tx_pause =
bp->flags |= B44_FLAG_TX_PAUSE; (bp->flags & B44_FLAG_TX_PAUSE) != 0;
else }
bp->flags &= ~B44_FLAG_TX_PAUSE;
if (bp->flags & B44_FLAG_PAUSE_AUTO) {
b44_halt(bp);
b44_init_rings(bp);
b44_init_hw(bp);
} else {
__b44_set_flow_ctrl(bp, bp->flags);
}
spin_unlock_irq(&bp->lock);
b44_enable_ints(bp); static int b44_set_pauseparam(struct net_device *dev,
struct ethtool_pauseparam *epause)
return 0; {
struct b44 *bp = netdev_priv(dev);
spin_lock_irq(&bp->lock);
if (epause->autoneg)
bp->flags |= B44_FLAG_PAUSE_AUTO;
else
bp->flags &= ~B44_FLAG_PAUSE_AUTO;
if (epause->rx_pause)
bp->flags |= B44_FLAG_RX_PAUSE;
else
bp->flags &= ~B44_FLAG_RX_PAUSE;
if (epause->tx_pause)
bp->flags |= B44_FLAG_TX_PAUSE;
else
bp->flags &= ~B44_FLAG_TX_PAUSE;
if (bp->flags & B44_FLAG_PAUSE_AUTO) {
b44_halt(bp);
b44_init_rings(bp);
b44_init_hw(bp);
} else {
__b44_set_flow_ctrl(bp, bp->flags);
} }
}; spin_unlock_irq(&bp->lock);
return -EOPNOTSUPP; b44_enable_ints(bp);
return 0;
} }
static struct ethtool_ops b44_ethtool_ops = {
.get_drvinfo = b44_get_drvinfo,
.get_settings = b44_get_settings,
.set_settings = b44_set_settings,
.nway_reset = b44_nway_reset,
.get_link = ethtool_op_get_link,
.get_ringparam = b44_get_ringparam,
.set_ringparam = b44_set_ringparam,
.get_pauseparam = b44_get_pauseparam,
.set_pauseparam = b44_set_pauseparam,
.get_msglevel = b44_get_msglevel,
.set_msglevel = b44_set_msglevel,
};
static int b44_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) static int b44_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
{ {
struct mii_ioctl_data __user *data = (struct mii_ioctl_data __user *)&ifr->ifr_data; struct mii_ioctl_data __user *data = (struct mii_ioctl_data __user *)&ifr->ifr_data;
...@@ -1621,9 +1608,6 @@ static int b44_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) ...@@ -1621,9 +1608,6 @@ static int b44_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
int err; int err;
switch (cmd) { switch (cmd) {
case SIOCETHTOOL:
return b44_ethtool_ioctl(dev, (void __user*) ifr->ifr_data);
case SIOCGMIIPHY: case SIOCGMIIPHY:
data->phy_id = bp->phy_addr; data->phy_id = bp->phy_addr;
...@@ -1797,6 +1781,7 @@ static int __devinit b44_init_one(struct pci_dev *pdev, ...@@ -1797,6 +1781,7 @@ static int __devinit b44_init_one(struct pci_dev *pdev,
dev->watchdog_timeo = B44_TX_TIMEOUT; dev->watchdog_timeo = B44_TX_TIMEOUT;
dev->change_mtu = b44_change_mtu; dev->change_mtu = b44_change_mtu;
dev->irq = pdev->irq; dev->irq = pdev->irq;
SET_ETHTOOL_OPS(dev, &b44_ethtool_ops);
err = b44_get_invariants(bp); err = b44_get_invariants(bp);
if (err) { if (err) {
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7