| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1 | /* | 
 | 2 |  * ASIX AX8817X based USB 2.0 Ethernet Devices | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 3 |  * Copyright (C) 2003-2006 David Hollis <dhollis@davehollis.com> | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 4 |  * Copyright (C) 2005 Phil Chang <pchang23@sbcglobal.net> | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 5 |  * Copyright (C) 2006 James Painter <jamie.painter@iname.com> | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 6 |  * Copyright (c) 2002-2003 TiVo Inc. | 
 | 7 |  * | 
 | 8 |  * This program is free software; you can redistribute it and/or modify | 
 | 9 |  * it under the terms of the GNU General Public License as published by | 
 | 10 |  * the Free Software Foundation; either version 2 of the License, or | 
 | 11 |  * (at your option) any later version. | 
 | 12 |  * | 
 | 13 |  * This program is distributed in the hope that it will be useful, | 
 | 14 |  * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
 | 15 |  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
 | 16 |  * GNU General Public License for more details. | 
 | 17 |  * | 
 | 18 |  * You should have received a copy of the GNU General Public License | 
 | 19 |  * along with this program; if not, write to the Free Software | 
 | 20 |  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA | 
 | 21 |  */ | 
 | 22 |  | 
 | 23 | // #define	DEBUG			// error path messages, extra info | 
 | 24 | // #define	VERBOSE			// more; success messages | 
 | 25 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 26 | #include <linux/module.h> | 
 | 27 | #include <linux/kmod.h> | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 28 | #include <linux/init.h> | 
 | 29 | #include <linux/netdevice.h> | 
 | 30 | #include <linux/etherdevice.h> | 
 | 31 | #include <linux/ethtool.h> | 
 | 32 | #include <linux/workqueue.h> | 
 | 33 | #include <linux/mii.h> | 
 | 34 | #include <linux/usb.h> | 
 | 35 | #include <linux/crc32.h> | 
| Jussi Kivilinna | 3692e94 | 2008-01-26 00:51:45 +0200 | [diff] [blame] | 36 | #include <linux/usb/usbnet.h> | 
| Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 37 | #include <linux/slab.h> | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 38 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 39 | #define DRIVER_VERSION "14-Jun-2006" | 
 | 40 | static const char driver_name [] = "asix"; | 
 | 41 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 42 | /* ASIX AX8817X based USB 2.0 Ethernet Devices */ | 
 | 43 |  | 
 | 44 | #define AX_CMD_SET_SW_MII		0x06 | 
 | 45 | #define AX_CMD_READ_MII_REG		0x07 | 
 | 46 | #define AX_CMD_WRITE_MII_REG		0x08 | 
 | 47 | #define AX_CMD_SET_HW_MII		0x0a | 
 | 48 | #define AX_CMD_READ_EEPROM		0x0b | 
 | 49 | #define AX_CMD_WRITE_EEPROM		0x0c | 
 | 50 | #define AX_CMD_WRITE_ENABLE		0x0d | 
 | 51 | #define AX_CMD_WRITE_DISABLE		0x0e | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 52 | #define AX_CMD_READ_RX_CTL		0x0f | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 53 | #define AX_CMD_WRITE_RX_CTL		0x10 | 
 | 54 | #define AX_CMD_READ_IPG012		0x11 | 
 | 55 | #define AX_CMD_WRITE_IPG0		0x12 | 
 | 56 | #define AX_CMD_WRITE_IPG1		0x13 | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 57 | #define AX_CMD_READ_NODE_ID		0x13 | 
