asix.c 39.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

38 39 40
#define DRIVER_VERSION "14-Jun-2006"
static const char driver_name [] = "asix";

41 42 43 44 45 46 47 48 49 50
/* 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
51
#define AX_CMD_READ_RX_CTL		0x0f
52 53 54 55
#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
56
#define AX_CMD_READ_NODE_ID		0x13
57
#define AX_CMD_WRITE_NODE_ID		0x14
58 59
#define AX_CMD_WRITE_IPG2		0x14
#define AX_CMD_WRITE_MULTI_FILTER	0x16
60
#define AX88172_CMD_READ_NODE_ID	0x17
61 62 63 64 65
#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
66
#define AX_CMD_READ_GPIOS		0x1e
67 68 69 70 71 72 73 74 75 76 77
#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 */
78 79 80 81 82
#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 )
83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99

#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

100 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 | \
	 AX_MEDIUM_RE )
118

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
#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
165 166

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

struct ax88172_int_data {
A
Al Viro 已提交
176
	__le16 res1;
177
	u8 link;
A
Al Viro 已提交
178
	__le16 res2;
179
	u8 status;
A
Al Viro 已提交
180
	__le16 res3;
181 182
} __attribute__ ((packed));

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

189 190
	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 已提交
191 192 193 194 195 196

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

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

out:
	return err;
214 215
}

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

222 223
	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 已提交
224 225 226 227 228 229 230 231 232

	if (data) {
		buf = kmalloc(size, GFP_KERNEL);
		if (!buf)
			goto out;
		memcpy(buf, data, size);
	}

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

out:
	return err;
246 247
}

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

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

	kfree(req);
	usb_free_urb(urb);
}

261 262 263 264 265 266 267 268
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;

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

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

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

	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) {
294 295
		netdev_err(dev->net, "Error submitting the control message: status=%d\n",
			   status);
296 297 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) {
		if ((short)(header & 0x0000ffff) !=
		    ~((short)((header & 0xffff0000) >> 16))) {
319
			netdev_err(dev->net, "asix_rx_fixup() Bad Header Length\n");
320 321 322 323 324 325 326
		}
		/* get the packet length */
		size = (u16) (header & 0x0000ffff);

		if ((skb->len) - ((size + 1) & 0xfffe) == 0)
			return 2;
		if (size > ETH_FRAME_LEN) {
327 328
			netdev_err(dev->net, "asix_rx_fixup() Bad RX Length %d\n",
				   size);
329 330 331 332 333 334
			return 0;
		}
		ax_skb = skb_clone(skb, GFP_ATOMIC);
		if (ax_skb) {
			ax_skb->len = size;
			ax_skb->data = packet;
335
			skb_set_tail_pointer(ax_skb, size);
336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353
			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) {
354 355
		netdev_err(dev->net, "asix_rx_fixup() Bad SKB Length %d\n",
			   skb->len);
356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371
		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;

372 373
	if ((!skb_cloned(skb)) &&
	    ((headroom + tailroom) >= (4 + padlen))) {
374 375
		if ((headroom < 4) || (tailroom < padlen)) {
			skb->data = memmove(skb->head + 4, skb->data, skb->len);
376
			skb_set_tail_pointer(skb, skb->len);
377 378 379 380 381 382 383 384 385 386 387 388
		}
	} 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);
389
	cpu_to_le32s(&packet_len);
390
	skb_copy_to_linear_data(skb, &packet_len, sizeof(packet_len));
391 392

	if ((skb->len % 512) == 0) {
393
		cpu_to_le32s(&padbytes);
394
		memcpy(skb_tail_pointer(skb), &padbytes, sizeof(padbytes));
395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415
		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);
416
		netdev_dbg(dev->net, "Link Status is: %d\n", link);
417 418 419
	}
}

420 421 422 423 424
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)
425
		netdev_err(dev->net, "Failed to enable software MII access\n");
426 427 428 429 430 431 432 433
	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)
434
		netdev_err(dev->net, "Failed to enable hardware MII access\n");
435 436 437
	return ret;
}

