asix_devices.c 27.8 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
 * 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
 */

C
Christian Riesch 已提交
23
#include "asix.h"
24 25 26 27 28 29 30 31 32 33 34 35

#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
36

37
#define	PHY_MODE_RTL8211CL	0x000C
38

39
struct ax88172_int_data {
A
Al Viro 已提交
40
	__le16 res1;
41
	u8 link;
A
Al Viro 已提交
42
	__le16 res2;
43
	u8 status;
A
Al Viro 已提交
44
	__le16 res3;
45
} __packed;
46

47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62
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);
63
		netdev_dbg(dev->net, "Link Status is: %d\n", link);
64 65 66
	}
}

67 68 69 70 71 72 73 74 75 76
static void asix_set_netdev_dev_addr(struct usbnet *dev, u8 *addr)
{
	if (is_valid_ether_addr(addr)) {
		memcpy(dev->net->dev_addr, addr, ETH_ALEN);
	} else {
		netdev_info(dev->net, "invalid hw address, using random\n");
		eth_hw_addr_random(dev->net);
	}
}

77 78
/* Get the PHY Identifier from the PHYSID1 & PHYSID2 MII registers */
static u32 asix_get_phyid(struct usbnet *dev)
79
{
80 81
	int phy_reg;
	u32 phy_id;
82
	int i;
83

84 85 86 87 88 89 90 91 92
	/* Poll for the rare case the FW or phy isn't ready yet.  */
	for (i = 0; i < 100; i++) {
		phy_reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_PHYSID1);
		if (phy_reg != 0 && phy_reg != 0xFFFF)
			break;
		mdelay(1);
	}

	if (phy_reg <= 0 || phy_reg == 0xFFFF)
93
		return 0;
94

95
	phy_id = (phy_reg & 0xffff) << 16;
96

97 98 99 100 101 102 103
	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;
104 105
}

106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122
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);
}

/* 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. */
123
static const struct ethtool_ops ax88172_ethtool_ops = {
124 125 126
	.get_drvinfo		= asix_get_drvinfo,
	.get_link		= asix_get_link,
	.get_msglevel		= usbnet_get_msglevel,
127
	.set_msglevel		= usbnet_set_msglevel,
128 129 130 131
	.get_wol		= asix_get_wol,
	.set_wol		= asix_set_wol,
	.get_eeprom_len		= asix_get_eeprom_len,
	.get_eeprom		= asix_get_eeprom,
132
	.set_eeprom		= asix_set_eeprom,
133 134 135
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
136 137
};

