Skip to content

L
linux
Commit 2967abcf authored by Jeff Garzik's avatar Jeff Garzik
Browse files
Options

[netdrvr de2104x] ethtool_ops support

parent 75257710
Hide whitespace changes
Inline Side-by-side
Showing with 96 additions and 146 deletions
drivers/net/tulip/de2104x.c
View file @ 2967abcf
/* de2104x.c: A Linux PCI Ethernet driver for Intel/Digital 21040/1 chips. */ /* de2104x.c: A Linux PCI Ethernet driver for Intel/Digital 21040/1 chips. */
/* /*
Copyright 2001 Jeff Garzik <jgarzik@pobox.com> Copyright 2001,2003 Jeff Garzik <jgarzik@pobox.com>
Copyright 1994, 1995 Digital Equipment Corporation. [de4x5.c] Copyright 1994, 1995 Digital Equipment Corporation. [de4x5.c]
Written/copyright 1994-2001 by Donald Becker. [tulip.c] Written/copyright 1994-2001 by Donald Becker. [tulip.c]
...@@ -28,8 +28,8 @@ ...@@ -28,8 +28,8 @@
*/ */
#define DRV_NAME "de2104x" #define DRV_NAME "de2104x"
#define DRV_VERSION "0.5.4" #define DRV_VERSION "0.6"
#define DRV_RELDATE "Jan 1, 2002" #define DRV_RELDATE "Sep 1, 2003"
#include <linux/config.h> #include <linux/config.h>
#include <linux/module.h> #include <linux/module.h>
...@@ -1464,7 +1464,7 @@ static void de_tx_timeout (struct net_device *dev) ...@@ -1464,7 +1464,7 @@ static void de_tx_timeout (struct net_device *dev)
netif_wake_queue(dev); netif_wake_queue(dev);
} }
static int de_get_regs(struct de_private *de, u8 *buf) static void __de_get_regs(struct de_private *de, u8 *buf)
{ {
int i; int i;
u32 *rbuf = (u32 *)buf; u32 *rbuf = (u32 *)buf;
...@@ -1475,11 +1475,9 @@ static int de_get_regs(struct de_private *de, u8 *buf) ...@@ -1475,11 +1475,9 @@ static int de_get_regs(struct de_private *de, u8 *buf)
/* handle self-clearing RxMissed counter, CSR8 */ /* handle self-clearing RxMissed counter, CSR8 */
de_rx_missed(de, rbuf[8]); de_rx_missed(de, rbuf[8]);
return 0;
} }
static int de_ethtool_gset(struct de_private *de, struct ethtool_cmd *ecmd) static int __de_get_settings(struct de_private *de, struct ethtool_cmd *ecmd)
{ {
ecmd->supported = de->media_supported; ecmd->supported = de->media_supported;
ecmd->transceiver = XCVR_INTERNAL; ecmd->transceiver = XCVR_INTERNAL;
...@@ -1516,7 +1514,7 @@ static int de_ethtool_gset(struct de_private *de, struct ethtool_cmd *ecmd) ...@@ -1516,7 +1514,7 @@ static int de_ethtool_gset(struct de_private *de, struct ethtool_cmd *ecmd)
return 0; return 0;
} }
static int de_ethtool_sset(struct de_private *de, struct ethtool_cmd *ecmd) static int __de_set_settings(struct de_private *de, struct ethtool_cmd *ecmd)
{ {
u32 new_media; u32 new_media;
unsigned int media_lock; unsigned int media_lock;
...@@ -1584,169 +1582,121 @@ static int de_ethtool_sset(struct de_private *de, struct ethtool_cmd *ecmd) ...@@ -1584,169 +1582,121 @@ static int de_ethtool_sset(struct de_private *de, struct ethtool_cmd *ecmd)
return 0; return 0;
} }
static int de_ethtool_ioctl (struct de_private *de, void *useraddr) static void de_get_drvinfo (struct net_device *dev,struct ethtool_drvinfo *info)
{ {
u32 ethcmd; struct de_private *de = dev->priv;
/* dev_ioctl() in ../../net/core/dev.c has already checked
capable(CAP_NET_ADMIN), so don't bother with that here. */
if (get_user(ethcmd, (u32 *)useraddr))
return -EFAULT;
switch (ethcmd) {
case ETHTOOL_GDRVINFO: {
struct ethtool_drvinfo info = { ETHTOOL_GDRVINFO };
strcpy (info.driver, DRV_NAME);
strcpy (info.version, DRV_VERSION);
strcpy (info.bus_info, pci_name(de->pdev));
info.eedump_len = DE_EEPROM_SIZE;
info.regdump_len = DE_REGS_SIZE;
if (copy_to_user (useraddr, &info, sizeof (info)))
return -EFAULT;
return 0;
}
/* get settings */
case ETHTOOL_GSET: {
struct ethtool_cmd ecmd = { ETHTOOL_GSET };
spin_lock_irq(&de->lock);
de_ethtool_gset(de, &ecmd);
spin_unlock_irq(&de->lock);
if (copy_to_user(useraddr, &ecmd, sizeof(ecmd)))
return -EFAULT;
return 0;
}
/* set settings */
case ETHTOOL_SSET: {
struct ethtool_cmd ecmd;
int r;
if (copy_from_user(&ecmd, useraddr, sizeof(ecmd)))
return -EFAULT;
spin_lock_irq(&de->lock);
r = de_ethtool_sset(de, &ecmd);
spin_unlock_irq(&de->lock);
return r;
}
/* restart autonegotiation */ strcpy (info->driver, DRV_NAME);
case ETHTOOL_NWAY_RST: { strcpy (info->version, DRV_VERSION);
u32 status; strcpy (info->bus_info, pci_name(de->pdev));
info->eedump_len = DE_EEPROM_SIZE;
}
if (de->media_type != DE_MEDIA_TP_AUTO) static int de_get_regs_len(struct net_device *dev)
return -EINVAL; {
if (netif_carrier_ok(de->dev)) return DE_REGS_SIZE;
de_link_down(de); }
status = dr32(SIAStatus); static int de_get_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
dw32(SIAStatus, (status & ~NWayState) | NWayRestart); {
if (netif_msg_link(de)) struct de_private *de = dev->priv;
printk(KERN_INFO "%s: link nway restart, status %x,%x\n", int rc;
de->dev->name, status, dr32(SIAStatus));
return 0;
}
/* get link status */ spin_lock_irq(&de->lock);
case ETHTOOL_GLINK: { rc = __de_get_settings(de, ecmd);
struct ethtool_value edata = {ETHTOOL_GLINK}; spin_unlock_irq(&de->lock);
edata.data = (netif_carrier_ok(de->dev)) ? 1 : 0;
if (copy_to_user(useraddr, &edata, sizeof(edata)))
return -EFAULT;
return 0;
}
/* get message-level */ return rc;
case ETHTOOL_GMSGLVL: { }
struct ethtool_value edata = {ETHTOOL_GMSGLVL};
edata.data = de->msg_enable;
if (copy_to_user(useraddr, &edata, sizeof(edata)))
return -EFAULT;
return 0;
}
/* set message-level */
case ETHTOOL_SMSGLVL: {
struct ethtool_value edata;
if (copy_from_user(&edata, useraddr, sizeof(edata)))
return -EFAULT;
de->msg_enable = edata.data;
return 0;
}
/* get registers */ static int de_set_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
case ETHTOOL_GREGS: { {
struct ethtool_regs regs; struct de_private *de = dev->priv;
u8 regbuf[DE_REGS_SIZE]; int rc;
int r;
if (copy_from_user(&regs, useraddr, sizeof(regs))) spin_lock_irq(&de->lock);
return -EFAULT; rc = __de_set_settings(de, ecmd);
spin_unlock_irq(&de->lock);
if (regs.len > DE_REGS_SIZE) {
regs.len = DE_REGS_SIZE;
}
regs.version = (DE_REGS_VER << 2) | de->de21040;
if (copy_to_user(useraddr, &regs, sizeof(regs)))
return -EFAULT;
useraddr += offsetof(struct ethtool_regs, data); return rc;
}
spin_lock_irq(&de->lock); static u32 de_get_msglevel(struct net_device *dev)
r = de_get_regs(de, regbuf); {
spin_unlock_irq(&de->lock); struct de_private *de = dev->priv;
if (r) return de->msg_enable;
return r; }
if (copy_to_user(useraddr, regbuf, regs.len))
return -EFAULT;
return 0;
}
/* get SROM dump */ static void de_set_msglevel(struct net_device *dev, u32 msglvl)
case ETHTOOL_GEEPROM: { {
struct ethtool_eeprom eeprom; struct de_private *de = dev->priv;
if (!de->ee_data) de->msg_enable = msglvl;
break; }
if (copy_from_user(&eeprom, useraddr, sizeof(eeprom)))
return -EFAULT;
if ((eeprom.offset != 0) || (eeprom.magic != 0) ||
(eeprom.len != DE_EEPROM_SIZE))
return -EINVAL;
useraddr += offsetof(struct ethtool_regs, data); static int de_get_eeprom(struct net_device *dev,
if (copy_to_user(useraddr, de->ee_data, DE_EEPROM_SIZE)) struct ethtool_eeprom *eeprom, u8 *data)
return -EFAULT; {
} struct de_private *de = dev->priv;
default: if (!de->ee_data)
break; return -EOPNOTSUPP;
} if ((eeprom->offset != 0) || (eeprom->magic != 0) ||
(eeprom->len != DE_EEPROM_SIZE))
return -EINVAL;
memcpy(data, de->ee_data, eeprom->len);
return -EOPNOTSUPP; return 0;
} }
static int de_nway_reset(struct net_device *dev)
static int de_ioctl (struct net_device *dev, struct ifreq *rq, int cmd)
{ {
struct de_private *de = dev->priv; struct de_private *de = dev->priv;
int rc = 0; u32 status;
if (!netif_running(dev)) if (de->media_type != DE_MEDIA_TP_AUTO)
return -EINVAL; return -EINVAL;
if (netif_carrier_ok(de->dev))
switch (cmd) { de_link_down(de);
case SIOCETHTOOL:
return de_ethtool_ioctl(de, (void *) rq->ifr_data);
default: status = dr32(SIAStatus);
rc = -EOPNOTSUPP; dw32(SIAStatus, (status & ~NWayState) | NWayRestart);
break; if (netif_msg_link(de))
} printk(KERN_INFO "%s: link nway restart, status %x,%x\n",
de->dev->name, status, dr32(SIAStatus));
return 0;
}
return rc; static void de_get_regs(struct net_device *dev, struct ethtool_regs *regs,
void *data)
{
struct de_private *de = dev->priv;
if (regs->len > DE_REGS_SIZE)
regs->len = DE_REGS_SIZE;
regs->version = (DE_REGS_VER << 2) | de->de21040;
spin_lock_irq(&de->lock);
__de_get_regs(de, data);
spin_unlock_irq(&de->lock);
} }
static struct ethtool_ops de_ethtool_ops = {
.get_link = ethtool_op_get_link,
.get_tx_csum = ethtool_op_get_tx_csum,
.get_sg = ethtool_op_get_sg,
.get_drvinfo = de_get_drvinfo,
.get_regs_len = de_get_regs_len,
.get_settings = de_get_settings,
.set_settings = de_set_settings,
.get_msglevel = de_get_msglevel,
.set_msglevel = de_set_msglevel,
.get_eeprom = de_get_eeprom,
.nway_reset = de_nway_reset,
.get_regs = de_get_regs,
};
static void __init de21040_get_mac_address (struct de_private *de) static void __init de21040_get_mac_address (struct de_private *de)
{ {
unsigned i; unsigned i;
...@@ -2011,7 +1961,7 @@ static int __init de_init_one (struct pci_dev *pdev, ...@@ -2011,7 +1961,7 @@ static int __init de_init_one (struct pci_dev *pdev,
dev->set_multicast_list = de_set_rx_mode; dev->set_multicast_list = de_set_rx_mode;
dev->hard_start_xmit = de_start_xmit; dev->hard_start_xmit = de_start_xmit;
dev->get_stats = de_get_stats; dev->get_stats = de_get_stats;
dev->do_ioctl = de_ioctl; dev->ethtool_ops = &de_ethtool_ops;
dev->tx_timeout = de_tx_timeout; dev->tx_timeout = de_tx_timeout;
dev->watchdog_timeo = TX_TIMEOUT; dev->watchdog_timeo = TX_TIMEOUT;
......
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