438
static inline int asix_get_phy_addr(struct usbnet *dev)
439
{
A
Al Viro 已提交
440 441
	u8 buf[2];
	int ret = asix_read_cmd(dev, AX_CMD_READ_PHY_ID, 0, 0, 2, buf);
442

443
	netdev_dbg(dev->net, "asix_get_phy_addr()\n");
444

A
Al Viro 已提交
445
	if (ret < 0) {
446
		netdev_err(dev->net, "Error reading PHYID register: %02x\n", ret);
A
Al Viro 已提交
447
		goto out;
448
	}
449 450
	netdev_dbg(dev->net, "asix_get_phy_addr() returning 0x%04x\n",
		   *((__le16 *)buf));
A
Al Viro 已提交
451 452 453
	ret = buf[1];

out:
454 455 456 457 458 459 460 461 462
	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)
463
		netdev_err(dev->net, "Failed to send software reset: %02x\n", ret);
464 465 466

	return ret;
}
467

468 469
static u16 asix_read_rx_ctl(struct usbnet *dev)
{
A
Al Viro 已提交
470 471
	__le16 v;
	int ret = asix_read_cmd(dev, AX_CMD_READ_RX_CTL, 0, 0, 2, &v);
472

A
Al Viro 已提交
473
	if (ret < 0) {
474
		netdev_err(dev->net, "Error reading RX_CTL register: %02x\n", ret);
A
Al Viro 已提交
475
		goto out;
476
	}
A
Al Viro 已提交
477 478
	ret = le16_to_cpu(v);
out:
479 480 481 482 483 484 485
	return ret;
}

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

486
	netdev_dbg(dev->net, "asix_write_rx_ctl() - mode = 0x%04x\n", mode);
487 488
	ret = asix_write_cmd(dev, AX_CMD_WRITE_RX_CTL, mode, 0, 0, NULL);
	if (ret < 0)
489 490
		netdev_err(dev->net, "Failed to write RX_CTL mode to 0x%04x: %02x\n",
			   mode, ret);
491 492 493 494

	return ret;
}

495
static u16 asix_read_medium_status(struct usbnet *dev)
496
{
A
Al Viro 已提交
497 498
	__le16 v;
	int ret = asix_read_cmd(dev, AX_CMD_READ_MEDIUM_STATUS, 0, 0, 2, &v);
499

A
Al Viro 已提交
500
	if (ret < 0) {
501 502
		netdev_err(dev->net, "Error reading Medium Status register: %02x\n",
			   ret);
A
Al Viro 已提交
503
		goto out;
504
	}
A
Al Viro 已提交
505 506
	ret = le16_to_cpu(v);
out:
507
	return ret;
508 509
}

510
static int asix_write_medium_mode(struct usbnet *dev, u16 mode)
511
{
512
	int ret;
513

514
	netdev_dbg(dev->net, "asix_write_medium_mode() - mode = 0x%04x\n", mode);
515 516
	ret = asix_write_cmd(dev, AX_CMD_WRITE_MEDIUM_MODE, mode, 0, 0, NULL);
	if (ret < 0)
517 518
		netdev_err(dev->net, "Failed to write Medium Mode mode to 0x%04x: %02x\n",
			   mode, ret);
519

520 521
	return ret;
}
522

523 524 525
static int asix_write_gpio(struct usbnet *dev, u16 value, int sleep)
{
	int ret;
526

527
	netdev_dbg(dev->net, "asix_write_gpio() - value = 0x%04x\n", value);
528 529
	ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS, value, 0, 0, NULL);
	if (ret < 0)
530 531
		netdev_err(dev->net, "Failed to write GPIO value 0x%04x: %02x\n",
			   value, ret);
532

533 534 535 536
	if (sleep)
		msleep(sleep);

	return ret;
537 538
}

539 540 541
/*
 * AX88772 & AX88178 have a 16-bit RX_CTL value
 */