138
static void ax88172_set_multicast(struct net_device *net)
139 140
{
	struct usbnet *dev = netdev_priv(net);
141 142
	struct asix_data *data = (struct asix_data *)&dev->data;
	u8 rx_ctl = 0x8c;
143

144 145
	if (net->flags & IFF_PROMISC) {
		rx_ctl |= 0x01;
146
	} else if (net->flags & IFF_ALLMULTI ||
147
		   netdev_mc_count(net) > AX_MAX_MCAST) {
148
		rx_ctl |= 0x02;
149
	} else if (netdev_mc_empty(net)) {
150 151 152 153 154 155
		/* 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 */
156
		struct netdev_hw_addr *ha;
157 158 159 160 161
		u32 crc_bits;

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

		/* Build the multicast hash filter. */
162 163
		netdev_for_each_mc_addr(ha, net) {
			crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179
			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;
180
	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
181 182 183 184 185 186 187 188

	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;

189 190
	netdev_dbg(dev->net, "ax88172_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
		   ethtool_cmd_speed(&ecmd), ecmd.duplex, mode);
191 192 193 194

	asix_write_medium_mode(dev, mode);

	return 0;
195 196
}

197 198 199 200 201 202 203 204 205
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,
206
	.ndo_set_rx_mode	= ax88172_set_multicast,
207 208
};

209
static int ax88172_bind(struct usbnet *dev, struct usb_interface *intf)
210 211
{
	int ret = 0;
A
Al Viro 已提交
212
	u8 buf[ETH_ALEN];
213 214 215 216 217 218 219
	int i;
	unsigned long gpio_bits = dev->driver_info->data;

	usbnet_get_endpoints(dev,intf);

	/* Toggle the GPIOs in a manufacturer/model specific way */
	for (i = 2; i >= 0; i--) {
220 221 222
		ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS,
				(gpio_bits >> (i * 8)) & 0xff, 0, 0, NULL);
		if (ret < 0)
A
Al Viro 已提交
223
			goto out;
224 225 226
		msleep(5);
	}

227 228
	ret = asix_write_rx_ctl(dev, 0x80);
	if (ret < 0)
A
Al Viro 已提交
229
		goto out;
230 231

	/* Get the MAC address */
232 233
	ret = asix_read_cmd(dev, AX88172_CMD_READ_NODE_ID, 0, 0, ETH_ALEN, buf);
	if (ret < 0) {
234 235
		netdev_dbg(dev->net, "read AX_CMD_READ_NODE_ID failed: %d\n",
			   ret);
A
Al Viro 已提交
236
		goto out;
237
	}
238 239

	asix_set_netdev_dev_addr(dev, buf);
240 241 242

	/* Initialize MII structure */
	dev->mii.dev = dev->net;
243 244
	dev->mii.mdio_read = asix_mdio_read;
	dev->mii.mdio_write = asix_mdio_write;
245 246
	dev->mii.phy_id_mask = 0x3f;
	dev->mii.reg_num_mask = 0x1f;
247
	dev->mii.phy_id = asix_get_phy_addr(dev);
248

249
	dev->net->netdev_ops = &ax88172_netdev_ops;
250
	dev->net->ethtool_ops = &ax88172_ethtool_ops;
E
Eric Dumazet 已提交
251 252
	dev->net->needed_headroom = 4; /* cf asix_tx_fixup() */
	dev->net->needed_tailroom = 4; /* cf asix_tx_fixup() */
253

254 255
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
256 257 258 259
		ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
	mii_nway_restart(&dev->mii);

	return 0;
A
Al Viro 已提交
260 261

out:
262 263 264
	return ret;
}

265
static const struct ethtool_ops ax88772_ethtool_ops = {
266
	.get_drvinfo		= asix_get_drvinfo,
267
	.get_link		= asix_get_link,
268 269
	.get_msglevel		= usbnet_get_msglevel,
	.set_msglevel		= usbnet_set_msglevel,
270 271 272 273
	.get_wol		= asix_get_wol,
	.set_wol		= asix_set_wol,
	.get_eeprom_len		= asix_get_eeprom_len,
	.get_eeprom		= asix_get_eeprom,
274
	.set_eeprom		= asix_set_eeprom,
275 276 277
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
278 279
};

280 281 282
static int ax88772_link_reset(struct usbnet *dev)
{
	u16 mode;
283
	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
284 285 286 287 288

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

289
	if (ethtool_cmd_speed(&ecmd) != SPEED_100)
290 291 292 293 294
		mode &= ~AX_MEDIUM_PS;

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

295 296
	netdev_dbg(dev->net, "ax88772_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
		   ethtool_cmd_speed(&ecmd), ecmd.duplex, mode);
297 298 299 300 301 302

	asix_write_medium_mode(dev, mode);

	return 0;
}

