asix.c 41.4 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 41
static const char driver_name [] = "asix";

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 118
/* 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 | \
	 AX_MEDIUM_RE )
119

120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 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 165
#define AX88772_MEDIUM_DEFAULT	\
	(AX_MEDIUM_FD | AX_MEDIUM_RFC | \
	 AX_MEDIUM_TFC | AX_MEDIUM_PS | \
	 AX_MEDIUM_AC | AX_MEDIUM_RE )

/* AX88772 & AX88178 RX_CTL values */
#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 )

/* 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
166

167 168
#define	PHY_MODE_RTL8211CL	0x0004

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

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

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

192 193
	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 已提交
194 195 196 197 198 199

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

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

out:
	return err;
217 218
}

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

225 226
	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 已提交
227 228

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

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

out:
	return err;
248 249
}

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

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

	kfree(req);
	usb_free_urb(urb);
}

263 264 265 266 267 268 269 270
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;

271 272
	netdev_dbg(dev->net, "asix_write_cmd_async() cmd=0x%02x value=0x%04x index=0x%04x size=%d\n",
		   cmd, value, index, size);
273
	if ((urb = usb_alloc_urb(0, GFP_ATOMIC)) == NULL) {
274
		netdev_err(dev->net, "Error allocating URB in write_cmd_async!\n");
275 276 277 278
		return;
	}

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

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

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

	if((status = usb_submit_urb(urb, GFP_ATOMIC)) < 0) {
296 297
		netdev_err(dev->net, "Error submitting the control message: status=%d\n",
			   status);
298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318
		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) {
319
		if ((header & 0x07ff) != ((~header >> 16) & 0x07ff))
320
			netdev_err(dev->net, "asix_rx_fixup() Bad Header Length\n");
321

322
		/* get the packet length */
323
		size = (u16) (header & 0x000007ff);
324

325
		if ((skb->len) - ((size + 1) & 0xfffe) == 0) {
326
			u8 alignment = (unsigned long)skb->data & 0x3;
327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344
			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);
			}
345
			return 2;
346 347
		}

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

			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;
			}
367
			ax_skb->data = packet;
368
			skb_set_tail_pointer(ax_skb, size);
369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386
			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) {
387 388
		netdev_err(dev->net, "asix_rx_fixup() Bad SKB Length %d\n",
			   skb->len);
389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404
		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;

405 406
	if ((!skb_cloned(skb)) &&
	    ((headroom + tailroom) >= (4 + padlen))) {
407 408
		if ((headroom < 4) || (tailroom < padlen)) {
			skb->data = memmove(skb->head + 4, skb->data, skb->len);
409
			skb_set_tail_pointer(skb, skb->len);
410 411 412 413 414 415 416 417 418 419 420 421
		}
	} 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);
422
	cpu_to_le32s(&packet_len);
423
	skb_copy_to_linear_data(skb, &packet_len, sizeof(packet_len));
424 425

	if ((skb->len % 512) == 0) {
426
		cpu_to_le32s(&padbytes);
427
		memcpy(skb_tail_pointer(skb), &padbytes, sizeof(padbytes));
428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448
		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);
449
		netdev_dbg(dev->net, "Link Status is: %d\n", link);
450 451 452
	}
}

453 454 455 456 457
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)
458
		netdev_err(dev->net, "Failed to enable software MII access\n");
459 460 461 462 463 464 465 466
	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)
467
		netdev_err(dev->net, "Failed to enable hardware MII access\n");
468 469 470
	return ret;
}

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

476
	netdev_dbg(dev->net, "asix_get_phy_addr()\n");
477

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

out:
487 488 489 490 491 492 493 494 495
	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)
496
		netdev_err(dev->net, "Failed to send software reset: %02x\n", ret);
497 498 499

	return ret;
}
500

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

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

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

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

	return ret;
}

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

A
Al Viro 已提交
533
	if (ret < 0) {
534 535
		netdev_err(dev->net, "Error reading Medium Status register: %02x\n",
			   ret);
A
Al Viro 已提交
536
		goto out;
537
	}
A
Al Viro 已提交
538 539
	ret = le16_to_cpu(v);
