asix.c 42.2 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 "26-Sep-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 379 380 381 382 383 384 385 386 387 388 389
			usbnet_skb_return(dev, ax_skb);
		} else {
			return 0;
		}

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

		if (skb->len == 0)
			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 692 693 694
		wolinfo->supported = 0;
		wolinfo->wolopts = 0;
		return;
	}
	wolinfo->supported = WAKE_PHY | WAKE_MAGIC;
	wolinfo->wolopts = 0;
}

static int
695
asix_set_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
696 697 698 699 700 701 702 703 704
{
	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;

705
	if (asix_write_cmd(dev, AX_CMD_WRITE_MONITOR_MODE,
A
Al Viro 已提交
706
			      opt, 0, 0, NULL) < 0)
707 708 709 710 711
		return -EINVAL;

	return 0;
}

712
static int asix_get_eeprom_len(struct net_device *net)
713
{
714 715 716 717
	struct usbnet *dev = netdev_priv(net);
	struct asix_data *data = (struct asix_data *)&dev->data;

	return data->eeprom_len;
718 719
}

720
static int asix_get_eeprom(struct net_device *net,
721 722 723
			      struct ethtool_eeprom *eeprom, u8 *data)
{
	struct usbnet *dev = netdev_priv(net);
A
Al Viro 已提交
724
	__le16 *ebuf = (__le16 *)data;
725 726 727 728 729 730 731 732 733 734 735 736
	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++) {
737
		if (asix_read_cmd(dev, AX_CMD_READ_EEPROM,
738 739 740 741 742 743
			eeprom->offset + i, 0, 2, &ebuf[i]) < 0)
			return -EINVAL;
	}
	return 0;
}

744
static void asix_get_drvinfo (struct net_device *net,
745 746
				 struct ethtool_drvinfo *info)
{
747 748 749
	struct usbnet *dev = netdev_priv(net);
	struct asix_data *data = (struct asix_data *)&dev->data;

750 751
	/* Inherit standard device info */
	usbnet_get_drvinfo(net, info);
752
	strncpy (info->driver, DRIVER_NAME, sizeof info->driver);
753 754
	strncpy (info->version, DRIVER_VERSION, sizeof info->version);
	info->eedump_len = data->eeprom_len;
755 756
}

757 758 759 760 761 762 763 764 765 766 767 768 769 770
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);
}

771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794
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;
}

795 796 797
/* 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. */
798
static const struct ethtool_ops ax88172_ethtool_ops = {
799 800 801
	.get_drvinfo		= asix_get_drvinfo,
	.get_link		= asix_get_link,
	.get_msglevel		= usbnet_get_msglevel,
802
	.set_msglevel		= usbnet_set_msglevel,
803 804 805 806
	.get_wol		= asix_get_wol,
	.set_wol		= asix_set_wol,
	.get_eeprom_len		= asix_get_eeprom_len,
	.get_eeprom		= asix_get_eeprom,
807 808 809
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
810 811
};