303
static int ax88772_reset(struct usbnet *dev)
304
{
305
	struct asix_data *data = (struct asix_data *)&dev->data;
306
	int ret, embd_phy;
307
	u16 rx_ctl;
308

309 310 311
	ret = asix_write_gpio(dev,
			AX_GPIO_RSE | AX_GPIO_GPO_2 | AX_GPIO_GPO2EN, 5);
	if (ret < 0)
A
Al Viro 已提交
312
		goto out;
313

314
	embd_phy = ((asix_get_phy_addr(dev) & 0x1f) == 0x10 ? 1 : 0);
315

316 317
	ret = asix_write_cmd(dev, AX_CMD_SW_PHY_SELECT, embd_phy, 0, 0, NULL);
	if (ret < 0) {
318
		netdev_dbg(dev->net, "Select PHY #1 failed: %d\n", ret);
A
Al Viro 已提交
319
		goto out;
320 321
	}

322 323
	ret = asix_sw_reset(dev, AX_SWRESET_IPPD | AX_SWRESET_PRL);
	if (ret < 0)
A
Al Viro 已提交
324
		goto out;
325 326

	msleep(150);
327 328 329

	ret = asix_sw_reset(dev, AX_SWRESET_CLEAR);
	if (ret < 0)
A
Al Viro 已提交
330
		goto out;
331 332

	msleep(150);
333

334
	if (embd_phy) {
335 336
		ret = asix_sw_reset(dev, AX_SWRESET_IPRL);
		if (ret < 0)
A
Al Viro 已提交
337
			goto out;
338 339 340
	} else {
		ret = asix_sw_reset(dev, AX_SWRESET_PRTE);
		if (ret < 0)
A
Al Viro 已提交
341
			goto out;
342
	}
343 344

	msleep(150);
345
	rx_ctl = asix_read_rx_ctl(dev);
346
	netdev_dbg(dev->net, "RX_CTL is 0x%04x after software reset\n", rx_ctl);
347 348
	ret = asix_write_rx_ctl(dev, 0x0000);
	if (ret < 0)
A
Al Viro 已提交
349
		goto out;
350

351
	rx_ctl = asix_read_rx_ctl(dev);
352
	netdev_dbg(dev->net, "RX_CTL is 0x%04x setting to 0x0000\n", rx_ctl);
353

354 355
	ret = asix_sw_reset(dev, AX_SWRESET_PRL);
	if (ret < 0)
A
Al Viro 已提交
356
		goto out;
357 358

	msleep(150);
359

360 361
	ret = asix_sw_reset(dev, AX_SWRESET_IPRL | AX_SWRESET_PRL);
	if (ret < 0)
A
Al Viro 已提交
362
		goto out;
363

364
	msleep(150);
365

366 367
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
368 369 370
			ADVERTISE_ALL | ADVERTISE_CSMA);
	mii_nway_restart(&dev->mii);

371 372
	ret = asix_write_medium_mode(dev, AX88772_MEDIUM_DEFAULT);
	if (ret < 0)
A
Al Viro 已提交
373
		goto out;
374

375
	ret = asix_write_cmd(dev, AX_CMD_WRITE_IPG0,
376
				AX88772_IPG0_DEFAULT | AX88772_IPG1_DEFAULT,
377 378
				AX88772_IPG2_DEFAULT, 0, NULL);
	if (ret < 0) {
379
		netdev_dbg(dev->net, "Write IPG,IPG1,IPG2 failed: %d\n", ret);
A
Al Viro 已提交
380
		goto out;
381 382
	}

383 384 385 386 387 388 389
	/* Rewrite MAC address */
	memcpy(data->mac_addr, dev->net->dev_addr, ETH_ALEN);
	ret = asix_write_cmd(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN,
							data->mac_addr);
	if (ret < 0)
		goto out;

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

395
	rx_ctl = asix_read_rx_ctl(dev);
396 397
	netdev_dbg(dev->net, "RX_CTL is 0x%04x after all initializations\n",
		   rx_ctl);
398 399

	rx_ctl = asix_read_medium_status(dev);
400 401 402
	netdev_dbg(dev->net,
		   "Medium Status is 0x%04x after all initializations\n",
		   rx_ctl);
403

404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424
	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)
{
425
	int ret, embd_phy, i;
426 427 428 429 430 431
	u8 buf[ETH_ALEN];
	u32 phyid;

	usbnet_get_endpoints(dev,intf);

	/* Get the MAC address */
432 433 434 435 436 437 438 439 440 441 442 443
	if (dev->driver_info->data & FLAG_EEPROM_MAC) {
		for (i = 0; i < (ETH_ALEN >> 1); i++) {
			ret = asix_read_cmd(dev, AX_CMD_READ_EEPROM, 0x04 + i,
					0, 2, buf + i * 2);
			if (ret < 0)
				break;
		}
	} else {
		ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID,
				0, 0, ETH_ALEN, buf);
	}

444
	if (ret < 0) {
445
		netdev_dbg(dev->net, "Failed to read MAC address: %d\n", ret);
446
		return ret;
447
	}
448 449

	asix_set_netdev_dev_addr(dev, buf);
450 451 452 453 454 455 456 457 458 459 460

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

	dev->net->netdev_ops = &ax88772_netdev_ops;
	dev->net->ethtool_ops = &ax88772_ethtool_ops;