| Jussi Kivilinna | 7f29a3b | 2010-03-09 12:24:38 +0000 | [diff] [blame] | 58 | #define AX_CMD_WRITE_NODE_ID		0x14 | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 59 | #define AX_CMD_WRITE_IPG2		0x14 | 
 | 60 | #define AX_CMD_WRITE_MULTI_FILTER	0x16 | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 61 | #define AX88172_CMD_READ_NODE_ID	0x17 | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 62 | #define AX_CMD_READ_PHY_ID		0x19 | 
 | 63 | #define AX_CMD_READ_MEDIUM_STATUS	0x1a | 
 | 64 | #define AX_CMD_WRITE_MEDIUM_MODE	0x1b | 
 | 65 | #define AX_CMD_READ_MONITOR_MODE	0x1c | 
 | 66 | #define AX_CMD_WRITE_MONITOR_MODE	0x1d | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 67 | #define AX_CMD_READ_GPIOS		0x1e | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 68 | #define AX_CMD_WRITE_GPIOS		0x1f | 
 | 69 | #define AX_CMD_SW_RESET			0x20 | 
 | 70 | #define AX_CMD_SW_PHY_STATUS		0x21 | 
 | 71 | #define AX_CMD_SW_PHY_SELECT		0x22 | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 72 |  | 
 | 73 | #define AX_MONITOR_MODE			0x01 | 
 | 74 | #define AX_MONITOR_LINK			0x02 | 
 | 75 | #define AX_MONITOR_MAGIC		0x04 | 
 | 76 | #define AX_MONITOR_HSFS			0x10 | 
 | 77 |  | 
 | 78 | /* AX88172 Medium Status Register values */ | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 79 | #define AX88172_MEDIUM_FD		0x02 | 
 | 80 | #define AX88172_MEDIUM_TX		0x04 | 
 | 81 | #define AX88172_MEDIUM_FC		0x10 | 
 | 82 | #define AX88172_MEDIUM_DEFAULT \ | 
 | 83 | 		( AX88172_MEDIUM_FD | AX88172_MEDIUM_TX | AX88172_MEDIUM_FC ) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 84 |  | 
 | 85 | #define AX_MCAST_FILTER_SIZE		8 | 
 | 86 | #define AX_MAX_MCAST			64 | 
 | 87 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 88 | #define AX_SWRESET_CLEAR		0x00 | 
 | 89 | #define AX_SWRESET_RR			0x01 | 
 | 90 | #define AX_SWRESET_RT			0x02 | 
 | 91 | #define AX_SWRESET_PRTE			0x04 | 
 | 92 | #define AX_SWRESET_PRL			0x08 | 
 | 93 | #define AX_SWRESET_BZ			0x10 | 
 | 94 | #define AX_SWRESET_IPRL			0x20 | 
 | 95 | #define AX_SWRESET_IPPD			0x40 | 
 | 96 |  | 
 | 97 | #define AX88772_IPG0_DEFAULT		0x15 | 
 | 98 | #define AX88772_IPG1_DEFAULT		0x0c | 
 | 99 | #define AX88772_IPG2_DEFAULT		0x12 | 
 | 100 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 101 | /* AX88772 & AX88178 Medium Mode Register */ | 
 | 102 | #define AX_MEDIUM_PF		0x0080 | 
 | 103 | #define AX_MEDIUM_JFE		0x0040 | 
 | 104 | #define AX_MEDIUM_TFC		0x0020 | 
 | 105 | #define AX_MEDIUM_RFC		0x0010 | 
 | 106 | #define AX_MEDIUM_ENCK		0x0008 | 
 | 107 | #define AX_MEDIUM_AC		0x0004 | 
 | 108 | #define AX_MEDIUM_FD		0x0002 | 
 | 109 | #define AX_MEDIUM_GM		0x0001 | 
 | 110 | #define AX_MEDIUM_SM		0x1000 | 
 | 111 | #define AX_MEDIUM_SBP		0x0800 | 
 | 112 | #define AX_MEDIUM_PS		0x0200 | 
 | 113 | #define AX_MEDIUM_RE		0x0100 | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 114 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 115 | #define AX88178_MEDIUM_DEFAULT	\ | 
 | 116 | 	(AX_MEDIUM_PS | AX_MEDIUM_FD | AX_MEDIUM_AC | \ | 
 | 117 | 	 AX_MEDIUM_RFC | AX_MEDIUM_TFC | AX_MEDIUM_JFE | \ | 
 | 118 | 	 AX_MEDIUM_RE ) | 
 | 119 |  | 
 | 120 | #define AX88772_MEDIUM_DEFAULT	\ | 
 | 121 | 	(AX_MEDIUM_FD | AX_MEDIUM_RFC | \ | 
 | 122 | 	 AX_MEDIUM_TFC | AX_MEDIUM_PS | \ | 
 | 123 | 	 AX_MEDIUM_AC | AX_MEDIUM_RE ) | 
 | 124 |  | 
 | 125 | /* AX88772 & AX88178 RX_CTL values */ | 
 | 126 | #define AX_RX_CTL_SO			0x0080 | 
 | 127 | #define AX_RX_CTL_AP			0x0020 | 
 | 128 | #define AX_RX_CTL_AM			0x0010 | 
 | 129 | #define AX_RX_CTL_AB			0x0008 | 
 | 130 | #define AX_RX_CTL_SEP			0x0004 | 
 | 131 | #define AX_RX_CTL_AMALL			0x0002 | 
 | 132 | #define AX_RX_CTL_PRO			0x0001 | 
 | 133 | #define AX_RX_CTL_MFB_2048		0x0000 | 
 | 134 | #define AX_RX_CTL_MFB_4096		0x0100 | 
 | 135 | #define AX_RX_CTL_MFB_8192		0x0200 | 
 | 136 | #define AX_RX_CTL_MFB_16384		0x0300 | 
 | 137 |  | 
 | 138 | #define AX_DEFAULT_RX_CTL	\ | 
 | 139 | 	(AX_RX_CTL_SO | AX_RX_CTL_AB ) | 
 | 140 |  | 
 | 141 | /* GPIO 0 .. 2 toggles */ | 
 | 142 | #define AX_GPIO_GPO0EN		0x01	/* GPIO0 Output enable */ | 
 | 143 | #define AX_GPIO_GPO_0		0x02	/* GPIO0 Output value */ | 
 | 144 | #define AX_GPIO_GPO1EN		0x04	/* GPIO1 Output enable */ | 
 | 145 | #define AX_GPIO_GPO_1		0x08	/* GPIO1 Output value */ | 
 | 146 | #define AX_GPIO_GPO2EN		0x10	/* GPIO2 Output enable */ | 
 | 147 | #define AX_GPIO_GPO_2		0x20	/* GPIO2 Output value */ | 
 | 148 | #define AX_GPIO_RESERVED	0x40	/* Reserved */ | 
 | 149 | #define AX_GPIO_RSE		0x80	/* Reload serial EEPROM */ | 
 | 150 |  | 
 | 151 | #define AX_EEPROM_MAGIC		0xdeadbeef | 
 | 152 | #define AX88172_EEPROM_LEN	0x40 | 
 | 153 | #define AX88772_EEPROM_LEN	0xff | 
 | 154 |  | 
 | 155 | #define PHY_MODE_MARVELL	0x0000 | 
 | 156 | #define MII_MARVELL_LED_CTRL	0x0018 | 
 | 157 | #define MII_MARVELL_STATUS	0x001b | 
 | 158 | #define MII_MARVELL_CTRL	0x0014 | 
 | 159 |  | 
 | 160 | #define MARVELL_LED_MANUAL	0x0019 | 
 | 161 |  | 
 | 162 | #define MARVELL_STATUS_HWCFG	0x0004 | 
 | 163 |  | 
 | 164 | #define MARVELL_CTRL_TXDELAY	0x0002 | 
 | 165 | #define MARVELL_CTRL_RXDELAY	0x0080 | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 166 |  | 
 | 167 | /* This structure cannot exceed sizeof(unsigned long [5]) AKA 20 bytes */ | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 168 | struct asix_data { | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 169 | 	u8 multi_filter[AX_MCAST_FILTER_SIZE]; | 
| Jussi Kivilinna | 7f29a3b | 2010-03-09 12:24:38 +0000 | [diff] [blame] | 170 | 	u8 mac_addr[ETH_ALEN]; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 171 | 	u8 phymode; | 
 | 172 | 	u8 ledmode; | 
 | 173 | 	u8 eeprom_len; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 174 | }; | 
 | 175 |  | 
 | 176 | struct ax88172_int_data { | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 177 | 	__le16 res1; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 178 | 	u8 link; | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 179 | 	__le16 res2; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 180 | 	u8 status; | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 181 | 	__le16 res3; | 
| Eric Dumazet | ba2d358 | 2010-06-02 18:10:09 +0000 | [diff] [blame] | 182 | } __packed; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 183 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 184 | static int asix_read_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 185 | 			    u16 size, void *data) | 
 | 186 | { | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 187 | 	void *buf; | 
 | 188 | 	int err = -ENOMEM; | 
 | 189 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 190 | 	netdev_dbg(dev->net, "asix_read_cmd() cmd=0x%02x value=0x%04x index=0x%04x size=%d\n", | 
 | 191 | 		   cmd, value, index, size); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 192 |  | 
 | 193 | 	buf = kmalloc(size, GFP_KERNEL); | 
 | 194 | 	if (!buf) | 
 | 195 | 		goto out; | 
 | 196 |  | 
 | 197 | 	err = usb_control_msg( | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 198 | 		dev->udev, | 
 | 199 | 		usb_rcvctrlpipe(dev->udev, 0), | 
 | 200 | 		cmd, | 
 | 201 | 		USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, | 
 | 202 | 		value, | 
 | 203 | 		index, | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 204 | 		buf, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 205 | 		size, | 
 | 206 | 		USB_CTRL_GET_TIMEOUT); | 
| Russ Dill | 94d4336 | 2008-01-09 21:32:07 -0700 | [diff] [blame] | 207 | 	if (err == size) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 208 | 		memcpy(data, buf, size); | 
| Russ Dill | 94d4336 | 2008-01-09 21:32:07 -0700 | [diff] [blame] | 209 | 	else if (err >= 0) | 
 | 210 | 		err = -EINVAL; | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 211 | 	kfree(buf); | 
 | 212 |  | 
 | 213 | out: | 
 | 214 | 	return err; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 215 | } | 
 | 216 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 217 | static int asix_write_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 218 | 			     u16 size, void *data) | 
 | 219 | { | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 220 | 	void *buf = NULL; | 
 | 221 | 	int err = -ENOMEM; | 
 | 222 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 223 | 	netdev_dbg(dev->net, "asix_write_cmd() cmd=0x%02x value=0x%04x index=0x%04x size=%d\n", | 
 | 224 | 		   cmd, value, index, size); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 225 |  | 
 | 226 | 	if (data) { | 
| Julia Lawall | 99bf236 | 2010-05-15 11:20:45 +0000 | [diff] [blame] | 227 | 		buf = kmemdup(data, size, GFP_KERNEL); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 228 | 		if (!buf) | 
 | 229 | 			goto out; | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 230 | 	} | 
 | 231 |  | 
 | 232 | 	err = usb_control_msg( | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 233 | 		dev->udev, | 
 | 234 | 		usb_sndctrlpipe(dev->udev, 0), | 
 | 235 | 		cmd, | 
 | 236 | 		USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, | 
 | 237 | 		value, | 
 | 238 | 		index, | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 239 | 		buf, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 240 | 		size, | 
 | 241 | 		USB_CTRL_SET_TIMEOUT); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 242 | 	kfree(buf); | 
 | 243 |  | 
 | 244 | out: | 
 | 245 | 	return err; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 246 | } | 
 | 247 |  | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 248 | static void asix_async_cmd_callback(struct urb *urb) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 249 | { | 
 | 250 | 	struct usb_ctrlrequest *req = (struct usb_ctrlrequest *)urb->context; | 
| Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 251 | 	int status = urb->status; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 252 |  | 
| Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 253 | 	if (status < 0) | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 254 | 		printk(KERN_DEBUG "asix_async_cmd_callback() failed with %d", | 
| Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 255 | 			status); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 256 |  | 
 | 257 | 	kfree(req); | 
 | 258 | 	usb_free_urb(urb); | 
 | 259 | } | 
 | 260 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 261 | static void | 
 | 262 | asix_write_cmd_async(struct usbnet *dev, u8 cmd, u16 value, u16 index, | 
 | 263 | 				    u16 size, void *data) | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 264 | { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 265 | 	struct usb_ctrlrequest *req; | 
 | 266 | 	int status; | 
 | 267 | 	struct urb *urb; | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 268 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 269 | 	netdev_dbg(dev->net, "asix_write_cmd_async() cmd=0x%02x value=0x%04x index=0x%04x size=%d\n", | 
 | 270 | 		   cmd, value, index, size); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 271 | 	if ((urb = usb_alloc_urb(0, GFP_ATOMIC)) == NULL) { | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 272 | 		netdev_err(dev->net, "Error allocating URB in write_cmd_async!\n"); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 273 | 		return; | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 274 | 	} | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 275 |  | 
 | 276 | 	if ((req = kmalloc(sizeof(struct usb_ctrlrequest), GFP_ATOMIC)) == NULL) { | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 277 | 		netdev_err(dev->net, "Failed to allocate memory for control request\n"); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 278 | 		usb_free_urb(urb); | 
 | 279 | 		return; | 
 | 280 | 	} | 
 | 281 |  | 
 | 282 | 	req->bRequestType = USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE; | 
 | 283 | 	req->bRequest = cmd; | 
| Oliver Neukum | 9aa742e | 2006-11-23 12:45:31 +0100 | [diff] [blame] | 284 | 	req->wValue = cpu_to_le16(value); | 
 | 285 | 	req->wIndex = cpu_to_le16(index); | 
 | 286 | 	req->wLength = cpu_to_le16(size); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 287 |  | 
 | 288 | 	usb_fill_control_urb(urb, dev->udev, | 
 | 289 | 			     usb_sndctrlpipe(dev->udev, 0), | 
 | 290 | 			     (void *)req, data, size, | 
 | 291 | 			     asix_async_cmd_callback, req); | 
 | 292 |  | 
 | 293 | 	if((status = usb_submit_urb(urb, GFP_ATOMIC)) < 0) { | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 294 | 		netdev_err(dev->net, "Error submitting the control message: status=%d\n", | 
 | 295 | 			   status); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 296 | 		kfree(req); | 
 | 297 | 		usb_free_urb(urb); | 
 | 298 | 	} | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 299 | } | 
 | 300 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 301 | static int asix_rx_fixup(struct usbnet *dev, struct sk_buff *skb) | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 302 | { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 303 | 	u8  *head; | 
 | 304 | 	u32  header; | 
 | 305 | 	char *packet; | 
 | 306 | 	struct sk_buff *ax_skb; | 
 | 307 | 	u16 size; | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 308 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 309 | 	head = (u8 *) skb->data; | 
 | 310 | 	memcpy(&header, head, sizeof(header)); | 
 | 311 | 	le32_to_cpus(&header); | 
 | 312 | 	packet = head + sizeof(header); | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 313 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 314 | 	skb_pull(skb, 4); | 
 | 315 |  | 
 | 316 | 	while (skb->len > 0) { | 
 | 317 | 		if ((short)(header & 0x0000ffff) != | 
 | 318 | 		    ~((short)((header & 0xffff0000) >> 16))) { | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 319 | 			netdev_err(dev->net, "asix_rx_fixup() Bad Header Length\n"); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 320 | 		} | 
 | 321 | 		/* get the packet length */ | 
 | 322 | 		size = (u16) (header & 0x0000ffff); | 
 | 323 |  | 
| Neil Jones | 3f78d1f | 2010-05-17 17:18:28 -0700 | [diff] [blame] | 324 | 		if ((skb->len) - ((size + 1) & 0xfffe) == 0) { | 
| David S. Miller | f925b13 | 2010-05-25 16:24:03 -0700 | [diff] [blame] | 325 | 			u8 alignment = (unsigned long)skb->data & 0x3; | 
| Neil Jones | 3f78d1f | 2010-05-17 17:18:28 -0700 | [diff] [blame] | 326 | 			if (alignment != 0x2) { | 
 | 327 | 				/* | 
 | 328 | 				 * not 16bit aligned so use the room provided by | 
 | 329 | 				 * the 32 bit header to align the data | 
 | 330 | 				 * | 
 | 331 | 				 * note we want 16bit alignment as MAC header is | 
 | 332 | 				 * 14bytes thus ip header will be aligned on | 
 | 333 | 				 * 32bit boundary so accessing ipheader elements | 
 | 334 | 				 * using a cast to struct ip header wont cause | 
 | 335 | 				 * an unaligned accesses. | 
 | 336 | 				 */ | 
 | 337 | 				u8 realignment = (alignment + 2) & 0x3; | 
 | 338 | 				memmove(skb->data - realignment, | 
 | 339 | 					skb->data, | 
 | 340 | 					size); | 
 | 341 | 				skb->data -= realignment; | 
 | 342 | 				skb_set_tail_pointer(skb, size); | 
 | 343 | 			} | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 344 | 			return 2; | 
| Neil Jones | 3f78d1f | 2010-05-17 17:18:28 -0700 | [diff] [blame] | 345 | 		} | 
 | 346 |  | 
| Jussi Kivilinna | 9227a46 | 2010-06-07 00:56:27 -0700 | [diff] [blame] | 347 | 		if (size > dev->net->mtu + ETH_HLEN) { | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 348 | 			netdev_err(dev->net, "asix_rx_fixup() Bad RX Length %d\n", | 
 | 349 | 				   size); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 350 | 			return 0; | 
 | 351 | 		} | 
 | 352 | 		ax_skb = skb_clone(skb, GFP_ATOMIC); | 
 | 353 | 		if (ax_skb) { | 
| David S. Miller | f925b13 | 2010-05-25 16:24:03 -0700 | [diff] [blame] | 354 | 			u8 alignment = (unsigned long)packet & 0x3; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 355 | 			ax_skb->len = size; | 
| Neil Jones | 3f78d1f | 2010-05-17 17:18:28 -0700 | [diff] [blame] | 356 |  | 
 | 357 | 			if (alignment != 0x2) { | 
 | 358 | 				/* | 
 | 359 | 				 * not 16bit aligned use the room provided by | 
 | 360 | 				 * the 32 bit header to align the data | 
 | 361 | 				 */ | 
 | 362 | 				u8 realignment = (alignment + 2) & 0x3; | 
 | 363 | 				memmove(packet - realignment, packet, size); | 
 | 364 | 				packet -= realignment; | 
 | 365 | 			} | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 366 | 			ax_skb->data = packet; | 
| Arnaldo Carvalho de Melo | 27a884d | 2007-04-19 20:29:13 -0700 | [diff] [blame] | 367 | 			skb_set_tail_pointer(ax_skb, size); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 368 | 			usbnet_skb_return(dev, ax_skb); | 
 | 369 | 		} else { | 
 | 370 | 			return 0; | 
 | 371 | 		} | 
 | 372 |  | 
 | 373 | 		skb_pull(skb, (size + 1) & 0xfffe); | 
 | 374 |  | 
 | 375 | 		if (skb->len == 0) | 
 | 376 | 			break; | 
 | 377 |  | 
 | 378 | 		head = (u8 *) skb->data; | 
 | 379 | 		memcpy(&header, head, sizeof(header)); | 
 | 380 | 		le32_to_cpus(&header); | 
 | 381 | 		packet = head + sizeof(header); | 
 | 382 | 		skb_pull(skb, 4); | 
 | 383 | 	} | 
 | 384 |  | 
 | 385 | 	if (skb->len < 0) { | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 386 | 		netdev_err(dev->net, "asix_rx_fixup() Bad SKB Length %d\n", | 
 | 387 | 			   skb->len); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 388 | 		return 0; | 
 | 389 | 	} | 
 | 390 | 	return 1; | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 391 | } | 
 | 392 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 393 | static struct sk_buff *asix_tx_fixup(struct usbnet *dev, struct sk_buff *skb, | 
 | 394 | 					gfp_t flags) | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 395 | { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 396 | 	int padlen; | 
 | 397 | 	int headroom = skb_headroom(skb); | 
 | 398 | 	int tailroom = skb_tailroom(skb); | 
 | 399 | 	u32 packet_len; | 
 | 400 | 	u32 padbytes = 0xffff0000; | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 401 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 402 | 	padlen = ((skb->len + 4) % 512) ? 0 : 4; | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 403 |  | 
| Joe Perches | 8e95a20 | 2009-12-03 07:58:21 +0000 | [diff] [blame] | 404 | 	if ((!skb_cloned(skb)) && | 
 | 405 | 	    ((headroom + tailroom) >= (4 + padlen))) { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 406 | 		if ((headroom < 4) || (tailroom < padlen)) { | 
 | 407 | 			skb->data = memmove(skb->head + 4, skb->data, skb->len); | 
| Arnaldo Carvalho de Melo | 27a884d | 2007-04-19 20:29:13 -0700 | [diff] [blame] | 408 | 			skb_set_tail_pointer(skb, skb->len); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 409 | 		} | 
 | 410 | 	} else { | 
 | 411 | 		struct sk_buff *skb2; | 
 | 412 | 		skb2 = skb_copy_expand(skb, 4, padlen, flags); | 
 | 413 | 		dev_kfree_skb_any(skb); | 
 | 414 | 		skb = skb2; | 
 | 415 | 		if (!skb) | 
 | 416 | 			return NULL; | 
 | 417 | 	} | 
 | 418 |  | 
 | 419 | 	skb_push(skb, 4); | 
 | 420 | 	packet_len = (((skb->len - 4) ^ 0x0000ffff) << 16) + (skb->len - 4); | 
| David Hollis | 57e4f04 | 2007-02-05 12:03:03 -0500 | [diff] [blame] | 421 | 	cpu_to_le32s(&packet_len); | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 422 | 	skb_copy_to_linear_data(skb, &packet_len, sizeof(packet_len)); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 423 |  | 
 | 424 | 	if ((skb->len % 512) == 0) { | 
| David Hollis | 57e4f04 | 2007-02-05 12:03:03 -0500 | [diff] [blame] | 425 | 		cpu_to_le32s(&padbytes); | 
| Arnaldo Carvalho de Melo | 27a884d | 2007-04-19 20:29:13 -0700 | [diff] [blame] | 426 | 		memcpy(skb_tail_pointer(skb), &padbytes, sizeof(padbytes)); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 427 | 		skb_put(skb, sizeof(padbytes)); | 
 | 428 | 	} | 
 | 429 | 	return skb; | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 430 | } | 
 | 431 |  | 
 | 432 | static void asix_status(struct usbnet *dev, struct urb *urb) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 433 | { | 
 | 434 | 	struct ax88172_int_data *event; | 
 | 435 | 	int link; | 
 | 436 |  | 
 | 437 | 	if (urb->actual_length < 8) | 
 | 438 | 		return; | 
 | 439 |  | 
 | 440 | 	event = urb->transfer_buffer; | 
 | 441 | 	link = event->link & 0x01; | 
 | 442 | 	if (netif_carrier_ok(dev->net) != link) { | 
 | 443 | 		if (link) { | 
 | 444 | 			netif_carrier_on(dev->net); | 
 | 445 | 			usbnet_defer_kevent (dev, EVENT_LINK_RESET ); | 
 | 446 | 		} else | 
 | 447 | 			netif_carrier_off(dev->net); | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 448 | 		netdev_dbg(dev->net, "Link Status is: %d\n", link); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 449 | 	} | 
 | 450 | } | 
 | 451 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 452 | static inline int asix_set_sw_mii(struct usbnet *dev) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 453 | { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 454 | 	int ret; | 
 | 455 | 	ret = asix_write_cmd(dev, AX_CMD_SET_SW_MII, 0x0000, 0, 0, NULL); | 
 | 456 | 	if (ret < 0) | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 457 | 		netdev_err(dev->net, "Failed to enable software MII access\n"); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 458 | 	return ret; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 459 | } | 
 | 460 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 461 | static inline int asix_set_hw_mii(struct usbnet *dev) | 
 | 462 | { | 
 | 463 | 	int ret; | 
 | 464 | 	ret = asix_write_cmd(dev, AX_CMD_SET_HW_MII, 0x0000, 0, 0, NULL); | 
 | 465 | 	if (ret < 0) | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 466 | 		netdev_err(dev->net, "Failed to enable hardware MII access\n"); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 467 | 	return ret; | 
 | 468 | } | 
 | 469 |  | 
 | 470 | static inline int asix_get_phy_addr(struct usbnet *dev) | 
 | 471 | { | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 472 | 	u8 buf[2]; | 
 | 473 | 	int ret = asix_read_cmd(dev, AX_CMD_READ_PHY_ID, 0, 0, 2, buf); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 474 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 475 | 	netdev_dbg(dev->net, "asix_get_phy_addr()\n"); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 476 |  | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 477 | 	if (ret < 0) { | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 478 | 		netdev_err(dev->net, "Error reading PHYID register: %02x\n", ret); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 479 | 		goto out; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 480 | 	} | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 481 | 	netdev_dbg(dev->net, "asix_get_phy_addr() returning 0x%04x\n", | 
 | 482 | 		   *((__le16 *)buf)); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 483 | 	ret = buf[1]; | 
 | 484 |  | 
 | 485 | out: | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 486 | 	return ret; | 
 | 487 | } | 
 | 488 |  | 
 | 489 | static int asix_sw_reset(struct usbnet *dev, u8 flags) | 
 | 490 | { | 
 | 491 | 	int ret; | 
 | 492 |  | 
 | 493 |         ret = asix_write_cmd(dev, AX_CMD_SW_RESET, flags, 0, 0, NULL); | 
 | 494 | 	if (ret < 0) | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 495 | 		netdev_err(dev->net, "Failed to send software reset: %02x\n", ret); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 496 |  | 
 | 497 | 	return ret; | 
 | 498 | } | 
 | 499 |  | 
 | 500 | static u16 asix_read_rx_ctl(struct usbnet *dev) | 
 | 501 | { | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 502 | 	__le16 v; | 
 | 503 | 	int ret = asix_read_cmd(dev, AX_CMD_READ_RX_CTL, 0, 0, 2, &v); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 504 |  | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 505 | 	if (ret < 0) { | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 506 | 		netdev_err(dev->net, "Error reading RX_CTL register: %02x\n", ret); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 507 | 		goto out; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 508 | 	} | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 509 | 	ret = le16_to_cpu(v); | 
 | 510 | out: | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 511 | 	return ret; | 
 | 512 | } | 
 | 513 |  | 
 | 514 | static int asix_write_rx_ctl(struct usbnet *dev, u16 mode) | 
 | 515 | { | 
 | 516 | 	int ret; | 
 | 517 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 518 | 	netdev_dbg(dev->net, "asix_write_rx_ctl() - mode = 0x%04x\n", mode); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 519 | 	ret = asix_write_cmd(dev, AX_CMD_WRITE_RX_CTL, mode, 0, 0, NULL); | 
 | 520 | 	if (ret < 0) | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 521 | 		netdev_err(dev->net, "Failed to write RX_CTL mode to 0x%04x: %02x\n", | 
 | 522 | 			   mode, ret); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 523 |  | 
 | 524 | 	return ret; | 
 | 525 | } | 
 | 526 |  | 
 | 527 | static u16 asix_read_medium_status(struct usbnet *dev) | 
 | 528 | { | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 529 | 	__le16 v; | 
 | 530 | 	int ret = asix_read_cmd(dev, AX_CMD_READ_MEDIUM_STATUS, 0, 0, 2, &v); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 531 |  | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 532 | 	if (ret < 0) { | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 533 | 		netdev_err(dev->net, "Error reading Medium Status register: %02x\n", | 
 | 534 | 			   ret); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 535 | 		goto out; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 536 | 	} | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 537 | 	ret = le16_to_cpu(v); | 
 | 538 | out: | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 539 | 	return ret; | 
 | 540 | } | 
 | 541 |  | 
 | 542 | static int asix_write_medium_mode(struct usbnet *dev, u16 mode) | 
 | 543 | { | 
 | 544 | 	int ret; | 
 | 545 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 546 | 	netdev_dbg(dev->net, "asix_write_medium_mode() - mode = 0x%04x\n", mode); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 547 | 	ret = asix_write_cmd(dev, AX_CMD_WRITE_MEDIUM_MODE, mode, 0, 0, NULL); | 
 | 548 | 	if (ret < 0) | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 549 | 		netdev_err(dev->net, "Failed to write Medium Mode mode to 0x%04x: %02x\n", | 
 | 550 | 			   mode, ret); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 551 |  | 
 | 552 | 	return ret; | 
 | 553 | } | 
 | 554 |  | 
 | 555 | static int asix_write_gpio(struct usbnet *dev, u16 value, int sleep) | 
 | 556 | { | 
 | 557 | 	int ret; | 
 | 558 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 559 | 	netdev_dbg(dev->net, "asix_write_gpio() - value = 0x%04x\n", value); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 560 | 	ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS, value, 0, 0, NULL); | 
 | 561 | 	if (ret < 0) | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 562 | 		netdev_err(dev->net, "Failed to write GPIO value 0x%04x: %02x\n", | 
 | 563 | 			   value, ret); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 564 |  | 
 | 565 | 	if (sleep) | 
 | 566 | 		msleep(sleep); | 
 | 567 |  | 
 | 568 | 	return ret; | 
 | 569 | } | 
 | 570 |  | 
 | 571 | /* | 
 | 572 |  * AX88772 & AX88178 have a 16-bit RX_CTL value | 
 | 573 |  */ | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 574 | static void asix_set_multicast(struct net_device *net) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 575 | { | 
 | 576 | 	struct usbnet *dev = netdev_priv(net); | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 577 | 	struct asix_data *data = (struct asix_data *)&dev->data; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 578 | 	u16 rx_ctl = AX_DEFAULT_RX_CTL; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 579 |  | 
 | 580 | 	if (net->flags & IFF_PROMISC) { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 581 | 		rx_ctl |= AX_RX_CTL_PRO; | 
| Joe Perches | 8e95a20 | 2009-12-03 07:58:21 +0000 | [diff] [blame] | 582 | 	} else if (net->flags & IFF_ALLMULTI || | 
| Jiri Pirko | 4cd24ea | 2010-02-08 04:30:35 +0000 | [diff] [blame] | 583 | 		   netdev_mc_count(net) > AX_MAX_MCAST) { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 584 | 		rx_ctl |= AX_RX_CTL_AMALL; | 
| Jiri Pirko | 4cd24ea | 2010-02-08 04:30:35 +0000 | [diff] [blame] | 585 | 	} else if (netdev_mc_empty(net)) { | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 586 | 		/* just broadcast and directed */ | 
 | 587 | 	} else { | 
 | 588 | 		/* We use the 20 byte dev->data | 
 | 589 | 		 * for our 8 byte filter buffer | 
 | 590 | 		 * to avoid allocating memory that | 
 | 591 | 		 * is tricky to free later */ | 
| Jiri Pirko | 22bedad | 2010-04-01 21:22:57 +0000 | [diff] [blame] | 592 | 		struct netdev_hw_addr *ha; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 593 | 		u32 crc_bits; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 594 |  | 
 | 595 | 		memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE); | 
 | 596 |  | 
 | 597 | 		/* Build the multicast hash filter. */ | 
| Jiri Pirko | 22bedad | 2010-04-01 21:22:57 +0000 | [diff] [blame] | 598 | 		netdev_for_each_mc_addr(ha, net) { | 
 | 599 | 			crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 600 | 			data->multi_filter[crc_bits >> 3] |= | 
 | 601 | 			    1 << (crc_bits & 7); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 602 | 		} | 
 | 603 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 604 | 		asix_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 605 | 				   AX_MCAST_FILTER_SIZE, data->multi_filter); | 
 | 606 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 607 | 		rx_ctl |= AX_RX_CTL_AM; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 608 | 	} | 
 | 609 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 610 | 	asix_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 611 | } | 
 | 612 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 613 | static int asix_mdio_read(struct net_device *netdev, int phy_id, int loc) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 614 | { | 
 | 615 | 	struct usbnet *dev = netdev_priv(netdev); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 616 | 	__le16 res; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 617 |  | 
| Arnd Bergmann | a9fc633 | 2006-10-09 00:08:02 +0200 | [diff] [blame] | 618 | 	mutex_lock(&dev->phy_mutex); | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 619 | 	asix_set_sw_mii(dev); | 
 | 620 | 	asix_read_cmd(dev, AX_CMD_READ_MII_REG, phy_id, | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 621 | 				(__u16)loc, 2, &res); | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 622 | 	asix_set_hw_mii(dev); | 
| Arnd Bergmann | a9fc633 | 2006-10-09 00:08:02 +0200 | [diff] [blame] | 623 | 	mutex_unlock(&dev->phy_mutex); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 624 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 625 | 	netdev_dbg(dev->net, "asix_mdio_read() phy_id=0x%02x, loc=0x%02x, returns=0x%04x\n", | 
 | 626 | 		   phy_id, loc, le16_to_cpu(res)); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 627 |  | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 628 | 	return le16_to_cpu(res); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 629 | } | 
 | 630 |  | 
 | 631 | static void | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 632 | asix_mdio_write(struct net_device *netdev, int phy_id, int loc, int val) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 633 | { | 
 | 634 | 	struct usbnet *dev = netdev_priv(netdev); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 635 | 	__le16 res = cpu_to_le16(val); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 636 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 637 | 	netdev_dbg(dev->net, "asix_mdio_write() phy_id=0x%02x, loc=0x%02x, val=0x%04x\n", | 
 | 638 | 		   phy_id, loc, val); | 
| Arnd Bergmann | a9fc633 | 2006-10-09 00:08:02 +0200 | [diff] [blame] | 639 | 	mutex_lock(&dev->phy_mutex); | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 640 | 	asix_set_sw_mii(dev); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 641 | 	asix_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id, (__u16)loc, 2, &res); | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 642 | 	asix_set_hw_mii(dev); | 
| Arnd Bergmann | a9fc633 | 2006-10-09 00:08:02 +0200 | [diff] [blame] | 643 | 	mutex_unlock(&dev->phy_mutex); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 644 | } | 
 | 645 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 646 | /* Get the PHY Identifier from the PHYSID1 & PHYSID2 MII registers */ | 
 | 647 | static u32 asix_get_phyid(struct usbnet *dev) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 648 | { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 649 | 	int phy_reg; | 
 | 650 | 	u32 phy_id; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 651 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 652 | 	phy_reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_PHYSID1); | 
 | 653 | 	if (phy_reg < 0) | 
 | 654 | 		return 0; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 655 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 656 | 	phy_id = (phy_reg & 0xffff) << 16; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 657 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 658 | 	phy_reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_PHYSID2); | 
 | 659 | 	if (phy_reg < 0) | 
 | 660 | 		return 0; | 
 | 661 |  | 
 | 662 | 	phy_id |= (phy_reg & 0xffff); | 
 | 663 |  | 
 | 664 | 	return phy_id; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 665 | } | 
 | 666 |  | 
 | 667 | static void | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 668 | asix_get_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 669 | { | 
 | 670 | 	struct usbnet *dev = netdev_priv(net); | 
 | 671 | 	u8 opt; | 
 | 672 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 673 | 	if (asix_read_cmd(dev, AX_CMD_READ_MONITOR_MODE, 0, 0, 1, &opt) < 0) { | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 674 | 		wolinfo->supported = 0; | 
 | 675 | 		wolinfo->wolopts = 0; | 
 | 676 | 		return; | 
 | 677 | 	} | 
 | 678 | 	wolinfo->supported = WAKE_PHY | WAKE_MAGIC; | 
 | 679 | 	wolinfo->wolopts = 0; | 
 | 680 | 	if (opt & AX_MONITOR_MODE) { | 
 | 681 | 		if (opt & AX_MONITOR_LINK) | 
 | 682 | 			wolinfo->wolopts |= WAKE_PHY; | 
 | 683 | 		if (opt & AX_MONITOR_MAGIC) | 
 | 684 | 			wolinfo->wolopts |= WAKE_MAGIC; | 
 | 685 | 	} | 
 | 686 | } | 
 | 687 |  | 
 | 688 | static int | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 689 | asix_set_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 690 | { | 
 | 691 | 	struct usbnet *dev = netdev_priv(net); | 
 | 692 | 	u8 opt = 0; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 693 |  | 
 | 694 | 	if (wolinfo->wolopts & WAKE_PHY) | 
 | 695 | 		opt |= AX_MONITOR_LINK; | 
 | 696 | 	if (wolinfo->wolopts & WAKE_MAGIC) | 
 | 697 | 		opt |= AX_MONITOR_MAGIC; | 
 | 698 | 	if (opt != 0) | 
 | 699 | 		opt |= AX_MONITOR_MODE; | 
 | 700 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 701 | 	if (asix_write_cmd(dev, AX_CMD_WRITE_MONITOR_MODE, | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 702 | 			      opt, 0, 0, NULL) < 0) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 703 | 		return -EINVAL; | 
 | 704 |  | 
 | 705 | 	return 0; | 
 | 706 | } | 
 | 707 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 708 | static int asix_get_eeprom_len(struct net_device *net) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 709 | { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 710 | 	struct usbnet *dev = netdev_priv(net); | 
 | 711 | 	struct asix_data *data = (struct asix_data *)&dev->data; | 
 | 712 |  | 
 | 713 | 	return data->eeprom_len; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 714 | } | 
 | 715 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 716 | static int asix_get_eeprom(struct net_device *net, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 717 | 			      struct ethtool_eeprom *eeprom, u8 *data) | 
 | 718 | { | 
 | 719 | 	struct usbnet *dev = netdev_priv(net); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 720 | 	__le16 *ebuf = (__le16 *)data; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 721 | 	int i; | 
 | 722 |  | 
 | 723 | 	/* Crude hack to ensure that we don't overwrite memory | 
 | 724 | 	 * if an odd length is supplied | 
 | 725 | 	 */ | 
 | 726 | 	if (eeprom->len % 2) | 
 | 727 | 		return -EINVAL; | 
 | 728 |  | 
 | 729 | 	eeprom->magic = AX_EEPROM_MAGIC; | 
 | 730 |  | 
 | 731 | 	/* ax8817x returns 2 bytes from eeprom on read */ | 
 | 732 | 	for (i=0; i < eeprom->len / 2; i++) { | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 733 | 		if (asix_read_cmd(dev, AX_CMD_READ_EEPROM, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 734 | 			eeprom->offset + i, 0, 2, &ebuf[i]) < 0) | 
 | 735 | 			return -EINVAL; | 
 | 736 | 	} | 
 | 737 | 	return 0; | 
 | 738 | } | 
 | 739 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 740 | static void asix_get_drvinfo (struct net_device *net, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 741 | 				 struct ethtool_drvinfo *info) | 
 | 742 | { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 743 | 	struct usbnet *dev = netdev_priv(net); | 
 | 744 | 	struct asix_data *data = (struct asix_data *)&dev->data; | 
 | 745 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 746 | 	/* Inherit standard device info */ | 
 | 747 | 	usbnet_get_drvinfo(net, info); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 748 | 	strncpy (info->driver, driver_name, sizeof info->driver); | 
 | 749 | 	strncpy (info->version, DRIVER_VERSION, sizeof info->version); | 
 | 750 | 	info->eedump_len = data->eeprom_len; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 751 | } | 
 | 752 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 753 | static u32 asix_get_link(struct net_device *net) | 
 | 754 | { | 
 | 755 | 	struct usbnet *dev = netdev_priv(net); | 
 | 756 |  | 
 | 757 | 	return mii_link_ok(&dev->mii); | 
 | 758 | } | 
 | 759 |  | 
 | 760 | static int asix_ioctl (struct net_device *net, struct ifreq *rq, int cmd) | 
 | 761 | { | 
 | 762 | 	struct usbnet *dev = netdev_priv(net); | 
 | 763 |  | 
 | 764 | 	return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 765 | } | 
 | 766 |  | 
