asix.c 42.6 KB
Newer Older
1 2
/*
 * ASIX AX8817X based USB 2.0 Ethernet Devices
3
 * Copyright (C) 2003-2006 David Hollis <dhollis@davehollis.com>
4
 * Copyright (C) 2005 Phil Chang <pchang23@sbcglobal.net>
5
 * Copyright (C) 2006 James Painter <jamie.painter@iname.com>
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35
 * Copyright (c) 2002-2003 TiVo Inc.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */

// #define	DEBUG			// error path messages, extra info
// #define	VERBOSE			// more; success messages

#include <linux/module.h>
#include <linux/kmod.h>
#include <linux/init.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/ethtool.h>
#include <linux/workqueue.h>
#include <linux/mii.h>
#include <linux/usb.h>
#include <linux/crc32.h>
36
#include <linux/usb/usbnet.h>
37
#include <linux/slab.h>
38

39
#define DRIVER_VERSION "22-Dec-2011"
40
#define DRIVER_NAME "asix"
41

42 43 44 45 46 47 48 49 50 51
/* ASIX AX8817X based USB 2.0 Ethernet Devices */

#define AX_CMD_SET_SW_MII		0x06
#define AX_CMD_READ_MII_REG		0x07
#define AX_CMD_WRITE_MII_REG		0x08
#define AX_CMD_SET_HW_MII		0x0a
#define AX_CMD_READ_EEPROM		0x0b
#define AX_CMD_WRITE_EEPROM		0x0c
#define AX_CMD_WRITE_ENABLE		0x0d
#define AX_CMD_WRITE_DISABLE		0x0e
52
#define AX_CMD_READ_RX_CTL		0x0f
53 54 55 56
#define AX_CMD_WRITE_RX_CTL		0x10
#define AX_CMD_READ_IPG012		0x11
#define AX_CMD_WRITE_IPG0		0x12
#define AX_CMD_WRITE_IPG1		0x13
57
#define AX_CMD_READ_NODE_ID		0x13
58
#define AX_CMD_WRITE_NODE_ID		0x14
59 60
#define AX_CMD_WRITE_IPG2		0x14
#define AX_CMD_WRITE_MULTI_FILTER	0x16
61
#define AX88172_CMD_READ_NODE_ID	0x17
62 63 64 65 66
#define AX_CMD_READ_PHY_ID		0x19
#define AX_CMD_READ_MEDIUM_STATUS	0x1a
#define AX_CMD_WRITE_MEDIUM_MODE	0x1b
#define AX_CMD_READ_MONITOR_MODE	0x1c
#define AX_CMD_WRITE_MONITOR_MODE	0x1d
67
#define AX_CMD_READ_GPIOS		0x1e
68 69 70 71 72 73 74 75 76 77 78
#define AX_CMD_WRITE_GPIOS		0x1f
#define AX_CMD_SW_RESET			0x20
#define AX_CMD_SW_PHY_STATUS		0x21
#define AX_CMD_SW_PHY_SELECT		0x22

#define AX_MONITOR_MODE			0x01
#define AX_MONITOR_LINK			0x02
#define AX_MONITOR_MAGIC		0x04
#define AX_MONITOR_HSFS			0x10

/* AX88172 Medium Status Register values */
79 80 81 82 83
#define AX88172_MEDIUM_FD		0x02
#define AX88172_MEDIUM_TX		0x04
#define AX88172_MEDIUM_FC		0x10
#define AX88172_MEDIUM_DEFAULT \
		( AX88172_MEDIUM_FD | AX88172_MEDIUM_TX | AX88172_MEDIUM_FC )
84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100

#define AX_MCAST_FILTER_SIZE		8
#define AX_MAX_MCAST			64

#define AX_SWRESET_CLEAR		0x00
#define AX_SWRESET_RR			0x01
#define AX_SWRESET_RT			0x02
#define AX_SWRESET_PRTE			0x04
#define AX_SWRESET_PRL			0x08
#define AX_SWRESET_BZ			0x10
#define AX_SWRESET_IPRL			0x20
#define AX_SWRESET_IPPD			0x40

#define AX88772_IPG0_DEFAULT		0x15
#define AX88772_IPG1_DEFAULT		0x0c
#define AX88772_IPG2_DEFAULT		0x12

101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117
/* AX88772 & AX88178 Medium Mode Register */
#define AX_MEDIUM_PF		0x0080
#define AX_MEDIUM_JFE		0x0040
#define AX_MEDIUM_TFC		0x0020
#define AX_MEDIUM_RFC		0x0010
#define AX_MEDIUM_ENCK		0x0008
#define AX_MEDIUM_AC		0x0004
#define AX_MEDIUM_FD		0x0002
#define AX_MEDIUM_GM		0x0001
#define AX_MEDIUM_SM		0x1000
#define AX_MEDIUM_SBP		0x0800
#define AX_MEDIUM_PS		0x0200
#define AX_MEDIUM_RE		0x0100

#define AX88178_MEDIUM_DEFAULT	\
	(AX_MEDIUM_PS | AX_MEDIUM_FD | AX_MEDIUM_AC | \
	 AX_MEDIUM_RFC | AX_MEDIUM_TFC | AX_MEDIUM_JFE | \
118
	 AX_MEDIUM_RE)
119

120 121 122
#define AX88772_MEDIUM_DEFAULT	\
	(AX_MEDIUM_FD | AX_MEDIUM_RFC | \
	 AX_MEDIUM_TFC | AX_MEDIUM_PS | \
123
	 AX_MEDIUM_AC | AX_MEDIUM_RE)
124 125

/* AX88772 & AX88178 RX_CTL values */
126 127 128 129 130 131 132 133 134 135 136 137 138
#define AX_RX_CTL_SO		0x0080
#define AX_RX_CTL_AP		0x0020
#define AX_RX_CTL_AM		0x0010
#define AX_RX_CTL_AB		0x0008
#define AX_RX_CTL_SEP		0x0004
#define AX_RX_CTL_AMALL		0x0002
#define AX_RX_CTL_PRO		0x0001
#define AX_RX_CTL_MFB_2048	0x0000
#define AX_RX_CTL_MFB_4096	0x0100
#define AX_RX_CTL_MFB_8192	0x0200
#define AX_RX_CTL_MFB_16384	0x0300

#define AX_DEFAULT_RX_CTL	(AX_RX_CTL_SO | AX_RX_CTL_AB)
139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164

/* GPIO 0 .. 2 toggles */
#define AX_GPIO_GPO0EN		0x01	/* GPIO0 Output enable */
#define AX_GPIO_GPO_0		0x02	/* GPIO0 Output value */
#define AX_GPIO_GPO1EN		0x04	/* GPIO1 Output enable */
#define AX_GPIO_GPO_1		0x08	/* GPIO1 Output value */
#define AX_GPIO_GPO2EN		0x10	/* GPIO2 Output enable */
#define AX_GPIO_GPO_2		0x20	/* GPIO2 Output value */
#define AX_GPIO_RESERVED	0x40	/* Reserved */
#define AX_GPIO_RSE		0x80	/* Reload serial EEPROM */

#define AX_EEPROM_MAGIC		0xdeadbeef
#define AX88172_EEPROM_LEN	0x40
#define AX88772_EEPROM_LEN	0xff

#define PHY_MODE_MARVELL	0x0000
#define MII_MARVELL_LED_CTRL	0x0018
#define MII_MARVELL_STATUS	0x001b
#define MII_MARVELL_CTRL	0x0014

#define MARVELL_LED_MANUAL	0x0019

#define MARVELL_STATUS_HWCFG	0x0004

#define MARVELL_CTRL_TXDELAY	0x0002
#define MARVELL_CTRL_RXDELAY	0x0080
165

166
#define	PHY_MODE_RTL8211CL	0x000C
167

168
/* This structure cannot exceed sizeof(unsigned long [5]) AKA 20 bytes */
169
struct asix_data {
170
	u8 multi_filter[AX_MCAST_FILTER_SIZE];
171
	u8 mac_addr[ETH_ALEN];
172 173 174
	u8 phymode;
	u8 ledmode;
	u8 eeprom_len;
175 176 177
};

struct ax88172_int_data {
A
Al Viro 已提交
178
	__le16 res1;
179
	u8 link;
A
Al Viro 已提交
180
	__le16 res2;
181
	u8 status;
A
Al Viro 已提交
182
	__le16 res3;
183
} __packed;
184