542
static void asix_set_multicast(struct net_device *net)
543 544
{
	struct usbnet *dev = netdev_priv(net);
545
	struct asix_data *data = (struct asix_data *)&dev->data;
546
	u16 rx_ctl = AX_DEFAULT_RX_CTL;
547 548

	if (net->flags & IFF_PROMISC) {
549
		rx_ctl |= AX_RX_CTL_PRO;
550
	} else if (net->flags & IFF_ALLMULTI ||
551
		   netdev_mc_count(net) > AX_MAX_MCAST) {
552
		rx_ctl |= AX_RX_CTL_AMALL;
553
	} else if (netdev_mc_empty(net)) {
554 555 556 557 558 559
		/* 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 */
560
		struct dev_mc_list *mc_list;
561 562 563 564 565
		u32 crc_bits;

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

		/* Build the multicast hash filter. */
566
		netdev_for_each_mc_addr(mc_list, net) {
567 568 569 570 571 572 573
			crc_bits =
			    ether_crc(ETH_ALEN,
				      mc_list->dmi_addr) >> 26;
			data->multi_filter[crc_bits >> 3] |=
			    1 << (crc_bits & 7);
		}

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

577
		rx_ctl |= AX_RX_CTL_AM;
578 579
	}

580
	asix_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL);
581 582
}

583
static int asix_mdio_read(struct net_device *netdev, int phy_id, int loc)
584 585
{
	struct usbnet *dev = netdev_priv(netdev);
A
Al Viro 已提交
586
	__le16 res;
587

588
	mutex_lock(&dev->phy_mutex);
589 590
	asix_set_sw_mii(dev);
	asix_read_cmd(dev, AX_CMD_READ_MII_REG, phy_id,
A
Al Viro 已提交
591
				(__u16)loc, 2, &res);
592
	asix_set_hw_mii(dev);
593
	mutex_unlock(&dev->phy_mutex);
594

595 596
	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));
597

A
Al Viro 已提交
598
	return le16_to_cpu(res);
599 600 601
}

static void
602
asix_mdio_write(struct net_device *netdev, int phy_id, int loc, int val)
603 604
{
	struct usbnet *dev = netdev_priv(netdev);
A
Al Viro 已提交
605
	__le16 res = cpu_to_le16(val);
606

607 608
	netdev_dbg(dev->net, "asix_mdio_write() phy_id=0x%02x, loc=0x%02x, val=0x%04x\n",
		   phy_id, loc, val);
609
	mutex_lock(&dev->phy_mutex);
610
	asix_set_sw_mii(dev);
A
Al Viro 已提交
611
	asix_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id, (__u16)loc, 2, &res);
612
	asix_set_hw_mii(dev);
613
	mutex_unlock(&dev->phy_mutex);
614 615
}

616 617
/* Get the PHY Identifier from the PHYSID1 & PHYSID2 MII registers */
static u32 asix_get_phyid(struct usbnet *dev)
618
{
619 620
	int phy_reg;
	u32 phy_id;
621

622 623 624
	phy_reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_PHYSID1);
	if (phy_reg < 0)
		return 0;
625

626
	phy_id = (phy_reg & 0xffff) << 16;
627

628 629 630 631 632 633 634
	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;
635 636 637
}

static void
638
asix_get_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
639 640 641 642
{
	struct usbnet *dev = netdev_priv(net);
	u8 opt;

643
	if (asix_read_cmd(dev, AX_CMD_READ_MONITOR_MODE, 0, 0, 1, &opt) < 0) {
644 645 646 647 648 649 650 651 652 653 654 655 656 657 658
		wolinfo->supported = 0;
		wolinfo->wolopts = 0;
		return;
	}
	wolinfo->supported = WAKE_PHY | WAKE_MAGIC;
	wolinfo->wolopts = 0;
	if (opt & AX_MONITOR_MODE) {
		if (opt & AX_MONITOR_LINK)
			wolinfo->wolopts |= WAKE_PHY;
		if (opt & AX_MONITOR_MAGIC)
			wolinfo->wolopts |= WAKE_MAGIC;
	}
}

static int
659
asix_set_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
660 661 662 663 664 665 666 667 668 669 670
{
	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;
	if (opt != 0)
		opt |= AX_MONITOR_MODE;

671
	if (asix_write_cmd(dev, AX_CMD_WRITE_MONITOR_MODE,
A
Al Viro 已提交
672
			      opt, 0, 0, NULL) < 0)
673 674 675 676 677
		return -EINVAL;

	return 0;
}