out:
540
	return ret;
541 542
}

543
static int asix_write_medium_mode(struct usbnet *dev, u16 mode)
544
{
545
	int ret;
546

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

553 554
	return ret;
}
555

556 557 558
static int asix_write_gpio(struct usbnet *dev, u16 value, int sleep)
{
	int ret;
559

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

566 567 568 569
	if (sleep)
		msleep(sleep);

	return ret;
570 571
}

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

	if (net->flags & IFF_PROMISC) {
582
		rx_ctl |= AX_RX_CTL_PRO;
583
	} else if (net->flags & IFF_ALLMULTI ||
584
		   netdev_mc_count(net) > AX_MAX_MCAST) {
585
		rx_ctl |= AX_RX_CTL_AMALL;
586
	} else if (netdev_mc_empty(net)) {
587 588 589 590 591 592
		/* 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 */
593
		struct netdev_hw_addr *ha;
594 595 596 597 598
		u32 crc_bits;

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

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

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

608
		rx_ctl |= AX_RX_CTL_AM;
609 610
	}

611
	asix_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL);
612 613
}

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

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

626 627
	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));
628

A
Al Viro 已提交
629
	return le16_to_cpu(res);
630 631 632
}

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

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

647 648
/* Get the PHY Identifier from the PHYSID1 & PHYSID2 MII registers */
static u32 asix_get_phyid(struct usbnet *dev)
649
{
650 651
	int phy_reg;
	u32 phy_id;
652

653 654 655
	phy_reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_PHYSID1);
	if (phy_reg < 0)
		return 0;
656

657
	phy_id = (phy_reg & 0xffff) << 16;
658

659 660 661 662 663 664 665
	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;
666 667 668
}

static void
669
asix_get_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
670 671 672 673
{
	struct usbnet *dev = netdev_priv(net);
	u8 opt;

674
	if (asix_read_cmd(dev, AX_CMD_READ_MONITOR_MODE, 0, 0, 1, &opt) < 0) {
675 676 677 678 679 680 681 682 683
		wolinfo->supported = 0;
		wolinfo->wolopts = 0;
		return;
	}
	wolinfo->supported = WAKE_PHY | WAKE_MAGIC;
	wolinfo->wolopts = 0;
}

static int
684
asix_set_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
685 686 687 688 689 690 691 692 693
{
	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;

694
	if (asix_write_cmd(dev, AX_CMD_WRITE_MONITOR_MODE,
A
Al Viro 已提交
695
			      opt, 0, 0, NULL) < 0)
696 697 698 699 700
		return -EINVAL;

	return 0;
}

701
static int asix_get_eeprom_len(struct net_device *net)
702
{
703 704 705 706
	struct usbnet *dev = netdev_priv(net);
	struct asix_data *data = (struct asix_data *)&dev->data;

	return data->eeprom_len;
707 708
}

709
static int asix_get_eeprom(struct net_device *net,
710 711 712
			      struct ethtool_eeprom *eeprom, u8 *data)
{
	struct usbnet *dev = netdev_priv(net);
A
Al Viro 已提交
713
	__le16 *ebuf = (__le16 *)data;
714 715 716 717 718 719 720 721 722 723 724 725
	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++) {
726
		if (asix_read_cmd(dev, AX_CMD_READ_EEPROM,
727 728 729 730 731 732
			eeprom->offset + i, 0, 2, &ebuf[i]) < 0)
			return -EINVAL;
	}
	return 0;
}

733
static void asix_get_drvinfo (struct net_device *net,
734 735
				 struct ethtool_drvinfo *info)
{
736 737 738
	struct usbnet *dev = netdev_priv(net);
	struct asix_data *data = (struct asix_data *)&dev->data;

739 740
	/* Inherit standard device info */
	usbnet_get_drvinfo(net, info);
741 742 743
	strncpy (info->driver, driver_name, sizeof info->driver);
	strncpy (info->version, DRIVER_VERSION, sizeof info->version);
	info->eedump_len = data->eeprom_len;
744 745
}

746 747 748 749 750 751 752 753 754 755 756 757 758 759
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);
}