185
static int asix_read_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
186 187
			    u16 size, void *data)
{
A
Al Viro 已提交
188 189 190
	void *buf;
	int err = -ENOMEM;

191 192
	netdev_dbg(dev->net, "asix_read_cmd() cmd=0x%02x value=0x%04x index=0x%04x size=%d\n",
		   cmd, value, index, size);
A
Al Viro 已提交
193 194 195 196 197 198

	buf = kmalloc(size, GFP_KERNEL);
	if (!buf)
		goto out;

	err = usb_control_msg(
199 200 201 202 203 204
		dev->udev,
		usb_rcvctrlpipe(dev->udev, 0),
		cmd,
		USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
		value,
		index,
A
Al Viro 已提交
205
		buf,
206 207
		size,
		USB_CTRL_GET_TIMEOUT);
R
Russ Dill 已提交
208
	if (err == size)
A
Al Viro 已提交
209
		memcpy(data, buf, size);
R
Russ Dill 已提交
210 211
	else if (err >= 0)
		err = -EINVAL;
A
Al Viro 已提交
212 213 214 215
	kfree(buf);

out:
	return err;
216 217
}

218
static int asix_write_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
219 220
			     u16 size, void *data)
{
A
Al Viro 已提交
221 222 223
	void *buf = NULL;
	int err = -ENOMEM;

224 225
	netdev_dbg(dev->net, "asix_write_cmd() cmd=0x%02x value=0x%04x index=0x%04x size=%d\n",
		   cmd, value, index, size);
A
Al Viro 已提交
226 227

	if (data) {
J
Julia Lawall 已提交
228
		buf = kmemdup(data, size, GFP_KERNEL);
A
Al Viro 已提交
229 230 231 232 233
		if (!buf)
			goto out;
	}

	err = usb_control_msg(
234 235 236 237 238 239
		dev->udev,
		usb_sndctrlpipe(dev->udev, 0),
		cmd,
		USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
		value,
		index,
A
Al Viro 已提交
240
		buf,
241 242
		size,
		USB_CTRL_SET_TIMEOUT);
A
Al Viro 已提交
243 244 245 246
	kfree(buf);

out:
	return err;
247 248
}

249
static void asix_async_cmd_callback(struct urb *urb)
250 251
{
	struct usb_ctrlrequest *req = (struct usb_ctrlrequest *)urb->context;
252
	int status = urb->status;
253

254
	if (status < 0)
255
		printk(KERN_DEBUG "asix_async_cmd_callback() failed with %d",
256
			status);
257 258 259 260 261

	kfree(req);
	usb_free_urb(urb);
}

262 263 264 265 266 267 268 269
static void
asix_write_cmd_async(struct usbnet *dev, u8 cmd, u16 value, u16 index,
				    u16 size, void *data)
{
	struct usb_ctrlrequest *req;
	int status;
	struct urb *urb;

270 271
	netdev_dbg(dev->net, "asix_write_cmd_async() cmd=0x%02x value=0x%04x index=0x%04x size=%d\n",
		   cmd, value, index, size);
272 273 274

	urb = usb_alloc_urb(0, GFP_ATOMIC);
	if (!urb) {
275
		netdev_err(dev->net, "Error allocating URB in write_cmd_async!\n");
276 277 278
		return;
	}

279 280
	req = kmalloc(sizeof(struct usb_ctrlrequest), GFP_ATOMIC);
	if (!req) {
281
		netdev_err(dev->net, "Failed to allocate memory for control request\n");
282 283 284 285 286 287
		usb_free_urb(urb);
		return;
	}

	req->bRequestType = USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE;
	req->bRequest = cmd;
O
Oliver Neukum 已提交
288 289 290
	req->wValue = cpu_to_le16(value);
	req->wIndex = cpu_to_le16(index);
	req->wLength = cpu_to_le16(size);
291 292 293 294 295 296

	usb_fill_control_urb(urb, dev->udev,
			     usb_sndctrlpipe(dev->udev, 0),
			     (void *)req, data, size,
			     asix_async_cmd_callback, req);

297 298
	status = usb_submit_urb(urb, GFP_ATOMIC);
	if (status < 0) {
299 300
		netdev_err(dev->net, "Error submitting the control message: status=%d\n",
			   status);
301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321
		kfree(req);
		usb_free_urb(urb);
	}
}

static int asix_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
{
	u8  *head;
	u32  header;
	char *packet;
	struct sk_buff *ax_skb;
	u16 size;

	head = (u8 *) skb->data;
	memcpy(&header, head, sizeof(header));
	le32_to_cpus(&header);
	packet = head + sizeof(header);

	skb_pull(skb, 4);

	while (skb->len > 0) {
322
		if ((header & 0x07ff) != ((~header >> 16) & 0x07ff))
323
			netdev_err(dev->net, "asix_rx_fixup() Bad Header Length\n");
324

325
		/* get the packet length */
326
		size = (u16) (header & 0x000007ff);
327

328
		if ((skb->len) - ((size + 1) & 0xfffe) == 0) {
329
			u8 alignment = (unsigned long)skb->data & 0x3;
330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347
			if (alignment != 0x2) {
				/*
				 * not 16bit aligned so use the room provided by
				 * the 32 bit header to align the data
				 *
				 * note we want 16bit alignment as MAC header is
				 * 14bytes thus ip header will be aligned on
				 * 32bit boundary so accessing ipheader elements
				 * using a cast to struct ip header wont cause
				 * an unaligned accesses.
				 */
				u8 realignment = (alignment + 2) & 0x3;
				memmove(skb->data - realignment,
					skb->data,
					size);
				skb->data -= realignment;
				skb_set_tail_pointer(skb, size);
			}
348
			return 2;
349 350
		}

351
		if (size > dev->net->mtu + ETH_HLEN) {
352 353
			netdev_err(dev->net, "asix_rx_fixup() Bad RX Length %d\n",
				   size);
354 355 356 357
			return 0;
		}
		ax_skb = skb_clone(skb, GFP_ATOMIC);
		if (ax_skb) {
358
			u8 alignment = (unsigned long)packet & 0x3;
359
			ax_skb->len = size;
360 361 362 363 364 365 366 367 368 369

			if (alignment != 0x2) {
				/*
				 * not 16bit aligned use the room provided by
				 * the 32 bit header to align the data
				 */
				u8 realignment = (alignment + 2) & 0x3;
				memmove(packet - realignment, packet, size);
				packet -= realignment;
			}
370
			ax_skb->data = packet;
371
			skb_set_tail_pointer(ax_skb, size);
372 373 374 375 376 377 378
			usbnet_skb_return(dev, ax_skb);
		} else {
			return 0;
		}

		skb_pull(skb, (size + 1) & 0xfffe);

379
		if (skb->len < sizeof(header))
380 381 382 383 384 385 386 387 388 389
			break;

		head = (u8 *) skb->data;
		memcpy(&header, head, sizeof(header));
		le32_to_cpus(&header);
		packet = head + sizeof(header);
		skb_pull(skb, 4);
	}

	if (skb->len < 0) {
390 391
		netdev_err(dev->net, "asix_rx_fixup() Bad SKB Length %d\n",
			   skb->len);
392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407
		return 0;
	}
	return 1;
}

static struct sk_buff *asix_tx_fixup(struct usbnet *dev, struct sk_buff *skb,
					gfp_t flags)
{
	int padlen;
	int headroom = skb_headroom(skb);
	int tailroom = skb_tailroom(skb);
	u32 packet_len;
	u32 padbytes = 0xffff0000;

	padlen = ((skb->len + 4) % 512) ? 0 : 4;

408 409
	if ((!skb_cloned(skb)) &&
	    ((headroom + tailroom) >= (4 + padlen))) {
410 411
		if ((headroom < 4) || (tailroom < padlen)) {
			skb->data = memmove(skb->head + 4, skb->data, skb->len);
412
			skb_set_tail_pointer(skb, skb->len);
413 414 415 416 417 418 419 420 421 422 423 424
		}
	} else {
		struct sk_buff *skb2;
		skb2 = skb_copy_expand(skb, 4, padlen, flags);
		dev_kfree_skb_any(skb);
		skb = skb2;
		if (!skb)
			return NULL;
	}

	skb_push(skb, 4);
	packet_len = (((skb->len - 4) ^ 0x0000ffff) << 16) + (skb->len - 4);
425
	cpu_to_le32s(&packet_len);
426
	skb_copy_to_linear_data(skb, &packet_len, sizeof(packet_len));
427 428

	if ((skb->len % 512) == 0) {
429
		cpu_to_le32s(&padbytes);
430
		memcpy(skb_tail_pointer(skb), &padbytes, sizeof(padbytes));
431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451
		skb_put(skb, sizeof(padbytes));
	}
	return skb;
}

