| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /**************************************************************** | 
 | 2 |  * | 
 | 3 |  *     kaweth.c - driver for KL5KUSB101 based USB->Ethernet | 
 | 4 |  * | 
 | 5 |  *     (c) 2000 Interlan Communications | 
 | 6 |  *     (c) 2000 Stephane Alnet | 
 | 7 |  *     (C) 2001 Brad Hards | 
 | 8 |  *     (C) 2002 Oliver Neukum | 
 | 9 |  * | 
 | 10 |  *     Original author: The Zapman <zapman@interlan.net> | 
 | 11 |  *     Inspired by, and much credit goes to Michael Rothwell | 
 | 12 |  *     <rothwell@interlan.net> for the test equipment, help, and patience | 
 | 13 |  *     Based off of (and with thanks to) Petko Manolov's pegaus.c driver. | 
 | 14 |  *     Also many thanks to Joel Silverman and Ed Surprenant at Kawasaki | 
 | 15 |  *     for providing the firmware and driver resources. | 
 | 16 |  * | 
 | 17 |  *     This program is free software; you can redistribute it and/or | 
 | 18 |  *     modify it under the terms of the GNU General Public License as | 
 | 19 |  *     published by the Free Software Foundation; either version 2, or | 
 | 20 |  *     (at your option) any later version. | 
 | 21 |  * | 
 | 22 |  *     This program is distributed in the hope that it will be useful, | 
 | 23 |  *     but WITHOUT ANY WARRANTY; without even the implied warranty of | 
 | 24 |  *     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
 | 25 |  *     GNU General Public License for more details. | 
 | 26 |  * | 
 | 27 |  *     You should have received a copy of the GNU General Public License | 
 | 28 |  *     along with this program; if not, write to the Free Software Foundation, | 
 | 29 |  *     Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | 
 | 30 |  * | 
 | 31 |  ****************************************************************/ | 
 | 32 |  | 
 | 33 | /* TODO: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 |  * Develop test procedures for USB net interfaces | 
 | 35 |  * Run test procedures | 
 | 36 |  * Fix bugs from previous two steps | 
 | 37 |  * Snoop other OSs for any tricks we're not doing | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 |  * Reduce arbitrary timeouts | 
 | 39 |  * Smart multicast support | 
 | 40 |  * Temporary MAC change support | 
 | 41 |  * Tunable SOFs parameter - ioctl()? | 
 | 42 |  * Ethernet stats collection | 
 | 43 |  * Code formatting improvements | 
 | 44 |  */ | 
 | 45 |  | 
 | 46 | #include <linux/module.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 47 | #include <linux/slab.h> | 
 | 48 | #include <linux/string.h> | 
 | 49 | #include <linux/init.h> | 
 | 50 | #include <linux/delay.h> | 
 | 51 | #include <linux/netdevice.h> | 
 | 52 | #include <linux/etherdevice.h> | 
 | 53 | #include <linux/usb.h> | 
 | 54 | #include <linux/types.h> | 
 | 55 | #include <linux/ethtool.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 56 | #include <linux/dma-mapping.h> | 
 | 57 | #include <linux/wait.h> | 
| David Woodhouse | 7968249 | 2008-05-29 17:17:17 +0300 | [diff] [blame] | 58 | #include <linux/firmware.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | #include <asm/uaccess.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 60 | #include <asm/byteorder.h> | 
 | 61 |  | 
 | 62 | #undef DEBUG | 
 | 63 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 64 | #define KAWETH_MTU			1514 | 
 | 65 | #define KAWETH_BUF_SIZE			1664 | 
 | 66 | #define KAWETH_TX_TIMEOUT		(5 * HZ) | 
 | 67 | #define KAWETH_SCRATCH_SIZE		32 | 
 | 68 | #define KAWETH_FIRMWARE_BUF_SIZE	4096 | 
| Russ Dill | 2b2b2e3 | 2008-01-07 21:48:12 -0800 | [diff] [blame] | 69 | #define KAWETH_CONTROL_TIMEOUT		(30000) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 70 |  | 
 | 71 | #define KAWETH_STATUS_BROKEN		0x0000001 | 
 | 72 | #define KAWETH_STATUS_CLOSING		0x0000002 | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 73 | #define KAWETH_STATUS_SUSPENDING	0x0000004 | 
 | 74 |  | 
 | 75 | #define KAWETH_STATUS_BLOCKED (KAWETH_STATUS_CLOSING | KAWETH_STATUS_SUSPENDING) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 76 |  | 
 | 77 | #define KAWETH_PACKET_FILTER_PROMISCUOUS	0x01 | 
 | 78 | #define KAWETH_PACKET_FILTER_ALL_MULTICAST	0x02 | 
 | 79 | #define KAWETH_PACKET_FILTER_DIRECTED		0x04 | 
 | 80 | #define KAWETH_PACKET_FILTER_BROADCAST		0x08 | 
 | 81 | #define KAWETH_PACKET_FILTER_MULTICAST		0x10 | 
 | 82 |  | 
 | 83 | /* Table 7 */ | 
 | 84 | #define KAWETH_COMMAND_GET_ETHERNET_DESC	0x00 | 
 | 85 | #define KAWETH_COMMAND_MULTICAST_FILTERS        0x01 | 
 | 86 | #define KAWETH_COMMAND_SET_PACKET_FILTER	0x02 | 
 | 87 | #define KAWETH_COMMAND_STATISTICS               0x03 | 
 | 88 | #define KAWETH_COMMAND_SET_TEMP_MAC     	0x06 | 
 | 89 | #define KAWETH_COMMAND_GET_TEMP_MAC             0x07 | 
 | 90 | #define KAWETH_COMMAND_SET_URB_SIZE		0x08 | 
 | 91 | #define KAWETH_COMMAND_SET_SOFS_WAIT		0x09 | 
 | 92 | #define KAWETH_COMMAND_SCAN			0xFF | 
 | 93 |  | 
 | 94 | #define KAWETH_SOFS_TO_WAIT			0x05 | 
 | 95 |  | 
 | 96 | #define INTBUFFERSIZE				4 | 
 | 97 |  | 
 | 98 | #define STATE_OFFSET				0 | 
 | 99 | #define STATE_MASK				0x40 | 
 | 100 | #define	STATE_SHIFT				5 | 
 | 101 |  | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 102 | #define IS_BLOCKED(s) (s & KAWETH_STATUS_BLOCKED) | 
 | 103 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 104 |  | 
 | 105 | MODULE_AUTHOR("Michael Zappe <zapman@interlan.net>, Stephane Alnet <stephane@u-picardie.fr>, Brad Hards <bhards@bigpond.net.au> and Oliver Neukum <oliver@neukum.org>"); | 
 | 106 | MODULE_DESCRIPTION("KL5USB101 USB Ethernet driver"); | 
 | 107 | MODULE_LICENSE("GPL"); | 
