* is out of the interrupt routine.
*/
-#undef DEBUG
-
#include <linux/sched.h>
#include <linux/slab.h>
#include <linux/init.h>
/*
* Version Information
*/
-#define DRIVER_VERSION "v0.5.12 (2005/01/13)"
+#define DRIVER_VERSION "v0.5.12 (2003/06/06)"
#define DRIVER_AUTHOR "Petko Manolov <petkan@users.sourceforge.net>"
#define DRIVER_DESC "Pegasus/Pegasus II USB Ethernet driver"
static int mdio_read(struct net_device *dev, int phy_id, int loc)
{
- pegasus_t *pegasus = (pegasus_t *) netdev_priv(dev);
+ pegasus_t *pegasus = (pegasus_t *) dev->priv;
int res;
read_mii_word(pegasus, phy_id, loc, (u16 *) & res);
*(data + 1) = cpu_to_le16p(®d);
set_register(pegasus, PhyCtrl, 0);
- set_registers(pegasus, PhyAddr, sizeof(data), data);
+ set_registers(pegasus, PhyAddr, 4, data);
set_register(pegasus, PhyCtrl, (indx | PHY_WRITE));
for (i = 0; i < REG_TIMEOUT; i++) {
get_registers(pegasus, PhyCtrl, 1, data);
static void mdio_write(struct net_device *dev, int phy_id, int loc, int val)
{
- pegasus_t *pegasus = (pegasus_t *) netdev_priv(dev);
+ pegasus_t *pegasus = (pegasus_t *) dev->priv;
write_mii_word(pegasus, phy_id, loc, val);
}
static int write_eprom_word(pegasus_t * pegasus, __u8 index, __u16 data)
{
- int i;
- __u8 tmp, d[4] = { 0x3f, 0, 0, EPROM_WRITE };
+ int i, tmp;
+ __u8 d[4] = { 0x3f, 0, 0, EPROM_WRITE };
set_registers(pegasus, EpromOffset, 4, d);
enable_eprom_write(pegasus);
{
__u16 linkpart;
__u8 data[4];
- pegasus_t *pegasus = netdev_priv(dev);
+ pegasus_t *pegasus = dev->priv;
read_mii_word(pegasus, pegasus->phy, MII_LPA, &linkpart);
data[0] = 0xc9;
{
pegasus_t *pegasus = urb->context;
struct net_device *net;
+ __u8 *d;
int status;
if (!pegasus)
return;
- net = pegasus->net;
switch (urb->status) {
case 0:
case -ESHUTDOWN:
return;
default:
- /* some Pegasus-I products report LOTS of data
- * toggle errors... avoid log spamming
- */
- pr_debug("%s: intr status %d\n", net->name, urb->status);
+ info("intr status %d", urb->status);
}
- if (urb->actual_length >= 6) {
- u8 * d = urb->transfer_buffer;
-
- /* byte 0 == tx_status1, reg 2B */
- if (d[0] & (TX_UNDERRUN|EXCESSIVE_COL
- |LATE_COL|JABBER_TIMEOUT)) {
- pegasus->stats.tx_errors++;
- if (d[0] & TX_UNDERRUN)
- pegasus->stats.tx_fifo_errors++;
- if (d[0] & (EXCESSIVE_COL | JABBER_TIMEOUT))
- pegasus->stats.tx_aborted_errors++;
- if (d[0] & LATE_COL)
- pegasus->stats.tx_window_errors++;
- }
-
- /* d[5].LINK_STATUS lies on some adapters.
- * d[0].NO_CARRIER kicks in only with failed TX.
- * ... so monitoring with MII may be safest.
- */
- if (d[0] & NO_CARRIER)
- netif_carrier_off(net);
- else
+ d = urb->transfer_buffer;
+ net = pegasus->net;
+ if (d[0] & 0xfc) {
+ pegasus->stats.tx_errors++;
+ if (d[0] & TX_UNDERRUN)
+ pegasus->stats.tx_fifo_errors++;
+ if (d[0] & (EXCESSIVE_COL | JABBER_TIMEOUT))
+ pegasus->stats.tx_aborted_errors++;
+ if (d[0] & LATE_COL)
+ pegasus->stats.tx_window_errors++;
+ if (d[5] & LINK_STATUS) {
netif_carrier_on(net);
-
- /* bytes 3-4 == rx_lostpkt, reg 2E/2F */
- pegasus->stats.rx_missed_errors += ((d[3] & 0x7f) << 8) | d[4];
+ } else {
+ pegasus->stats.tx_carrier_errors++;
+ netif_carrier_off(net);
+ }
}
status = usb_submit_urb(urb, SLAB_ATOMIC);
if (status)
- printk(KERN_ERR "%s: can't resubmit interrupt urb, %d\n",
- net->name, status);
+ err("%s: can't resubmit interrupt urb, %d", net->name, status);
}
static void pegasus_tx_timeout(struct net_device *net)
{
- pegasus_t *pegasus = netdev_priv(net);
- printk(KERN_WARNING "%s: tx timeout\n", net->name);
+ pegasus_t *pegasus = net->priv;
+
+ if (!pegasus)
+ return;
+
+ warn("%s: Tx timed out.", net->name);
pegasus->tx_urb->transfer_flags |= URB_ASYNC_UNLINK;
usb_unlink_urb(pegasus->tx_urb);
pegasus->stats.tx_errors++;
static int pegasus_start_xmit(struct sk_buff *skb, struct net_device *net)
{
- pegasus_t *pegasus = netdev_priv(net);
+ pegasus_t *pegasus = net->priv;
int count = ((skb->len + 2) & 0x3f) ? skb->len + 2 : skb->len + 3;
int res;
__u16 l16 = skb->len;
static struct net_device_stats *pegasus_netdev_stats(struct net_device *dev)
{
- return &((pegasus_t *) netdev_priv(dev))->stats;
+ return &((pegasus_t *) dev->priv)->stats;
}
static inline void disable_net_traffic(pegasus_t * pegasus)
static void set_carrier(struct net_device *net)
{
- pegasus_t *pegasus = netdev_priv(net);
+ pegasus_t *pegasus;
short tmp;
+ pegasus = net->priv;
read_mii_word(pegasus, pegasus->phy, MII_BMSR, &tmp);
if (tmp & BMSR_LSTATUS)
netif_carrier_on(net);
static void unlink_all_urbs(pegasus_t * pegasus)
{
- usb_kill_urb(pegasus->intr_urb);
- usb_kill_urb(pegasus->tx_urb);
- usb_kill_urb(pegasus->rx_urb);
- usb_kill_urb(pegasus->ctrl_urb);
+ usb_unlink_urb(pegasus->intr_urb);
+ usb_unlink_urb(pegasus->tx_urb);
+ usb_unlink_urb(pegasus->rx_urb);
+ usb_unlink_urb(pegasus->ctrl_urb);
}
static int alloc_urbs(pegasus_t * pegasus)
static int pegasus_open(struct net_device *net)
{
- pegasus_t *pegasus = netdev_priv(net);
+ pegasus_t *pegasus = (pegasus_t *) net->priv;
int res;
if (pegasus->rx_skb == NULL)
if ((res = enable_net_traffic(net, pegasus->usb))) {
err("can't enable_net_traffic() - %d", res);
res = -EIO;
- usb_kill_urb(pegasus->rx_urb);
- usb_kill_urb(pegasus->intr_urb);
+ usb_unlink_urb(pegasus->rx_urb);
+ usb_unlink_urb(pegasus->intr_urb);
free_skb_pool(pegasus);
goto exit;
}
static int pegasus_close(struct net_device *net)
{
- pegasus_t *pegasus = netdev_priv(net);
+ pegasus_t *pegasus = net->priv;
pegasus->flags &= ~PEGASUS_RUNNING;
netif_stop_queue(net);
return 0;
}
-
-void pegasus_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
-{
- pegasus_t *pegasus = netdev_priv(dev);
- strncpy(info->driver, driver_name, sizeof (info->driver) - 1);
- strncpy(info->version, DRIVER_VERSION, sizeof (info->version) - 1);
- usb_make_path(pegasus->usb, info->bus_info, sizeof (info->bus_info));
-}
-
-/* also handles three patterns of some kind in hardware */
-#define WOL_SUPPORTED (WAKE_MAGIC|WAKE_PHY)
-
-static void
-pegasus_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
+#ifdef CONFIG_MII
+static int pegasus_ethtool_ioctl(struct net_device *dev, void __user *useraddr)
{
- pegasus_t *pegasus = netdev_priv(dev);
- wol->supported = WAKE_MAGIC | WAKE_PHY;
- wol->wolopts = pegasus->wolopts;
-}
+ u32 ethcmd;
+ pegasus_t *pegasus = dev->priv;
+
+ if (copy_from_user(ðcmd, useraddr, sizeof (ethcmd)))
+ return -EFAULT;
+
+ switch (ethcmd) {
+ /* get driver-specific version/etc. info */
+ case ETHTOOL_GDRVINFO:{
+ struct ethtool_drvinfo info;
+ memset (&info, 0, sizeof (info));
+ info.cmd = ETHTOOL_GDRVINFO;
+ strncpy(info.driver, driver_name,
+ sizeof (info.driver) - 1);
+ strncpy(info.version, DRIVER_VERSION,
+ sizeof (info.version) - 1);
+ usb_make_path(pegasus->usb, info.bus_info,
+ sizeof (info.bus_info));
+ if (copy_to_user(useraddr, &info, sizeof (info)))
+ return -EFAULT;
+ return 0;
+ }
-static int
-pegasus_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
-{
- pegasus_t *pegasus = netdev_priv(dev);
- u8 reg78 = 0x04;
-
- if (wol->wolopts & ~WOL_SUPPORTED)
- return -EINVAL;
-
- if (wol->wolopts & WAKE_MAGIC)
- reg78 |= 0x80;
- if (wol->wolopts & WAKE_PHY)
- reg78 |= 0x40;
- if (wol->wolopts)
- pegasus->eth_regs[0] |= 0x10;
- else
- pegasus->eth_regs[0] &= ~0x10;
- pegasus->wolopts = wol->wolopts;
- return set_register(pegasus, WakeupControl, reg78);
-}
+ /* get settings */
+ case ETHTOOL_GSET:{
+ struct ethtool_cmd ecmd = { ETHTOOL_GSET };
+ mii_ethtool_gset(&pegasus->mii, &ecmd);
+ if (copy_to_user(useraddr, &ecmd, sizeof (ecmd)))
+ return -EFAULT;
+ return 0;
+ }
+ /* set settings */
+ case ETHTOOL_SSET:{
+ int r;
+ struct ethtool_cmd ecmd;
+ if (copy_from_user(&ecmd, useraddr, sizeof (ecmd)))
+ return -EFAULT;
+ r = mii_ethtool_sset(&pegasus->mii, &ecmd);
+ return r;
+ }
+ /* restart autonegotiation */
+ case ETHTOOL_NWAY_RST:{
+ return mii_nway_restart(&pegasus->mii);
+ }
-static inline void
-pegasus_reset_wol(struct net_device *dev)
-{
- struct ethtool_wolinfo wol;
-
- memset(&wol, 0, sizeof wol);
- (void) pegasus_set_wol(dev, &wol);
-}
+ /* get link status */
+ case ETHTOOL_GLINK:{
+ struct ethtool_value edata = { ETHTOOL_GLINK };
+ edata.data = mii_link_ok(&pegasus->mii);
+ if (copy_to_user(useraddr, &edata, sizeof (edata)))
+ return -EFAULT;
+ return 0;
+ }
+ /* get message-level */
+ case ETHTOOL_GMSGLVL:{
+ struct ethtool_value edata = { ETHTOOL_GMSGLVL };
+ /* edata.data = pegasus->msg_enable; FIXME */
+ 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;
+ /* sp->msg_enable = edata.data; FIXME */
+ return 0;
+ }
-static int
-pegasus_get_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
-{
- pegasus_t *pegasus = netdev_priv(dev);
- mii_ethtool_gset(&pegasus->mii, ecmd);
- return 0;
-}
-static int
-pegasus_set_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
-{
- pegasus_t *pegasus = netdev_priv(dev);
- return mii_ethtool_sset(&pegasus->mii, ecmd);
-}
+ }
-static int pegasus_nway_reset(struct net_device *dev)
-{
- pegasus_t *pegasus = netdev_priv(dev);
- return mii_nway_restart(&pegasus->mii);
-}
+ return -EOPNOTSUPP;
-static u32 pegasus_get_link(struct net_device *dev)
-{
- pegasus_t *pegasus = netdev_priv(dev);
- return mii_link_ok(&pegasus->mii);
}
-
-static u32 pegasus_get_msglevel(struct net_device *dev)
+#else
+static int pegasus_ethtool_ioctl(struct net_device *net, void __user *uaddr)
{
- pegasus_t *pegasus = netdev_priv(dev);
- return pegasus->msg_level;
-}
+ pegasus_t *pegasus;
+ int cmd;
-static void pegasus_set_msglevel(struct net_device *dev, u32 v)
-{
- pegasus_t *pegasus = netdev_priv(dev);
- pegasus->msg_level = v;
+ pegasus = net->priv;
+ if (get_user(cmd, (int __user *) uaddr))
+ return -EFAULT;
+ switch (cmd) {
+ case ETHTOOL_GDRVINFO:{
+ struct ethtool_drvinfo info;
+ memset (&info, 0, sizeof (info));
+ info.cmd = ETHTOOL_GDRVINFO;
+ strncpy(info.driver, driver_name,
+ sizeof (info.driver) - 1);
+ strncpy(info.version, DRIVER_VERSION,
+ sizeof (info.version) - 1);
+ usb_make_path(pegasus->usb, info.bus_info,
+ sizeof (info.bus_info));
+ if (copy_to_user(uaddr, &info, sizeof (info)))
+ return -EFAULT;
+ return 0;
+ }
+ case ETHTOOL_GSET:{
+ struct ethtool_cmd ecmd;
+ short lpa, bmcr;
+ u8 port;
+
+ memset(&ecmd, 0, sizeof (ecmd));
+ ecmd.supported = (SUPPORTED_10baseT_Half |
+ SUPPORTED_10baseT_Full |
+ SUPPORTED_100baseT_Half |
+ SUPPORTED_100baseT_Full |
+ SUPPORTED_Autoneg |
+ SUPPORTED_TP | SUPPORTED_MII);
+ get_registers(pegasus, Reg7b, 1, &port);
+ if (port == 0)
+ ecmd.port = PORT_MII;
+ else
+ ecmd.port = PORT_TP;
+ ecmd.transceiver = XCVR_INTERNAL;
+ ecmd.phy_address = pegasus->phy;
+ read_mii_word(pegasus, pegasus->phy, MII_BMCR, &bmcr);
+ read_mii_word(pegasus, pegasus->phy, MII_LPA, &lpa);
+ if (bmcr & BMCR_ANENABLE) {
+ ecmd.autoneg = AUTONEG_ENABLE;
+ ecmd.speed = lpa & (LPA_100HALF | LPA_100FULL) ?
+ SPEED_100 : SPEED_10;
+ if (ecmd.speed == SPEED_100)
+ ecmd.duplex = lpa & LPA_100FULL ?
+ DUPLEX_FULL : DUPLEX_HALF;
+ else
+ ecmd.duplex = lpa & LPA_10FULL ?
+ DUPLEX_FULL : DUPLEX_HALF;
+ } else {
+ ecmd.autoneg = AUTONEG_DISABLE;
+ ecmd.speed = bmcr & BMCR_SPEED100 ?
+ SPEED_100 : SPEED_10;
+ ecmd.duplex = bmcr & BMCR_FULLDPLX ?
+ DUPLEX_FULL : DUPLEX_HALF;
+ }
+ if (copy_to_user(uaddr, &ecmd, sizeof (ecmd)))
+ return -EFAULT;
+
+ return 0;
+ }
+ case ETHTOOL_SSET:{
+ return -EOPNOTSUPP;
+ }
+ case ETHTOOL_GLINK:{
+ struct ethtool_value edata = { ETHTOOL_GLINK };
+ edata.data = netif_carrier_ok(net);
+ if (copy_to_user(uaddr, &edata, sizeof (edata)))
+ return -EFAULT;
+ return 0;
+ }
+ default:
+ return -EOPNOTSUPP;
+ }
}
-
-static struct ethtool_ops ops = {
- .get_drvinfo = pegasus_get_drvinfo,
- .get_settings = pegasus_get_settings,
- .set_settings = pegasus_set_settings,
- .nway_reset = pegasus_nway_reset,
- .get_link = pegasus_get_link,
- .get_msglevel = pegasus_get_msglevel,
- .set_msglevel = pegasus_set_msglevel,
- .get_wol = pegasus_get_wol,
- .set_wol = pegasus_set_wol,
-};
-
+#endif
static int pegasus_ioctl(struct net_device *net, struct ifreq *rq, int cmd)
{
__u16 *data = (__u16 *) & rq->ifr_ifru;
- pegasus_t *pegasus = netdev_priv(net);
+ pegasus_t *pegasus = net->priv;
int res;
switch (cmd) {
+ case SIOCETHTOOL:
+ res = pegasus_ethtool_ioctl(net, rq->ifr_data);
+ break;
case SIOCDEVPRIVATE:
data[0] = pegasus->phy;
case SIOCDEVPRIVATE + 1:
static void pegasus_set_multicast(struct net_device *net)
{
- pegasus_t *pegasus = netdev_priv(net);
+ pegasus_t *pegasus = net->priv;
if (net->flags & IFF_PROMISC) {
pegasus->eth_regs[EthCtrl2] |= RX_PROMISCUOUS;
- pr_info("%s: Promiscuous mode enabled.\n", net->name);
+ info("%s: Promiscuous mode enabled", net->name);
} else if ((net->mc_count > multicast_filter_limit) ||
(net->flags & IFF_ALLMULTI)) {
pegasus->eth_regs[EthCtrl0] |= RX_MULTICAST;
pegasus->eth_regs[EthCtrl2] &= ~RX_PROMISCUOUS;
- pr_info("%s: set allmulti\n", net->name);
+ info("%s set allmulti", net->name);
} else {
pegasus->eth_regs[EthCtrl0] &= ~RX_MULTICAST;
pegasus->eth_regs[EthCtrl2] &= ~RX_PROMISCUOUS;
static inline void setup_pegasus_II(pegasus_t * pegasus)
{
- __u8 data = 0xa5;
+ u16 data = 0xa5;
set_register(pegasus, Reg1d, 0);
set_register(pegasus, Reg7b, 1);
int res = -ENOMEM;
usb_get_dev(dev);
- net = alloc_etherdev(sizeof(struct pegasus));
- if (!net) {
+ if (!(pegasus = kmalloc(sizeof (struct pegasus), GFP_KERNEL))) {
err("out of memory allocating device structure");
goto out;
}
- pegasus = netdev_priv(net);
memset(pegasus, 0, sizeof (struct pegasus));
pegasus->dev_index = dev_index;
init_waitqueue_head(&pegasus->ctrl_wait);
if (!alloc_urbs(pegasus))
goto out1;
+ net = alloc_etherdev(0);
+ if (!net)
+ goto out2;
+
tasklet_init(&pegasus->rx_tl, rx_fixup, (unsigned long) pegasus);
pegasus->usb = dev;
pegasus->net = net;
SET_MODULE_OWNER(net);
+ net->priv = pegasus;
net->open = pegasus_open;
net->stop = pegasus_close;
net->watchdog_timeo = PEGASUS_TX_TIMEOUT;
net->hard_start_xmit = pegasus_start_xmit;
net->set_multicast_list = pegasus_set_multicast;
net->get_stats = pegasus_netdev_stats;
- SET_ETHTOOL_OPS(net, &ops);
+ net->mtu = PEGASUS_MTU;
pegasus->mii.dev = net;
pegasus->mii.mdio_read = mdio_read;
pegasus->mii.mdio_write = mdio_write;
pegasus->features = usb_dev_id[dev_index].private;
get_interrupt_interval(pegasus);
if (reset_mac(pegasus)) {
- dev_err(&intf->dev, "can't reset MAC\n");
+ err("can't reset MAC");
res = -EIO;
- goto out2;
+ goto out3;
}
set_ethernet_addr(pegasus);
fill_skb_pool(pegasus);
if (pegasus->features & PEGASUS_II) {
- dev_info(&intf->dev, "setup Pegasus II specific registers\n");
+ info("setup Pegasus II specific registers");
setup_pegasus_II(pegasus);
}
pegasus->phy = mii_phy_probe(pegasus);
if (pegasus->phy == 0xff) {
- dev_warn(&intf->dev, "can't locate MII phy, using default\n");
+ warn("can't locate MII phy, using default");
pegasus->phy = 1;
}
usb_set_intfdata(intf, pegasus);
SET_NETDEV_DEV(net, &intf->dev);
- pegasus_reset_wol(net);
res = register_netdev(net);
if (res)
- goto out3;
- pr_info("%s: %s\n", net->name, usb_dev_id[dev_index].name);
+ goto out4;
+ printk("%s: %s\n", net->name, usb_dev_id[dev_index].name);
return 0;
-out3:
+out4:
usb_set_intfdata(intf, NULL);
free_skb_pool(pegasus);
+out3:
+ free_netdev(net);
out2:
free_all_urbs(pegasus);
out1:
- free_netdev(net);
+ kfree(pegasus);
out:
usb_put_dev(dev);
return res;
if (pegasus->rx_skb)
dev_kfree_skb(pegasus->rx_skb);
free_netdev(pegasus->net);
-}
-
-static int pegasus_suspend (struct usb_interface *intf, u32 state)
-{
- struct pegasus *pegasus = usb_get_intfdata(intf);
-
- netif_device_detach (pegasus->net);
- return 0;
-}
-
-static int pegasus_resume (struct usb_interface *intf)
-{
- struct pegasus *pegasus = usb_get_intfdata(intf);
-
- netif_device_attach (pegasus->net);
- return 0;
+ kfree(pegasus);
}
static struct usb_driver pegasus_driver = {
.probe = pegasus_probe,
.disconnect = pegasus_disconnect,
.id_table = pegasus_ids,
- .suspend = pegasus_suspend,
- .resume = pegasus_resume,
};
static int __init pegasus_init(void)
{
- pr_info("%s: %s, " DRIVER_DESC "\n", driver_name, DRIVER_VERSION);
+ info(DRIVER_VERSION ":" DRIVER_DESC);
return usb_register(&pegasus_driver);
}
git://git.onelab.eu / linux-2.6.git / blobdiff