678
static int asix_get_eeprom_len(struct net_device *net)
679
{
680 681 682 683
	struct usbnet *dev = netdev_priv(net);
	struct asix_data *data = (struct asix_data *)&dev->data;

	return data->eeprom_len;
684 685
}

686
static int asix_get_eeprom(struct net_device *net,
687 688 689
			      struct ethtool_eeprom *eeprom, u8 *data)
{
	struct usbnet *dev = netdev_priv(net);
A
Al Viro 已提交
690
	__le16 *ebuf = (__le16 *)data;
691 692 693 694 695 696 697 698 699 700 701 702
	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++) {
703
		if (asix_read_cmd(dev, AX_CMD_READ_EEPROM,
704 705 706 707 708 709
			eeprom->offset + i, 0, 2, &ebuf[i]) < 0)
			return -EINVAL;
	}
	return 0;
}

710
static void asix_get_drvinfo (struct net_device *net,
711 712
				 struct ethtool_drvinfo *info)
{
713 714 715
	struct usbnet *dev = netdev_priv(net);
	struct asix_data *data = (struct asix_data *)&dev->data;

716 717
	/* Inherit standard device info */
	usbnet_get_drvinfo(net, info);
718 719 720
	strncpy (info->driver, driver_name, sizeof info->driver);
	strncpy (info->version, DRIVER_VERSION, sizeof info->version);
	info->eedump_len = data->eeprom_len;
721 722
}

723 724 725 726 727 728 729 730 731 732 733 734 735 736
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);
}

737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760
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;
}

761 762 763
/* 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. */
764
static const struct ethtool_ops ax88172_ethtool_ops = {
765 766 767
	.get_drvinfo		= asix_get_drvinfo,
	.get_link		= asix_get_link,
	.get_msglevel		= usbnet_get_msglevel,
768
	.set_msglevel		= usbnet_set_msglevel,
769 770 771 772
	.get_wol		= asix_get_wol,
	.set_wol		= asix_set_wol,
	.get_eeprom_len		= asix_get_eeprom_len,
	.get_eeprom		= asix_get_eeprom,
773 774 775
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
776 777
};

778
static void ax88172_set_multicast(struct net_device *net)
779 780
{
	struct usbnet *dev = netdev_priv(net);
781 782
	struct asix_data *data = (struct asix_data *)&dev->data;
	u8 rx_ctl = 0x8c;
783

784 785
	if (net->flags & IFF_PROMISC) {
		rx_ctl |= 0x01;
786
	} else if (net->flags & IFF_ALLMULTI ||
787
		   netdev_mc_count(net) > AX_MAX_MCAST) {
788
		rx_ctl |= 0x02;
789
	} else if (netdev_mc_empty(net)) {
790 791 792 793 794 795
		/* 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 */
796
		struct dev_mc_list *mc_list;
797 798 799 800 801
		u32 crc_bits;

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

		/* Build the multicast hash filter. */
802
		netdev_for_each_mc_addr(mc_list, net) {
803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830
			crc_bits =
			    ether_crc(ETH_ALEN,
				      mc_list->dmi_addr) >> 26;
			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;
	struct ethtool_cmd ecmd;

	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;

831 832
	netdev_dbg(dev->net, "ax88172_link_reset() speed: %d duplex: %d setting mode to 0x%04x\n",
		   ecmd.speed, ecmd.duplex, mode);
833 834 835 836

	asix_write_medium_mode(dev, mode);

	return 0;
837 838
}

839 840 841 842 843 844 845 846 847 848 849 850
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,
	.ndo_set_multicast_list = ax88172_set_multicast,
};

851
static int ax88172_bind(struct usbnet *dev, struct usb_interface *intf)
852 853
{
	int ret = 0;
A
Al Viro 已提交
854
	u8 buf[ETH_ALEN];
855 856
	int i;
	unsigned long gpio_bits = dev->driver_info->data;
857 858 859
	struct asix_data *data = (struct asix_data *)&dev->data;

	data->eeprom_len = AX88172_EEPROM_LEN;
860 861 862 863 864

	usbnet_get_endpoints(dev,intf);

	/* Toggle the GPIOs in a manufacturer/model specific way */
	for (i = 2; i >= 0; i--) {
865
		if ((ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS,
866
					(gpio_bits >> (i * 8)) & 0xff, 0, 0,
A
Al Viro 已提交
867 868
					NULL)) < 0)
			goto out;
869 870 871
		msleep(5);
	}

872
	if ((ret = asix_write_rx_ctl(dev, 0x80)) < 0)
A
Al Viro 已提交
873
		goto out;
874 875

	/* Get the MAC address */
876
	if ((ret = asix_read_cmd(dev, AX88172_CMD_READ_NODE_ID,
A
Al Viro 已提交
877
				0, 0, ETH_ALEN, buf)) < 0) {
878
		dbg("read AX_CMD_READ_NODE_ID failed: %d", ret);
A
Al Viro 已提交
879
		goto out;
880 881 882 883 884
	}
	memcpy(dev->net->dev_addr, buf, ETH_ALEN);

	/* Initialize MII structure */
	dev->mii.dev = dev->net;
885 886
	dev->mii.mdio_read = asix_mdio_read;
	dev->mii.mdio_write = asix_mdio_write;
887 888
	dev->mii.phy_id_mask = 0x3f;
	dev->mii.reg_num_mask = 0x1f;
889
	dev->mii.phy_id = asix_get_phy_addr(dev);
890

891
	dev->net->netdev_ops = &ax88172_netdev_ops;
892
	dev->net->ethtool_ops = &ax88172_ethtool_ops;
893

894 895
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
896 897 898 899
		ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
	mii_nway_restart(&dev->mii);

	return 0;
A
Al Viro 已提交
900 901

out:
902 903 904
	return ret;
}