760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783
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;
}

784 785 786
/* 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. */
787
static const struct ethtool_ops ax88172_ethtool_ops = {
788 789 790
	.get_drvinfo		= asix_get_drvinfo,
	.get_link		= asix_get_link,
	.get_msglevel		= usbnet_get_msglevel,
791
	.set_msglevel		= usbnet_set_msglevel,
792 793 794 795
	.get_wol		= asix_get_wol,
	.set_wol		= asix_set_wol,
	.get_eeprom_len		= asix_get_eeprom_len,
	.get_eeprom		= asix_get_eeprom,
796 797 798
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
799 800
};

801
static void ax88172_set_multicast(struct net_device *net)
802 803
{
	struct usbnet *dev = netdev_priv(net);
804 805
	struct asix_data *data = (struct asix_data *)&dev->data;
	u8 rx_ctl = 0x8c;
806

807 808
	if (net->flags & IFF_PROMISC) {
		rx_ctl |= 0x01;
809
	} else if (net->flags & IFF_ALLMULTI ||
810
		   netdev_mc_count(net) > AX_MAX_MCAST) {
811
		rx_ctl |= 0x02;
812
	} else if (netdev_mc_empty(net)) {
813 814 815 816 817 818
		/* 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 */
819
		struct netdev_hw_addr *ha;
820 821 822 823 824
		u32 crc_bits;

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

		/* Build the multicast hash filter. */
825 826
		netdev_for_each_mc_addr(ha, net) {
			crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842
			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;
843
	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
844 845 846 847 848 849 850 851

	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;

852 853
	netdev_dbg(dev->net, "ax88172_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
		   ethtool_cmd_speed(&ecmd), ecmd.duplex, mode);
854 855 856 857

	asix_write_medium_mode(dev, mode);

	return 0;
858 859
}

860 861 862 863 864 865 866 867 868
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,
869
	.ndo_set_rx_mode	= ax88172_set_multicast,
870 871
};

872
static int ax88172_bind(struct usbnet *dev, struct usb_interface *intf)
873 874
{
	int ret = 0;
A
Al Viro 已提交
875
	u8 buf[ETH_ALEN];
876 877
	int i;
	unsigned long gpio_bits = dev->driver_info->data;
878 879 880
	struct asix_data *data = (struct asix_data *)&dev->data;

	data->eeprom_len = AX88172_EEPROM_LEN;
881 882 883 884 885

	usbnet_get_endpoints(dev,intf);

	/* Toggle the GPIOs in a manufacturer/model specific way */
	for (i = 2; i >= 0; i--) {
886
		if ((ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS,
887
					(gpio_bits >> (i * 8)) & 0xff, 0, 0,
A
Al Viro 已提交
888 889
					NULL)) < 0)
			goto out;
890 891 892
		msleep(5);
	}

893
	if ((ret = asix_write_rx_ctl(dev, 0x80)) < 0)
A
Al Viro 已提交
894
		goto out;
895 896

	/* Get the MAC address */
897
	if ((ret = asix_read_cmd(dev, AX88172_CMD_READ_NODE_ID,
A
Al Viro 已提交
898
				0, 0, ETH_ALEN, buf)) < 0) {
899
		dbg("read AX_CMD_READ_NODE_ID failed: %d", ret);
A
Al Viro 已提交
900
		goto out;
901 902 903 904 905
	}
	memcpy(dev->net->dev_addr, buf, ETH_ALEN);

	/* Initialize MII structure */
	dev->mii.dev = dev->net;
906 907
	dev->mii.mdio_read = asix_mdio_read;
	dev->mii.mdio_write = asix_mdio_write;
908 909
	dev->mii.phy_id_mask = 0x3f;
	dev->mii.reg_num_mask = 0x1f;
910
	dev->mii.phy_id = asix_get_phy_addr(dev);
911

912
	dev->net->netdev_ops = &ax88172_netdev_ops;
913
	dev->net->ethtool_ops = &ax88172_ethtool_ops;
914

915 916
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
917 918 919 920
		ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
	mii_nway_restart(&dev->mii);

	return 0;
A
Al Viro 已提交
921 922

out:
923 924 925
	return ret;
}