static void asix_status(struct usbnet *dev, struct urb *urb)
{
	struct ax88172_int_data *event;
	int link;

	if (urb->actual_length < 8)
		return;

	event = urb->transfer_buffer;
	link = event->link & 0x01;
	if (netif_carrier_ok(dev->net) != link) {
		if (link) {
			netif_carrier_on(dev->net);
			usbnet_defer_kevent (dev, EVENT_LINK_RESET );
		} else
			netif_carrier_off(dev->net);
452
		netdev_dbg(dev->net, "Link Status is: %d\n", link);
453 454 455
	}
}

456 457 458 459 460
static inline int asix_set_sw_mii(struct usbnet *dev)
{
	int ret;
	ret = asix_write_cmd(dev, AX_CMD_SET_SW_MII, 0x0000, 0, 0, NULL);
	if (ret < 0)
461
		netdev_err(dev->net, "Failed to enable software MII access\n");
462 463 464 465 466 467 468 469
	return ret;
}

static inline int asix_set_hw_mii(struct usbnet *dev)
{
	int ret;
	ret = asix_write_cmd(dev, AX_CMD_SET_HW_MII, 0x0000, 0, 0, NULL);
	if (ret < 0)
470
		netdev_err(dev->net, "Failed to enable hardware MII access\n");
471 472 473
	return ret;
}

474
static inline int asix_get_phy_addr(struct usbnet *dev)
475
{
A
Al Viro 已提交
476 477
	u8 buf[2];
	int ret = asix_read_cmd(dev, AX_CMD_READ_PHY_ID, 0, 0, 2, buf);
478

479
	netdev_dbg(dev->net, "asix_get_phy_addr()\n");
480

A
Al Viro 已提交
481
	if (ret < 0) {
482
		netdev_err(dev->net, "Error reading PHYID register: %02x\n", ret);
A
Al Viro 已提交
483
		goto out;
484
	}
485 486
	netdev_dbg(dev->net, "asix_get_phy_addr() returning 0x%04x\n",
		   *((__le16 *)buf));
A
Al Viro 已提交
487 488 489
	ret = buf[1];

out:
490 491 492 493 494 495 496 497 498
	return ret;
}

static int asix_sw_reset(struct usbnet *dev, u8 flags)
{
	int ret;

        ret = asix_write_cmd(dev, AX_CMD_SW_RESET, flags, 0, 0, NULL);
	if (ret < 0)
499
		netdev_err(dev->net, "Failed to send software reset: %02x\n", ret);
500 501 502

	return ret;
}
503

504 505
static u16 asix_read_rx_ctl(struct usbnet *dev)
{
A
Al Viro 已提交
506 507
	__le16 v;
	int ret = asix_read_cmd(dev, AX_CMD_READ_RX_CTL, 0, 0, 2, &v);
508

A
Al Viro 已提交
509
	if (ret < 0) {
510
		netdev_err(dev->net, "Error reading RX_CTL register: %02x\n", ret);
A
Al Viro 已提交
511
		goto out;
512
	}
A
Al Viro 已提交
513 514
	ret = le16_to_cpu(v);
out:
515 516 517 518 519 520 521
	return ret;
}

static int asix_write_rx_ctl(struct usbnet *dev, u16 mode)
{
	int ret;

522
	netdev_dbg(dev->net, "asix_write_rx_ctl() - mode = 0x%04x\n", mode);
523 524
	ret = asix_write_cmd(dev, AX_CMD_WRITE_RX_CTL, mode, 0, 0, NULL);
	if (ret < 0)
525 526
		netdev_err(dev->net, "Failed to write RX_CTL mode to 0x%04x: %02x\n",
			   mode, ret);
527 528 529 530

	return ret;
}

531
static u16 asix_read_medium_status(struct usbnet *dev)
532
{
A
Al Viro 已提交
533 534
	__le16 v;
	int ret = asix_read_cmd(dev, AX_CMD_READ_MEDIUM_STATUS, 0, 0, 2, &v);
535

A
Al Viro 已提交
536
	if (ret < 0) {
537 538
		netdev_err(dev->net, "Error reading Medium Status register: %02x\n",
			   ret);
539
		return ret;	/* TODO: callers not checking for error ret */
540
	}
541 542 543

	return le16_to_cpu(v);

544 545
}

546
static int asix_write_medium_mode(struct usbnet *dev, u16 mode)
547
{
548
	int ret;
549

550
	netdev_dbg(dev->net, "asix_write_medium_mode() - mode = 0x%04x\n", mode);
551 552
	ret = asix_write_cmd(dev, AX_CMD_WRITE_MEDIUM_MODE, mode, 0, 0, NULL);
	if (ret < 0)
553 554
		netdev_err(dev->net, "Failed to write Medium Mode mode to 0x%04x: %02x\n",
			   mode, ret);
555

556 557
	return ret;
}
558

559 560 561
static int asix_write_gpio(struct usbnet *dev, u16 value, int sleep)
{
	int ret;
562

563
	netdev_dbg(dev->net, "asix_write_gpio() - value = 0x%04x\n", value);
564 565
	ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS, value, 0, 0, NULL);
	if (ret < 0)
566 567
		netdev_err(dev->net, "Failed to write GPIO value 0x%04x: %02x\n",
			   value, ret);
568

569 570 571 572
	if (sleep)
		msleep(sleep);

	return ret;
573 574
}

575 576 577
/*
 * AX88772 & AX88178 have a 16-bit RX_CTL value
 */
578
static void asix_set_multicast(struct net_device *net)
579 580
{
	struct usbnet *dev = netdev_priv(net);
581
	struct asix_data *data = (struct asix_data *)&dev->data;
582
	u16 rx_ctl = AX_DEFAULT_RX_CTL;
583 584

	if (net->flags & IFF_PROMISC) {
585
		rx_ctl |= AX_RX_CTL_PRO;
586
	} else if (net->flags & IFF_ALLMULTI ||
587
		   netdev_mc_count(net) > AX_MAX_MCAST) {
588
		rx_ctl |= AX_RX_CTL_AMALL;
589
	} else if (netdev_mc_empty(net)) {
590 591 592 593 594 595
		/* just broadcast and directed */
	} else {
		/* We use the 20 byte dev->data
		 * for our 8 byte filter buffer
		 * to avoid allocating memory that
		 * is tricky to free later */
596
		struct netdev_hw_addr *ha;
597 598 599 600 601
		u32 crc_bits;

		memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE);

		/* Build the multicast hash filter. */
602 603
		netdev_for_each_mc_addr(ha, net) {
			crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
604 605 606 607
			data->multi_filter[crc_bits >> 3] |=
			    1 << (crc_bits & 7);
		}

608
		asix_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0,
609 610
				   AX_MCAST_FILTER_SIZE, data->multi_filter);

611
		rx_ctl |= AX_RX_CTL_AM;
612 613
	}

614
	asix_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL);
615 616
}

617
static int asix_mdio_read(struct net_device *netdev, int phy_id, int loc)
618 619
{
	struct usbnet *dev = netdev_priv(netdev);
A
Al Viro 已提交
620
	__le16 res;
621

622
	mutex_lock(&dev->phy_mutex);
623 624
	asix_set_sw_mii(dev);
	asix_read_cmd(dev, AX_CMD_READ_MII_REG, phy_id,
A
Al Viro 已提交
625
				(__u16)loc, 2, &res);
626
	asix_set_hw_mii(dev);
627
	mutex_unlock(&dev->phy_mutex);
628

629 630
	netdev_dbg(dev->net, "asix_mdio_read() phy_id=0x%02x, loc=0x%02x, returns=0x%04x\n",
		   phy_id, loc, le16_to_cpu(res));
631

A
Al Viro 已提交
632
	return le16_to_cpu(res);
633 634 635
}