812
static void ax88172_set_multicast(struct net_device *net)
813 814
{
	struct usbnet *dev = netdev_priv(net);
815 816
	struct asix_data *data = (struct asix_data *)&dev->data;
	u8 rx_ctl = 0x8c;
817

818 819
	if (net->flags & IFF_PROMISC) {
		rx_ctl |= 0x01;
820
	} else if (net->flags & IFF_ALLMULTI ||
821
		   netdev_mc_count(net) > AX_MAX_MCAST) {
822
		rx_ctl |= 0x02;
823
	} else if (netdev_mc_empty(net)) {
824 825 826 827 828 829
		/* 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 */
830
		struct netdev_hw_addr *ha;
831 832 833 834 835
		u32 crc_bits;

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

		/* Build the multicast hash filter. */
836 837
		netdev_for_each_mc_addr(ha, net) {
			crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853
			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;
854
	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
855 856 857 858 859 860 861 862

	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;

863 864
	netdev_dbg(dev->net, "ax88172_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
		   ethtool_cmd_speed(&ecmd), ecmd.duplex, mode);
865 866 867 868

	asix_write_medium_mode(dev, mode);

	return 0;
869 870
}

871 872 873 874 875 876 877 878 879
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,
880
	.ndo_set_rx_mode	= ax88172_set_multicast,
881 882
};

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

	data->eeprom_len = AX88172_EEPROM_LEN;
892 893 894 895 896

	usbnet_get_endpoints(dev,intf);

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

904 905
	ret = asix_write_rx_ctl(dev, 0x80);
	if (ret < 0)
A
Al Viro 已提交
906
		goto out;
907 908

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

	/* Initialize MII structure */
	dev->mii.dev = dev->net;
918 919
	dev->mii.mdio_read = asix_mdio_read;
	dev->mii.mdio_write = asix_mdio_write;
920 921
	dev->mii.phy_id_mask = 0x3f;
	dev->mii.reg_num_mask = 0x1f;
922
	dev->mii.phy_id = asix_get_phy_addr(dev);
923

924
	dev->net->netdev_ops = &ax88172_netdev_ops;
925
	dev->net->ethtool_ops = &ax88172_ethtool_ops;
926

927 928
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
929 930 931 932
		ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
	mii_nway_restart(&dev->mii);

	return 0;
A
Al Viro 已提交
933 934

out:
935 936 937
	return ret;
}

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

952 953 954
static int ax88772_link_reset(struct usbnet *dev)
{
	u16 mode;
955
	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
956 957 958 959 960

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

961
	if (ethtool_cmd_speed(&ecmd) != SPEED_100)
962 963 964 965 966
		mode &= ~AX_MEDIUM_PS;

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

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

	asix_write_medium_mode(dev, mode);

	return 0;
}

975
static int ax88772_reset(struct usbnet *dev)
976
{
977
	int ret, embd_phy;
978
	u16 rx_ctl;
979

980 981 982
	ret = asix_write_gpio(dev,
			AX_GPIO_RSE | AX_GPIO_GPO_2 | AX_GPIO_GPO2EN, 5);
	if (ret < 0)
A
Al Viro 已提交
983
		goto out;
984

985
	embd_phy = ((asix_get_phy_addr(dev) & 0x1f) == 0x10 ? 1 : 0);
986

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

993 994
	ret = asix_sw_reset(dev, AX_SWRESET_IPPD | AX_SWRESET_PRL);
	if (ret < 0)
A
Al Viro 已提交
995
		goto out;
996 997

	msleep(150);
998 999 1000

	ret = asix_sw_reset(dev, AX_SWRESET_CLEAR);
	if (ret < 0)
A
Al Viro 已提交
1001
		goto out;
1002 1003

	msleep(150);
1004

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

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

1022 1023 1024
	rx_ctl = asix_read_rx_ctl(dev);
	dbg("RX_CTL is 0x%04x setting to 0x0000", rx_ctl);

1025 1026
	ret = asix_sw_reset(dev, AX_SWRESET_PRL);
	if (ret < 0)
A
Al Viro 已提交
1027
		goto out;
1028 1029

	msleep(150);
1030

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

1035
	msleep(150);
1036

1037 1038
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
1039 1040 1041
			ADVERTISE_ALL | ADVERTISE_CSMA);
	mii_nway_restart(&dev->mii);

1042 1043
	ret = asix_write_medium_mode(dev, AX88772_MEDIUM_DEFAULT);
	if (ret < 0)
A
Al Viro 已提交
1044
		goto out;
1045

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

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

1059 1060 1061 1062 1063 1064
	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);

1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085
	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)
{
1086
	int ret, embd_phy;
1087 1088 1089 1090 1091 1092 1093 1094 1095
	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 */
1096 1097
	ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID, 0, 0, ETH_ALEN, buf);
	if (ret < 0) {
1098
		dbg("Failed to read MAC address: %d", ret);
1099
		return ret;
1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113
	}
	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;

1114 1115 1116 1117 1118 1119 1120 1121 1122 1123
	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);
1124 1125
	if (ret < 0)
		return ret;
1126

1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140
	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);