926
static const struct ethtool_ops ax88772_ethtool_ops = {
927
	.get_drvinfo		= asix_get_drvinfo,
928
	.get_link		= asix_get_link,
929 930
	.get_msglevel		= usbnet_get_msglevel,
	.set_msglevel		= usbnet_set_msglevel,
931 932 933 934
	.get_wol		= asix_get_wol,
	.set_wol		= asix_set_wol,
	.get_eeprom_len		= asix_get_eeprom_len,
	.get_eeprom		= asix_get_eeprom,
935 936 937
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
938 939
};

940 941 942
static int ax88772_link_reset(struct usbnet *dev)
{
	u16 mode;
943
	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
944 945 946 947 948

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

949
	if (ethtool_cmd_speed(&ecmd) != SPEED_100)
950 951 952 953 954
		mode &= ~AX_MEDIUM_PS;

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

955 956
	netdev_dbg(dev->net, "ax88772_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
		   ethtool_cmd_speed(&ecmd), ecmd.duplex, mode);
957 958 959 960 961 962

	asix_write_medium_mode(dev, mode);

	return 0;
}

963
static int ax88772_reset(struct usbnet *dev)
964
{
965
	int ret, embd_phy;
966
	u16 rx_ctl;
967

968 969
	if ((ret = asix_write_gpio(dev,
			AX_GPIO_RSE | AX_GPIO_GPO_2 | AX_GPIO_GPO2EN, 5)) < 0)
A
Al Viro 已提交
970
		goto out;
971

972
	embd_phy = ((asix_get_phy_addr(dev) & 0x1f) == 0x10 ? 1 : 0);
973

974
	if ((ret = asix_write_cmd(dev, AX_CMD_SW_PHY_SELECT,
A
Al Viro 已提交
975
				embd_phy, 0, 0, NULL)) < 0) {
976
		dbg("Select PHY #1 failed: %d", ret);
A
Al Viro 已提交
977
		goto out;
978 979
	}

980
	if ((ret = asix_sw_reset(dev, AX_SWRESET_IPPD | AX_SWRESET_PRL)) < 0)
A
Al Viro 已提交
981
		goto out;
982 983

	msleep(150);
984
	if ((ret = asix_sw_reset(dev, AX_SWRESET_CLEAR)) < 0)
A
Al Viro 已提交
985
		goto out;
986 987

	msleep(150);
988

989 990
	if (embd_phy) {
		if ((ret = asix_sw_reset(dev, AX_SWRESET_IPRL)) < 0)
A
Al Viro 已提交
991
			goto out;
992 993 994
	}
	else {
		if ((ret = asix_sw_reset(dev, AX_SWRESET_PRTE)) < 0)
A
Al Viro 已提交
995
			goto out;
996
	}
997 998

	msleep(150);
999 1000 1001
	rx_ctl = asix_read_rx_ctl(dev);
	dbg("RX_CTL is 0x%04x after software reset", rx_ctl);
	if ((ret = asix_write_rx_ctl(dev, 0x0000)) < 0)
A
Al Viro 已提交
1002
		goto out;
1003

1004 1005 1006
	rx_ctl = asix_read_rx_ctl(dev);
	dbg("RX_CTL is 0x%04x setting to 0x0000", rx_ctl);

1007
	if ((ret = asix_sw_reset(dev, AX_SWRESET_PRL)) < 0)
A
Al Viro 已提交
1008
		goto out;
1009 1010

	msleep(150);
1011 1012

	if ((ret = asix_sw_reset(dev, AX_SWRESET_IPRL | AX_SWRESET_PRL)) < 0)
A
Al Viro 已提交
1013
		goto out;
1014

1015
	msleep(150);
1016

1017 1018
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
1019 1020 1021
			ADVERTISE_ALL | ADVERTISE_CSMA);
	mii_nway_restart(&dev->mii);

1022
	if ((ret = asix_write_medium_mode(dev, AX88772_MEDIUM_DEFAULT)) < 0)
A
Al Viro 已提交
1023
		goto out;
1024