E
Eric Dumazet 已提交
461 462
	dev->net->needed_headroom = 4; /* cf asix_tx_fixup() */
	dev->net->needed_tailroom = 4; /* cf asix_tx_fixup() */
463

464 465 466 467 468
	embd_phy = ((dev->mii.phy_id & 0x1f) == 0x10 ? 1 : 0);

	/* Reset the PHY to normal operation mode */
	ret = asix_write_cmd(dev, AX_CMD_SW_PHY_SELECT, embd_phy, 0, 0, NULL);
	if (ret < 0) {
469
		netdev_dbg(dev->net, "Select PHY #1 failed: %d\n", ret);
470 471 472 473
		return ret;
	}

	ret = asix_sw_reset(dev, AX_SWRESET_IPPD | AX_SWRESET_PRL);
474 475
	if (ret < 0)
		return ret;
476

477 478 479 480 481 482 483 484 485 486 487 488
	msleep(150);

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

	msleep(150);

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

	/* Read PHYID register *AFTER* the PHY was reset properly */
	phyid = asix_get_phyid(dev);
489
	netdev_dbg(dev->net, "PHYID=0x%08x\n", phyid);
490

491 492 493 494 495 496
	/* 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;
	}
497

498 499 500
	return 0;
}

501
static const struct ethtool_ops ax88178_ethtool_ops = {
502 503 504 505 506 507 508 509
	.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,
510
	.set_eeprom		= asix_set_eeprom,
511 512 513
	.get_settings		= usbnet_get_settings,
	.set_settings		= usbnet_set_settings,
	.nway_reset		= usbnet_nway_reset,
514 515 516
};

static int marvell_phy_init(struct usbnet *dev)
517
{
518 519
	struct asix_data *data = (struct asix_data *)&dev->data;
	u16 reg;
520

521
	netdev_dbg(dev->net, "marvell_phy_init()\n");
522

523
	reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_MARVELL_STATUS);
524
	netdev_dbg(dev->net, "MII_MARVELL_STATUS = 0x%04x\n", reg);
525

526 527
	asix_mdio_write(dev->net, dev->mii.phy_id, MII_MARVELL_CTRL,
			MARVELL_CTRL_RXDELAY | MARVELL_CTRL_TXDELAY);
528

529 530 531
	if (data->ledmode) {
		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL);
532
		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (1) = 0x%04x\n", reg);
533

534 535 536 537
		reg &= 0xf8ff;
		reg |= (1 + 0x0100);
		asix_mdio_write(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL, reg);
538

539 540
		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
			MII_MARVELL_LED_CTRL);
541
		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (2) = 0x%04x\n", reg);
542 543
		reg &= 0xfc0f;
	}
544

545 546 547
	return 0;
}

548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568
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;
}

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

573
	netdev_dbg(dev->net, "marvell_led_status() read 0x%04x\n", reg);
574 575 576 577 578 579 580 581 582 583 584 585 586

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

589
	netdev_dbg(dev->net, "marvell_led_status() writing 0x%04x\n", reg);
590 591 592 593 594
	asix_mdio_write(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL, reg);

	return 0;
}

595 596 597 598 599 600 601
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;
602
	u32 phyid;
603 604

	asix_read_cmd(dev, AX_CMD_READ_GPIOS, 0, 0, 1, &status);
605
	netdev_dbg(dev->net, "GPIO Status: 0x%04x\n", status);
606 607 608 609 610

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

611
	netdev_dbg(dev->net, "EEPROM index 0x17 is 0x%04x\n", eeprom);
612 613 614 615 616 617

	if (eeprom == cpu_to_le16(0xffff)) {
		data->phymode = PHY_MODE_MARVELL;
		data->ledmode = 0;
		gpio0 = 1;
	} else {
618
		data->phymode = le16_to_cpu(eeprom) & 0x7F;
619 620 621
		data->ledmode = le16_to_cpu(eeprom) >> 8;
		gpio0 = (le16_to_cpu(eeprom) & 0x80) ? 0 : 1;
	}
622
	netdev_dbg(dev->net, "GPIO0: %d, PhyMode: %d\n", gpio0, data->phymode);
623

624
	/* Power up external GigaPHY through AX88178 GPIO pin */