| Jussi Kivilinna | 7f29a3b | 2010-03-09 12:24:38 +0000 | [diff] [blame] | 767 | static int asix_set_mac_address(struct net_device *net, void *p) | 
 | 768 | { | 
 | 769 | 	struct usbnet *dev = netdev_priv(net); | 
 | 770 | 	struct asix_data *data = (struct asix_data *)&dev->data; | 
 | 771 | 	struct sockaddr *addr = p; | 
 | 772 |  | 
 | 773 | 	if (netif_running(net)) | 
 | 774 | 		return -EBUSY; | 
 | 775 | 	if (!is_valid_ether_addr(addr->sa_data)) | 
 | 776 | 		return -EADDRNOTAVAIL; | 
 | 777 |  | 
 | 778 | 	memcpy(net->dev_addr, addr->sa_data, ETH_ALEN); | 
 | 779 |  | 
 | 780 | 	/* We use the 20 byte dev->data | 
 | 781 | 	 * for our 6 byte mac buffer | 
 | 782 | 	 * to avoid allocating memory that | 
 | 783 | 	 * is tricky to free later */ | 
 | 784 | 	memcpy(data->mac_addr, addr->sa_data, ETH_ALEN); | 
 | 785 | 	asix_write_cmd_async(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN, | 
 | 786 | 							data->mac_addr); | 
 | 787 |  | 
 | 788 | 	return 0; | 
 | 789 | } | 
 | 790 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 791 | /* We need to override some ethtool_ops so we require our | 
 | 792 |    own structure so we don't interfere with other usbnet | 
 | 793 |    devices that may be connected at the same time. */ | 