| David Woodhouse | 7968249 | 2008-05-29 17:17:17 +0300 | [diff] [blame] | 108 | MODULE_FIRMWARE("kaweth/new_code.bin"); | 
 | 109 | MODULE_FIRMWARE("kaweth/new_code_fix.bin"); | 
 | 110 | MODULE_FIRMWARE("kaweth/trigger_code.bin"); | 
 | 111 | MODULE_FIRMWARE("kaweth/trigger_code_fix.bin"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 112 |  | 
 | 113 | static const char driver_name[] = "kaweth"; | 
 | 114 |  | 
 | 115 | static int kaweth_probe( | 
 | 116 | 		struct usb_interface *intf, | 
 | 117 | 		const struct usb_device_id *id	/* from id_table */ | 
 | 118 | 	); | 
 | 119 | static void kaweth_disconnect(struct usb_interface *intf); | 
 | 120 | static int kaweth_internal_control_msg(struct usb_device *usb_dev, | 
 | 121 | 				       unsigned int pipe, | 
 | 122 | 				       struct usb_ctrlrequest *cmd, void *data, | 
 | 123 | 				       int len, int timeout); | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 124 | static int kaweth_suspend(struct usb_interface *intf, pm_message_t message); | 
 | 125 | static int kaweth_resume(struct usb_interface *intf); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 126 |  | 
 | 127 | /**************************************************************** | 
 | 128 |  *     usb_device_id | 
 | 129 |  ****************************************************************/ | 
 | 130 | static struct usb_device_id usb_klsi_table[] = { | 
 | 131 | 	{ USB_DEVICE(0x03e8, 0x0008) }, /* AOX Endpoints USB Ethernet */ | 
 | 132 | 	{ USB_DEVICE(0x04bb, 0x0901) }, /* I-O DATA USB-ET/T */ | 
 | 133 | 	{ USB_DEVICE(0x0506, 0x03e8) }, /* 3Com 3C19250 */ | 
 | 134 | 	{ USB_DEVICE(0x0506, 0x11f8) }, /* 3Com 3C460 */ | 
 | 135 | 	{ USB_DEVICE(0x0557, 0x2002) }, /* ATEN USB Ethernet */ | 
 | 136 | 	{ USB_DEVICE(0x0557, 0x4000) }, /* D-Link DSB-650C */ | 
 | 137 | 	{ USB_DEVICE(0x0565, 0x0002) }, /* Peracom Enet */ | 
 | 138 | 	{ USB_DEVICE(0x0565, 0x0003) }, /* Optus@Home UEP1045A */ | 
 | 139 | 	{ USB_DEVICE(0x0565, 0x0005) }, /* Peracom Enet2 */ | 
 | 140 | 	{ USB_DEVICE(0x05e9, 0x0008) }, /* KLSI KL5KUSB101B */ | 
 | 141 | 	{ USB_DEVICE(0x05e9, 0x0009) }, /* KLSI KL5KUSB101B (Board change) */ | 
 | 142 | 	{ USB_DEVICE(0x066b, 0x2202) }, /* Linksys USB10T */ | 
 | 143 | 	{ USB_DEVICE(0x06e1, 0x0008) }, /* ADS USB-10BT */ | 
 | 144 | 	{ USB_DEVICE(0x06e1, 0x0009) }, /* ADS USB-10BT */ | 
 | 145 | 	{ USB_DEVICE(0x0707, 0x0100) }, /* SMC 2202USB */ | 
 | 146 | 	{ USB_DEVICE(0x07aa, 0x0001) }, /* Correga K.K. */ | 
 | 147 | 	{ USB_DEVICE(0x07b8, 0x4000) }, /* D-Link DU-E10 */ | 
| Andreas Hartmann | dacf4fc | 2010-04-27 14:39:33 -0700 | [diff] [blame] | 148 | 	{ USB_DEVICE(0x07c9, 0xb010) }, /* Allied Telesyn AT-USB10 USB Ethernet Adapter */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 149 | 	{ USB_DEVICE(0x0846, 0x1001) }, /* NetGear EA-101 */ | 
 | 150 | 	{ USB_DEVICE(0x0846, 0x1002) }, /* NetGear EA-101 */ | 
 | 151 | 	{ USB_DEVICE(0x085a, 0x0008) }, /* PortGear Ethernet Adapter */ | 
 | 152 | 	{ USB_DEVICE(0x085a, 0x0009) }, /* PortGear Ethernet Adapter */ | 
 | 153 | 	{ USB_DEVICE(0x087d, 0x5704) }, /* Jaton USB Ethernet Device Adapter */ | 
 | 154 | 	{ USB_DEVICE(0x0951, 0x0008) }, /* Kingston Technology USB Ethernet Adapter */ | 
 | 155 | 	{ USB_DEVICE(0x095a, 0x3003) }, /* Portsmith Express Ethernet Adapter */ | 
 | 156 | 	{ USB_DEVICE(0x10bd, 0x1427) }, /* ASANTE USB To Ethernet Adapter */ | 
 | 157 | 	{ USB_DEVICE(0x1342, 0x0204) }, /* Mobility USB-Ethernet Adapter */ | 
 | 158 | 	{ USB_DEVICE(0x13d2, 0x0400) }, /* Shark Pocket Adapter */ | 
 | 159 | 	{ USB_DEVICE(0x1485, 0x0001) },	/* Silicom U2E */ | 
 | 160 | 	{ USB_DEVICE(0x1485, 0x0002) }, /* Psion Dacom Gold Port Ethernet */ | 
 | 161 | 	{ USB_DEVICE(0x1645, 0x0005) }, /* Entrega E45 */ | 
 | 162 | 	{ USB_DEVICE(0x1645, 0x0008) }, /* Entrega USB Ethernet Adapter */ | 
 | 163 | 	{ USB_DEVICE(0x1645, 0x8005) }, /* PortGear Ethernet Adapter */ | 
| Oliver Neukum | 486ba2a | 2006-09-28 22:21:19 +0200 | [diff] [blame] | 164 | 	{ USB_DEVICE(0x1668, 0x0323) }, /* Actiontec USB Ethernet */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 165 | 	{ USB_DEVICE(0x2001, 0x4000) }, /* D-link DSB-650C */ | 
 | 166 | 	{} /* Null terminator */ | 
 | 167 | }; | 
 | 168 |  | 
 | 169 | MODULE_DEVICE_TABLE (usb, usb_klsi_table); | 
 | 170 |  | 
 | 171 | /**************************************************************** | 
 | 172 |  *     kaweth_driver | 
 | 173 |  ****************************************************************/ | 
 | 174 | static struct usb_driver kaweth_driver = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 175 | 	.name =		driver_name, | 
 | 176 | 	.probe =	kaweth_probe, | 
 | 177 | 	.disconnect =	kaweth_disconnect, | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 178 | 	.suspend =	kaweth_suspend, | 
 | 179 | 	.resume =	kaweth_resume, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 180 | 	.id_table =     usb_klsi_table, | 
| Oliver Neukum | b98b98f | 2007-01-16 09:47:12 +0100 | [diff] [blame] | 181 | 	.supports_autosuspend =	1, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 182 | }; | 
 | 183 |  | 
 | 184 | typedef __u8 eth_addr_t[6]; | 
 | 185 |  | 
 | 186 | /**************************************************************** | 
 | 187 |  *     usb_eth_dev | 
 | 188 |  ****************************************************************/ | 
 | 189 | struct usb_eth_dev { | 
 | 190 | 	char *name; | 
 | 191 | 	__u16 vendor; | 
 | 192 | 	__u16 device; | 
 | 193 | 	void *pdata; | 
 | 194 | }; | 
 | 195 |  | 
 | 196 | /**************************************************************** | 
 | 197 |  *     kaweth_ethernet_configuration | 
 | 198 |  *     Refer Table 8 | 
 | 199 |  ****************************************************************/ | 
 | 200 | struct kaweth_ethernet_configuration | 
 | 201 | { | 
 | 202 | 	__u8 size; | 
 | 203 | 	__u8 reserved1; | 
 | 204 | 	__u8 reserved2; | 
 | 205 | 	eth_addr_t hw_addr; | 
 | 206 | 	__u32 statistics_mask; | 
 | 207 | 	__le16 segment_size; | 
 | 208 | 	__u16 max_multicast_filters; | 
 | 209 | 	__u8 reserved3; | 
| Eric Dumazet | ba2d358 | 2010-06-02 18:10:09 +0000 | [diff] [blame] | 210 | } __packed; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 211 |  | 
 | 212 | /**************************************************************** | 
 | 213 |  *     kaweth_device | 
 | 214 |  ****************************************************************/ | 
 | 215 | struct kaweth_device | 
 | 216 | { | 
 | 217 | 	spinlock_t device_lock; | 
 | 218 |  | 
 | 219 | 	__u32 status; | 
 | 220 | 	int end; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 221 | 	int suspend_lowmem_rx; | 
 | 222 | 	int suspend_lowmem_ctrl; | 
 | 223 | 	int linkstate; | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 224 | 	int opened; | 
| David Howells | c402895 | 2006-11-22 14:57:56 +0000 | [diff] [blame] | 225 | 	struct delayed_work lowmem_work; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 226 |  | 
 | 227 | 	struct usb_device *dev; | 
| Oliver Neukum | b98b98f | 2007-01-16 09:47:12 +0100 | [diff] [blame] | 228 | 	struct usb_interface *intf; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 229 | 	struct net_device *net; | 
 | 230 | 	wait_queue_head_t term_wait; | 
 | 231 |  | 
 | 232 | 	struct urb *rx_urb; | 
 | 233 | 	struct urb *tx_urb; | 
 | 234 | 	struct urb *irq_urb; | 
 | 235 |  | 
 | 236 | 	dma_addr_t intbufferhandle; | 
 | 237 | 	__u8 *intbuffer; | 
 | 238 | 	dma_addr_t rxbufferhandle; | 
 | 239 | 	__u8 *rx_buf; | 
 | 240 |  | 
 | 241 | 	 | 
 | 242 | 	struct sk_buff *tx_skb; | 
 | 243 |  | 
 | 244 | 	__u8 *firmware_buf; | 
 | 245 | 	__u8 scratch[KAWETH_SCRATCH_SIZE]; | 
 | 246 | 	__u16 packet_filter_bitmap; | 
 | 247 |  | 
 | 248 | 	struct kaweth_ethernet_configuration configuration; | 
 | 249 |  | 
 | 250 | 	struct net_device_stats stats; | 
 | 251 | }; | 
 | 252 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 253 | /**************************************************************** | 
 | 254 |  *     kaweth_control | 
 | 255 |  ****************************************************************/ | 
 | 256 | static int kaweth_control(struct kaweth_device *kaweth, | 
 | 257 | 			  unsigned int pipe, | 
 | 258 | 			  __u8 request, | 
 | 259 | 			  __u8 requesttype, | 
 | 260 | 			  __u16 value, | 
 | 261 | 			  __u16 index, | 
 | 262 | 			  void *data, | 
 | 263 | 			  __u16 size, | 
 | 264 | 			  int timeout) | 
 | 265 | { | 
 | 266 | 	struct usb_ctrlrequest *dr; | 
| Kevin Cernekee | 051b982 | 2009-09-19 11:18:21 +0000 | [diff] [blame] | 267 | 	int retval; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 268 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 269 | 	dbg("kaweth_control()"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 270 |  | 
 | 271 | 	if(in_interrupt()) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 272 | 		dbg("in_interrupt()"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 273 | 		return -EBUSY; | 
 | 274 | 	} | 
 | 275 |  | 
 | 276 | 	dr = kmalloc(sizeof(struct usb_ctrlrequest), GFP_ATOMIC); | 
 | 277 |  | 
 | 278 | 	if (!dr) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 279 | 		dbg("kmalloc() failed"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 280 | 		return -ENOMEM; | 
 | 281 | 	} | 
 | 282 |  | 
| Kevin Cernekee | 051b982 | 2009-09-19 11:18:21 +0000 | [diff] [blame] | 283 | 	dr->bRequestType = requesttype; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 284 | 	dr->bRequest = request; | 
| Harvey Harrison | da2bbdc | 2008-10-29 14:25:51 -0700 | [diff] [blame] | 285 | 	dr->wValue = cpu_to_le16(value); | 
 | 286 | 	dr->wIndex = cpu_to_le16(index); | 
 | 287 | 	dr->wLength = cpu_to_le16(size); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 288 |  | 
| Kevin Cernekee | 051b982 | 2009-09-19 11:18:21 +0000 | [diff] [blame] | 289 | 	retval = kaweth_internal_control_msg(kaweth->dev, | 
 | 290 | 					     pipe, | 
 | 291 | 					     dr, | 
 | 292 | 					     data, | 
 | 293 | 					     size, | 
 | 294 | 					     timeout); | 
 | 295 |  | 
 | 296 | 	kfree(dr); | 
 | 297 | 	return retval; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 298 | } | 
 | 299 |  | 
 | 300 | /**************************************************************** | 
 | 301 |  *     kaweth_read_configuration | 
 | 302 |  ****************************************************************/ | 
 | 303 | static int kaweth_read_configuration(struct kaweth_device *kaweth) | 
 | 304 | { | 
 | 305 | 	int retval; | 
 | 306 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 307 | 	dbg("Reading kaweth configuration"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 308 |  | 
 | 309 | 	retval = kaweth_control(kaweth, | 
 | 310 | 				usb_rcvctrlpipe(kaweth->dev, 0), | 
 | 311 | 				KAWETH_COMMAND_GET_ETHERNET_DESC, | 
 | 312 | 				USB_TYPE_VENDOR | USB_DIR_IN | USB_RECIP_DEVICE, | 
 | 313 | 				0, | 
 | 314 | 				0, | 
 | 315 | 				(void *)&kaweth->configuration, | 
 | 316 | 				sizeof(kaweth->configuration), | 
 | 317 | 				KAWETH_CONTROL_TIMEOUT); | 
 | 318 |  | 
 | 319 | 	return retval; | 
 | 320 | } | 
 | 321 |  | 
 | 322 | /**************************************************************** | 
 | 323 |  *     kaweth_set_urb_size | 
 | 324 |  ****************************************************************/ | 
 | 325 | static int kaweth_set_urb_size(struct kaweth_device *kaweth, __u16 urb_size) | 
 | 326 | { | 
 | 327 | 	int retval; | 
 | 328 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 329 | 	dbg("Setting URB size to %d", (unsigned)urb_size); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 330 |  | 
 | 331 | 	retval = kaweth_control(kaweth, | 
 | 332 | 				usb_sndctrlpipe(kaweth->dev, 0), | 
 | 333 | 				KAWETH_COMMAND_SET_URB_SIZE, | 
 | 334 | 				USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE, | 
 | 335 | 				urb_size, | 
 | 336 | 				0, | 
 | 337 | 				(void *)&kaweth->scratch, | 
 | 338 | 				0, | 
 | 339 | 				KAWETH_CONTROL_TIMEOUT); | 
 | 340 |  | 
 | 341 | 	return retval; | 
 | 342 | } | 
 | 343 |  | 
 | 344 | /**************************************************************** | 
 | 345 |  *     kaweth_set_sofs_wait | 
 | 346 |  ****************************************************************/ | 
 | 347 | static int kaweth_set_sofs_wait(struct kaweth_device *kaweth, __u16 sofs_wait) | 
 | 348 | { | 
 | 349 | 	int retval; | 
 | 350 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 351 | 	dbg("Set SOFS wait to %d", (unsigned)sofs_wait); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 352 |  | 
 | 353 | 	retval = kaweth_control(kaweth, | 
 | 354 | 				usb_sndctrlpipe(kaweth->dev, 0), | 
 | 355 | 				KAWETH_COMMAND_SET_SOFS_WAIT, | 
 | 356 | 				USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE, | 
 | 357 | 				sofs_wait, | 
 | 358 | 				0, | 
 | 359 | 				(void *)&kaweth->scratch, | 
 | 360 | 				0, | 
 | 361 | 				KAWETH_CONTROL_TIMEOUT); | 
 | 362 |  | 
 | 363 | 	return retval; | 
 | 364 | } | 
 | 365 |  | 
 | 366 | /**************************************************************** | 
 | 367 |  *     kaweth_set_receive_filter | 
 | 368 |  ****************************************************************/ | 
 | 369 | static int kaweth_set_receive_filter(struct kaweth_device *kaweth, | 
 | 370 | 				     __u16 receive_filter) | 
 | 371 | { | 
 | 372 | 	int retval; | 
 | 373 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 374 | 	dbg("Set receive filter to %d", (unsigned)receive_filter); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 375 |  | 
 | 376 | 	retval = kaweth_control(kaweth, | 
 | 377 | 				usb_sndctrlpipe(kaweth->dev, 0), | 
 | 378 | 				KAWETH_COMMAND_SET_PACKET_FILTER, | 
 | 379 | 				USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE, | 
 | 380 | 				receive_filter, | 
 | 381 | 				0, | 
 | 382 | 				(void *)&kaweth->scratch, | 
 | 383 | 				0, | 
 | 384 | 				KAWETH_CONTROL_TIMEOUT); | 
 | 385 |  | 
 | 386 | 	return retval; | 
 | 387 | } | 
 | 388 |  | 
 | 389 | /**************************************************************** | 
 | 390 |  *     kaweth_download_firmware | 
 | 391 |  ****************************************************************/ | 
 | 392 | static int kaweth_download_firmware(struct kaweth_device *kaweth, | 
| David Woodhouse | 7968249 | 2008-05-29 17:17:17 +0300 | [diff] [blame] | 393 | 				    const char *fwname, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 394 | 				    __u8 interrupt, | 
 | 395 | 				    __u8 type) | 
 | 396 | { | 
| David Woodhouse | 7968249 | 2008-05-29 17:17:17 +0300 | [diff] [blame] | 397 | 	const struct firmware *fw; | 
 | 398 | 	int data_len; | 
 | 399 | 	int ret; | 
 | 400 |  | 
 | 401 | 	ret = request_firmware(&fw, fwname, &kaweth->dev->dev); | 
 | 402 | 	if (ret) { | 
 | 403 | 		err("Firmware request failed\n"); | 
 | 404 | 		return ret; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 405 | 	} | 
 | 406 |  | 
| David Woodhouse | 7968249 | 2008-05-29 17:17:17 +0300 | [diff] [blame] | 407 | 	if (fw->size > KAWETH_FIRMWARE_BUF_SIZE) { | 
 | 408 | 		err("Firmware too big: %zu", fw->size); | 
| Jesper Juhl | 986e3f6 | 2011-01-23 12:19:55 +0000 | [diff] [blame] | 409 | 		release_firmware(fw); | 
| David Woodhouse | 7968249 | 2008-05-29 17:17:17 +0300 | [diff] [blame] | 410 | 		return -ENOSPC; | 
 | 411 | 	} | 
 | 412 | 	data_len = fw->size; | 
 | 413 | 	memcpy(kaweth->firmware_buf, fw->data, fw->size); | 
 | 414 |  | 
 | 415 | 	release_firmware(fw); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 416 |  | 
 | 417 | 	kaweth->firmware_buf[2] = (data_len & 0xFF) - 7; | 
 | 418 | 	kaweth->firmware_buf[3] = data_len >> 8; | 
 | 419 | 	kaweth->firmware_buf[4] = type; | 
 | 420 | 	kaweth->firmware_buf[5] = interrupt; | 
 | 421 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 422 | 	dbg("High: %i, Low:%i", kaweth->firmware_buf[3], | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 423 | 		   kaweth->firmware_buf[2]); | 
 | 424 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 425 | 	dbg("Downloading firmware at %p to kaweth device at %p", | 
| David Woodhouse | 7968249 | 2008-05-29 17:17:17 +0300 | [diff] [blame] | 426 | 	    fw->data, kaweth); | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 427 | 	dbg("Firmware length: %d", data_len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 428 |  | 
 | 429 | 	return kaweth_control(kaweth, | 
 | 430 | 		              usb_sndctrlpipe(kaweth->dev, 0), | 
 | 431 | 			      KAWETH_COMMAND_SCAN, | 
 | 432 | 			      USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE, | 
 | 433 | 			      0, | 
 | 434 | 			      0, | 
 | 435 | 			      (void *)kaweth->firmware_buf, | 
 | 436 | 			      data_len, | 
 | 437 | 			      KAWETH_CONTROL_TIMEOUT); | 
 | 438 | } | 
 | 439 |  | 
 | 440 | /**************************************************************** | 
 | 441 |  *     kaweth_trigger_firmware | 
 | 442 |  ****************************************************************/ | 
 | 443 | static int kaweth_trigger_firmware(struct kaweth_device *kaweth, | 
 | 444 | 				   __u8 interrupt) | 
 | 445 | { | 
 | 446 | 	kaweth->firmware_buf[0] = 0xB6; | 
 | 447 | 	kaweth->firmware_buf[1] = 0xC3; | 
 | 448 | 	kaweth->firmware_buf[2] = 0x01; | 
 | 449 | 	kaweth->firmware_buf[3] = 0x00; | 
 | 450 | 	kaweth->firmware_buf[4] = 0x06; | 
 | 451 | 	kaweth->firmware_buf[5] = interrupt; | 
 | 452 | 	kaweth->firmware_buf[6] = 0x00; | 
 | 453 | 	kaweth->firmware_buf[7] = 0x00; | 
 | 454 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 455 | 	dbg("Triggering firmware"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 456 |  | 
 | 457 | 	return kaweth_control(kaweth, | 
 | 458 | 			      usb_sndctrlpipe(kaweth->dev, 0), | 
 | 459 | 			      KAWETH_COMMAND_SCAN, | 
 | 460 | 			      USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE, | 
 | 461 | 			      0, | 
 | 462 | 			      0, | 
 | 463 | 			      (void *)kaweth->firmware_buf, | 
 | 464 | 			      8, | 
 | 465 | 			      KAWETH_CONTROL_TIMEOUT); | 
 | 466 | } | 
 | 467 |  | 
 | 468 | /**************************************************************** | 
 | 469 |  *     kaweth_reset | 
 | 470 |  ****************************************************************/ | 
 | 471 | static int kaweth_reset(struct kaweth_device *kaweth) | 
 | 472 | { | 
 | 473 | 	int result; | 
 | 474 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 475 | 	dbg("kaweth_reset(%p)", kaweth); | 
| Oliver Neukum | f0816ce | 2009-10-29 05:07:12 +0000 | [diff] [blame] | 476 | 	result = usb_reset_configuration(kaweth->dev); | 
| Guillaume GOURAT / | f2d45cd | 2005-10-21 14:01:35 +0200 | [diff] [blame] | 477 | 	mdelay(10); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 478 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 479 | 	dbg("kaweth_reset() returns %d.",result); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 480 |  | 
 | 481 | 	return result; | 
 | 482 | } | 
 | 483 |  | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 484 | static void kaweth_usb_receive(struct urb *); | 
| Al Viro | 55016f1 | 2005-10-21 03:21:58 -0400 | [diff] [blame] | 485 | static int kaweth_resubmit_rx_urb(struct kaweth_device *, gfp_t); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 486 |  | 
 | 487 | /**************************************************************** | 
 | 488 | 	int_callback | 
 | 489 | *****************************************************************/ | 
 | 490 |  | 
| Al Viro | 55016f1 | 2005-10-21 03:21:58 -0400 | [diff] [blame] | 491 | static void kaweth_resubmit_int_urb(struct kaweth_device *kaweth, gfp_t mf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 492 | { | 
 | 493 | 	int status; | 
 | 494 |  | 
 | 495 | 	status = usb_submit_urb (kaweth->irq_urb, mf); | 
 | 496 | 	if (unlikely(status == -ENOMEM)) { | 
 | 497 | 		kaweth->suspend_lowmem_ctrl = 1; | 
 | 498 | 		schedule_delayed_work(&kaweth->lowmem_work, HZ/4); | 
 | 499 | 	} else { | 
 | 500 | 		kaweth->suspend_lowmem_ctrl = 0; | 
 | 501 | 	} | 
 | 502 |  | 
 | 503 | 	if (status) | 
 | 504 | 		err ("can't resubmit intr, %s-%s, status %d", | 
 | 505 | 				kaweth->dev->bus->bus_name, | 
 | 506 | 				kaweth->dev->devpath, status); | 
 | 507 | } | 
 | 508 |  | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 509 | static void int_callback(struct urb *u) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 510 | { | 
 | 511 | 	struct kaweth_device *kaweth = u->context; | 
 | 512 | 	int act_state; | 
| Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 513 | 	int status = u->status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 514 |  | 
| Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 515 | 	switch (status) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 516 | 	case 0:			/* success */ | 
 | 517 | 		break; | 
 | 518 | 	case -ECONNRESET:	/* unlink */ | 
 | 519 | 	case -ENOENT: | 
 | 520 | 	case -ESHUTDOWN: | 
 | 521 | 		return; | 
 | 522 | 	/* -EPIPE:  should clear the halt */ | 
 | 523 | 	default:		/* error */ | 
 | 524 | 		goto resubmit; | 
 | 525 | 	} | 
 | 526 |  | 
 | 527 | 	/* we check the link state to report changes */ | 
 | 528 | 	if (kaweth->linkstate != (act_state = ( kaweth->intbuffer[STATE_OFFSET] | STATE_MASK) >> STATE_SHIFT)) { | 
| Oliver Neukum | 58125f9 | 2005-06-15 22:26:38 -0700 | [diff] [blame] | 529 | 		if (act_state) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 530 | 			netif_carrier_on(kaweth->net); | 
 | 531 | 		else | 
 | 532 | 			netif_carrier_off(kaweth->net); | 
 | 533 |  | 
 | 534 | 		kaweth->linkstate = act_state; | 
 | 535 | 	} | 
 | 536 | resubmit: | 
 | 537 | 	kaweth_resubmit_int_urb(kaweth, GFP_ATOMIC); | 
 | 538 | } | 
 | 539 |  | 
| David Howells | c402895 | 2006-11-22 14:57:56 +0000 | [diff] [blame] | 540 | static void kaweth_resubmit_tl(struct work_struct *work) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 541 | { | 
| David Howells | c402895 | 2006-11-22 14:57:56 +0000 | [diff] [blame] | 542 | 	struct kaweth_device *kaweth = | 
 | 543 | 		container_of(work, struct kaweth_device, lowmem_work.work); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 544 |  | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 545 | 	if (IS_BLOCKED(kaweth->status)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 546 | 		return; | 
 | 547 |  | 
 | 548 | 	if (kaweth->suspend_lowmem_rx) | 
 | 549 | 		kaweth_resubmit_rx_urb(kaweth, GFP_NOIO); | 
 | 550 |  | 
 | 551 | 	if (kaweth->suspend_lowmem_ctrl) | 
 | 552 | 		kaweth_resubmit_int_urb(kaweth, GFP_NOIO); | 
 | 553 | } | 
 | 554 |  | 
 | 555 |  | 
 | 556 | /**************************************************************** | 
 | 557 |  *     kaweth_resubmit_rx_urb | 
 | 558 |  ****************************************************************/ | 
 | 559 | static int kaweth_resubmit_rx_urb(struct kaweth_device *kaweth, | 
| Al Viro | 55016f1 | 2005-10-21 03:21:58 -0400 | [diff] [blame] | 560 | 						gfp_t mem_flags) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 561 | { | 
 | 562 | 	int result; | 
 | 563 |  | 
 | 564 | 	usb_fill_bulk_urb(kaweth->rx_urb, | 
 | 565 | 		      kaweth->dev, | 
 | 566 | 		      usb_rcvbulkpipe(kaweth->dev, 1), | 
 | 567 | 		      kaweth->rx_buf, | 
 | 568 | 		      KAWETH_BUF_SIZE, | 
 | 569 | 		      kaweth_usb_receive, | 
 | 570 | 		      kaweth); | 
 | 571 | 	kaweth->rx_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | 
 | 572 | 	kaweth->rx_urb->transfer_dma = kaweth->rxbufferhandle; | 
 | 573 |  | 
 | 574 | 	if((result = usb_submit_urb(kaweth->rx_urb, mem_flags))) { | 
 | 575 | 		if (result == -ENOMEM) { | 
 | 576 | 			kaweth->suspend_lowmem_rx = 1; | 
 | 577 | 			schedule_delayed_work(&kaweth->lowmem_work, HZ/4); | 
 | 578 | 		} | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 579 | 		err("resubmitting rx_urb %d failed", result); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 580 | 	} else { | 
 | 581 | 		kaweth->suspend_lowmem_rx = 0; | 
 | 582 | 	} | 
 | 583 |  | 
 | 584 | 	return result; | 
 | 585 | } | 
 | 586 |  | 
 | 587 | static void kaweth_async_set_rx_mode(struct kaweth_device *kaweth); | 
 | 588 |  | 
 | 589 | /**************************************************************** | 
 | 590 |  *     kaweth_usb_receive | 
 | 591 |  ****************************************************************/ | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 592 | static void kaweth_usb_receive(struct urb *urb) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 593 | { | 
 | 594 | 	struct kaweth_device *kaweth = urb->context; | 
 | 595 | 	struct net_device *net = kaweth->net; | 
| Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 596 | 	int status = urb->status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 597 |  | 
 | 598 | 	int count = urb->actual_length; | 
 | 599 | 	int count2 = urb->transfer_buffer_length; | 
 | 600 |  | 
 | 601 | 	__u16 pkt_len = le16_to_cpup((__le16 *)kaweth->rx_buf); | 
 | 602 |  | 
 | 603 | 	struct sk_buff *skb; | 
 | 604 |  | 
| Larry Finger | 710b523 | 2009-04-09 07:11:55 +0000 | [diff] [blame] | 605 | 	if (unlikely(status == -EPIPE)) { | 
 | 606 | 		kaweth->stats.rx_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 607 | 		kaweth->end = 1; | 
 | 608 | 		wake_up(&kaweth->term_wait); | 
| Larry Finger | 710b523 | 2009-04-09 07:11:55 +0000 | [diff] [blame] | 609 | 		dbg("Status was -EPIPE."); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 610 | 		return; | 
 | 611 | 	} | 
| Larry Finger | 710b523 | 2009-04-09 07:11:55 +0000 | [diff] [blame] | 612 | 	if (unlikely(status == -ECONNRESET || status == -ESHUTDOWN)) { | 
 | 613 | 		/* we are killed - set a flag and wake the disconnect handler */ | 
 | 614 | 		kaweth->end = 1; | 
 | 615 | 		wake_up(&kaweth->term_wait); | 
 | 616 | 		dbg("Status was -ECONNRESET or -ESHUTDOWN."); | 
 | 617 | 		return; | 
 | 618 | 	} | 
 | 619 | 	if (unlikely(status == -EPROTO || status == -ETIME || | 
 | 620 | 		     status == -EILSEQ)) { | 
 | 621 | 		kaweth->stats.rx_errors++; | 
 | 622 | 		dbg("Status was -EPROTO, -ETIME, or -EILSEQ."); | 
 | 623 | 		return; | 
 | 624 | 	} | 
 | 625 | 	if (unlikely(status == -EOVERFLOW)) { | 
 | 626 | 		kaweth->stats.rx_errors++; | 
 | 627 | 		dbg("Status was -EOVERFLOW."); | 
 | 628 | 	} | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 629 | 	spin_lock(&kaweth->device_lock); | 
 | 630 | 	if (IS_BLOCKED(kaweth->status)) { | 
 | 631 | 		spin_unlock(&kaweth->device_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 632 | 		return; | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 633 | 	} | 
 | 634 | 	spin_unlock(&kaweth->device_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 635 |  | 
| Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 636 | 	if(status && status != -EREMOTEIO && count != 1) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 637 | 		err("%s RX status: %d count: %d packet_len: %d", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 638 |                            net->name, | 
| Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 639 | 			   status, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 640 | 			   count, | 
 | 641 | 			   (int)pkt_len); | 
 | 642 | 		kaweth_resubmit_rx_urb(kaweth, GFP_ATOMIC); | 
 | 643 |                 return; | 
 | 644 | 	} | 
 | 645 |  | 
 | 646 | 	if(kaweth->net && (count > 2)) { | 
 | 647 | 		if(pkt_len > (count - 2)) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 648 | 			err("Packet length too long for USB frame (pkt_len: %x, count: %x)",pkt_len, count); | 
 | 649 | 			err("Packet len & 2047: %x", pkt_len & 2047); | 
 | 650 | 			err("Count 2: %x", count2); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 651 | 		        kaweth_resubmit_rx_urb(kaweth, GFP_ATOMIC); | 
 | 652 |                         return; | 
 | 653 |                 } | 
 | 654 |  | 
 | 655 | 		if(!(skb = dev_alloc_skb(pkt_len+2))) { | 
 | 656 | 		        kaweth_resubmit_rx_urb(kaweth, GFP_ATOMIC); | 
 | 657 |                         return; | 
 | 658 | 		} | 
 | 659 |  | 
 | 660 | 		skb_reserve(skb, 2);    /* Align IP on 16 byte boundaries */ | 
 | 661 |  | 
| David S. Miller | 8c7b7fa | 2007-07-10 22:08:12 -0700 | [diff] [blame] | 662 | 		skb_copy_to_linear_data(skb, kaweth->rx_buf + 2, pkt_len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 663 |  | 
 | 664 | 		skb_put(skb, pkt_len); | 
 | 665 |  | 
 | 666 | 		skb->protocol = eth_type_trans(skb, net); | 
 | 667 |  | 
 | 668 | 		netif_rx(skb); | 
 | 669 |  | 
 | 670 | 		kaweth->stats.rx_packets++; | 
 | 671 | 		kaweth->stats.rx_bytes += pkt_len; | 
 | 672 | 	} | 
 | 673 |  | 
 | 674 | 	kaweth_resubmit_rx_urb(kaweth, GFP_ATOMIC); | 
 | 675 | } | 
 | 676 |  | 
 | 677 | /**************************************************************** | 
 | 678 |  *     kaweth_open | 
 | 679 |  ****************************************************************/ | 
 | 680 | static int kaweth_open(struct net_device *net) | 
 | 681 | { | 
 | 682 | 	struct kaweth_device *kaweth = netdev_priv(net); | 
 | 683 | 	int res; | 
 | 684 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 685 | 	dbg("Opening network device."); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 686 |  | 
| Oliver Neukum | b98b98f | 2007-01-16 09:47:12 +0100 | [diff] [blame] | 687 | 	res = usb_autopm_get_interface(kaweth->intf); | 
 | 688 | 	if (res) { | 
 | 689 | 		err("Interface cannot be resumed."); | 
 | 690 | 		return -EIO; | 
 | 691 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 692 | 	res = kaweth_resubmit_rx_urb(kaweth, GFP_KERNEL); | 
 | 693 | 	if (res) | 
| Oliver Neukum | b98b98f | 2007-01-16 09:47:12 +0100 | [diff] [blame] | 694 | 		goto err_out; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 695 |  | 
 | 696 | 	usb_fill_int_urb( | 
 | 697 | 		kaweth->irq_urb, | 
 | 698 | 		kaweth->dev, | 
 | 699 | 		usb_rcvintpipe(kaweth->dev, 3), | 
 | 700 | 		kaweth->intbuffer, | 
 | 701 | 		INTBUFFERSIZE, | 
 | 702 | 		int_callback, | 
 | 703 | 		kaweth, | 
 | 704 | 		250); /* overriding the descriptor */ | 
 | 705 | 	kaweth->irq_urb->transfer_dma = kaweth->intbufferhandle; | 
 | 706 | 	kaweth->irq_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | 
 | 707 |  | 
 | 708 | 	res = usb_submit_urb(kaweth->irq_urb, GFP_KERNEL); | 
 | 709 | 	if (res) { | 
 | 710 | 		usb_kill_urb(kaweth->rx_urb); | 
| Oliver Neukum | b98b98f | 2007-01-16 09:47:12 +0100 | [diff] [blame] | 711 | 		goto err_out; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 712 | 	} | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 713 | 	kaweth->opened = 1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 714 |  | 
 | 715 | 	netif_start_queue(net); | 
 | 716 |  | 
 | 717 | 	kaweth_async_set_rx_mode(kaweth); | 
 | 718 | 	return 0; | 
| Oliver Neukum | b98b98f | 2007-01-16 09:47:12 +0100 | [diff] [blame] | 719 |  | 
 | 720 | err_out: | 
| Oliver Neukum | ceb0c77 | 2009-12-11 21:43:00 -0800 | [diff] [blame] | 721 | 	usb_autopm_put_interface(kaweth->intf); | 
| Oliver Neukum | b98b98f | 2007-01-16 09:47:12 +0100 | [diff] [blame] | 722 | 	return -EIO; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 723 | } | 
 | 724 |  | 
 | 725 | /**************************************************************** | 
| Oliver Neukum | b98b98f | 2007-01-16 09:47:12 +0100 | [diff] [blame] | 726 |  *     kaweth_kill_urbs | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 727 |  ****************************************************************/ | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 728 | static void kaweth_kill_urbs(struct kaweth_device *kaweth) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 729 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 730 | 	usb_kill_urb(kaweth->irq_urb); | 
 | 731 | 	usb_kill_urb(kaweth->rx_urb); | 
| Herbert Xu | d23b536 | 2005-11-17 09:47:45 -0800 | [diff] [blame] | 732 | 	usb_kill_urb(kaweth->tx_urb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 733 |  | 
| David S. Miller | 4bb073c | 2008-06-12 02:22:02 -0700 | [diff] [blame] | 734 | 	cancel_delayed_work_sync(&kaweth->lowmem_work); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 735 |  | 
 | 736 | 	/* a scheduled work may have resubmitted, | 
 | 737 | 	   we hit them again */ | 
 | 738 | 	usb_kill_urb(kaweth->irq_urb); | 
 | 739 | 	usb_kill_urb(kaweth->rx_urb); | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 740 | } | 
 | 741 |  | 
 | 742 | /**************************************************************** | 
 | 743 |  *     kaweth_close | 
 | 744 |  ****************************************************************/ | 
 | 745 | static int kaweth_close(struct net_device *net) | 
 | 746 | { | 
 | 747 | 	struct kaweth_device *kaweth = netdev_priv(net); | 
 | 748 |  | 
 | 749 | 	netif_stop_queue(net); | 
 | 750 | 	kaweth->opened = 0; | 
 | 751 |  | 
 | 752 | 	kaweth->status |= KAWETH_STATUS_CLOSING; | 
 | 753 |  | 
 | 754 | 	kaweth_kill_urbs(kaweth); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 755 |  | 
 | 756 | 	kaweth->status &= ~KAWETH_STATUS_CLOSING; | 
 | 757 |  | 
| Oliver Neukum | ceb0c77 | 2009-12-11 21:43:00 -0800 | [diff] [blame] | 758 | 	usb_autopm_put_interface(kaweth->intf); | 
| Oliver Neukum | b98b98f | 2007-01-16 09:47:12 +0100 | [diff] [blame] | 759 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 760 | 	return 0; | 
 | 761 | } | 
 | 762 |  | 
| Oliver Neukum | b3ebd52 | 2007-01-16 12:01:26 +0100 | [diff] [blame] | 763 | static u32 kaweth_get_link(struct net_device *dev) | 
 | 764 | { | 
 | 765 | 	struct kaweth_device *kaweth = netdev_priv(dev); | 
 | 766 |  | 
 | 767 | 	return kaweth->linkstate; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 768 | } | 
 | 769 |  | 
| Stephen Hemminger | 0fc0b73 | 2009-09-02 01:03:33 -0700 | [diff] [blame] | 770 | static const struct ethtool_ops ops = { | 
| Oliver Neukum | b3ebd52 | 2007-01-16 12:01:26 +0100 | [diff] [blame] | 771 | 	.get_link	= kaweth_get_link | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 772 | }; | 
 | 773 |  | 
 | 774 | /**************************************************************** | 
 | 775 |  *     kaweth_usb_transmit_complete | 
 | 776 |  ****************************************************************/ | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 777 | static void kaweth_usb_transmit_complete(struct urb *urb) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 778 | { | 
 | 779 | 	struct kaweth_device *kaweth = urb->context; | 
 | 780 | 	struct sk_buff *skb = kaweth->tx_skb; | 
| Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 781 | 	int status = urb->status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 782 |  | 
| Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 783 | 	if (unlikely(status != 0)) | 
 | 784 | 		if (status != -ENOENT) | 
 | 785 | 			dbg("%s: TX status %d.", kaweth->net->name, status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 786 |  | 
 | 787 | 	netif_wake_queue(kaweth->net); | 
 | 788 | 	dev_kfree_skb_irq(skb); | 
 | 789 | } | 
 | 790 |  | 
 | 791 | /**************************************************************** | 
 | 792 |  *     kaweth_start_xmit | 
 | 793 |  ****************************************************************/ | 
| Stephen Hemminger | 25a79c4 | 2009-08-31 19:50:45 +0000 | [diff] [blame] | 794 | static netdev_tx_t kaweth_start_xmit(struct sk_buff *skb, | 
 | 795 | 					   struct net_device *net) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 796 | { | 
 | 797 | 	struct kaweth_device *kaweth = netdev_priv(net); | 
 | 798 | 	__le16 *private_header; | 
 | 799 |  | 
 | 800 | 	int res; | 
 | 801 |  | 
| Larry Finger | 4ff61c8 | 2009-04-02 01:09:43 -0700 | [diff] [blame] | 802 | 	spin_lock_irq(&kaweth->device_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 803 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 804 | 	kaweth_async_set_rx_mode(kaweth); | 
 | 805 | 	netif_stop_queue(net); | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 806 | 	if (IS_BLOCKED(kaweth->status)) { | 
 | 807 | 		goto skip; | 
 | 808 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 809 |  | 
 | 810 | 	/* We now decide whether we can put our special header into the sk_buff */ | 
 | 811 | 	if (skb_cloned(skb) || skb_headroom(skb) < 2) { | 
 | 812 | 		/* no such luck - we make our own */ | 
 | 813 | 		struct sk_buff *copied_skb; | 
 | 814 | 		copied_skb = skb_copy_expand(skb, 2, 0, GFP_ATOMIC); | 
 | 815 | 		dev_kfree_skb_irq(skb); | 
 | 816 | 		skb = copied_skb; | 
 | 817 | 		if (!copied_skb) { | 
 | 818 | 			kaweth->stats.tx_errors++; | 
 | 819 | 			netif_start_queue(net); | 
| Larry Finger | 4ff61c8 | 2009-04-02 01:09:43 -0700 | [diff] [blame] | 820 | 			spin_unlock_irq(&kaweth->device_lock); | 
| Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 821 | 			return NETDEV_TX_OK; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 822 | 		} | 
 | 823 | 	} | 
 | 824 |  | 
 | 825 | 	private_header = (__le16 *)__skb_push(skb, 2); | 
 | 826 | 	*private_header = cpu_to_le16(skb->len-2); | 
 | 827 | 	kaweth->tx_skb = skb; | 
 | 828 |  | 
 | 829 | 	usb_fill_bulk_urb(kaweth->tx_urb, | 
 | 830 | 		      kaweth->dev, | 
 | 831 | 		      usb_sndbulkpipe(kaweth->dev, 2), | 
 | 832 | 		      private_header, | 
 | 833 | 		      skb->len, | 
 | 834 | 		      kaweth_usb_transmit_complete, | 
 | 835 | 		      kaweth); | 
 | 836 | 	kaweth->end = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 837 |  | 
 | 838 | 	if((res = usb_submit_urb(kaweth->tx_urb, GFP_ATOMIC))) | 
 | 839 | 	{ | 
| Greg Kroah-Hartman | 4dc8994 | 2008-08-14 09:37:34 -0700 | [diff] [blame] | 840 | 		dev_warn(&net->dev, "kaweth failed tx_urb %d\n", res); | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 841 | skip: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 842 | 		kaweth->stats.tx_errors++; | 
 | 843 |  | 
 | 844 | 		netif_start_queue(net); | 
 | 845 | 		dev_kfree_skb_irq(skb); | 
 | 846 | 	} | 
 | 847 | 	else | 
 | 848 | 	{ | 
 | 849 | 		kaweth->stats.tx_packets++; | 
 | 850 | 		kaweth->stats.tx_bytes += skb->len; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 851 | 	} | 
 | 852 |  | 
| Larry Finger | 4ff61c8 | 2009-04-02 01:09:43 -0700 | [diff] [blame] | 853 | 	spin_unlock_irq(&kaweth->device_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 854 |  | 
| Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 855 | 	return NETDEV_TX_OK; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 856 | } | 
 | 857 |  | 
 | 858 | /**************************************************************** | 
 | 859 |  *     kaweth_set_rx_mode | 
 | 860 |  ****************************************************************/ | 
 | 861 | static void kaweth_set_rx_mode(struct net_device *net) | 
 | 862 | { | 
 | 863 | 	struct kaweth_device *kaweth = netdev_priv(net); | 
 | 864 |  | 
 | 865 | 	__u16 packet_filter_bitmap = KAWETH_PACKET_FILTER_DIRECTED | | 
 | 866 |                                      KAWETH_PACKET_FILTER_BROADCAST | | 
 | 867 | 		                     KAWETH_PACKET_FILTER_MULTICAST; | 
 | 868 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 869 | 	dbg("Setting Rx mode to %d", packet_filter_bitmap); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 870 |  | 
 | 871 | 	netif_stop_queue(net); | 
 | 872 |  | 
 | 873 | 	if (net->flags & IFF_PROMISC) { | 
 | 874 | 		packet_filter_bitmap |= KAWETH_PACKET_FILTER_PROMISCUOUS; | 
 | 875 | 	} | 
| Jiri Pirko | 4cd24ea | 2010-02-08 04:30:35 +0000 | [diff] [blame] | 876 | 	else if (!netdev_mc_empty(net) || (net->flags & IFF_ALLMULTI)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 877 | 		packet_filter_bitmap |= KAWETH_PACKET_FILTER_ALL_MULTICAST; | 
 | 878 | 	} | 
 | 879 |  | 
 | 880 | 	kaweth->packet_filter_bitmap = packet_filter_bitmap; | 
 | 881 | 	netif_wake_queue(net); | 
 | 882 | } | 
 | 883 |  | 
 | 884 | /**************************************************************** | 
 | 885 |  *     kaweth_async_set_rx_mode | 
 | 886 |  ****************************************************************/ | 
 | 887 | static void kaweth_async_set_rx_mode(struct kaweth_device *kaweth) | 
 | 888 | { | 
| Larry Finger | 710b523 | 2009-04-09 07:11:55 +0000 | [diff] [blame] | 889 | 	int result; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 890 | 	__u16 packet_filter_bitmap = kaweth->packet_filter_bitmap; | 
| Larry Finger | 710b523 | 2009-04-09 07:11:55 +0000 | [diff] [blame] | 891 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 892 | 	kaweth->packet_filter_bitmap = 0; | 
 | 893 | 	if (packet_filter_bitmap == 0) | 
 | 894 | 		return; | 
 | 895 |  | 
| Larry Finger | 710b523 | 2009-04-09 07:11:55 +0000 | [diff] [blame] | 896 | 	if (in_interrupt()) | 
 | 897 | 		return; | 
 | 898 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 899 | 	result = kaweth_control(kaweth, | 
 | 900 | 				usb_sndctrlpipe(kaweth->dev, 0), | 
 | 901 | 				KAWETH_COMMAND_SET_PACKET_FILTER, | 
 | 902 | 				USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE, | 
 | 903 | 				packet_filter_bitmap, | 
 | 904 | 				0, | 
 | 905 | 				(void *)&kaweth->scratch, | 
 | 906 | 				0, | 
 | 907 | 				KAWETH_CONTROL_TIMEOUT); | 
 | 908 |  | 
 | 909 | 	if(result < 0) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 910 | 		err("Failed to set Rx mode: %d", result); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 911 | 	} | 
 | 912 | 	else { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 913 | 		dbg("Set Rx mode to %d", packet_filter_bitmap); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 914 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 915 | } | 
 | 916 |  | 
 | 917 | /**************************************************************** | 
 | 918 |  *     kaweth_netdev_stats | 
 | 919 |  ****************************************************************/ | 
 | 920 | static struct net_device_stats *kaweth_netdev_stats(struct net_device *dev) | 
 | 921 | { | 
 | 922 | 	struct kaweth_device *kaweth = netdev_priv(dev); | 
 | 923 | 	return &kaweth->stats; | 
 | 924 | } | 
 | 925 |  | 
 | 926 | /**************************************************************** | 
 | 927 |  *     kaweth_tx_timeout | 
 | 928 |  ****************************************************************/ | 
 | 929 | static void kaweth_tx_timeout(struct net_device *net) | 
 | 930 | { | 
 | 931 | 	struct kaweth_device *kaweth = netdev_priv(net); | 
 | 932 |  | 
| Greg Kroah-Hartman | 4dc8994 | 2008-08-14 09:37:34 -0700 | [diff] [blame] | 933 | 	dev_warn(&net->dev, "%s: Tx timed out. Resetting.\n", net->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 934 | 	kaweth->stats.tx_errors++; | 
 | 935 | 	net->trans_start = jiffies; | 
 | 936 |  | 
 | 937 | 	usb_unlink_urb(kaweth->tx_urb); | 
 | 938 | } | 
 | 939 |  | 
 | 940 | /**************************************************************** | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 941 |  *     kaweth_suspend | 
 | 942 |  ****************************************************************/ | 
 | 943 | static int kaweth_suspend(struct usb_interface *intf, pm_message_t message) | 
 | 944 | { | 
 | 945 | 	struct kaweth_device *kaweth = usb_get_intfdata(intf); | 
 | 946 | 	unsigned long flags; | 
 | 947 |  | 
| Oliver Neukum | b98b98f | 2007-01-16 09:47:12 +0100 | [diff] [blame] | 948 | 	dbg("Suspending device"); | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 949 | 	spin_lock_irqsave(&kaweth->device_lock, flags); | 
 | 950 | 	kaweth->status |= KAWETH_STATUS_SUSPENDING; | 
 | 951 | 	spin_unlock_irqrestore(&kaweth->device_lock, flags); | 
 | 952 |  | 
 | 953 | 	kaweth_kill_urbs(kaweth); | 
 | 954 | 	return 0; | 
 | 955 | } | 
 | 956 |  | 
 | 957 | /**************************************************************** | 
 | 958 |  *     kaweth_resume | 
 | 959 |  ****************************************************************/ | 
 | 960 | static int kaweth_resume(struct usb_interface *intf) | 
 | 961 | { | 
 | 962 | 	struct kaweth_device *kaweth = usb_get_intfdata(intf); | 
 | 963 | 	unsigned long flags; | 
 | 964 |  | 
| Oliver Neukum | b98b98f | 2007-01-16 09:47:12 +0100 | [diff] [blame] | 965 | 	dbg("Resuming device"); | 
| Oliver Neukum | 1a2ea1d | 2006-10-03 10:30:52 +0200 | [diff] [blame] | 966 | 	spin_lock_irqsave(&kaweth->device_lock, flags); | 
 | 967 | 	kaweth->status &= ~KAWETH_STATUS_SUSPENDING; | 
 | 968 | 	spin_unlock_irqrestore(&kaweth->device_lock, flags); | 
 | 969 |  | 
 | 970 | 	if (!kaweth->opened) | 
 | 971 | 		return 0; | 
 | 972 | 	kaweth_resubmit_rx_urb(kaweth, GFP_NOIO); | 
 | 973 | 	kaweth_resubmit_int_urb(kaweth, GFP_NOIO); | 
 | 974 |  | 
 | 975 | 	return 0; | 
 | 976 | } | 
 | 977 |  | 
 | 978 | /**************************************************************** | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 979 |  *     kaweth_probe | 
 | 980 |  ****************************************************************/ | 
| Oliver Neukum | 321ea8b | 2009-01-08 11:20:22 -0800 | [diff] [blame] | 981 |  | 
 | 982 |  | 
 | 983 | static const struct net_device_ops kaweth_netdev_ops = { | 
 | 984 | 	.ndo_open =			kaweth_open, | 
 | 985 | 	.ndo_stop =			kaweth_close, | 
 | 986 | 	.ndo_start_xmit =		kaweth_start_xmit, | 
 | 987 | 	.ndo_tx_timeout =		kaweth_tx_timeout, | 
 | 988 | 	.ndo_set_multicast_list =	kaweth_set_rx_mode, | 
 | 989 | 	.ndo_get_stats =		kaweth_netdev_stats, | 
| Ben Hutchings | 635ecaa | 2009-07-09 17:59:01 +0000 | [diff] [blame] | 990 | 	.ndo_change_mtu =		eth_change_mtu, | 
| Ben Hutchings | 240c102 | 2009-07-09 17:54:35 +0000 | [diff] [blame] | 991 | 	.ndo_set_mac_address =		eth_mac_addr, | 
 | 992 | 	.ndo_validate_addr =		eth_validate_addr, | 
| Oliver Neukum | 321ea8b | 2009-01-08 11:20:22 -0800 | [diff] [blame] | 993 | }; | 
 | 994 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 995 | static int kaweth_probe( | 
 | 996 | 		struct usb_interface *intf, | 
 | 997 | 		const struct usb_device_id *id      /* from id_table */ | 
 | 998 | 	) | 
 | 999 | { | 
 | 1000 | 	struct usb_device *dev = interface_to_usbdev(intf); | 
 | 1001 | 	struct kaweth_device *kaweth; | 
 | 1002 | 	struct net_device *netdev; | 
 | 1003 | 	const eth_addr_t bcast_addr = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF }; | 
 | 1004 | 	int result = 0; | 
 | 1005 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1006 | 	dbg("Kawasaki Device Probe (Device number:%d): 0x%4.4x:0x%4.4x:0x%4.4x", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1007 | 		 dev->devnum, | 
 | 1008 | 		 le16_to_cpu(dev->descriptor.idVendor), | 
 | 1009 | 		 le16_to_cpu(dev->descriptor.idProduct), | 
 | 1010 | 		 le16_to_cpu(dev->descriptor.bcdDevice)); | 
 | 1011 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1012 | 	dbg("Device at %p", dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1013 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1014 | 	dbg("Descriptor length: %x type: %x", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1015 | 		 (int)dev->descriptor.bLength, | 
 | 1016 | 		 (int)dev->descriptor.bDescriptorType); | 
 | 1017 |  | 
 | 1018 | 	netdev = alloc_etherdev(sizeof(*kaweth)); | 
 | 1019 | 	if (!netdev) | 
 | 1020 | 		return -ENOMEM; | 
 | 1021 |  | 
 | 1022 | 	kaweth = netdev_priv(netdev); | 
 | 1023 | 	kaweth->dev = dev; | 
 | 1024 | 	kaweth->net = netdev; | 
 | 1025 |  | 
 | 1026 | 	spin_lock_init(&kaweth->device_lock); | 
 | 1027 | 	init_waitqueue_head(&kaweth->term_wait); | 
 | 1028 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1029 | 	dbg("Resetting."); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1030 |  | 
 | 1031 | 	kaweth_reset(kaweth); | 
 | 1032 |  | 
 | 1033 | 	/* | 
 | 1034 | 	 * If high byte of bcdDevice is nonzero, firmware is already | 
 | 1035 | 	 * downloaded. Don't try to do it again, or we'll hang the device. | 
 | 1036 | 	 */ | 
 | 1037 |  | 
 | 1038 | 	if (le16_to_cpu(dev->descriptor.bcdDevice) >> 8) { | 
| Greg Kroah-Hartman | 880c9c6 | 2008-08-18 13:21:04 -0700 | [diff] [blame] | 1039 | 		dev_info(&intf->dev, "Firmware present in device.\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1040 | 	} else { | 
 | 1041 | 		/* Download the firmware */ | 
| Greg Kroah-Hartman | 880c9c6 | 2008-08-18 13:21:04 -0700 | [diff] [blame] | 1042 | 		dev_info(&intf->dev, "Downloading firmware...\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1043 | 		kaweth->firmware_buf = (__u8 *)__get_free_page(GFP_KERNEL); | 
 | 1044 | 		if ((result = kaweth_download_firmware(kaweth, | 
| David Woodhouse | 7968249 | 2008-05-29 17:17:17 +0300 | [diff] [blame] | 1045 | 						      "kaweth/new_code.bin", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1046 | 						      100, | 
 | 1047 | 						      2)) < 0) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1048 | 			err("Error downloading firmware (%d)", result); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1049 | 			goto err_fw; | 
 | 1050 | 		} | 
 | 1051 |  | 
 | 1052 | 		if ((result = kaweth_download_firmware(kaweth, | 
| David Woodhouse | 7968249 | 2008-05-29 17:17:17 +0300 | [diff] [blame] | 1053 | 						      "kaweth/new_code_fix.bin", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1054 | 						      100, | 
 | 1055 | 						      3)) < 0) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1056 | 			err("Error downloading firmware fix (%d)", result); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1057 | 			goto err_fw; | 
 | 1058 | 		} | 
 | 1059 |  | 
 | 1060 | 		if ((result = kaweth_download_firmware(kaweth, | 
| David Woodhouse | 7968249 | 2008-05-29 17:17:17 +0300 | [diff] [blame] | 1061 | 						      "kaweth/trigger_code.bin", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1062 | 						      126, | 
 | 1063 | 						      2)) < 0) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1064 | 			err("Error downloading trigger code (%d)", result); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1065 | 			goto err_fw; | 
 | 1066 |  | 
 | 1067 | 		} | 
 | 1068 |  | 
 | 1069 | 		if ((result = kaweth_download_firmware(kaweth, | 
| David Woodhouse | 7968249 | 2008-05-29 17:17:17 +0300 | [diff] [blame] | 1070 | 						      "kaweth/trigger_code_fix.bin", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1071 | 						      126, | 
 | 1072 | 						      3)) < 0) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1073 | 			err("Error downloading trigger code fix (%d)", result); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1074 | 			goto err_fw; | 
 | 1075 | 		} | 
 | 1076 |  | 
 | 1077 |  | 
 | 1078 | 		if ((result = kaweth_trigger_firmware(kaweth, 126)) < 0) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1079 | 			err("Error triggering firmware (%d)", result); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1080 | 			goto err_fw; | 
 | 1081 | 		} | 
 | 1082 |  | 
 | 1083 | 		/* Device will now disappear for a moment...  */ | 
| Greg Kroah-Hartman | 880c9c6 | 2008-08-18 13:21:04 -0700 | [diff] [blame] | 1084 | 		dev_info(&intf->dev, "Firmware loaded.  I'll be back...\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1085 | err_fw: | 
 | 1086 | 		free_page((unsigned long)kaweth->firmware_buf); | 
 | 1087 | 		free_netdev(netdev); | 
 | 1088 | 		return -EIO; | 
 | 1089 | 	} | 
 | 1090 |  | 
 | 1091 | 	result = kaweth_read_configuration(kaweth); | 
 | 1092 |  | 
 | 1093 | 	if(result < 0) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1094 | 		err("Error reading configuration (%d), no net device created", result); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1095 | 		goto err_free_netdev; | 
 | 1096 | 	} | 
 | 1097 |  | 
| Greg Kroah-Hartman | 880c9c6 | 2008-08-18 13:21:04 -0700 | [diff] [blame] | 1098 | 	dev_info(&intf->dev, "Statistics collection: %x\n", kaweth->configuration.statistics_mask); | 
 | 1099 | 	dev_info(&intf->dev, "Multicast filter limit: %x\n", kaweth->configuration.max_multicast_filters & ((1 << 15) - 1)); | 
 | 1100 | 	dev_info(&intf->dev, "MTU: %d\n", le16_to_cpu(kaweth->configuration.segment_size)); | 
 | 1101 | 	dev_info(&intf->dev, "Read MAC address %2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x\n", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1102 | 		 (int)kaweth->configuration.hw_addr[0], | 
 | 1103 | 		 (int)kaweth->configuration.hw_addr[1], | 
 | 1104 | 		 (int)kaweth->configuration.hw_addr[2], | 
 | 1105 | 		 (int)kaweth->configuration.hw_addr[3], | 
 | 1106 | 		 (int)kaweth->configuration.hw_addr[4], | 
 | 1107 | 		 (int)kaweth->configuration.hw_addr[5]); | 
 | 1108 |  | 
 | 1109 | 	if(!memcmp(&kaweth->configuration.hw_addr, | 
 | 1110 |                    &bcast_addr, | 
 | 1111 | 		   sizeof(bcast_addr))) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1112 | 		err("Firmware not functioning properly, no net device created"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1113 | 		goto err_free_netdev; | 
 | 1114 | 	} | 
 | 1115 |  | 
 | 1116 | 	if(kaweth_set_urb_size(kaweth, KAWETH_BUF_SIZE) < 0) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1117 | 		dbg("Error setting URB size"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1118 | 		goto err_free_netdev; | 
 | 1119 | 	} | 
 | 1120 |  | 
 | 1121 | 	if(kaweth_set_sofs_wait(kaweth, KAWETH_SOFS_TO_WAIT) < 0) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1122 | 		err("Error setting SOFS wait"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1123 | 		goto err_free_netdev; | 
 | 1124 | 	} | 
 | 1125 |  | 
 | 1126 | 	result = kaweth_set_receive_filter(kaweth, | 
 | 1127 |                                            KAWETH_PACKET_FILTER_DIRECTED | | 
 | 1128 |                                            KAWETH_PACKET_FILTER_BROADCAST | | 
 | 1129 |                                            KAWETH_PACKET_FILTER_MULTICAST); | 
 | 1130 |  | 
 | 1131 | 	if(result < 0) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1132 | 		err("Error setting receive filter"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1133 | 		goto err_free_netdev; | 
 | 1134 | 	} | 
 | 1135 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1136 | 	dbg("Initializing net device."); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1137 |  | 
| Oliver Neukum | b98b98f | 2007-01-16 09:47:12 +0100 | [diff] [blame] | 1138 | 	kaweth->intf = intf; | 
 | 1139 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1140 | 	kaweth->tx_urb = usb_alloc_urb(0, GFP_KERNEL); | 
 | 1141 | 	if (!kaweth->tx_urb) | 
 | 1142 | 		goto err_free_netdev; | 
 | 1143 | 	kaweth->rx_urb = usb_alloc_urb(0, GFP_KERNEL); | 
 | 1144 | 	if (!kaweth->rx_urb) | 
 | 1145 | 		goto err_only_tx; | 
 | 1146 | 	kaweth->irq_urb = usb_alloc_urb(0, GFP_KERNEL); | 
 | 1147 | 	if (!kaweth->irq_urb) | 
 | 1148 | 		goto err_tx_and_rx; | 
 | 1149 |  | 
| Daniel Mack | 997ea58 | 2010-04-12 13:17:25 +0200 | [diff] [blame] | 1150 | 	kaweth->intbuffer = usb_alloc_coherent(	kaweth->dev, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1151 | 						INTBUFFERSIZE, | 
 | 1152 | 						GFP_KERNEL, | 
 | 1153 | 						&kaweth->intbufferhandle); | 
 | 1154 | 	if (!kaweth->intbuffer) | 
 | 1155 | 		goto err_tx_and_rx_and_irq; | 
| Daniel Mack | 997ea58 | 2010-04-12 13:17:25 +0200 | [diff] [blame] | 1156 | 	kaweth->rx_buf = usb_alloc_coherent(	kaweth->dev, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1157 | 						KAWETH_BUF_SIZE, | 
 | 1158 | 						GFP_KERNEL, | 
 | 1159 | 						&kaweth->rxbufferhandle); | 
 | 1160 | 	if (!kaweth->rx_buf) | 
 | 1161 | 		goto err_all_but_rxbuf; | 
 | 1162 |  | 
 | 1163 | 	memcpy(netdev->broadcast, &bcast_addr, sizeof(bcast_addr)); | 
 | 1164 | 	memcpy(netdev->dev_addr, &kaweth->configuration.hw_addr, | 
 | 1165 |                sizeof(kaweth->configuration.hw_addr)); | 
 | 1166 |  | 
| Oliver Neukum | 321ea8b | 2009-01-08 11:20:22 -0800 | [diff] [blame] | 1167 | 	netdev->netdev_ops = &kaweth_netdev_ops; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1168 | 	netdev->watchdog_timeo = KAWETH_TX_TIMEOUT; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1169 | 	netdev->mtu = le16_to_cpu(kaweth->configuration.segment_size); | 
 | 1170 | 	SET_ETHTOOL_OPS(netdev, &ops); | 
 | 1171 |  | 
 | 1172 | 	/* kaweth is zeroed as part of alloc_netdev */ | 
| David Howells | c402895 | 2006-11-22 14:57:56 +0000 | [diff] [blame] | 1173 | 	INIT_DELAYED_WORK(&kaweth->lowmem_work, kaweth_resubmit_tl); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1174 | 	usb_set_intfdata(intf, kaweth); | 
 | 1175 |  | 
 | 1176 | #if 0 | 
 | 1177 | // dma_supported() is deeply broken on almost all architectures | 
 | 1178 | 	if (dma_supported (&intf->dev, 0xffffffffffffffffULL)) | 
 | 1179 | 		kaweth->net->features |= NETIF_F_HIGHDMA; | 
 | 1180 | #endif | 
 | 1181 |  | 
 | 1182 | 	SET_NETDEV_DEV(netdev, &intf->dev); | 
 | 1183 | 	if (register_netdev(netdev) != 0) { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1184 | 		err("Error registering netdev."); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1185 | 		goto err_intfdata; | 
 | 1186 | 	} | 
 | 1187 |  | 
| Greg Kroah-Hartman | 880c9c6 | 2008-08-18 13:21:04 -0700 | [diff] [blame] | 1188 | 	dev_info(&intf->dev, "kaweth interface created at %s\n", | 
 | 1189 | 		 kaweth->net->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1190 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1191 | 	dbg("Kaweth probe returning."); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1192 |  | 
 | 1193 | 	return 0; | 
 | 1194 |  | 
 | 1195 | err_intfdata: | 
 | 1196 | 	usb_set_intfdata(intf, NULL); | 
| Daniel Mack | 997ea58 | 2010-04-12 13:17:25 +0200 | [diff] [blame] | 1197 | 	usb_free_coherent(kaweth->dev, KAWETH_BUF_SIZE, (void *)kaweth->rx_buf, kaweth->rxbufferhandle); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1198 | err_all_but_rxbuf: | 
| Daniel Mack | 997ea58 | 2010-04-12 13:17:25 +0200 | [diff] [blame] | 1199 | 	usb_free_coherent(kaweth->dev, INTBUFFERSIZE, (void *)kaweth->intbuffer, kaweth->intbufferhandle); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1200 | err_tx_and_rx_and_irq: | 
 | 1201 | 	usb_free_urb(kaweth->irq_urb); | 
 | 1202 | err_tx_and_rx: | 
 | 1203 | 	usb_free_urb(kaweth->rx_urb); | 
 | 1204 | err_only_tx: | 
 | 1205 | 	usb_free_urb(kaweth->tx_urb); | 
 | 1206 | err_free_netdev: | 
 | 1207 | 	free_netdev(netdev); | 
 | 1208 |  | 
 | 1209 | 	return -EIO; | 
 | 1210 | } | 
 | 1211 |  | 
 | 1212 | /**************************************************************** | 
 | 1213 |  *     kaweth_disconnect | 
 | 1214 |  ****************************************************************/ | 
 | 1215 | static void kaweth_disconnect(struct usb_interface *intf) | 
 | 1216 | { | 
 | 1217 | 	struct kaweth_device *kaweth = usb_get_intfdata(intf); | 
 | 1218 | 	struct net_device *netdev; | 
 | 1219 |  | 
| Greg Kroah-Hartman | 880c9c6 | 2008-08-18 13:21:04 -0700 | [diff] [blame] | 1220 | 	dev_info(&intf->dev, "Unregistering\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1221 |  | 
 | 1222 | 	usb_set_intfdata(intf, NULL); | 
 | 1223 | 	if (!kaweth) { | 
| Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 1224 | 		dev_warn(&intf->dev, "unregistering non-existent device\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1225 | 		return; | 
 | 1226 | 	} | 
 | 1227 | 	netdev = kaweth->net; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1228 |  | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1229 | 	dbg("Unregistering net device"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1230 | 	unregister_netdev(netdev); | 
 | 1231 |  | 
 | 1232 | 	usb_free_urb(kaweth->rx_urb); | 
 | 1233 | 	usb_free_urb(kaweth->tx_urb); | 
 | 1234 | 	usb_free_urb(kaweth->irq_urb); | 
 | 1235 |  | 
| Daniel Mack | 997ea58 | 2010-04-12 13:17:25 +0200 | [diff] [blame] | 1236 | 	usb_free_coherent(kaweth->dev, KAWETH_BUF_SIZE, (void *)kaweth->rx_buf, kaweth->rxbufferhandle); | 
 | 1237 | 	usb_free_coherent(kaweth->dev, INTBUFFERSIZE, (void *)kaweth->intbuffer, kaweth->intbufferhandle); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1238 |  | 
 | 1239 | 	free_netdev(netdev); | 
 | 1240 | } | 
 | 1241 |  | 
 | 1242 |  | 
 | 1243 | // FIXME this completion stuff is a modified clone of | 
 | 1244 | // an OLD version of some stuff in usb.c ... | 
 | 1245 | struct usb_api_data { | 
 | 1246 | 	wait_queue_head_t wqh; | 
 | 1247 | 	int done; | 
 | 1248 | }; | 
 | 1249 |  | 
 | 1250 | /*-------------------------------------------------------------------* | 
 | 1251 |  * completion handler for compatibility wrappers (sync control/bulk) * | 
 | 1252 |  *-------------------------------------------------------------------*/ | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 1253 | static void usb_api_blocking_completion(struct urb *urb) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1254 | { | 
 | 1255 |         struct usb_api_data *awd = (struct usb_api_data *)urb->context; | 
 | 1256 |  | 
 | 1257 | 	awd->done=1; | 
 | 1258 | 	wake_up(&awd->wqh); | 
 | 1259 | } | 
 | 1260 |  | 
 | 1261 | /*-------------------------------------------------------------------* | 
 | 1262 |  *                         COMPATIBILITY STUFF                       * | 
 | 1263 |  *-------------------------------------------------------------------*/ | 
 | 1264 |  | 
 | 1265 | // Starts urb and waits for completion or timeout | 
 | 1266 | static int usb_start_wait_urb(struct urb *urb, int timeout, int* actual_length) | 
 | 1267 | { | 
 | 1268 | 	struct usb_api_data awd; | 
 | 1269 |         int status; | 
 | 1270 |  | 
 | 1271 |         init_waitqueue_head(&awd.wqh); | 
 | 1272 |         awd.done = 0; | 
 | 1273 |  | 
 | 1274 |         urb->context = &awd; | 
 | 1275 |         status = usb_submit_urb(urb, GFP_NOIO); | 
 | 1276 |         if (status) { | 
 | 1277 |                 // something went wrong | 
 | 1278 |                 usb_free_urb(urb); | 
 | 1279 |                 return status; | 
 | 1280 |         } | 
 | 1281 |  | 
 | 1282 | 	if (!wait_event_timeout(awd.wqh, awd.done, timeout)) { | 
 | 1283 |                 // timeout | 
| Greg Kroah-Hartman | 4dc8994 | 2008-08-14 09:37:34 -0700 | [diff] [blame] | 1284 |                 dev_warn(&urb->dev->dev, "usb_control/bulk_msg: timeout\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1285 |                 usb_kill_urb(urb);  // remove urb safely | 
 | 1286 |                 status = -ETIMEDOUT; | 
 | 1287 |         } | 
 | 1288 | 	else { | 
 | 1289 |                 status = urb->status; | 
 | 1290 | 	} | 
 | 1291 |  | 
 | 1292 |         if (actual_length) { | 
 | 1293 |                 *actual_length = urb->actual_length; | 
 | 1294 | 	} | 
 | 1295 |  | 
 | 1296 |         usb_free_urb(urb); | 
 | 1297 |         return status; | 
 | 1298 | } | 
 | 1299 |  | 
 | 1300 | /*-------------------------------------------------------------------*/ | 
 | 1301 | // returns status (negative) or length (positive) | 
 | 1302 | static int kaweth_internal_control_msg(struct usb_device *usb_dev, | 
 | 1303 | 				       unsigned int pipe, | 
 | 1304 | 				       struct usb_ctrlrequest *cmd, void *data, | 
 | 1305 | 				       int len, int timeout) | 
 | 1306 | { | 
 | 1307 |         struct urb *urb; | 
 | 1308 |         int retv; | 
| Oliver Neukum | b98b98f | 2007-01-16 09:47:12 +0100 | [diff] [blame] | 1309 |         int length = 0; /* shut up GCC */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1310 |  | 
 | 1311 |         urb = usb_alloc_urb(0, GFP_NOIO); | 
 | 1312 |         if (!urb) | 
 | 1313 |                 return -ENOMEM; | 
 | 1314 |  | 
 | 1315 |         usb_fill_control_urb(urb, usb_dev, pipe, (unsigned char*)cmd, data, | 
 | 1316 | 			 len, usb_api_blocking_completion, NULL); | 
 | 1317 |  | 
 | 1318 |         retv = usb_start_wait_urb(urb, timeout, &length); | 
 | 1319 |         if (retv < 0) { | 
 | 1320 |                 return retv; | 
 | 1321 | 	} | 
 | 1322 |         else { | 
 | 1323 |                 return length; | 
 | 1324 | 	} | 
 | 1325 | } | 
 | 1326 |  | 
 | 1327 |  | 
 | 1328 | /**************************************************************** | 
 | 1329 |  *     kaweth_init | 
 | 1330 |  ****************************************************************/ | 
 | 1331 | static int __init kaweth_init(void) | 
 | 1332 | { | 
| Oliver Neukum | fbe2baf | 2006-09-28 23:36:04 +0200 | [diff] [blame] | 1333 | 	dbg("Driver loading"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1334 | 	return usb_register(&kaweth_driver); | 
 | 1335 | } | 
 | 1336 |  | 
 | 1337 | /**************************************************************** | 
 | 1338 |  *     kaweth_exit | 
 | 1339 |  ****************************************************************/ | 
 | 1340 | static void __exit kaweth_exit(void) | 
 | 1341 | { | 
 | 1342 | 	usb_deregister(&kaweth_driver); | 
 | 1343 | } | 
 | 1344 |  | 
 | 1345 | module_init(kaweth_init); | 
 | 1346 | module_exit(kaweth_exit); | 
 | 1347 |  | 
 | 1348 |  | 
 | 1349 |  | 
 | 1350 |  | 
 | 1351 |  | 
 | 1352 |  | 
 | 1353 |  | 
 | 1354 |  | 
 | 1355 |  |