905
static const struct ethtool_ops ax88772_ethtool_ops = {
906
	.get_drvinfo		= asix_get_drvinfo,
907
	.get_link		= asix_get_link,
908 909
	.get_msglevel		= usbnet_get_msglevel,
	.set_msglevel		= usbnet_set_msglevel,
910 911 912 913
	.get_wol		= asix_get_wol,
	.set_wol		= asix_set_wol,
	.get_eeprom_len		= asix_get_eeprom_len,
	.get_eeprom		= asix_get_eeprom,
914 915 916
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
917 918
};

919 920 921 922 923 924 925 926 927 928 929 930 931 932 933
static int ax88772_link_reset(struct usbnet *dev)
{
	u16 mode;
	struct ethtool_cmd ecmd;

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

	if (ecmd.speed != SPEED_100)
		mode &= ~AX_MEDIUM_PS;

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

934 935
	netdev_dbg(dev->net, "ax88772_link_reset() speed: %d duplex: %d setting mode to 0x%04x\n",
		   ecmd.speed, ecmd.duplex, mode);
936 937 938 939 940 941

	asix_write_medium_mode(dev, mode);

	return 0;
}

942 943 944 945 946 947
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,
948
	.ndo_set_mac_address 	= asix_set_mac_address,
949 950 951 952 953
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_do_ioctl		= asix_ioctl,
	.ndo_set_multicast_list = asix_set_multicast,
};

954 955
static int ax88772_bind(struct usbnet *dev, struct usb_interface *intf)
{
956
	int ret, embd_phy;
957 958
	u16 rx_ctl;
	struct asix_data *data = (struct asix_data *)&dev->data;
A
Al Viro 已提交
959
	u8 buf[ETH_ALEN];
960 961 962
	u32 phyid;

	data->eeprom_len = AX88772_EEPROM_LEN;
963 964 965

	usbnet_get_endpoints(dev,intf);

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

970 971
	/* 0x10 is the phy id of the embedded 10/100 ethernet phy */
	embd_phy = ((asix_get_phy_addr(dev) & 0x1f) == 0x10 ? 1 : 0);
972
	if ((ret = asix_write_cmd(dev, AX_CMD_SW_PHY_SELECT,
A
Al Viro 已提交
973
				embd_phy, 0, 0, NULL)) < 0) {
974
		dbg("Select PHY #1 failed: %d", ret);
A
Al Viro 已提交
975
		goto out;
976 977
	}

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

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

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

	msleep(150);
996 997 998
	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 已提交
999
		goto out;
1000

1001 1002 1003
	rx_ctl = asix_read_rx_ctl(dev);
	dbg("RX_CTL is 0x%04x setting to 0x0000", rx_ctl);

1004
	/* Get the MAC address */
1005
	if ((ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID,
1006 1007
				0, 0, ETH_ALEN, buf)) < 0) {
		dbg("Failed to read MAC address: %d", ret);
A
Al Viro 已提交
1008
		goto out;
1009 1010 1011 1012 1013
	}
	memcpy(dev->net->dev_addr, buf, ETH_ALEN);

	/* Initialize MII structure */
	dev->mii.dev = dev->net;