1141 1142 1143 1144 1145 1146
	/* 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;
	}
1147

1148 1149 1150
	return 0;
}

1151 1152 1153 1154 1155 1156 1157 1158 1159
static struct ethtool_ops ax88178_ethtool_ops = {
	.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,
1160 1161 1162
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
1163 1164 1165
};

static int marvell_phy_init(struct usbnet *dev)
1166
{
1167 1168
	struct asix_data *data = (struct asix_data *)&dev->data;
	u16 reg;
1169

1170
	netdev_dbg(dev->net, "marvell_phy_init()\n");
1171

1172
	reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_MARVELL_STATUS);
1173
	netdev_dbg(dev->net, "MII_MARVELL_STATUS = 0x%04x\n", reg);
1174

1175 1176
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_MARVELL_CTRL,
			MARVELL_CTRL_RXDELAY | MARVELL_CTRL_TXDELAY);
1177

1178 1179 1180
	if (data->ledmode) {
		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL);
1181
		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (1) = 0x%04x\n", reg);
1182

1183 1184 1185 1186
		reg &= 0xf8ff;
		reg |= (1 + 0x0100);
		asix_mdio_write(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL, reg);
1187

1188 1189
		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL);
1190
		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (2) = 0x%04x\n", reg);
1191 1192
		reg &= 0xfc0f;
	}
1193

1194 1195 1196
	return 0;
}

1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217
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;
}

1218 1219 1220 1221
static int marvell_led_status(struct usbnet *dev, u16 speed)
{
	u16 reg = asix_mdio_read(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL);

1222
	netdev_dbg(dev->net, "marvell_led_status() read 0x%04x\n", reg);
1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235

	/* 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;
1236 1237
	}

1238
	netdev_dbg(dev->net, "marvell_led_status() writing 0x%04x\n", reg);
1239 1240 1241 1242 1243
	asix_mdio_write(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL, reg);

	return 0;
}

1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305
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;

	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 {
		data->phymode = le16_to_cpu(eeprom) & 7;
		data->ledmode = le16_to_cpu(eeprom) >> 8;
		gpio0 = (le16_to_cpu(eeprom) & 0x80) ? 0 : 1;
	}
	dbg("GPIO0: %d, PhyMode: %d", gpio0, data->phymode);

	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);
	}

	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);

1306 1307 1308
	ret = asix_write_medium_mode(dev, AX88178_MEDIUM_DEFAULT);
	if (ret < 0)
		return ret;
1309

1310 1311 1312
	ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL);
	if (ret < 0)
		return ret;
1313 1314 1315 1316

	return 0;
}

1317 1318 1319
static int ax88178_link_reset(struct usbnet *dev)
{
	u16 mode;
1320
	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
1321
	struct asix_data *data = (struct asix_data *)&dev->data;
1322
	u32 speed;
1323

1324
	netdev_dbg(dev->net, "ax88178_link_reset()\n");
1325 1326 1327 1328

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

1331
	if (speed == SPEED_1000)
1332
		mode |= AX_MEDIUM_GM;
1333
	else if (speed == SPEED_100)
1334 1335 1336 1337
		mode |= AX_MEDIUM_PS;
	else
		mode &= ~(AX_MEDIUM_PS | AX_MEDIUM_GM);

1338 1339
	mode |= AX_MEDIUM_ENCK;

1340 1341 1342 1343 1344
	if (ecmd.duplex == DUPLEX_FULL)
		mode |= AX_MEDIUM_FD;
	else
		mode &= ~AX_MEDIUM_FD;

1345 1346
	netdev_dbg(dev->net, "ax88178_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
		   speed, ecmd.duplex, mode);
1347 1348 1349 1350

	asix_write_medium_mode(dev, mode);

	if (data->phymode == PHY_MODE_MARVELL && data->ledmode)
1351
		marvell_led_status(dev, speed);
1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374

	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;
1375
	}
1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388

	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);
1389 1390
}

1391
static int ax88178_change_mtu(struct net_device *net, int new_mtu)
1392
{
1393 1394
	struct usbnet *dev = netdev_priv(net);
	int ll_mtu = new_mtu + net->hard_header_len + 4;
1395

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

1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410
	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;
}

1411 1412 1413 1414 1415
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,
1416
	.ndo_set_mac_address 	= asix_set_mac_address,
1417
	.ndo_validate_addr	= eth_validate_addr,
1418
	.ndo_set_rx_mode	= asix_set_multicast,
1419 1420 1421 1422
	.ndo_do_ioctl 		= asix_ioctl,
	.ndo_change_mtu 	= ax88178_change_mtu,
};

1423 1424 1425
static int ax88178_bind(struct usbnet *dev, struct usb_interface *intf)
{
	int ret;
A
Al Viro 已提交
1426
	u8 buf[ETH_ALEN];
1427
	u32 phyid;
1428 1429 1430
	struct asix_data *data = (struct asix_data *)&dev->data;

	data->eeprom_len = AX88772_EEPROM_LEN;
1431 1432 1433 1434

	usbnet_get_endpoints(dev,intf);

	/* Get the MAC address */
