xref: /openbmc/linux/drivers/net/usb/asix_devices.c (revision 8eac0095)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * ASIX AX8817X based USB 2.0 Ethernet Devices
4  * Copyright (C) 2003-2006 David Hollis <dhollis@davehollis.com>
5  * Copyright (C) 2005 Phil Chang <pchang23@sbcglobal.net>
6  * Copyright (C) 2006 James Painter <jamie.painter@iname.com>
7  * Copyright (c) 2002-2003 TiVo Inc.
8  */
9 
10 #include "asix.h"
11 
12 #define PHY_MODE_MARVELL	0x0000
13 #define MII_MARVELL_LED_CTRL	0x0018
14 #define MII_MARVELL_STATUS	0x001b
15 #define MII_MARVELL_CTRL	0x0014
16 
17 #define MARVELL_LED_MANUAL	0x0019
18 
19 #define MARVELL_STATUS_HWCFG	0x0004
20 
21 #define MARVELL_CTRL_TXDELAY	0x0002
22 #define MARVELL_CTRL_RXDELAY	0x0080
23 
24 #define	PHY_MODE_RTL8211CL	0x000C
25 
26 #define AX88772A_PHY14H		0x14
27 #define AX88772A_PHY14H_DEFAULT 0x442C
28 
29 #define AX88772A_PHY15H		0x15
30 #define AX88772A_PHY15H_DEFAULT 0x03C8
31 
32 #define AX88772A_PHY16H		0x16
33 #define AX88772A_PHY16H_DEFAULT 0x4044
34 
35 struct ax88172_int_data {
36 	__le16 res1;
37 	u8 link;
38 	__le16 res2;
39 	u8 status;
40 	__le16 res3;
41 } __packed;
42 
asix_status(struct usbnet * dev,struct urb * urb)43 static void asix_status(struct usbnet *dev, struct urb *urb)
44 {
45 	struct ax88172_int_data *event;
46 	int link;
47 
48 	if (urb->actual_length < 8)
49 		return;
50 
51 	event = urb->transfer_buffer;
52 	link = event->link & 0x01;
53 	if (netif_carrier_ok(dev->net) != link) {
54 		usbnet_link_change(dev, link, 1);
55 		netdev_dbg(dev->net, "Link Status is: %d\n", link);
56 	}
57 }
58 
asix_set_netdev_dev_addr(struct usbnet * dev,u8 * addr)59 static void asix_set_netdev_dev_addr(struct usbnet *dev, u8 *addr)
60 {
61 	if (is_valid_ether_addr(addr)) {
62 		eth_hw_addr_set(dev->net, addr);
63 	} else {
64 		netdev_info(dev->net, "invalid hw address, using random\n");
65 		eth_hw_addr_random(dev->net);
66 	}
67 }
68 
69 /* Get the PHY Identifier from the PHYSID1 & PHYSID2 MII registers */
asix_get_phyid(struct usbnet * dev)70 static u32 asix_get_phyid(struct usbnet *dev)
71 {
72 	int phy_reg;
73 	u32 phy_id;
74 	int i;
75 
76 	/* Poll for the rare case the FW or phy isn't ready yet.  */
77 	for (i = 0; i < 100; i++) {
78 		phy_reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_PHYSID1);
79 		if (phy_reg < 0)
80 			return 0;
81 		if (phy_reg != 0 && phy_reg != 0xFFFF)
82 			break;
83 		mdelay(1);
84 	}
85 
86 	if (phy_reg <= 0 || phy_reg == 0xFFFF)
87 		return 0;
88 
89 	phy_id = (phy_reg & 0xffff) << 16;
90 
91 	phy_reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_PHYSID2);
92 	if (phy_reg < 0)
93 		return 0;
94 
95 	phy_id |= (phy_reg & 0xffff);
96 
97 	return phy_id;
98 }
99 
asix_get_link(struct net_device * net)100 static u32 asix_get_link(struct net_device *net)
101 {
102 	struct usbnet *dev = netdev_priv(net);
103 
104 	return mii_link_ok(&dev->mii);
105 }
106 
asix_ioctl(struct net_device * net,struct ifreq * rq,int cmd)107 static int asix_ioctl (struct net_device *net, struct ifreq *rq, int cmd)
108 {
109 	struct usbnet *dev = netdev_priv(net);
110 
111 	return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL);
112 }
113 
114 /* We need to override some ethtool_ops so we require our
115    own structure so we don't interfere with other usbnet
116    devices that may be connected at the same time. */
117 static const struct ethtool_ops ax88172_ethtool_ops = {
118 	.get_drvinfo		= asix_get_drvinfo,
119 	.get_link		= asix_get_link,
120 	.get_msglevel		= usbnet_get_msglevel,
121 	.set_msglevel		= usbnet_set_msglevel,
122 	.get_wol		= asix_get_wol,
123 	.set_wol		= asix_set_wol,
124 	.get_eeprom_len		= asix_get_eeprom_len,
125 	.get_eeprom		= asix_get_eeprom,
126 	.set_eeprom		= asix_set_eeprom,
127 	.nway_reset		= usbnet_nway_reset,
128 	.get_link_ksettings	= usbnet_get_link_ksettings_mii,
129 	.set_link_ksettings	= usbnet_set_link_ksettings_mii,
130 };
131 
ax88172_set_multicast(struct net_device * net)132 static void ax88172_set_multicast(struct net_device *net)
133 {
134 	struct usbnet *dev = netdev_priv(net);
135 	struct asix_data *data = (struct asix_data *)&dev->data;
136 	u8 rx_ctl = 0x8c;
137 
138 	if (net->flags & IFF_PROMISC) {
139 		rx_ctl |= 0x01;
140 	} else if (net->flags & IFF_ALLMULTI ||
141 		   netdev_mc_count(net) > AX_MAX_MCAST) {
142 		rx_ctl |= 0x02;
143 	} else if (netdev_mc_empty(net)) {
144 		/* just broadcast and directed */
145 	} else {
146 		/* We use the 20 byte dev->data
147 		 * for our 8 byte filter buffer
148 		 * to avoid allocating memory that
149 		 * is tricky to free later */
150 		struct netdev_hw_addr *ha;
151 		u32 crc_bits;
152 
153 		memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE);
154 
155 		/* Build the multicast hash filter. */
156 		netdev_for_each_mc_addr(ha, net) {
157 			crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
158 			data->multi_filter[crc_bits >> 3] |=
159 			    1 << (crc_bits & 7);
160 		}
161 
162 		asix_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0,
163 				   AX_MCAST_FILTER_SIZE, data->multi_filter);
164 
165 		rx_ctl |= 0x10;
166 	}
167 
168 	asix_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL);
169 }
170 
ax88172_link_reset(struct usbnet * dev)171 static int ax88172_link_reset(struct usbnet *dev)
172 {
173 	u8 mode;
174 	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
175 
176 	mii_check_media(&dev->mii, 1, 1);
177 	mii_ethtool_gset(&dev->mii, &ecmd);
178 	mode = AX88172_MEDIUM_DEFAULT;
179 
180 	if (ecmd.duplex != DUPLEX_FULL)
181 		mode |= ~AX88172_MEDIUM_FD;
182 
183 	netdev_dbg(dev->net, "ax88172_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
184 		   ethtool_cmd_speed(&ecmd), ecmd.duplex, mode);
185 
186 	asix_write_medium_mode(dev, mode, 0);
187 
188 	return 0;
189 }
190 
191 static const struct net_device_ops ax88172_netdev_ops = {
192 	.ndo_open		= usbnet_open,
193 	.ndo_stop		= usbnet_stop,
194 	.ndo_start_xmit		= usbnet_start_xmit,
195 	.ndo_tx_timeout		= usbnet_tx_timeout,
196 	.ndo_change_mtu		= usbnet_change_mtu,
197 	.ndo_get_stats64	= dev_get_tstats64,
198 	.ndo_set_mac_address 	= eth_mac_addr,
199 	.ndo_validate_addr	= eth_validate_addr,
200 	.ndo_eth_ioctl		= asix_ioctl,
201 	.ndo_set_rx_mode	= ax88172_set_multicast,
202 };
203 
asix_phy_reset(struct usbnet * dev,unsigned int reset_bits)204 static void asix_phy_reset(struct usbnet *dev, unsigned int reset_bits)
205 {
206 	unsigned int timeout = 5000;
207 
208 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, reset_bits);
209 
210 	/* give phy_id a chance to process reset */
211 	udelay(500);
212 
213 	/* See IEEE 802.3 "22.2.4.1.1 Reset": 500ms max */
214 	while (timeout--) {
215 		if (asix_mdio_read(dev->net, dev->mii.phy_id, MII_BMCR)
216 							& BMCR_RESET)
217 			udelay(100);
218 		else
219 			return;
220 	}
221 
222 	netdev_err(dev->net, "BMCR_RESET timeout on phy_id %d\n",
223 		   dev->mii.phy_id);
224 }
225 
ax88172_bind(struct usbnet * dev,struct usb_interface * intf)226 static int ax88172_bind(struct usbnet *dev, struct usb_interface *intf)
227 {
228 	int ret = 0;
229 	u8 buf[ETH_ALEN] = {0};
230 	int i;
231 	unsigned long gpio_bits = dev->driver_info->data;
232 
233 	usbnet_get_endpoints(dev,intf);
234 
235 	/* Toggle the GPIOs in a manufacturer/model specific way */
236 	for (i = 2; i >= 0; i--) {
237 		ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS,
238 				(gpio_bits >> (i * 8)) & 0xff, 0, 0, NULL, 0);
239 		if (ret < 0)
240 			goto out;
241 		msleep(5);
242 	}
243 
244 	ret = asix_write_rx_ctl(dev, 0x80, 0);
245 	if (ret < 0)
246 		goto out;
247 
248 	/* Get the MAC address */
249 	ret = asix_read_cmd(dev, AX88172_CMD_READ_NODE_ID,
250 			    0, 0, ETH_ALEN, buf, 0);
251 	if (ret < 0) {
252 		netdev_dbg(dev->net, "read AX_CMD_READ_NODE_ID failed: %d\n",
253 			   ret);
254 		goto out;
255 	}
256 
257 	asix_set_netdev_dev_addr(dev, buf);
258 
259 	/* Initialize MII structure */
260 	dev->mii.dev = dev->net;
261 	dev->mii.mdio_read = asix_mdio_read;
262 	dev->mii.mdio_write = asix_mdio_write;
263 	dev->mii.phy_id_mask = 0x3f;
264 	dev->mii.reg_num_mask = 0x1f;
265 
266 	dev->mii.phy_id = asix_read_phy_addr(dev, true);
267 	if (dev->mii.phy_id < 0)
268 		return dev->mii.phy_id;
269 
270 	dev->net->netdev_ops = &ax88172_netdev_ops;
271 	dev->net->ethtool_ops = &ax88172_ethtool_ops;
272 	dev->net->needed_headroom = 4; /* cf asix_tx_fixup() */
273 	dev->net->needed_tailroom = 4; /* cf asix_tx_fixup() */
274 
275 	asix_phy_reset(dev, BMCR_RESET);
276 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
277 		ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
278 	mii_nway_restart(&dev->mii);
279 
280 	return 0;
281 
282 out:
283 	return ret;
284 }
285 
ax88772_ethtool_get_strings(struct net_device * netdev,u32 sset,u8 * data)286 static void ax88772_ethtool_get_strings(struct net_device *netdev, u32 sset,
287 					u8 *data)
288 {
289 	switch (sset) {
290 	case ETH_SS_TEST:
291 		net_selftest_get_strings(data);
292 		break;
293 	}
294 }
295 
ax88772_ethtool_get_sset_count(struct net_device * ndev,int sset)296 static int ax88772_ethtool_get_sset_count(struct net_device *ndev, int sset)
297 {
298 	switch (sset) {
299 	case ETH_SS_TEST:
300 		return net_selftest_get_count();
301 	default:
302 		return -EOPNOTSUPP;
303 	}
304 }
305 
ax88772_ethtool_get_pauseparam(struct net_device * ndev,struct ethtool_pauseparam * pause)306 static void ax88772_ethtool_get_pauseparam(struct net_device *ndev,
307 					  struct ethtool_pauseparam *pause)
308 {
309 	struct usbnet *dev = netdev_priv(ndev);
310 	struct asix_common_private *priv = dev->driver_priv;
311 
312 	phylink_ethtool_get_pauseparam(priv->phylink, pause);
313 }
314 
ax88772_ethtool_set_pauseparam(struct net_device * ndev,struct ethtool_pauseparam * pause)315 static int ax88772_ethtool_set_pauseparam(struct net_device *ndev,
316 					 struct ethtool_pauseparam *pause)
317 {
318 	struct usbnet *dev = netdev_priv(ndev);
319 	struct asix_common_private *priv = dev->driver_priv;
320 
321 	return phylink_ethtool_set_pauseparam(priv->phylink, pause);
322 }
323 
324 static const struct ethtool_ops ax88772_ethtool_ops = {
325 	.get_drvinfo		= asix_get_drvinfo,
326 	.get_link		= usbnet_get_link,
327 	.get_msglevel		= usbnet_get_msglevel,
328 	.set_msglevel		= usbnet_set_msglevel,
329 	.get_wol		= asix_get_wol,
330 	.set_wol		= asix_set_wol,
331 	.get_eeprom_len		= asix_get_eeprom_len,
332 	.get_eeprom		= asix_get_eeprom,
333 	.set_eeprom		= asix_set_eeprom,
334 	.nway_reset		= phy_ethtool_nway_reset,
335 	.get_link_ksettings	= phy_ethtool_get_link_ksettings,
336 	.set_link_ksettings	= phy_ethtool_set_link_ksettings,
337 	.self_test		= net_selftest,
338 	.get_strings		= ax88772_ethtool_get_strings,
339 	.get_sset_count		= ax88772_ethtool_get_sset_count,
340 	.get_pauseparam		= ax88772_ethtool_get_pauseparam,
341 	.set_pauseparam		= ax88772_ethtool_set_pauseparam,
342 };
343 
ax88772_reset(struct usbnet * dev)344 static int ax88772_reset(struct usbnet *dev)
345 {
346 	struct asix_data *data = (struct asix_data *)&dev->data;
347 	struct asix_common_private *priv = dev->driver_priv;
348 	int ret;
349 
350 	/* Rewrite MAC address */
351 	ether_addr_copy(data->mac_addr, dev->net->dev_addr);
352 	ret = asix_write_cmd(dev, AX_CMD_WRITE_NODE_ID, 0, 0,
353 			     ETH_ALEN, data->mac_addr, 0);
354 	if (ret < 0)
355 		goto out;
356 
357 	/* Set RX_CTL to default values with 2k buffer, and enable cactus */
358 	ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL, 0);
359 	if (ret < 0)
360 		goto out;
361 
362 	ret = asix_write_medium_mode(dev, AX88772_MEDIUM_DEFAULT, 0);
363 	if (ret < 0)
364 		goto out;
365 
366 	phylink_start(priv->phylink);
367 
368 	return 0;
369 
370 out:
371 	return ret;
372 }
373 
ax88772_hw_reset(struct usbnet * dev,int in_pm)374 static int ax88772_hw_reset(struct usbnet *dev, int in_pm)
375 {
376 	struct asix_data *data = (struct asix_data *)&dev->data;
377 	struct asix_common_private *priv = dev->driver_priv;
378 	u16 rx_ctl;
379 	int ret;
380 
381 	ret = asix_write_gpio(dev, AX_GPIO_RSE | AX_GPIO_GPO_2 |
382 			      AX_GPIO_GPO2EN, 5, in_pm);
383 	if (ret < 0)
384 		goto out;
385 
386 	ret = asix_write_cmd(dev, AX_CMD_SW_PHY_SELECT, priv->embd_phy,
387 			     0, 0, NULL, in_pm);
388 	if (ret < 0) {
389 		netdev_dbg(dev->net, "Select PHY #1 failed: %d\n", ret);
390 		goto out;
391 	}
392 
393 	if (priv->embd_phy) {
394 		ret = asix_sw_reset(dev, AX_SWRESET_IPPD, in_pm);
395 		if (ret < 0)
396 			goto out;
397 
398 		usleep_range(10000, 11000);
399 
400 		ret = asix_sw_reset(dev, AX_SWRESET_CLEAR, in_pm);
401 		if (ret < 0)
402 			goto out;
403 
404 		msleep(60);
405 
406 		ret = asix_sw_reset(dev, AX_SWRESET_IPRL | AX_SWRESET_PRL,
407 				    in_pm);
408 		if (ret < 0)
409 			goto out;
410 	} else {
411 		ret = asix_sw_reset(dev, AX_SWRESET_IPPD | AX_SWRESET_PRL,
412 				    in_pm);
413 		if (ret < 0)
414 			goto out;
415 	}
416 
417 	msleep(150);
418 
419 	if (in_pm && (!asix_mdio_read_nopm(dev->net, dev->mii.phy_id,
420 					   MII_PHYSID1))){
421 		ret = -EIO;
422 		goto out;
423 	}
424 
425 	ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL, in_pm);
426 	if (ret < 0)
427 		goto out;
428 
429 	ret = asix_write_medium_mode(dev, AX88772_MEDIUM_DEFAULT, in_pm);
430 	if (ret < 0)
431 		goto out;
432 
433 	ret = asix_write_cmd(dev, AX_CMD_WRITE_IPG0,
434 			     AX88772_IPG0_DEFAULT | AX88772_IPG1_DEFAULT,
435 			     AX88772_IPG2_DEFAULT, 0, NULL, in_pm);
436 	if (ret < 0) {
437 		netdev_dbg(dev->net, "Write IPG,IPG1,IPG2 failed: %d\n", ret);
438 		goto out;
439 	}
440 
441 	/* Rewrite MAC address */
442 	ether_addr_copy(data->mac_addr, dev->net->dev_addr);
443 	ret = asix_write_cmd(dev, AX_CMD_WRITE_NODE_ID, 0, 0,
444 			     ETH_ALEN, data->mac_addr, in_pm);
445 	if (ret < 0)
446 		goto out;
447 
448 	/* Set RX_CTL to default values with 2k buffer, and enable cactus */
449 	ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL, in_pm);
450 	if (ret < 0)
451 		goto out;
452 
453 	rx_ctl = asix_read_rx_ctl(dev, in_pm);
454 	netdev_dbg(dev->net, "RX_CTL is 0x%04x after all initializations\n",
455 		   rx_ctl);
456 
457 	rx_ctl = asix_read_medium_status(dev, in_pm);
458 	netdev_dbg(dev->net,
459 		   "Medium Status is 0x%04x after all initializations\n",
460 		   rx_ctl);
461 
462 	return 0;
463 
464 out:
465 	return ret;
466 }
467 
ax88772a_hw_reset(struct usbnet * dev,int in_pm)468 static int ax88772a_hw_reset(struct usbnet *dev, int in_pm)
469 {
470 	struct asix_data *data = (struct asix_data *)&dev->data;
471 	struct asix_common_private *priv = dev->driver_priv;
472 	u16 rx_ctl, phy14h, phy15h, phy16h;
473 	int ret;
474 
475 	ret = asix_write_gpio(dev, AX_GPIO_RSE, 5, in_pm);
476 	if (ret < 0)
477 		goto out;
478 
479 	ret = asix_write_cmd(dev, AX_CMD_SW_PHY_SELECT, priv->embd_phy |
480 			     AX_PHYSEL_SSEN, 0, 0, NULL, in_pm);
481 	if (ret < 0) {
482 		netdev_dbg(dev->net, "Select PHY #1 failed: %d\n", ret);
483 		goto out;
484 	}
485 	usleep_range(10000, 11000);
486 
487 	ret = asix_sw_reset(dev, AX_SWRESET_IPPD | AX_SWRESET_IPRL, in_pm);
488 	if (ret < 0)
489 		goto out;
490 
491 	usleep_range(10000, 11000);
492 
493 	ret = asix_sw_reset(dev, AX_SWRESET_IPRL, in_pm);
494 	if (ret < 0)
495 		goto out;
496 
497 	msleep(160);
498 
499 	ret = asix_sw_reset(dev, AX_SWRESET_CLEAR, in_pm);
500 	if (ret < 0)
501 		goto out;
502 
503 	ret = asix_sw_reset(dev, AX_SWRESET_IPRL, in_pm);
504 	if (ret < 0)
505 		goto out;
506 
507 	msleep(200);
508 
509 	if (in_pm && (!asix_mdio_read_nopm(dev->net, dev->mii.phy_id,
510 					   MII_PHYSID1))) {
511 		ret = -1;
512 		goto out;
513 	}
514 
515 	if (priv->chipcode == AX_AX88772B_CHIPCODE) {
516 		ret = asix_write_cmd(dev, AX_QCTCTRL, 0x8000, 0x8001,
517 				     0, NULL, in_pm);
518 		if (ret < 0) {
519 			netdev_dbg(dev->net, "Write BQ setting failed: %d\n",
520 				   ret);
521 			goto out;
522 		}
523 	} else if (priv->chipcode == AX_AX88772A_CHIPCODE) {
524 		/* Check if the PHY registers have default settings */
525 		phy14h = asix_mdio_read_nopm(dev->net, dev->mii.phy_id,
526 					     AX88772A_PHY14H);
527 		phy15h = asix_mdio_read_nopm(dev->net, dev->mii.phy_id,
528 					     AX88772A_PHY15H);
529 		phy16h = asix_mdio_read_nopm(dev->net, dev->mii.phy_id,
530 					     AX88772A_PHY16H);
531 
532 		netdev_dbg(dev->net,
533 			   "772a_hw_reset: MR20=0x%x MR21=0x%x MR22=0x%x\n",
534 			   phy14h, phy15h, phy16h);
535 
536 		/* Restore PHY registers default setting if not */
537 		if (phy14h != AX88772A_PHY14H_DEFAULT)
538 			asix_mdio_write_nopm(dev->net, dev->mii.phy_id,
539 					     AX88772A_PHY14H,
540 					     AX88772A_PHY14H_DEFAULT);
541 		if (phy15h != AX88772A_PHY15H_DEFAULT)
542 			asix_mdio_write_nopm(dev->net, dev->mii.phy_id,
543 					     AX88772A_PHY15H,
544 					     AX88772A_PHY15H_DEFAULT);
545 		if (phy16h != AX88772A_PHY16H_DEFAULT)
546 			asix_mdio_write_nopm(dev->net, dev->mii.phy_id,
547 					     AX88772A_PHY16H,
548 					     AX88772A_PHY16H_DEFAULT);
549 	}
550 
551 	ret = asix_write_cmd(dev, AX_CMD_WRITE_IPG0,
552 				AX88772_IPG0_DEFAULT | AX88772_IPG1_DEFAULT,
553 				AX88772_IPG2_DEFAULT, 0, NULL, in_pm);
554 	if (ret < 0) {
555 		netdev_dbg(dev->net, "Write IPG,IPG1,IPG2 failed: %d\n", ret);
556 		goto out;
557 	}
558 
559 	/* Rewrite MAC address */
560 	memcpy(data->mac_addr, dev->net->dev_addr, ETH_ALEN);
561 	ret = asix_write_cmd(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN,
562 							data->mac_addr, in_pm);
563 	if (ret < 0)
564 		goto out;
565 
566 	/* Set RX_CTL to default values with 2k buffer, and enable cactus */
567 	ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL, in_pm);
568 	if (ret < 0)
569 		goto out;
570 
571 	ret = asix_write_medium_mode(dev, AX88772_MEDIUM_DEFAULT, in_pm);
572 	if (ret < 0)
573 		return ret;
574 
575 	/* Set RX_CTL to default values with 2k buffer, and enable cactus */
576 	ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL, in_pm);
577 	if (ret < 0)
578 		goto out;
579 
580 	rx_ctl = asix_read_rx_ctl(dev, in_pm);
581 	netdev_dbg(dev->net, "RX_CTL is 0x%04x after all initializations\n",
582 		   rx_ctl);
583 
584 	rx_ctl = asix_read_medium_status(dev, in_pm);
585 	netdev_dbg(dev->net,
586 		   "Medium Status is 0x%04x after all initializations\n",
587 		   rx_ctl);
588 
589 	return 0;
590 
591 out:
592 	return ret;
593 }
594 
595 static const struct net_device_ops ax88772_netdev_ops = {
596 	.ndo_open		= usbnet_open,
597 	.ndo_stop		= usbnet_stop,
598 	.ndo_start_xmit		= usbnet_start_xmit,
599 	.ndo_tx_timeout		= usbnet_tx_timeout,
600 	.ndo_change_mtu		= usbnet_change_mtu,
601 	.ndo_get_stats64	= dev_get_tstats64,
602 	.ndo_set_mac_address 	= asix_set_mac_address,
603 	.ndo_validate_addr	= eth_validate_addr,
604 	.ndo_eth_ioctl		= phy_do_ioctl_running,
605 	.ndo_set_rx_mode        = asix_set_multicast,
606 };
607 
ax88772_suspend(struct usbnet * dev)608 static void ax88772_suspend(struct usbnet *dev)
609 {
610 	struct asix_common_private *priv = dev->driver_priv;
611 	u16 medium;
612 
613 	if (netif_running(dev->net)) {
614 		rtnl_lock();
615 		phylink_suspend(priv->phylink, false);
616 		rtnl_unlock();
617 	}
618 
619 	/* Stop MAC operation */
620 	medium = asix_read_medium_status(dev, 1);
621 	medium &= ~AX_MEDIUM_RE;
622 	asix_write_medium_mode(dev, medium, 1);
623 
624 	netdev_dbg(dev->net, "ax88772_suspend: medium=0x%04x\n",
625 		   asix_read_medium_status(dev, 1));
626 }
627 
asix_suspend(struct usb_interface * intf,pm_message_t message)628 static int asix_suspend(struct usb_interface *intf, pm_message_t message)
629 {
630 	struct usbnet *dev = usb_get_intfdata(intf);
631 	struct asix_common_private *priv = dev->driver_priv;
632 
633 	if (priv && priv->suspend)
634 		priv->suspend(dev);
635 
636 	return usbnet_suspend(intf, message);
637 }
638 
ax88772_resume(struct usbnet * dev)639 static void ax88772_resume(struct usbnet *dev)
640 {
641 	struct asix_common_private *priv = dev->driver_priv;
642 	int i;
643 
644 	for (i = 0; i < 3; i++)
645 		if (!priv->reset(dev, 1))
646 			break;
647 
648 	if (netif_running(dev->net)) {
649 		rtnl_lock();
650 		phylink_resume(priv->phylink);
651 		rtnl_unlock();
652 	}
653 }
654 
asix_resume(struct usb_interface * intf)655 static int asix_resume(struct usb_interface *intf)
656 {
657 	struct usbnet *dev = usb_get_intfdata(intf);
658 	struct asix_common_private *priv = dev->driver_priv;
659 
660 	if (priv && priv->resume)
661 		priv->resume(dev);
662 
663 	return usbnet_resume(intf);
664 }
665 
ax88772_init_mdio(struct usbnet * dev)666 static int ax88772_init_mdio(struct usbnet *dev)
667 {
668 	struct asix_common_private *priv = dev->driver_priv;
669 	int ret;
670 
671 	priv->mdio = mdiobus_alloc();
672 	if (!priv->mdio)
673 		return -ENOMEM;
674 
675 	priv->mdio->priv = dev;
676 	priv->mdio->read = &asix_mdio_bus_read;
677 	priv->mdio->write = &asix_mdio_bus_write;
678 	priv->mdio->name = "Asix MDIO Bus";
679 	/* mii bus name is usb-<usb bus number>-<usb device number> */
680 	snprintf(priv->mdio->id, MII_BUS_ID_SIZE, "usb-%03d:%03d",
681 		 dev->udev->bus->busnum, dev->udev->devnum);
682 
683 	ret = mdiobus_register(priv->mdio);
684 	if (ret) {
685 		netdev_err(dev->net, "Could not register MDIO bus (err %d)\n", ret);
686 		mdiobus_free(priv->mdio);
687 		priv->mdio = NULL;
688 	}
689 
690 	return ret;
691 }
692 
ax88772_mdio_unregister(struct asix_common_private * priv)693 static void ax88772_mdio_unregister(struct asix_common_private *priv)
694 {
695 	mdiobus_unregister(priv->mdio);
696 	mdiobus_free(priv->mdio);
697 }
698 
ax88772_init_phy(struct usbnet * dev)699 static int ax88772_init_phy(struct usbnet *dev)
700 {
701 	struct asix_common_private *priv = dev->driver_priv;
702 	int ret;
703 
704 	priv->phydev = mdiobus_get_phy(priv->mdio, priv->phy_addr);
705 	if (!priv->phydev) {
706 		netdev_err(dev->net, "Could not find PHY\n");
707 		return -ENODEV;
708 	}
709 
710 	ret = phylink_connect_phy(priv->phylink, priv->phydev);
711 	if (ret) {
712 		netdev_err(dev->net, "Could not connect PHY\n");
713 		return ret;
714 	}
715 
716 	phy_suspend(priv->phydev);
717 	priv->phydev->mac_managed_pm = true;
718 
719 	phy_attached_info(priv->phydev);
720 
721 	if (priv->embd_phy)
722 		return 0;
723 
724 	/* In case main PHY is not the embedded PHY and MAC is RMII clock
725 	 * provider, we need to suspend embedded PHY by keeping PLL enabled
726 	 * (AX_SWRESET_IPPD == 0).
727 	 */
728 	priv->phydev_int = mdiobus_get_phy(priv->mdio, AX_EMBD_PHY_ADDR);
729 	if (!priv->phydev_int) {
730 		rtnl_lock();
731 		phylink_disconnect_phy(priv->phylink);
732 		rtnl_unlock();
733 		netdev_err(dev->net, "Could not find internal PHY\n");
734 		return -ENODEV;
735 	}
736 
737 	priv->phydev_int->mac_managed_pm = true;
738 	phy_suspend(priv->phydev_int);
739 
740 	return 0;
741 }
742 
ax88772_mac_config(struct phylink_config * config,unsigned int mode,const struct phylink_link_state * state)743 static void ax88772_mac_config(struct phylink_config *config, unsigned int mode,
744 			      const struct phylink_link_state *state)
745 {
746 	/* Nothing to do */
747 }
748 
ax88772_mac_link_down(struct phylink_config * config,unsigned int mode,phy_interface_t interface)749 static void ax88772_mac_link_down(struct phylink_config *config,
750 				 unsigned int mode, phy_interface_t interface)
751 {
752 	struct usbnet *dev = netdev_priv(to_net_dev(config->dev));
753 
754 	asix_write_medium_mode(dev, 0, 0);
755 	usbnet_link_change(dev, false, false);
756 }
757 
ax88772_mac_link_up(struct phylink_config * config,struct phy_device * phy,unsigned int mode,phy_interface_t interface,int speed,int duplex,bool tx_pause,bool rx_pause)758 static void ax88772_mac_link_up(struct phylink_config *config,
759 			       struct phy_device *phy,
760 			       unsigned int mode, phy_interface_t interface,
761 			       int speed, int duplex,
762 			       bool tx_pause, bool rx_pause)
763 {
764 	struct usbnet *dev = netdev_priv(to_net_dev(config->dev));
765 	u16 m = AX_MEDIUM_AC | AX_MEDIUM_RE;
766 
767 	m |= duplex ? AX_MEDIUM_FD : 0;
768 
769 	switch (speed) {
770 	case SPEED_100:
771 		m |= AX_MEDIUM_PS;
772 		break;
773 	case SPEED_10:
774 		break;
775 	default:
776 		return;
777 	}
778 
779 	if (tx_pause)
780 		m |= AX_MEDIUM_TFC;
781 
782 	if (rx_pause)
783 		m |= AX_MEDIUM_RFC;
784 
785 	asix_write_medium_mode(dev, m, 0);
786 	usbnet_link_change(dev, true, false);
787 }
788 
789 static const struct phylink_mac_ops ax88772_phylink_mac_ops = {
790 	.mac_config = ax88772_mac_config,
791 	.mac_link_down = ax88772_mac_link_down,
792 	.mac_link_up = ax88772_mac_link_up,
793 };
794 
ax88772_phylink_setup(struct usbnet * dev)795 static int ax88772_phylink_setup(struct usbnet *dev)
796 {
797 	struct asix_common_private *priv = dev->driver_priv;
798 	phy_interface_t phy_if_mode;
799 	struct phylink *phylink;
800 
801 	priv->phylink_config.dev = &dev->net->dev;
802 	priv->phylink_config.type = PHYLINK_NETDEV;
803 	priv->phylink_config.mac_capabilities = MAC_SYM_PAUSE | MAC_ASYM_PAUSE |
804 		MAC_10 | MAC_100;
805 
806 	__set_bit(PHY_INTERFACE_MODE_INTERNAL,
807 		  priv->phylink_config.supported_interfaces);
808 	__set_bit(PHY_INTERFACE_MODE_RMII,
809 		  priv->phylink_config.supported_interfaces);
810 
811 	if (priv->embd_phy)
812 		phy_if_mode = PHY_INTERFACE_MODE_INTERNAL;
813 	else
814 		phy_if_mode = PHY_INTERFACE_MODE_RMII;
815 
816 	phylink = phylink_create(&priv->phylink_config, dev->net->dev.fwnode,
817 				 phy_if_mode, &ax88772_phylink_mac_ops);
818 	if (IS_ERR(phylink))
819 		return PTR_ERR(phylink);
820 
821 	priv->phylink = phylink;
822 	return 0;
823 }
824 
ax88772_bind(struct usbnet * dev,struct usb_interface * intf)825 static int ax88772_bind(struct usbnet *dev, struct usb_interface *intf)
826 {
827 	struct asix_common_private *priv;
828 	u8 buf[ETH_ALEN] = {0};
829 	int ret, i;
830 
831 	priv = devm_kzalloc(&dev->udev->dev, sizeof(*priv), GFP_KERNEL);
832 	if (!priv)
833 		return -ENOMEM;
834 
835 	dev->driver_priv = priv;
836 
837 	usbnet_get_endpoints(dev, intf);
838 
839 	/* Maybe the boot loader passed the MAC address via device tree */
840 	if (!eth_platform_get_mac_address(&dev->udev->dev, buf)) {
841 		netif_dbg(dev, ifup, dev->net,
842 			  "MAC address read from device tree");
843 	} else {
844 		/* Try getting the MAC address from EEPROM */
845 		if (dev->driver_info->data & FLAG_EEPROM_MAC) {
846 			for (i = 0; i < (ETH_ALEN >> 1); i++) {
847 				ret = asix_read_cmd(dev, AX_CMD_READ_EEPROM,
848 						    0x04 + i, 0, 2, buf + i * 2,
849 						    0);
850 				if (ret < 0)
851 					break;
852 			}
853 		} else {
854 			ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID,
855 					    0, 0, ETH_ALEN, buf, 0);
856 		}
857 
858 		if (ret < 0) {
859 			netdev_dbg(dev->net, "Failed to read MAC address: %d\n",
860 				   ret);
861 			return ret;
862 		}
863 	}
864 
865 	asix_set_netdev_dev_addr(dev, buf);
866 
867 	dev->net->netdev_ops = &ax88772_netdev_ops;
868 	dev->net->ethtool_ops = &ax88772_ethtool_ops;
869 	dev->net->needed_headroom = 4; /* cf asix_tx_fixup() */
870 	dev->net->needed_tailroom = 4; /* cf asix_tx_fixup() */
871 
872 	ret = asix_read_phy_addr(dev, true);
873 	if (ret < 0)
874 		return ret;
875 
876 	priv->phy_addr = ret;
877 	priv->embd_phy = ((priv->phy_addr & 0x1f) == AX_EMBD_PHY_ADDR);
878 
879 	ret = asix_read_cmd(dev, AX_CMD_STATMNGSTS_REG, 0, 0, 1,
880 			    &priv->chipcode, 0);
881 	if (ret < 0) {
882 		netdev_dbg(dev->net, "Failed to read STATMNGSTS_REG: %d\n", ret);
883 		return ret;
884 	}
885 
886 	priv->chipcode &= AX_CHIPCODE_MASK;
887 
888 	priv->resume = ax88772_resume;
889 	priv->suspend = ax88772_suspend;
890 	if (priv->chipcode == AX_AX88772_CHIPCODE)
891 		priv->reset = ax88772_hw_reset;
892 	else
893 		priv->reset = ax88772a_hw_reset;
894 
895 	ret = priv->reset(dev, 0);
896 	if (ret < 0) {
897 		netdev_dbg(dev->net, "Failed to reset AX88772: %d\n", ret);
898 		return ret;
899 	}
900 
901 	/* Asix framing packs multiple eth frames into a 2K usb bulk transfer */
902 	if (dev->driver_info->flags & FLAG_FRAMING_AX) {
903 		/* hard_mtu  is still the default - the device does not support
904 		   jumbo eth frames */
905 		dev->rx_urb_size = 2048;
906 	}
907 
908 	priv->presvd_phy_bmcr = 0;
909 	priv->presvd_phy_advertise = 0;
910 
911 	ret = ax88772_init_mdio(dev);
912 	if (ret)
913 		goto mdio_err;
914 
915 	ret = ax88772_phylink_setup(dev);
916 	if (ret)
917 		goto phylink_err;
918 
919 	ret = ax88772_init_phy(dev);
920 	if (ret)
921 		goto initphy_err;
922 
923 	return 0;
924 
925 initphy_err:
926 	phylink_destroy(priv->phylink);
927 phylink_err:
928 	ax88772_mdio_unregister(priv);
929 mdio_err:
930 	return ret;
931 }
932 
ax88772_stop(struct usbnet * dev)933 static int ax88772_stop(struct usbnet *dev)
934 {
935 	struct asix_common_private *priv = dev->driver_priv;
936 
937 	phylink_stop(priv->phylink);
938 
939 	return 0;
940 }
941 
ax88772_unbind(struct usbnet * dev,struct usb_interface * intf)942 static void ax88772_unbind(struct usbnet *dev, struct usb_interface *intf)
943 {
944 	struct asix_common_private *priv = dev->driver_priv;
945 
946 	rtnl_lock();
947 	phylink_disconnect_phy(priv->phylink);
948 	rtnl_unlock();
949 	phylink_destroy(priv->phylink);
950 	ax88772_mdio_unregister(priv);
951 	asix_rx_fixup_common_free(dev->driver_priv);
952 }
953 
ax88178_unbind(struct usbnet * dev,struct usb_interface * intf)954 static void ax88178_unbind(struct usbnet *dev, struct usb_interface *intf)
955 {
956 	asix_rx_fixup_common_free(dev->driver_priv);
957 	kfree(dev->driver_priv);
958 }
959 
960 static const struct ethtool_ops ax88178_ethtool_ops = {
961 	.get_drvinfo		= asix_get_drvinfo,
962 	.get_link		= asix_get_link,
963 	.get_msglevel		= usbnet_get_msglevel,
964 	.set_msglevel		= usbnet_set_msglevel,
965 	.get_wol		= asix_get_wol,
966 	.set_wol		= asix_set_wol,
967 	.get_eeprom_len		= asix_get_eeprom_len,
968 	.get_eeprom		= asix_get_eeprom,
969 	.set_eeprom		= asix_set_eeprom,
970 	.nway_reset		= usbnet_nway_reset,
971 	.get_link_ksettings	= usbnet_get_link_ksettings_mii,
972 	.set_link_ksettings	= usbnet_set_link_ksettings_mii,
973 };
974 
marvell_phy_init(struct usbnet * dev)975 static int marvell_phy_init(struct usbnet *dev)
976 {
977 	struct asix_data *data = (struct asix_data *)&dev->data;
978 	u16 reg;
979 
980 	netdev_dbg(dev->net, "marvell_phy_init()\n");
981 
982 	reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_MARVELL_STATUS);
983 	netdev_dbg(dev->net, "MII_MARVELL_STATUS = 0x%04x\n", reg);
984 
985 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_MARVELL_CTRL,
986 			MARVELL_CTRL_RXDELAY | MARVELL_CTRL_TXDELAY);
987 
988 	if (data->ledmode) {
989 		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
990 			MII_MARVELL_LED_CTRL);
991 		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (1) = 0x%04x\n", reg);
992 
993 		reg &= 0xf8ff;
994 		reg |= (1 + 0x0100);
995 		asix_mdio_write(dev->net, dev->mii.phy_id,
996 			MII_MARVELL_LED_CTRL, reg);
997 
998 		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
999 			MII_MARVELL_LED_CTRL);
1000 		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (2) = 0x%04x\n", reg);
1001 	}
1002 
1003 	return 0;
1004 }
1005 
rtl8211cl_phy_init(struct usbnet * dev)1006 static int rtl8211cl_phy_init(struct usbnet *dev)
1007 {
1008 	struct asix_data *data = (struct asix_data *)&dev->data;
1009 
1010 	netdev_dbg(dev->net, "rtl8211cl_phy_init()\n");
1011 
1012 	asix_mdio_write (dev->net, dev->mii.phy_id, 0x1f, 0x0005);
1013 	asix_mdio_write (dev->net, dev->mii.phy_id, 0x0c, 0);
1014 	asix_mdio_write (dev->net, dev->mii.phy_id, 0x01,
1015 		asix_mdio_read (dev->net, dev->mii.phy_id, 0x01) | 0x0080);
1016 	asix_mdio_write (dev->net, dev->mii.phy_id, 0x1f, 0);
1017 
1018 	if (data->ledmode == 12) {
1019 		asix_mdio_write (dev->net, dev->mii.phy_id, 0x1f, 0x0002);
1020 		asix_mdio_write (dev->net, dev->mii.phy_id, 0x1a, 0x00cb);
1021 		asix_mdio_write (dev->net, dev->mii.phy_id, 0x1f, 0);
1022 	}
1023 
1024 	return 0;
1025 }
1026 
marvell_led_status(struct usbnet * dev,u16 speed)1027 static int marvell_led_status(struct usbnet *dev, u16 speed)
1028 {
1029 	u16 reg = asix_mdio_read(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL);
1030 
1031 	netdev_dbg(dev->net, "marvell_led_status() read 0x%04x\n", reg);
1032 
1033 	/* Clear out the center LED bits - 0x03F0 */
1034 	reg &= 0xfc0f;
1035 
1036 	switch (speed) {
1037 		case SPEED_1000:
1038 			reg |= 0x03e0;
1039 			break;
1040 		case SPEED_100:
1041 			reg |= 0x03b0;
1042 			break;
1043 		default:
1044 			reg |= 0x02f0;
1045 	}
1046 
1047 	netdev_dbg(dev->net, "marvell_led_status() writing 0x%04x\n", reg);
1048 	asix_mdio_write(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL, reg);
1049 
1050 	return 0;
1051 }
1052 
ax88178_reset(struct usbnet * dev)1053 static int ax88178_reset(struct usbnet *dev)
1054 {
1055 	struct asix_data *data = (struct asix_data *)&dev->data;
1056 	int ret;
1057 	__le16 eeprom;
1058 	u8 status;
1059 	int gpio0 = 0;
1060 	u32 phyid;
1061 
1062 	ret = asix_read_cmd(dev, AX_CMD_READ_GPIOS, 0, 0, 1, &status, 0);
1063 	if (ret < 0) {
1064 		netdev_dbg(dev->net, "Failed to read GPIOS: %d\n", ret);
1065 		return ret;
1066 	}
1067 
1068 	netdev_dbg(dev->net, "GPIO Status: 0x%04x\n", status);
1069 
1070 	asix_write_cmd(dev, AX_CMD_WRITE_ENABLE, 0, 0, 0, NULL, 0);
1071 	ret = asix_read_cmd(dev, AX_CMD_READ_EEPROM, 0x0017, 0, 2, &eeprom, 0);
1072 	if (ret < 0) {
1073 		netdev_dbg(dev->net, "Failed to read EEPROM: %d\n", ret);
1074 		return ret;
1075 	}
1076 
1077 	asix_write_cmd(dev, AX_CMD_WRITE_DISABLE, 0, 0, 0, NULL, 0);
1078 
1079 	netdev_dbg(dev->net, "EEPROM index 0x17 is 0x%04x\n", eeprom);
1080 
1081 	if (eeprom == cpu_to_le16(0xffff)) {
1082 		data->phymode = PHY_MODE_MARVELL;
1083 		data->ledmode = 0;
1084 		gpio0 = 1;
1085 	} else {
1086 		data->phymode = le16_to_cpu(eeprom) & 0x7F;
1087 		data->ledmode = le16_to_cpu(eeprom) >> 8;
1088 		gpio0 = (le16_to_cpu(eeprom) & 0x80) ? 0 : 1;
1089 	}
1090 	netdev_dbg(dev->net, "GPIO0: %d, PhyMode: %d\n", gpio0, data->phymode);
1091 
1092 	/* Power up external GigaPHY through AX88178 GPIO pin */
1093 	asix_write_gpio(dev, AX_GPIO_RSE | AX_GPIO_GPO_1 |
1094 			AX_GPIO_GPO1EN, 40, 0);
1095 	if ((le16_to_cpu(eeprom) >> 8) != 1) {
1096 		asix_write_gpio(dev, 0x003c, 30, 0);
1097 		asix_write_gpio(dev, 0x001c, 300, 0);
1098 		asix_write_gpio(dev, 0x003c, 30, 0);
1099 	} else {
1100 		netdev_dbg(dev->net, "gpio phymode == 1 path\n");
1101 		asix_write_gpio(dev, AX_GPIO_GPO1EN, 30, 0);
1102 		asix_write_gpio(dev, AX_GPIO_GPO1EN | AX_GPIO_GPO_1, 30, 0);
1103 	}
1104 
1105 	/* Read PHYID register *AFTER* powering up PHY */
1106 	phyid = asix_get_phyid(dev);
1107 	netdev_dbg(dev->net, "PHYID=0x%08x\n", phyid);
1108 
1109 	/* Set AX88178 to enable MII/GMII/RGMII interface for external PHY */
1110 	asix_write_cmd(dev, AX_CMD_SW_PHY_SELECT, 0, 0, 0, NULL, 0);
1111 
1112 	asix_sw_reset(dev, 0, 0);
1113 	msleep(150);
1114 
1115 	asix_sw_reset(dev, AX_SWRESET_PRL | AX_SWRESET_IPPD, 0);
1116 	msleep(150);
1117 
1118 	asix_write_rx_ctl(dev, 0, 0);
1119 
1120 	if (data->phymode == PHY_MODE_MARVELL) {
1121 		marvell_phy_init(dev);
1122 		msleep(60);
1123 	} else if (data->phymode == PHY_MODE_RTL8211CL)
1124 		rtl8211cl_phy_init(dev);
1125 
1126 	asix_phy_reset(dev, BMCR_RESET | BMCR_ANENABLE);
1127 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
1128 			ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
1129 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_CTRL1000,
1130 			ADVERTISE_1000FULL);
1131 
1132 	asix_write_medium_mode(dev, AX88178_MEDIUM_DEFAULT, 0);
1133 	mii_nway_restart(&dev->mii);
1134 
1135 	/* Rewrite MAC address */
1136 	memcpy(data->mac_addr, dev->net->dev_addr, ETH_ALEN);
1137 	ret = asix_write_cmd(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN,
1138 							data->mac_addr, 0);
1139 	if (ret < 0)
1140 		return ret;
1141 
1142 	ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL, 0);
1143 	if (ret < 0)
1144 		return ret;
1145 
1146 	return 0;
1147 }
1148 
ax88178_link_reset(struct usbnet * dev)1149 static int ax88178_link_reset(struct usbnet *dev)
1150 {
1151 	u16 mode;
1152 	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
1153 	struct asix_data *data = (struct asix_data *)&dev->data;
1154 	u32 speed;
1155 
1156 	netdev_dbg(dev->net, "ax88178_link_reset()\n");
1157 
1158 	mii_check_media(&dev->mii, 1, 1);
1159 	mii_ethtool_gset(&dev->mii, &ecmd);
1160 	mode = AX88178_MEDIUM_DEFAULT;
1161 	speed = ethtool_cmd_speed(&ecmd);
1162 
1163 	if (speed == SPEED_1000)
1164 		mode |= AX_MEDIUM_GM;
1165 	else if (speed == SPEED_100)
1166 		mode |= AX_MEDIUM_PS;
1167 	else
1168 		mode &= ~(AX_MEDIUM_PS | AX_MEDIUM_GM);
1169 
1170 	mode |= AX_MEDIUM_ENCK;
1171 
1172 	if (ecmd.duplex == DUPLEX_FULL)
1173 		mode |= AX_MEDIUM_FD;
1174 	else
1175 		mode &= ~AX_MEDIUM_FD;
1176 
1177 	netdev_dbg(dev->net, "ax88178_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
1178 		   speed, ecmd.duplex, mode);
1179 
1180 	asix_write_medium_mode(dev, mode, 0);
1181 
1182 	if (data->phymode == PHY_MODE_MARVELL && data->ledmode)
1183 		marvell_led_status(dev, speed);
1184 
1185 	return 0;
1186 }
1187 
ax88178_set_mfb(struct usbnet * dev)1188 static void ax88178_set_mfb(struct usbnet *dev)
1189 {
1190 	u16 mfb = AX_RX_CTL_MFB_16384;
1191 	u16 rxctl;
1192 	u16 medium;
1193 	int old_rx_urb_size = dev->rx_urb_size;
1194 
1195 	if (dev->hard_mtu < 2048) {
1196 		dev->rx_urb_size = 2048;
1197 		mfb = AX_RX_CTL_MFB_2048;
1198 	} else if (dev->hard_mtu < 4096) {
1199 		dev->rx_urb_size = 4096;
1200 		mfb = AX_RX_CTL_MFB_4096;
1201 	} else if (dev->hard_mtu < 8192) {
1202 		dev->rx_urb_size = 8192;
1203 		mfb = AX_RX_CTL_MFB_8192;
1204 	} else if (dev->hard_mtu < 16384) {
1205 		dev->rx_urb_size = 16384;
1206 		mfb = AX_RX_CTL_MFB_16384;
1207 	}
1208 
1209 	rxctl = asix_read_rx_ctl(dev, 0);
1210 	asix_write_rx_ctl(dev, (rxctl & ~AX_RX_CTL_MFB_16384) | mfb, 0);
1211 
1212 	medium = asix_read_medium_status(dev, 0);
1213 	if (dev->net->mtu > 1500)
1214 		medium |= AX_MEDIUM_JFE;
1215 	else
1216 		medium &= ~AX_MEDIUM_JFE;
1217 	asix_write_medium_mode(dev, medium, 0);
1218 
1219 	if (dev->rx_urb_size > old_rx_urb_size)
1220 		usbnet_unlink_rx_urbs(dev);
1221 }
1222 
ax88178_change_mtu(struct net_device * net,int new_mtu)1223 static int ax88178_change_mtu(struct net_device *net, int new_mtu)
1224 {
1225 	struct usbnet *dev = netdev_priv(net);
1226 	int ll_mtu = new_mtu + net->hard_header_len + 4;
1227 
1228 	netdev_dbg(dev->net, "ax88178_change_mtu() new_mtu=%d\n", new_mtu);
1229 
1230 	if ((ll_mtu % dev->maxpacket) == 0)
1231 		return -EDOM;
1232 
1233 	net->mtu = new_mtu;
1234 	dev->hard_mtu = net->mtu + net->hard_header_len;
1235 	ax88178_set_mfb(dev);
1236 
1237 	/* max qlen depend on hard_mtu and rx_urb_size */
1238 	usbnet_update_max_qlen(dev);
1239 
1240 	return 0;
1241 }
1242 
1243 static const struct net_device_ops ax88178_netdev_ops = {
1244 	.ndo_open		= usbnet_open,
1245 	.ndo_stop		= usbnet_stop,
1246 	.ndo_start_xmit		= usbnet_start_xmit,
1247 	.ndo_tx_timeout		= usbnet_tx_timeout,
1248 	.ndo_get_stats64	= dev_get_tstats64,
1249 	.ndo_set_mac_address 	= asix_set_mac_address,
1250 	.ndo_validate_addr	= eth_validate_addr,
1251 	.ndo_set_rx_mode	= asix_set_multicast,
1252 	.ndo_eth_ioctl		= asix_ioctl,
1253 	.ndo_change_mtu 	= ax88178_change_mtu,
1254 };
1255 
ax88178_bind(struct usbnet * dev,struct usb_interface * intf)1256 static int ax88178_bind(struct usbnet *dev, struct usb_interface *intf)
1257 {
1258 	int ret;
1259 	u8 buf[ETH_ALEN] = {0};
1260 
1261 	usbnet_get_endpoints(dev,intf);
1262 
1263 	/* Get the MAC address */
1264 	ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID, 0, 0, ETH_ALEN, buf, 0);
1265 	if (ret < 0) {
1266 		netdev_dbg(dev->net, "Failed to read MAC address: %d\n", ret);
1267 		return ret;
1268 	}
1269 
1270 	asix_set_netdev_dev_addr(dev, buf);
1271 
1272 	/* Initialize MII structure */
1273 	dev->mii.dev = dev->net;
1274 	dev->mii.mdio_read = asix_mdio_read;
1275 	dev->mii.mdio_write = asix_mdio_write;
1276 	dev->mii.phy_id_mask = 0x1f;
1277 	dev->mii.reg_num_mask = 0xff;
1278 	dev->mii.supports_gmii = 1;
1279 
1280 	dev->mii.phy_id = asix_read_phy_addr(dev, true);
1281 	if (dev->mii.phy_id < 0)
1282 		return dev->mii.phy_id;
1283 
1284 	dev->net->netdev_ops = &ax88178_netdev_ops;
1285 	dev->net->ethtool_ops = &ax88178_ethtool_ops;
1286 	dev->net->max_mtu = 16384 - (dev->net->hard_header_len + 4);
1287 
1288 	/* Blink LEDS so users know driver saw dongle */
1289 	asix_sw_reset(dev, 0, 0);
1290 	msleep(150);
1291 
1292 	asix_sw_reset(dev, AX_SWRESET_PRL | AX_SWRESET_IPPD, 0);
1293 	msleep(150);
1294 
1295 	/* Asix framing packs multiple eth frames into a 2K usb bulk transfer */
1296 	if (dev->driver_info->flags & FLAG_FRAMING_AX) {
1297 		/* hard_mtu  is still the default - the device does not support
1298 		   jumbo eth frames */
1299 		dev->rx_urb_size = 2048;
1300 	}
1301 
1302 	dev->driver_priv = kzalloc(sizeof(struct asix_common_private), GFP_KERNEL);
1303 	if (!dev->driver_priv)
1304 			return -ENOMEM;
1305 
1306 	return 0;
1307 }
1308 
1309 static const struct driver_info ax8817x_info = {
1310 	.description = "ASIX AX8817x USB 2.0 Ethernet",
1311 	.bind = ax88172_bind,
1312 	.status = asix_status,
1313 	.link_reset = ax88172_link_reset,
1314 	.reset = ax88172_link_reset,
1315 	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1316 	.data = 0x00130103,
1317 };
1318 
1319 static const struct driver_info dlink_dub_e100_info = {
1320 	.description = "DLink DUB-E100 USB Ethernet",
1321 	.bind = ax88172_bind,
1322 	.status = asix_status,
1323 	.link_reset = ax88172_link_reset,
1324 	.reset = ax88172_link_reset,
1325 	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1326 	.data = 0x009f9d9f,
1327 };
1328 
1329 static const struct driver_info netgear_fa120_info = {
1330 	.description = "Netgear FA-120 USB Ethernet",
1331 	.bind = ax88172_bind,
1332 	.status = asix_status,
1333 	.link_reset = ax88172_link_reset,
1334 	.reset = ax88172_link_reset,
1335 	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1336 	.data = 0x00130103,
1337 };
1338 
1339 static const struct driver_info hawking_uf200_info = {
1340 	.description = "Hawking UF200 USB Ethernet",
1341 	.bind = ax88172_bind,
1342 	.status = asix_status,
1343 	.link_reset = ax88172_link_reset,
1344 	.reset = ax88172_link_reset,
1345 	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1346 	.data = 0x001f1d1f,
1347 };
1348 
1349 static const struct driver_info ax88772_info = {
1350 	.description = "ASIX AX88772 USB 2.0 Ethernet",
1351 	.bind = ax88772_bind,
1352 	.unbind = ax88772_unbind,
1353 	.status = asix_status,
1354 	.reset = ax88772_reset,
1355 	.stop = ax88772_stop,
1356 	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR | FLAG_MULTI_PACKET,
1357 	.rx_fixup = asix_rx_fixup_common,
1358 	.tx_fixup = asix_tx_fixup,
1359 };
1360 
1361 static const struct driver_info ax88772b_info = {
1362 	.description = "ASIX AX88772B USB 2.0 Ethernet",
1363 	.bind = ax88772_bind,
1364 	.unbind = ax88772_unbind,
1365 	.status = asix_status,
1366 	.reset = ax88772_reset,
1367 	.stop = ax88772_stop,
1368 	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR |
1369 	         FLAG_MULTI_PACKET,
1370 	.rx_fixup = asix_rx_fixup_common,
1371 	.tx_fixup = asix_tx_fixup,
1372 	.data = FLAG_EEPROM_MAC,
1373 };
1374 
1375 static const struct driver_info lxausb_t1l_info = {
1376 	.description = "Linux Automation GmbH USB 10Base-T1L",
1377 	.bind = ax88772_bind,
1378 	.unbind = ax88772_unbind,
1379 	.status = asix_status,
1380 	.reset = ax88772_reset,
1381 	.stop = ax88772_stop,
1382 	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR |
1383 		 FLAG_MULTI_PACKET,
1384 	.rx_fixup = asix_rx_fixup_common,
1385 	.tx_fixup = asix_tx_fixup,
1386 	.data = FLAG_EEPROM_MAC,
1387 };
1388 
1389 static const struct driver_info ax88178_info = {
1390 	.description = "ASIX AX88178 USB 2.0 Ethernet",
1391 	.bind = ax88178_bind,
1392 	.unbind = ax88178_unbind,
1393 	.status = asix_status,
1394 	.link_reset = ax88178_link_reset,
1395 	.reset = ax88178_reset,
1396 	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR |
1397 		 FLAG_MULTI_PACKET,
1398 	.rx_fixup = asix_rx_fixup_common,
1399 	.tx_fixup = asix_tx_fixup,
1400 };
1401 
1402 /*
1403  * USBLINK 20F9 "USB 2.0 LAN" USB ethernet adapter, typically found in
1404  * no-name packaging.
1405  * USB device strings are:
1406  *   1: Manufacturer: USBLINK
1407  *   2: Product: HG20F9 USB2.0
1408  *   3: Serial: 000003
1409  * Appears to be compatible with Asix 88772B.
1410  */
1411 static const struct driver_info hg20f9_info = {
1412 	.description = "HG20F9 USB 2.0 Ethernet",
1413 	.bind = ax88772_bind,
1414 	.unbind = ax88772_unbind,
1415 	.status = asix_status,
1416 	.reset = ax88772_reset,
1417 	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR |
1418 	         FLAG_MULTI_PACKET,
1419 	.rx_fixup = asix_rx_fixup_common,
1420 	.tx_fixup = asix_tx_fixup,
1421 	.data = FLAG_EEPROM_MAC,
1422 };
1423 
1424 static const struct usb_device_id	products [] = {
1425 {
1426 	// Linksys USB200M
1427 	USB_DEVICE (0x077b, 0x2226),
1428 	.driver_info =	(unsigned long) &ax8817x_info,
1429 }, {
1430 	// Netgear FA120
1431 	USB_DEVICE (0x0846, 0x1040),
1432 	.driver_info =  (unsigned long) &netgear_fa120_info,
1433 }, {
1434 	// DLink DUB-E100
1435 	USB_DEVICE (0x2001, 0x1a00),
1436 	.driver_info =  (unsigned long) &dlink_dub_e100_info,
1437 }, {
1438 	// Intellinet, ST Lab USB Ethernet
1439 	USB_DEVICE (0x0b95, 0x1720),
1440 	.driver_info =  (unsigned long) &ax8817x_info,
1441 }, {
1442 	// Hawking UF200, TrendNet TU2-ET100
1443 	USB_DEVICE (0x07b8, 0x420a),
1444 	.driver_info =  (unsigned long) &hawking_uf200_info,
1445 }, {
1446 	// Billionton Systems, USB2AR
1447 	USB_DEVICE (0x08dd, 0x90ff),
1448 	.driver_info =  (unsigned long) &ax8817x_info,
1449 }, {
1450 	// Billionton Systems, GUSB2AM-1G-B
1451 	USB_DEVICE(0x08dd, 0x0114),
1452 	.driver_info =  (unsigned long) &ax88178_info,
1453 }, {
1454 	// ATEN UC210T
1455 	USB_DEVICE (0x0557, 0x2009),
1456 	.driver_info =  (unsigned long) &ax8817x_info,
1457 }, {
1458 	// Buffalo LUA-U2-KTX
1459 	USB_DEVICE (0x0411, 0x003d),
1460 	.driver_info =  (unsigned long) &ax8817x_info,
1461 }, {
1462 	// Buffalo LUA-U2-GT 10/100/1000
1463 	USB_DEVICE (0x0411, 0x006e),
1464 	.driver_info =  (unsigned long) &ax88178_info,
1465 }, {
1466 	// Sitecom LN-029 "USB 2.0 10/100 Ethernet adapter"
1467 	USB_DEVICE (0x6189, 0x182d),
1468 	.driver_info =  (unsigned long) &ax8817x_info,
1469 }, {
1470 	// Sitecom LN-031 "USB 2.0 10/100/1000 Ethernet adapter"
1471 	USB_DEVICE (0x0df6, 0x0056),
1472 	.driver_info =  (unsigned long) &ax88178_info,
1473 }, {
1474 	// Sitecom LN-028 "USB 2.0 10/100/1000 Ethernet adapter"
1475 	USB_DEVICE (0x0df6, 0x061c),
1476 	.driver_info =  (unsigned long) &ax88178_info,
1477 }, {
1478 	// corega FEther USB2-TX
1479 	USB_DEVICE (0x07aa, 0x0017),
1480 	.driver_info =  (unsigned long) &ax8817x_info,
1481 }, {
1482 	// Surecom EP-1427X-2
1483 	USB_DEVICE (0x1189, 0x0893),
1484 	.driver_info = (unsigned long) &ax8817x_info,
1485 }, {
1486 	// goodway corp usb gwusb2e
1487 	USB_DEVICE (0x1631, 0x6200),
1488 	.driver_info = (unsigned long) &ax8817x_info,
1489 }, {
1490 	// JVC MP-PRX1 Port Replicator
1491 	USB_DEVICE (0x04f1, 0x3008),
1492 	.driver_info = (unsigned long) &ax8817x_info,
1493 }, {
1494 	// Lenovo U2L100P 10/100
1495 	USB_DEVICE (0x17ef, 0x7203),
1496 	.driver_info = (unsigned long)&ax88772b_info,
1497 }, {
1498 	// ASIX AX88772B 10/100
1499 	USB_DEVICE (0x0b95, 0x772b),
1500 	.driver_info = (unsigned long) &ax88772b_info,
1501 }, {
1502 	// ASIX AX88772 10/100
1503 	USB_DEVICE (0x0b95, 0x7720),
1504 	.driver_info = (unsigned long) &ax88772_info,
1505 }, {
1506 	// ASIX AX88178 10/100/1000
1507 	USB_DEVICE (0x0b95, 0x1780),
1508 	.driver_info = (unsigned long) &ax88178_info,
1509 }, {
1510 	// Logitec LAN-GTJ/U2A
1511 	USB_DEVICE (0x0789, 0x0160),
1512 	.driver_info = (unsigned long) &ax88178_info,
1513 }, {
1514 	// Linksys USB200M Rev 2
1515 	USB_DEVICE (0x13b1, 0x0018),
1516 	.driver_info = (unsigned long) &ax88772_info,
1517 }, {
1518 	// 0Q0 cable ethernet
1519 	USB_DEVICE (0x1557, 0x7720),
1520 	.driver_info = (unsigned long) &ax88772_info,
1521 }, {
1522 	// DLink DUB-E100 H/W Ver B1
1523 	USB_DEVICE (0x07d1, 0x3c05),
1524 	.driver_info = (unsigned long) &ax88772_info,
1525 }, {
1526 	// DLink DUB-E100 H/W Ver B1 Alternate
1527 	USB_DEVICE (0x2001, 0x3c05),
1528 	.driver_info = (unsigned long) &ax88772_info,
1529 }, {
1530        // DLink DUB-E100 H/W Ver C1
1531        USB_DEVICE (0x2001, 0x1a02),
1532        .driver_info = (unsigned long) &ax88772_info,
1533 }, {
1534 	// Linksys USB1000
1535 	USB_DEVICE (0x1737, 0x0039),
1536 	.driver_info = (unsigned long) &ax88178_info,
1537 }, {
1538 	// IO-DATA ETG-US2
1539 	USB_DEVICE (0x04bb, 0x0930),
1540 	.driver_info = (unsigned long) &ax88178_info,
1541 }, {
1542 	// Belkin F5D5055
1543 	USB_DEVICE(0x050d, 0x5055),
1544 	.driver_info = (unsigned long) &ax88178_info,
1545 }, {
1546 	// Apple USB Ethernet Adapter
1547 	USB_DEVICE(0x05ac, 0x1402),
1548 	.driver_info = (unsigned long) &ax88772_info,
1549 }, {
1550 	// Cables-to-Go USB Ethernet Adapter
1551 	USB_DEVICE(0x0b95, 0x772a),
1552 	.driver_info = (unsigned long) &ax88772_info,
1553 }, {
1554 	// ABOCOM for pci
1555 	USB_DEVICE(0x14ea, 0xab11),
1556 	.driver_info = (unsigned long) &ax88178_info,
1557 }, {
1558 	// ASIX 88772a
1559 	USB_DEVICE(0x0db0, 0xa877),
1560 	.driver_info = (unsigned long) &ax88772_info,
1561 }, {
1562 	// Asus USB Ethernet Adapter
1563 	USB_DEVICE (0x0b95, 0x7e2b),
1564 	.driver_info = (unsigned long)&ax88772b_info,
1565 }, {
1566 	/* ASIX 88172a demo board */
1567 	USB_DEVICE(0x0b95, 0x172a),
1568 	.driver_info = (unsigned long) &ax88172a_info,
1569 }, {
1570 	/*
1571 	 * USBLINK HG20F9 "USB 2.0 LAN"
1572 	 * Appears to have gazumped Linksys's manufacturer ID but
1573 	 * doesn't (yet) conflict with any known Linksys product.
1574 	 */
1575 	USB_DEVICE(0x066b, 0x20f9),
1576 	.driver_info = (unsigned long) &hg20f9_info,
1577 }, {
1578 	// Linux Automation GmbH USB 10Base-T1L
1579 	USB_DEVICE(0x33f7, 0x0004),
1580 	.driver_info = (unsigned long) &lxausb_t1l_info,
1581 },
1582 	{ },		// END
1583 };
1584 MODULE_DEVICE_TABLE(usb, products);
1585 
1586 static struct usb_driver asix_driver = {
1587 	.name =		DRIVER_NAME,
1588 	.id_table =	products,
1589 	.probe =	usbnet_probe,
1590 	.suspend =	asix_suspend,
1591 	.resume =	asix_resume,
1592 	.reset_resume =	asix_resume,
1593 	.disconnect =	usbnet_disconnect,
1594 	.supports_autosuspend = 1,
1595 	.disable_hub_initiated_lpm = 1,
1596 };
1597 
1598 module_usb_driver(asix_driver);
1599 
1600 MODULE_AUTHOR("David Hollis");
1601 MODULE_VERSION(DRIVER_VERSION);
1602 MODULE_DESCRIPTION("ASIX AX8817X based USB 2.0 Ethernet Devices");
1603 MODULE_LICENSE("GPL");
1604 
1605