static void
636
asix_mdio_write(struct net_device *netdev, int phy_id, int loc, int val)
637 638
{
	struct usbnet *dev = netdev_priv(netdev);
A
Al Viro 已提交
639
	__le16 res = cpu_to_le16(val);
640

641 642
	netdev_dbg(dev->net, "asix_mdio_write() phy_id=0x%02x, loc=0x%02x, val=0x%04x\n",
		   phy_id, loc, val);
643
	mutex_lock(&dev->phy_mutex);
644
	asix_set_sw_mii(dev);
A
Al Viro 已提交
645
	asix_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id, (__u16)loc, 2, &res);
646
	asix_set_hw_mii(dev);
647
	mutex_unlock(&dev->phy_mutex);
648 649
}

650 651
/* Get the PHY Identifier from the PHYSID1 & PHYSID2 MII registers */
static u32 asix_get_phyid(struct usbnet *dev)
652
{
653 654
	int phy_reg;
	u32 phy_id;
655
	int i;
656

657 658 659 660 661 662 663 664 665
	/* Poll for the rare case the FW or phy isn't ready yet.  */
	for (i = 0; i < 100; i++) {
		phy_reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_PHYSID1);
		if (phy_reg != 0 && phy_reg != 0xFFFF)
			break;
		mdelay(1);
	}

	if (phy_reg <= 0 || phy_reg == 0xFFFF)
666
		return 0;
667

668
	phy_id = (phy_reg & 0xffff) << 16;
669

670 671 672 673 674 675 676
	phy_reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_PHYSID2);
	if (phy_reg < 0)
		return 0;

	phy_id |= (phy_reg & 0xffff);

	return phy_id;
677 678 679
}

static void
680
asix_get_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
681 682 683 684
{
	struct usbnet *dev = netdev_priv(net);
	u8 opt;

685
	if (asix_read_cmd(dev, AX_CMD_READ_MONITOR_MODE, 0, 0, 1, &opt) < 0) {
686 687 688 689 690 691
		wolinfo->supported = 0;
		wolinfo->wolopts = 0;
		return;
	}
	wolinfo->supported = WAKE_PHY | WAKE_MAGIC;
	wolinfo->wolopts = 0;
692 693 694 695
	if (opt & AX_MONITOR_LINK)
		wolinfo->wolopts |= WAKE_PHY;
	if (opt & AX_MONITOR_MAGIC)
		wolinfo->wolopts |= WAKE_MAGIC;
696 697 698
}

static int
699
asix_set_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
700 701 702 703 704 705 706 707 708
{
	struct usbnet *dev = netdev_priv(net);
	u8 opt = 0;

	if (wolinfo->wolopts & WAKE_PHY)
		opt |= AX_MONITOR_LINK;
	if (wolinfo->wolopts & WAKE_MAGIC)
		opt |= AX_MONITOR_MAGIC;

709
	if (asix_write_cmd(dev, AX_CMD_WRITE_MONITOR_MODE,
A
Al Viro 已提交
710
			      opt, 0, 0, NULL) < 0)
711 712 713 714 715
		return -EINVAL;

	return 0;
}

716
static int asix_get_eeprom_len(struct net_device *net)
717
{
718 719 720 721
	struct usbnet *dev = netdev_priv(net);
	struct asix_data *data = (struct asix_data *)&dev->data;

	return data->eeprom_len;
722 723
}

724
static int asix_get_eeprom(struct net_device *net,
725 726 727
			      struct ethtool_eeprom *eeprom, u8 *data)
{
	struct usbnet *dev = netdev_priv(net);
A
Al Viro 已提交
728
	__le16 *ebuf = (__le16 *)data;
729 730 731 732 733 734 735 736 737 738 739 740
	int i;

	/* Crude hack to ensure that we don't overwrite memory
	 * if an odd length is supplied
	 */
	if (eeprom->len % 2)
		return -EINVAL;

	eeprom->magic = AX_EEPROM_MAGIC;

	/* ax8817x returns 2 bytes from eeprom on read */
	for (i=0; i < eeprom->len / 2; i++) {
741
		if (asix_read_cmd(dev, AX_CMD_READ_EEPROM,
742 743 744 745 746 747
			eeprom->offset + i, 0, 2, &ebuf[i]) < 0)
			return -EINVAL;
	}
	return 0;
}

748
static void asix_get_drvinfo (struct net_device *net,
749 750
				 struct ethtool_drvinfo *info)
{
751 752 753
	struct usbnet *dev = netdev_priv(net);
	struct asix_data *data = (struct asix_data *)&dev->data;

754 755
	/* Inherit standard device info */
	usbnet_get_drvinfo(net, info);
756
	strncpy (info->driver, DRIVER_NAME, sizeof info->driver);
757 758
	strncpy (info->version, DRIVER_VERSION, sizeof info->version);
	info->eedump_len = data->eeprom_len;
759 760
}

761 762 763 764 765 766 767 768 769 770 771 772 773 774
static u32 asix_get_link(struct net_device *net)
{
	struct usbnet *dev = netdev_priv(net);

	return mii_link_ok(&dev->mii);
}

static int asix_ioctl (struct net_device *net, struct ifreq *rq, int cmd)
{
	struct usbnet *dev = netdev_priv(net);

	return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL);
}

775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798
static int asix_set_mac_address(struct net_device *net, void *p)
{
	struct usbnet *dev = netdev_priv(net);
	struct asix_data *data = (struct asix_data *)&dev->data;
	struct sockaddr *addr = p;

	if (netif_running(net))
		return -EBUSY;
	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

	memcpy(net->dev_addr, addr->sa_data, ETH_ALEN);

	/* We use the 20 byte dev->data
	 * for our 6 byte mac buffer
	 * to avoid allocating memory that
	 * is tricky to free later */
	memcpy(data->mac_addr, addr->sa_data, ETH_ALEN);
	asix_write_cmd_async(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN,
							data->mac_addr);

	return 0;
}

799 800 801
/* We need to override some ethtool_ops so we require our
   own structure so we don't interfere with other usbnet
   devices that may be connected at the same time. */
802
static const struct ethtool_ops ax88172_ethtool_ops = {
803 804 805
	.get_drvinfo		= asix_get_drvinfo,
	.get_link		= asix_get_link,
	.get_msglevel		= usbnet_get_msglevel,
806
	.set_msglevel		= usbnet_set_msglevel,
807 808 809 810
	.get_wol		= asix_get_wol,
	.set_wol		= asix_set_wol,
	.get_eeprom_len		= asix_get_eeprom_len,
	.get_eeprom		= asix_get_eeprom,
811 812 813
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
814 815
};

816
static void ax88172_set_multicast(struct net_device *net)
817 818
{
	struct usbnet *dev = netdev_priv(net);
819 820
	struct asix_data *data = (struct asix_data *)&dev->data;
	u8 rx_ctl = 0x8c;
821

822 823
	if (net->flags & IFF_PROMISC) {
		rx_ctl |= 0x01;
824
	} else if (net->flags & IFF_ALLMULTI ||
825
		   netdev_mc_count(net) > AX_MAX_MCAST) {
826
		rx_ctl |= 0x02;
827
	} else if (netdev_mc_empty(net)) {
828 829 830 831 832 833
		/* just broadcast and directed */
	} else {
		/* We use the 20 byte dev->data
		 * for our 8 byte filter buffer
		 * to avoid allocating memory that
		 * is tricky to free later */
834
		struct netdev_hw_addr *ha;
835 836 837 838 839
		u32 crc_bits;

		memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE);

		/* Build the multicast hash filter. */
840 841
		netdev_for_each_mc_addr(ha, net) {
			crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857
			data->multi_filter[crc_bits >> 3] |=
			    1 << (crc_bits & 7);
		}

		asix_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0,
				   AX_MCAST_FILTER_SIZE, data->multi_filter);

		rx_ctl |= 0x10;
	}

	asix_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL);
}

static int ax88172_link_reset(struct usbnet *dev)
{
	u8 mode;
858
	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
859 860 861 862 863 864 865 866

	mii_check_media(&dev->mii, 1, 1);
	mii_ethtool_gset(&dev->mii, &ecmd);
	mode = AX88172_MEDIUM_DEFAULT;

	if (ecmd.duplex != DUPLEX_FULL)
		mode |= ~AX88172_MEDIUM_FD;

867 868
	netdev_dbg(dev->net, "ax88172_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
		   ethtool_cmd_speed(&ecmd), ecmd.duplex, mode);
869 870 871 872

	asix_write_medium_mode(dev, mode);

	return 0;
873 874
}