| Stephen Hemminger | 0fc0b73 | 2009-09-02 01:03:33 -0700 | [diff] [blame] | 794 | static const struct ethtool_ops ax88172_ethtool_ops = { | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 795 | 	.get_drvinfo		= asix_get_drvinfo, | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 796 | 	.get_link		= asix_get_link, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 797 | 	.get_msglevel		= usbnet_get_msglevel, | 
 | 798 | 	.set_msglevel		= usbnet_set_msglevel, | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 799 | 	.get_wol		= asix_get_wol, | 
 | 800 | 	.set_wol		= asix_set_wol, | 
 | 801 | 	.get_eeprom_len		= asix_get_eeprom_len, | 
 | 802 | 	.get_eeprom		= asix_get_eeprom, | 
| Arnd Bergmann | c41286f | 2006-10-09 00:08:01 +0200 | [diff] [blame] | 803 | 	.get_settings		= usbnet_get_settings, | 
 | 804 | 	.set_settings		= usbnet_set_settings, | 
 | 805 | 	.nway_reset		= usbnet_nway_reset, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 806 | }; | 
 | 807 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 808 | static void ax88172_set_multicast(struct net_device *net) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 809 | { | 
 | 810 | 	struct usbnet *dev = netdev_priv(net); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 811 | 	struct asix_data *data = (struct asix_data *)&dev->data; | 
 | 812 | 	u8 rx_ctl = 0x8c; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 813 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 814 | 	if (net->flags & IFF_PROMISC) { | 
 | 815 | 		rx_ctl |= 0x01; | 
| Joe Perches | 8e95a20 | 2009-12-03 07:58:21 +0000 | [diff] [blame] | 816 | 	} else if (net->flags & IFF_ALLMULTI || | 
| Jiri Pirko | 4cd24ea | 2010-02-08 04:30:35 +0000 | [diff] [blame] | 817 | 		   netdev_mc_count(net) > AX_MAX_MCAST) { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 818 | 		rx_ctl |= 0x02; | 
| Jiri Pirko | 4cd24ea | 2010-02-08 04:30:35 +0000 | [diff] [blame] | 819 | 	} else if (netdev_mc_empty(net)) { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 820 | 		/* just broadcast and directed */ | 
 | 821 | 	} else { | 
 | 822 | 		/* We use the 20 byte dev->data | 
 | 823 | 		 * for our 8 byte filter buffer | 
 | 824 | 		 * to avoid allocating memory that | 
 | 825 | 		 * is tricky to free later */ | 
| Jiri Pirko | 22bedad | 2010-04-01 21:22:57 +0000 | [diff] [blame] | 826 | 		struct netdev_hw_addr *ha; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 827 | 		u32 crc_bits; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 828 |  | 
 | 829 | 		memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE); | 
 | 830 |  | 
 | 831 | 		/* Build the multicast hash filter. */ | 
| Jiri Pirko | 22bedad | 2010-04-01 21:22:57 +0000 | [diff] [blame] | 832 | 		netdev_for_each_mc_addr(ha, net) { | 
 | 833 | 			crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 834 | 			data->multi_filter[crc_bits >> 3] |= | 
 | 835 | 			    1 << (crc_bits & 7); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 836 | 		} | 
 | 837 |  | 
 | 838 | 		asix_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0, | 
 | 839 | 				   AX_MCAST_FILTER_SIZE, data->multi_filter); | 
 | 840 |  | 
 | 841 | 		rx_ctl |= 0x10; | 
 | 842 | 	} | 
 | 843 |  | 
 | 844 | 	asix_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL); | 
 | 845 | } | 
 | 846 |  | 
 | 847 | static int ax88172_link_reset(struct usbnet *dev) | 
 | 848 | { | 
 | 849 | 	u8 mode; | 
 | 850 | 	struct ethtool_cmd ecmd; | 
 | 851 |  | 
 | 852 | 	mii_check_media(&dev->mii, 1, 1); | 
 | 853 | 	mii_ethtool_gset(&dev->mii, &ecmd); | 
 | 854 | 	mode = AX88172_MEDIUM_DEFAULT; | 
 | 855 |  | 
 | 856 | 	if (ecmd.duplex != DUPLEX_FULL) | 
 | 857 | 		mode |= ~AX88172_MEDIUM_FD; | 
 | 858 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 859 | 	netdev_dbg(dev->net, "ax88172_link_reset() speed: %d duplex: %d setting mode to 0x%04x\n", | 
 | 860 | 		   ecmd.speed, ecmd.duplex, mode); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 861 |  | 
 | 862 | 	asix_write_medium_mode(dev, mode); | 
 | 863 |  | 
 | 864 | 	return 0; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 865 | } | 
 | 866 |  | 