625 626 627 628 629 630
	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 {
631
		netdev_dbg(dev->net, "gpio phymode == 1 path\n");
632 633 634 635
		asix_write_gpio(dev, AX_GPIO_GPO1EN, 30);
		asix_write_gpio(dev, AX_GPIO_GPO1EN | AX_GPIO_GPO_1, 30);
	}

636 637
	/* Read PHYID register *AFTER* powering up PHY */
	phyid = asix_get_phyid(dev);
638
	netdev_dbg(dev->net, "PHYID=0x%08x\n", phyid);
639 640 641 642

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

643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665
	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);

666 667 668
	ret = asix_write_medium_mode(dev, AX88178_MEDIUM_DEFAULT);
	if (ret < 0)
		return ret;
669

670 671 672 673 674 675 676
	/* Rewrite MAC address */
	memcpy(data->mac_addr, dev->net->dev_addr, ETH_ALEN);
	ret = asix_write_cmd(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN,
							data->mac_addr);
	if (ret < 0)
		return ret;

677 678 679
	ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL);
	if (ret < 0)
		return ret;
680 681 682 683

	return 0;
}

684 685 686
static int ax88178_link_reset(struct usbnet *dev)
{
	u16 mode;
687
	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
688
	struct asix_data *data = (struct asix_data *)&dev->data;
689
	u32 speed;
690

691
	netdev_dbg(dev->net, "ax88178_link_reset()\n");
692 693 694 695

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

698
	if (speed == SPEED_1000)
699
		mode |= AX_MEDIUM_GM;
700
	else if (speed == SPEED_100)
701 702 703 704
		mode |= AX_MEDIUM_PS;
	else
		mode &= ~(AX_MEDIUM_PS | AX_MEDIUM_GM);

705 706
	mode |= AX_MEDIUM_ENCK;

707 708 709 710 711
	if (ecmd.duplex == DUPLEX_FULL)
		mode |= AX_MEDIUM_FD;
	else
		mode &= ~AX_MEDIUM_FD;

712 713
	netdev_dbg(dev->net, "ax88178_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
		   speed, ecmd.duplex, mode);
714 715 716 717

	asix_write_medium_mode(dev, mode);

	if (data->phymode == PHY_MODE_MARVELL && data->ledmode)
718
		marvell_led_status(dev, speed);
719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741

	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;
742
	}
743 744 745 746 747 748 749 750 751 752 753 754 755

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

758
static int ax88178_change_mtu(struct net_device *net, int new_mtu)
759
{
760 761
	struct usbnet *dev = netdev_priv(net);
	int ll_mtu = new_mtu + net->hard_header_len + 4;
762

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

765 766 767 768 769 770 771 772 773 774 775 776 777
	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;
}

778 779 780 781 782
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,
783
	.ndo_set_mac_address 	= asix_set_mac_address,
784
	.ndo_validate_addr	= eth_validate_addr,
785
	.ndo_set_rx_mode	= asix_set_multicast,
786 787 788 789
	.ndo_do_ioctl 		= asix_ioctl,
	.ndo_change_mtu 	= ax88178_change_mtu,
};

790 791 792
static int ax88178_bind(struct usbnet *dev, struct usb_interface *intf)
{
	int ret;
A
Al Viro 已提交
793
	u8 buf[ETH_ALEN];
794 795 796 797

	usbnet_get_endpoints(dev,intf);

	/* Get the MAC address */
798 799
	ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID, 0, 0, ETH_ALEN, buf);
	if (ret < 0) {
800
		netdev_dbg(dev->net, "Failed to read MAC address: %d\n", ret);
801
		return ret;
802
	}
803 804

	asix_set_netdev_dev_addr(dev, buf);
805

806 807 808 809 810 811 812 813
	/* 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);
814 815

	dev->net->netdev_ops = &ax88178_netdev_ops;
816
	dev->net->ethtool_ops = &ax88178_ethtool_ops;
817

818 819 820
	/* Blink LEDS so users know driver saw dongle */
	asix_sw_reset(dev, 0);
	msleep(150);
821

822 823
	asix_sw_reset(dev, AX_SWRESET_PRL | AX_SWRESET_IPPD);
	msleep(150);
824 825 826 827 828 829 830 831

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

832
	return 0;
833 834 835 836
}

