xref: /openbmc/linux/drivers/net/usb/pegasus.c (revision 313a58e487ab3eb80e7e1f9baddc75968288aad9)
15b2fc499SJeff Garzik /*
25b2fc499SJeff Garzik  *  Copyright (c) 1999-2005 Petko Manolov (petkan@users.sourceforge.net)
35b2fc499SJeff Garzik  *
45b2fc499SJeff Garzik  * This program is free software; you can redistribute it and/or modify
55b2fc499SJeff Garzik  * it under the terms of the GNU General Public License version 2 as
65b2fc499SJeff Garzik  * published by the Free Software Foundation.
75b2fc499SJeff Garzik  *
85b2fc499SJeff Garzik  *	ChangeLog:
95b2fc499SJeff Garzik  *		....	Most of the time spent on reading sources & docs.
105b2fc499SJeff Garzik  *		v0.2.x	First official release for the Linux kernel.
115b2fc499SJeff Garzik  *		v0.3.0	Beutified and structured, some bugs fixed.
125b2fc499SJeff Garzik  *		v0.3.x	URBifying bulk requests and bugfixing. First relatively
135b2fc499SJeff Garzik  *			stable release. Still can touch device's registers only
145b2fc499SJeff Garzik  *			from top-halves.
155b2fc499SJeff Garzik  *		v0.4.0	Control messages remained unurbified are now URBs.
165b2fc499SJeff Garzik  *			Now we can touch the HW at any time.
175b2fc499SJeff Garzik  *		v0.4.9	Control urbs again use process context to wait. Argh...
185b2fc499SJeff Garzik  *			Some long standing bugs (enable_net_traffic) fixed.
195b2fc499SJeff Garzik  *			Also nasty trick about resubmiting control urb from
205b2fc499SJeff Garzik  *			interrupt context used. Please let me know how it
215b2fc499SJeff Garzik  *			behaves. Pegasus II support added since this version.
225b2fc499SJeff Garzik  *			TODO: suppressing HCD warnings spewage on disconnect.
235b2fc499SJeff Garzik  *		v0.4.13	Ethernet address is now set at probe(), not at open()
245b2fc499SJeff Garzik  *			time as this seems to break dhcpd.
255b2fc499SJeff Garzik  *		v0.5.0	branch to 2.5.x kernels
265b2fc499SJeff Garzik  *		v0.5.1	ethtool support added
275b2fc499SJeff Garzik  *		v0.5.5	rx socket buffers are in a pool and the their allocation
285b2fc499SJeff Garzik  *			is out of the interrupt routine.
295b2fc499SJeff Garzik  */
305b2fc499SJeff Garzik 
315b2fc499SJeff Garzik #include <linux/sched.h>
325b2fc499SJeff Garzik #include <linux/slab.h>
335b2fc499SJeff Garzik #include <linux/init.h>
345b2fc499SJeff Garzik #include <linux/delay.h>
355b2fc499SJeff Garzik #include <linux/netdevice.h>
365b2fc499SJeff Garzik #include <linux/etherdevice.h>
375b2fc499SJeff Garzik #include <linux/ethtool.h>
385b2fc499SJeff Garzik #include <linux/mii.h>
395b2fc499SJeff Garzik #include <linux/usb.h>
405b2fc499SJeff Garzik #include <linux/module.h>
415b2fc499SJeff Garzik #include <asm/byteorder.h>
425b2fc499SJeff Garzik #include <asm/uaccess.h>
435b2fc499SJeff Garzik #include "pegasus.h"
445b2fc499SJeff Garzik 
455b2fc499SJeff Garzik /*
465b2fc499SJeff Garzik  * Version Information
475b2fc499SJeff Garzik  */
485b2fc499SJeff Garzik #define DRIVER_VERSION "v0.6.14 (2006/09/27)"
495b2fc499SJeff Garzik #define DRIVER_AUTHOR "Petko Manolov <petkan@users.sourceforge.net>"
505b2fc499SJeff Garzik #define DRIVER_DESC "Pegasus/Pegasus II USB Ethernet driver"
515b2fc499SJeff Garzik 
525b2fc499SJeff Garzik static const char driver_name[] = "pegasus";
535b2fc499SJeff Garzik 
545b2fc499SJeff Garzik #undef	PEGASUS_WRITE_EEPROM
555b2fc499SJeff Garzik #define	BMSR_MEDIA	(BMSR_10HALF | BMSR_10FULL | BMSR_100HALF | \
565b2fc499SJeff Garzik 			BMSR_100FULL | BMSR_ANEGCAPABLE)
575b2fc499SJeff Garzik 
58eb939922SRusty Russell static bool loopback;
59eb939922SRusty Russell static bool mii_mode;
605a9dbfe0SNicolas Kaiser static char *devid;
615b2fc499SJeff Garzik 
625b2fc499SJeff Garzik static struct usb_eth_dev usb_dev_id[] = {
635b2fc499SJeff Garzik #define	PEGASUS_DEV(pn, vid, pid, flags)	\
645b2fc499SJeff Garzik 	{.name = pn, .vendor = vid, .device = pid, .private = flags},
65ab854b24SChris Rankin #define PEGASUS_DEV_CLASS(pn, vid, pid, dclass, flags) \
66ab854b24SChris Rankin 	PEGASUS_DEV(pn, vid, pid, flags)
675b2fc499SJeff Garzik #include "pegasus.h"
685b2fc499SJeff Garzik #undef	PEGASUS_DEV
69ab854b24SChris Rankin #undef	PEGASUS_DEV_CLASS
705b2fc499SJeff Garzik 	{NULL, 0, 0, 0},
715b2fc499SJeff Garzik 	{NULL, 0, 0, 0}
725b2fc499SJeff Garzik };
735b2fc499SJeff Garzik 
745b2fc499SJeff Garzik static struct usb_device_id pegasus_ids[] = {
755b2fc499SJeff Garzik #define	PEGASUS_DEV(pn, vid, pid, flags) \
765b2fc499SJeff Garzik 	{.match_flags = USB_DEVICE_ID_MATCH_DEVICE, .idVendor = vid, .idProduct = pid},
77ab854b24SChris Rankin /*
78ab854b24SChris Rankin  * The Belkin F8T012xx1 bluetooth adaptor has the same vendor and product
79ab854b24SChris Rankin  * IDs as the Belkin F5D5050, so we need to teach the pegasus driver to
80ab854b24SChris Rankin  * ignore adaptors belonging to the "Wireless" class 0xE0. For this one
81ab854b24SChris Rankin  * case anyway, seeing as the pegasus is for "Wired" adaptors.
82ab854b24SChris Rankin  */
83ab854b24SChris Rankin #define PEGASUS_DEV_CLASS(pn, vid, pid, dclass, flags) \
84ab854b24SChris Rankin 	{.match_flags = (USB_DEVICE_ID_MATCH_DEVICE | USB_DEVICE_ID_MATCH_DEV_CLASS), \
85ab854b24SChris Rankin 	.idVendor = vid, .idProduct = pid, .bDeviceClass = dclass},
865b2fc499SJeff Garzik #include "pegasus.h"
875b2fc499SJeff Garzik #undef	PEGASUS_DEV
88ab854b24SChris Rankin #undef	PEGASUS_DEV_CLASS
895b2fc499SJeff Garzik 	{},
905b2fc499SJeff Garzik 	{}
915b2fc499SJeff Garzik };
925b2fc499SJeff Garzik 
935b2fc499SJeff Garzik MODULE_AUTHOR(DRIVER_AUTHOR);
945b2fc499SJeff Garzik MODULE_DESCRIPTION(DRIVER_DESC);
955b2fc499SJeff Garzik MODULE_LICENSE("GPL");
965b2fc499SJeff Garzik module_param(loopback, bool, 0);
975b2fc499SJeff Garzik module_param(mii_mode, bool, 0);
985b2fc499SJeff Garzik module_param(devid, charp, 0);
995b2fc499SJeff Garzik MODULE_PARM_DESC(loopback, "Enable MAC loopback mode (bit 0)");
1005b2fc499SJeff Garzik MODULE_PARM_DESC(mii_mode, "Enable HomePNA mode (bit 0),default=MII mode = 0");
1015b2fc499SJeff Garzik MODULE_PARM_DESC(devid, "The format is: 'DEV_name:VendorID:DeviceID:Flags'");
1025b2fc499SJeff Garzik 
1035b2fc499SJeff Garzik /* use ethtool to change the level for any given device */
1045b2fc499SJeff Garzik static int msg_level = -1;
1055b2fc499SJeff Garzik module_param(msg_level, int, 0);
1065b2fc499SJeff Garzik MODULE_PARM_DESC(msg_level, "Override default message level");
1075b2fc499SJeff Garzik 
1085b2fc499SJeff Garzik MODULE_DEVICE_TABLE(usb, pegasus_ids);
1098cb89571SOliver Neukum static const struct net_device_ops pegasus_netdev_ops;
1105b2fc499SJeff Garzik 
1115b2fc499SJeff Garzik static int update_eth_regs_async(pegasus_t *);
1125b2fc499SJeff Garzik /* Aargh!!! I _really_ hate such tweaks */
1135b2fc499SJeff Garzik static void ctrl_callback(struct urb *urb)
1145b2fc499SJeff Garzik {
1155b2fc499SJeff Garzik 	pegasus_t *pegasus = urb->context;
116c94cb314SOliver Neukum 	int status = urb->status;
1175b2fc499SJeff Garzik 
1185b2fc499SJeff Garzik 	if (!pegasus)
1195b2fc499SJeff Garzik 		return;
1205b2fc499SJeff Garzik 
121c94cb314SOliver Neukum 	switch (status) {
1225b2fc499SJeff Garzik 	case 0:
1235b2fc499SJeff Garzik 		if (pegasus->flags & ETH_REGS_CHANGE) {
1245b2fc499SJeff Garzik 			pegasus->flags &= ~ETH_REGS_CHANGE;
1255b2fc499SJeff Garzik 			pegasus->flags |= ETH_REGS_CHANGED;
1265b2fc499SJeff Garzik 			update_eth_regs_async(pegasus);
1275b2fc499SJeff Garzik 			return;
1285b2fc499SJeff Garzik 		}
1295b2fc499SJeff Garzik 		break;
1305b2fc499SJeff Garzik 	case -EINPROGRESS:
1315b2fc499SJeff Garzik 		return;
1325b2fc499SJeff Garzik 	case -ENOENT:
1335b2fc499SJeff Garzik 		break;
1345b2fc499SJeff Garzik 	default:
135a475f603SJoe Perches 		if (net_ratelimit())
136a475f603SJoe Perches 			netif_dbg(pegasus, drv, pegasus->net,
137a475f603SJoe Perches 				  "%s, status %d\n", __func__, status);
138a475f603SJoe Perches 		break;
1395b2fc499SJeff Garzik 	}
1405b2fc499SJeff Garzik 	pegasus->flags &= ~ETH_REGS_CHANGED;
1415b2fc499SJeff Garzik 	wake_up(&pegasus->ctrl_wait);
1425b2fc499SJeff Garzik }
1435b2fc499SJeff Garzik 
1445b2fc499SJeff Garzik static int get_registers(pegasus_t *pegasus, __u16 indx, __u16 size,
1455b2fc499SJeff Garzik 			 void *data)
1465b2fc499SJeff Garzik {
1475b2fc499SJeff Garzik 	int ret;
1485b2fc499SJeff Garzik 	char *buffer;
1495b2fc499SJeff Garzik 	DECLARE_WAITQUEUE(wait, current);
1505b2fc499SJeff Garzik 
1515b2fc499SJeff Garzik 	buffer = kmalloc(size, GFP_KERNEL);
15214f8dc49SJoe Perches 	if (!buffer)
1535b2fc499SJeff Garzik 		return -ENOMEM;
15414f8dc49SJoe Perches 
1555b2fc499SJeff Garzik 	add_wait_queue(&pegasus->ctrl_wait, &wait);
1565b2fc499SJeff Garzik 	set_current_state(TASK_UNINTERRUPTIBLE);
1575b2fc499SJeff Garzik 	while (pegasus->flags & ETH_REGS_CHANGED)
1585b2fc499SJeff Garzik 		schedule();
1595b2fc499SJeff Garzik 	remove_wait_queue(&pegasus->ctrl_wait, &wait);
1605b2fc499SJeff Garzik 	set_current_state(TASK_RUNNING);
1615b2fc499SJeff Garzik 
1625b2fc499SJeff Garzik 	pegasus->dr.bRequestType = PEGASUS_REQT_READ;
1635b2fc499SJeff Garzik 	pegasus->dr.bRequest = PEGASUS_REQ_GET_REGS;
1645b2fc499SJeff Garzik 	pegasus->dr.wValue = cpu_to_le16(0);
165da2bbdccSHarvey Harrison 	pegasus->dr.wIndex = cpu_to_le16(indx);
166da2bbdccSHarvey Harrison 	pegasus->dr.wLength = cpu_to_le16(size);
1675b2fc499SJeff Garzik 	pegasus->ctrl_urb->transfer_buffer_length = size;
1685b2fc499SJeff Garzik 
1695b2fc499SJeff Garzik 	usb_fill_control_urb(pegasus->ctrl_urb, pegasus->usb,
1705b2fc499SJeff Garzik 			     usb_rcvctrlpipe(pegasus->usb, 0),
1715b2fc499SJeff Garzik 			     (char *) &pegasus->dr,
1725b2fc499SJeff Garzik 			     buffer, size, ctrl_callback, pegasus);
1735b2fc499SJeff Garzik 
1745b2fc499SJeff Garzik 	add_wait_queue(&pegasus->ctrl_wait, &wait);
1755b2fc499SJeff Garzik 	set_current_state(TASK_UNINTERRUPTIBLE);
1765b2fc499SJeff Garzik 
1775b2fc499SJeff Garzik 	/* using ATOMIC, we'd never wake up if we slept */
1785b2fc499SJeff Garzik 	if ((ret = usb_submit_urb(pegasus->ctrl_urb, GFP_ATOMIC))) {
1795b2fc499SJeff Garzik 		set_current_state(TASK_RUNNING);
1805b2fc499SJeff Garzik 		if (ret == -ENODEV)
1815b2fc499SJeff Garzik 			netif_device_detach(pegasus->net);
182a475f603SJoe Perches 		if (net_ratelimit())
183a475f603SJoe Perches 			netif_err(pegasus, drv, pegasus->net,
184a475f603SJoe Perches 				  "%s, status %d\n", __func__, ret);
1855b2fc499SJeff Garzik 		goto out;
1865b2fc499SJeff Garzik 	}
1875b2fc499SJeff Garzik 
1885b2fc499SJeff Garzik 	schedule();
1895b2fc499SJeff Garzik out:
1905b2fc499SJeff Garzik 	remove_wait_queue(&pegasus->ctrl_wait, &wait);
1915b2fc499SJeff Garzik 	memcpy(data, buffer, size);
1925b2fc499SJeff Garzik 	kfree(buffer);
1935b2fc499SJeff Garzik 
1945b2fc499SJeff Garzik 	return ret;
1955b2fc499SJeff Garzik }
1965b2fc499SJeff Garzik 
1975b2fc499SJeff Garzik static int set_registers(pegasus_t *pegasus, __u16 indx, __u16 size,
1985b2fc499SJeff Garzik 			 void *data)
1995b2fc499SJeff Garzik {
2005b2fc499SJeff Garzik 	int ret;
2015b2fc499SJeff Garzik 	char *buffer;
2025b2fc499SJeff Garzik 	DECLARE_WAITQUEUE(wait, current);
2035b2fc499SJeff Garzik 
204175c0441SJulia Lawall 	buffer = kmemdup(data, size, GFP_KERNEL);
2055b2fc499SJeff Garzik 	if (!buffer) {
206a475f603SJoe Perches 		netif_warn(pegasus, drv, pegasus->net,
207a475f603SJoe Perches 			   "out of memory in %s\n", __func__);
2085b2fc499SJeff Garzik 		return -ENOMEM;
2095b2fc499SJeff Garzik 	}
2105b2fc499SJeff Garzik 
2115b2fc499SJeff Garzik 	add_wait_queue(&pegasus->ctrl_wait, &wait);
2125b2fc499SJeff Garzik 	set_current_state(TASK_UNINTERRUPTIBLE);
2135b2fc499SJeff Garzik 	while (pegasus->flags & ETH_REGS_CHANGED)
2145b2fc499SJeff Garzik 		schedule();
2155b2fc499SJeff Garzik 	remove_wait_queue(&pegasus->ctrl_wait, &wait);
2165b2fc499SJeff Garzik 	set_current_state(TASK_RUNNING);
2175b2fc499SJeff Garzik 
2185b2fc499SJeff Garzik 	pegasus->dr.bRequestType = PEGASUS_REQT_WRITE;
2195b2fc499SJeff Garzik 	pegasus->dr.bRequest = PEGASUS_REQ_SET_REGS;
2205b2fc499SJeff Garzik 	pegasus->dr.wValue = cpu_to_le16(0);
221da2bbdccSHarvey Harrison 	pegasus->dr.wIndex = cpu_to_le16(indx);
222da2bbdccSHarvey Harrison 	pegasus->dr.wLength = cpu_to_le16(size);
2235b2fc499SJeff Garzik 	pegasus->ctrl_urb->transfer_buffer_length = size;
2245b2fc499SJeff Garzik 
2255b2fc499SJeff Garzik 	usb_fill_control_urb(pegasus->ctrl_urb, pegasus->usb,
2265b2fc499SJeff Garzik 			     usb_sndctrlpipe(pegasus->usb, 0),
2275b2fc499SJeff Garzik 			     (char *) &pegasus->dr,
2285b2fc499SJeff Garzik 			     buffer, size, ctrl_callback, pegasus);
2295b2fc499SJeff Garzik 
2305b2fc499SJeff Garzik 	add_wait_queue(&pegasus->ctrl_wait, &wait);
2315b2fc499SJeff Garzik 	set_current_state(TASK_UNINTERRUPTIBLE);
2325b2fc499SJeff Garzik 
2335b2fc499SJeff Garzik 	if ((ret = usb_submit_urb(pegasus->ctrl_urb, GFP_ATOMIC))) {
2345b2fc499SJeff Garzik 		if (ret == -ENODEV)
2355b2fc499SJeff Garzik 			netif_device_detach(pegasus->net);
236a475f603SJoe Perches 		netif_err(pegasus, drv, pegasus->net,
237a475f603SJoe Perches 			  "%s, status %d\n", __func__, ret);
2385b2fc499SJeff Garzik 		goto out;
2395b2fc499SJeff Garzik 	}
2405b2fc499SJeff Garzik 
2415b2fc499SJeff Garzik 	schedule();
2425b2fc499SJeff Garzik out:
2435b2fc499SJeff Garzik 	remove_wait_queue(&pegasus->ctrl_wait, &wait);
2445b2fc499SJeff Garzik 	kfree(buffer);
2455b2fc499SJeff Garzik 
2465b2fc499SJeff Garzik 	return ret;
2475b2fc499SJeff Garzik }
2485b2fc499SJeff Garzik 
2495b2fc499SJeff Garzik static int set_register(pegasus_t *pegasus, __u16 indx, __u8 data)
2505b2fc499SJeff Garzik {
2515b2fc499SJeff Garzik 	int ret;
2525b2fc499SJeff Garzik 	char *tmp;
2535b2fc499SJeff Garzik 	DECLARE_WAITQUEUE(wait, current);
2545b2fc499SJeff Garzik 
255175c0441SJulia Lawall 	tmp = kmemdup(&data, 1, GFP_KERNEL);
2565b2fc499SJeff Garzik 	if (!tmp) {
257a475f603SJoe Perches 		netif_warn(pegasus, drv, pegasus->net,
258a475f603SJoe Perches 			   "out of memory in %s\n", __func__);
2595b2fc499SJeff Garzik 		return -ENOMEM;
2605b2fc499SJeff Garzik 	}
2615b2fc499SJeff Garzik 	add_wait_queue(&pegasus->ctrl_wait, &wait);
2625b2fc499SJeff Garzik 	set_current_state(TASK_UNINTERRUPTIBLE);
2635b2fc499SJeff Garzik 	while (pegasus->flags & ETH_REGS_CHANGED)
2645b2fc499SJeff Garzik 		schedule();
2655b2fc499SJeff Garzik 	remove_wait_queue(&pegasus->ctrl_wait, &wait);
2665b2fc499SJeff Garzik 	set_current_state(TASK_RUNNING);
2675b2fc499SJeff Garzik 
2685b2fc499SJeff Garzik 	pegasus->dr.bRequestType = PEGASUS_REQT_WRITE;
2695b2fc499SJeff Garzik 	pegasus->dr.bRequest = PEGASUS_REQ_SET_REG;
2705b2fc499SJeff Garzik 	pegasus->dr.wValue = cpu_to_le16(data);
271da2bbdccSHarvey Harrison 	pegasus->dr.wIndex = cpu_to_le16(indx);
2725b2fc499SJeff Garzik 	pegasus->dr.wLength = cpu_to_le16(1);
2735b2fc499SJeff Garzik 	pegasus->ctrl_urb->transfer_buffer_length = 1;
2745b2fc499SJeff Garzik 
2755b2fc499SJeff Garzik 	usb_fill_control_urb(pegasus->ctrl_urb, pegasus->usb,
2765b2fc499SJeff Garzik 			     usb_sndctrlpipe(pegasus->usb, 0),
2775b2fc499SJeff Garzik 			     (char *) &pegasus->dr,
2785b2fc499SJeff Garzik 			     tmp, 1, ctrl_callback, pegasus);
2795b2fc499SJeff Garzik 
2805b2fc499SJeff Garzik 	add_wait_queue(&pegasus->ctrl_wait, &wait);
2815b2fc499SJeff Garzik 	set_current_state(TASK_UNINTERRUPTIBLE);
2825b2fc499SJeff Garzik 
2835b2fc499SJeff Garzik 	if ((ret = usb_submit_urb(pegasus->ctrl_urb, GFP_ATOMIC))) {
2845b2fc499SJeff Garzik 		if (ret == -ENODEV)
2855b2fc499SJeff Garzik 			netif_device_detach(pegasus->net);
286a475f603SJoe Perches 		if (net_ratelimit())
287a475f603SJoe Perches 			netif_err(pegasus, drv, pegasus->net,
288a475f603SJoe Perches 				  "%s, status %d\n", __func__, ret);
2895b2fc499SJeff Garzik 		goto out;
2905b2fc499SJeff Garzik 	}
2915b2fc499SJeff Garzik 
2925b2fc499SJeff Garzik 	schedule();
2935b2fc499SJeff Garzik out:
2945b2fc499SJeff Garzik 	remove_wait_queue(&pegasus->ctrl_wait, &wait);
2955b2fc499SJeff Garzik 	kfree(tmp);
2965b2fc499SJeff Garzik 
2975b2fc499SJeff Garzik 	return ret;
2985b2fc499SJeff Garzik }
2995b2fc499SJeff Garzik 
3005b2fc499SJeff Garzik static int update_eth_regs_async(pegasus_t *pegasus)
3015b2fc499SJeff Garzik {
3025b2fc499SJeff Garzik 	int ret;
3035b2fc499SJeff Garzik 
3045b2fc499SJeff Garzik 	pegasus->dr.bRequestType = PEGASUS_REQT_WRITE;
3055b2fc499SJeff Garzik 	pegasus->dr.bRequest = PEGASUS_REQ_SET_REGS;
306e3453f63SMichael Buesch 	pegasus->dr.wValue = cpu_to_le16(0);
3075b2fc499SJeff Garzik 	pegasus->dr.wIndex = cpu_to_le16(EthCtrl0);
3085b2fc499SJeff Garzik 	pegasus->dr.wLength = cpu_to_le16(3);
3095b2fc499SJeff Garzik 	pegasus->ctrl_urb->transfer_buffer_length = 3;
3105b2fc499SJeff Garzik 
3115b2fc499SJeff Garzik 	usb_fill_control_urb(pegasus->ctrl_urb, pegasus->usb,
3125b2fc499SJeff Garzik 			     usb_sndctrlpipe(pegasus->usb, 0),
3135b2fc499SJeff Garzik 			     (char *) &pegasus->dr,
3145b2fc499SJeff Garzik 			     pegasus->eth_regs, 3, ctrl_callback, pegasus);
3155b2fc499SJeff Garzik 
3165b2fc499SJeff Garzik 	if ((ret = usb_submit_urb(pegasus->ctrl_urb, GFP_ATOMIC))) {
3175b2fc499SJeff Garzik 		if (ret == -ENODEV)
3185b2fc499SJeff Garzik 			netif_device_detach(pegasus->net);
319a475f603SJoe Perches 		netif_err(pegasus, drv, pegasus->net,
320a475f603SJoe Perches 			  "%s, status %d\n", __func__, ret);
3215b2fc499SJeff Garzik 	}
3225b2fc499SJeff Garzik 
3235b2fc499SJeff Garzik 	return ret;
3245b2fc499SJeff Garzik }
3255b2fc499SJeff Garzik 
3265b2fc499SJeff Garzik /* Returns 0 on success, error on failure */
3275b2fc499SJeff Garzik static int read_mii_word(pegasus_t *pegasus, __u8 phy, __u8 indx, __u16 *regd)
3285b2fc499SJeff Garzik {
3295b2fc499SJeff Garzik 	int i;
3305b2fc499SJeff Garzik 	__u8 data[4] = { phy, 0, 0, indx };
3315b2fc499SJeff Garzik 	__le16 regdi;
3325b2fc499SJeff Garzik 	int ret;
3335b2fc499SJeff Garzik 
3345b2fc499SJeff Garzik 	set_register(pegasus, PhyCtrl, 0);
3355b2fc499SJeff Garzik 	set_registers(pegasus, PhyAddr, sizeof(data), data);
3365b2fc499SJeff Garzik 	set_register(pegasus, PhyCtrl, (indx | PHY_READ));
3375b2fc499SJeff Garzik 	for (i = 0; i < REG_TIMEOUT; i++) {
3385b2fc499SJeff Garzik 		ret = get_registers(pegasus, PhyCtrl, 1, data);
3395b2fc499SJeff Garzik 		if (ret == -ESHUTDOWN)
3405b2fc499SJeff Garzik 			goto fail;
3415b2fc499SJeff Garzik 		if (data[0] & PHY_DONE)
3425b2fc499SJeff Garzik 			break;
3435b2fc499SJeff Garzik 	}
344a475f603SJoe Perches 
345a475f603SJoe Perches 	if (i >= REG_TIMEOUT)
346a475f603SJoe Perches 		goto fail;
347a475f603SJoe Perches 
3485b2fc499SJeff Garzik 	ret = get_registers(pegasus, PhyData, 2, &regdi);
3495b2fc499SJeff Garzik 	*regd = le16_to_cpu(regdi);
3505b2fc499SJeff Garzik 	return ret;
351a475f603SJoe Perches 
3525b2fc499SJeff Garzik fail:
353a475f603SJoe Perches 	netif_warn(pegasus, drv, pegasus->net, "%s failed\n", __func__);
3545b2fc499SJeff Garzik 
3555b2fc499SJeff Garzik 	return ret;
3565b2fc499SJeff Garzik }
3575b2fc499SJeff Garzik 
3585b2fc499SJeff Garzik static int mdio_read(struct net_device *dev, int phy_id, int loc)
3595b2fc499SJeff Garzik {
3608739cfefSJoe Perches 	pegasus_t *pegasus = netdev_priv(dev);
3615b2fc499SJeff Garzik 	u16 res;
3625b2fc499SJeff Garzik 
3635b2fc499SJeff Garzik 	read_mii_word(pegasus, phy_id, loc, &res);
3645b2fc499SJeff Garzik 	return (int)res;
3655b2fc499SJeff Garzik }
3665b2fc499SJeff Garzik 
3675b2fc499SJeff Garzik static int write_mii_word(pegasus_t *pegasus, __u8 phy, __u8 indx, __u16 regd)
3685b2fc499SJeff Garzik {
3695b2fc499SJeff Garzik 	int i;
3705b2fc499SJeff Garzik 	__u8 data[4] = { phy, 0, 0, indx };
3715b2fc499SJeff Garzik 	int ret;
3725b2fc499SJeff Garzik 
3735b2fc499SJeff Garzik 	data[1] = (u8) regd;
3745b2fc499SJeff Garzik 	data[2] = (u8) (regd >> 8);
3755b2fc499SJeff Garzik 	set_register(pegasus, PhyCtrl, 0);
3765b2fc499SJeff Garzik 	set_registers(pegasus, PhyAddr, sizeof(data), data);
3775b2fc499SJeff Garzik 	set_register(pegasus, PhyCtrl, (indx | PHY_WRITE));
3785b2fc499SJeff Garzik 	for (i = 0; i < REG_TIMEOUT; i++) {
3795b2fc499SJeff Garzik 		ret = get_registers(pegasus, PhyCtrl, 1, data);
3805b2fc499SJeff Garzik 		if (ret == -ESHUTDOWN)
3815b2fc499SJeff Garzik 			goto fail;
3825b2fc499SJeff Garzik 		if (data[0] & PHY_DONE)
3835b2fc499SJeff Garzik 			break;
3845b2fc499SJeff Garzik 	}
385a475f603SJoe Perches 
386a475f603SJoe Perches 	if (i >= REG_TIMEOUT)
387a475f603SJoe Perches 		goto fail;
388a475f603SJoe Perches 
3895b2fc499SJeff Garzik 	return ret;
3905b2fc499SJeff Garzik 
3915b2fc499SJeff Garzik fail:
392a475f603SJoe Perches 	netif_warn(pegasus, drv, pegasus->net, "%s failed\n", __func__);
3935b2fc499SJeff Garzik 	return -ETIMEDOUT;
3945b2fc499SJeff Garzik }
3955b2fc499SJeff Garzik 
3965b2fc499SJeff Garzik static void mdio_write(struct net_device *dev, int phy_id, int loc, int val)
3975b2fc499SJeff Garzik {
3988739cfefSJoe Perches 	pegasus_t *pegasus = netdev_priv(dev);
3995b2fc499SJeff Garzik 
4005b2fc499SJeff Garzik 	write_mii_word(pegasus, phy_id, loc, val);
4015b2fc499SJeff Garzik }
4025b2fc499SJeff Garzik 
4035b2fc499SJeff Garzik static int read_eprom_word(pegasus_t *pegasus, __u8 index, __u16 *retdata)
4045b2fc499SJeff Garzik {
4055b2fc499SJeff Garzik 	int i;
4065b2fc499SJeff Garzik 	__u8 tmp;
4075b2fc499SJeff Garzik 	__le16 retdatai;
4085b2fc499SJeff Garzik 	int ret;
4095b2fc499SJeff Garzik 
4105b2fc499SJeff Garzik 	set_register(pegasus, EpromCtrl, 0);
4115b2fc499SJeff Garzik 	set_register(pegasus, EpromOffset, index);
4125b2fc499SJeff Garzik 	set_register(pegasus, EpromCtrl, EPROM_READ);
4135b2fc499SJeff Garzik 
4145b2fc499SJeff Garzik 	for (i = 0; i < REG_TIMEOUT; i++) {
4155b2fc499SJeff Garzik 		ret = get_registers(pegasus, EpromCtrl, 1, &tmp);
4165b2fc499SJeff Garzik 		if (tmp & EPROM_DONE)
4175b2fc499SJeff Garzik 			break;
4185b2fc499SJeff Garzik 		if (ret == -ESHUTDOWN)
4195b2fc499SJeff Garzik 			goto fail;
4205b2fc499SJeff Garzik 	}
421a475f603SJoe Perches 	if (i >= REG_TIMEOUT)
422a475f603SJoe Perches 		goto fail;
423a475f603SJoe Perches 
4245b2fc499SJeff Garzik 	ret = get_registers(pegasus, EpromData, 2, &retdatai);
4255b2fc499SJeff Garzik 	*retdata = le16_to_cpu(retdatai);
4265b2fc499SJeff Garzik 	return ret;
4275b2fc499SJeff Garzik 
4285b2fc499SJeff Garzik fail:
429a475f603SJoe Perches 	netif_warn(pegasus, drv, pegasus->net, "%s failed\n", __func__);
4305b2fc499SJeff Garzik 	return -ETIMEDOUT;
4315b2fc499SJeff Garzik }
4325b2fc499SJeff Garzik 
4335b2fc499SJeff Garzik #ifdef	PEGASUS_WRITE_EEPROM
4345b2fc499SJeff Garzik static inline void enable_eprom_write(pegasus_t *pegasus)
4355b2fc499SJeff Garzik {
4365b2fc499SJeff Garzik 	__u8 tmp;
4375b2fc499SJeff Garzik 	int ret;
4385b2fc499SJeff Garzik 
4395b2fc499SJeff Garzik 	get_registers(pegasus, EthCtrl2, 1, &tmp);
4405b2fc499SJeff Garzik 	set_register(pegasus, EthCtrl2, tmp | EPROM_WR_ENABLE);
4415b2fc499SJeff Garzik }
4425b2fc499SJeff Garzik 
4435b2fc499SJeff Garzik static inline void disable_eprom_write(pegasus_t *pegasus)
4445b2fc499SJeff Garzik {
4455b2fc499SJeff Garzik 	__u8 tmp;
4465b2fc499SJeff Garzik 	int ret;
4475b2fc499SJeff Garzik 
4485b2fc499SJeff Garzik 	get_registers(pegasus, EthCtrl2, 1, &tmp);
4495b2fc499SJeff Garzik 	set_register(pegasus, EpromCtrl, 0);
4505b2fc499SJeff Garzik 	set_register(pegasus, EthCtrl2, tmp & ~EPROM_WR_ENABLE);
4515b2fc499SJeff Garzik }
4525b2fc499SJeff Garzik 
4535b2fc499SJeff Garzik static int write_eprom_word(pegasus_t *pegasus, __u8 index, __u16 data)
4545b2fc499SJeff Garzik {
4555b2fc499SJeff Garzik 	int i;
4565b2fc499SJeff Garzik 	__u8 tmp, d[4] = { 0x3f, 0, 0, EPROM_WRITE };
4575b2fc499SJeff Garzik 	int ret;
458e3453f63SMichael Buesch 	__le16 le_data = cpu_to_le16(data);
4595b2fc499SJeff Garzik 
4605b2fc499SJeff Garzik 	set_registers(pegasus, EpromOffset, 4, d);
4615b2fc499SJeff Garzik 	enable_eprom_write(pegasus);
4625b2fc499SJeff Garzik 	set_register(pegasus, EpromOffset, index);
463e3453f63SMichael Buesch 	set_registers(pegasus, EpromData, 2, &le_data);
4645b2fc499SJeff Garzik 	set_register(pegasus, EpromCtrl, EPROM_WRITE);
4655b2fc499SJeff Garzik 
4665b2fc499SJeff Garzik 	for (i = 0; i < REG_TIMEOUT; i++) {
4675b2fc499SJeff Garzik 		ret = get_registers(pegasus, EpromCtrl, 1, &tmp);
4685b2fc499SJeff Garzik 		if (ret == -ESHUTDOWN)
4695b2fc499SJeff Garzik 			goto fail;
4705b2fc499SJeff Garzik 		if (tmp & EPROM_DONE)
4715b2fc499SJeff Garzik 			break;
4725b2fc499SJeff Garzik 	}
4735b2fc499SJeff Garzik 	disable_eprom_write(pegasus);
474a475f603SJoe Perches 	if (i >= REG_TIMEOUT)
475a475f603SJoe Perches 		goto fail;
476a475f603SJoe Perches 
4775b2fc499SJeff Garzik 	return ret;
478a475f603SJoe Perches 
4795b2fc499SJeff Garzik fail:
480a475f603SJoe Perches 	netif_warn(pegasus, drv, pegasus->net, "%s failed\n", __func__);
4815b2fc499SJeff Garzik 	return -ETIMEDOUT;
4825b2fc499SJeff Garzik }
4835b2fc499SJeff Garzik #endif				/* PEGASUS_WRITE_EEPROM */
4845b2fc499SJeff Garzik 
4855b2fc499SJeff Garzik static inline void get_node_id(pegasus_t *pegasus, __u8 *id)
4865b2fc499SJeff Garzik {
4875b2fc499SJeff Garzik 	int i;
4885b2fc499SJeff Garzik 	__u16 w16;
4895b2fc499SJeff Garzik 
4905b2fc499SJeff Garzik 	for (i = 0; i < 3; i++) {
4915b2fc499SJeff Garzik 		read_eprom_word(pegasus, i, &w16);
492da2bbdccSHarvey Harrison 		((__le16 *) id)[i] = cpu_to_le16(w16);
4935b2fc499SJeff Garzik 	}
4945b2fc499SJeff Garzik }
4955b2fc499SJeff Garzik 
4965b2fc499SJeff Garzik static void set_ethernet_addr(pegasus_t *pegasus)
4975b2fc499SJeff Garzik {
4985b2fc499SJeff Garzik 	__u8 node_id[6];
4995b2fc499SJeff Garzik 
5005b2fc499SJeff Garzik 	if (pegasus->features & PEGASUS_II) {
5015b2fc499SJeff Garzik 		get_registers(pegasus, 0x10, sizeof(node_id), node_id);
5025b2fc499SJeff Garzik 	} else {
5035b2fc499SJeff Garzik 		get_node_id(pegasus, node_id);
5045b2fc499SJeff Garzik 		set_registers(pegasus, EthID, sizeof(node_id), node_id);
5055b2fc499SJeff Garzik 	}
5065b2fc499SJeff Garzik 	memcpy(pegasus->net->dev_addr, node_id, sizeof(node_id));
5075b2fc499SJeff Garzik }
5085b2fc499SJeff Garzik 
5095b2fc499SJeff Garzik static inline int reset_mac(pegasus_t *pegasus)
5105b2fc499SJeff Garzik {
5115b2fc499SJeff Garzik 	__u8 data = 0x8;
5125b2fc499SJeff Garzik 	int i;
5135b2fc499SJeff Garzik 
5145b2fc499SJeff Garzik 	set_register(pegasus, EthCtrl1, data);
5155b2fc499SJeff Garzik 	for (i = 0; i < REG_TIMEOUT; i++) {
5165b2fc499SJeff Garzik 		get_registers(pegasus, EthCtrl1, 1, &data);
5175b2fc499SJeff Garzik 		if (~data & 0x08) {
518681f1623SDan Carpenter 			if (loopback)
5195b2fc499SJeff Garzik 				break;
5205b2fc499SJeff Garzik 			if (mii_mode && (pegasus->features & HAS_HOME_PNA))
5215b2fc499SJeff Garzik 				set_register(pegasus, Gpio1, 0x34);
5225b2fc499SJeff Garzik 			else
5235b2fc499SJeff Garzik 				set_register(pegasus, Gpio1, 0x26);
5245b2fc499SJeff Garzik 			set_register(pegasus, Gpio0, pegasus->features);
5255b2fc499SJeff Garzik 			set_register(pegasus, Gpio0, DEFAULT_GPIO_SET);
5265b2fc499SJeff Garzik 			break;
5275b2fc499SJeff Garzik 		}
5285b2fc499SJeff Garzik 	}
5295b2fc499SJeff Garzik 	if (i == REG_TIMEOUT)
5305b2fc499SJeff Garzik 		return -ETIMEDOUT;
5315b2fc499SJeff Garzik 
5325b2fc499SJeff Garzik 	if (usb_dev_id[pegasus->dev_index].vendor == VENDOR_LINKSYS ||
5335b2fc499SJeff Garzik 	    usb_dev_id[pegasus->dev_index].vendor == VENDOR_DLINK) {
5345b2fc499SJeff Garzik 		set_register(pegasus, Gpio0, 0x24);
5355b2fc499SJeff Garzik 		set_register(pegasus, Gpio0, 0x26);
5365b2fc499SJeff Garzik 	}
5375b2fc499SJeff Garzik 	if (usb_dev_id[pegasus->dev_index].vendor == VENDOR_ELCON) {
5385b2fc499SJeff Garzik 		__u16 auxmode;
5395b2fc499SJeff Garzik 		read_mii_word(pegasus, 3, 0x1b, &auxmode);
5405b2fc499SJeff Garzik 		write_mii_word(pegasus, 3, 0x1b, auxmode | 4);
5415b2fc499SJeff Garzik 	}
5425b2fc499SJeff Garzik 
5435b2fc499SJeff Garzik 	return 0;
5445b2fc499SJeff Garzik }
5455b2fc499SJeff Garzik 
5465b2fc499SJeff Garzik static int enable_net_traffic(struct net_device *dev, struct usb_device *usb)
5475b2fc499SJeff Garzik {
5485b2fc499SJeff Garzik 	__u16 linkpart;
5495b2fc499SJeff Garzik 	__u8 data[4];
5505b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(dev);
5515b2fc499SJeff Garzik 	int ret;
5525b2fc499SJeff Garzik 
5535b2fc499SJeff Garzik 	read_mii_word(pegasus, pegasus->phy, MII_LPA, &linkpart);
5545b2fc499SJeff Garzik 	data[0] = 0xc9;
5555b2fc499SJeff Garzik 	data[1] = 0;
5565b2fc499SJeff Garzik 	if (linkpart & (ADVERTISE_100FULL | ADVERTISE_10FULL))
5575b2fc499SJeff Garzik 		data[1] |= 0x20;	/* set full duplex */
5585b2fc499SJeff Garzik 	if (linkpart & (ADVERTISE_100FULL | ADVERTISE_100HALF))
5595b2fc499SJeff Garzik 		data[1] |= 0x10;	/* set 100 Mbps */
5605b2fc499SJeff Garzik 	if (mii_mode)
5615b2fc499SJeff Garzik 		data[1] = 0;
562681f1623SDan Carpenter 	data[2] = loopback ? 0x09 : 0x01;
5635b2fc499SJeff Garzik 
5645b2fc499SJeff Garzik 	memcpy(pegasus->eth_regs, data, sizeof(data));
5655b2fc499SJeff Garzik 	ret = set_registers(pegasus, EthCtrl0, 3, data);
5665b2fc499SJeff Garzik 
5675b2fc499SJeff Garzik 	if (usb_dev_id[pegasus->dev_index].vendor == VENDOR_LINKSYS ||
5685b2fc499SJeff Garzik 	    usb_dev_id[pegasus->dev_index].vendor == VENDOR_LINKSYS2 ||
5695b2fc499SJeff Garzik 	    usb_dev_id[pegasus->dev_index].vendor == VENDOR_DLINK) {
5705b2fc499SJeff Garzik 		u16 auxmode;
5715b2fc499SJeff Garzik 		read_mii_word(pegasus, 0, 0x1b, &auxmode);
5725b2fc499SJeff Garzik 		write_mii_word(pegasus, 0, 0x1b, auxmode | 4);
5735b2fc499SJeff Garzik 	}
5745b2fc499SJeff Garzik 
5755b2fc499SJeff Garzik 	return ret;
5765b2fc499SJeff Garzik }
5775b2fc499SJeff Garzik 
5785b2fc499SJeff Garzik static void read_bulk_callback(struct urb *urb)
5795b2fc499SJeff Garzik {
5805b2fc499SJeff Garzik 	pegasus_t *pegasus = urb->context;
5815b2fc499SJeff Garzik 	struct net_device *net;
5825b2fc499SJeff Garzik 	int rx_status, count = urb->actual_length;
583c94cb314SOliver Neukum 	int status = urb->status;
5845b2fc499SJeff Garzik 	u8 *buf = urb->transfer_buffer;
5855b2fc499SJeff Garzik 	__u16 pkt_len;
5865b2fc499SJeff Garzik 
5875b2fc499SJeff Garzik 	if (!pegasus)
5885b2fc499SJeff Garzik 		return;
5895b2fc499SJeff Garzik 
5905b2fc499SJeff Garzik 	net = pegasus->net;
5915b2fc499SJeff Garzik 	if (!netif_device_present(net) || !netif_running(net))
5925b2fc499SJeff Garzik 		return;
5935b2fc499SJeff Garzik 
594c94cb314SOliver Neukum 	switch (status) {
5955b2fc499SJeff Garzik 	case 0:
5965b2fc499SJeff Garzik 		break;
5975b2fc499SJeff Garzik 	case -ETIME:
598a475f603SJoe Perches 		netif_dbg(pegasus, rx_err, net, "reset MAC\n");
5995b2fc499SJeff Garzik 		pegasus->flags &= ~PEGASUS_RX_BUSY;
6005b2fc499SJeff Garzik 		break;
6015b2fc499SJeff Garzik 	case -EPIPE:		/* stall, or disconnect from TT */
6025b2fc499SJeff Garzik 		/* FIXME schedule work to clear the halt */
603a475f603SJoe Perches 		netif_warn(pegasus, rx_err, net, "no rx stall recovery\n");
6045b2fc499SJeff Garzik 		return;
6055b2fc499SJeff Garzik 	case -ENOENT:
6065b2fc499SJeff Garzik 	case -ECONNRESET:
6075b2fc499SJeff Garzik 	case -ESHUTDOWN:
608a475f603SJoe Perches 		netif_dbg(pegasus, ifdown, net, "rx unlink, %d\n", status);
6095b2fc499SJeff Garzik 		return;
6105b2fc499SJeff Garzik 	default:
611a475f603SJoe Perches 		netif_dbg(pegasus, rx_err, net, "RX status %d\n", status);
6125b2fc499SJeff Garzik 		goto goon;
6135b2fc499SJeff Garzik 	}
6145b2fc499SJeff Garzik 
6155b2fc499SJeff Garzik 	if (!count || count < 4)
6165b2fc499SJeff Garzik 		goto goon;
6175b2fc499SJeff Garzik 
6185b2fc499SJeff Garzik 	rx_status = buf[count - 2];
6195b2fc499SJeff Garzik 	if (rx_status & 0x1e) {
620a475f603SJoe Perches 		netif_dbg(pegasus, rx_err, net,
621a475f603SJoe Perches 			  "RX packet error %x\n", rx_status);
6225b2fc499SJeff Garzik 		pegasus->stats.rx_errors++;
6235a9dbfe0SNicolas Kaiser 		if (rx_status & 0x06)	/* long or runt	*/
6245b2fc499SJeff Garzik 			pegasus->stats.rx_length_errors++;
6255b2fc499SJeff Garzik 		if (rx_status & 0x08)
6265b2fc499SJeff Garzik 			pegasus->stats.rx_crc_errors++;
6275a9dbfe0SNicolas Kaiser 		if (rx_status & 0x10)	/* extra bits	*/
6285b2fc499SJeff Garzik 			pegasus->stats.rx_frame_errors++;
6295b2fc499SJeff Garzik 		goto goon;
6305b2fc499SJeff Garzik 	}
6315b2fc499SJeff Garzik 	if (pegasus->chip == 0x8513) {
6325b2fc499SJeff Garzik 		pkt_len = le32_to_cpu(*(__le32 *)urb->transfer_buffer);
6335b2fc499SJeff Garzik 		pkt_len &= 0x0fff;
6345b2fc499SJeff Garzik 		pegasus->rx_skb->data += 2;
6355b2fc499SJeff Garzik 	} else {
6365b2fc499SJeff Garzik 		pkt_len = buf[count - 3] << 8;
6375b2fc499SJeff Garzik 		pkt_len += buf[count - 4];
6385b2fc499SJeff Garzik 		pkt_len &= 0xfff;
6395b2fc499SJeff Garzik 		pkt_len -= 8;
6405b2fc499SJeff Garzik 	}
6415b2fc499SJeff Garzik 
6425b2fc499SJeff Garzik 	/*
6435b2fc499SJeff Garzik 	 * If the packet is unreasonably long, quietly drop it rather than
6445b2fc499SJeff Garzik 	 * kernel panicing by calling skb_put.
6455b2fc499SJeff Garzik 	 */
6465b2fc499SJeff Garzik 	if (pkt_len > PEGASUS_MTU)
6475b2fc499SJeff Garzik 		goto goon;
6485b2fc499SJeff Garzik 
6495b2fc499SJeff Garzik 	/*
6505b2fc499SJeff Garzik 	 * at this point we are sure pegasus->rx_skb != NULL
6515b2fc499SJeff Garzik 	 * so we go ahead and pass up the packet.
6525b2fc499SJeff Garzik 	 */
6535b2fc499SJeff Garzik 	skb_put(pegasus->rx_skb, pkt_len);
6545b2fc499SJeff Garzik 	pegasus->rx_skb->protocol = eth_type_trans(pegasus->rx_skb, net);
6555b2fc499SJeff Garzik 	netif_rx(pegasus->rx_skb);
6565b2fc499SJeff Garzik 	pegasus->stats.rx_packets++;
6575b2fc499SJeff Garzik 	pegasus->stats.rx_bytes += pkt_len;
6585b2fc499SJeff Garzik 
6595b2fc499SJeff Garzik 	if (pegasus->flags & PEGASUS_UNPLUG)
6605b2fc499SJeff Garzik 		return;
6615b2fc499SJeff Garzik 
662*313a58e4SPetko Manolov 	pegasus->rx_skb = __netdev_alloc_skb_ip_align(pegasus->net, PEGASUS_MTU,
663*313a58e4SPetko Manolov 						      GFP_ATOMIC);
6645b2fc499SJeff Garzik 
6655b2fc499SJeff Garzik 	if (pegasus->rx_skb == NULL)
6665b2fc499SJeff Garzik 		goto tl_sched;
6675b2fc499SJeff Garzik goon:
6685b2fc499SJeff Garzik 	usb_fill_bulk_urb(pegasus->rx_urb, pegasus->usb,
6695b2fc499SJeff Garzik 			  usb_rcvbulkpipe(pegasus->usb, 1),
6705b2fc499SJeff Garzik 			  pegasus->rx_skb->data, PEGASUS_MTU + 8,
6715b2fc499SJeff Garzik 			  read_bulk_callback, pegasus);
6725b2fc499SJeff Garzik 	rx_status = usb_submit_urb(pegasus->rx_urb, GFP_ATOMIC);
6735b2fc499SJeff Garzik 	if (rx_status == -ENODEV)
6745b2fc499SJeff Garzik 		netif_device_detach(pegasus->net);
6755b2fc499SJeff Garzik 	else if (rx_status) {
6765b2fc499SJeff Garzik 		pegasus->flags |= PEGASUS_RX_URB_FAIL;
6775b2fc499SJeff Garzik 		goto tl_sched;
6785b2fc499SJeff Garzik 	} else {
6795b2fc499SJeff Garzik 		pegasus->flags &= ~PEGASUS_RX_URB_FAIL;
6805b2fc499SJeff Garzik 	}
6815b2fc499SJeff Garzik 
6825b2fc499SJeff Garzik 	return;
6835b2fc499SJeff Garzik 
6845b2fc499SJeff Garzik tl_sched:
6855b2fc499SJeff Garzik 	tasklet_schedule(&pegasus->rx_tl);
6865b2fc499SJeff Garzik }
6875b2fc499SJeff Garzik 
6885b2fc499SJeff Garzik static void rx_fixup(unsigned long data)
6895b2fc499SJeff Garzik {
6905b2fc499SJeff Garzik 	pegasus_t *pegasus;
6915b2fc499SJeff Garzik 	int status;
6925b2fc499SJeff Garzik 
6935b2fc499SJeff Garzik 	pegasus = (pegasus_t *) data;
6945b2fc499SJeff Garzik 	if (pegasus->flags & PEGASUS_UNPLUG)
6955b2fc499SJeff Garzik 		return;
6965b2fc499SJeff Garzik 
6975b2fc499SJeff Garzik 	if (pegasus->flags & PEGASUS_RX_URB_FAIL)
6985b2fc499SJeff Garzik 		if (pegasus->rx_skb)
6995b2fc499SJeff Garzik 			goto try_again;
7005a9dbfe0SNicolas Kaiser 	if (pegasus->rx_skb == NULL)
701*313a58e4SPetko Manolov 		pegasus->rx_skb = __netdev_alloc_skb_ip_align(pegasus->net,
702*313a58e4SPetko Manolov 							      PEGASUS_MTU,
703*313a58e4SPetko Manolov 							      GFP_ATOMIC);
7045b2fc499SJeff Garzik 	if (pegasus->rx_skb == NULL) {
705a475f603SJoe Perches 		netif_warn(pegasus, rx_err, pegasus->net, "low on memory\n");
7065b2fc499SJeff Garzik 		tasklet_schedule(&pegasus->rx_tl);
707*313a58e4SPetko Manolov 		return;
7085b2fc499SJeff Garzik 	}
7095b2fc499SJeff Garzik 	usb_fill_bulk_urb(pegasus->rx_urb, pegasus->usb,
7105b2fc499SJeff Garzik 			  usb_rcvbulkpipe(pegasus->usb, 1),
7115b2fc499SJeff Garzik 			  pegasus->rx_skb->data, PEGASUS_MTU + 8,
7125b2fc499SJeff Garzik 			  read_bulk_callback, pegasus);
7135b2fc499SJeff Garzik try_again:
7145b2fc499SJeff Garzik 	status = usb_submit_urb(pegasus->rx_urb, GFP_ATOMIC);
7155b2fc499SJeff Garzik 	if (status == -ENODEV)
7165b2fc499SJeff Garzik 		netif_device_detach(pegasus->net);
7175b2fc499SJeff Garzik 	else if (status) {
7185b2fc499SJeff Garzik 		pegasus->flags |= PEGASUS_RX_URB_FAIL;
7195b2fc499SJeff Garzik 		tasklet_schedule(&pegasus->rx_tl);
7205b2fc499SJeff Garzik 	} else {
7215b2fc499SJeff Garzik 		pegasus->flags &= ~PEGASUS_RX_URB_FAIL;
7225b2fc499SJeff Garzik 	}
7235b2fc499SJeff Garzik }
7245b2fc499SJeff Garzik 
7255b2fc499SJeff Garzik static void write_bulk_callback(struct urb *urb)
7265b2fc499SJeff Garzik {
7275b2fc499SJeff Garzik 	pegasus_t *pegasus = urb->context;
7289351982bSMicah Gruber 	struct net_device *net;
729c94cb314SOliver Neukum 	int status = urb->status;
7305b2fc499SJeff Garzik 
7315b2fc499SJeff Garzik 	if (!pegasus)
7325b2fc499SJeff Garzik 		return;
7335b2fc499SJeff Garzik 
7349351982bSMicah Gruber 	net = pegasus->net;
7359351982bSMicah Gruber 
7365b2fc499SJeff Garzik 	if (!netif_device_present(net) || !netif_running(net))
7375b2fc499SJeff Garzik 		return;
7385b2fc499SJeff Garzik 
739c94cb314SOliver Neukum 	switch (status) {
7405b2fc499SJeff Garzik 	case -EPIPE:
7415b2fc499SJeff Garzik 		/* FIXME schedule_work() to clear the tx halt */
7425b2fc499SJeff Garzik 		netif_stop_queue(net);
743a475f603SJoe Perches 		netif_warn(pegasus, tx_err, net, "no tx stall recovery\n");
7445b2fc499SJeff Garzik 		return;
7455b2fc499SJeff Garzik 	case -ENOENT:
7465b2fc499SJeff Garzik 	case -ECONNRESET:
7475b2fc499SJeff Garzik 	case -ESHUTDOWN:
748a475f603SJoe Perches 		netif_dbg(pegasus, ifdown, net, "tx unlink, %d\n", status);
7495b2fc499SJeff Garzik 		return;
7505b2fc499SJeff Garzik 	default:
751a475f603SJoe Perches 		netif_info(pegasus, tx_err, net, "TX status %d\n", status);
7525b2fc499SJeff Garzik 		/* FALL THROUGH */
7535b2fc499SJeff Garzik 	case 0:
7545b2fc499SJeff Garzik 		break;
7555b2fc499SJeff Garzik 	}
7565b2fc499SJeff Garzik 
7571ae5dc34SEric Dumazet 	net->trans_start = jiffies; /* prevent tx timeout */
7585b2fc499SJeff Garzik 	netif_wake_queue(net);
7595b2fc499SJeff Garzik }
7605b2fc499SJeff Garzik 
7615b2fc499SJeff Garzik static void intr_callback(struct urb *urb)
7625b2fc499SJeff Garzik {
7635b2fc499SJeff Garzik 	pegasus_t *pegasus = urb->context;
7645b2fc499SJeff Garzik 	struct net_device *net;
765c94cb314SOliver Neukum 	int res, status = urb->status;
7665b2fc499SJeff Garzik 
7675b2fc499SJeff Garzik 	if (!pegasus)
7685b2fc499SJeff Garzik 		return;
7695b2fc499SJeff Garzik 	net = pegasus->net;
7705b2fc499SJeff Garzik 
771c94cb314SOliver Neukum 	switch (status) {
7725b2fc499SJeff Garzik 	case 0:
7735b2fc499SJeff Garzik 		break;
7745b2fc499SJeff Garzik 	case -ECONNRESET:	/* unlink */
7755b2fc499SJeff Garzik 	case -ENOENT:
7765b2fc499SJeff Garzik 	case -ESHUTDOWN:
7775b2fc499SJeff Garzik 		return;
7785b2fc499SJeff Garzik 	default:
7795b2fc499SJeff Garzik 		/* some Pegasus-I products report LOTS of data
7805b2fc499SJeff Garzik 		 * toggle errors... avoid log spamming
7815b2fc499SJeff Garzik 		 */
782a475f603SJoe Perches 		netif_dbg(pegasus, timer, net, "intr status %d\n", status);
7835b2fc499SJeff Garzik 	}
7845b2fc499SJeff Garzik 
7855b2fc499SJeff Garzik 	if (urb->actual_length >= 6) {
7865b2fc499SJeff Garzik 		u8 *d = urb->transfer_buffer;
7875b2fc499SJeff Garzik 
7885b2fc499SJeff Garzik 		/* byte 0 == tx_status1, reg 2B */
7895b2fc499SJeff Garzik 		if (d[0] & (TX_UNDERRUN|EXCESSIVE_COL
7905b2fc499SJeff Garzik 					|LATE_COL|JABBER_TIMEOUT)) {
7915b2fc499SJeff Garzik 			pegasus->stats.tx_errors++;
7925b2fc499SJeff Garzik 			if (d[0] & TX_UNDERRUN)
7935b2fc499SJeff Garzik 				pegasus->stats.tx_fifo_errors++;
7945b2fc499SJeff Garzik 			if (d[0] & (EXCESSIVE_COL | JABBER_TIMEOUT))
7955b2fc499SJeff Garzik 				pegasus->stats.tx_aborted_errors++;
7965b2fc499SJeff Garzik 			if (d[0] & LATE_COL)
7975b2fc499SJeff Garzik 				pegasus->stats.tx_window_errors++;
7985b2fc499SJeff Garzik 		}
7995b2fc499SJeff Garzik 
8005b2fc499SJeff Garzik 		/* d[5].LINK_STATUS lies on some adapters.
8015b2fc499SJeff Garzik 		 * d[0].NO_CARRIER kicks in only with failed TX.
8025b2fc499SJeff Garzik 		 * ... so monitoring with MII may be safest.
8035b2fc499SJeff Garzik 		 */
8045b2fc499SJeff Garzik 
8055b2fc499SJeff Garzik 		/* bytes 3-4 == rx_lostpkt, reg 2E/2F */
8065b2fc499SJeff Garzik 		pegasus->stats.rx_missed_errors += ((d[3] & 0x7f) << 8) | d[4];
8075b2fc499SJeff Garzik 	}
8085b2fc499SJeff Garzik 
809c94cb314SOliver Neukum 	res = usb_submit_urb(urb, GFP_ATOMIC);
810c94cb314SOliver Neukum 	if (res == -ENODEV)
8115b2fc499SJeff Garzik 		netif_device_detach(pegasus->net);
812a475f603SJoe Perches 	if (res)
813a475f603SJoe Perches 		netif_err(pegasus, timer, net,
814a475f603SJoe Perches 			  "can't resubmit interrupt urb, %d\n", res);
8155b2fc499SJeff Garzik }
8165b2fc499SJeff Garzik 
8175b2fc499SJeff Garzik static void pegasus_tx_timeout(struct net_device *net)
8185b2fc499SJeff Garzik {
8195b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(net);
820a475f603SJoe Perches 	netif_warn(pegasus, timer, net, "tx timeout\n");
8215b2fc499SJeff Garzik 	usb_unlink_urb(pegasus->tx_urb);
8225b2fc499SJeff Garzik 	pegasus->stats.tx_errors++;
8235b2fc499SJeff Garzik }
8245b2fc499SJeff Garzik 
82525a79c41SStephen Hemminger static netdev_tx_t pegasus_start_xmit(struct sk_buff *skb,
82625a79c41SStephen Hemminger 					    struct net_device *net)
8275b2fc499SJeff Garzik {
8285b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(net);
8295b2fc499SJeff Garzik 	int count = ((skb->len + 2) & 0x3f) ? skb->len + 2 : skb->len + 3;
8305b2fc499SJeff Garzik 	int res;
8315b2fc499SJeff Garzik 	__u16 l16 = skb->len;
8325b2fc499SJeff Garzik 
8335b2fc499SJeff Garzik 	netif_stop_queue(net);
8345b2fc499SJeff Garzik 
8355b2fc499SJeff Garzik 	((__le16 *) pegasus->tx_buff)[0] = cpu_to_le16(l16);
8365b2fc499SJeff Garzik 	skb_copy_from_linear_data(skb, pegasus->tx_buff + 2, skb->len);
8375b2fc499SJeff Garzik 	usb_fill_bulk_urb(pegasus->tx_urb, pegasus->usb,
8385b2fc499SJeff Garzik 			  usb_sndbulkpipe(pegasus->usb, 2),
8395b2fc499SJeff Garzik 			  pegasus->tx_buff, count,
8405b2fc499SJeff Garzik 			  write_bulk_callback, pegasus);
8415b2fc499SJeff Garzik 	if ((res = usb_submit_urb(pegasus->tx_urb, GFP_ATOMIC))) {
842a475f603SJoe Perches 		netif_warn(pegasus, tx_err, net, "fail tx, %d\n", res);
8435b2fc499SJeff Garzik 		switch (res) {
8445b2fc499SJeff Garzik 		case -EPIPE:		/* stall, or disconnect from TT */
8455b2fc499SJeff Garzik 			/* cleanup should already have been scheduled */
8465b2fc499SJeff Garzik 			break;
8475b2fc499SJeff Garzik 		case -ENODEV:		/* disconnect() upcoming */
8489dd014ebSOliver Neukum 		case -EPERM:
8495b2fc499SJeff Garzik 			netif_device_detach(pegasus->net);
8505b2fc499SJeff Garzik 			break;
8515b2fc499SJeff Garzik 		default:
8525b2fc499SJeff Garzik 			pegasus->stats.tx_errors++;
8535b2fc499SJeff Garzik 			netif_start_queue(net);
8545b2fc499SJeff Garzik 		}
8555b2fc499SJeff Garzik 	} else {
8565b2fc499SJeff Garzik 		pegasus->stats.tx_packets++;
8575b2fc499SJeff Garzik 		pegasus->stats.tx_bytes += skb->len;
8585b2fc499SJeff Garzik 	}
8595b2fc499SJeff Garzik 	dev_kfree_skb(skb);
8605b2fc499SJeff Garzik 
8616ed10654SPatrick McHardy 	return NETDEV_TX_OK;
8625b2fc499SJeff Garzik }
8635b2fc499SJeff Garzik 
8645b2fc499SJeff Garzik static struct net_device_stats *pegasus_netdev_stats(struct net_device *dev)
8655b2fc499SJeff Garzik {
8665b2fc499SJeff Garzik 	return &((pegasus_t *) netdev_priv(dev))->stats;
8675b2fc499SJeff Garzik }
8685b2fc499SJeff Garzik 
8695b2fc499SJeff Garzik static inline void disable_net_traffic(pegasus_t *pegasus)
8705b2fc499SJeff Garzik {
871e3453f63SMichael Buesch 	__le16 tmp = cpu_to_le16(0);
8725b2fc499SJeff Garzik 
873e3453f63SMichael Buesch 	set_registers(pegasus, EthCtrl0, sizeof(tmp), &tmp);
8745b2fc499SJeff Garzik }
8755b2fc499SJeff Garzik 
8765b2fc499SJeff Garzik static inline void get_interrupt_interval(pegasus_t *pegasus)
8775b2fc499SJeff Garzik {
878e3453f63SMichael Buesch 	u16 data;
879e3453f63SMichael Buesch 	u8 interval;
8805b2fc499SJeff Garzik 
881e3453f63SMichael Buesch 	read_eprom_word(pegasus, 4, &data);
882e3453f63SMichael Buesch 	interval = data >> 8;
8835b2fc499SJeff Garzik 	if (pegasus->usb->speed != USB_SPEED_HIGH) {
884e3453f63SMichael Buesch 		if (interval < 0x80) {
885a475f603SJoe Perches 			netif_info(pegasus, timer, pegasus->net,
886a475f603SJoe Perches 				   "intr interval changed from %ums to %ums\n",
887e3453f63SMichael Buesch 				   interval, 0x80);
888e3453f63SMichael Buesch 			interval = 0x80;
889e3453f63SMichael Buesch 			data = (data & 0x00FF) | ((u16)interval << 8);
8905b2fc499SJeff Garzik #ifdef PEGASUS_WRITE_EEPROM
891e3453f63SMichael Buesch 			write_eprom_word(pegasus, 4, data);
8925b2fc499SJeff Garzik #endif
8935b2fc499SJeff Garzik 		}
8945b2fc499SJeff Garzik 	}
895e3453f63SMichael Buesch 	pegasus->intr_interval = interval;
8965b2fc499SJeff Garzik }
8975b2fc499SJeff Garzik 
8985b2fc499SJeff Garzik static void set_carrier(struct net_device *net)
8995b2fc499SJeff Garzik {
9005b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(net);
9015b2fc499SJeff Garzik 	u16 tmp;
9025b2fc499SJeff Garzik 
9035b2fc499SJeff Garzik 	if (read_mii_word(pegasus, pegasus->phy, MII_BMSR, &tmp))
9045b2fc499SJeff Garzik 		return;
9055b2fc499SJeff Garzik 
9065b2fc499SJeff Garzik 	if (tmp & BMSR_LSTATUS)
9075b2fc499SJeff Garzik 		netif_carrier_on(net);
9085b2fc499SJeff Garzik 	else
9095b2fc499SJeff Garzik 		netif_carrier_off(net);
9105b2fc499SJeff Garzik }
9115b2fc499SJeff Garzik 
9125b2fc499SJeff Garzik static void free_all_urbs(pegasus_t *pegasus)
9135b2fc499SJeff Garzik {
9145b2fc499SJeff Garzik 	usb_free_urb(pegasus->intr_urb);
9155b2fc499SJeff Garzik 	usb_free_urb(pegasus->tx_urb);
9165b2fc499SJeff Garzik 	usb_free_urb(pegasus->rx_urb);
9175b2fc499SJeff Garzik 	usb_free_urb(pegasus->ctrl_urb);
9185b2fc499SJeff Garzik }
9195b2fc499SJeff Garzik 
9205b2fc499SJeff Garzik static void unlink_all_urbs(pegasus_t *pegasus)
9215b2fc499SJeff Garzik {
9225b2fc499SJeff Garzik 	usb_kill_urb(pegasus->intr_urb);
9235b2fc499SJeff Garzik 	usb_kill_urb(pegasus->tx_urb);
9245b2fc499SJeff Garzik 	usb_kill_urb(pegasus->rx_urb);
9255b2fc499SJeff Garzik 	usb_kill_urb(pegasus->ctrl_urb);
9265b2fc499SJeff Garzik }
9275b2fc499SJeff Garzik 
9285b2fc499SJeff Garzik static int alloc_urbs(pegasus_t *pegasus)
9295b2fc499SJeff Garzik {
9305b2fc499SJeff Garzik 	pegasus->ctrl_urb = usb_alloc_urb(0, GFP_KERNEL);
9315a9dbfe0SNicolas Kaiser 	if (!pegasus->ctrl_urb)
9325b2fc499SJeff Garzik 		return 0;
9335b2fc499SJeff Garzik 	pegasus->rx_urb = usb_alloc_urb(0, GFP_KERNEL);
9345b2fc499SJeff Garzik 	if (!pegasus->rx_urb) {
9355b2fc499SJeff Garzik 		usb_free_urb(pegasus->ctrl_urb);
9365b2fc499SJeff Garzik 		return 0;
9375b2fc499SJeff Garzik 	}
9385b2fc499SJeff Garzik 	pegasus->tx_urb = usb_alloc_urb(0, GFP_KERNEL);
9395b2fc499SJeff Garzik 	if (!pegasus->tx_urb) {
9405b2fc499SJeff Garzik 		usb_free_urb(pegasus->rx_urb);
9415b2fc499SJeff Garzik 		usb_free_urb(pegasus->ctrl_urb);
9425b2fc499SJeff Garzik 		return 0;
9435b2fc499SJeff Garzik 	}
9445b2fc499SJeff Garzik 	pegasus->intr_urb = usb_alloc_urb(0, GFP_KERNEL);
9455b2fc499SJeff Garzik 	if (!pegasus->intr_urb) {
9465b2fc499SJeff Garzik 		usb_free_urb(pegasus->tx_urb);
9475b2fc499SJeff Garzik 		usb_free_urb(pegasus->rx_urb);
9485b2fc499SJeff Garzik 		usb_free_urb(pegasus->ctrl_urb);
9495b2fc499SJeff Garzik 		return 0;
9505b2fc499SJeff Garzik 	}
9515b2fc499SJeff Garzik 
9525b2fc499SJeff Garzik 	return 1;
9535b2fc499SJeff Garzik }
9545b2fc499SJeff Garzik 
9555b2fc499SJeff Garzik static int pegasus_open(struct net_device *net)
9565b2fc499SJeff Garzik {
9575b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(net);
9585b2fc499SJeff Garzik 	int res;
9595b2fc499SJeff Garzik 
9605b2fc499SJeff Garzik 	if (pegasus->rx_skb == NULL)
961*313a58e4SPetko Manolov 		pegasus->rx_skb = __netdev_alloc_skb_ip_align(pegasus->net,
962*313a58e4SPetko Manolov 							      PEGASUS_MTU,
963*313a58e4SPetko Manolov 							      GFP_KERNEL);
9645b2fc499SJeff Garzik 	if (!pegasus->rx_skb)
9655b2fc499SJeff Garzik 		return -ENOMEM;
9665b2fc499SJeff Garzik 
9675b2fc499SJeff Garzik 	res = set_registers(pegasus, EthID, 6, net->dev_addr);
9685b2fc499SJeff Garzik 
9695b2fc499SJeff Garzik 	usb_fill_bulk_urb(pegasus->rx_urb, pegasus->usb,
9705b2fc499SJeff Garzik 			  usb_rcvbulkpipe(pegasus->usb, 1),
9715b2fc499SJeff Garzik 			  pegasus->rx_skb->data, PEGASUS_MTU + 8,
9725b2fc499SJeff Garzik 			  read_bulk_callback, pegasus);
9735b2fc499SJeff Garzik 	if ((res = usb_submit_urb(pegasus->rx_urb, GFP_KERNEL))) {
9745b2fc499SJeff Garzik 		if (res == -ENODEV)
9755b2fc499SJeff Garzik 			netif_device_detach(pegasus->net);
976a475f603SJoe Perches 		netif_dbg(pegasus, ifup, net, "failed rx_urb, %d\n", res);
9775b2fc499SJeff Garzik 		goto exit;
9785b2fc499SJeff Garzik 	}
9795b2fc499SJeff Garzik 
9805b2fc499SJeff Garzik 	usb_fill_int_urb(pegasus->intr_urb, pegasus->usb,
9815b2fc499SJeff Garzik 			 usb_rcvintpipe(pegasus->usb, 3),
9825b2fc499SJeff Garzik 			 pegasus->intr_buff, sizeof(pegasus->intr_buff),
9835b2fc499SJeff Garzik 			 intr_callback, pegasus, pegasus->intr_interval);
9845b2fc499SJeff Garzik 	if ((res = usb_submit_urb(pegasus->intr_urb, GFP_KERNEL))) {
9855b2fc499SJeff Garzik 		if (res == -ENODEV)
9865b2fc499SJeff Garzik 			netif_device_detach(pegasus->net);
987a475f603SJoe Perches 		netif_dbg(pegasus, ifup, net, "failed intr_urb, %d\n", res);
9885b2fc499SJeff Garzik 		usb_kill_urb(pegasus->rx_urb);
9895b2fc499SJeff Garzik 		goto exit;
9905b2fc499SJeff Garzik 	}
9915b2fc499SJeff Garzik 	if ((res = enable_net_traffic(net, pegasus->usb))) {
992a475f603SJoe Perches 		netif_dbg(pegasus, ifup, net,
993a475f603SJoe Perches 			  "can't enable_net_traffic() - %d\n", res);
9945b2fc499SJeff Garzik 		res = -EIO;
9955b2fc499SJeff Garzik 		usb_kill_urb(pegasus->rx_urb);
9965b2fc499SJeff Garzik 		usb_kill_urb(pegasus->intr_urb);
9975b2fc499SJeff Garzik 		goto exit;
9985b2fc499SJeff Garzik 	}
9995b2fc499SJeff Garzik 	set_carrier(net);
10005b2fc499SJeff Garzik 	netif_start_queue(net);
1001a475f603SJoe Perches 	netif_dbg(pegasus, ifup, net, "open\n");
10025b2fc499SJeff Garzik 	res = 0;
10035b2fc499SJeff Garzik exit:
10045b2fc499SJeff Garzik 	return res;
10055b2fc499SJeff Garzik }
10065b2fc499SJeff Garzik 
10075b2fc499SJeff Garzik static int pegasus_close(struct net_device *net)
10085b2fc499SJeff Garzik {
10095b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(net);
10105b2fc499SJeff Garzik 
10115b2fc499SJeff Garzik 	netif_stop_queue(net);
10125b2fc499SJeff Garzik 	if (!(pegasus->flags & PEGASUS_UNPLUG))
10135b2fc499SJeff Garzik 		disable_net_traffic(pegasus);
10145b2fc499SJeff Garzik 	tasklet_kill(&pegasus->rx_tl);
10155b2fc499SJeff Garzik 	unlink_all_urbs(pegasus);
10165b2fc499SJeff Garzik 
10175b2fc499SJeff Garzik 	return 0;
10185b2fc499SJeff Garzik }
10195b2fc499SJeff Garzik 
10205b2fc499SJeff Garzik static void pegasus_get_drvinfo(struct net_device *dev,
10215b2fc499SJeff Garzik 				struct ethtool_drvinfo *info)
10225b2fc499SJeff Garzik {
10235b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(dev);
10247826d43fSJiri Pirko 
10257826d43fSJiri Pirko 	strlcpy(info->driver, driver_name, sizeof(info->driver));
10267826d43fSJiri Pirko 	strlcpy(info->version, DRIVER_VERSION, sizeof(info->version));
10275b2fc499SJeff Garzik 	usb_make_path(pegasus->usb, info->bus_info, sizeof(info->bus_info));
10285b2fc499SJeff Garzik }
10295b2fc499SJeff Garzik 
10305b2fc499SJeff Garzik /* also handles three patterns of some kind in hardware */
10315b2fc499SJeff Garzik #define	WOL_SUPPORTED	(WAKE_MAGIC|WAKE_PHY)
10325b2fc499SJeff Garzik 
10335b2fc499SJeff Garzik static void
10345b2fc499SJeff Garzik pegasus_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
10355b2fc499SJeff Garzik {
10365b2fc499SJeff Garzik 	pegasus_t	*pegasus = netdev_priv(dev);
10375b2fc499SJeff Garzik 
10385b2fc499SJeff Garzik 	wol->supported = WAKE_MAGIC | WAKE_PHY;
10395b2fc499SJeff Garzik 	wol->wolopts = pegasus->wolopts;
10405b2fc499SJeff Garzik }
10415b2fc499SJeff Garzik 
10425b2fc499SJeff Garzik static int
10435b2fc499SJeff Garzik pegasus_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
10445b2fc499SJeff Garzik {
10455b2fc499SJeff Garzik 	pegasus_t	*pegasus = netdev_priv(dev);
10465b2fc499SJeff Garzik 	u8		reg78 = 0x04;
10474fbc5b20SMing Lei 	int		ret;
10485b2fc499SJeff Garzik 
10495b2fc499SJeff Garzik 	if (wol->wolopts & ~WOL_SUPPORTED)
10505b2fc499SJeff Garzik 		return -EINVAL;
10515b2fc499SJeff Garzik 
10525b2fc499SJeff Garzik 	if (wol->wolopts & WAKE_MAGIC)
10535b2fc499SJeff Garzik 		reg78 |= 0x80;
10545b2fc499SJeff Garzik 	if (wol->wolopts & WAKE_PHY)
10555b2fc499SJeff Garzik 		reg78 |= 0x40;
10565b2fc499SJeff Garzik 	/* FIXME this 0x10 bit still needs to get set in the chip... */
10575b2fc499SJeff Garzik 	if (wol->wolopts)
10585b2fc499SJeff Garzik 		pegasus->eth_regs[0] |= 0x10;
10595b2fc499SJeff Garzik 	else
10605b2fc499SJeff Garzik 		pegasus->eth_regs[0] &= ~0x10;
10615b2fc499SJeff Garzik 	pegasus->wolopts = wol->wolopts;
10624fbc5b20SMing Lei 
10634fbc5b20SMing Lei 	ret = set_register(pegasus, WakeupControl, reg78);
10644fbc5b20SMing Lei 	if (!ret)
10654fbc5b20SMing Lei 		ret = device_set_wakeup_enable(&pegasus->usb->dev,
10664fbc5b20SMing Lei 						wol->wolopts);
10674fbc5b20SMing Lei 	return ret;
10685b2fc499SJeff Garzik }
10695b2fc499SJeff Garzik 
10705b2fc499SJeff Garzik static inline void pegasus_reset_wol(struct net_device *dev)
10715b2fc499SJeff Garzik {
10725b2fc499SJeff Garzik 	struct ethtool_wolinfo wol;
10735b2fc499SJeff Garzik 
10745b2fc499SJeff Garzik 	memset(&wol, 0, sizeof wol);
10755b2fc499SJeff Garzik 	(void) pegasus_set_wol(dev, &wol);
10765b2fc499SJeff Garzik }
10775b2fc499SJeff Garzik 
10785b2fc499SJeff Garzik static int
10795b2fc499SJeff Garzik pegasus_get_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
10805b2fc499SJeff Garzik {
10815b2fc499SJeff Garzik 	pegasus_t *pegasus;
10825b2fc499SJeff Garzik 
10835b2fc499SJeff Garzik 	pegasus = netdev_priv(dev);
10845b2fc499SJeff Garzik 	mii_ethtool_gset(&pegasus->mii, ecmd);
10855b2fc499SJeff Garzik 	return 0;
10865b2fc499SJeff Garzik }
10875b2fc499SJeff Garzik 
10885b2fc499SJeff Garzik static int
10895b2fc499SJeff Garzik pegasus_set_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
10905b2fc499SJeff Garzik {
10915b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(dev);
10925b2fc499SJeff Garzik 	return mii_ethtool_sset(&pegasus->mii, ecmd);
10935b2fc499SJeff Garzik }
10945b2fc499SJeff Garzik 
10955b2fc499SJeff Garzik static int pegasus_nway_reset(struct net_device *dev)
10965b2fc499SJeff Garzik {
10975b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(dev);
10985b2fc499SJeff Garzik 	return mii_nway_restart(&pegasus->mii);
10995b2fc499SJeff Garzik }
11005b2fc499SJeff Garzik 
11015b2fc499SJeff Garzik static u32 pegasus_get_link(struct net_device *dev)
11025b2fc499SJeff Garzik {
11035b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(dev);
11045b2fc499SJeff Garzik 	return mii_link_ok(&pegasus->mii);
11055b2fc499SJeff Garzik }
11065b2fc499SJeff Garzik 
11075b2fc499SJeff Garzik static u32 pegasus_get_msglevel(struct net_device *dev)
11085b2fc499SJeff Garzik {
11095b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(dev);
11105b2fc499SJeff Garzik 	return pegasus->msg_enable;
11115b2fc499SJeff Garzik }
11125b2fc499SJeff Garzik 
11135b2fc499SJeff Garzik static void pegasus_set_msglevel(struct net_device *dev, u32 v)
11145b2fc499SJeff Garzik {
11155b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(dev);
11165b2fc499SJeff Garzik 	pegasus->msg_enable = v;
11175b2fc499SJeff Garzik }
11185b2fc499SJeff Garzik 
11190fc0b732SStephen Hemminger static const struct ethtool_ops ops = {
11205b2fc499SJeff Garzik 	.get_drvinfo = pegasus_get_drvinfo,
11215b2fc499SJeff Garzik 	.get_settings = pegasus_get_settings,
11225b2fc499SJeff Garzik 	.set_settings = pegasus_set_settings,
11235b2fc499SJeff Garzik 	.nway_reset = pegasus_nway_reset,
11245b2fc499SJeff Garzik 	.get_link = pegasus_get_link,
11255b2fc499SJeff Garzik 	.get_msglevel = pegasus_get_msglevel,
11265b2fc499SJeff Garzik 	.set_msglevel = pegasus_set_msglevel,
11275b2fc499SJeff Garzik 	.get_wol = pegasus_get_wol,
11285b2fc499SJeff Garzik 	.set_wol = pegasus_set_wol,
11295b2fc499SJeff Garzik };
11305b2fc499SJeff Garzik 
11315b2fc499SJeff Garzik static int pegasus_ioctl(struct net_device *net, struct ifreq *rq, int cmd)
11325b2fc499SJeff Garzik {
11335b2fc499SJeff Garzik 	__u16 *data = (__u16 *) &rq->ifr_ifru;
11345b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(net);
11355b2fc499SJeff Garzik 	int res;
11365b2fc499SJeff Garzik 
11375b2fc499SJeff Garzik 	switch (cmd) {
11385b2fc499SJeff Garzik 	case SIOCDEVPRIVATE:
11395b2fc499SJeff Garzik 		data[0] = pegasus->phy;
11405b2fc499SJeff Garzik 	case SIOCDEVPRIVATE + 1:
11415b2fc499SJeff Garzik 		read_mii_word(pegasus, data[0], data[1] & 0x1f, &data[3]);
11425b2fc499SJeff Garzik 		res = 0;
11435b2fc499SJeff Garzik 		break;
11445b2fc499SJeff Garzik 	case SIOCDEVPRIVATE + 2:
11455b2fc499SJeff Garzik 		if (!capable(CAP_NET_ADMIN))
11465b2fc499SJeff Garzik 			return -EPERM;
11475b2fc499SJeff Garzik 		write_mii_word(pegasus, pegasus->phy, data[1] & 0x1f, data[2]);
11485b2fc499SJeff Garzik 		res = 0;
11495b2fc499SJeff Garzik 		break;
11505b2fc499SJeff Garzik 	default:
11515b2fc499SJeff Garzik 		res = -EOPNOTSUPP;
11525b2fc499SJeff Garzik 	}
11535b2fc499SJeff Garzik 	return res;
11545b2fc499SJeff Garzik }
11555b2fc499SJeff Garzik 
11565b2fc499SJeff Garzik static void pegasus_set_multicast(struct net_device *net)
11575b2fc499SJeff Garzik {
11585b2fc499SJeff Garzik 	pegasus_t *pegasus = netdev_priv(net);
11595b2fc499SJeff Garzik 
11605b2fc499SJeff Garzik 	if (net->flags & IFF_PROMISC) {
11615b2fc499SJeff Garzik 		pegasus->eth_regs[EthCtrl2] |= RX_PROMISCUOUS;
1162a475f603SJoe Perches 		netif_info(pegasus, link, net, "Promiscuous mode enabled\n");
11634cd24eafSJiri Pirko 	} else if (!netdev_mc_empty(net) || (net->flags & IFF_ALLMULTI)) {
11645b2fc499SJeff Garzik 		pegasus->eth_regs[EthCtrl0] |= RX_MULTICAST;
11655b2fc499SJeff Garzik 		pegasus->eth_regs[EthCtrl2] &= ~RX_PROMISCUOUS;
1166a475f603SJoe Perches 		netif_dbg(pegasus, link, net, "set allmulti\n");
11675b2fc499SJeff Garzik 	} else {
11685b2fc499SJeff Garzik 		pegasus->eth_regs[EthCtrl0] &= ~RX_MULTICAST;
11695b2fc499SJeff Garzik 		pegasus->eth_regs[EthCtrl2] &= ~RX_PROMISCUOUS;
11705b2fc499SJeff Garzik 	}
11715b2fc499SJeff Garzik 
1172e000ea13SDavid Brownell 	pegasus->ctrl_urb->status = 0;
1173e000ea13SDavid Brownell 
11745b2fc499SJeff Garzik 	pegasus->flags |= ETH_REGS_CHANGE;
11755b2fc499SJeff Garzik 	ctrl_callback(pegasus->ctrl_urb);
11765b2fc499SJeff Garzik }
11775b2fc499SJeff Garzik 
11785b2fc499SJeff Garzik static __u8 mii_phy_probe(pegasus_t *pegasus)
11795b2fc499SJeff Garzik {
11805b2fc499SJeff Garzik 	int i;
11815b2fc499SJeff Garzik 	__u16 tmp;
11825b2fc499SJeff Garzik 
11835b2fc499SJeff Garzik 	for (i = 0; i < 32; i++) {
11845b2fc499SJeff Garzik 		read_mii_word(pegasus, i, MII_BMSR, &tmp);
11855b2fc499SJeff Garzik 		if (tmp == 0 || tmp == 0xffff || (tmp & BMSR_MEDIA) == 0)
11865b2fc499SJeff Garzik 			continue;
11875b2fc499SJeff Garzik 		else
11885b2fc499SJeff Garzik 			return i;
11895b2fc499SJeff Garzik 	}
11905b2fc499SJeff Garzik 
11915b2fc499SJeff Garzik 	return 0xff;
11925b2fc499SJeff Garzik }
11935b2fc499SJeff Garzik 
11945b2fc499SJeff Garzik static inline void setup_pegasus_II(pegasus_t *pegasus)
11955b2fc499SJeff Garzik {
11965b2fc499SJeff Garzik 	__u8 data = 0xa5;
11975b2fc499SJeff Garzik 
11985b2fc499SJeff Garzik 	set_register(pegasus, Reg1d, 0);
11995b2fc499SJeff Garzik 	set_register(pegasus, Reg7b, 1);
12005b2fc499SJeff Garzik 	mdelay(100);
12015b2fc499SJeff Garzik 	if ((pegasus->features & HAS_HOME_PNA) && mii_mode)
12025b2fc499SJeff Garzik 		set_register(pegasus, Reg7b, 0);
12035b2fc499SJeff Garzik 	else
12045b2fc499SJeff Garzik 		set_register(pegasus, Reg7b, 2);
12055b2fc499SJeff Garzik 
12065b2fc499SJeff Garzik 	set_register(pegasus, 0x83, data);
12075b2fc499SJeff Garzik 	get_registers(pegasus, 0x83, 1, &data);
12085b2fc499SJeff Garzik 
12095a9dbfe0SNicolas Kaiser 	if (data == 0xa5)
12105b2fc499SJeff Garzik 		pegasus->chip = 0x8513;
12115a9dbfe0SNicolas Kaiser 	else
12125b2fc499SJeff Garzik 		pegasus->chip = 0;
12135b2fc499SJeff Garzik 
12145b2fc499SJeff Garzik 	set_register(pegasus, 0x80, 0xc0);
12155b2fc499SJeff Garzik 	set_register(pegasus, 0x83, 0xff);
12165b2fc499SJeff Garzik 	set_register(pegasus, 0x84, 0x01);
12175b2fc499SJeff Garzik 
12185b2fc499SJeff Garzik 	if (pegasus->features & HAS_HOME_PNA && mii_mode)
12195b2fc499SJeff Garzik 		set_register(pegasus, Reg81, 6);
12205b2fc499SJeff Garzik 	else
12215b2fc499SJeff Garzik 		set_register(pegasus, Reg81, 2);
12225b2fc499SJeff Garzik }
12235b2fc499SJeff Garzik 
12245b2fc499SJeff Garzik 
1225cda2836dSDavid Brownell static int pegasus_count;
12265a9dbfe0SNicolas Kaiser static struct workqueue_struct *pegasus_workqueue;
12275b2fc499SJeff Garzik #define CARRIER_CHECK_DELAY (2 * HZ)
12285b2fc499SJeff Garzik 
12295b2fc499SJeff Garzik static void check_carrier(struct work_struct *work)
12305b2fc499SJeff Garzik {
12315b2fc499SJeff Garzik 	pegasus_t *pegasus = container_of(work, pegasus_t, carrier_check.work);
12325b2fc499SJeff Garzik 	set_carrier(pegasus->net);
12335b2fc499SJeff Garzik 	if (!(pegasus->flags & PEGASUS_UNPLUG)) {
12345b2fc499SJeff Garzik 		queue_delayed_work(pegasus_workqueue, &pegasus->carrier_check,
12355b2fc499SJeff Garzik 			CARRIER_CHECK_DELAY);
12365b2fc499SJeff Garzik 	}
12375b2fc499SJeff Garzik }
12385b2fc499SJeff Garzik 
12394f63135eSBen Collins static int pegasus_blacklisted(struct usb_device *udev)
12404f63135eSBen Collins {
12414f63135eSBen Collins 	struct usb_device_descriptor *udd = &udev->descriptor;
12424f63135eSBen Collins 
12434f63135eSBen Collins 	/* Special quirk to keep the driver from handling the Belkin Bluetooth
12444f63135eSBen Collins 	 * dongle which happens to have the same ID.
12454f63135eSBen Collins 	 */
1246e3453f63SMichael Buesch 	if ((udd->idVendor == cpu_to_le16(VENDOR_BELKIN)) &&
1247e3453f63SMichael Buesch 	    (udd->idProduct == cpu_to_le16(0x0121)) &&
12484f63135eSBen Collins 	    (udd->bDeviceClass == USB_CLASS_WIRELESS_CONTROLLER) &&
12494f63135eSBen Collins 	    (udd->bDeviceProtocol == 1))
12504f63135eSBen Collins 		return 1;
12514f63135eSBen Collins 
12524f63135eSBen Collins 	return 0;
12534f63135eSBen Collins }
12544f63135eSBen Collins 
1255cda2836dSDavid Brownell /* we rely on probe() and remove() being serialized so we
1256cda2836dSDavid Brownell  * don't need extra locking on pegasus_count.
1257cda2836dSDavid Brownell  */
1258cda2836dSDavid Brownell static void pegasus_dec_workqueue(void)
1259cda2836dSDavid Brownell {
1260cda2836dSDavid Brownell 	pegasus_count--;
1261cda2836dSDavid Brownell 	if (pegasus_count == 0) {
1262cda2836dSDavid Brownell 		destroy_workqueue(pegasus_workqueue);
1263cda2836dSDavid Brownell 		pegasus_workqueue = NULL;
1264cda2836dSDavid Brownell 	}
1265cda2836dSDavid Brownell }
1266cda2836dSDavid Brownell 
12675b2fc499SJeff Garzik static int pegasus_probe(struct usb_interface *intf,
12685b2fc499SJeff Garzik 			 const struct usb_device_id *id)
12695b2fc499SJeff Garzik {
12705b2fc499SJeff Garzik 	struct usb_device *dev = interface_to_usbdev(intf);
12715b2fc499SJeff Garzik 	struct net_device *net;
12725b2fc499SJeff Garzik 	pegasus_t *pegasus;
12735b2fc499SJeff Garzik 	int dev_index = id - pegasus_ids;
12745b2fc499SJeff Garzik 	int res = -ENOMEM;
12755b2fc499SJeff Garzik 
1276cda2836dSDavid Brownell 	if (pegasus_blacklisted(dev))
1277cda2836dSDavid Brownell 		return -ENODEV;
12784f63135eSBen Collins 
1279cda2836dSDavid Brownell 	if (pegasus_count == 0) {
1280cda2836dSDavid Brownell 		pegasus_workqueue = create_singlethread_workqueue("pegasus");
1281cda2836dSDavid Brownell 		if (!pegasus_workqueue)
1282cda2836dSDavid Brownell 			return -ENOMEM;
12834f63135eSBen Collins 	}
1284cda2836dSDavid Brownell 	pegasus_count++;
1285cda2836dSDavid Brownell 
12865b2fc499SJeff Garzik 	net = alloc_etherdev(sizeof(struct pegasus));
128741de8d4cSJoe Perches 	if (!net)
12885b2fc499SJeff Garzik 		goto out;
12895b2fc499SJeff Garzik 
12905b2fc499SJeff Garzik 	pegasus = netdev_priv(net);
12915b2fc499SJeff Garzik 	pegasus->dev_index = dev_index;
12925b2fc499SJeff Garzik 	init_waitqueue_head(&pegasus->ctrl_wait);
12935b2fc499SJeff Garzik 
12945b2fc499SJeff Garzik 	if (!alloc_urbs(pegasus)) {
12955b2fc499SJeff Garzik 		dev_err(&intf->dev, "can't allocate %s\n", "urbs");
12965b2fc499SJeff Garzik 		goto out1;
12975b2fc499SJeff Garzik 	}
12985b2fc499SJeff Garzik 
12995b2fc499SJeff Garzik 	tasklet_init(&pegasus->rx_tl, rx_fixup, (unsigned long) pegasus);
13005b2fc499SJeff Garzik 
13015b2fc499SJeff Garzik 	INIT_DELAYED_WORK(&pegasus->carrier_check, check_carrier);
13025b2fc499SJeff Garzik 
13035b2fc499SJeff Garzik 	pegasus->intf = intf;
13045b2fc499SJeff Garzik 	pegasus->usb = dev;
13055b2fc499SJeff Garzik 	pegasus->net = net;
13068cb89571SOliver Neukum 
13078cb89571SOliver Neukum 
13085b2fc499SJeff Garzik 	net->watchdog_timeo = PEGASUS_TX_TIMEOUT;
13098cb89571SOliver Neukum 	net->netdev_ops = &pegasus_netdev_ops;
13105b2fc499SJeff Garzik 	SET_ETHTOOL_OPS(net, &ops);
13115b2fc499SJeff Garzik 	pegasus->mii.dev = net;
13125b2fc499SJeff Garzik 	pegasus->mii.mdio_read = mdio_read;
13135b2fc499SJeff Garzik 	pegasus->mii.mdio_write = mdio_write;
13145b2fc499SJeff Garzik 	pegasus->mii.phy_id_mask = 0x1f;
13155b2fc499SJeff Garzik 	pegasus->mii.reg_num_mask = 0x1f;
13165b2fc499SJeff Garzik 	pegasus->msg_enable = netif_msg_init(msg_level, NETIF_MSG_DRV
13175b2fc499SJeff Garzik 				| NETIF_MSG_PROBE | NETIF_MSG_LINK);
13185b2fc499SJeff Garzik 
13195b2fc499SJeff Garzik 	pegasus->features = usb_dev_id[dev_index].private;
13205b2fc499SJeff Garzik 	get_interrupt_interval(pegasus);
13215b2fc499SJeff Garzik 	if (reset_mac(pegasus)) {
13225b2fc499SJeff Garzik 		dev_err(&intf->dev, "can't reset MAC\n");
13235b2fc499SJeff Garzik 		res = -EIO;
13245b2fc499SJeff Garzik 		goto out2;
13255b2fc499SJeff Garzik 	}
13265b2fc499SJeff Garzik 	set_ethernet_addr(pegasus);
13275b2fc499SJeff Garzik 	if (pegasus->features & PEGASUS_II) {
13285b2fc499SJeff Garzik 		dev_info(&intf->dev, "setup Pegasus II specific registers\n");
13295b2fc499SJeff Garzik 		setup_pegasus_II(pegasus);
13305b2fc499SJeff Garzik 	}
13315b2fc499SJeff Garzik 	pegasus->phy = mii_phy_probe(pegasus);
13325b2fc499SJeff Garzik 	if (pegasus->phy == 0xff) {
13335b2fc499SJeff Garzik 		dev_warn(&intf->dev, "can't locate MII phy, using default\n");
13345b2fc499SJeff Garzik 		pegasus->phy = 1;
13355b2fc499SJeff Garzik 	}
13365b2fc499SJeff Garzik 	pegasus->mii.phy_id = pegasus->phy;
13375b2fc499SJeff Garzik 	usb_set_intfdata(intf, pegasus);
13385b2fc499SJeff Garzik 	SET_NETDEV_DEV(net, &intf->dev);
13395b2fc499SJeff Garzik 	pegasus_reset_wol(net);
13405b2fc499SJeff Garzik 	res = register_netdev(net);
13415b2fc499SJeff Garzik 	if (res)
13425b2fc499SJeff Garzik 		goto out3;
13435b2fc499SJeff Garzik 	queue_delayed_work(pegasus_workqueue, &pegasus->carrier_check,
13445b2fc499SJeff Garzik 				CARRIER_CHECK_DELAY);
13455b2fc499SJeff Garzik 
1346e174961cSJohannes Berg 	dev_info(&intf->dev, "%s, %s, %pM\n",
13475b2fc499SJeff Garzik 		 net->name,
13485b2fc499SJeff Garzik 		 usb_dev_id[dev_index].name,
1349e174961cSJohannes Berg 		 net->dev_addr);
13505b2fc499SJeff Garzik 	return 0;
13515b2fc499SJeff Garzik 
13525b2fc499SJeff Garzik out3:
13535b2fc499SJeff Garzik 	usb_set_intfdata(intf, NULL);
13545b2fc499SJeff Garzik out2:
13555b2fc499SJeff Garzik 	free_all_urbs(pegasus);
13565b2fc499SJeff Garzik out1:
13575b2fc499SJeff Garzik 	free_netdev(net);
13585b2fc499SJeff Garzik out:
1359cda2836dSDavid Brownell 	pegasus_dec_workqueue();
13605b2fc499SJeff Garzik 	return res;
13615b2fc499SJeff Garzik }
13625b2fc499SJeff Garzik 
13635b2fc499SJeff Garzik static void pegasus_disconnect(struct usb_interface *intf)
13645b2fc499SJeff Garzik {
13655b2fc499SJeff Garzik 	struct pegasus *pegasus = usb_get_intfdata(intf);
13665b2fc499SJeff Garzik 
13675b2fc499SJeff Garzik 	usb_set_intfdata(intf, NULL);
13685b2fc499SJeff Garzik 	if (!pegasus) {
13695b2fc499SJeff Garzik 		dev_dbg(&intf->dev, "unregistering non-bound device?\n");
13705b2fc499SJeff Garzik 		return;
13715b2fc499SJeff Garzik 	}
13725b2fc499SJeff Garzik 
13735b2fc499SJeff Garzik 	pegasus->flags |= PEGASUS_UNPLUG;
13745b2fc499SJeff Garzik 	cancel_delayed_work(&pegasus->carrier_check);
13755b2fc499SJeff Garzik 	unregister_netdev(pegasus->net);
13765b2fc499SJeff Garzik 	unlink_all_urbs(pegasus);
13775b2fc499SJeff Garzik 	free_all_urbs(pegasus);
13785b2fc499SJeff Garzik 	if (pegasus->rx_skb != NULL) {
13795b2fc499SJeff Garzik 		dev_kfree_skb(pegasus->rx_skb);
13805b2fc499SJeff Garzik 		pegasus->rx_skb = NULL;
13815b2fc499SJeff Garzik 	}
13825b2fc499SJeff Garzik 	free_netdev(pegasus->net);
1383cda2836dSDavid Brownell 	pegasus_dec_workqueue();
13845b2fc499SJeff Garzik }
13855b2fc499SJeff Garzik 
13865b2fc499SJeff Garzik static int pegasus_suspend(struct usb_interface *intf, pm_message_t message)
13875b2fc499SJeff Garzik {
13885b2fc499SJeff Garzik 	struct pegasus *pegasus = usb_get_intfdata(intf);
13895b2fc499SJeff Garzik 
13905b2fc499SJeff Garzik 	netif_device_detach(pegasus->net);
13915b2fc499SJeff Garzik 	cancel_delayed_work(&pegasus->carrier_check);
13925b2fc499SJeff Garzik 	if (netif_running(pegasus->net)) {
13935b2fc499SJeff Garzik 		usb_kill_urb(pegasus->rx_urb);
13945b2fc499SJeff Garzik 		usb_kill_urb(pegasus->intr_urb);
13955b2fc499SJeff Garzik 	}
13965b2fc499SJeff Garzik 	return 0;
13975b2fc499SJeff Garzik }
13985b2fc499SJeff Garzik 
13995b2fc499SJeff Garzik static int pegasus_resume(struct usb_interface *intf)
14005b2fc499SJeff Garzik {
14015b2fc499SJeff Garzik 	struct pegasus *pegasus = usb_get_intfdata(intf);
14025b2fc499SJeff Garzik 
14035b2fc499SJeff Garzik 	netif_device_attach(pegasus->net);
14045b2fc499SJeff Garzik 	if (netif_running(pegasus->net)) {
14055b2fc499SJeff Garzik 		pegasus->rx_urb->status = 0;
14065b2fc499SJeff Garzik 		pegasus->rx_urb->actual_length = 0;
14075b2fc499SJeff Garzik 		read_bulk_callback(pegasus->rx_urb);
14085b2fc499SJeff Garzik 
14095b2fc499SJeff Garzik 		pegasus->intr_urb->status = 0;
14105b2fc499SJeff Garzik 		pegasus->intr_urb->actual_length = 0;
14115b2fc499SJeff Garzik 		intr_callback(pegasus->intr_urb);
14125b2fc499SJeff Garzik 	}
14135b2fc499SJeff Garzik 	queue_delayed_work(pegasus_workqueue, &pegasus->carrier_check,
14145b2fc499SJeff Garzik 				CARRIER_CHECK_DELAY);
14155b2fc499SJeff Garzik 	return 0;
14165b2fc499SJeff Garzik }
14175b2fc499SJeff Garzik 
14188cb89571SOliver Neukum static const struct net_device_ops pegasus_netdev_ops = {
14198cb89571SOliver Neukum 	.ndo_open =			pegasus_open,
14208cb89571SOliver Neukum 	.ndo_stop =			pegasus_close,
14218cb89571SOliver Neukum 	.ndo_do_ioctl =			pegasus_ioctl,
14228cb89571SOliver Neukum 	.ndo_start_xmit =		pegasus_start_xmit,
1423afc4b13dSJiri Pirko 	.ndo_set_rx_mode =		pegasus_set_multicast,
14248cb89571SOliver Neukum 	.ndo_get_stats =		pegasus_netdev_stats,
14258cb89571SOliver Neukum 	.ndo_tx_timeout =		pegasus_tx_timeout,
1426635ecaa7SBen Hutchings 	.ndo_change_mtu =		eth_change_mtu,
1427240c102dSBen Hutchings 	.ndo_set_mac_address =		eth_mac_addr,
1428240c102dSBen Hutchings 	.ndo_validate_addr =		eth_validate_addr,
14298cb89571SOliver Neukum };
14308cb89571SOliver Neukum 
14315b2fc499SJeff Garzik static struct usb_driver pegasus_driver = {
14325b2fc499SJeff Garzik 	.name = driver_name,
14335b2fc499SJeff Garzik 	.probe = pegasus_probe,
14345b2fc499SJeff Garzik 	.disconnect = pegasus_disconnect,
14355b2fc499SJeff Garzik 	.id_table = pegasus_ids,
14365b2fc499SJeff Garzik 	.suspend = pegasus_suspend,
14375b2fc499SJeff Garzik 	.resume = pegasus_resume,
1438e1f12eb6SSarah Sharp 	.disable_hub_initiated_lpm = 1,
14395b2fc499SJeff Garzik };
14405b2fc499SJeff Garzik 
1441cda2836dSDavid Brownell static void __init parse_id(char *id)
14425b2fc499SJeff Garzik {
14435b2fc499SJeff Garzik 	unsigned int vendor_id = 0, device_id = 0, flags = 0, i = 0;
14445b2fc499SJeff Garzik 	char *token, *name = NULL;
14455b2fc499SJeff Garzik 
14465b2fc499SJeff Garzik 	if ((token = strsep(&id, ":")) != NULL)
14475b2fc499SJeff Garzik 		name = token;
14485b2fc499SJeff Garzik 	/* name now points to a null terminated string*/
14495b2fc499SJeff Garzik 	if ((token = strsep(&id, ":")) != NULL)
14505b2fc499SJeff Garzik 		vendor_id = simple_strtoul(token, NULL, 16);
14515b2fc499SJeff Garzik 	if ((token = strsep(&id, ":")) != NULL)
14525b2fc499SJeff Garzik 		device_id = simple_strtoul(token, NULL, 16);
14535b2fc499SJeff Garzik 	flags = simple_strtoul(id, NULL, 16);
14545b2fc499SJeff Garzik 	pr_info("%s: new device %s, vendor ID 0x%04x, device ID 0x%04x, flags: 0x%x\n",
14555b2fc499SJeff Garzik 		driver_name, name, vendor_id, device_id, flags);
14565b2fc499SJeff Garzik 
14575b2fc499SJeff Garzik 	if (vendor_id > 0x10000 || vendor_id == 0)
14585b2fc499SJeff Garzik 		return;
14595b2fc499SJeff Garzik 	if (device_id > 0x10000 || device_id == 0)
14605b2fc499SJeff Garzik 		return;
14615b2fc499SJeff Garzik 
14625b2fc499SJeff Garzik 	for (i = 0; usb_dev_id[i].name; i++);
14635b2fc499SJeff Garzik 	usb_dev_id[i].name = name;
14645b2fc499SJeff Garzik 	usb_dev_id[i].vendor = vendor_id;
14655b2fc499SJeff Garzik 	usb_dev_id[i].device = device_id;
14665b2fc499SJeff Garzik 	usb_dev_id[i].private = flags;
14675b2fc499SJeff Garzik 	pegasus_ids[i].match_flags = USB_DEVICE_ID_MATCH_DEVICE;
14685b2fc499SJeff Garzik 	pegasus_ids[i].idVendor = vendor_id;
14695b2fc499SJeff Garzik 	pegasus_ids[i].idProduct = device_id;
14705b2fc499SJeff Garzik }
14715b2fc499SJeff Garzik 
14725b2fc499SJeff Garzik static int __init pegasus_init(void)
14735b2fc499SJeff Garzik {
14745b2fc499SJeff Garzik 	pr_info("%s: %s, " DRIVER_DESC "\n", driver_name, DRIVER_VERSION);
14755b2fc499SJeff Garzik 	if (devid)
14765b2fc499SJeff Garzik 		parse_id(devid);
14775b2fc499SJeff Garzik 	return usb_register(&pegasus_driver);
14785b2fc499SJeff Garzik }
14795b2fc499SJeff Garzik 
14805b2fc499SJeff Garzik static void __exit pegasus_exit(void)
14815b2fc499SJeff Garzik {
14825b2fc499SJeff Garzik 	usb_deregister(&pegasus_driver);
14835b2fc499SJeff Garzik }
14845b2fc499SJeff Garzik 
14855b2fc499SJeff Garzik module_init(pegasus_init);
14865b2fc499SJeff Garzik module_exit(pegasus_exit);
1487