| Stephen Hemminger | 1703338 | 2009-03-20 19:35:55 +0000 | [diff] [blame] | 867 | static const struct net_device_ops ax88172_netdev_ops = { | 
 | 868 | 	.ndo_open		= usbnet_open, | 
 | 869 | 	.ndo_stop		= usbnet_stop, | 
 | 870 | 	.ndo_start_xmit		= usbnet_start_xmit, | 
 | 871 | 	.ndo_tx_timeout		= usbnet_tx_timeout, | 
 | 872 | 	.ndo_change_mtu		= usbnet_change_mtu, | 
 | 873 | 	.ndo_set_mac_address 	= eth_mac_addr, | 
 | 874 | 	.ndo_validate_addr	= eth_validate_addr, | 
 | 875 | 	.ndo_do_ioctl		= asix_ioctl, | 
 | 876 | 	.ndo_set_multicast_list = ax88172_set_multicast, | 
 | 877 | }; | 
 | 878 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 879 | static int ax88172_bind(struct usbnet *dev, struct usb_interface *intf) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 880 | { | 
 | 881 | 	int ret = 0; | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 882 | 	u8 buf[ETH_ALEN]; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 883 | 	int i; | 
 | 884 | 	unsigned long gpio_bits = dev->driver_info->data; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 885 | 	struct asix_data *data = (struct asix_data *)&dev->data; | 
 | 886 |  | 
 | 887 | 	data->eeprom_len = AX88172_EEPROM_LEN; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 888 |  | 
 | 889 | 	usbnet_get_endpoints(dev,intf); | 
 | 890 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 891 | 	/* Toggle the GPIOs in a manufacturer/model specific way */ | 
 | 892 | 	for (i = 2; i >= 0; i--) { | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 893 | 		if ((ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 894 | 					(gpio_bits >> (i * 8)) & 0xff, 0, 0, | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 895 | 					NULL)) < 0) | 
 | 896 | 			goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 897 | 		msleep(5); | 
 | 898 | 	} | 
 | 899 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 900 | 	if ((ret = asix_write_rx_ctl(dev, 0x80)) < 0) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 901 | 		goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 902 |  | 
 | 903 | 	/* Get the MAC address */ | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 904 | 	if ((ret = asix_read_cmd(dev, AX88172_CMD_READ_NODE_ID, | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 905 | 				0, 0, ETH_ALEN, buf)) < 0) { | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 906 | 		dbg("read AX_CMD_READ_NODE_ID failed: %d", ret); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 907 | 		goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 908 | 	} | 
 | 909 | 	memcpy(dev->net->dev_addr, buf, ETH_ALEN); | 
 | 910 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 911 | 	/* Initialize MII structure */ | 
 | 912 | 	dev->mii.dev = dev->net; | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 913 | 	dev->mii.mdio_read = asix_mdio_read; | 
 | 914 | 	dev->mii.mdio_write = asix_mdio_write; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 915 | 	dev->mii.phy_id_mask = 0x3f; | 
 | 916 | 	dev->mii.reg_num_mask = 0x1f; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 917 | 	dev->mii.phy_id = asix_get_phy_addr(dev); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 918 |  | 
| Stephen Hemminger | 1703338 | 2009-03-20 19:35:55 +0000 | [diff] [blame] | 919 | 	dev->net->netdev_ops = &ax88172_netdev_ops; | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 920 | 	dev->net->ethtool_ops = &ax88172_ethtool_ops; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 921 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 922 | 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET); | 
 | 923 | 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 924 | 		ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP); | 
 | 925 | 	mii_nway_restart(&dev->mii); | 
 | 926 |  | 
 | 927 | 	return 0; | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 928 |  | 
 | 929 | out: | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 930 | 	return ret; | 
 | 931 | } | 
 | 932 |  | 
| Stephen Hemminger | 0fc0b73 | 2009-09-02 01:03:33 -0700 | [diff] [blame] | 933 | static const struct ethtool_ops ax88772_ethtool_ops = { | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 934 | 	.get_drvinfo		= asix_get_drvinfo, | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 935 | 	.get_link		= asix_get_link, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 936 | 	.get_msglevel		= usbnet_get_msglevel, | 
 | 937 | 	.set_msglevel		= usbnet_set_msglevel, | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 938 | 	.get_wol		= asix_get_wol, | 
 | 939 | 	.set_wol		= asix_set_wol, | 
 | 940 | 	.get_eeprom_len		= asix_get_eeprom_len, | 
 | 941 | 	.get_eeprom		= asix_get_eeprom, | 
| Arnd Bergmann | c41286f | 2006-10-09 00:08:01 +0200 | [diff] [blame] | 942 | 	.get_settings		= usbnet_get_settings, | 
 | 943 | 	.set_settings		= usbnet_set_settings, | 
 | 944 | 	.nway_reset		= usbnet_nway_reset, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 945 | }; | 
 | 946 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 947 | static int ax88772_link_reset(struct usbnet *dev) | 
 | 948 | { | 
 | 949 | 	u16 mode; | 
 | 950 | 	struct ethtool_cmd ecmd; | 
 | 951 |  | 
 | 952 | 	mii_check_media(&dev->mii, 1, 1); | 
 | 953 | 	mii_ethtool_gset(&dev->mii, &ecmd); | 
 | 954 | 	mode = AX88772_MEDIUM_DEFAULT; | 
 | 955 |  | 
 | 956 | 	if (ecmd.speed != SPEED_100) | 
 | 957 | 		mode &= ~AX_MEDIUM_PS; | 
 | 958 |  | 
 | 959 | 	if (ecmd.duplex != DUPLEX_FULL) | 
 | 960 | 		mode &= ~AX_MEDIUM_FD; | 
 | 961 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 962 | 	netdev_dbg(dev->net, "ax88772_link_reset() speed: %d duplex: %d setting mode to 0x%04x\n", | 
 | 963 | 		   ecmd.speed, ecmd.duplex, mode); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 964 |  | 
 | 965 | 	asix_write_medium_mode(dev, mode); | 
 | 966 |  | 
 | 967 | 	return 0; | 
 | 968 | } | 
 | 969 |  | 
| Stephen Hemminger | 1703338 | 2009-03-20 19:35:55 +0000 | [diff] [blame] | 970 | static const struct net_device_ops ax88772_netdev_ops = { | 
 | 971 | 	.ndo_open		= usbnet_open, | 
 | 972 | 	.ndo_stop		= usbnet_stop, | 
 | 973 | 	.ndo_start_xmit		= usbnet_start_xmit, | 
 | 974 | 	.ndo_tx_timeout		= usbnet_tx_timeout, | 
 | 975 | 	.ndo_change_mtu		= usbnet_change_mtu, | 
| Jussi Kivilinna | 7f29a3b | 2010-03-09 12:24:38 +0000 | [diff] [blame] | 976 | 	.ndo_set_mac_address 	= asix_set_mac_address, | 
| Stephen Hemminger | 1703338 | 2009-03-20 19:35:55 +0000 | [diff] [blame] | 977 | 	.ndo_validate_addr	= eth_validate_addr, | 
 | 978 | 	.ndo_do_ioctl		= asix_ioctl, | 
 | 979 | 	.ndo_set_multicast_list = asix_set_multicast, | 
 | 980 | }; | 
 | 981 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 982 | static int ax88772_bind(struct usbnet *dev, struct usb_interface *intf) | 
 | 983 | { | 
| Andres Salomon | d0ffff8 | 2007-01-11 18:39:16 -0500 | [diff] [blame] | 984 | 	int ret, embd_phy; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 985 | 	u16 rx_ctl; | 
 | 986 | 	struct asix_data *data = (struct asix_data *)&dev->data; | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 987 | 	u8 buf[ETH_ALEN]; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 988 | 	u32 phyid; | 
 | 989 |  | 
 | 990 | 	data->eeprom_len = AX88772_EEPROM_LEN; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 991 |  | 
 | 992 | 	usbnet_get_endpoints(dev,intf); | 
 | 993 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 994 | 	if ((ret = asix_write_gpio(dev, | 
 | 995 | 			AX_GPIO_RSE | AX_GPIO_GPO_2 | AX_GPIO_GPO2EN, 5)) < 0) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 996 | 		goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 997 |  | 
| Andres Salomon | d0ffff8 | 2007-01-11 18:39:16 -0500 | [diff] [blame] | 998 | 	/* 0x10 is the phy id of the embedded 10/100 ethernet phy */ | 
 | 999 | 	embd_phy = ((asix_get_phy_addr(dev) & 0x1f) == 0x10 ? 1 : 0); | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 1000 | 	if ((ret = asix_write_cmd(dev, AX_CMD_SW_PHY_SELECT, | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1001 | 				embd_phy, 0, 0, NULL)) < 0) { | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1002 | 		dbg("Select PHY #1 failed: %d", ret); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1003 | 		goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1004 | 	} | 
 | 1005 |  | 
| Andres Salomon | d0ffff8 | 2007-01-11 18:39:16 -0500 | [diff] [blame] | 1006 | 	if ((ret = asix_sw_reset(dev, AX_SWRESET_IPPD | AX_SWRESET_PRL)) < 0) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1007 | 		goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1008 |  | 
 | 1009 | 	msleep(150); | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 1010 | 	if ((ret = asix_sw_reset(dev, AX_SWRESET_CLEAR)) < 0) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1011 | 		goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1012 |  | 
 | 1013 | 	msleep(150); | 
| Andres Salomon | d0ffff8 | 2007-01-11 18:39:16 -0500 | [diff] [blame] | 1014 | 	if (embd_phy) { | 
 | 1015 | 		if ((ret = asix_sw_reset(dev, AX_SWRESET_IPRL)) < 0) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1016 | 			goto out; | 
| Andres Salomon | d0ffff8 | 2007-01-11 18:39:16 -0500 | [diff] [blame] | 1017 | 	} | 
 | 1018 | 	else { | 
 | 1019 | 		if ((ret = asix_sw_reset(dev, AX_SWRESET_PRTE)) < 0) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1020 | 			goto out; | 
| Andres Salomon | d0ffff8 | 2007-01-11 18:39:16 -0500 | [diff] [blame] | 1021 | 	} | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1022 |  | 
 | 1023 | 	msleep(150); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1024 | 	rx_ctl = asix_read_rx_ctl(dev); | 
 | 1025 | 	dbg("RX_CTL is 0x%04x after software reset", rx_ctl); | 
 | 1026 | 	if ((ret = asix_write_rx_ctl(dev, 0x0000)) < 0) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1027 | 		goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1028 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1029 | 	rx_ctl = asix_read_rx_ctl(dev); | 
 | 1030 | 	dbg("RX_CTL is 0x%04x setting to 0x0000", rx_ctl); | 
 | 1031 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1032 | 	/* Get the MAC address */ | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1033 | 	if ((ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1034 | 				0, 0, ETH_ALEN, buf)) < 0) { | 
 | 1035 | 		dbg("Failed to read MAC address: %d", ret); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1036 | 		goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1037 | 	} | 
 | 1038 | 	memcpy(dev->net->dev_addr, buf, ETH_ALEN); | 
 | 1039 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1040 | 	/* Initialize MII structure */ | 
 | 1041 | 	dev->mii.dev = dev->net; | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 1042 | 	dev->mii.mdio_read = asix_mdio_read; | 
 | 1043 | 	dev->mii.mdio_write = asix_mdio_write; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1044 | 	dev->mii.phy_id_mask = 0x1f; | 
 | 1045 | 	dev->mii.reg_num_mask = 0x1f; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1046 | 	dev->mii.phy_id = asix_get_phy_addr(dev); | 
 | 1047 |  | 
 | 1048 | 	phyid = asix_get_phyid(dev); | 
 | 1049 | 	dbg("PHYID=0x%08x", phyid); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1050 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 1051 | 	if ((ret = asix_sw_reset(dev, AX_SWRESET_PRL)) < 0) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1052 | 		goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1053 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1054 | 	msleep(150); | 
 | 1055 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 1056 | 	if ((ret = asix_sw_reset(dev, AX_SWRESET_IPRL | AX_SWRESET_PRL)) < 0) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1057 | 		goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1058 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 1059 | 	msleep(150); | 
 | 1060 |  | 