1025
	if ((ret = asix_write_cmd(dev, AX_CMD_WRITE_IPG0,
1026
				AX88772_IPG0_DEFAULT | AX88772_IPG1_DEFAULT,
A
Al Viro 已提交
1027
				AX88772_IPG2_DEFAULT, 0, NULL)) < 0) {
1028
		dbg("Write IPG,IPG1,IPG2 failed: %d", ret);
A
Al Viro 已提交
1029
		goto out;
1030 1031 1032
	}

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

1036 1037 1038 1039 1040 1041
	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);

1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096
	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)
{
	int ret;
	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 */
	if ((ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID,
				0, 0, ETH_ALEN, buf)) < 0) {
		dbg("Failed to read MAC address: %d", ret);
		goto out;
	}
	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);

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

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

	if ((ret = ax88772_reset(dev)) < 0)
		goto out;

1097 1098 1099 1100 1101 1102 1103
	/* 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;
	}
	return 0;
A
Al Viro 已提交
1104
out:
1105 1106 1107
	return ret;
}

1108 1109 1110 1111 1112 1113 1114 1115 1116
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,
1117 1118 1119
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
1120 1121 1122
};

static int marvell_phy_init(struct usbnet *dev)
1123
{
1124 1125
	struct asix_data *data = (struct asix_data *)&dev->data;
	u16 reg;
1126

1127
	netdev_dbg(dev->net, "marvell_phy_init()\n");
1128

1129
	reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_MARVELL_STATUS);
1130
	netdev_dbg(dev->net, "MII_MARVELL_STATUS = 0x%04x\n", reg);
1131

1132 1133
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_MARVELL_CTRL,
			MARVELL_CTRL_RXDELAY | MARVELL_CTRL_TXDELAY);
1134

1135 1136 1137
	if (data->ledmode) {
		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL);
1138
		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (1) = 0x%04x\n", reg);
1139

1140 1141 1142 1143
		reg &= 0xf8ff;
		reg |= (1 + 0x0100);
		asix_mdio_write(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL, reg);
1144

1145 1146
		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL);
1147
		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (2) = 0x%04x\n", reg);
1148 1149
		reg &= 0xfc0f;
	}
1150

1151 1152 1153
	return 0;
}

1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174
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;
}

1175 1176 1177 1178
static int marvell_led_status(struct usbnet *dev, u16 speed)
{
	u16 reg = asix_mdio_read(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL);

1179
	netdev_dbg(dev->net, "marvell_led_status() read 0x%04x\n", reg);
1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192

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

1195
	netdev_dbg(dev->net, "marvell_led_status() writing 0x%04x\n", reg);
1196 1197 1198 1199 1200
	asix_mdio_write(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL, reg);

	return 0;
}

1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 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
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);

	if ((ret = asix_write_medium_mode(dev, AX88178_MEDIUM_DEFAULT)) < 0)
		goto out;

	if ((ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL)) < 0)
		goto out;

	return 0;

out:
	return ret;

}

1276 1277 1278
static int ax88178_link_reset(struct usbnet *dev)
{
	u16 mode;
1279
	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
1280
	struct asix_data *data = (struct asix_data *)&dev->data;
1281
	u32 speed;
1282

1283
	netdev_dbg(dev->net, "ax88178_link_reset()\n");
1284 1285 1286 1287

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

1290
	if (speed == SPEED_1000)
1291
		mode |= AX_MEDIUM_GM;
1292
	else if (speed == SPEED_100)
1293 1294 1295 1296
		mode |= AX_MEDIUM_PS;
	else
		mode &= ~(AX_MEDIUM_PS | AX_MEDIUM_GM);

1297 1298
	mode |= AX_MEDIUM_ENCK;

1299 1300 1301 1302 1303
	if (ecmd.duplex == DUPLEX_FULL)
		mode |= AX_MEDIUM_FD;
	else
		mode &= ~AX_MEDIUM_FD;

1304 1305
	netdev_dbg(dev->net, "ax88178_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
		   speed, ecmd.duplex, mode);
1306 1307 1308 1309

	asix_write_medium_mode(dev, mode);

	if (data->phymode == PHY_MODE_MARVELL && data->ledmode)
1310
		marvell_led_status(dev, speed);
1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333

	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;
1334
	}
1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347

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

1350
static int ax88178_change_mtu(struct net_device *net, int new_mtu)
1351
{
1352 1353
	struct usbnet *dev = netdev_priv(net);
	int ll_mtu = new_mtu + net->hard_header_len + 4;
1354

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

1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369
	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;
}

1370 1371 1372 1373 1374
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,
1375
	.ndo_set_mac_address 	= asix_set_mac_address,
1376
	.ndo_validate_addr	= eth_validate_addr,
1377
	.ndo_set_rx_mode	= asix_set_multicast,
1378 1379 1380 1381
	.ndo_do_ioctl 		= asix_ioctl,
	.ndo_change_mtu 	= ax88178_change_mtu,
};

1382 1383 1384
static int ax88178_bind(struct usbnet *dev, struct usb_interface *intf)
{
	int ret;
A
Al Viro 已提交
1385
	u8 buf[ETH_ALEN];
1386 1387 1388 1389 1390 1391 1392 1393
	u32 phyid;

	usbnet_get_endpoints(dev,intf);

	/* Get the MAC address */
	if ((ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID,
				0, 0, ETH_ALEN, buf)) < 0) {
		dbg("Failed to read MAC address: %d", ret);
A
Al Viro 已提交
1394
		goto out;
1395
	}