static const struct driver_info ax8817x_info = {
	.description = "ASIX AX8817x USB 2.0 Ethernet",
837 838
	.bind = ax88172_bind,
	.status = asix_status,
839 840
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
841
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
842 843 844 845 846
	.data = 0x00130103,
};

static const struct driver_info dlink_dub_e100_info = {
	.description = "DLink DUB-E100 USB Ethernet",
847 848
	.bind = ax88172_bind,
	.status = asix_status,
849 850
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
851
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
852 853 854 855 856
	.data = 0x009f9d9f,
};

static const struct driver_info netgear_fa120_info = {
	.description = "Netgear FA-120 USB Ethernet",
857 858
	.bind = ax88172_bind,
	.status = asix_status,
859 860
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
861
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
862 863 864 865 866
	.data = 0x00130103,
};

static const struct driver_info hawking_uf200_info = {
	.description = "Hawking UF200 USB Ethernet",
867 868
	.bind = ax88172_bind,
	.status = asix_status,
869 870
	.link_reset = ax88172_link_reset,
	.reset = ax88172_link_reset,
871
	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
872 873 874 875 876 877
	.data = 0x001f1d1f,
};

static const struct driver_info ax88772_info = {
	.description = "ASIX AX88772 USB 2.0 Ethernet",
	.bind = ax88772_bind,
878
	.status = asix_status,
879
	.link_reset = ax88772_link_reset,
880
	.reset = ax88772_reset,
881
	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR | FLAG_MULTI_PACKET,
882 883 884 885
	.rx_fixup = asix_rx_fixup,
	.tx_fixup = asix_tx_fixup,
};

886 887 888 889 890 891 892 893 894 895 896 897 898
static const struct driver_info ax88772b_info = {
	.description = "ASIX AX88772B USB 2.0 Ethernet",
	.bind = ax88772_bind,
	.status = asix_status,
	.link_reset = ax88772_link_reset,
	.reset = ax88772_reset,
	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR |
	         FLAG_MULTI_PACKET,
	.rx_fixup = asix_rx_fixup,
	.tx_fixup = asix_tx_fixup,
	.data = FLAG_EEPROM_MAC,
};

899 900 901 902 903
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,
904
	.reset = ax88178_reset,
905
	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR,
906 907
	.rx_fixup = asix_rx_fixup,
	.tx_fixup = asix_tx_fixup,
908 909
};

910 911
extern const struct driver_info ax88172a_info;

912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933
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 已提交
934 935 936
	// Billionton Systems, USB2AR
	USB_DEVICE (0x08dd, 0x90ff),
	.driver_info =  (unsigned long) &ax8817x_info,