875 876 877 878 879 880 881 882 883
static const struct net_device_ops ax88172_netdev_ops = {
	.ndo_open		= usbnet_open,
	.ndo_stop		= usbnet_stop,
	.ndo_start_xmit		= usbnet_start_xmit,
	.ndo_tx_timeout		= usbnet_tx_timeout,
	.ndo_change_mtu		= usbnet_change_mtu,
	.ndo_set_mac_address 	= eth_mac_addr,
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_do_ioctl		= asix_ioctl,
884
	.ndo_set_rx_mode	= ax88172_set_multicast,
885 886
};

887
static int ax88172_bind(struct usbnet *dev, struct usb_interface *intf)
888 889
{
	int ret = 0;
A
Al Viro 已提交
890
	u8 buf[ETH_ALEN];
891 892
	int i;
	unsigned long gpio_bits = dev->driver_info->data;
893 894 895
	struct asix_data *data = (struct asix_data *)&dev->data;

	data->eeprom_len = AX88172_EEPROM_LEN;
896 897 898 899 900

	usbnet_get_endpoints(dev,intf);

	/* Toggle the GPIOs in a manufacturer/model specific way */
	for (i = 2; i >= 0; i--) {
901 902 903
		ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS,
				(gpio_bits >> (i * 8)) & 0xff, 0, 0, NULL);
		if (ret < 0)
A
Al Viro 已提交
904
			goto out;
905 906 907
		msleep(5);
	}

908 909
	ret = asix_write_rx_ctl(dev, 0x80);
	if (ret < 0)
A
Al Viro 已提交
910
		goto out;
911 912

	/* Get the MAC address */
913 914
	ret = asix_read_cmd(dev, AX88172_CMD_READ_NODE_ID, 0, 0, ETH_ALEN, buf);
	if (ret < 0) {
915
		dbg("read AX_CMD_READ_NODE_ID failed: %d", ret);
A
Al Viro 已提交
916
		goto out;
917 918 919 920 921
	}
	memcpy(dev->net->dev_addr, buf, ETH_ALEN);

	/* Initialize MII structure */
	dev->mii.dev = dev->net;
922 923
	dev->mii.mdio_read = asix_mdio_read;
	dev->mii.mdio_write = asix_mdio_write;
924 925
	dev->mii.phy_id_mask = 0x3f;
	dev->mii.reg_num_mask = 0x1f;
926
	dev->mii.phy_id = asix_get_phy_addr(dev);
927

928
	dev->net->netdev_ops = &ax88172_netdev_ops;
929
	dev->net->ethtool_ops = &ax88172_ethtool_ops;
930

931 932
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
933 934 935 936
		ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
	mii_nway_restart(&dev->mii);

	return 0;
A
Al Viro 已提交
937 938

out:
939 940 941
	return ret;
}

942
static const struct ethtool_ops ax88772_ethtool_ops = {
943
	.get_drvinfo		= asix_get_drvinfo,
944
	.get_link		= asix_get_link,
945 946
	.get_msglevel		= usbnet_get_msglevel,
	.set_msglevel		= usbnet_set_msglevel,
947 948 949 950
	.get_wol		= asix_get_wol,
	.set_wol		= asix_set_wol,
	.get_eeprom_len		= asix_get_eeprom_len,
	.get_eeprom		= asix_get_eeprom,
951 952 953
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
954 955
};

956 957 958
static int ax88772_link_reset(struct usbnet *dev)
{
	u16 mode;
959
	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
960 961 962 963 964

	mii_check_media(&dev->mii, 1, 1);
	mii_ethtool_gset(&dev->mii, &ecmd);
	mode = AX88772_MEDIUM_DEFAULT;

965
	if (ethtool_cmd_speed(&ecmd) != SPEED_100)
966 967 968 969 970
		mode &= ~AX_MEDIUM_PS;

	if (ecmd.duplex != DUPLEX_FULL)
		mode &= ~AX_MEDIUM_FD;

971 972
	netdev_dbg(dev->net, "ax88772_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
		   ethtool_cmd_speed(&ecmd), ecmd.duplex, mode);
973 974 975 976 977 978

	asix_write_medium_mode(dev, mode);

	return 0;
}

979
static int ax88772_reset(struct usbnet *dev)
980
{
981
	int ret, embd_phy;
982
	u16 rx_ctl;
983

984 985 986
	ret = asix_write_gpio(dev,
			AX_GPIO_RSE | AX_GPIO_GPO_2 | AX_GPIO_GPO2EN, 5);
	if (ret < 0)
A
Al Viro 已提交
987
		goto out;
988

989
	embd_phy = ((asix_get_phy_addr(dev) & 0x1f) == 0x10 ? 1 : 0);
990

991 992
	ret = asix_write_cmd(dev, AX_CMD_SW_PHY_SELECT, embd_phy, 0, 0, NULL);
	if (ret < 0) {
993
		dbg("Select PHY #1 failed: %d", ret);
A
Al Viro 已提交
994
		goto out;
995 996
	}

997 998
	ret = asix_sw_reset(dev, AX_SWRESET_IPPD | AX_SWRESET_PRL);
	if (ret < 0)
A
Al Viro 已提交
999
		goto out;
1000 1001

	msleep(150);
1002 1003 1004

	ret = asix_sw_reset(dev, AX_SWRESET_CLEAR);
	if (ret < 0)
A
Al Viro 已提交
1005
		goto out;
1006 1007

	msleep(150);
1008

1009
	if (embd_phy) {
1010 1011
		ret = asix_sw_reset(dev, AX_SWRESET_IPRL);
		if (ret < 0)
A
Al Viro 已提交
1012
			goto out;
1013 1014 1015
	} else {
		ret = asix_sw_reset(dev, AX_SWRESET_PRTE);
		if (ret < 0)
A
Al Viro 已提交
1016
			goto out;
1017
	}
1018 1019

	msleep(150);
1020 1021
	rx_ctl = asix_read_rx_ctl(dev);
	dbg("RX_CTL is 0x%04x after software reset", rx_ctl);
1022 1023
	ret = asix_write_rx_ctl(dev, 0x0000);
	if (ret < 0)
A
Al Viro 已提交
1024
		goto out;
1025

1026 1027 1028
	rx_ctl = asix_read_rx_ctl(dev);
	dbg("RX_CTL is 0x%04x setting to 0x0000", rx_ctl);

1029 1030
	ret = asix_sw_reset(dev, AX_SWRESET_PRL);
	if (ret < 0)
A
Al Viro 已提交
1031
		goto out;
1032 1033

	msleep(150);
1034

1035 1036
	ret = asix_sw_reset(dev, AX_SWRESET_IPRL | AX_SWRESET_PRL);
	if (ret < 0)
A
Al Viro 已提交
1037
		goto out;
1038

1039
	msleep(150);
1040

1041 1042
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
1043 1044 1045
			ADVERTISE_ALL | ADVERTISE_CSMA);
	mii_nway_restart(&dev->mii);

1046 1047
	ret = asix_write_medium_mode(dev, AX88772_MEDIUM_DEFAULT);
	if (ret < 0)
A
Al Viro 已提交
1048
		goto out;
1049

1050
	ret = asix_write_cmd(dev, AX_CMD_WRITE_IPG0,
1051
				AX88772_IPG0_DEFAULT | AX88772_IPG1_DEFAULT,
1052 1053
				AX88772_IPG2_DEFAULT, 0, NULL);
	if (ret < 0) {
1054
		dbg("Write IPG,IPG1,IPG2 failed: %d", ret);
A
Al Viro 已提交
1055
		goto out;
1056 1057 1058
	}

	/* Set RX_CTL to default values with 2k buffer, and enable cactus */
1059 1060
	ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL);
	if (ret < 0)
A
Al Viro 已提交
1061
		goto out;
1062

1063 1064 1065 1066 1067 1068
	rx_ctl = asix_read_rx_ctl(dev);
	dbg("RX_CTL is 0x%04x after all initializations", rx_ctl);

	rx_ctl = asix_read_medium_status(dev);
	dbg("Medium Status is 0x%04x after all initializations", rx_ctl);

1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089
	return 0;

out:
	return ret;

}

static const struct net_device_ops ax88772_netdev_ops = {
	.ndo_open		= usbnet_open,
	.ndo_stop		= usbnet_stop,
	.ndo_start_xmit		= usbnet_start_xmit,
	.ndo_tx_timeout		= usbnet_tx_timeout,
	.ndo_change_mtu		= usbnet_change_mtu,
	.ndo_set_mac_address 	= asix_set_mac_address,
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_do_ioctl		= asix_ioctl,
	.ndo_set_rx_mode        = asix_set_multicast,
};