1435 1436
	ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID, 0, 0, ETH_ALEN, buf);
	if (ret < 0) {
1437
		dbg("Failed to read MAC address: %d", ret);
1438
		return ret;
1439
	}
1440
	memcpy(dev->net->dev_addr, buf, ETH_ALEN);
1441

1442 1443 1444 1445 1446 1447 1448 1449
	/* 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);
1450 1451

	dev->net->netdev_ops = &ax88178_netdev_ops;
1452
	dev->net->ethtool_ops = &ax88178_ethtool_ops;
1453

1454 1455
	phyid = asix_get_phyid(dev);
	dbg("PHYID=0x%08x", phyid);
1456

1457 1458
	ret = ax88178_reset(dev);
	if (ret < 0)
1459
		return ret;
1460 1461 1462 1463 1464 1465 1466 1467

	/* 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;
	}

1468
	return 0;
1469 1470 1471 1472
}

static const struct driver_info ax8817x_info = {
	.description = "ASIX AX8817x USB 2.0 Ethernet",
1473 1474
	.bind = ax88172_bind,
	.status = asix_status,
1475 1476
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1477
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1478 1479 1480 1481 1482
	.data = 0x00130103,
};

static const struct driver_info dlink_dub_e100_info = {
	.description = "DLink DUB-E100 USB Ethernet",
1483 1484
	.bind = ax88172_bind,
	.status = asix_status,
1485 1486
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1487
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1488 1489 1490 1491 1492
	.data = 0x009f9d9f,
};

static const struct driver_info netgear_fa120_info = {
	.description = "Netgear FA-120 USB Ethernet",
1493 1494
	.bind = ax88172_bind,
	.status = asix_status,
1495 1496
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1497
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1498 1499 1500 1501 1502
	.data = 0x00130103,
};

static const struct driver_info hawking_uf200_info = {
	.description = "Hawking UF200 USB Ethernet",
1503 1504
	.bind = ax88172_bind,
	.status = asix_status,
1505 1506
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1507
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1508 1509 1510 1511 1512 1513
	.data = 0x001f1d1f,
};

static const struct driver_info ax88772_info = {
	.description = "ASIX AX88772 USB 2.0 Ethernet",
	.bind = ax88772_bind,
1514
	.status = asix_status,
1515
	.link_reset = ax88772_link_reset,
1516
	.reset = ax88772_reset,
1517
	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR,
1518 1519 1520 1521 1522 1523 1524 1525 1526
	.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,
1527
	.reset = ax88178_reset,
1528
	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR,
1529 1530
	.rx_fixup = asix_rx_fixup,
	.tx_fixup = asix_tx_fixup,
1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554
};

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 已提交
1555 1556 1557
	// Billionton Systems, USB2AR
	USB_DEVICE (0x08dd, 0x90ff),
	.driver_info =  (unsigned long) &ax8817x_info,
1558 1559 1560 1561 1562 1563 1564 1565
}, {
	// 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,
1566 1567 1568 1569
}, {
	// Buffalo LUA-U2-GT 10/100/1000
	USB_DEVICE (0x0411, 0x006e),
	.driver_info =  (unsigned long) &ax88178_info,
1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585
}, {
	// 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 已提交
1586 1587 1588 1589
}, {
	// JVC MP-PRX1 Port Replicator
	USB_DEVICE (0x04f1, 0x3008),
	.driver_info = (unsigned long) &ax8817x_info,
M
Marek Vasut 已提交
1590 1591 1592 1593
}, {
	// ASIX AX88772B 10/100
	USB_DEVICE (0x0b95, 0x772b),
	.driver_info = (unsigned long) &ax88772_info,
1594 1595
}, {
	// ASIX AX88772 10/100
D
David Hollis 已提交
1596 1597
	USB_DEVICE (0x0b95, 0x7720),
	.driver_info = (unsigned long) &ax88772_info,
1598 1599 1600
}, {
	// ASIX AX88178 10/100/1000
	USB_DEVICE (0x0b95, 0x1780),
1601
	.driver_info = (unsigned long) &ax88178_info,
1602 1603 1604 1605
}, {
	// Logitec LAN-GTJ/U2A
	USB_DEVICE (0x0789, 0x0160),
	.driver_info = (unsigned long) &ax88178_info,
1606 1607 1608 1609
}, {
	// Linksys USB200M Rev 2
	USB_DEVICE (0x13b1, 0x0018),
	.driver_info = (unsigned long) &ax88772_info,
1610 1611 1612 1613
}, {
	// 0Q0 cable ethernet
	USB_DEVICE (0x1557, 0x7720),
	.driver_info = (unsigned long) &ax88772_info,
1614 1615 1616 1617
}, {
	// DLink DUB-E100 H/W Ver B1
	USB_DEVICE (0x07d1, 0x3c05),
	.driver_info = (unsigned long) &ax88772_info,
1618 1619 1620 1621
}, {
	// DLink DUB-E100 H/W Ver B1 Alternate
	USB_DEVICE (0x2001, 0x3c05),
	.driver_info = (unsigned long) &ax88772_info,
1622 1623 1624 1625
}, {
	// Linksys USB1000
	USB_DEVICE (0x1737, 0x0039),
	.driver_info = (unsigned long) &ax88178_info,
1626 1627 1628 1629
}, {
	// IO-DATA ETG-US2
	USB_DEVICE (0x04bb, 0x0930),
	.driver_info = (unsigned long) &ax88178_info,
D
David Hollis 已提交
1630 1631 1632 1633
}, {
	// Belkin F5D5055
	USB_DEVICE(0x050d, 0x5055),
	.driver_info = (unsigned long) &ax88178_info,
1634 1635 1636 1637
}, {
	// Apple USB Ethernet Adapter
	USB_DEVICE(0x05ac, 0x1402),
	.driver_info = (unsigned long) &ax88772_info,
1638 1639 1640 1641
}, {
	// Cables-to-Go USB Ethernet Adapter
	USB_DEVICE(0x0b95, 0x772a),
	.driver_info = (unsigned long) &ax88772_info,
G
Greg Kroah-Hartman 已提交
1642 1643 1644 1645 1646 1647 1648 1649
}, {
	// 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,
1650 1651 1652 1653 1654 1655
},
	{ },		// END
};
MODULE_DEVICE_TABLE(usb, products);

static struct usb_driver asix_driver = {
1656
	.name =		DRIVER_NAME,
1657 1658 1659 1660 1661
	.id_table =	products,
	.probe =	usbnet_probe,
	.suspend =	usbnet_suspend,
	.resume =	usbnet_resume,
	.disconnect =	usbnet_disconnect,
1662
	.supports_autosuspend = 1,
1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677
};

static int __init asix_init(void)
{
 	return usb_register(&asix_driver);
}
module_init(asix_init);

static void __exit asix_exit(void)
{
 	usb_deregister(&asix_driver);
}
module_exit(asix_exit);

MODULE_AUTHOR("David Hollis");
1678
MODULE_VERSION(DRIVER_VERSION);
1679 1680 1681
MODULE_DESCRIPTION("ASIX AX8817X based USB 2.0 Ethernet Devices");
MODULE_LICENSE("GPL");