1014 1015
	dev->mii.mdio_read = asix_mdio_read;
	dev->mii.mdio_write = asix_mdio_write;
1016 1017 1018 1019 1020 1021
	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);
1022

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

	msleep(150);
1027 1028

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

1031
	msleep(150);
1032

1033
	dev->net->netdev_ops = &ax88772_netdev_ops;
1034 1035
	dev->net->ethtool_ops = &ax88772_ethtool_ops;

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

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

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

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

1055 1056 1057 1058 1059 1060
	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);

1061 1062 1063 1064 1065 1066 1067 1068
	/* 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 已提交
1069
out:
1070 1071 1072
	return ret;
}

1073 1074 1075 1076 1077 1078 1079 1080 1081
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,
1082 1083 1084
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
1085 1086 1087
};

static int marvell_phy_init(struct usbnet *dev)
1088
{
1089 1090
	struct asix_data *data = (struct asix_data *)&dev->data;
	u16 reg;
1091

1092
	netdev_dbg(dev->net, "marvell_phy_init()\n");
1093

1094
	reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_MARVELL_STATUS);
1095
	netdev_dbg(dev->net, "MII_MARVELL_STATUS = 0x%04x\n", reg);
1096

1097 1098
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_MARVELL_CTRL,
			MARVELL_CTRL_RXDELAY | MARVELL_CTRL_TXDELAY);
1099

1100 1101 1102
	if (data->ledmode) {
		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL);
1103
		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (1) = 0x%04x\n", reg);
1104

1105 1106 1107 1108
		reg &= 0xf8ff;
		reg |= (1 + 0x0100);
		asix_mdio_write(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL, reg);
1109

1110 1111
		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL);
1112
		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (2) = 0x%04x\n", reg);
1113 1114
		reg &= 0xfc0f;
	}
1115

1116 1117 1118 1119 1120 1121 1122
	return 0;
}

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

1123
	netdev_dbg(dev->net, "marvell_led_status() read 0x%04x\n", reg);
1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136

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

1139
	netdev_dbg(dev->net, "marvell_led_status() writing 0x%04x\n", reg);
1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150
	asix_mdio_write(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL, reg);

	return 0;
}

static int ax88178_link_reset(struct usbnet *dev)
{
	u16 mode;
	struct ethtool_cmd ecmd;
	struct asix_data *data = (struct asix_data *)&dev->data;

1151
	netdev_dbg(dev->net, "ax88178_link_reset()\n");
1152 1153 1154 1155 1156 1157

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

	if (ecmd.speed == SPEED_1000)
1158
		mode |= AX_MEDIUM_GM;
1159 1160 1161 1162 1163
	else if (ecmd.speed == SPEED_100)
		mode |= AX_MEDIUM_PS;
	else
		mode &= ~(AX_MEDIUM_PS | AX_MEDIUM_GM);

1164 1165
	mode |= AX_MEDIUM_ENCK;

1166 1167 1168 1169 1170
	if (ecmd.duplex == DUPLEX_FULL)
		mode |= AX_MEDIUM_FD;
	else
		mode &= ~AX_MEDIUM_FD;

1171 1172
	netdev_dbg(dev->net, "ax88178_link_reset() speed: %d duplex: %d setting mode to 0x%04x\n",
		   ecmd.speed, ecmd.duplex, mode);
1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200

	asix_write_medium_mode(dev, mode);

	if (data->phymode == PHY_MODE_MARVELL && data->ledmode)
		marvell_led_status(dev, ecmd.speed);

	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;
1201
	}
1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214

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

1217
static int ax88178_change_mtu(struct net_device *net, int new_mtu)
1218
{
1219 1220
	struct usbnet *dev = netdev_priv(net);
	int ll_mtu = new_mtu + net->hard_header_len + 4;
1221

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

1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236
	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;
}

1237 1238 1239 1240 1241
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,
1242
	.ndo_set_mac_address 	= asix_set_mac_address,
1243 1244 1245 1246 1247 1248
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_set_multicast_list = asix_set_multicast,
	.ndo_do_ioctl 		= asix_ioctl,
	.ndo_change_mtu 	= ax88178_change_mtu,
};

1249 1250 1251 1252
static int ax88178_bind(struct usbnet *dev, struct usb_interface *intf)
{
	struct asix_data *data = (struct asix_data *)&dev->data;
	int ret;
A
Al Viro 已提交
1253 1254 1255
	u8 buf[ETH_ALEN];
	__le16 eeprom;
	u8 status;
1256 1257 1258 1259 1260
	int gpio0 = 0;
	u32 phyid;

	usbnet_get_endpoints(dev,intf);

A
Al Viro 已提交
1261 1262
	asix_read_cmd(dev, AX_CMD_READ_GPIOS, 0, 0, 1, &status);
	dbg("GPIO Status: 0x%04x", status);
1263 1264 1265 1266 1267 1268 1269

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

A
Al Viro 已提交
1270
	if (eeprom == cpu_to_le16(0xffff)) {
1271 1272 1273
		data->phymode = PHY_MODE_MARVELL;
		data->ledmode = 0;
		gpio0 = 1;
1274
	} else {
A
Al Viro 已提交
1275 1276 1277
		data->phymode = le16_to_cpu(eeprom) & 7;
		data->ledmode = le16_to_cpu(eeprom) >> 8;
		gpio0 = (le16_to_cpu(eeprom) & 0x80) ? 0 : 1;
1278
	}
1279
	dbg("GPIO0: %d, PhyMode: %d", gpio0, data->phymode);
1280

1281
	asix_write_gpio(dev, AX_GPIO_RSE | AX_GPIO_GPO_1 | AX_GPIO_GPO1EN, 40);
A
Al Viro 已提交
1282
	if ((le16_to_cpu(eeprom) >> 8) != 1) {
1283 1284 1285 1286 1287 1288 1289 1290
		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);
	}
1291

1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303
	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);

	/* 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 已提交
1304
		goto out;
1305
	}
1306
	memcpy(dev->net->dev_addr, buf, ETH_ALEN);
1307

1308 1309 1310 1311 1312 1313 1314 1315
	/* 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);
1316 1317

	dev->net->netdev_ops = &ax88178_netdev_ops;
1318
	dev->net->ethtool_ops = &ax88178_ethtool_ops;
1319

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

1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337
	if (data->phymode == PHY_MODE_MARVELL) {
		marvell_phy_init(dev);
		msleep(60);
	}

	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)
A
Al Viro 已提交
1338
		goto out;
1339 1340

	if ((ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL)) < 0)
A
Al Viro 已提交
1341
		goto out;
1342 1343 1344 1345 1346 1347 1348

	/* 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;
	}
1349
	return 0;
1350

A
Al Viro 已提交
1351
out:
1352
	return ret;
1353 1354 1355 1356
}

static const struct driver_info ax8817x_info = {
	.description = "ASIX AX8817x USB 2.0 Ethernet",
1357 1358
	.bind = ax88172_bind,
	.status = asix_status,
1359 1360
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1361
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1362 1363 1364 1365 1366
	.data = 0x00130103,
};

static const struct driver_info dlink_dub_e100_info = {
	.description = "DLink DUB-E100 USB Ethernet",
1367 1368
	.bind = ax88172_bind,
	.status = asix_status,
1369 1370
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1371
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1372 1373 1374 1375 1376
	.data = 0x009f9d9f,
};

static const struct driver_info netgear_fa120_info = {
	.description = "Netgear FA-120 USB Ethernet",
1377 1378
	.bind = ax88172_bind,
	.status = asix_status,
1379 1380
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1381
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1382 1383 1384 1385 1386
	.data = 0x00130103,
};

static const struct driver_info hawking_uf200_info = {
	.description = "Hawking UF200 USB Ethernet",
1387 1388
	.bind = ax88172_bind,
	.status = asix_status,
1389 1390
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
1391
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1392 1393 1394 1395 1396 1397
	.data = 0x001f1d1f,
};

static const struct driver_info ax88772_info = {
	.description = "ASIX AX88772 USB 2.0 Ethernet",
	.bind = ax88772_bind,
1398
	.status = asix_status,
1399 1400
	.link_reset = ax88772_link_reset,
	.reset = ax88772_link_reset,
1401
	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR,
1402 1403 1404 1405 1406 1407 1408 1409 1410 1411
	.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,
	.reset = ax88178_link_reset,
1412
	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR,
1413 1414
	.rx_fixup = asix_rx_fixup,
	.tx_fixup = asix_tx_fixup,
1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438
};

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 已提交
1439 1440 1441
	// Billionton Systems, USB2AR
	USB_DEVICE (0x08dd, 0x90ff),
	.driver_info =  (unsigned long) &ax8817x_info,
1442 1443 1444 1445 1446 1447 1448 1449
}, {
	// 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,
1450 1451 1452 1453
}, {
	// Buffalo LUA-U2-GT 10/100/1000
	USB_DEVICE (0x0411, 0x006e),
	.driver_info =  (unsigned long) &ax88178_info,
1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469
}, {
	// 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 已提交
1470 1471 1472 1473
}, {
	// JVC MP-PRX1 Port Replicator
	USB_DEVICE (0x04f1, 0x3008),
	.driver_info = (unsigned long) &ax8817x_info,
1474 1475
}, {
	// ASIX AX88772 10/100
D
David Hollis 已提交
1476 1477
	USB_DEVICE (0x0b95, 0x7720),
	.driver_info = (unsigned long) &ax88772_info,
1478 1479 1480
}, {
	// ASIX AX88178 10/100/1000
	USB_DEVICE (0x0b95, 0x1780),
1481
	.driver_info = (unsigned long) &ax88178_info,
1482 1483 1484 1485
}, {
	// Linksys USB200M Rev 2
	USB_DEVICE (0x13b1, 0x0018),
	.driver_info = (unsigned long) &ax88772_info,
1486 1487 1488 1489
}, {
	// 0Q0 cable ethernet
	USB_DEVICE (0x1557, 0x7720),
	.driver_info = (unsigned long) &ax88772_info,
1490 1491 1492 1493
}, {
	// DLink DUB-E100 H/W Ver B1
	USB_DEVICE (0x07d1, 0x3c05),
	.driver_info = (unsigned long) &ax88772_info,
1494 1495 1496 1497
}, {
	// DLink DUB-E100 H/W Ver B1 Alternate
	USB_DEVICE (0x2001, 0x3c05),
	.driver_info = (unsigned long) &ax88772_info,
1498 1499 1500 1501
}, {
	// Linksys USB1000
	USB_DEVICE (0x1737, 0x0039),
	.driver_info = (unsigned long) &ax88178_info,
1502 1503 1504 1505
}, {
	// IO-DATA ETG-US2
	USB_DEVICE (0x04bb, 0x0930),
	.driver_info = (unsigned long) &ax88178_info,
D
David Hollis 已提交
1506 1507 1508 1509
}, {
	// Belkin F5D5055
	USB_DEVICE(0x050d, 0x5055),
	.driver_info = (unsigned long) &ax88178_info,
1510 1511 1512 1513
}, {
	// Apple USB Ethernet Adapter
	USB_DEVICE(0x05ac, 0x1402),
	.driver_info = (unsigned long) &ax88772_info,
1514 1515 1516 1517
}, {
	// Cables-to-Go USB Ethernet Adapter
	USB_DEVICE(0x0b95, 0x772a),
	.driver_info = (unsigned long) &ax88772_info,
G
Greg Kroah-Hartman 已提交
1518 1519 1520 1521 1522 1523 1524 1525
}, {
	// 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,
1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537
},
	{ },		// 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,
1538
	.supports_autosuspend = 1,
1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556
};

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");
MODULE_DESCRIPTION("ASIX AX8817X based USB 2.0 Ethernet Devices");
MODULE_LICENSE("GPL");