937 938 939 940 941 942 943 944
}, {
	// 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,
945 946 947 948
}, {
	// Buffalo LUA-U2-GT 10/100/1000
	USB_DEVICE (0x0411, 0x006e),
	.driver_info =  (unsigned long) &ax88178_info,
949 950 951 952
}, {
	// Sitecom LN-029 "USB 2.0 10/100 Ethernet adapter"
	USB_DEVICE (0x6189, 0x182d),
	.driver_info =  (unsigned long) &ax8817x_info,
953 954 955 956
}, {
	// Sitecom LN-031 "USB 2.0 10/100/1000 Ethernet adapter"
	USB_DEVICE (0x0df6, 0x0056),
	.driver_info =  (unsigned long) &ax88178_info,
957 958 959 960 961 962 963 964 965 966 967 968
}, {
	// 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 已提交
969 970 971 972
}, {
	// JVC MP-PRX1 Port Replicator
	USB_DEVICE (0x04f1, 0x3008),
	.driver_info = (unsigned long) &ax8817x_info,
973 974 975 976
}, {
	// Lenovo U2L100P 10/100
	USB_DEVICE (0x17ef, 0x7203),
	.driver_info = (unsigned long) &ax88772_info,
M
Marek Vasut 已提交
977 978 979
}, {
	// ASIX AX88772B 10/100
	USB_DEVICE (0x0b95, 0x772b),
980
	.driver_info = (unsigned long) &ax88772b_info,
981 982
}, {
	// ASIX AX88772 10/100
D
David Hollis 已提交
983 984
	USB_DEVICE (0x0b95, 0x7720),
	.driver_info = (unsigned long) &ax88772_info,
985 986 987
}, {
	// ASIX AX88178 10/100/1000
	USB_DEVICE (0x0b95, 0x1780),
988
	.driver_info = (unsigned long) &ax88178_info,
989 990 991 992
}, {
	// Logitec LAN-GTJ/U2A
	USB_DEVICE (0x0789, 0x0160),
	.driver_info = (unsigned long) &ax88178_info,
993 994 995 996
}, {
	// Linksys USB200M Rev 2
	USB_DEVICE (0x13b1, 0x0018),
	.driver_info = (unsigned long) &ax88772_info,
997 998 999 1000
}, {
	// 0Q0 cable ethernet
	USB_DEVICE (0x1557, 0x7720),
	.driver_info = (unsigned long) &ax88772_info,
1001 1002 1003 1004
}, {
	// DLink DUB-E100 H/W Ver B1
	USB_DEVICE (0x07d1, 0x3c05),
	.driver_info = (unsigned long) &ax88772_info,
1005 1006 1007 1008
}, {
	// DLink DUB-E100 H/W Ver B1 Alternate
	USB_DEVICE (0x2001, 0x3c05),
	.driver_info = (unsigned long) &ax88772_info,
1009 1010 1011 1012
}, {
       // DLink DUB-E100 H/W Ver C1
       USB_DEVICE (0x2001, 0x1a02),
       .driver_info = (unsigned long) &ax88772_info,
1013 1014 1015 1016
}, {
	// Linksys USB1000
	USB_DEVICE (0x1737, 0x0039),
	.driver_info = (unsigned long) &ax88178_info,
1017 1018 1019 1020
}, {
	// IO-DATA ETG-US2
	USB_DEVICE (0x04bb, 0x0930),
	.driver_info = (unsigned long) &ax88178_info,
D
David Hollis 已提交
1021 1022 1023 1024
}, {
	// Belkin F5D5055
	USB_DEVICE(0x050d, 0x5055),
	.driver_info = (unsigned long) &ax88178_info,
1025 1026 1027 1028
}, {
	// Apple USB Ethernet Adapter
	USB_DEVICE(0x05ac, 0x1402),
	.driver_info = (unsigned long) &ax88772_info,
1029 1030 1031 1032
}, {
	// Cables-to-Go USB Ethernet Adapter
	USB_DEVICE(0x0b95, 0x772a),
	.driver_info = (unsigned long) &ax88772_info,
G
Greg Kroah-Hartman 已提交
1033 1034 1035 1036 1037 1038 1039 1040
}, {
	// ABOCOM for pci
	USB_DEVICE(0x14ea, 0xab11),
	.driver_info = (unsigned long) &ax88178_info,
}, {
	// ASIX 88772a
	USB_DEVICE(0x0db0, 0xa877),
	.driver_info = (unsigned long) &ax88772_info,
A
Aurelien Jacobs 已提交
1041 1042 1043 1044
}, {
	// Asus USB Ethernet Adapter
	USB_DEVICE (0x0b95, 0x7e2b),
	.driver_info = (unsigned long) &ax88772_info,
1045 1046 1047 1048
}, {
	/* ASIX 88172a demo board */
	USB_DEVICE(0x0b95, 0x172a),
	.driver_info = (unsigned long) &ax88172a_info,
1049 1050 1051 1052 1053 1054
},
	{ },		// END
};
MODULE_DEVICE_TABLE(usb, products);

static struct usb_driver asix_driver = {
1055
	.name =		DRIVER_NAME,
1056 1057 1058 1059 1060
	.id_table =	products,
	.probe =	usbnet_probe,
	.suspend =	usbnet_suspend,
	.resume =	usbnet_resume,
	.disconnect =	usbnet_disconnect,
1061
	.supports_autosuspend = 1,
1062
	.disable_hub_initiated_lpm = 1,
1063 1064
};

1065
module_usb_driver(asix_driver);
1066 1067

MODULE_AUTHOR("David Hollis");
1068
MODULE_VERSION(DRIVER_VERSION);
1069 1070 1071
MODULE_DESCRIPTION("ASIX AX8817X based USB 2.0 Ethernet Devices");
MODULE_LICENSE("GPL");