static int ax88772_bind(struct usbnet *dev, struct usb_interface *intf)
{
1090
	int ret, embd_phy;
1091 1092 1093 1094 1095 1096 1097 1098 1099
	struct asix_data *data = (struct asix_data *)&dev->data;
	u8 buf[ETH_ALEN];
	u32 phyid;

	data->eeprom_len = AX88772_EEPROM_LEN;

	usbnet_get_endpoints(dev,intf);

	/* Get the MAC address */
1100 1101
	ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID, 0, 0, ETH_ALEN, buf);
	if (ret < 0) {
1102
		dbg("Failed to read MAC address: %d", ret);
1103
		return ret;
1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117
	}
	memcpy(dev->net->dev_addr, buf, ETH_ALEN);

	/* Initialize MII structure */
	dev->mii.dev = dev->net;
	dev->mii.mdio_read = asix_mdio_read;
	dev->mii.mdio_write = asix_mdio_write;
	dev->mii.phy_id_mask = 0x1f;
	dev->mii.reg_num_mask = 0x1f;
	dev->mii.phy_id = asix_get_phy_addr(dev);

	dev->net->netdev_ops = &ax88772_netdev_ops;
	dev->net->ethtool_ops = &ax88772_ethtool_ops;

1118 1119 1120 1121 1122 1123 1124 1125 1126 1127
	embd_phy = ((dev->mii.phy_id & 0x1f) == 0x10 ? 1 : 0);

	/* Reset the PHY to normal operation mode */
	ret = asix_write_cmd(dev, AX_CMD_SW_PHY_SELECT, embd_phy, 0, 0, NULL);
	if (ret < 0) {
		dbg("Select PHY #1 failed: %d", ret);
		return ret;
	}

	ret = asix_sw_reset(dev, AX_SWRESET_IPPD | AX_SWRESET_PRL);
1128 1129
	if (ret < 0)
		return ret;
1130

1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144
	msleep(150);

	ret = asix_sw_reset(dev, AX_SWRESET_CLEAR);
	if (ret < 0)
		return ret;

	msleep(150);

	ret = asix_sw_reset(dev, embd_phy ? AX_SWRESET_IPRL : AX_SWRESET_PRTE);

	/* Read PHYID register *AFTER* the PHY was reset properly */
	phyid = asix_get_phyid(dev);
	dbg("PHYID=0x%08x", phyid);

1145 1146 1147 1148 1149 1150
	/* Asix framing packs multiple eth frames into a 2K usb bulk transfer */
	if (dev->driver_info->flags & FLAG_FRAMING_AX) {
		/* hard_mtu  is still the default - the device does not support
		   jumbo eth frames */
		dev->rx_urb_size = 2048;
	}
1151

1152 1153 1154
	return 0;
}

1155
static const struct ethtool_ops ax88178_ethtool_ops = {
1156 1157 1158 1159 1160 1161 1162 1163
	.get_drvinfo		= asix_get_drvinfo,
	.get_link		= asix_get_link,
	.get_msglevel		= usbnet_get_msglevel,
	.set_msglevel		= usbnet_set_msglevel,
	.get_wol		= asix_get_wol,
	.set_wol		= asix_set_wol,
	.get_eeprom_len		= asix_get_eeprom_len,
	.get_eeprom		= asix_get_eeprom,
1164 1165 1166
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
1167 1168 1169
};

static int marvell_phy_init(struct usbnet *dev)
1170
{
1171 1172
	struct asix_data *data = (struct asix_data *)&dev->data;
	u16 reg;
1173

1174
	netdev_dbg(dev->net, "marvell_phy_init()\n");
1175

1176
	reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_MARVELL_STATUS);
1177
	netdev_dbg(dev->net, "MII_MARVELL_STATUS = 0x%04x\n", reg);
1178

1179 1180
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_MARVELL_CTRL,
			MARVELL_CTRL_RXDELAY | MARVELL_CTRL_TXDELAY);
1181

1182 1183 1184
	if (data->ledmode) {
		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL);
1185
		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (1) = 0x%04x\n", reg);
1186

1187 1188 1189 1190
		reg &= 0xf8ff;
		reg |= (1 + 0x0100);
		asix_mdio_write(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL, reg);
1191

1192 1193
		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL);
1194
		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (2) = 0x%04x\n", reg);
1195 1196
		reg &= 0xfc0f;
	}
1197

1198 1199 1200
	return 0;
}

1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221
static int rtl8211cl_phy_init(struct usbnet *dev)
{
	struct asix_data *data = (struct asix_data *)&dev->data;

	netdev_dbg(dev->net, "rtl8211cl_phy_init()\n");

	asix_mdio_write (dev->net, dev->mii.phy_id, 0x1f, 0x0005);
	asix_mdio_write (dev->net, dev->mii.phy_id, 0x0c, 0);
	asix_mdio_write (dev->net, dev->mii.phy_id, 0x01,
		asix_mdio_read (dev->net, dev->mii.phy_id, 0x01) | 0x0080);
	asix_mdio_write (dev->net, dev->mii.phy_id, 0x1f, 0);

	if (data->ledmode == 12) {
		asix_mdio_write (dev->net, dev->mii.phy_id, 0x1f, 0x0002);
		asix_mdio_write (dev->net, dev->mii.phy_id, 0x1a, 0x00cb);
		asix_mdio_write (dev->net, dev->mii.phy_id, 0x1f, 0);
	}

	return 0;
}

1222 1223 1224 1225
static int marvell_led_status(struct usbnet *dev, u16 speed)
{
	u16 reg = asix_mdio_read(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL);

1226
	netdev_dbg(dev->net, "marvell_led_status() read 0x%04x\n", reg);
1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239

	/* Clear out the center LED bits - 0x03F0 */
	reg &= 0xfc0f;

	switch (speed) {
		case SPEED_1000:
			reg |= 0x03e0;
			break;
		case SPEED_100:
			reg |= 0x03b0;
			break;
		default:
			reg |= 0x02f0;
1240 1241
	}

1242
	netdev_dbg(dev->net, "marvell_led_status() writing 0x%04x\n", reg);
1243 1244 1245 1246 1247
	asix_mdio_write(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL, reg);

	return 0;
}

1248 1249 1250 1251 1252 1253 1254
static int ax88178_reset(struct usbnet *dev)
{
	struct asix_data *data = (struct asix_data *)&dev->data;
	int ret;
	__le16 eeprom;
	u8 status;
	int gpio0 = 0;
1255
	u32 phyid;
1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270

	asix_read_cmd(dev, AX_CMD_READ_GPIOS, 0, 0, 1, &status);
	dbg("GPIO Status: 0x%04x", status);

	asix_write_cmd(dev, AX_CMD_WRITE_ENABLE, 0, 0, 0, NULL);
	asix_read_cmd(dev, AX_CMD_READ_EEPROM, 0x0017, 0, 2, &eeprom);
	asix_write_cmd(dev, AX_CMD_WRITE_DISABLE, 0, 0, 0, NULL);

	dbg("EEPROM index 0x17 is 0x%04x", eeprom);

	if (eeprom == cpu_to_le16(0xffff)) {
		data->phymode = PHY_MODE_MARVELL;
		data->ledmode = 0;
		gpio0 = 1;
	} else {
1271
		data->phymode = le16_to_cpu(eeprom) & 0x7F;
1272 1273 1274 1275 1276
		data->ledmode = le16_to_cpu(eeprom) >> 8;
		gpio0 = (le16_to_cpu(eeprom) & 0x80) ? 0 : 1;
	}
	dbg("GPIO0: %d, PhyMode: %d", gpio0, data->phymode);

1277
	/* Power up external GigaPHY through AX88178 GPIO pin */
1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288
	asix_write_gpio(dev, AX_GPIO_RSE | AX_GPIO_GPO_1 | AX_GPIO_GPO1EN, 40);
	if ((le16_to_cpu(eeprom) >> 8) != 1) {
		asix_write_gpio(dev, 0x003c, 30);
		asix_write_gpio(dev, 0x001c, 300);
		asix_write_gpio(dev, 0x003c, 30);
	} else {
		dbg("gpio phymode == 1 path");
		asix_write_gpio(dev, AX_GPIO_GPO1EN, 30);
		asix_write_gpio(dev, AX_GPIO_GPO1EN | AX_GPIO_GPO_1, 30);
	}

1289 1290 1291 1292 1293 1294 1295
	/* Read PHYID register *AFTER* powering up PHY */
	phyid = asix_get_phyid(dev);
	dbg("PHYID=0x%08x", phyid);

	/* Set AX88178 to enable MII/GMII/RGMII interface for external PHY */
	asix_write_cmd(dev, AX_CMD_SW_PHY_SELECT, 0, 0, 0, NULL);

1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318
	asix_sw_reset(dev, 0);
	msleep(150);

	asix_sw_reset(dev, AX_SWRESET_PRL | AX_SWRESET_IPPD);
	msleep(150);

	asix_write_rx_ctl(dev, 0);

	if (data->phymode == PHY_MODE_MARVELL) {
		marvell_phy_init(dev);
		msleep(60);
	} else if (data->phymode == PHY_MODE_RTL8211CL)
		rtl8211cl_phy_init(dev);

	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR,
			BMCR_RESET | BMCR_ANENABLE);
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
			ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_CTRL1000,
			ADVERTISE_1000FULL);

	mii_nway_restart(&dev->mii);