| Stephen Hemminger | 1703338 | 2009-03-20 19:35:55 +0000 | [diff] [blame] | 1061 | 	dev->net->netdev_ops = &ax88772_netdev_ops; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1062 | 	dev->net->ethtool_ops = &ax88772_ethtool_ops; | 
 | 1063 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1064 | 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET); | 
 | 1065 | 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1066 | 			ADVERTISE_ALL | ADVERTISE_CSMA); | 
 | 1067 | 	mii_nway_restart(&dev->mii); | 
 | 1068 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1069 | 	if ((ret = asix_write_medium_mode(dev, AX88772_MEDIUM_DEFAULT)) < 0) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1070 | 		goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1071 |  | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 1072 | 	if ((ret = asix_write_cmd(dev, AX_CMD_WRITE_IPG0, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1073 | 				AX88772_IPG0_DEFAULT | AX88772_IPG1_DEFAULT, | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1074 | 				AX88772_IPG2_DEFAULT, 0, NULL)) < 0) { | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1075 | 		dbg("Write IPG,IPG1,IPG2 failed: %d", ret); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1076 | 		goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1077 | 	} | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1078 |  | 
 | 1079 | 	/* Set RX_CTL to default values with 2k buffer, and enable cactus */ | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1080 | 	if ((ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL)) < 0) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1081 | 		goto out; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1082 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1083 | 	rx_ctl = asix_read_rx_ctl(dev); | 
 | 1084 | 	dbg("RX_CTL is 0x%04x after all initializations", rx_ctl); | 
 | 1085 |  | 
 | 1086 | 	rx_ctl = asix_read_medium_status(dev); | 
 | 1087 | 	dbg("Medium Status is 0x%04x after all initializations", rx_ctl); | 
 | 1088 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1089 | 	/* Asix framing packs multiple eth frames into a 2K usb bulk transfer */ | 
 | 1090 | 	if (dev->driver_info->flags & FLAG_FRAMING_AX) { | 
 | 1091 | 		/* hard_mtu  is still the default - the device does not support | 
 | 1092 | 		   jumbo eth frames */ | 
 | 1093 | 		dev->rx_urb_size = 2048; | 
 | 1094 | 	} | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1095 | 	return 0; | 
 | 1096 |  | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1097 | out: | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1098 | 	return ret; | 
 | 1099 | } | 
 | 1100 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1101 | static struct ethtool_ops ax88178_ethtool_ops = { | 
 | 1102 | 	.get_drvinfo		= asix_get_drvinfo, | 
 | 1103 | 	.get_link		= asix_get_link, | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1104 | 	.get_msglevel		= usbnet_get_msglevel, | 
 | 1105 | 	.set_msglevel		= usbnet_set_msglevel, | 
 | 1106 | 	.get_wol		= asix_get_wol, | 
 | 1107 | 	.set_wol		= asix_set_wol, | 
 | 1108 | 	.get_eeprom_len		= asix_get_eeprom_len, | 
 | 1109 | 	.get_eeprom		= asix_get_eeprom, | 
| Arnd Bergmann | c41286f | 2006-10-09 00:08:01 +0200 | [diff] [blame] | 1110 | 	.get_settings		= usbnet_get_settings, | 
 | 1111 | 	.set_settings		= usbnet_set_settings, | 
 | 1112 | 	.nway_reset		= usbnet_nway_reset, | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1113 | }; | 
 | 1114 |  | 
 | 1115 | static int marvell_phy_init(struct usbnet *dev) | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1116 | { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1117 | 	struct asix_data *data = (struct asix_data *)&dev->data; | 
 | 1118 | 	u16 reg; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1119 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 1120 | 	netdev_dbg(dev->net, "marvell_phy_init()\n"); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1121 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1122 | 	reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_MARVELL_STATUS); | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 1123 | 	netdev_dbg(dev->net, "MII_MARVELL_STATUS = 0x%04x\n", reg); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1124 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1125 | 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_MARVELL_CTRL, | 
 | 1126 | 			MARVELL_CTRL_RXDELAY | MARVELL_CTRL_TXDELAY); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1127 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1128 | 	if (data->ledmode) { | 
 | 1129 | 		reg = asix_mdio_read(dev->net, dev->mii.phy_id, | 
 | 1130 | 			MII_MARVELL_LED_CTRL); | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 1131 | 		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (1) = 0x%04x\n", reg); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1132 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1133 | 		reg &= 0xf8ff; | 
 | 1134 | 		reg |= (1 + 0x0100); | 
 | 1135 | 		asix_mdio_write(dev->net, dev->mii.phy_id, | 
 | 1136 | 			MII_MARVELL_LED_CTRL, reg); | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1137 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1138 | 		reg = asix_mdio_read(dev->net, dev->mii.phy_id, | 
 | 1139 | 			MII_MARVELL_LED_CTRL); | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 1140 | 		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (2) = 0x%04x\n", reg); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1141 | 		reg &= 0xfc0f; | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1142 | 	} | 
 | 1143 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1144 | 	return 0; | 
 | 1145 | } | 
 | 1146 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1147 | static int marvell_led_status(struct usbnet *dev, u16 speed) | 
 | 1148 | { | 
 | 1149 | 	u16 reg = asix_mdio_read(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL); | 
 | 1150 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 1151 | 	netdev_dbg(dev->net, "marvell_led_status() read 0x%04x\n", reg); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1152 |  | 
 | 1153 | 	/* Clear out the center LED bits - 0x03F0 */ | 
 | 1154 | 	reg &= 0xfc0f; | 
 | 1155 |  | 
 | 1156 | 	switch (speed) { | 
 | 1157 | 		case SPEED_1000: | 
 | 1158 | 			reg |= 0x03e0; | 
 | 1159 | 			break; | 
 | 1160 | 		case SPEED_100: | 
 | 1161 | 			reg |= 0x03b0; | 
 | 1162 | 			break; | 
 | 1163 | 		default: | 
 | 1164 | 			reg |= 0x02f0; | 
 | 1165 | 	} | 
 | 1166 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 1167 | 	netdev_dbg(dev->net, "marvell_led_status() writing 0x%04x\n", reg); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1168 | 	asix_mdio_write(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL, reg); | 
 | 1169 |  | 
 | 1170 | 	return 0; | 
 | 1171 | } | 
 | 1172 |  | 
 | 1173 | static int ax88178_link_reset(struct usbnet *dev) | 
 | 1174 | { | 
 | 1175 | 	u16 mode; | 
 | 1176 | 	struct ethtool_cmd ecmd; | 
 | 1177 | 	struct asix_data *data = (struct asix_data *)&dev->data; | 
 | 1178 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 1179 | 	netdev_dbg(dev->net, "ax88178_link_reset()\n"); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1180 |  | 
 | 1181 | 	mii_check_media(&dev->mii, 1, 1); | 
 | 1182 | 	mii_ethtool_gset(&dev->mii, &ecmd); | 
 | 1183 | 	mode = AX88178_MEDIUM_DEFAULT; | 
 | 1184 |  | 
 | 1185 | 	if (ecmd.speed == SPEED_1000) | 
| Pantelis Koukousoulas | a7f75c0 | 2008-11-20 01:48:46 -0800 | [diff] [blame] | 1186 | 		mode |= AX_MEDIUM_GM; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1187 | 	else if (ecmd.speed == SPEED_100) | 
 | 1188 | 		mode |= AX_MEDIUM_PS; | 
 | 1189 | 	else | 
 | 1190 | 		mode &= ~(AX_MEDIUM_PS | AX_MEDIUM_GM); | 
 | 1191 |  | 
| Pantelis Koukousoulas | a7f75c0 | 2008-11-20 01:48:46 -0800 | [diff] [blame] | 1192 | 	mode |= AX_MEDIUM_ENCK; | 
 | 1193 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1194 | 	if (ecmd.duplex == DUPLEX_FULL) | 
 | 1195 | 		mode |= AX_MEDIUM_FD; | 
 | 1196 | 	else | 
 | 1197 | 		mode &= ~AX_MEDIUM_FD; | 
 | 1198 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 1199 | 	netdev_dbg(dev->net, "ax88178_link_reset() speed: %d duplex: %d setting mode to 0x%04x\n", | 
 | 1200 | 		   ecmd.speed, ecmd.duplex, mode); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1201 |  | 
 | 1202 | 	asix_write_medium_mode(dev, mode); | 
 | 1203 |  | 
 | 1204 | 	if (data->phymode == PHY_MODE_MARVELL && data->ledmode) | 
 | 1205 | 		marvell_led_status(dev, ecmd.speed); | 
 | 1206 |  | 
 | 1207 | 	return 0; | 
 | 1208 | } | 
 | 1209 |  | 
 | 1210 | static void ax88178_set_mfb(struct usbnet *dev) | 
 | 1211 | { | 
 | 1212 | 	u16 mfb = AX_RX_CTL_MFB_16384; | 
 | 1213 | 	u16 rxctl; | 
 | 1214 | 	u16 medium; | 
 | 1215 | 	int old_rx_urb_size = dev->rx_urb_size; | 
 | 1216 |  | 
 | 1217 | 	if (dev->hard_mtu < 2048) { | 
 | 1218 | 		dev->rx_urb_size = 2048; | 
 | 1219 | 		mfb = AX_RX_CTL_MFB_2048; | 
 | 1220 | 	} else if (dev->hard_mtu < 4096) { | 
 | 1221 | 		dev->rx_urb_size = 4096; | 
 | 1222 | 		mfb = AX_RX_CTL_MFB_4096; | 
 | 1223 | 	} else if (dev->hard_mtu < 8192) { | 
 | 1224 | 		dev->rx_urb_size = 8192; | 
 | 1225 | 		mfb = AX_RX_CTL_MFB_8192; | 
 | 1226 | 	} else if (dev->hard_mtu < 16384) { | 
 | 1227 | 		dev->rx_urb_size = 16384; | 
 | 1228 | 		mfb = AX_RX_CTL_MFB_16384; | 
 | 1229 | 	} | 
 | 1230 |  | 
 | 1231 | 	rxctl = asix_read_rx_ctl(dev); | 
 | 1232 | 	asix_write_rx_ctl(dev, (rxctl & ~AX_RX_CTL_MFB_16384) | mfb); | 
 | 1233 |  | 
 | 1234 | 	medium = asix_read_medium_status(dev); | 
 | 1235 | 	if (dev->net->mtu > 1500) | 
 | 1236 | 		medium |= AX_MEDIUM_JFE; | 
 | 1237 | 	else | 
 | 1238 | 		medium &= ~AX_MEDIUM_JFE; | 
 | 1239 | 	asix_write_medium_mode(dev, medium); | 
 | 1240 |  | 
 | 1241 | 	if (dev->rx_urb_size > old_rx_urb_size) | 
 | 1242 | 		usbnet_unlink_rx_urbs(dev); | 
 | 1243 | } | 
 | 1244 |  | 
 | 1245 | static int ax88178_change_mtu(struct net_device *net, int new_mtu) | 
 | 1246 | { | 
 | 1247 | 	struct usbnet *dev = netdev_priv(net); | 
 | 1248 | 	int ll_mtu = new_mtu + net->hard_header_len + 4; | 
 | 1249 |  | 
| Joe Perches | 60b8675 | 2010-02-17 10:30:23 +0000 | [diff] [blame] | 1250 | 	netdev_dbg(dev->net, "ax88178_change_mtu() new_mtu=%d\n", new_mtu); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1251 |  | 
 | 1252 | 	if (new_mtu <= 0 || ll_mtu > 16384) | 
 | 1253 | 		return -EINVAL; | 
 | 1254 |  | 
 | 1255 | 	if ((ll_mtu % dev->maxpacket) == 0) | 
 | 1256 | 		return -EDOM; | 
 | 1257 |  | 
 | 1258 | 	net->mtu = new_mtu; | 
 | 1259 | 	dev->hard_mtu = net->mtu + net->hard_header_len; | 
 | 1260 | 	ax88178_set_mfb(dev); | 
 | 1261 |  | 
 | 1262 | 	return 0; | 
 | 1263 | } | 
 | 1264 |  | 