1396
	memcpy(dev->net->dev_addr, buf, ETH_ALEN);
1397

1398 1399 1400 1401 1402 1403 1404 1405
	/* 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);
1406 1407

	dev->net->netdev_ops = &ax88178_netdev_ops;
1408
	dev->net->ethtool_ops = &ax88178_ethtool_ops;
1409

1410 1411
	phyid = asix_get_phyid(dev);
	dbg("PHYID=0x%08x", phyid);
1412

1413 1414
	ret = ax88178_reset(dev);
	if (ret < 0)
A
Al Viro 已提交
1415
		goto out;
1416 1417 1418 1419 1420 1421 1422

	/* 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;
	}
1423
	return 0;
1424

A
Al Viro 已提交
1425
out:
1426
	return ret;
1427 1428 1429 1430
}

static const struct driver_info ax8817x_info = {
	.description = "ASIX AX8817x USB 2.0 Ethernet",
1431 1432
	.bind = ax88172_bind,
	.status = asix_status,
1433 1434
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1435
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1436 1437 1438 1439 1440
	.data = 0x00130103,
};

static const struct driver_info dlink_dub_e100_info = {
	.description = "DLink DUB-E100 USB Ethernet",
1441 1442
	.bind = ax88172_bind,
	.status = asix_status,
1443 1444
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1445
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1446 1447 1448 1449 1450
	.data = 0x009f9d9f,
};

static const struct driver_info netgear_fa120_info = {
	.description = "Netgear FA-120 USB Ethernet",
1451 1452
	.bind = ax88172_bind,
	.status = asix_status,
1453 1454
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1455
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1456 1457 1458 1459 1460
	.data = 0x00130103,
};

static const struct driver_info hawking_uf200_info = {
	.description = "Hawking UF200 USB Ethernet",
1461 1462
	.bind = ax88172_bind,
	.status = asix_status,
1463 1464
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1465
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1466 1467 1468 1469 1470 1471
	.data = 0x001f1d1f,
};

static const struct driver_info ax88772_info = {
	.description = "ASIX AX88772 USB 2.0 Ethernet",
	.bind = ax88772_bind,
1472
	.status = asix_status,
1473
	.link_reset = ax88772_link_reset,
1474
	.reset = ax88772_reset,
1475
	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR,
1476 1477 1478 1479 1480 1481 1482 1483 1484
	.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,
1485
	.reset = ax88178_reset,
1486
	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR,
1487 1488
	.rx_fixup = asix_rx_fixup,
	.tx_fixup = asix_tx_fixup,
1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512
};

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 已提交
1513 1514 1515
	// Billionton Systems, USB2AR
	USB_DEVICE (0x08dd, 0x90ff),
	.driver_info =  (unsigned long) &ax8817x_info,
1516 1517 1518 1519 1520 1521 1522 1523
}, {
	// 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,
1524 1525 1526 1527
}, {
	// Buffalo LUA-U2-GT 10/100/1000
	USB_DEVICE (0x0411, 0x006e),
	.driver_info =  (unsigned long) &ax88178_info,
1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543
}, {
	// 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 已提交
1544 1545 1546 1547
}, {
	// JVC MP-PRX1 Port Replicator
	USB_DEVICE (0x04f1, 0x3008),
	.driver_info = (unsigned long) &ax8817x_info,
M
Marek Vasut 已提交
1548 1549 1550 1551
}, {
	// ASIX AX88772B 10/100
	USB_DEVICE (0x0b95, 0x772b),
	.driver_info = (unsigned long) &ax88772_info,
1552 1553
}, {
	// ASIX AX88772 10/100
D
David Hollis 已提交
1554 1555
	USB_DEVICE (0x0b95, 0x7720),
	.driver_info = (unsigned long) &ax88772_info,
1556 1557 1558
}, {
	// ASIX AX88178 10/100/1000
	USB_DEVICE (0x0b95, 0x1780),
1559
	.driver_info = (unsigned long) &ax88178_info,
1560 1561 1562 1563
}, {
	// Logitec LAN-GTJ/U2A
	USB_DEVICE (0x0789, 0x0160),
	.driver_info = (unsigned long) &ax88178_info,
1564 1565 1566 1567
}, {
	// Linksys USB200M Rev 2
	USB_DEVICE (0x13b1, 0x0018),
	.driver_info = (unsigned long) &ax88772_info,
1568 1569 1570 1571
}, {
	// 0Q0 cable ethernet
	USB_DEVICE (0x1557, 0x7720),
	.driver_info = (unsigned long) &ax88772_info,
1572 1573 1574 1575
}, {
	// DLink DUB-E100 H/W Ver B1
	USB_DEVICE (0x07d1, 0x3c05),
	.driver_info = (unsigned long) &ax88772_info,
1576 1577 1578 1579
}, {
	// DLink DUB-E100 H/W Ver B1 Alternate
	USB_DEVICE (0x2001, 0x3c05),
	.driver_info = (unsigned long) &ax88772_info,
1580 1581 1582 1583
}, {
	// Linksys USB1000
	USB_DEVICE (0x1737, 0x0039),
	.driver_info = (unsigned long) &ax88178_info,
1584 1585 1586 1587
}, {
	// IO-DATA ETG-US2
	USB_DEVICE (0x04bb, 0x0930),
	.driver_info = (unsigned long) &ax88178_info,
D
David Hollis 已提交
1588 1589 1590 1591
}, {
	// Belkin F5D5055
	USB_DEVICE(0x050d, 0x5055),
	.driver_info = (unsigned long) &ax88178_info,
1592 1593 1594 1595
}, {
	// Apple USB Ethernet Adapter
	USB_DEVICE(0x05ac, 0x1402),
	.driver_info = (unsigned long) &ax88772_info,
1596 1597 1598 1599
}, {
	// Cables-to-Go USB Ethernet Adapter
	USB_DEVICE(0x0b95, 0x772a),
	.driver_info = (unsigned long) &ax88772_info,
G
Greg Kroah-Hartman 已提交
1600 1601 1602 1603 1604 1605 1606 1607
}, {
	// 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,
1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619
},
	{ },		// END
};
MODULE_DEVICE_TABLE(usb, products);

static struct usb_driver asix_driver = {
	.name =		"asix",
	.id_table =	products,
	.probe =	usbnet_probe,
	.suspend =	usbnet_suspend,
	.resume =	usbnet_resume,
	.disconnect =	usbnet_disconnect,
1620
	.supports_autosuspend = 1,
1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635
};

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");
1636
MODULE_VERSION(DRIVER_VERSION);
1637 1638 1639
MODULE_DESCRIPTION("ASIX AX8817X based USB 2.0 Ethernet Devices");
MODULE_LICENSE("GPL");