1319 1320 1321
	ret = asix_write_medium_mode(dev, AX88178_MEDIUM_DEFAULT);
	if (ret < 0)
		return ret;
1322

1323 1324 1325
	ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL);
	if (ret < 0)
		return ret;
1326 1327 1328 1329

	return 0;
}

1330 1331 1332
static int ax88178_link_reset(struct usbnet *dev)
{
	u16 mode;
1333
	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
1334
	struct asix_data *data = (struct asix_data *)&dev->data;
1335
	u32 speed;
1336

1337
	netdev_dbg(dev->net, "ax88178_link_reset()\n");
1338 1339 1340 1341

	mii_check_media(&dev->mii, 1, 1);
	mii_ethtool_gset(&dev->mii, &ecmd);
	mode = AX88178_MEDIUM_DEFAULT;
1342
	speed = ethtool_cmd_speed(&ecmd);
1343

1344
	if (speed == SPEED_1000)
1345
		mode |= AX_MEDIUM_GM;
1346
	else if (speed == SPEED_100)
1347 1348 1349 1350
		mode |= AX_MEDIUM_PS;
	else
		mode &= ~(AX_MEDIUM_PS | AX_MEDIUM_GM);

1351 1352
	mode |= AX_MEDIUM_ENCK;

1353 1354 1355 1356 1357
	if (ecmd.duplex == DUPLEX_FULL)
		mode |= AX_MEDIUM_FD;
	else
		mode &= ~AX_MEDIUM_FD;

1358 1359
	netdev_dbg(dev->net, "ax88178_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
		   speed, ecmd.duplex, mode);
1360 1361 1362 1363

	asix_write_medium_mode(dev, mode);

	if (data->phymode == PHY_MODE_MARVELL && data->ledmode)
1364
		marvell_led_status(dev, speed);
1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387

	return 0;
}

static void ax88178_set_mfb(struct usbnet *dev)
{
	u16 mfb = AX_RX_CTL_MFB_16384;
	u16 rxctl;
	u16 medium;
	int old_rx_urb_size = dev->rx_urb_size;

	if (dev->hard_mtu < 2048) {
		dev->rx_urb_size = 2048;
		mfb = AX_RX_CTL_MFB_2048;
	} else if (dev->hard_mtu < 4096) {
		dev->rx_urb_size = 4096;
		mfb = AX_RX_CTL_MFB_4096;
	} else if (dev->hard_mtu < 8192) {
		dev->rx_urb_size = 8192;
		mfb = AX_RX_CTL_MFB_8192;
	} else if (dev->hard_mtu < 16384) {
		dev->rx_urb_size = 16384;
		mfb = AX_RX_CTL_MFB_16384;
1388
	}
1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401

	rxctl = asix_read_rx_ctl(dev);
	asix_write_rx_ctl(dev, (rxctl & ~AX_RX_CTL_MFB_16384) | mfb);

	medium = asix_read_medium_status(dev);
	if (dev->net->mtu > 1500)
		medium |= AX_MEDIUM_JFE;
	else
		medium &= ~AX_MEDIUM_JFE;
	asix_write_medium_mode(dev, medium);

	if (dev->rx_urb_size > old_rx_urb_size)
		usbnet_unlink_rx_urbs(dev);
1402 1403
}

1404
static int ax88178_change_mtu(struct net_device *net, int new_mtu)
1405
{
1406 1407
	struct usbnet *dev = netdev_priv(net);
	int ll_mtu = new_mtu + net->hard_header_len + 4;
1408

1409
	netdev_dbg(dev->net, "ax88178_change_mtu() new_mtu=%d\n", new_mtu);
1410

1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423
	if (new_mtu <= 0 || ll_mtu > 16384)
		return -EINVAL;

	if ((ll_mtu % dev->maxpacket) == 0)
		return -EDOM;

	net->mtu = new_mtu;
	dev->hard_mtu = net->mtu + net->hard_header_len;
	ax88178_set_mfb(dev);

	return 0;
}

1424 1425 1426 1427 1428
static const struct net_device_ops ax88178_netdev_ops = {
	.ndo_open		= usbnet_open,
	.ndo_stop		= usbnet_stop,
	.ndo_start_xmit		= usbnet_start_xmit,
	.ndo_tx_timeout		= usbnet_tx_timeout,
1429
	.ndo_set_mac_address 	= asix_set_mac_address,
1430
	.ndo_validate_addr	= eth_validate_addr,
1431
	.ndo_set_rx_mode	= asix_set_multicast,
1432 1433 1434 1435
	.ndo_do_ioctl 		= asix_ioctl,
	.ndo_change_mtu 	= ax88178_change_mtu,
};

1436 1437 1438
static int ax88178_bind(struct usbnet *dev, struct usb_interface *intf)
{
	int ret;
A
Al Viro 已提交
1439
	u8 buf[ETH_ALEN];
1440 1441 1442
	struct asix_data *data = (struct asix_data *)&dev->data;

	data->eeprom_len = AX88772_EEPROM_LEN;
1443 1444 1445 1446

	usbnet_get_endpoints(dev,intf);

	/* Get the MAC address */
1447 1448
	ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID, 0, 0, ETH_ALEN, buf);
	if (ret < 0) {
1449
		dbg("Failed to read MAC address: %d", ret);
1450
		return ret;
1451
	}
1452
	memcpy(dev->net->dev_addr, buf, ETH_ALEN);
1453

1454 1455 1456 1457 1458 1459 1460 1461
	/* Initialize MII structure */
	dev->mii.dev = dev->net;
	dev->mii.mdio_read = asix_mdio_read;
	dev->mii.mdio_write = asix_mdio_write;
	dev->mii.phy_id_mask = 0x1f;
	dev->mii.reg_num_mask = 0xff;
	dev->mii.supports_gmii = 1;
	dev->mii.phy_id = asix_get_phy_addr(dev);
1462 1463

	dev->net->netdev_ops = &ax88178_netdev_ops;
1464
	dev->net->ethtool_ops = &ax88178_ethtool_ops;
1465

1466 1467 1468
	/* Blink LEDS so users know driver saw dongle */
	asix_sw_reset(dev, 0);
	msleep(150);
1469

1470 1471
	asix_sw_reset(dev, AX_SWRESET_PRL | AX_SWRESET_IPPD);
	msleep(150);
1472 1473 1474 1475 1476 1477 1478 1479

	/* Asix framing packs multiple eth frames into a 2K usb bulk transfer */
	if (dev->driver_info->flags & FLAG_FRAMING_AX) {
		/* hard_mtu  is still the default - the device does not support
		   jumbo eth frames */
		dev->rx_urb_size = 2048;
	}

1480
	return 0;
1481 1482 1483 1484
}

static const struct driver_info ax8817x_info = {
	.description = "ASIX AX8817x USB 2.0 Ethernet",
1485 1486
	.bind = ax88172_bind,
	.status = asix_status,
1487 1488
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1489
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1490 1491 1492 1493 1494
	.data = 0x00130103,
};

static const struct driver_info dlink_dub_e100_info = {
	.description = "DLink DUB-E100 USB Ethernet",
1495 1496
	.bind = ax88172_bind,
	.status = asix_status,
1497 1498
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1499
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1500 1501 1502 1503 1504
	.data = 0x009f9d9f,
};