| Stephen Hemminger | 1703338 | 2009-03-20 19:35:55 +0000 | [diff] [blame] | 1265 | static const struct net_device_ops ax88178_netdev_ops = { | 
 | 1266 | 	.ndo_open		= usbnet_open, | 
 | 1267 | 	.ndo_stop		= usbnet_stop, | 
 | 1268 | 	.ndo_start_xmit		= usbnet_start_xmit, | 
 | 1269 | 	.ndo_tx_timeout		= usbnet_tx_timeout, | 
| Jussi Kivilinna | 7f29a3b | 2010-03-09 12:24:38 +0000 | [diff] [blame] | 1270 | 	.ndo_set_mac_address 	= asix_set_mac_address, | 
| Stephen Hemminger | 1703338 | 2009-03-20 19:35:55 +0000 | [diff] [blame] | 1271 | 	.ndo_validate_addr	= eth_validate_addr, | 
 | 1272 | 	.ndo_set_multicast_list = asix_set_multicast, | 
 | 1273 | 	.ndo_do_ioctl 		= asix_ioctl, | 
 | 1274 | 	.ndo_change_mtu 	= ax88178_change_mtu, | 
 | 1275 | }; | 
 | 1276 |  | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1277 | static int ax88178_bind(struct usbnet *dev, struct usb_interface *intf) | 
 | 1278 | { | 
 | 1279 | 	struct asix_data *data = (struct asix_data *)&dev->data; | 
 | 1280 | 	int ret; | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1281 | 	u8 buf[ETH_ALEN]; | 
 | 1282 | 	__le16 eeprom; | 
 | 1283 | 	u8 status; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1284 | 	int gpio0 = 0; | 
 | 1285 | 	u32 phyid; | 
 | 1286 |  | 
 | 1287 | 	usbnet_get_endpoints(dev,intf); | 
 | 1288 |  | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1289 | 	asix_read_cmd(dev, AX_CMD_READ_GPIOS, 0, 0, 1, &status); | 
 | 1290 | 	dbg("GPIO Status: 0x%04x", status); | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1291 |  | 
 | 1292 | 	asix_write_cmd(dev, AX_CMD_WRITE_ENABLE, 0, 0, 0, NULL); | 
 | 1293 | 	asix_read_cmd(dev, AX_CMD_READ_EEPROM, 0x0017, 0, 2, &eeprom); | 
 | 1294 | 	asix_write_cmd(dev, AX_CMD_WRITE_DISABLE, 0, 0, 0, NULL); | 
 | 1295 |  | 
 | 1296 | 	dbg("EEPROM index 0x17 is 0x%04x", eeprom); | 
 | 1297 |  | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1298 | 	if (eeprom == cpu_to_le16(0xffff)) { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1299 | 		data->phymode = PHY_MODE_MARVELL; | 
 | 1300 | 		data->ledmode = 0; | 
 | 1301 | 		gpio0 = 1; | 
 | 1302 | 	} else { | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1303 | 		data->phymode = le16_to_cpu(eeprom) & 7; | 
 | 1304 | 		data->ledmode = le16_to_cpu(eeprom) >> 8; | 
 | 1305 | 		gpio0 = (le16_to_cpu(eeprom) & 0x80) ? 0 : 1; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1306 | 	} | 
 | 1307 | 	dbg("GPIO0: %d, PhyMode: %d", gpio0, data->phymode); | 
 | 1308 |  | 
 | 1309 | 	asix_write_gpio(dev, AX_GPIO_RSE | AX_GPIO_GPO_1 | AX_GPIO_GPO1EN, 40); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1310 | 	if ((le16_to_cpu(eeprom) >> 8) != 1) { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1311 | 		asix_write_gpio(dev, 0x003c, 30); | 
 | 1312 | 		asix_write_gpio(dev, 0x001c, 300); | 
 | 1313 | 		asix_write_gpio(dev, 0x003c, 30); | 
 | 1314 | 	} else { | 
 | 1315 | 		dbg("gpio phymode == 1 path"); | 
 | 1316 | 		asix_write_gpio(dev, AX_GPIO_GPO1EN, 30); | 
 | 1317 | 		asix_write_gpio(dev, AX_GPIO_GPO1EN | AX_GPIO_GPO_1, 30); | 
 | 1318 | 	} | 
 | 1319 |  | 
 | 1320 | 	asix_sw_reset(dev, 0); | 
 | 1321 | 	msleep(150); | 
 | 1322 |  | 
 | 1323 | 	asix_sw_reset(dev, AX_SWRESET_PRL | AX_SWRESET_IPPD); | 
 | 1324 | 	msleep(150); | 
 | 1325 |  | 
 | 1326 | 	asix_write_rx_ctl(dev, 0); | 
 | 1327 |  | 
 | 1328 | 	/* Get the MAC address */ | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1329 | 	if ((ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID, | 
 | 1330 | 				0, 0, ETH_ALEN, buf)) < 0) { | 
 | 1331 | 		dbg("Failed to read MAC address: %d", ret); | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1332 | 		goto out; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1333 | 	} | 
 | 1334 | 	memcpy(dev->net->dev_addr, buf, ETH_ALEN); | 
 | 1335 |  | 
 | 1336 | 	/* Initialize MII structure */ | 
 | 1337 | 	dev->mii.dev = dev->net; | 
 | 1338 | 	dev->mii.mdio_read = asix_mdio_read; | 
 | 1339 | 	dev->mii.mdio_write = asix_mdio_write; | 
 | 1340 | 	dev->mii.phy_id_mask = 0x1f; | 
 | 1341 | 	dev->mii.reg_num_mask = 0xff; | 
 | 1342 | 	dev->mii.supports_gmii = 1; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1343 | 	dev->mii.phy_id = asix_get_phy_addr(dev); | 
| Stephen Hemminger | 1703338 | 2009-03-20 19:35:55 +0000 | [diff] [blame] | 1344 |  | 
 | 1345 | 	dev->net->netdev_ops = &ax88178_netdev_ops; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1346 | 	dev->net->ethtool_ops = &ax88178_ethtool_ops; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1347 |  | 
 | 1348 | 	phyid = asix_get_phyid(dev); | 
 | 1349 | 	dbg("PHYID=0x%08x", phyid); | 
 | 1350 |  | 
 | 1351 | 	if (data->phymode == PHY_MODE_MARVELL) { | 
 | 1352 | 		marvell_phy_init(dev); | 
 | 1353 | 		msleep(60); | 
 | 1354 | 	} | 
 | 1355 |  | 
 | 1356 | 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, | 
 | 1357 | 			BMCR_RESET | BMCR_ANENABLE); | 
 | 1358 | 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE, | 
 | 1359 | 			ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP); | 
 | 1360 | 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_CTRL1000, | 
 | 1361 | 			ADVERTISE_1000FULL); | 
 | 1362 |  | 
 | 1363 | 	mii_nway_restart(&dev->mii); | 
 | 1364 |  | 
 | 1365 | 	if ((ret = asix_write_medium_mode(dev, AX88178_MEDIUM_DEFAULT)) < 0) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1366 | 		goto out; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1367 |  | 
 | 1368 | 	if ((ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL)) < 0) | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1369 | 		goto out; | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1370 |  | 
 | 1371 | 	/* Asix framing packs multiple eth frames into a 2K usb bulk transfer */ | 
 | 1372 | 	if (dev->driver_info->flags & FLAG_FRAMING_AX) { | 
 | 1373 | 		/* hard_mtu  is still the default - the device does not support | 
 | 1374 | 		   jumbo eth frames */ | 
 | 1375 | 		dev->rx_urb_size = 2048; | 
 | 1376 | 	} | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1377 | 	return 0; | 
 | 1378 |  | 
