xref: /linux/drivers/net/usb/asix_devices.c (revision 4faff70959d51078f9ee8372f8cff0d7045e4114)
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 	priv->mdio->phy_mask = ~(BIT(priv->phy_addr) | BIT(AX_EMBD_PHY_ADDR));
680 	/* mii bus name is usb-<usb bus number>-<usb device number> */
681 	snprintf(priv->mdio->id, MII_BUS_ID_SIZE, "usb-%03d:%03d",
682 		 dev->udev->bus->busnum, dev->udev->devnum);
683 
684 	ret = mdiobus_register(priv->mdio);
685 	if (ret) {
686 		netdev_err(dev->net, "Could not register MDIO bus (err %d)\n", ret);
687 		mdiobus_free(priv->mdio);
688 		priv->mdio = NULL;
689 	}
690 
691 	return ret;
692 }
693 
ax88772_mdio_unregister(struct asix_common_private * priv)694 static void ax88772_mdio_unregister(struct asix_common_private *priv)
695 {
696 	mdiobus_unregister(priv->mdio);
697 	mdiobus_free(priv->mdio);
698 }
699 
ax88772_init_phy(struct usbnet * dev)700 static int ax88772_init_phy(struct usbnet *dev)
701 {
702 	struct asix_common_private *priv = dev->driver_priv;
703 	int ret;
704 
705 	priv->phydev = mdiobus_get_phy(priv->mdio, priv->phy_addr);
706 	if (!priv->phydev) {
707 		netdev_err(dev->net, "Could not find PHY\n");
708 		return -ENODEV;
709 	}
710 
711 	ret = phylink_connect_phy(priv->phylink, priv->phydev);
712 	if (ret) {
713 		netdev_err(dev->net, "Could not connect PHY\n");
714 		return ret;
715 	}
716 
717 	phy_suspend(priv->phydev);
718 	priv->phydev->mac_managed_pm = true;
719 
720 	phy_attached_info(priv->phydev);
721 
722 	if (priv->embd_phy)
723 		return 0;
724 
725 	/* In case main PHY is not the embedded PHY and MAC is RMII clock
726 	 * provider, we need to suspend embedded PHY by keeping PLL enabled
727 	 * (AX_SWRESET_IPPD == 0).
728 	 */
729 	priv->phydev_int = mdiobus_get_phy(priv->mdio, AX_EMBD_PHY_ADDR);
730 	if (!priv->phydev_int) {
731 		rtnl_lock();
732 		phylink_disconnect_phy(priv->phylink);
733 		rtnl_unlock();
734 		netdev_err(dev->net, "Could not find internal PHY\n");
735 		return -ENODEV;
736 	}
737 
738 	priv->phydev_int->mac_managed_pm = true;
739 	phy_suspend(priv->phydev_int);
740 
741 	return 0;
742 }
743 
ax88772_mac_config(struct phylink_config * config,unsigned int mode,const struct phylink_link_state * state)744 static void ax88772_mac_config(struct phylink_config *config, unsigned int mode,
745 			      const struct phylink_link_state *state)
746 {
747 	/* Nothing to do */
748 }
749 
ax88772_mac_link_down(struct phylink_config * config,unsigned int mode,phy_interface_t interface)750 static void ax88772_mac_link_down(struct phylink_config *config,
751 				 unsigned int mode, phy_interface_t interface)
752 {
753 	struct usbnet *dev = netdev_priv(to_net_dev(config->dev));
754 
755 	asix_write_medium_mode(dev, 0, 0);
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 }
787 
788 static const struct phylink_mac_ops ax88772_phylink_mac_ops = {
789 	.mac_config = ax88772_mac_config,
790 	.mac_link_down = ax88772_mac_link_down,
791 	.mac_link_up = ax88772_mac_link_up,
792 };
793 
ax88772_phylink_setup(struct usbnet * dev)794 static int ax88772_phylink_setup(struct usbnet *dev)
795 {
796 	struct asix_common_private *priv = dev->driver_priv;
797 	phy_interface_t phy_if_mode;
798 	struct phylink *phylink;
799 
800 	priv->phylink_config.dev = &dev->net->dev;
801 	priv->phylink_config.type = PHYLINK_NETDEV;
802 	priv->phylink_config.mac_capabilities = MAC_SYM_PAUSE | MAC_ASYM_PAUSE |
803 		MAC_10 | MAC_100;
804 
805 	__set_bit(PHY_INTERFACE_MODE_INTERNAL,
806 		  priv->phylink_config.supported_interfaces);
807 	__set_bit(PHY_INTERFACE_MODE_RMII,
808 		  priv->phylink_config.supported_interfaces);
809 
810 	if (priv->embd_phy)
811 		phy_if_mode = PHY_INTERFACE_MODE_INTERNAL;
812 	else
813 		phy_if_mode = PHY_INTERFACE_MODE_RMII;
814 
815 	phylink = phylink_create(&priv->phylink_config, dev->net->dev.fwnode,
816 				 phy_if_mode, &ax88772_phylink_mac_ops);
817 	if (IS_ERR(phylink))
818 		return PTR_ERR(phylink);
819 
820 	priv->phylink = phylink;
821 	return 0;
822 }
823 
ax88772_bind(struct usbnet * dev,struct usb_interface * intf)824 static int ax88772_bind(struct usbnet *dev, struct usb_interface *intf)
825 {
826 	struct asix_common_private *priv;
827 	u8 buf[ETH_ALEN] = {0};
828 	int ret, i;
829 
830 	priv = devm_kzalloc(&dev->udev->dev, sizeof(*priv), GFP_KERNEL);
831 	if (!priv)
832 		return -ENOMEM;
833 
834 	dev->driver_priv = priv;
835 
836 	usbnet_get_endpoints(dev, intf);
837 
838 	/* Maybe the boot loader passed the MAC address via device tree */
839 	if (!eth_platform_get_mac_address(&dev->udev->dev, buf)) {
840 		netif_dbg(dev, ifup, dev->net,
841 			  "MAC address read from device tree");
842 	} else {
843 		/* Try getting the MAC address from EEPROM */
844 		if (dev->driver_info->data & FLAG_EEPROM_MAC) {
845 			for (i = 0; i < (ETH_ALEN >> 1); i++) {
846 				ret = asix_read_cmd(dev, AX_CMD_READ_EEPROM,
847 						    0x04 + i, 0, 2, buf + i * 2,
848 						    0);
849 				if (ret < 0)
850 					break;
851 			}
852 		} else {
853 			ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID,
854 					    0, 0, ETH_ALEN, buf, 0);
855 		}
856 
857 		if (ret < 0) {
858 			netdev_dbg(dev->net, "Failed to read MAC address: %d\n",
859 				   ret);
860 			return ret;
861 		}
862 	}
863 
864 	asix_set_netdev_dev_addr(dev, buf);
865 
866 	dev->net->netdev_ops = &ax88772_netdev_ops;
867 	dev->net->ethtool_ops = &ax88772_ethtool_ops;
868 	dev->net->needed_headroom = 4; /* cf asix_tx_fixup() */
869 	dev->net->needed_tailroom = 4; /* cf asix_tx_fixup() */
870 
871 	ret = asix_read_phy_addr(dev, true);
872 	if (ret < 0)
873 		return ret;
874 
875 	priv->phy_addr = ret;
876 	priv->embd_phy = ((priv->phy_addr & 0x1f) == AX_EMBD_PHY_ADDR);
877 
878 	ret = asix_read_cmd(dev, AX_CMD_STATMNGSTS_REG, 0, 0, 1,
879 			    &priv->chipcode, 0);
880 	if (ret < 0) {
881 		netdev_dbg(dev->net, "Failed to read STATMNGSTS_REG: %d\n", ret);
882 		return ret;
883 	}
884 
885 	priv->chipcode &= AX_CHIPCODE_MASK;
886 
887 	priv->resume = ax88772_resume;
888 	priv->suspend = ax88772_suspend;
889 	if (priv->chipcode == AX_AX88772_CHIPCODE)
890 		priv->reset = ax88772_hw_reset;
891 	else
892 		priv->reset = ax88772a_hw_reset;
893 
894 	ret = priv->reset(dev, 0);
895 	if (ret < 0) {
896 		netdev_dbg(dev->net, "Failed to reset AX88772: %d\n", ret);
897 		return ret;
898 	}
899 
900 	/* Asix framing packs multiple eth frames into a 2K usb bulk transfer */
901 	if (dev->driver_info->flags & FLAG_FRAMING_AX) {
902 		/* hard_mtu  is still the default - the device does not support
903 		   jumbo eth frames */
904 		dev->rx_urb_size = 2048;
905 	}
906 
907 	priv->presvd_phy_bmcr = 0;
908 	priv->presvd_phy_advertise = 0;
909 
910 	ret = ax88772_init_mdio(dev);
911 	if (ret)
912 		goto mdio_err;
913 
914 	ret = ax88772_phylink_setup(dev);
915 	if (ret)
916 		goto phylink_err;
917 
918 	ret = ax88772_init_phy(dev);
919 	if (ret)
920 		goto initphy_err;
921 
922 	return 0;
923 
924 initphy_err:
925 	phylink_destroy(priv->phylink);
926 phylink_err:
927 	ax88772_mdio_unregister(priv);
928 mdio_err:
929 	return ret;
930 }
931 
ax88772_stop(struct usbnet * dev)932 static int ax88772_stop(struct usbnet *dev)
933 {
934 	struct asix_common_private *priv = dev->driver_priv;
935 
936 	phylink_stop(priv->phylink);
937 
938 	return 0;
939 }
940 
ax88772_unbind(struct usbnet * dev,struct usb_interface * intf)941 static void ax88772_unbind(struct usbnet *dev, struct usb_interface *intf)
942 {
943 	struct asix_common_private *priv = dev->driver_priv;
944 
945 	rtnl_lock();
946 	phylink_disconnect_phy(priv->phylink);
947 	rtnl_unlock();
948 	phylink_destroy(priv->phylink);
949 	ax88772_mdio_unregister(priv);
950 	asix_rx_fixup_common_free(dev->driver_priv);
951 }
952 
ax88178_unbind(struct usbnet * dev,struct usb_interface * intf)953 static void ax88178_unbind(struct usbnet *dev, struct usb_interface *intf)
954 {
955 	asix_rx_fixup_common_free(dev->driver_priv);
956 	kfree(dev->driver_priv);
957 }
958 
959 static const struct ethtool_ops ax88178_ethtool_ops = {
960 	.get_drvinfo		= asix_get_drvinfo,
961 	.get_link		= asix_get_link,
962 	.get_msglevel		= usbnet_get_msglevel,
963 	.set_msglevel		= usbnet_set_msglevel,
964 	.get_wol		= asix_get_wol,
965 	.set_wol		= asix_set_wol,
966 	.get_eeprom_len		= asix_get_eeprom_len,
967 	.get_eeprom		= asix_get_eeprom,
968 	.set_eeprom		= asix_set_eeprom,
969 	.nway_reset		= usbnet_nway_reset,
970 	.get_link_ksettings	= usbnet_get_link_ksettings_mii,
971 	.set_link_ksettings	= usbnet_set_link_ksettings_mii,
972 };
973 
marvell_phy_init(struct usbnet * dev)974 static int marvell_phy_init(struct usbnet *dev)
975 {
976 	struct asix_data *data = (struct asix_data *)&dev->data;
977 	u16 reg;
978 
979 	netdev_dbg(dev->net, "marvell_phy_init()\n");
980 
981 	reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_MARVELL_STATUS);
982 	netdev_dbg(dev->net, "MII_MARVELL_STATUS = 0x%04x\n", reg);
983 
984 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_MARVELL_CTRL,
985 			MARVELL_CTRL_RXDELAY | MARVELL_CTRL_TXDELAY);
986 
987 	if (data->ledmode) {
988 		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
989 			MII_MARVELL_LED_CTRL);
990 		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (1) = 0x%04x\n", reg);
991 
992 		reg &= 0xf8ff;
993 		reg |= (1 + 0x0100);
994 		asix_mdio_write(dev->net, dev->mii.phy_id,
995 			MII_MARVELL_LED_CTRL, reg);
996 
997 		reg = asix_mdio_read(dev->net, dev->mii.phy_id,
998 			MII_MARVELL_LED_CTRL);
999 		netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (2) = 0x%04x\n", reg);
1000 	}
1001 
1002 	return 0;
1003 }
1004 
rtl8211cl_phy_init(struct usbnet * dev)1005 static int rtl8211cl_phy_init(struct usbnet *dev)
1006 {
1007 	struct asix_data *data = (struct asix_data *)&dev->data;
1008 
1009 	netdev_dbg(dev->net, "rtl8211cl_phy_init()\n");
1010 
1011 	asix_mdio_write (dev->net, dev->mii.phy_id, 0x1f, 0x0005);
1012 	asix_mdio_write (dev->net, dev->mii.phy_id, 0x0c, 0);
1013 	asix_mdio_write (dev->net, dev->mii.phy_id, 0x01,
1014 		asix_mdio_read (dev->net, dev->mii.phy_id, 0x01) | 0x0080);
1015 	asix_mdio_write (dev->net, dev->mii.phy_id, 0x1f, 0);
1016 
1017 	if (data->ledmode == 12) {
1018 		asix_mdio_write (dev->net, dev->mii.phy_id, 0x1f, 0x0002);
1019 		asix_mdio_write (dev->net, dev->mii.phy_id, 0x1a, 0x00cb);
1020 		asix_mdio_write (dev->net, dev->mii.phy_id, 0x1f, 0);
1021 	}
1022 
1023 	return 0;
1024 }
1025 
marvell_led_status(struct usbnet * dev,u16 speed)1026 static int marvell_led_status(struct usbnet *dev, u16 speed)
1027 {
1028 	u16 reg = asix_mdio_read(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL);
1029 
1030 	netdev_dbg(dev->net, "marvell_led_status() read 0x%04x\n", reg);
1031 
1032 	/* Clear out the center LED bits - 0x03F0 */
1033 	reg &= 0xfc0f;
1034 
1035 	switch (speed) {
1036 		case SPEED_1000:
1037 			reg |= 0x03e0;
1038 			break;
1039 		case SPEED_100:
1040 			reg |= 0x03b0;
1041 			break;
1042 		default:
1043 			reg |= 0x02f0;
1044 	}
1045 
1046 	netdev_dbg(dev->net, "marvell_led_status() writing 0x%04x\n", reg);
1047 	asix_mdio_write(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL, reg);
1048 
1049 	return 0;
1050 }
1051 
ax88178_reset(struct usbnet * dev)1052 static int ax88178_reset(struct usbnet *dev)
1053 {
1054 	struct asix_data *data = (struct asix_data *)&dev->data;
1055 	int ret;
1056 	__le16 eeprom;
1057 	u8 status;
1058 	int gpio0 = 0;
1059 	u32 phyid;
1060 
1061 	ret = asix_read_cmd(dev, AX_CMD_READ_GPIOS, 0, 0, 1, &status, 0);
1062 	if (ret < 0) {
1063 		netdev_dbg(dev->net, "Failed to read GPIOS: %d\n", ret);
1064 		return ret;
1065 	}
1066 
1067 	netdev_dbg(dev->net, "GPIO Status: 0x%04x\n", status);
1068 
1069 	asix_write_cmd(dev, AX_CMD_WRITE_ENABLE, 0, 0, 0, NULL, 0);
1070 	ret = asix_read_cmd(dev, AX_CMD_READ_EEPROM, 0x0017, 0, 2, &eeprom, 0);
1071 	if (ret < 0) {
1072 		netdev_dbg(dev->net, "Failed to read EEPROM: %d\n", ret);
1073 		return ret;
1074 	}
1075 
1076 	asix_write_cmd(dev, AX_CMD_WRITE_DISABLE, 0, 0, 0, NULL, 0);
1077 
1078 	netdev_dbg(dev->net, "EEPROM index 0x17 is 0x%04x\n", eeprom);
1079 
1080 	if (eeprom == cpu_to_le16(0xffff)) {
1081 		data->phymode = PHY_MODE_MARVELL;
1082 		data->ledmode = 0;
1083 		gpio0 = 1;
1084 	} else {
1085 		data->phymode = le16_to_cpu(eeprom) & 0x7F;
1086 		data->ledmode = le16_to_cpu(eeprom) >> 8;
1087 		gpio0 = (le16_to_cpu(eeprom) & 0x80) ? 0 : 1;
1088 	}
1089 	netdev_dbg(dev->net, "GPIO0: %d, PhyMode: %d\n", gpio0, data->phymode);
1090 
1091 	/* Power up external GigaPHY through AX88178 GPIO pin */
1092 	asix_write_gpio(dev, AX_GPIO_RSE | AX_GPIO_GPO_1 |
1093 			AX_GPIO_GPO1EN, 40, 0);
1094 	if ((le16_to_cpu(eeprom) >> 8) != 1) {
1095 		asix_write_gpio(dev, 0x003c, 30, 0);
1096 		asix_write_gpio(dev, 0x001c, 300, 0);
1097 		asix_write_gpio(dev, 0x003c, 30, 0);
1098 	} else {
1099 		netdev_dbg(dev->net, "gpio phymode == 1 path\n");
1100 		asix_write_gpio(dev, AX_GPIO_GPO1EN, 30, 0);
1101 		asix_write_gpio(dev, AX_GPIO_GPO1EN | AX_GPIO_GPO_1, 30, 0);
1102 	}
1103 
1104 	/* Read PHYID register *AFTER* powering up PHY */
1105 	phyid = asix_get_phyid(dev);
1106 	netdev_dbg(dev->net, "PHYID=0x%08x\n", phyid);
1107 
1108 	/* Set AX88178 to enable MII/GMII/RGMII interface for external PHY */
1109 	asix_write_cmd(dev, AX_CMD_SW_PHY_SELECT, 0, 0, 0, NULL, 0);
1110 
1111 	asix_sw_reset(dev, 0, 0);
1112 	msleep(150);
1113 
1114 	asix_sw_reset(dev, AX_SWRESET_PRL | AX_SWRESET_IPPD, 0);
1115 	msleep(150);
1116 
1117 	asix_write_rx_ctl(dev, 0, 0);
1118 
1119 	if (data->phymode == PHY_MODE_MARVELL) {
1120 		marvell_phy_init(dev);
1121 		msleep(60);
1122 	} else if (data->phymode == PHY_MODE_RTL8211CL)
1123 		rtl8211cl_phy_init(dev);
1124 
1125 	asix_phy_reset(dev, BMCR_RESET | BMCR_ANENABLE);
1126 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
1127 			ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
1128 	asix_mdio_write(dev->net, dev->mii.phy_id, MII_CTRL1000,
1129 			ADVERTISE_1000FULL);
1130 
1131 	asix_write_medium_mode(dev, AX88178_MEDIUM_DEFAULT, 0);
1132 	mii_nway_restart(&dev->mii);
1133 
1134 	/* Rewrite MAC address */
1135 	memcpy(data->mac_addr, dev->net->dev_addr, ETH_ALEN);
1136 	ret = asix_write_cmd(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN,
1137 							data->mac_addr, 0);
1138 	if (ret < 0)
1139 		return ret;
1140 
1141 	ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL, 0);
1142 	if (ret < 0)
1143 		return ret;
1144 
1145 	return 0;
1146 }
1147 
ax88178_link_reset(struct usbnet * dev)1148 static int ax88178_link_reset(struct usbnet *dev)
1149 {
1150 	u16 mode;
1151 	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
1152 	struct asix_data *data = (struct asix_data *)&dev->data;
1153 	u32 speed;
1154 
1155 	netdev_dbg(dev->net, "ax88178_link_reset()\n");
1156 
1157 	mii_check_media(&dev->mii, 1, 1);
1158 	mii_ethtool_gset(&dev->mii, &ecmd);
1159 	mode = AX88178_MEDIUM_DEFAULT;
1160 	speed = ethtool_cmd_speed(&ecmd);
1161 
1162 	if (speed == SPEED_1000)
1163 		mode |= AX_MEDIUM_GM;
1164 	else if (speed == SPEED_100)
1165 		mode |= AX_MEDIUM_PS;
1166 	else
1167 		mode &= ~(AX_MEDIUM_PS | AX_MEDIUM_GM);
1168 
1169 	mode |= AX_MEDIUM_ENCK;
1170 
1171 	if (ecmd.duplex == DUPLEX_FULL)
1172 		mode |= AX_MEDIUM_FD;
1173 	else
1174 		mode &= ~AX_MEDIUM_FD;
1175 
1176 	netdev_dbg(dev->net, "ax88178_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n",
1177 		   speed, ecmd.duplex, mode);
1178 
1179 	asix_write_medium_mode(dev, mode, 0);
1180 
1181 	if (data->phymode == PHY_MODE_MARVELL && data->ledmode)
1182 		marvell_led_status(dev, speed);
1183 
1184 	return 0;
1185 }
1186 
ax88178_set_mfb(struct usbnet * dev)1187 static void ax88178_set_mfb(struct usbnet *dev)
1188 {
1189 	u16 mfb = AX_RX_CTL_MFB_16384;
1190 	u16 rxctl;
1191 	u16 medium;
1192 	int old_rx_urb_size = dev->rx_urb_size;
1193 
1194 	if (dev->hard_mtu < 2048) {
1195 		dev->rx_urb_size = 2048;
1196 		mfb = AX_RX_CTL_MFB_2048;
1197 	} else if (dev->hard_mtu < 4096) {
1198 		dev->rx_urb_size = 4096;
1199 		mfb = AX_RX_CTL_MFB_4096;
1200 	} else if (dev->hard_mtu < 8192) {
1201 		dev->rx_urb_size = 8192;
1202 		mfb = AX_RX_CTL_MFB_8192;
1203 	} else if (dev->hard_mtu < 16384) {
1204 		dev->rx_urb_size = 16384;
1205 		mfb = AX_RX_CTL_MFB_16384;
1206 	}
1207 
1208 	rxctl = asix_read_rx_ctl(dev, 0);
1209 	asix_write_rx_ctl(dev, (rxctl & ~AX_RX_CTL_MFB_16384) | mfb, 0);
1210 
1211 	medium = asix_read_medium_status(dev, 0);
1212 	if (dev->net->mtu > 1500)
1213 		medium |= AX_MEDIUM_JFE;
1214 	else
1215 		medium &= ~AX_MEDIUM_JFE;
1216 	asix_write_medium_mode(dev, medium, 0);
1217 
1218 	if (dev->rx_urb_size > old_rx_urb_size)
1219 		usbnet_unlink_rx_urbs(dev);
1220 }
1221 
ax88178_change_mtu(struct net_device * net,int new_mtu)1222 static int ax88178_change_mtu(struct net_device *net, int new_mtu)
1223 {
1224 	struct usbnet *dev = netdev_priv(net);
1225 	int ll_mtu = new_mtu + net->hard_header_len + 4;
1226 
1227 	netdev_dbg(dev->net, "ax88178_change_mtu() new_mtu=%d\n", new_mtu);
1228 
1229 	if ((ll_mtu % dev->maxpacket) == 0)
1230 		return -EDOM;
1231 
1232 	WRITE_ONCE(net->mtu, new_mtu);
1233 	dev->hard_mtu = net->mtu + net->hard_header_len;
1234 	ax88178_set_mfb(dev);
1235 
1236 	/* max qlen depend on hard_mtu and rx_urb_size */
1237 	usbnet_update_max_qlen(dev);
1238 
1239 	return 0;
1240 }
1241 
1242 static const struct net_device_ops ax88178_netdev_ops = {
1243 	.ndo_open		= usbnet_open,
1244 	.ndo_stop		= usbnet_stop,
1245 	.ndo_start_xmit		= usbnet_start_xmit,
1246 	.ndo_tx_timeout		= usbnet_tx_timeout,
1247 	.ndo_get_stats64	= dev_get_tstats64,
1248 	.ndo_set_mac_address 	= asix_set_mac_address,
1249 	.ndo_validate_addr	= eth_validate_addr,
1250 	.ndo_set_rx_mode	= asix_set_multicast,
1251 	.ndo_eth_ioctl		= asix_ioctl,
1252 	.ndo_change_mtu 	= ax88178_change_mtu,
1253 };
1254 
ax88178_bind(struct usbnet * dev,struct usb_interface * intf)1255 static int ax88178_bind(struct usbnet *dev, struct usb_interface *intf)
1256 {
1257 	int ret;
1258 	u8 buf[ETH_ALEN] = {0};
1259 
1260 	usbnet_get_endpoints(dev,intf);
1261 
1262 	/* Get the MAC address */
1263 	ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID, 0, 0, ETH_ALEN, buf, 0);
1264 	if (ret < 0) {
1265 		netdev_dbg(dev->net, "Failed to read MAC address: %d\n", ret);
1266 		return ret;
1267 	}
1268 
1269 	asix_set_netdev_dev_addr(dev, buf);
1270 
1271 	/* Initialize MII structure */
1272 	dev->mii.dev = dev->net;
1273 	dev->mii.mdio_read = asix_mdio_read;
1274 	dev->mii.mdio_write = asix_mdio_write;
1275 	dev->mii.phy_id_mask = 0x1f;
1276 	dev->mii.reg_num_mask = 0xff;
1277 	dev->mii.supports_gmii = 1;
1278 
1279 	dev->mii.phy_id = asix_read_phy_addr(dev, true);
1280 	if (dev->mii.phy_id < 0)
1281 		return dev->mii.phy_id;
1282 
1283 	dev->net->netdev_ops = &ax88178_netdev_ops;
1284 	dev->net->ethtool_ops = &ax88178_ethtool_ops;
1285 	dev->net->max_mtu = 16384 - (dev->net->hard_header_len + 4);
1286 
1287 	/* Blink LEDS so users know driver saw dongle */
1288 	asix_sw_reset(dev, 0, 0);
1289 	msleep(150);
1290 
1291 	asix_sw_reset(dev, AX_SWRESET_PRL | AX_SWRESET_IPPD, 0);
1292 	msleep(150);
1293 
1294 	/* Asix framing packs multiple eth frames into a 2K usb bulk transfer */
1295 	if (dev->driver_info->flags & FLAG_FRAMING_AX) {
1296 		/* hard_mtu  is still the default - the device does not support
1297 		   jumbo eth frames */
1298 		dev->rx_urb_size = 2048;
1299 	}
1300 
1301 	dev->driver_priv = kzalloc(sizeof(struct asix_common_private), GFP_KERNEL);
1302 	if (!dev->driver_priv)
1303 			return -ENOMEM;
1304 
1305 	return 0;
1306 }
1307 
1308 static const struct driver_info ax8817x_info = {
1309 	.description = "ASIX AX8817x USB 2.0 Ethernet",
1310 	.bind = ax88172_bind,
1311 	.status = asix_status,
1312 	.link_reset = ax88172_link_reset,
1313 	.reset = ax88172_link_reset,
1314 	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1315 	.data = 0x00130103,
1316 };
1317 
1318 static const struct driver_info dlink_dub_e100_info = {
1319 	.description = "DLink DUB-E100 USB Ethernet",
1320 	.bind = ax88172_bind,
1321 	.status = asix_status,
1322 	.link_reset = ax88172_link_reset,
1323 	.reset = ax88172_link_reset,
1324 	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1325 	.data = 0x009f9d9f,
1326 };
1327 
1328 static const struct driver_info netgear_fa120_info = {
1329 	.description = "Netgear FA-120 USB Ethernet",
1330 	.bind = ax88172_bind,
1331 	.status = asix_status,
1332 	.link_reset = ax88172_link_reset,
1333 	.reset = ax88172_link_reset,
1334 	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1335 	.data = 0x00130103,
1336 };
1337 
1338 static const struct driver_info hawking_uf200_info = {
1339 	.description = "Hawking UF200 USB Ethernet",
1340 	.bind = ax88172_bind,
1341 	.status = asix_status,
1342 	.link_reset = ax88172_link_reset,
1343 	.reset = ax88172_link_reset,
1344 	.flags =  FLAG_ETHER | FLAG_LINK_INTR,
1345 	.data = 0x001f1d1f,
1346 };
1347 
1348 static const struct driver_info ax88772_info = {
1349 	.description = "ASIX AX88772 USB 2.0 Ethernet",
1350 	.bind = ax88772_bind,
1351 	.unbind = ax88772_unbind,
1352 	.reset = ax88772_reset,
1353 	.stop = ax88772_stop,
1354 	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_MULTI_PACKET,
1355 	.rx_fixup = asix_rx_fixup_common,
1356 	.tx_fixup = asix_tx_fixup,
1357 };
1358 
1359 static const struct driver_info ax88772b_info = {
1360 	.description = "ASIX AX88772B USB 2.0 Ethernet",
1361 	.bind = ax88772_bind,
1362 	.unbind = ax88772_unbind,
1363 	.reset = ax88772_reset,
1364 	.stop = ax88772_stop,
1365 	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_MULTI_PACKET,
1366 	.rx_fixup = asix_rx_fixup_common,
1367 	.tx_fixup = asix_tx_fixup,
1368 	.data = FLAG_EEPROM_MAC,
1369 };
1370 
1371 static const struct driver_info lxausb_t1l_info = {
1372 	.description = "Linux Automation GmbH USB 10Base-T1L",
1373 	.bind = ax88772_bind,
1374 	.unbind = ax88772_unbind,
1375 	.reset = ax88772_reset,
1376 	.stop = ax88772_stop,
1377 	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_MULTI_PACKET,
1378 	.rx_fixup = asix_rx_fixup_common,
1379 	.tx_fixup = asix_tx_fixup,
1380 	.data = FLAG_EEPROM_MAC,
1381 };
1382 
1383 static const struct driver_info ax88178_info = {
1384 	.description = "ASIX AX88178 USB 2.0 Ethernet",
1385 	.bind = ax88178_bind,
1386 	.unbind = ax88178_unbind,
1387 	.status = asix_status,
1388 	.link_reset = ax88178_link_reset,
1389 	.reset = ax88178_reset,
1390 	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR |
1391 		 FLAG_MULTI_PACKET,
1392 	.rx_fixup = asix_rx_fixup_common,
1393 	.tx_fixup = asix_tx_fixup,
1394 };
1395 
1396 /*
1397  * USBLINK 20F9 "USB 2.0 LAN" USB ethernet adapter, typically found in
1398  * no-name packaging.
1399  * USB device strings are:
1400  *   1: Manufacturer: USBLINK
1401  *   2: Product: HG20F9 USB2.0
1402  *   3: Serial: 000003
1403  * Appears to be compatible with Asix 88772B.
1404  */
1405 static const struct driver_info hg20f9_info = {
1406 	.description = "HG20F9 USB 2.0 Ethernet",
1407 	.bind = ax88772_bind,
1408 	.unbind = ax88772_unbind,
1409 	.reset = ax88772_reset,
1410 	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_MULTI_PACKET,
1411 	.rx_fixup = asix_rx_fixup_common,
1412 	.tx_fixup = asix_tx_fixup,
1413 	.data = FLAG_EEPROM_MAC,
1414 };
1415 
1416 static const struct driver_info lyconsys_fibergecko100_info = {
1417 	.description = "LyconSys FiberGecko 100 USB 2.0 to SFP Adapter",
1418 	.bind = ax88178_bind,
1419 	.status = asix_status,
1420 	.link_reset = ax88178_link_reset,
1421 	.reset = ax88178_link_reset,
1422 	.flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR |
1423 		 FLAG_MULTI_PACKET,
1424 	.rx_fixup = asix_rx_fixup_common,
1425 	.tx_fixup = asix_tx_fixup,
1426 	.data = 0x20061201,
1427 };
1428 
1429 static const struct usb_device_id	products [] = {
1430 {
1431 	// Linksys USB200M
1432 	USB_DEVICE (0x077b, 0x2226),
1433 	.driver_info =	(unsigned long) &ax8817x_info,
1434 }, {
1435 	// Netgear FA120
1436 	USB_DEVICE (0x0846, 0x1040),
1437 	.driver_info =  (unsigned long) &netgear_fa120_info,
1438 }, {
1439 	// DLink DUB-E100
1440 	USB_DEVICE (0x2001, 0x1a00),
1441 	.driver_info =  (unsigned long) &dlink_dub_e100_info,
1442 }, {
1443 	// Intellinet, ST Lab USB Ethernet
1444 	USB_DEVICE (0x0b95, 0x1720),
1445 	.driver_info =  (unsigned long) &ax8817x_info,
1446 }, {
1447 	// Hawking UF200, TrendNet TU2-ET100
1448 	USB_DEVICE (0x07b8, 0x420a),
1449 	.driver_info =  (unsigned long) &hawking_uf200_info,
1450 }, {
1451 	// Billionton Systems, USB2AR
1452 	USB_DEVICE (0x08dd, 0x90ff),
1453 	.driver_info =  (unsigned long) &ax8817x_info,
1454 }, {
1455 	// Billionton Systems, GUSB2AM-1G-B
1456 	USB_DEVICE(0x08dd, 0x0114),
1457 	.driver_info =  (unsigned long) &ax88178_info,
1458 }, {
1459 	// ATEN UC210T
1460 	USB_DEVICE (0x0557, 0x2009),
1461 	.driver_info =  (unsigned long) &ax8817x_info,
1462 }, {
1463 	// Buffalo LUA-U2-KTX
1464 	USB_DEVICE (0x0411, 0x003d),
1465 	.driver_info =  (unsigned long) &ax8817x_info,
1466 }, {
1467 	// Buffalo LUA-U2-GT 10/100/1000
1468 	USB_DEVICE (0x0411, 0x006e),
1469 	.driver_info =  (unsigned long) &ax88178_info,
1470 }, {
1471 	// Sitecom LN-029 "USB 2.0 10/100 Ethernet adapter"
1472 	USB_DEVICE (0x6189, 0x182d),
1473 	.driver_info =  (unsigned long) &ax8817x_info,
1474 }, {
1475 	// Sitecom LN-031 "USB 2.0 10/100/1000 Ethernet adapter"
1476 	USB_DEVICE (0x0df6, 0x0056),
1477 	.driver_info =  (unsigned long) &ax88178_info,
1478 }, {
1479 	// Sitecom LN-028 "USB 2.0 10/100/1000 Ethernet adapter"
1480 	USB_DEVICE (0x0df6, 0x061c),
1481 	.driver_info =  (unsigned long) &ax88178_info,
1482 }, {
1483 	// corega FEther USB2-TX
1484 	USB_DEVICE (0x07aa, 0x0017),
1485 	.driver_info =  (unsigned long) &ax8817x_info,
1486 }, {
1487 	// Surecom EP-1427X-2
1488 	USB_DEVICE (0x1189, 0x0893),
1489 	.driver_info = (unsigned long) &ax8817x_info,
1490 }, {
1491 	// goodway corp usb gwusb2e
1492 	USB_DEVICE (0x1631, 0x6200),
1493 	.driver_info = (unsigned long) &ax8817x_info,
1494 }, {
1495 	// JVC MP-PRX1 Port Replicator
1496 	USB_DEVICE (0x04f1, 0x3008),
1497 	.driver_info = (unsigned long) &ax8817x_info,
1498 }, {
1499 	// Lenovo U2L100P 10/100
1500 	USB_DEVICE (0x17ef, 0x7203),
1501 	.driver_info = (unsigned long)&ax88772b_info,
1502 }, {
1503 	// ASIX AX88772B 10/100
1504 	USB_DEVICE (0x0b95, 0x772b),
1505 	.driver_info = (unsigned long) &ax88772b_info,
1506 }, {
1507 	// ASIX AX88772 10/100
1508 	USB_DEVICE (0x0b95, 0x7720),
1509 	.driver_info = (unsigned long) &ax88772_info,
1510 }, {
1511 	// ASIX AX88178 10/100/1000
1512 	USB_DEVICE (0x0b95, 0x1780),
1513 	.driver_info = (unsigned long) &ax88178_info,
1514 }, {
1515 	// Logitec LAN-GTJ/U2A
1516 	USB_DEVICE (0x0789, 0x0160),
1517 	.driver_info = (unsigned long) &ax88178_info,
1518 }, {
1519 	// Linksys USB200M Rev 2
1520 	USB_DEVICE (0x13b1, 0x0018),
1521 	.driver_info = (unsigned long) &ax88772_info,
1522 }, {
1523 	// 0Q0 cable ethernet
1524 	USB_DEVICE (0x1557, 0x7720),
1525 	.driver_info = (unsigned long) &ax88772_info,
1526 }, {
1527 	// DLink DUB-E100 H/W Ver B1
1528 	USB_DEVICE (0x07d1, 0x3c05),
1529 	.driver_info = (unsigned long) &ax88772_info,
1530 }, {
1531 	// DLink DUB-E100 H/W Ver B1 Alternate
1532 	USB_DEVICE (0x2001, 0x3c05),
1533 	.driver_info = (unsigned long) &ax88772_info,
1534 }, {
1535        // DLink DUB-E100 H/W Ver C1
1536        USB_DEVICE (0x2001, 0x1a02),
1537        .driver_info = (unsigned long) &ax88772_info,
1538 }, {
1539 	// Linksys USB1000
1540 	USB_DEVICE (0x1737, 0x0039),
1541 	.driver_info = (unsigned long) &ax88178_info,
1542 }, {
1543 	// IO-DATA ETG-US2
1544 	USB_DEVICE (0x04bb, 0x0930),
1545 	.driver_info = (unsigned long) &ax88178_info,
1546 }, {
1547 	// Belkin F5D5055
1548 	USB_DEVICE(0x050d, 0x5055),
1549 	.driver_info = (unsigned long) &ax88178_info,
1550 }, {
1551 	// Apple USB Ethernet Adapter
1552 	USB_DEVICE(0x05ac, 0x1402),
1553 	.driver_info = (unsigned long) &ax88772_info,
1554 }, {
1555 	// Cables-to-Go USB Ethernet Adapter
1556 	USB_DEVICE(0x0b95, 0x772a),
1557 	.driver_info = (unsigned long) &ax88772_info,
1558 }, {
1559 	// ABOCOM for pci
1560 	USB_DEVICE(0x14ea, 0xab11),
1561 	.driver_info = (unsigned long) &ax88178_info,
1562 }, {
1563 	// ASIX 88772a
1564 	USB_DEVICE(0x0db0, 0xa877),
1565 	.driver_info = (unsigned long) &ax88772_info,
1566 }, {
1567 	// Asus USB Ethernet Adapter
1568 	USB_DEVICE (0x0b95, 0x7e2b),
1569 	.driver_info = (unsigned long)&ax88772b_info,
1570 }, {
1571 	/* ASIX 88172a demo board */
1572 	USB_DEVICE(0x0b95, 0x172a),
1573 	.driver_info = (unsigned long) &ax88172a_info,
1574 }, {
1575 	/*
1576 	 * USBLINK HG20F9 "USB 2.0 LAN"
1577 	 * Appears to have gazumped Linksys's manufacturer ID but
1578 	 * doesn't (yet) conflict with any known Linksys product.
1579 	 */
1580 	USB_DEVICE(0x066b, 0x20f9),
1581 	.driver_info = (unsigned long) &hg20f9_info,
1582 }, {
1583 	// Linux Automation GmbH USB 10Base-T1L
1584 	USB_DEVICE(0x33f7, 0x0004),
1585 	.driver_info = (unsigned long) &lxausb_t1l_info,
1586 }, {
1587 	/* LyconSys FiberGecko 100 */
1588 	USB_DEVICE(0x1d2a, 0x0801),
1589 	.driver_info = (unsigned long) &lyconsys_fibergecko100_info,
1590 },
1591 	{ },		// END
1592 };
1593 MODULE_DEVICE_TABLE(usb, products);
1594 
1595 static struct usb_driver asix_driver = {
1596 	.name =		DRIVER_NAME,
1597 	.id_table =	products,
1598 	.probe =	usbnet_probe,
1599 	.suspend =	asix_suspend,
1600 	.resume =	asix_resume,
1601 	.reset_resume =	asix_resume,
1602 	.disconnect =	usbnet_disconnect,
1603 	.supports_autosuspend = 1,
1604 	.disable_hub_initiated_lpm = 1,
1605 };
1606 
1607 module_usb_driver(asix_driver);
1608 
1609 MODULE_AUTHOR("David Hollis");
1610 MODULE_VERSION(DRIVER_VERSION);
1611 MODULE_DESCRIPTION("ASIX AX8817X based USB 2.0 Ethernet Devices");
1612 MODULE_LICENSE("GPL");
1613 
1614