static const struct driver_info netgear_fa120_info = {
	.description = "Netgear FA-120 USB Ethernet",
1505 1506
	.bind = ax88172_bind,
	.status = asix_status,
1507 1508
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1509
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1510 1511 1512 1513 1514
	.data = 0x00130103,
};

static const struct driver_info hawking_uf200_info = {
	.description = "Hawking UF200 USB Ethernet",
1515 1516
	.bind = ax88172_bind,
	.status = asix_status,
1517 1518
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1519
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1520 1521 1522 1523 1524 1525
	.data = 0x001f1d1f,
};

static const struct driver_info ax88772_info = {
	.description = "ASIX AX88772 USB 2.0 Ethernet",
	.bind = ax88772_bind,
1526
	.status = asix_status,
1527
	.link_reset = ax88772_link_reset,
1528
	.reset = ax88772_reset,
1529
	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR,
1530 1531 1532 1533 1534 1535 1536 1537 1538
	.rx_fixup = asix_rx_fixup,
	.tx_fixup = asix_tx_fixup,
};

static const struct driver_info ax88178_info = {
	.description = "ASIX AX88178 USB 2.0 Ethernet",
	.bind = ax88178_bind,
	.status = asix_status,
	.link_reset = ax88178_link_reset,
1539
	.reset = ax88178_reset,
1540
	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR,
1541 1542
	.rx_fixup = asix_rx_fixup,
	.tx_fixup = asix_tx_fixup,
1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566
};

static const struct usb_device_id	products [] = {
{
	// Linksys USB200M
	USB_DEVICE (0x077b, 0x2226),
	.driver_info =	(unsigned long) &ax8817x_info,
}, {
	// Netgear FA120
	USB_DEVICE (0x0846, 0x1040),
	.driver_info =  (unsigned long) &netgear_fa120_info,
}, {
	// DLink DUB-E100
	USB_DEVICE (0x2001, 0x1a00),
	.driver_info =  (unsigned long) &dlink_dub_e100_info,
}, {
	// Intellinet, ST Lab USB Ethernet
	USB_DEVICE (0x0b95, 0x1720),
	.driver_info =  (unsigned long) &ax8817x_info,
}, {
	// Hawking UF200, TrendNet TU2-ET100
	USB_DEVICE (0x07b8, 0x420a),
	.driver_info =  (unsigned long) &hawking_uf200_info,
}, {
D
David Hollis 已提交
1567 1568 1569
	// Billionton Systems, USB2AR
	USB_DEVICE (0x08dd, 0x90ff),
	.driver_info =  (unsigned long) &ax8817x_info,
1570 1571 1572 1573 1574 1575 1576 1577
}, {
	// ATEN UC210T
	USB_DEVICE (0x0557, 0x2009),
	.driver_info =  (unsigned long) &ax8817x_info,
}, {
	// Buffalo LUA-U2-KTX
	USB_DEVICE (0x0411, 0x003d),
	.driver_info =  (unsigned long) &ax8817x_info,
1578 1579 1580 1581
}, {
	// Buffalo LUA-U2-GT 10/100/1000
	USB_DEVICE (0x0411, 0x006e),
	.driver_info =  (unsigned long) &ax88178_info,
1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597
}, {
	// Sitecom LN-029 "USB 2.0 10/100 Ethernet adapter"
	USB_DEVICE (0x6189, 0x182d),
	.driver_info =  (unsigned long) &ax8817x_info,
}, {
	// corega FEther USB2-TX
	USB_DEVICE (0x07aa, 0x0017),
	.driver_info =  (unsigned long) &ax8817x_info,
}, {
	// Surecom EP-1427X-2
	USB_DEVICE (0x1189, 0x0893),
	.driver_info = (unsigned long) &ax8817x_info,
}, {
	// goodway corp usb gwusb2e
	USB_DEVICE (0x1631, 0x6200),
	.driver_info = (unsigned long) &ax8817x_info,
D
David Hollis 已提交
1598 1599 1600 1601
}, {
	// JVC MP-PRX1 Port Replicator
	USB_DEVICE (0x04f1, 0x3008),
	.driver_info = (unsigned long) &ax8817x_info,
M
Marek Vasut 已提交
1602 1603 1604 1605
}, {
	// ASIX AX88772B 10/100
	USB_DEVICE (0x0b95, 0x772b),
	.driver_info = (unsigned long) &ax88772_info,
1606 1607
}, {
	// ASIX AX88772 10/100
D
David Hollis 已提交
1608 1609
	USB_DEVICE (0x0b95, 0x7720),
	.driver_info = (unsigned long) &ax88772_info,
1610 1611 1612
}, {
	// ASIX AX88178 10/100/1000
	USB_DEVICE (0x0b95, 0x1780),
1613
	.driver_info = (unsigned long) &ax88178_info,
1614 1615 1616 1617
}, {
	// Logitec LAN-GTJ/U2A
	USB_DEVICE (0x0789, 0x0160),
	.driver_info = (unsigned long) &ax88178_info,
1618 1619 1620 1621
}, {
	// Linksys USB200M Rev 2
	USB_DEVICE (0x13b1, 0x0018),
	.driver_info = (unsigned long) &ax88772_info,
1622 1623 1624 1625
}, {
	// 0Q0 cable ethernet
	USB_DEVICE (0x1557, 0x7720),
	.driver_info = (unsigned long) &ax88772_info,
1626 1627 1628 1629
}, {
	// DLink DUB-E100 H/W Ver B1
	USB_DEVICE (0x07d1, 0x3c05),
	.driver_info = (unsigned long) &ax88772_info,
1630 1631 1632 1633
}, {
	// DLink DUB-E100 H/W Ver B1 Alternate
	USB_DEVICE (0x2001, 0x3c05),
	.driver_info = (unsigned long) &ax88772_info,
1634 1635 1636 1637
}, {
	// Linksys USB1000
	USB_DEVICE (0x1737, 0x0039),
	.driver_info = (unsigned long) &ax88178_info,
1638 1639 1640 1641
}, {
	// IO-DATA ETG-US2
	USB_DEVICE (0x04bb, 0x0930),
	.driver_info = (unsigned long) &ax88178_info,
D
David Hollis 已提交
1642 1643 1644 1645
}, {
	// Belkin F5D5055
	USB_DEVICE(0x050d, 0x5055),
	.driver_info = (unsigned long) &ax88178_info,
1646 1647 1648 1649
}, {
	// Apple USB Ethernet Adapter
	USB_DEVICE(0x05ac, 0x1402),
	.driver_info = (unsigned long) &ax88772_info,
1650 1651 1652 1653
}, {
	// Cables-to-Go USB Ethernet Adapter
	USB_DEVICE(0x0b95, 0x772a),
	.driver_info = (unsigned long) &ax88772_info,
G
Greg Kroah-Hartman 已提交
1654 1655 1656 1657 1658 1659 1660 1661
}, {
	// ABOCOM for pci
	USB_DEVICE(0x14ea, 0xab11),
	.driver_info = (unsigned long) &ax88178_info,
}, {
	// ASIX 88772a
	USB_DEVICE(0x0db0, 0xa877),
	.driver_info = (unsigned long) &ax88772_info,
A
Aurelien Jacobs 已提交
1662 1663 1664 1665
}, {
	// Asus USB Ethernet Adapter
	USB_DEVICE (0x0b95, 0x7e2b),
	.driver_info = (unsigned long) &ax88772_info,
1666 1667 1668 1669 1670 1671
},
	{ },		// END
};
MODULE_DEVICE_TABLE(usb, products);

static struct usb_driver asix_driver = {
1672
	.name =		DRIVER_NAME,
1673 1674 1675 1676 1677
	.id_table =	products,
	.probe =	usbnet_probe,
	.suspend =	usbnet_suspend,
	.resume =	usbnet_resume,
	.disconnect =	usbnet_disconnect,
1678
	.supports_autosuspend = 1,
1679 1680
};

1681
module_usb_driver(asix_driver);
1682 1683

MODULE_AUTHOR("David Hollis");
1684
MODULE_VERSION(DRIVER_VERSION);
1685 1686 1687
MODULE_DESCRIPTION("ASIX AX8817X based USB 2.0 Ethernet Devices");
MODULE_LICENSE("GPL");