| Al Viro | 51bf297 | 2007-12-22 17:42:36 +0000 | [diff] [blame] | 1379 | out: | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1380 | 	return ret; | 
 | 1381 | } | 
 | 1382 |  | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1383 | static const struct driver_info ax8817x_info = { | 
 | 1384 | 	.description = "ASIX AX8817x USB 2.0 Ethernet", | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 1385 | 	.bind = ax88172_bind, | 
 | 1386 | 	.status = asix_status, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1387 | 	.link_reset = ax88172_link_reset, | 
 | 1388 | 	.reset = ax88172_link_reset, | 
| Ben Hutchings | 37e8273 | 2009-11-04 15:29:52 +0000 | [diff] [blame] | 1389 | 	.flags =  FLAG_ETHER | FLAG_LINK_INTR, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1390 | 	.data = 0x00130103, | 
 | 1391 | }; | 
 | 1392 |  | 
 | 1393 | static const struct driver_info dlink_dub_e100_info = { | 
 | 1394 | 	.description = "DLink DUB-E100 USB Ethernet", | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 1395 | 	.bind = ax88172_bind, | 
 | 1396 | 	.status = asix_status, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1397 | 	.link_reset = ax88172_link_reset, | 
 | 1398 | 	.reset = ax88172_link_reset, | 
| Ben Hutchings | 37e8273 | 2009-11-04 15:29:52 +0000 | [diff] [blame] | 1399 | 	.flags =  FLAG_ETHER | FLAG_LINK_INTR, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1400 | 	.data = 0x009f9d9f, | 
 | 1401 | }; | 
 | 1402 |  | 
 | 1403 | static const struct driver_info netgear_fa120_info = { | 
 | 1404 | 	.description = "Netgear FA-120 USB Ethernet", | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 1405 | 	.bind = ax88172_bind, | 
 | 1406 | 	.status = asix_status, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1407 | 	.link_reset = ax88172_link_reset, | 
 | 1408 | 	.reset = ax88172_link_reset, | 
| Ben Hutchings | 37e8273 | 2009-11-04 15:29:52 +0000 | [diff] [blame] | 1409 | 	.flags =  FLAG_ETHER | FLAG_LINK_INTR, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1410 | 	.data = 0x00130103, | 
 | 1411 | }; | 
 | 1412 |  | 
 | 1413 | static const struct driver_info hawking_uf200_info = { | 
 | 1414 | 	.description = "Hawking UF200 USB Ethernet", | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 1415 | 	.bind = ax88172_bind, | 
 | 1416 | 	.status = asix_status, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1417 | 	.link_reset = ax88172_link_reset, | 
 | 1418 | 	.reset = ax88172_link_reset, | 
| Ben Hutchings | 37e8273 | 2009-11-04 15:29:52 +0000 | [diff] [blame] | 1419 | 	.flags =  FLAG_ETHER | FLAG_LINK_INTR, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1420 | 	.data = 0x001f1d1f, | 
 | 1421 | }; | 
 | 1422 |  | 
 | 1423 | static const struct driver_info ax88772_info = { | 
 | 1424 | 	.description = "ASIX AX88772 USB 2.0 Ethernet", | 
 | 1425 | 	.bind = ax88772_bind, | 
| David Hollis | 48b1be6 | 2006-03-28 20:15:42 -0500 | [diff] [blame] | 1426 | 	.status = asix_status, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1427 | 	.link_reset = ax88772_link_reset, | 
 | 1428 | 	.reset = ax88772_link_reset, | 
| Ben Hutchings | 37e8273 | 2009-11-04 15:29:52 +0000 | [diff] [blame] | 1429 | 	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR, | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1430 | 	.rx_fixup = asix_rx_fixup, | 
 | 1431 | 	.tx_fixup = asix_tx_fixup, | 
 | 1432 | }; | 
 | 1433 |  | 
 | 1434 | static const struct driver_info ax88178_info = { | 
 | 1435 | 	.description = "ASIX AX88178 USB 2.0 Ethernet", | 
 | 1436 | 	.bind = ax88178_bind, | 
 | 1437 | 	.status = asix_status, | 
 | 1438 | 	.link_reset = ax88178_link_reset, | 
 | 1439 | 	.reset = ax88178_link_reset, | 
| Ben Hutchings | 37e8273 | 2009-11-04 15:29:52 +0000 | [diff] [blame] | 1440 | 	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR, | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1441 | 	.rx_fixup = asix_rx_fixup, | 
 | 1442 | 	.tx_fixup = asix_tx_fixup, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1443 | }; | 
 | 1444 |  | 
 | 1445 | static const struct usb_device_id	products [] = { | 
 | 1446 | { | 
 | 1447 | 	// Linksys USB200M | 
 | 1448 | 	USB_DEVICE (0x077b, 0x2226), | 
 | 1449 | 	.driver_info =	(unsigned long) &ax8817x_info, | 
 | 1450 | }, { | 
 | 1451 | 	// Netgear FA120 | 
 | 1452 | 	USB_DEVICE (0x0846, 0x1040), | 
 | 1453 | 	.driver_info =  (unsigned long) &netgear_fa120_info, | 
 | 1454 | }, { | 
 | 1455 | 	// DLink DUB-E100 | 
 | 1456 | 	USB_DEVICE (0x2001, 0x1a00), | 
 | 1457 | 	.driver_info =  (unsigned long) &dlink_dub_e100_info, | 
 | 1458 | }, { | 
 | 1459 | 	// Intellinet, ST Lab USB Ethernet | 
 | 1460 | 	USB_DEVICE (0x0b95, 0x1720), | 
 | 1461 | 	.driver_info =  (unsigned long) &ax8817x_info, | 
 | 1462 | }, { | 
 | 1463 | 	// Hawking UF200, TrendNet TU2-ET100 | 
 | 1464 | 	USB_DEVICE (0x07b8, 0x420a), | 
 | 1465 | 	.driver_info =  (unsigned long) &hawking_uf200_info, | 
 | 1466 | }, { | 
| David Hollis | 39c4b38 | 2007-02-20 08:02:24 -0500 | [diff] [blame] | 1467 | 	// Billionton Systems, USB2AR | 
 | 1468 | 	USB_DEVICE (0x08dd, 0x90ff), | 
 | 1469 | 	.driver_info =  (unsigned long) &ax8817x_info, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1470 | }, { | 
 | 1471 | 	// ATEN UC210T | 
 | 1472 | 	USB_DEVICE (0x0557, 0x2009), | 
 | 1473 | 	.driver_info =  (unsigned long) &ax8817x_info, | 
 | 1474 | }, { | 
 | 1475 | 	// Buffalo LUA-U2-KTX | 
 | 1476 | 	USB_DEVICE (0x0411, 0x003d), | 
 | 1477 | 	.driver_info =  (unsigned long) &ax8817x_info, | 
 | 1478 | }, { | 
| Mattia Dongili | ac7b77f | 2008-05-06 20:42:35 -0700 | [diff] [blame] | 1479 | 	// Buffalo LUA-U2-GT 10/100/1000 | 
 | 1480 | 	USB_DEVICE (0x0411, 0x006e), | 
 | 1481 | 	.driver_info =  (unsigned long) &ax88178_info, | 
 | 1482 | }, { | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1483 | 	// Sitecom LN-029 "USB 2.0 10/100 Ethernet adapter" | 
 | 1484 | 	USB_DEVICE (0x6189, 0x182d), | 
 | 1485 | 	.driver_info =  (unsigned long) &ax8817x_info, | 
 | 1486 | }, { | 
 | 1487 | 	// corega FEther USB2-TX | 
 | 1488 | 	USB_DEVICE (0x07aa, 0x0017), | 
 | 1489 | 	.driver_info =  (unsigned long) &ax8817x_info, | 
 | 1490 | }, { | 
 | 1491 | 	// Surecom EP-1427X-2 | 
 | 1492 | 	USB_DEVICE (0x1189, 0x0893), | 
 | 1493 | 	.driver_info = (unsigned long) &ax8817x_info, | 
 | 1494 | }, { | 
 | 1495 | 	// goodway corp usb gwusb2e | 
 | 1496 | 	USB_DEVICE (0x1631, 0x6200), | 
 | 1497 | 	.driver_info = (unsigned long) &ax8817x_info, | 
 | 1498 | }, { | 
| David Hollis | 39c4b38 | 2007-02-20 08:02:24 -0500 | [diff] [blame] | 1499 | 	// JVC MP-PRX1 Port Replicator | 
 | 1500 | 	USB_DEVICE (0x04f1, 0x3008), | 
 | 1501 | 	.driver_info = (unsigned long) &ax8817x_info, | 
 | 1502 | }, { | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1503 | 	// ASIX AX88772 10/100 | 
| David Hollis | 39c4b38 | 2007-02-20 08:02:24 -0500 | [diff] [blame] | 1504 | 	USB_DEVICE (0x0b95, 0x7720), | 
 | 1505 | 	.driver_info = (unsigned long) &ax88772_info, | 
| David Hollis | 5e0f76c | 2005-12-19 13:58:38 -0500 | [diff] [blame] | 1506 | }, { | 
| Eduard Warkentin | 7327413 | 2006-05-18 01:13:17 -0700 | [diff] [blame] | 1507 | 	// ASIX AX88178 10/100/1000 | 
 | 1508 | 	USB_DEVICE (0x0b95, 0x1780), | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1509 | 	.driver_info = (unsigned long) &ax88178_info, | 
| Eduard Warkentin | 7327413 | 2006-05-18 01:13:17 -0700 | [diff] [blame] | 1510 | }, { | 
| David Hollis | 5e0f76c | 2005-12-19 13:58:38 -0500 | [diff] [blame] | 1511 | 	// Linksys USB200M Rev 2 | 
 | 1512 | 	USB_DEVICE (0x13b1, 0x0018), | 
 | 1513 | 	.driver_info = (unsigned long) &ax88772_info, | 
| David Hollis | 5732ce8 | 2006-01-05 14:39:49 -0500 | [diff] [blame] | 1514 | }, { | 
 | 1515 | 	// 0Q0 cable ethernet | 
 | 1516 | 	USB_DEVICE (0x1557, 0x7720), | 
 | 1517 | 	.driver_info = (unsigned long) &ax88772_info, | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1518 | }, { | 
 | 1519 | 	// DLink DUB-E100 H/W Ver B1 | 
 | 1520 | 	USB_DEVICE (0x07d1, 0x3c05), | 
 | 1521 | 	.driver_info = (unsigned long) &ax88772_info, | 
 | 1522 | }, { | 
| David Hollis | b923e7f | 2006-09-21 08:09:29 -0400 | [diff] [blame] | 1523 | 	// DLink DUB-E100 H/W Ver B1 Alternate | 
 | 1524 | 	USB_DEVICE (0x2001, 0x3c05), | 
 | 1525 | 	.driver_info = (unsigned long) &ax88772_info, | 
 | 1526 | }, { | 
| David Hollis | 933a27d | 2006-07-29 10:12:50 -0400 | [diff] [blame] | 1527 | 	// Linksys USB1000 | 
 | 1528 | 	USB_DEVICE (0x1737, 0x0039), | 
 | 1529 | 	.driver_info = (unsigned long) &ax88178_info, | 
| YOSHIFUJI Hideaki / 吉藤英明 | b29cf31 | 2007-01-26 22:57:38 +0900 | [diff] [blame] | 1530 | }, { | 
 | 1531 | 	// IO-DATA ETG-US2 | 
 | 1532 | 	USB_DEVICE (0x04bb, 0x0930), | 
 | 1533 | 	.driver_info = (unsigned long) &ax88178_info, | 
| David Hollis | 2ed22bc | 2007-05-23 07:33:17 -0400 | [diff] [blame] | 1534 | }, { | 
 | 1535 | 	// Belkin F5D5055 | 
 | 1536 | 	USB_DEVICE(0x050d, 0x5055), | 
 | 1537 | 	.driver_info = (unsigned long) &ax88178_info, | 
| Aurelien Nephtali | 3d60efb5 | 2008-05-14 17:04:13 -0700 | [diff] [blame] | 1538 | }, { | 
 | 1539 | 	// Apple USB Ethernet Adapter | 
 | 1540 | 	USB_DEVICE(0x05ac, 0x1402), | 
 | 1541 | 	.driver_info = (unsigned long) &ax88772_info, | 
| Jason Cooper | ccf9540 | 2008-11-11 13:02:53 -0500 | [diff] [blame] | 1542 | }, { | 
 | 1543 | 	// Cables-to-Go USB Ethernet Adapter | 
 | 1544 | 	USB_DEVICE(0x0b95, 0x772a), | 
 | 1545 | 	.driver_info = (unsigned long) &ax88772_info, | 
| Greg Kroah-Hartman | fef7cc0 | 2009-02-24 23:52:24 -0800 | [diff] [blame] | 1546 | }, { | 
 | 1547 | 	// ABOCOM for pci | 
 | 1548 | 	USB_DEVICE(0x14ea, 0xab11), | 
 | 1549 | 	.driver_info = (unsigned long) &ax88178_info, | 
 | 1550 | }, { | 
 | 1551 | 	// ASIX 88772a | 
 | 1552 | 	USB_DEVICE(0x0db0, 0xa877), | 
 | 1553 | 	.driver_info = (unsigned long) &ax88772_info, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1554 | }, | 
 | 1555 | 	{ },		// END | 
 | 1556 | }; | 
 | 1557 | MODULE_DEVICE_TABLE(usb, products); | 
 | 1558 |  | 
 | 1559 | static struct usb_driver asix_driver = { | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1560 | 	.name =		"asix", | 
 | 1561 | 	.id_table =	products, | 
 | 1562 | 	.probe =	usbnet_probe, | 
 | 1563 | 	.suspend =	usbnet_suspend, | 
 | 1564 | 	.resume =	usbnet_resume, | 
 | 1565 | 	.disconnect =	usbnet_disconnect, | 
| Oliver Neukum | a11a654 | 2007-08-03 13:52:19 +0200 | [diff] [blame] | 1566 | 	.supports_autosuspend = 1, | 
| David Brownell | 2e55cc7 | 2005-08-31 09:53:10 -0700 | [diff] [blame] | 1567 | }; | 
 | 1568 |  | 
 | 1569 | static int __init asix_init(void) | 
 | 1570 | { | 
 | 1571 |  	return usb_register(&asix_driver); | 
 | 1572 | } | 
 | 1573 | module_init(asix_init); | 
 | 1574 |  | 
 | 1575 | static void __exit asix_exit(void) | 
 | 1576 | { | 
 | 1577 |  	usb_deregister(&asix_driver); | 
 | 1578 | } | 
 | 1579 | module_exit(asix_exit); | 
 | 1580 |  | 
 | 1581 | MODULE_AUTHOR("David Hollis"); | 
 | 1582 | MODULE_DESCRIPTION("ASIX AX8817X based USB 2.0 Ethernet Devices"); | 
 | 1583 | MODULE_LICENSE("GPL"); | 
 | 1584 |  |