162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
262306a36Sopenharmony_ci /***************************************************************************
362306a36Sopenharmony_ci *
462306a36Sopenharmony_ci * Copyright (C) 2007-2010 SMSC
562306a36Sopenharmony_ci *
662306a36Sopenharmony_ci *****************************************************************************/
762306a36Sopenharmony_ci
862306a36Sopenharmony_ci#include <linux/module.h>
962306a36Sopenharmony_ci#include <linux/kmod.h>
1062306a36Sopenharmony_ci#include <linux/netdevice.h>
1162306a36Sopenharmony_ci#include <linux/etherdevice.h>
1262306a36Sopenharmony_ci#include <linux/ethtool.h>
1362306a36Sopenharmony_ci#include <linux/mii.h>
1462306a36Sopenharmony_ci#include <linux/usb.h>
1562306a36Sopenharmony_ci#include <linux/bitrev.h>
1662306a36Sopenharmony_ci#include <linux/crc16.h>
1762306a36Sopenharmony_ci#include <linux/crc32.h>
1862306a36Sopenharmony_ci#include <linux/usb/usbnet.h>
1962306a36Sopenharmony_ci#include <linux/slab.h>
2062306a36Sopenharmony_ci#include <linux/of_net.h>
2162306a36Sopenharmony_ci#include "smsc75xx.h"
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ci#define SMSC_CHIPNAME			"smsc75xx"
2462306a36Sopenharmony_ci#define SMSC_DRIVER_VERSION		"1.0.0"
2562306a36Sopenharmony_ci#define HS_USB_PKT_SIZE			(512)
2662306a36Sopenharmony_ci#define FS_USB_PKT_SIZE			(64)
2762306a36Sopenharmony_ci#define DEFAULT_HS_BURST_CAP_SIZE	(16 * 1024 + 5 * HS_USB_PKT_SIZE)
2862306a36Sopenharmony_ci#define DEFAULT_FS_BURST_CAP_SIZE	(6 * 1024 + 33 * FS_USB_PKT_SIZE)
2962306a36Sopenharmony_ci#define DEFAULT_BULK_IN_DELAY		(0x00002000)
3062306a36Sopenharmony_ci#define MAX_SINGLE_PACKET_SIZE		(9000)
3162306a36Sopenharmony_ci#define LAN75XX_EEPROM_MAGIC		(0x7500)
3262306a36Sopenharmony_ci#define EEPROM_MAC_OFFSET		(0x01)
3362306a36Sopenharmony_ci#define DEFAULT_TX_CSUM_ENABLE		(true)
3462306a36Sopenharmony_ci#define DEFAULT_RX_CSUM_ENABLE		(true)
3562306a36Sopenharmony_ci#define SMSC75XX_INTERNAL_PHY_ID	(1)
3662306a36Sopenharmony_ci#define SMSC75XX_TX_OVERHEAD		(8)
3762306a36Sopenharmony_ci#define MAX_RX_FIFO_SIZE		(20 * 1024)
3862306a36Sopenharmony_ci#define MAX_TX_FIFO_SIZE		(12 * 1024)
3962306a36Sopenharmony_ci#define USB_VENDOR_ID_SMSC		(0x0424)
4062306a36Sopenharmony_ci#define USB_PRODUCT_ID_LAN7500		(0x7500)
4162306a36Sopenharmony_ci#define USB_PRODUCT_ID_LAN7505		(0x7505)
4262306a36Sopenharmony_ci#define RXW_PADDING			2
4362306a36Sopenharmony_ci#define SUPPORTED_WAKE			(WAKE_PHY | WAKE_UCAST | WAKE_BCAST | \
4462306a36Sopenharmony_ci					 WAKE_MCAST | WAKE_ARP | WAKE_MAGIC)
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_ci#define SUSPEND_SUSPEND0		(0x01)
4762306a36Sopenharmony_ci#define SUSPEND_SUSPEND1		(0x02)
4862306a36Sopenharmony_ci#define SUSPEND_SUSPEND2		(0x04)
4962306a36Sopenharmony_ci#define SUSPEND_SUSPEND3		(0x08)
5062306a36Sopenharmony_ci#define SUSPEND_ALLMODES		(SUSPEND_SUSPEND0 | SUSPEND_SUSPEND1 | \
5162306a36Sopenharmony_ci					 SUSPEND_SUSPEND2 | SUSPEND_SUSPEND3)
5262306a36Sopenharmony_ci
5362306a36Sopenharmony_cistruct smsc75xx_priv {
5462306a36Sopenharmony_ci	struct usbnet *dev;
5562306a36Sopenharmony_ci	u32 rfe_ctl;
5662306a36Sopenharmony_ci	u32 wolopts;
5762306a36Sopenharmony_ci	u32 multicast_hash_table[DP_SEL_VHF_HASH_LEN];
5862306a36Sopenharmony_ci	struct mutex dataport_mutex;
5962306a36Sopenharmony_ci	spinlock_t rfe_ctl_lock;
6062306a36Sopenharmony_ci	struct work_struct set_multicast;
6162306a36Sopenharmony_ci	u8 suspend_flags;
6262306a36Sopenharmony_ci};
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_cistruct usb_context {
6562306a36Sopenharmony_ci	struct usb_ctrlrequest req;
6662306a36Sopenharmony_ci	struct usbnet *dev;
6762306a36Sopenharmony_ci};
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_cistatic bool turbo_mode = true;
7062306a36Sopenharmony_cimodule_param(turbo_mode, bool, 0644);
7162306a36Sopenharmony_ciMODULE_PARM_DESC(turbo_mode, "Enable multiple frames per Rx transaction");
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_cistatic int smsc75xx_link_ok_nopm(struct usbnet *dev);
7462306a36Sopenharmony_cistatic int smsc75xx_phy_gig_workaround(struct usbnet *dev);
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_cistatic int __must_check __smsc75xx_read_reg(struct usbnet *dev, u32 index,
7762306a36Sopenharmony_ci					    u32 *data, int in_pm)
7862306a36Sopenharmony_ci{
7962306a36Sopenharmony_ci	u32 buf;
8062306a36Sopenharmony_ci	int ret;
8162306a36Sopenharmony_ci	int (*fn)(struct usbnet *, u8, u8, u16, u16, void *, u16);
8262306a36Sopenharmony_ci
8362306a36Sopenharmony_ci	BUG_ON(!dev);
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_ci	if (!in_pm)
8662306a36Sopenharmony_ci		fn = usbnet_read_cmd;
8762306a36Sopenharmony_ci	else
8862306a36Sopenharmony_ci		fn = usbnet_read_cmd_nopm;
8962306a36Sopenharmony_ci
9062306a36Sopenharmony_ci	ret = fn(dev, USB_VENDOR_REQUEST_READ_REGISTER, USB_DIR_IN
9162306a36Sopenharmony_ci		 | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
9262306a36Sopenharmony_ci		 0, index, &buf, 4);
9362306a36Sopenharmony_ci	if (unlikely(ret < 4)) {
9462306a36Sopenharmony_ci		ret = ret < 0 ? ret : -ENODATA;
9562306a36Sopenharmony_ci
9662306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read reg index 0x%08x: %d\n",
9762306a36Sopenharmony_ci			    index, ret);
9862306a36Sopenharmony_ci		return ret;
9962306a36Sopenharmony_ci	}
10062306a36Sopenharmony_ci
10162306a36Sopenharmony_ci	le32_to_cpus(&buf);
10262306a36Sopenharmony_ci	*data = buf;
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci	return ret;
10562306a36Sopenharmony_ci}
10662306a36Sopenharmony_ci
10762306a36Sopenharmony_cistatic int __must_check __smsc75xx_write_reg(struct usbnet *dev, u32 index,
10862306a36Sopenharmony_ci					     u32 data, int in_pm)
10962306a36Sopenharmony_ci{
11062306a36Sopenharmony_ci	u32 buf;
11162306a36Sopenharmony_ci	int ret;
11262306a36Sopenharmony_ci	int (*fn)(struct usbnet *, u8, u8, u16, u16, const void *, u16);
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_ci	BUG_ON(!dev);
11562306a36Sopenharmony_ci
11662306a36Sopenharmony_ci	if (!in_pm)
11762306a36Sopenharmony_ci		fn = usbnet_write_cmd;
11862306a36Sopenharmony_ci	else
11962306a36Sopenharmony_ci		fn = usbnet_write_cmd_nopm;
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_ci	buf = data;
12262306a36Sopenharmony_ci	cpu_to_le32s(&buf);
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_ci	ret = fn(dev, USB_VENDOR_REQUEST_WRITE_REGISTER, USB_DIR_OUT
12562306a36Sopenharmony_ci		 | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
12662306a36Sopenharmony_ci		 0, index, &buf, 4);
12762306a36Sopenharmony_ci	if (unlikely(ret < 0))
12862306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write reg index 0x%08x: %d\n",
12962306a36Sopenharmony_ci			    index, ret);
13062306a36Sopenharmony_ci
13162306a36Sopenharmony_ci	return ret;
13262306a36Sopenharmony_ci}
13362306a36Sopenharmony_ci
13462306a36Sopenharmony_cistatic int __must_check smsc75xx_read_reg_nopm(struct usbnet *dev, u32 index,
13562306a36Sopenharmony_ci					       u32 *data)
13662306a36Sopenharmony_ci{
13762306a36Sopenharmony_ci	return __smsc75xx_read_reg(dev, index, data, 1);
13862306a36Sopenharmony_ci}
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_cistatic int __must_check smsc75xx_write_reg_nopm(struct usbnet *dev, u32 index,
14162306a36Sopenharmony_ci						u32 data)
14262306a36Sopenharmony_ci{
14362306a36Sopenharmony_ci	return __smsc75xx_write_reg(dev, index, data, 1);
14462306a36Sopenharmony_ci}
14562306a36Sopenharmony_ci
14662306a36Sopenharmony_cistatic int __must_check smsc75xx_read_reg(struct usbnet *dev, u32 index,
14762306a36Sopenharmony_ci					  u32 *data)
14862306a36Sopenharmony_ci{
14962306a36Sopenharmony_ci	return __smsc75xx_read_reg(dev, index, data, 0);
15062306a36Sopenharmony_ci}
15162306a36Sopenharmony_ci
15262306a36Sopenharmony_cistatic int __must_check smsc75xx_write_reg(struct usbnet *dev, u32 index,
15362306a36Sopenharmony_ci					   u32 data)
15462306a36Sopenharmony_ci{
15562306a36Sopenharmony_ci	return __smsc75xx_write_reg(dev, index, data, 0);
15662306a36Sopenharmony_ci}
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_ci/* Loop until the read is completed with timeout
15962306a36Sopenharmony_ci * called with phy_mutex held */
16062306a36Sopenharmony_cistatic __must_check int __smsc75xx_phy_wait_not_busy(struct usbnet *dev,
16162306a36Sopenharmony_ci						     int in_pm)
16262306a36Sopenharmony_ci{
16362306a36Sopenharmony_ci	unsigned long start_time = jiffies;
16462306a36Sopenharmony_ci	u32 val;
16562306a36Sopenharmony_ci	int ret;
16662306a36Sopenharmony_ci
16762306a36Sopenharmony_ci	do {
16862306a36Sopenharmony_ci		ret = __smsc75xx_read_reg(dev, MII_ACCESS, &val, in_pm);
16962306a36Sopenharmony_ci		if (ret < 0) {
17062306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading MII_ACCESS\n");
17162306a36Sopenharmony_ci			return ret;
17262306a36Sopenharmony_ci		}
17362306a36Sopenharmony_ci
17462306a36Sopenharmony_ci		if (!(val & MII_ACCESS_BUSY))
17562306a36Sopenharmony_ci			return 0;
17662306a36Sopenharmony_ci	} while (!time_after(jiffies, start_time + HZ));
17762306a36Sopenharmony_ci
17862306a36Sopenharmony_ci	return -EIO;
17962306a36Sopenharmony_ci}
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_cistatic int __smsc75xx_mdio_read(struct net_device *netdev, int phy_id, int idx,
18262306a36Sopenharmony_ci				int in_pm)
18362306a36Sopenharmony_ci{
18462306a36Sopenharmony_ci	struct usbnet *dev = netdev_priv(netdev);
18562306a36Sopenharmony_ci	u32 val, addr;
18662306a36Sopenharmony_ci	int ret;
18762306a36Sopenharmony_ci
18862306a36Sopenharmony_ci	mutex_lock(&dev->phy_mutex);
18962306a36Sopenharmony_ci
19062306a36Sopenharmony_ci	/* confirm MII not busy */
19162306a36Sopenharmony_ci	ret = __smsc75xx_phy_wait_not_busy(dev, in_pm);
19262306a36Sopenharmony_ci	if (ret < 0) {
19362306a36Sopenharmony_ci		netdev_warn(dev->net, "MII is busy in smsc75xx_mdio_read\n");
19462306a36Sopenharmony_ci		goto done;
19562306a36Sopenharmony_ci	}
19662306a36Sopenharmony_ci
19762306a36Sopenharmony_ci	/* set the address, index & direction (read from PHY) */
19862306a36Sopenharmony_ci	phy_id &= dev->mii.phy_id_mask;
19962306a36Sopenharmony_ci	idx &= dev->mii.reg_num_mask;
20062306a36Sopenharmony_ci	addr = ((phy_id << MII_ACCESS_PHY_ADDR_SHIFT) & MII_ACCESS_PHY_ADDR)
20162306a36Sopenharmony_ci		| ((idx << MII_ACCESS_REG_ADDR_SHIFT) & MII_ACCESS_REG_ADDR)
20262306a36Sopenharmony_ci		| MII_ACCESS_READ | MII_ACCESS_BUSY;
20362306a36Sopenharmony_ci	ret = __smsc75xx_write_reg(dev, MII_ACCESS, addr, in_pm);
20462306a36Sopenharmony_ci	if (ret < 0) {
20562306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing MII_ACCESS\n");
20662306a36Sopenharmony_ci		goto done;
20762306a36Sopenharmony_ci	}
20862306a36Sopenharmony_ci
20962306a36Sopenharmony_ci	ret = __smsc75xx_phy_wait_not_busy(dev, in_pm);
21062306a36Sopenharmony_ci	if (ret < 0) {
21162306a36Sopenharmony_ci		netdev_warn(dev->net, "Timed out reading MII reg %02X\n", idx);
21262306a36Sopenharmony_ci		goto done;
21362306a36Sopenharmony_ci	}
21462306a36Sopenharmony_ci
21562306a36Sopenharmony_ci	ret = __smsc75xx_read_reg(dev, MII_DATA, &val, in_pm);
21662306a36Sopenharmony_ci	if (ret < 0) {
21762306a36Sopenharmony_ci		netdev_warn(dev->net, "Error reading MII_DATA\n");
21862306a36Sopenharmony_ci		goto done;
21962306a36Sopenharmony_ci	}
22062306a36Sopenharmony_ci
22162306a36Sopenharmony_ci	ret = (u16)(val & 0xFFFF);
22262306a36Sopenharmony_ci
22362306a36Sopenharmony_cidone:
22462306a36Sopenharmony_ci	mutex_unlock(&dev->phy_mutex);
22562306a36Sopenharmony_ci	return ret;
22662306a36Sopenharmony_ci}
22762306a36Sopenharmony_ci
22862306a36Sopenharmony_cistatic void __smsc75xx_mdio_write(struct net_device *netdev, int phy_id,
22962306a36Sopenharmony_ci				  int idx, int regval, int in_pm)
23062306a36Sopenharmony_ci{
23162306a36Sopenharmony_ci	struct usbnet *dev = netdev_priv(netdev);
23262306a36Sopenharmony_ci	u32 val, addr;
23362306a36Sopenharmony_ci	int ret;
23462306a36Sopenharmony_ci
23562306a36Sopenharmony_ci	mutex_lock(&dev->phy_mutex);
23662306a36Sopenharmony_ci
23762306a36Sopenharmony_ci	/* confirm MII not busy */
23862306a36Sopenharmony_ci	ret = __smsc75xx_phy_wait_not_busy(dev, in_pm);
23962306a36Sopenharmony_ci	if (ret < 0) {
24062306a36Sopenharmony_ci		netdev_warn(dev->net, "MII is busy in smsc75xx_mdio_write\n");
24162306a36Sopenharmony_ci		goto done;
24262306a36Sopenharmony_ci	}
24362306a36Sopenharmony_ci
24462306a36Sopenharmony_ci	val = regval;
24562306a36Sopenharmony_ci	ret = __smsc75xx_write_reg(dev, MII_DATA, val, in_pm);
24662306a36Sopenharmony_ci	if (ret < 0) {
24762306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing MII_DATA\n");
24862306a36Sopenharmony_ci		goto done;
24962306a36Sopenharmony_ci	}
25062306a36Sopenharmony_ci
25162306a36Sopenharmony_ci	/* set the address, index & direction (write to PHY) */
25262306a36Sopenharmony_ci	phy_id &= dev->mii.phy_id_mask;
25362306a36Sopenharmony_ci	idx &= dev->mii.reg_num_mask;
25462306a36Sopenharmony_ci	addr = ((phy_id << MII_ACCESS_PHY_ADDR_SHIFT) & MII_ACCESS_PHY_ADDR)
25562306a36Sopenharmony_ci		| ((idx << MII_ACCESS_REG_ADDR_SHIFT) & MII_ACCESS_REG_ADDR)
25662306a36Sopenharmony_ci		| MII_ACCESS_WRITE | MII_ACCESS_BUSY;
25762306a36Sopenharmony_ci	ret = __smsc75xx_write_reg(dev, MII_ACCESS, addr, in_pm);
25862306a36Sopenharmony_ci	if (ret < 0) {
25962306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing MII_ACCESS\n");
26062306a36Sopenharmony_ci		goto done;
26162306a36Sopenharmony_ci	}
26262306a36Sopenharmony_ci
26362306a36Sopenharmony_ci	ret = __smsc75xx_phy_wait_not_busy(dev, in_pm);
26462306a36Sopenharmony_ci	if (ret < 0) {
26562306a36Sopenharmony_ci		netdev_warn(dev->net, "Timed out writing MII reg %02X\n", idx);
26662306a36Sopenharmony_ci		goto done;
26762306a36Sopenharmony_ci	}
26862306a36Sopenharmony_ci
26962306a36Sopenharmony_cidone:
27062306a36Sopenharmony_ci	mutex_unlock(&dev->phy_mutex);
27162306a36Sopenharmony_ci}
27262306a36Sopenharmony_ci
27362306a36Sopenharmony_cistatic int smsc75xx_mdio_read_nopm(struct net_device *netdev, int phy_id,
27462306a36Sopenharmony_ci				   int idx)
27562306a36Sopenharmony_ci{
27662306a36Sopenharmony_ci	return __smsc75xx_mdio_read(netdev, phy_id, idx, 1);
27762306a36Sopenharmony_ci}
27862306a36Sopenharmony_ci
27962306a36Sopenharmony_cistatic void smsc75xx_mdio_write_nopm(struct net_device *netdev, int phy_id,
28062306a36Sopenharmony_ci				     int idx, int regval)
28162306a36Sopenharmony_ci{
28262306a36Sopenharmony_ci	__smsc75xx_mdio_write(netdev, phy_id, idx, regval, 1);
28362306a36Sopenharmony_ci}
28462306a36Sopenharmony_ci
28562306a36Sopenharmony_cistatic int smsc75xx_mdio_read(struct net_device *netdev, int phy_id, int idx)
28662306a36Sopenharmony_ci{
28762306a36Sopenharmony_ci	return __smsc75xx_mdio_read(netdev, phy_id, idx, 0);
28862306a36Sopenharmony_ci}
28962306a36Sopenharmony_ci
29062306a36Sopenharmony_cistatic void smsc75xx_mdio_write(struct net_device *netdev, int phy_id, int idx,
29162306a36Sopenharmony_ci				int regval)
29262306a36Sopenharmony_ci{
29362306a36Sopenharmony_ci	__smsc75xx_mdio_write(netdev, phy_id, idx, regval, 0);
29462306a36Sopenharmony_ci}
29562306a36Sopenharmony_ci
29662306a36Sopenharmony_cistatic int smsc75xx_wait_eeprom(struct usbnet *dev)
29762306a36Sopenharmony_ci{
29862306a36Sopenharmony_ci	unsigned long start_time = jiffies;
29962306a36Sopenharmony_ci	u32 val;
30062306a36Sopenharmony_ci	int ret;
30162306a36Sopenharmony_ci
30262306a36Sopenharmony_ci	do {
30362306a36Sopenharmony_ci		ret = smsc75xx_read_reg(dev, E2P_CMD, &val);
30462306a36Sopenharmony_ci		if (ret < 0) {
30562306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading E2P_CMD\n");
30662306a36Sopenharmony_ci			return ret;
30762306a36Sopenharmony_ci		}
30862306a36Sopenharmony_ci
30962306a36Sopenharmony_ci		if (!(val & E2P_CMD_BUSY) || (val & E2P_CMD_TIMEOUT))
31062306a36Sopenharmony_ci			break;
31162306a36Sopenharmony_ci		udelay(40);
31262306a36Sopenharmony_ci	} while (!time_after(jiffies, start_time + HZ));
31362306a36Sopenharmony_ci
31462306a36Sopenharmony_ci	if (val & (E2P_CMD_TIMEOUT | E2P_CMD_BUSY)) {
31562306a36Sopenharmony_ci		netdev_warn(dev->net, "EEPROM read operation timeout\n");
31662306a36Sopenharmony_ci		return -EIO;
31762306a36Sopenharmony_ci	}
31862306a36Sopenharmony_ci
31962306a36Sopenharmony_ci	return 0;
32062306a36Sopenharmony_ci}
32162306a36Sopenharmony_ci
32262306a36Sopenharmony_cistatic int smsc75xx_eeprom_confirm_not_busy(struct usbnet *dev)
32362306a36Sopenharmony_ci{
32462306a36Sopenharmony_ci	unsigned long start_time = jiffies;
32562306a36Sopenharmony_ci	u32 val;
32662306a36Sopenharmony_ci	int ret;
32762306a36Sopenharmony_ci
32862306a36Sopenharmony_ci	do {
32962306a36Sopenharmony_ci		ret = smsc75xx_read_reg(dev, E2P_CMD, &val);
33062306a36Sopenharmony_ci		if (ret < 0) {
33162306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading E2P_CMD\n");
33262306a36Sopenharmony_ci			return ret;
33362306a36Sopenharmony_ci		}
33462306a36Sopenharmony_ci
33562306a36Sopenharmony_ci		if (!(val & E2P_CMD_BUSY))
33662306a36Sopenharmony_ci			return 0;
33762306a36Sopenharmony_ci
33862306a36Sopenharmony_ci		udelay(40);
33962306a36Sopenharmony_ci	} while (!time_after(jiffies, start_time + HZ));
34062306a36Sopenharmony_ci
34162306a36Sopenharmony_ci	netdev_warn(dev->net, "EEPROM is busy\n");
34262306a36Sopenharmony_ci	return -EIO;
34362306a36Sopenharmony_ci}
34462306a36Sopenharmony_ci
34562306a36Sopenharmony_cistatic int smsc75xx_read_eeprom(struct usbnet *dev, u32 offset, u32 length,
34662306a36Sopenharmony_ci				u8 *data)
34762306a36Sopenharmony_ci{
34862306a36Sopenharmony_ci	u32 val;
34962306a36Sopenharmony_ci	int i, ret;
35062306a36Sopenharmony_ci
35162306a36Sopenharmony_ci	BUG_ON(!dev);
35262306a36Sopenharmony_ci	BUG_ON(!data);
35362306a36Sopenharmony_ci
35462306a36Sopenharmony_ci	ret = smsc75xx_eeprom_confirm_not_busy(dev);
35562306a36Sopenharmony_ci	if (ret)
35662306a36Sopenharmony_ci		return ret;
35762306a36Sopenharmony_ci
35862306a36Sopenharmony_ci	for (i = 0; i < length; i++) {
35962306a36Sopenharmony_ci		val = E2P_CMD_BUSY | E2P_CMD_READ | (offset & E2P_CMD_ADDR);
36062306a36Sopenharmony_ci		ret = smsc75xx_write_reg(dev, E2P_CMD, val);
36162306a36Sopenharmony_ci		if (ret < 0) {
36262306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing E2P_CMD\n");
36362306a36Sopenharmony_ci			return ret;
36462306a36Sopenharmony_ci		}
36562306a36Sopenharmony_ci
36662306a36Sopenharmony_ci		ret = smsc75xx_wait_eeprom(dev);
36762306a36Sopenharmony_ci		if (ret < 0)
36862306a36Sopenharmony_ci			return ret;
36962306a36Sopenharmony_ci
37062306a36Sopenharmony_ci		ret = smsc75xx_read_reg(dev, E2P_DATA, &val);
37162306a36Sopenharmony_ci		if (ret < 0) {
37262306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading E2P_DATA\n");
37362306a36Sopenharmony_ci			return ret;
37462306a36Sopenharmony_ci		}
37562306a36Sopenharmony_ci
37662306a36Sopenharmony_ci		data[i] = val & 0xFF;
37762306a36Sopenharmony_ci		offset++;
37862306a36Sopenharmony_ci	}
37962306a36Sopenharmony_ci
38062306a36Sopenharmony_ci	return 0;
38162306a36Sopenharmony_ci}
38262306a36Sopenharmony_ci
38362306a36Sopenharmony_cistatic int smsc75xx_write_eeprom(struct usbnet *dev, u32 offset, u32 length,
38462306a36Sopenharmony_ci				 u8 *data)
38562306a36Sopenharmony_ci{
38662306a36Sopenharmony_ci	u32 val;
38762306a36Sopenharmony_ci	int i, ret;
38862306a36Sopenharmony_ci
38962306a36Sopenharmony_ci	BUG_ON(!dev);
39062306a36Sopenharmony_ci	BUG_ON(!data);
39162306a36Sopenharmony_ci
39262306a36Sopenharmony_ci	ret = smsc75xx_eeprom_confirm_not_busy(dev);
39362306a36Sopenharmony_ci	if (ret)
39462306a36Sopenharmony_ci		return ret;
39562306a36Sopenharmony_ci
39662306a36Sopenharmony_ci	/* Issue write/erase enable command */
39762306a36Sopenharmony_ci	val = E2P_CMD_BUSY | E2P_CMD_EWEN;
39862306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, E2P_CMD, val);
39962306a36Sopenharmony_ci	if (ret < 0) {
40062306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing E2P_CMD\n");
40162306a36Sopenharmony_ci		return ret;
40262306a36Sopenharmony_ci	}
40362306a36Sopenharmony_ci
40462306a36Sopenharmony_ci	ret = smsc75xx_wait_eeprom(dev);
40562306a36Sopenharmony_ci	if (ret < 0)
40662306a36Sopenharmony_ci		return ret;
40762306a36Sopenharmony_ci
40862306a36Sopenharmony_ci	for (i = 0; i < length; i++) {
40962306a36Sopenharmony_ci
41062306a36Sopenharmony_ci		/* Fill data register */
41162306a36Sopenharmony_ci		val = data[i];
41262306a36Sopenharmony_ci		ret = smsc75xx_write_reg(dev, E2P_DATA, val);
41362306a36Sopenharmony_ci		if (ret < 0) {
41462306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing E2P_DATA\n");
41562306a36Sopenharmony_ci			return ret;
41662306a36Sopenharmony_ci		}
41762306a36Sopenharmony_ci
41862306a36Sopenharmony_ci		/* Send "write" command */
41962306a36Sopenharmony_ci		val = E2P_CMD_BUSY | E2P_CMD_WRITE | (offset & E2P_CMD_ADDR);
42062306a36Sopenharmony_ci		ret = smsc75xx_write_reg(dev, E2P_CMD, val);
42162306a36Sopenharmony_ci		if (ret < 0) {
42262306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing E2P_CMD\n");
42362306a36Sopenharmony_ci			return ret;
42462306a36Sopenharmony_ci		}
42562306a36Sopenharmony_ci
42662306a36Sopenharmony_ci		ret = smsc75xx_wait_eeprom(dev);
42762306a36Sopenharmony_ci		if (ret < 0)
42862306a36Sopenharmony_ci			return ret;
42962306a36Sopenharmony_ci
43062306a36Sopenharmony_ci		offset++;
43162306a36Sopenharmony_ci	}
43262306a36Sopenharmony_ci
43362306a36Sopenharmony_ci	return 0;
43462306a36Sopenharmony_ci}
43562306a36Sopenharmony_ci
43662306a36Sopenharmony_cistatic int smsc75xx_dataport_wait_not_busy(struct usbnet *dev)
43762306a36Sopenharmony_ci{
43862306a36Sopenharmony_ci	int i, ret;
43962306a36Sopenharmony_ci
44062306a36Sopenharmony_ci	for (i = 0; i < 100; i++) {
44162306a36Sopenharmony_ci		u32 dp_sel;
44262306a36Sopenharmony_ci		ret = smsc75xx_read_reg(dev, DP_SEL, &dp_sel);
44362306a36Sopenharmony_ci		if (ret < 0) {
44462306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading DP_SEL\n");
44562306a36Sopenharmony_ci			return ret;
44662306a36Sopenharmony_ci		}
44762306a36Sopenharmony_ci
44862306a36Sopenharmony_ci		if (dp_sel & DP_SEL_DPRDY)
44962306a36Sopenharmony_ci			return 0;
45062306a36Sopenharmony_ci
45162306a36Sopenharmony_ci		udelay(40);
45262306a36Sopenharmony_ci	}
45362306a36Sopenharmony_ci
45462306a36Sopenharmony_ci	netdev_warn(dev->net, "smsc75xx_dataport_wait_not_busy timed out\n");
45562306a36Sopenharmony_ci
45662306a36Sopenharmony_ci	return -EIO;
45762306a36Sopenharmony_ci}
45862306a36Sopenharmony_ci
45962306a36Sopenharmony_cistatic int smsc75xx_dataport_write(struct usbnet *dev, u32 ram_select, u32 addr,
46062306a36Sopenharmony_ci				   u32 length, u32 *buf)
46162306a36Sopenharmony_ci{
46262306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
46362306a36Sopenharmony_ci	u32 dp_sel;
46462306a36Sopenharmony_ci	int i, ret;
46562306a36Sopenharmony_ci
46662306a36Sopenharmony_ci	mutex_lock(&pdata->dataport_mutex);
46762306a36Sopenharmony_ci
46862306a36Sopenharmony_ci	ret = smsc75xx_dataport_wait_not_busy(dev);
46962306a36Sopenharmony_ci	if (ret < 0) {
47062306a36Sopenharmony_ci		netdev_warn(dev->net, "smsc75xx_dataport_write busy on entry\n");
47162306a36Sopenharmony_ci		goto done;
47262306a36Sopenharmony_ci	}
47362306a36Sopenharmony_ci
47462306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, DP_SEL, &dp_sel);
47562306a36Sopenharmony_ci	if (ret < 0) {
47662306a36Sopenharmony_ci		netdev_warn(dev->net, "Error reading DP_SEL\n");
47762306a36Sopenharmony_ci		goto done;
47862306a36Sopenharmony_ci	}
47962306a36Sopenharmony_ci
48062306a36Sopenharmony_ci	dp_sel &= ~DP_SEL_RSEL;
48162306a36Sopenharmony_ci	dp_sel |= ram_select;
48262306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, DP_SEL, dp_sel);
48362306a36Sopenharmony_ci	if (ret < 0) {
48462306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing DP_SEL\n");
48562306a36Sopenharmony_ci		goto done;
48662306a36Sopenharmony_ci	}
48762306a36Sopenharmony_ci
48862306a36Sopenharmony_ci	for (i = 0; i < length; i++) {
48962306a36Sopenharmony_ci		ret = smsc75xx_write_reg(dev, DP_ADDR, addr + i);
49062306a36Sopenharmony_ci		if (ret < 0) {
49162306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing DP_ADDR\n");
49262306a36Sopenharmony_ci			goto done;
49362306a36Sopenharmony_ci		}
49462306a36Sopenharmony_ci
49562306a36Sopenharmony_ci		ret = smsc75xx_write_reg(dev, DP_DATA, buf[i]);
49662306a36Sopenharmony_ci		if (ret < 0) {
49762306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing DP_DATA\n");
49862306a36Sopenharmony_ci			goto done;
49962306a36Sopenharmony_ci		}
50062306a36Sopenharmony_ci
50162306a36Sopenharmony_ci		ret = smsc75xx_write_reg(dev, DP_CMD, DP_CMD_WRITE);
50262306a36Sopenharmony_ci		if (ret < 0) {
50362306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing DP_CMD\n");
50462306a36Sopenharmony_ci			goto done;
50562306a36Sopenharmony_ci		}
50662306a36Sopenharmony_ci
50762306a36Sopenharmony_ci		ret = smsc75xx_dataport_wait_not_busy(dev);
50862306a36Sopenharmony_ci		if (ret < 0) {
50962306a36Sopenharmony_ci			netdev_warn(dev->net, "smsc75xx_dataport_write timeout\n");
51062306a36Sopenharmony_ci			goto done;
51162306a36Sopenharmony_ci		}
51262306a36Sopenharmony_ci	}
51362306a36Sopenharmony_ci
51462306a36Sopenharmony_cidone:
51562306a36Sopenharmony_ci	mutex_unlock(&pdata->dataport_mutex);
51662306a36Sopenharmony_ci	return ret;
51762306a36Sopenharmony_ci}
51862306a36Sopenharmony_ci
51962306a36Sopenharmony_ci/* returns hash bit number for given MAC address */
52062306a36Sopenharmony_cistatic u32 smsc75xx_hash(char addr[ETH_ALEN])
52162306a36Sopenharmony_ci{
52262306a36Sopenharmony_ci	return (ether_crc(ETH_ALEN, addr) >> 23) & 0x1ff;
52362306a36Sopenharmony_ci}
52462306a36Sopenharmony_ci
52562306a36Sopenharmony_cistatic void smsc75xx_deferred_multicast_write(struct work_struct *param)
52662306a36Sopenharmony_ci{
52762306a36Sopenharmony_ci	struct smsc75xx_priv *pdata =
52862306a36Sopenharmony_ci		container_of(param, struct smsc75xx_priv, set_multicast);
52962306a36Sopenharmony_ci	struct usbnet *dev = pdata->dev;
53062306a36Sopenharmony_ci	int ret;
53162306a36Sopenharmony_ci
53262306a36Sopenharmony_ci	netif_dbg(dev, drv, dev->net, "deferred multicast write 0x%08x\n",
53362306a36Sopenharmony_ci		  pdata->rfe_ctl);
53462306a36Sopenharmony_ci
53562306a36Sopenharmony_ci	smsc75xx_dataport_write(dev, DP_SEL_VHF, DP_SEL_VHF_VLAN_LEN,
53662306a36Sopenharmony_ci		DP_SEL_VHF_HASH_LEN, pdata->multicast_hash_table);
53762306a36Sopenharmony_ci
53862306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, RFE_CTL, pdata->rfe_ctl);
53962306a36Sopenharmony_ci	if (ret < 0)
54062306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing RFE_CRL\n");
54162306a36Sopenharmony_ci}
54262306a36Sopenharmony_ci
54362306a36Sopenharmony_cistatic void smsc75xx_set_multicast(struct net_device *netdev)
54462306a36Sopenharmony_ci{
54562306a36Sopenharmony_ci	struct usbnet *dev = netdev_priv(netdev);
54662306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
54762306a36Sopenharmony_ci	unsigned long flags;
54862306a36Sopenharmony_ci	int i;
54962306a36Sopenharmony_ci
55062306a36Sopenharmony_ci	spin_lock_irqsave(&pdata->rfe_ctl_lock, flags);
55162306a36Sopenharmony_ci
55262306a36Sopenharmony_ci	pdata->rfe_ctl &=
55362306a36Sopenharmony_ci		~(RFE_CTL_AU | RFE_CTL_AM | RFE_CTL_DPF | RFE_CTL_MHF);
55462306a36Sopenharmony_ci	pdata->rfe_ctl |= RFE_CTL_AB;
55562306a36Sopenharmony_ci
55662306a36Sopenharmony_ci	for (i = 0; i < DP_SEL_VHF_HASH_LEN; i++)
55762306a36Sopenharmony_ci		pdata->multicast_hash_table[i] = 0;
55862306a36Sopenharmony_ci
55962306a36Sopenharmony_ci	if (dev->net->flags & IFF_PROMISC) {
56062306a36Sopenharmony_ci		netif_dbg(dev, drv, dev->net, "promiscuous mode enabled\n");
56162306a36Sopenharmony_ci		pdata->rfe_ctl |= RFE_CTL_AM | RFE_CTL_AU;
56262306a36Sopenharmony_ci	} else if (dev->net->flags & IFF_ALLMULTI) {
56362306a36Sopenharmony_ci		netif_dbg(dev, drv, dev->net, "receive all multicast enabled\n");
56462306a36Sopenharmony_ci		pdata->rfe_ctl |= RFE_CTL_AM | RFE_CTL_DPF;
56562306a36Sopenharmony_ci	} else if (!netdev_mc_empty(dev->net)) {
56662306a36Sopenharmony_ci		struct netdev_hw_addr *ha;
56762306a36Sopenharmony_ci
56862306a36Sopenharmony_ci		netif_dbg(dev, drv, dev->net, "receive multicast hash filter\n");
56962306a36Sopenharmony_ci
57062306a36Sopenharmony_ci		pdata->rfe_ctl |= RFE_CTL_MHF | RFE_CTL_DPF;
57162306a36Sopenharmony_ci
57262306a36Sopenharmony_ci		netdev_for_each_mc_addr(ha, netdev) {
57362306a36Sopenharmony_ci			u32 bitnum = smsc75xx_hash(ha->addr);
57462306a36Sopenharmony_ci			pdata->multicast_hash_table[bitnum / 32] |=
57562306a36Sopenharmony_ci				(1 << (bitnum % 32));
57662306a36Sopenharmony_ci		}
57762306a36Sopenharmony_ci	} else {
57862306a36Sopenharmony_ci		netif_dbg(dev, drv, dev->net, "receive own packets only\n");
57962306a36Sopenharmony_ci		pdata->rfe_ctl |= RFE_CTL_DPF;
58062306a36Sopenharmony_ci	}
58162306a36Sopenharmony_ci
58262306a36Sopenharmony_ci	spin_unlock_irqrestore(&pdata->rfe_ctl_lock, flags);
58362306a36Sopenharmony_ci
58462306a36Sopenharmony_ci	/* defer register writes to a sleepable context */
58562306a36Sopenharmony_ci	schedule_work(&pdata->set_multicast);
58662306a36Sopenharmony_ci}
58762306a36Sopenharmony_ci
58862306a36Sopenharmony_cistatic int smsc75xx_update_flowcontrol(struct usbnet *dev, u8 duplex,
58962306a36Sopenharmony_ci					    u16 lcladv, u16 rmtadv)
59062306a36Sopenharmony_ci{
59162306a36Sopenharmony_ci	u32 flow = 0, fct_flow = 0;
59262306a36Sopenharmony_ci	int ret;
59362306a36Sopenharmony_ci
59462306a36Sopenharmony_ci	if (duplex == DUPLEX_FULL) {
59562306a36Sopenharmony_ci		u8 cap = mii_resolve_flowctrl_fdx(lcladv, rmtadv);
59662306a36Sopenharmony_ci
59762306a36Sopenharmony_ci		if (cap & FLOW_CTRL_TX) {
59862306a36Sopenharmony_ci			flow = (FLOW_TX_FCEN | 0xFFFF);
59962306a36Sopenharmony_ci			/* set fct_flow thresholds to 20% and 80% */
60062306a36Sopenharmony_ci			fct_flow = (8 << 8) | 32;
60162306a36Sopenharmony_ci		}
60262306a36Sopenharmony_ci
60362306a36Sopenharmony_ci		if (cap & FLOW_CTRL_RX)
60462306a36Sopenharmony_ci			flow |= FLOW_RX_FCEN;
60562306a36Sopenharmony_ci
60662306a36Sopenharmony_ci		netif_dbg(dev, link, dev->net, "rx pause %s, tx pause %s\n",
60762306a36Sopenharmony_ci			  (cap & FLOW_CTRL_RX ? "enabled" : "disabled"),
60862306a36Sopenharmony_ci			  (cap & FLOW_CTRL_TX ? "enabled" : "disabled"));
60962306a36Sopenharmony_ci	} else {
61062306a36Sopenharmony_ci		netif_dbg(dev, link, dev->net, "half duplex\n");
61162306a36Sopenharmony_ci	}
61262306a36Sopenharmony_ci
61362306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, FLOW, flow);
61462306a36Sopenharmony_ci	if (ret < 0) {
61562306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing FLOW\n");
61662306a36Sopenharmony_ci		return ret;
61762306a36Sopenharmony_ci	}
61862306a36Sopenharmony_ci
61962306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, FCT_FLOW, fct_flow);
62062306a36Sopenharmony_ci	if (ret < 0) {
62162306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing FCT_FLOW\n");
62262306a36Sopenharmony_ci		return ret;
62362306a36Sopenharmony_ci	}
62462306a36Sopenharmony_ci
62562306a36Sopenharmony_ci	return 0;
62662306a36Sopenharmony_ci}
62762306a36Sopenharmony_ci
62862306a36Sopenharmony_cistatic int smsc75xx_link_reset(struct usbnet *dev)
62962306a36Sopenharmony_ci{
63062306a36Sopenharmony_ci	struct mii_if_info *mii = &dev->mii;
63162306a36Sopenharmony_ci	struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
63262306a36Sopenharmony_ci	u16 lcladv, rmtadv;
63362306a36Sopenharmony_ci	int ret;
63462306a36Sopenharmony_ci
63562306a36Sopenharmony_ci	/* write to clear phy interrupt status */
63662306a36Sopenharmony_ci	smsc75xx_mdio_write(dev->net, mii->phy_id, PHY_INT_SRC,
63762306a36Sopenharmony_ci		PHY_INT_SRC_CLEAR_ALL);
63862306a36Sopenharmony_ci
63962306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, INT_STS, INT_STS_CLEAR_ALL);
64062306a36Sopenharmony_ci	if (ret < 0) {
64162306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing INT_STS\n");
64262306a36Sopenharmony_ci		return ret;
64362306a36Sopenharmony_ci	}
64462306a36Sopenharmony_ci
64562306a36Sopenharmony_ci	mii_check_media(mii, 1, 1);
64662306a36Sopenharmony_ci	mii_ethtool_gset(&dev->mii, &ecmd);
64762306a36Sopenharmony_ci	lcladv = smsc75xx_mdio_read(dev->net, mii->phy_id, MII_ADVERTISE);
64862306a36Sopenharmony_ci	rmtadv = smsc75xx_mdio_read(dev->net, mii->phy_id, MII_LPA);
64962306a36Sopenharmony_ci
65062306a36Sopenharmony_ci	netif_dbg(dev, link, dev->net, "speed: %u duplex: %d lcladv: %04x rmtadv: %04x\n",
65162306a36Sopenharmony_ci		  ethtool_cmd_speed(&ecmd), ecmd.duplex, lcladv, rmtadv);
65262306a36Sopenharmony_ci
65362306a36Sopenharmony_ci	return smsc75xx_update_flowcontrol(dev, ecmd.duplex, lcladv, rmtadv);
65462306a36Sopenharmony_ci}
65562306a36Sopenharmony_ci
65662306a36Sopenharmony_cistatic void smsc75xx_status(struct usbnet *dev, struct urb *urb)
65762306a36Sopenharmony_ci{
65862306a36Sopenharmony_ci	u32 intdata;
65962306a36Sopenharmony_ci
66062306a36Sopenharmony_ci	if (urb->actual_length != 4) {
66162306a36Sopenharmony_ci		netdev_warn(dev->net, "unexpected urb length %d\n",
66262306a36Sopenharmony_ci			    urb->actual_length);
66362306a36Sopenharmony_ci		return;
66462306a36Sopenharmony_ci	}
66562306a36Sopenharmony_ci
66662306a36Sopenharmony_ci	intdata = get_unaligned_le32(urb->transfer_buffer);
66762306a36Sopenharmony_ci
66862306a36Sopenharmony_ci	netif_dbg(dev, link, dev->net, "intdata: 0x%08X\n", intdata);
66962306a36Sopenharmony_ci
67062306a36Sopenharmony_ci	if (intdata & INT_ENP_PHY_INT)
67162306a36Sopenharmony_ci		usbnet_defer_kevent(dev, EVENT_LINK_RESET);
67262306a36Sopenharmony_ci	else
67362306a36Sopenharmony_ci		netdev_warn(dev->net, "unexpected interrupt, intdata=0x%08X\n",
67462306a36Sopenharmony_ci			    intdata);
67562306a36Sopenharmony_ci}
67662306a36Sopenharmony_ci
67762306a36Sopenharmony_cistatic int smsc75xx_ethtool_get_eeprom_len(struct net_device *net)
67862306a36Sopenharmony_ci{
67962306a36Sopenharmony_ci	return MAX_EEPROM_SIZE;
68062306a36Sopenharmony_ci}
68162306a36Sopenharmony_ci
68262306a36Sopenharmony_cistatic int smsc75xx_ethtool_get_eeprom(struct net_device *netdev,
68362306a36Sopenharmony_ci				       struct ethtool_eeprom *ee, u8 *data)
68462306a36Sopenharmony_ci{
68562306a36Sopenharmony_ci	struct usbnet *dev = netdev_priv(netdev);
68662306a36Sopenharmony_ci
68762306a36Sopenharmony_ci	ee->magic = LAN75XX_EEPROM_MAGIC;
68862306a36Sopenharmony_ci
68962306a36Sopenharmony_ci	return smsc75xx_read_eeprom(dev, ee->offset, ee->len, data);
69062306a36Sopenharmony_ci}
69162306a36Sopenharmony_ci
69262306a36Sopenharmony_cistatic int smsc75xx_ethtool_set_eeprom(struct net_device *netdev,
69362306a36Sopenharmony_ci				       struct ethtool_eeprom *ee, u8 *data)
69462306a36Sopenharmony_ci{
69562306a36Sopenharmony_ci	struct usbnet *dev = netdev_priv(netdev);
69662306a36Sopenharmony_ci
69762306a36Sopenharmony_ci	if (ee->magic != LAN75XX_EEPROM_MAGIC) {
69862306a36Sopenharmony_ci		netdev_warn(dev->net, "EEPROM: magic value mismatch: 0x%x\n",
69962306a36Sopenharmony_ci			    ee->magic);
70062306a36Sopenharmony_ci		return -EINVAL;
70162306a36Sopenharmony_ci	}
70262306a36Sopenharmony_ci
70362306a36Sopenharmony_ci	return smsc75xx_write_eeprom(dev, ee->offset, ee->len, data);
70462306a36Sopenharmony_ci}
70562306a36Sopenharmony_ci
70662306a36Sopenharmony_cistatic void smsc75xx_ethtool_get_wol(struct net_device *net,
70762306a36Sopenharmony_ci				     struct ethtool_wolinfo *wolinfo)
70862306a36Sopenharmony_ci{
70962306a36Sopenharmony_ci	struct usbnet *dev = netdev_priv(net);
71062306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
71162306a36Sopenharmony_ci
71262306a36Sopenharmony_ci	wolinfo->supported = SUPPORTED_WAKE;
71362306a36Sopenharmony_ci	wolinfo->wolopts = pdata->wolopts;
71462306a36Sopenharmony_ci}
71562306a36Sopenharmony_ci
71662306a36Sopenharmony_cistatic int smsc75xx_ethtool_set_wol(struct net_device *net,
71762306a36Sopenharmony_ci				    struct ethtool_wolinfo *wolinfo)
71862306a36Sopenharmony_ci{
71962306a36Sopenharmony_ci	struct usbnet *dev = netdev_priv(net);
72062306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
72162306a36Sopenharmony_ci	int ret;
72262306a36Sopenharmony_ci
72362306a36Sopenharmony_ci	if (wolinfo->wolopts & ~SUPPORTED_WAKE)
72462306a36Sopenharmony_ci		return -EINVAL;
72562306a36Sopenharmony_ci
72662306a36Sopenharmony_ci	pdata->wolopts = wolinfo->wolopts & SUPPORTED_WAKE;
72762306a36Sopenharmony_ci
72862306a36Sopenharmony_ci	ret = device_set_wakeup_enable(&dev->udev->dev, pdata->wolopts);
72962306a36Sopenharmony_ci	if (ret < 0)
73062306a36Sopenharmony_ci		netdev_warn(dev->net, "device_set_wakeup_enable error %d\n", ret);
73162306a36Sopenharmony_ci
73262306a36Sopenharmony_ci	return ret;
73362306a36Sopenharmony_ci}
73462306a36Sopenharmony_ci
73562306a36Sopenharmony_cistatic const struct ethtool_ops smsc75xx_ethtool_ops = {
73662306a36Sopenharmony_ci	.get_link	= usbnet_get_link,
73762306a36Sopenharmony_ci	.nway_reset	= usbnet_nway_reset,
73862306a36Sopenharmony_ci	.get_drvinfo	= usbnet_get_drvinfo,
73962306a36Sopenharmony_ci	.get_msglevel	= usbnet_get_msglevel,
74062306a36Sopenharmony_ci	.set_msglevel	= usbnet_set_msglevel,
74162306a36Sopenharmony_ci	.get_eeprom_len	= smsc75xx_ethtool_get_eeprom_len,
74262306a36Sopenharmony_ci	.get_eeprom	= smsc75xx_ethtool_get_eeprom,
74362306a36Sopenharmony_ci	.set_eeprom	= smsc75xx_ethtool_set_eeprom,
74462306a36Sopenharmony_ci	.get_wol	= smsc75xx_ethtool_get_wol,
74562306a36Sopenharmony_ci	.set_wol	= smsc75xx_ethtool_set_wol,
74662306a36Sopenharmony_ci	.get_link_ksettings	= usbnet_get_link_ksettings_mii,
74762306a36Sopenharmony_ci	.set_link_ksettings	= usbnet_set_link_ksettings_mii,
74862306a36Sopenharmony_ci};
74962306a36Sopenharmony_ci
75062306a36Sopenharmony_cistatic int smsc75xx_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd)
75162306a36Sopenharmony_ci{
75262306a36Sopenharmony_ci	struct usbnet *dev = netdev_priv(netdev);
75362306a36Sopenharmony_ci
75462306a36Sopenharmony_ci	if (!netif_running(netdev))
75562306a36Sopenharmony_ci		return -EINVAL;
75662306a36Sopenharmony_ci
75762306a36Sopenharmony_ci	return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL);
75862306a36Sopenharmony_ci}
75962306a36Sopenharmony_ci
76062306a36Sopenharmony_cistatic void smsc75xx_init_mac_address(struct usbnet *dev)
76162306a36Sopenharmony_ci{
76262306a36Sopenharmony_ci	u8 addr[ETH_ALEN];
76362306a36Sopenharmony_ci
76462306a36Sopenharmony_ci	/* maybe the boot loader passed the MAC address in devicetree */
76562306a36Sopenharmony_ci	if (!platform_get_ethdev_address(&dev->udev->dev, dev->net)) {
76662306a36Sopenharmony_ci		if (is_valid_ether_addr(dev->net->dev_addr)) {
76762306a36Sopenharmony_ci			/* device tree values are valid so use them */
76862306a36Sopenharmony_ci			netif_dbg(dev, ifup, dev->net, "MAC address read from the device tree\n");
76962306a36Sopenharmony_ci			return;
77062306a36Sopenharmony_ci		}
77162306a36Sopenharmony_ci	}
77262306a36Sopenharmony_ci
77362306a36Sopenharmony_ci	/* try reading mac address from EEPROM */
77462306a36Sopenharmony_ci	if (smsc75xx_read_eeprom(dev, EEPROM_MAC_OFFSET, ETH_ALEN, addr) == 0) {
77562306a36Sopenharmony_ci		eth_hw_addr_set(dev->net, addr);
77662306a36Sopenharmony_ci		if (is_valid_ether_addr(dev->net->dev_addr)) {
77762306a36Sopenharmony_ci			/* eeprom values are valid so use them */
77862306a36Sopenharmony_ci			netif_dbg(dev, ifup, dev->net,
77962306a36Sopenharmony_ci				  "MAC address read from EEPROM\n");
78062306a36Sopenharmony_ci			return;
78162306a36Sopenharmony_ci		}
78262306a36Sopenharmony_ci	}
78362306a36Sopenharmony_ci
78462306a36Sopenharmony_ci	/* no useful static MAC address found. generate a random one */
78562306a36Sopenharmony_ci	eth_hw_addr_random(dev->net);
78662306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "MAC address set to eth_random_addr\n");
78762306a36Sopenharmony_ci}
78862306a36Sopenharmony_ci
78962306a36Sopenharmony_cistatic int smsc75xx_set_mac_address(struct usbnet *dev)
79062306a36Sopenharmony_ci{
79162306a36Sopenharmony_ci	u32 addr_lo = dev->net->dev_addr[0] | dev->net->dev_addr[1] << 8 |
79262306a36Sopenharmony_ci		dev->net->dev_addr[2] << 16 | dev->net->dev_addr[3] << 24;
79362306a36Sopenharmony_ci	u32 addr_hi = dev->net->dev_addr[4] | dev->net->dev_addr[5] << 8;
79462306a36Sopenharmony_ci
79562306a36Sopenharmony_ci	int ret = smsc75xx_write_reg(dev, RX_ADDRH, addr_hi);
79662306a36Sopenharmony_ci	if (ret < 0) {
79762306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write RX_ADDRH: %d\n", ret);
79862306a36Sopenharmony_ci		return ret;
79962306a36Sopenharmony_ci	}
80062306a36Sopenharmony_ci
80162306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, RX_ADDRL, addr_lo);
80262306a36Sopenharmony_ci	if (ret < 0) {
80362306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write RX_ADDRL: %d\n", ret);
80462306a36Sopenharmony_ci		return ret;
80562306a36Sopenharmony_ci	}
80662306a36Sopenharmony_ci
80762306a36Sopenharmony_ci	addr_hi |= ADDR_FILTX_FB_VALID;
80862306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, ADDR_FILTX, addr_hi);
80962306a36Sopenharmony_ci	if (ret < 0) {
81062306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write ADDR_FILTX: %d\n", ret);
81162306a36Sopenharmony_ci		return ret;
81262306a36Sopenharmony_ci	}
81362306a36Sopenharmony_ci
81462306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, ADDR_FILTX + 4, addr_lo);
81562306a36Sopenharmony_ci	if (ret < 0)
81662306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write ADDR_FILTX+4: %d\n", ret);
81762306a36Sopenharmony_ci
81862306a36Sopenharmony_ci	return ret;
81962306a36Sopenharmony_ci}
82062306a36Sopenharmony_ci
82162306a36Sopenharmony_cistatic int smsc75xx_phy_initialize(struct usbnet *dev)
82262306a36Sopenharmony_ci{
82362306a36Sopenharmony_ci	int bmcr, ret, timeout = 0;
82462306a36Sopenharmony_ci
82562306a36Sopenharmony_ci	/* Initialize MII structure */
82662306a36Sopenharmony_ci	dev->mii.dev = dev->net;
82762306a36Sopenharmony_ci	dev->mii.mdio_read = smsc75xx_mdio_read;
82862306a36Sopenharmony_ci	dev->mii.mdio_write = smsc75xx_mdio_write;
82962306a36Sopenharmony_ci	dev->mii.phy_id_mask = 0x1f;
83062306a36Sopenharmony_ci	dev->mii.reg_num_mask = 0x1f;
83162306a36Sopenharmony_ci	dev->mii.supports_gmii = 1;
83262306a36Sopenharmony_ci	dev->mii.phy_id = SMSC75XX_INTERNAL_PHY_ID;
83362306a36Sopenharmony_ci
83462306a36Sopenharmony_ci	/* reset phy and wait for reset to complete */
83562306a36Sopenharmony_ci	smsc75xx_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
83662306a36Sopenharmony_ci
83762306a36Sopenharmony_ci	do {
83862306a36Sopenharmony_ci		msleep(10);
83962306a36Sopenharmony_ci		bmcr = smsc75xx_mdio_read(dev->net, dev->mii.phy_id, MII_BMCR);
84062306a36Sopenharmony_ci		if (bmcr < 0) {
84162306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading MII_BMCR\n");
84262306a36Sopenharmony_ci			return bmcr;
84362306a36Sopenharmony_ci		}
84462306a36Sopenharmony_ci		timeout++;
84562306a36Sopenharmony_ci	} while ((bmcr & BMCR_RESET) && (timeout < 100));
84662306a36Sopenharmony_ci
84762306a36Sopenharmony_ci	if (timeout >= 100) {
84862306a36Sopenharmony_ci		netdev_warn(dev->net, "timeout on PHY Reset\n");
84962306a36Sopenharmony_ci		return -EIO;
85062306a36Sopenharmony_ci	}
85162306a36Sopenharmony_ci
85262306a36Sopenharmony_ci	/* phy workaround for gig link */
85362306a36Sopenharmony_ci	smsc75xx_phy_gig_workaround(dev);
85462306a36Sopenharmony_ci
85562306a36Sopenharmony_ci	smsc75xx_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE,
85662306a36Sopenharmony_ci		ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP |
85762306a36Sopenharmony_ci		ADVERTISE_PAUSE_ASYM);
85862306a36Sopenharmony_ci	smsc75xx_mdio_write(dev->net, dev->mii.phy_id, MII_CTRL1000,
85962306a36Sopenharmony_ci		ADVERTISE_1000FULL);
86062306a36Sopenharmony_ci
86162306a36Sopenharmony_ci	/* read and write to clear phy interrupt status */
86262306a36Sopenharmony_ci	ret = smsc75xx_mdio_read(dev->net, dev->mii.phy_id, PHY_INT_SRC);
86362306a36Sopenharmony_ci	if (ret < 0) {
86462306a36Sopenharmony_ci		netdev_warn(dev->net, "Error reading PHY_INT_SRC\n");
86562306a36Sopenharmony_ci		return ret;
86662306a36Sopenharmony_ci	}
86762306a36Sopenharmony_ci
86862306a36Sopenharmony_ci	smsc75xx_mdio_write(dev->net, dev->mii.phy_id, PHY_INT_SRC, 0xffff);
86962306a36Sopenharmony_ci
87062306a36Sopenharmony_ci	smsc75xx_mdio_write(dev->net, dev->mii.phy_id, PHY_INT_MASK,
87162306a36Sopenharmony_ci		PHY_INT_MASK_DEFAULT);
87262306a36Sopenharmony_ci	mii_nway_restart(&dev->mii);
87362306a36Sopenharmony_ci
87462306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "phy initialised successfully\n");
87562306a36Sopenharmony_ci	return 0;
87662306a36Sopenharmony_ci}
87762306a36Sopenharmony_ci
87862306a36Sopenharmony_cistatic int smsc75xx_set_rx_max_frame_length(struct usbnet *dev, int size)
87962306a36Sopenharmony_ci{
88062306a36Sopenharmony_ci	int ret = 0;
88162306a36Sopenharmony_ci	u32 buf;
88262306a36Sopenharmony_ci	bool rxenabled;
88362306a36Sopenharmony_ci
88462306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, MAC_RX, &buf);
88562306a36Sopenharmony_ci	if (ret < 0) {
88662306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read MAC_RX: %d\n", ret);
88762306a36Sopenharmony_ci		return ret;
88862306a36Sopenharmony_ci	}
88962306a36Sopenharmony_ci
89062306a36Sopenharmony_ci	rxenabled = ((buf & MAC_RX_RXEN) != 0);
89162306a36Sopenharmony_ci
89262306a36Sopenharmony_ci	if (rxenabled) {
89362306a36Sopenharmony_ci		buf &= ~MAC_RX_RXEN;
89462306a36Sopenharmony_ci		ret = smsc75xx_write_reg(dev, MAC_RX, buf);
89562306a36Sopenharmony_ci		if (ret < 0) {
89662306a36Sopenharmony_ci			netdev_warn(dev->net, "Failed to write MAC_RX: %d\n", ret);
89762306a36Sopenharmony_ci			return ret;
89862306a36Sopenharmony_ci		}
89962306a36Sopenharmony_ci	}
90062306a36Sopenharmony_ci
90162306a36Sopenharmony_ci	/* add 4 to size for FCS */
90262306a36Sopenharmony_ci	buf &= ~MAC_RX_MAX_SIZE;
90362306a36Sopenharmony_ci	buf |= (((size + 4) << MAC_RX_MAX_SIZE_SHIFT) & MAC_RX_MAX_SIZE);
90462306a36Sopenharmony_ci
90562306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, MAC_RX, buf);
90662306a36Sopenharmony_ci	if (ret < 0) {
90762306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write MAC_RX: %d\n", ret);
90862306a36Sopenharmony_ci		return ret;
90962306a36Sopenharmony_ci	}
91062306a36Sopenharmony_ci
91162306a36Sopenharmony_ci	if (rxenabled) {
91262306a36Sopenharmony_ci		buf |= MAC_RX_RXEN;
91362306a36Sopenharmony_ci		ret = smsc75xx_write_reg(dev, MAC_RX, buf);
91462306a36Sopenharmony_ci		if (ret < 0) {
91562306a36Sopenharmony_ci			netdev_warn(dev->net, "Failed to write MAC_RX: %d\n", ret);
91662306a36Sopenharmony_ci			return ret;
91762306a36Sopenharmony_ci		}
91862306a36Sopenharmony_ci	}
91962306a36Sopenharmony_ci
92062306a36Sopenharmony_ci	return 0;
92162306a36Sopenharmony_ci}
92262306a36Sopenharmony_ci
92362306a36Sopenharmony_cistatic int smsc75xx_change_mtu(struct net_device *netdev, int new_mtu)
92462306a36Sopenharmony_ci{
92562306a36Sopenharmony_ci	struct usbnet *dev = netdev_priv(netdev);
92662306a36Sopenharmony_ci	int ret;
92762306a36Sopenharmony_ci
92862306a36Sopenharmony_ci	ret = smsc75xx_set_rx_max_frame_length(dev, new_mtu + ETH_HLEN);
92962306a36Sopenharmony_ci	if (ret < 0) {
93062306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to set mac rx frame length\n");
93162306a36Sopenharmony_ci		return ret;
93262306a36Sopenharmony_ci	}
93362306a36Sopenharmony_ci
93462306a36Sopenharmony_ci	return usbnet_change_mtu(netdev, new_mtu);
93562306a36Sopenharmony_ci}
93662306a36Sopenharmony_ci
93762306a36Sopenharmony_ci/* Enable or disable Rx checksum offload engine */
93862306a36Sopenharmony_cistatic int smsc75xx_set_features(struct net_device *netdev,
93962306a36Sopenharmony_ci	netdev_features_t features)
94062306a36Sopenharmony_ci{
94162306a36Sopenharmony_ci	struct usbnet *dev = netdev_priv(netdev);
94262306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
94362306a36Sopenharmony_ci	unsigned long flags;
94462306a36Sopenharmony_ci	int ret;
94562306a36Sopenharmony_ci
94662306a36Sopenharmony_ci	spin_lock_irqsave(&pdata->rfe_ctl_lock, flags);
94762306a36Sopenharmony_ci
94862306a36Sopenharmony_ci	if (features & NETIF_F_RXCSUM)
94962306a36Sopenharmony_ci		pdata->rfe_ctl |= RFE_CTL_TCPUDP_CKM | RFE_CTL_IP_CKM;
95062306a36Sopenharmony_ci	else
95162306a36Sopenharmony_ci		pdata->rfe_ctl &= ~(RFE_CTL_TCPUDP_CKM | RFE_CTL_IP_CKM);
95262306a36Sopenharmony_ci
95362306a36Sopenharmony_ci	spin_unlock_irqrestore(&pdata->rfe_ctl_lock, flags);
95462306a36Sopenharmony_ci	/* it's racing here! */
95562306a36Sopenharmony_ci
95662306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, RFE_CTL, pdata->rfe_ctl);
95762306a36Sopenharmony_ci	if (ret < 0) {
95862306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing RFE_CTL\n");
95962306a36Sopenharmony_ci		return ret;
96062306a36Sopenharmony_ci	}
96162306a36Sopenharmony_ci	return 0;
96262306a36Sopenharmony_ci}
96362306a36Sopenharmony_ci
96462306a36Sopenharmony_cistatic int smsc75xx_wait_ready(struct usbnet *dev, int in_pm)
96562306a36Sopenharmony_ci{
96662306a36Sopenharmony_ci	int timeout = 0;
96762306a36Sopenharmony_ci
96862306a36Sopenharmony_ci	do {
96962306a36Sopenharmony_ci		u32 buf;
97062306a36Sopenharmony_ci		int ret;
97162306a36Sopenharmony_ci
97262306a36Sopenharmony_ci		ret = __smsc75xx_read_reg(dev, PMT_CTL, &buf, in_pm);
97362306a36Sopenharmony_ci
97462306a36Sopenharmony_ci		if (ret < 0) {
97562306a36Sopenharmony_ci			netdev_warn(dev->net, "Failed to read PMT_CTL: %d\n", ret);
97662306a36Sopenharmony_ci			return ret;
97762306a36Sopenharmony_ci		}
97862306a36Sopenharmony_ci
97962306a36Sopenharmony_ci		if (buf & PMT_CTL_DEV_RDY)
98062306a36Sopenharmony_ci			return 0;
98162306a36Sopenharmony_ci
98262306a36Sopenharmony_ci		msleep(10);
98362306a36Sopenharmony_ci		timeout++;
98462306a36Sopenharmony_ci	} while (timeout < 100);
98562306a36Sopenharmony_ci
98662306a36Sopenharmony_ci	netdev_warn(dev->net, "timeout waiting for device ready\n");
98762306a36Sopenharmony_ci	return -EIO;
98862306a36Sopenharmony_ci}
98962306a36Sopenharmony_ci
99062306a36Sopenharmony_cistatic int smsc75xx_phy_gig_workaround(struct usbnet *dev)
99162306a36Sopenharmony_ci{
99262306a36Sopenharmony_ci	struct mii_if_info *mii = &dev->mii;
99362306a36Sopenharmony_ci	int ret = 0, timeout = 0;
99462306a36Sopenharmony_ci	u32 buf, link_up = 0;
99562306a36Sopenharmony_ci
99662306a36Sopenharmony_ci	/* Set the phy in Gig loopback */
99762306a36Sopenharmony_ci	smsc75xx_mdio_write(dev->net, mii->phy_id, MII_BMCR, 0x4040);
99862306a36Sopenharmony_ci
99962306a36Sopenharmony_ci	/* Wait for the link up */
100062306a36Sopenharmony_ci	do {
100162306a36Sopenharmony_ci		link_up = smsc75xx_link_ok_nopm(dev);
100262306a36Sopenharmony_ci		usleep_range(10000, 20000);
100362306a36Sopenharmony_ci		timeout++;
100462306a36Sopenharmony_ci	} while ((!link_up) && (timeout < 1000));
100562306a36Sopenharmony_ci
100662306a36Sopenharmony_ci	if (timeout >= 1000) {
100762306a36Sopenharmony_ci		netdev_warn(dev->net, "Timeout waiting for PHY link up\n");
100862306a36Sopenharmony_ci		return -EIO;
100962306a36Sopenharmony_ci	}
101062306a36Sopenharmony_ci
101162306a36Sopenharmony_ci	/* phy reset */
101262306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, PMT_CTL, &buf);
101362306a36Sopenharmony_ci	if (ret < 0) {
101462306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read PMT_CTL: %d\n", ret);
101562306a36Sopenharmony_ci		return ret;
101662306a36Sopenharmony_ci	}
101762306a36Sopenharmony_ci
101862306a36Sopenharmony_ci	buf |= PMT_CTL_PHY_RST;
101962306a36Sopenharmony_ci
102062306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, PMT_CTL, buf);
102162306a36Sopenharmony_ci	if (ret < 0) {
102262306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write PMT_CTL: %d\n", ret);
102362306a36Sopenharmony_ci		return ret;
102462306a36Sopenharmony_ci	}
102562306a36Sopenharmony_ci
102662306a36Sopenharmony_ci	timeout = 0;
102762306a36Sopenharmony_ci	do {
102862306a36Sopenharmony_ci		usleep_range(10000, 20000);
102962306a36Sopenharmony_ci		ret = smsc75xx_read_reg(dev, PMT_CTL, &buf);
103062306a36Sopenharmony_ci		if (ret < 0) {
103162306a36Sopenharmony_ci			netdev_warn(dev->net, "Failed to read PMT_CTL: %d\n",
103262306a36Sopenharmony_ci				    ret);
103362306a36Sopenharmony_ci			return ret;
103462306a36Sopenharmony_ci		}
103562306a36Sopenharmony_ci		timeout++;
103662306a36Sopenharmony_ci	} while ((buf & PMT_CTL_PHY_RST) && (timeout < 100));
103762306a36Sopenharmony_ci
103862306a36Sopenharmony_ci	if (timeout >= 100) {
103962306a36Sopenharmony_ci		netdev_warn(dev->net, "timeout waiting for PHY Reset\n");
104062306a36Sopenharmony_ci		return -EIO;
104162306a36Sopenharmony_ci	}
104262306a36Sopenharmony_ci
104362306a36Sopenharmony_ci	return 0;
104462306a36Sopenharmony_ci}
104562306a36Sopenharmony_ci
104662306a36Sopenharmony_cistatic int smsc75xx_reset(struct usbnet *dev)
104762306a36Sopenharmony_ci{
104862306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
104962306a36Sopenharmony_ci	u32 buf;
105062306a36Sopenharmony_ci	int ret = 0, timeout;
105162306a36Sopenharmony_ci
105262306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "entering smsc75xx_reset\n");
105362306a36Sopenharmony_ci
105462306a36Sopenharmony_ci	ret = smsc75xx_wait_ready(dev, 0);
105562306a36Sopenharmony_ci	if (ret < 0) {
105662306a36Sopenharmony_ci		netdev_warn(dev->net, "device not ready in smsc75xx_reset\n");
105762306a36Sopenharmony_ci		return ret;
105862306a36Sopenharmony_ci	}
105962306a36Sopenharmony_ci
106062306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, HW_CFG, &buf);
106162306a36Sopenharmony_ci	if (ret < 0) {
106262306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read HW_CFG: %d\n", ret);
106362306a36Sopenharmony_ci		return ret;
106462306a36Sopenharmony_ci	}
106562306a36Sopenharmony_ci
106662306a36Sopenharmony_ci	buf |= HW_CFG_LRST;
106762306a36Sopenharmony_ci
106862306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, HW_CFG, buf);
106962306a36Sopenharmony_ci	if (ret < 0) {
107062306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write HW_CFG: %d\n", ret);
107162306a36Sopenharmony_ci		return ret;
107262306a36Sopenharmony_ci	}
107362306a36Sopenharmony_ci
107462306a36Sopenharmony_ci	timeout = 0;
107562306a36Sopenharmony_ci	do {
107662306a36Sopenharmony_ci		msleep(10);
107762306a36Sopenharmony_ci		ret = smsc75xx_read_reg(dev, HW_CFG, &buf);
107862306a36Sopenharmony_ci		if (ret < 0) {
107962306a36Sopenharmony_ci			netdev_warn(dev->net, "Failed to read HW_CFG: %d\n", ret);
108062306a36Sopenharmony_ci			return ret;
108162306a36Sopenharmony_ci		}
108262306a36Sopenharmony_ci		timeout++;
108362306a36Sopenharmony_ci	} while ((buf & HW_CFG_LRST) && (timeout < 100));
108462306a36Sopenharmony_ci
108562306a36Sopenharmony_ci	if (timeout >= 100) {
108662306a36Sopenharmony_ci		netdev_warn(dev->net, "timeout on completion of Lite Reset\n");
108762306a36Sopenharmony_ci		return -EIO;
108862306a36Sopenharmony_ci	}
108962306a36Sopenharmony_ci
109062306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "Lite reset complete, resetting PHY\n");
109162306a36Sopenharmony_ci
109262306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, PMT_CTL, &buf);
109362306a36Sopenharmony_ci	if (ret < 0) {
109462306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read PMT_CTL: %d\n", ret);
109562306a36Sopenharmony_ci		return ret;
109662306a36Sopenharmony_ci	}
109762306a36Sopenharmony_ci
109862306a36Sopenharmony_ci	buf |= PMT_CTL_PHY_RST;
109962306a36Sopenharmony_ci
110062306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, PMT_CTL, buf);
110162306a36Sopenharmony_ci	if (ret < 0) {
110262306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write PMT_CTL: %d\n", ret);
110362306a36Sopenharmony_ci		return ret;
110462306a36Sopenharmony_ci	}
110562306a36Sopenharmony_ci
110662306a36Sopenharmony_ci	timeout = 0;
110762306a36Sopenharmony_ci	do {
110862306a36Sopenharmony_ci		msleep(10);
110962306a36Sopenharmony_ci		ret = smsc75xx_read_reg(dev, PMT_CTL, &buf);
111062306a36Sopenharmony_ci		if (ret < 0) {
111162306a36Sopenharmony_ci			netdev_warn(dev->net, "Failed to read PMT_CTL: %d\n", ret);
111262306a36Sopenharmony_ci			return ret;
111362306a36Sopenharmony_ci		}
111462306a36Sopenharmony_ci		timeout++;
111562306a36Sopenharmony_ci	} while ((buf & PMT_CTL_PHY_RST) && (timeout < 100));
111662306a36Sopenharmony_ci
111762306a36Sopenharmony_ci	if (timeout >= 100) {
111862306a36Sopenharmony_ci		netdev_warn(dev->net, "timeout waiting for PHY Reset\n");
111962306a36Sopenharmony_ci		return -EIO;
112062306a36Sopenharmony_ci	}
112162306a36Sopenharmony_ci
112262306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "PHY reset complete\n");
112362306a36Sopenharmony_ci
112462306a36Sopenharmony_ci	ret = smsc75xx_set_mac_address(dev);
112562306a36Sopenharmony_ci	if (ret < 0) {
112662306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to set mac address\n");
112762306a36Sopenharmony_ci		return ret;
112862306a36Sopenharmony_ci	}
112962306a36Sopenharmony_ci
113062306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "MAC Address: %pM\n",
113162306a36Sopenharmony_ci		  dev->net->dev_addr);
113262306a36Sopenharmony_ci
113362306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, HW_CFG, &buf);
113462306a36Sopenharmony_ci	if (ret < 0) {
113562306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read HW_CFG: %d\n", ret);
113662306a36Sopenharmony_ci		return ret;
113762306a36Sopenharmony_ci	}
113862306a36Sopenharmony_ci
113962306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "Read Value from HW_CFG : 0x%08x\n",
114062306a36Sopenharmony_ci		  buf);
114162306a36Sopenharmony_ci
114262306a36Sopenharmony_ci	buf |= HW_CFG_BIR;
114362306a36Sopenharmony_ci
114462306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, HW_CFG, buf);
114562306a36Sopenharmony_ci	if (ret < 0) {
114662306a36Sopenharmony_ci		netdev_warn(dev->net,  "Failed to write HW_CFG: %d\n", ret);
114762306a36Sopenharmony_ci		return ret;
114862306a36Sopenharmony_ci	}
114962306a36Sopenharmony_ci
115062306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, HW_CFG, &buf);
115162306a36Sopenharmony_ci	if (ret < 0) {
115262306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read HW_CFG: %d\n", ret);
115362306a36Sopenharmony_ci		return ret;
115462306a36Sopenharmony_ci	}
115562306a36Sopenharmony_ci
115662306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "Read Value from HW_CFG after writing HW_CFG_BIR: 0x%08x\n",
115762306a36Sopenharmony_ci		  buf);
115862306a36Sopenharmony_ci
115962306a36Sopenharmony_ci	if (!turbo_mode) {
116062306a36Sopenharmony_ci		buf = 0;
116162306a36Sopenharmony_ci		dev->rx_urb_size = MAX_SINGLE_PACKET_SIZE;
116262306a36Sopenharmony_ci	} else if (dev->udev->speed == USB_SPEED_HIGH) {
116362306a36Sopenharmony_ci		buf = DEFAULT_HS_BURST_CAP_SIZE / HS_USB_PKT_SIZE;
116462306a36Sopenharmony_ci		dev->rx_urb_size = DEFAULT_HS_BURST_CAP_SIZE;
116562306a36Sopenharmony_ci	} else {
116662306a36Sopenharmony_ci		buf = DEFAULT_FS_BURST_CAP_SIZE / FS_USB_PKT_SIZE;
116762306a36Sopenharmony_ci		dev->rx_urb_size = DEFAULT_FS_BURST_CAP_SIZE;
116862306a36Sopenharmony_ci	}
116962306a36Sopenharmony_ci
117062306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "rx_urb_size=%ld\n",
117162306a36Sopenharmony_ci		  (ulong)dev->rx_urb_size);
117262306a36Sopenharmony_ci
117362306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, BURST_CAP, buf);
117462306a36Sopenharmony_ci	if (ret < 0) {
117562306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write BURST_CAP: %d\n", ret);
117662306a36Sopenharmony_ci		return ret;
117762306a36Sopenharmony_ci	}
117862306a36Sopenharmony_ci
117962306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, BURST_CAP, &buf);
118062306a36Sopenharmony_ci	if (ret < 0) {
118162306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read BURST_CAP: %d\n", ret);
118262306a36Sopenharmony_ci		return ret;
118362306a36Sopenharmony_ci	}
118462306a36Sopenharmony_ci
118562306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net,
118662306a36Sopenharmony_ci		  "Read Value from BURST_CAP after writing: 0x%08x\n", buf);
118762306a36Sopenharmony_ci
118862306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, BULK_IN_DLY, DEFAULT_BULK_IN_DELAY);
118962306a36Sopenharmony_ci	if (ret < 0) {
119062306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write BULK_IN_DLY: %d\n", ret);
119162306a36Sopenharmony_ci		return ret;
119262306a36Sopenharmony_ci	}
119362306a36Sopenharmony_ci
119462306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, BULK_IN_DLY, &buf);
119562306a36Sopenharmony_ci	if (ret < 0) {
119662306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read BULK_IN_DLY: %d\n", ret);
119762306a36Sopenharmony_ci		return ret;
119862306a36Sopenharmony_ci	}
119962306a36Sopenharmony_ci
120062306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net,
120162306a36Sopenharmony_ci		  "Read Value from BULK_IN_DLY after writing: 0x%08x\n", buf);
120262306a36Sopenharmony_ci
120362306a36Sopenharmony_ci	if (turbo_mode) {
120462306a36Sopenharmony_ci		ret = smsc75xx_read_reg(dev, HW_CFG, &buf);
120562306a36Sopenharmony_ci		if (ret < 0) {
120662306a36Sopenharmony_ci			netdev_warn(dev->net, "Failed to read HW_CFG: %d\n", ret);
120762306a36Sopenharmony_ci			return ret;
120862306a36Sopenharmony_ci		}
120962306a36Sopenharmony_ci
121062306a36Sopenharmony_ci		netif_dbg(dev, ifup, dev->net, "HW_CFG: 0x%08x\n", buf);
121162306a36Sopenharmony_ci
121262306a36Sopenharmony_ci		buf |= (HW_CFG_MEF | HW_CFG_BCE);
121362306a36Sopenharmony_ci
121462306a36Sopenharmony_ci		ret = smsc75xx_write_reg(dev, HW_CFG, buf);
121562306a36Sopenharmony_ci		if (ret < 0) {
121662306a36Sopenharmony_ci			netdev_warn(dev->net, "Failed to write HW_CFG: %d\n", ret);
121762306a36Sopenharmony_ci			return ret;
121862306a36Sopenharmony_ci		}
121962306a36Sopenharmony_ci
122062306a36Sopenharmony_ci		ret = smsc75xx_read_reg(dev, HW_CFG, &buf);
122162306a36Sopenharmony_ci		if (ret < 0) {
122262306a36Sopenharmony_ci			netdev_warn(dev->net, "Failed to read HW_CFG: %d\n", ret);
122362306a36Sopenharmony_ci			return ret;
122462306a36Sopenharmony_ci		}
122562306a36Sopenharmony_ci
122662306a36Sopenharmony_ci		netif_dbg(dev, ifup, dev->net, "HW_CFG: 0x%08x\n", buf);
122762306a36Sopenharmony_ci	}
122862306a36Sopenharmony_ci
122962306a36Sopenharmony_ci	/* set FIFO sizes */
123062306a36Sopenharmony_ci	buf = (MAX_RX_FIFO_SIZE - 512) / 512;
123162306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, FCT_RX_FIFO_END, buf);
123262306a36Sopenharmony_ci	if (ret < 0) {
123362306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write FCT_RX_FIFO_END: %d\n", ret);
123462306a36Sopenharmony_ci		return ret;
123562306a36Sopenharmony_ci	}
123662306a36Sopenharmony_ci
123762306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "FCT_RX_FIFO_END set to 0x%08x\n", buf);
123862306a36Sopenharmony_ci
123962306a36Sopenharmony_ci	buf = (MAX_TX_FIFO_SIZE - 512) / 512;
124062306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, FCT_TX_FIFO_END, buf);
124162306a36Sopenharmony_ci	if (ret < 0) {
124262306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write FCT_TX_FIFO_END: %d\n", ret);
124362306a36Sopenharmony_ci		return ret;
124462306a36Sopenharmony_ci	}
124562306a36Sopenharmony_ci
124662306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "FCT_TX_FIFO_END set to 0x%08x\n", buf);
124762306a36Sopenharmony_ci
124862306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, INT_STS, INT_STS_CLEAR_ALL);
124962306a36Sopenharmony_ci	if (ret < 0) {
125062306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write INT_STS: %d\n", ret);
125162306a36Sopenharmony_ci		return ret;
125262306a36Sopenharmony_ci	}
125362306a36Sopenharmony_ci
125462306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, ID_REV, &buf);
125562306a36Sopenharmony_ci	if (ret < 0) {
125662306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read ID_REV: %d\n", ret);
125762306a36Sopenharmony_ci		return ret;
125862306a36Sopenharmony_ci	}
125962306a36Sopenharmony_ci
126062306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "ID_REV = 0x%08x\n", buf);
126162306a36Sopenharmony_ci
126262306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, E2P_CMD, &buf);
126362306a36Sopenharmony_ci	if (ret < 0) {
126462306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read E2P_CMD: %d\n", ret);
126562306a36Sopenharmony_ci		return ret;
126662306a36Sopenharmony_ci	}
126762306a36Sopenharmony_ci
126862306a36Sopenharmony_ci	/* only set default GPIO/LED settings if no EEPROM is detected */
126962306a36Sopenharmony_ci	if (!(buf & E2P_CMD_LOADED)) {
127062306a36Sopenharmony_ci		ret = smsc75xx_read_reg(dev, LED_GPIO_CFG, &buf);
127162306a36Sopenharmony_ci		if (ret < 0) {
127262306a36Sopenharmony_ci			netdev_warn(dev->net, "Failed to read LED_GPIO_CFG: %d\n", ret);
127362306a36Sopenharmony_ci			return ret;
127462306a36Sopenharmony_ci		}
127562306a36Sopenharmony_ci
127662306a36Sopenharmony_ci		buf &= ~(LED_GPIO_CFG_LED2_FUN_SEL | LED_GPIO_CFG_LED10_FUN_SEL);
127762306a36Sopenharmony_ci		buf |= LED_GPIO_CFG_LEDGPIO_EN | LED_GPIO_CFG_LED2_FUN_SEL;
127862306a36Sopenharmony_ci
127962306a36Sopenharmony_ci		ret = smsc75xx_write_reg(dev, LED_GPIO_CFG, buf);
128062306a36Sopenharmony_ci		if (ret < 0) {
128162306a36Sopenharmony_ci			netdev_warn(dev->net, "Failed to write LED_GPIO_CFG: %d\n", ret);
128262306a36Sopenharmony_ci			return ret;
128362306a36Sopenharmony_ci		}
128462306a36Sopenharmony_ci	}
128562306a36Sopenharmony_ci
128662306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, FLOW, 0);
128762306a36Sopenharmony_ci	if (ret < 0) {
128862306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write FLOW: %d\n", ret);
128962306a36Sopenharmony_ci		return ret;
129062306a36Sopenharmony_ci	}
129162306a36Sopenharmony_ci
129262306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, FCT_FLOW, 0);
129362306a36Sopenharmony_ci	if (ret < 0) {
129462306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write FCT_FLOW: %d\n", ret);
129562306a36Sopenharmony_ci		return ret;
129662306a36Sopenharmony_ci	}
129762306a36Sopenharmony_ci
129862306a36Sopenharmony_ci	/* Don't need rfe_ctl_lock during initialisation */
129962306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, RFE_CTL, &pdata->rfe_ctl);
130062306a36Sopenharmony_ci	if (ret < 0) {
130162306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read RFE_CTL: %d\n", ret);
130262306a36Sopenharmony_ci		return ret;
130362306a36Sopenharmony_ci	}
130462306a36Sopenharmony_ci
130562306a36Sopenharmony_ci	pdata->rfe_ctl |= RFE_CTL_AB | RFE_CTL_DPF;
130662306a36Sopenharmony_ci
130762306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, RFE_CTL, pdata->rfe_ctl);
130862306a36Sopenharmony_ci	if (ret < 0) {
130962306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write RFE_CTL: %d\n", ret);
131062306a36Sopenharmony_ci		return ret;
131162306a36Sopenharmony_ci	}
131262306a36Sopenharmony_ci
131362306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, RFE_CTL, &pdata->rfe_ctl);
131462306a36Sopenharmony_ci	if (ret < 0) {
131562306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read RFE_CTL: %d\n", ret);
131662306a36Sopenharmony_ci		return ret;
131762306a36Sopenharmony_ci	}
131862306a36Sopenharmony_ci
131962306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "RFE_CTL set to 0x%08x\n",
132062306a36Sopenharmony_ci		  pdata->rfe_ctl);
132162306a36Sopenharmony_ci
132262306a36Sopenharmony_ci	/* Enable or disable checksum offload engines */
132362306a36Sopenharmony_ci	smsc75xx_set_features(dev->net, dev->net->features);
132462306a36Sopenharmony_ci
132562306a36Sopenharmony_ci	smsc75xx_set_multicast(dev->net);
132662306a36Sopenharmony_ci
132762306a36Sopenharmony_ci	ret = smsc75xx_phy_initialize(dev);
132862306a36Sopenharmony_ci	if (ret < 0) {
132962306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to initialize PHY: %d\n", ret);
133062306a36Sopenharmony_ci		return ret;
133162306a36Sopenharmony_ci	}
133262306a36Sopenharmony_ci
133362306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, INT_EP_CTL, &buf);
133462306a36Sopenharmony_ci	if (ret < 0) {
133562306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read INT_EP_CTL: %d\n", ret);
133662306a36Sopenharmony_ci		return ret;
133762306a36Sopenharmony_ci	}
133862306a36Sopenharmony_ci
133962306a36Sopenharmony_ci	/* enable PHY interrupts */
134062306a36Sopenharmony_ci	buf |= INT_ENP_PHY_INT;
134162306a36Sopenharmony_ci
134262306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, INT_EP_CTL, buf);
134362306a36Sopenharmony_ci	if (ret < 0) {
134462306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write INT_EP_CTL: %d\n", ret);
134562306a36Sopenharmony_ci		return ret;
134662306a36Sopenharmony_ci	}
134762306a36Sopenharmony_ci
134862306a36Sopenharmony_ci	/* allow mac to detect speed and duplex from phy */
134962306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, MAC_CR, &buf);
135062306a36Sopenharmony_ci	if (ret < 0) {
135162306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read MAC_CR: %d\n", ret);
135262306a36Sopenharmony_ci		return ret;
135362306a36Sopenharmony_ci	}
135462306a36Sopenharmony_ci
135562306a36Sopenharmony_ci	buf |= (MAC_CR_ADD | MAC_CR_ASD);
135662306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, MAC_CR, buf);
135762306a36Sopenharmony_ci	if (ret < 0) {
135862306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write MAC_CR: %d\n", ret);
135962306a36Sopenharmony_ci		return ret;
136062306a36Sopenharmony_ci	}
136162306a36Sopenharmony_ci
136262306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, MAC_TX, &buf);
136362306a36Sopenharmony_ci	if (ret < 0) {
136462306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read MAC_TX: %d\n", ret);
136562306a36Sopenharmony_ci		return ret;
136662306a36Sopenharmony_ci	}
136762306a36Sopenharmony_ci
136862306a36Sopenharmony_ci	buf |= MAC_TX_TXEN;
136962306a36Sopenharmony_ci
137062306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, MAC_TX, buf);
137162306a36Sopenharmony_ci	if (ret < 0) {
137262306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write MAC_TX: %d\n", ret);
137362306a36Sopenharmony_ci		return ret;
137462306a36Sopenharmony_ci	}
137562306a36Sopenharmony_ci
137662306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "MAC_TX set to 0x%08x\n", buf);
137762306a36Sopenharmony_ci
137862306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, FCT_TX_CTL, &buf);
137962306a36Sopenharmony_ci	if (ret < 0) {
138062306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read FCT_TX_CTL: %d\n", ret);
138162306a36Sopenharmony_ci		return ret;
138262306a36Sopenharmony_ci	}
138362306a36Sopenharmony_ci
138462306a36Sopenharmony_ci	buf |= FCT_TX_CTL_EN;
138562306a36Sopenharmony_ci
138662306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, FCT_TX_CTL, buf);
138762306a36Sopenharmony_ci	if (ret < 0) {
138862306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write FCT_TX_CTL: %d\n", ret);
138962306a36Sopenharmony_ci		return ret;
139062306a36Sopenharmony_ci	}
139162306a36Sopenharmony_ci
139262306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "FCT_TX_CTL set to 0x%08x\n", buf);
139362306a36Sopenharmony_ci
139462306a36Sopenharmony_ci	ret = smsc75xx_set_rx_max_frame_length(dev, dev->net->mtu + ETH_HLEN);
139562306a36Sopenharmony_ci	if (ret < 0) {
139662306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to set max rx frame length\n");
139762306a36Sopenharmony_ci		return ret;
139862306a36Sopenharmony_ci	}
139962306a36Sopenharmony_ci
140062306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, MAC_RX, &buf);
140162306a36Sopenharmony_ci	if (ret < 0) {
140262306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read MAC_RX: %d\n", ret);
140362306a36Sopenharmony_ci		return ret;
140462306a36Sopenharmony_ci	}
140562306a36Sopenharmony_ci
140662306a36Sopenharmony_ci	buf |= MAC_RX_RXEN;
140762306a36Sopenharmony_ci
140862306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, MAC_RX, buf);
140962306a36Sopenharmony_ci	if (ret < 0) {
141062306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write MAC_RX: %d\n", ret);
141162306a36Sopenharmony_ci		return ret;
141262306a36Sopenharmony_ci	}
141362306a36Sopenharmony_ci
141462306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "MAC_RX set to 0x%08x\n", buf);
141562306a36Sopenharmony_ci
141662306a36Sopenharmony_ci	ret = smsc75xx_read_reg(dev, FCT_RX_CTL, &buf);
141762306a36Sopenharmony_ci	if (ret < 0) {
141862306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read FCT_RX_CTL: %d\n", ret);
141962306a36Sopenharmony_ci		return ret;
142062306a36Sopenharmony_ci	}
142162306a36Sopenharmony_ci
142262306a36Sopenharmony_ci	buf |= FCT_RX_CTL_EN;
142362306a36Sopenharmony_ci
142462306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, FCT_RX_CTL, buf);
142562306a36Sopenharmony_ci	if (ret < 0) {
142662306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write FCT_RX_CTL: %d\n", ret);
142762306a36Sopenharmony_ci		return ret;
142862306a36Sopenharmony_ci	}
142962306a36Sopenharmony_ci
143062306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "FCT_RX_CTL set to 0x%08x\n", buf);
143162306a36Sopenharmony_ci
143262306a36Sopenharmony_ci	netif_dbg(dev, ifup, dev->net, "smsc75xx_reset, return 0\n");
143362306a36Sopenharmony_ci	return 0;
143462306a36Sopenharmony_ci}
143562306a36Sopenharmony_ci
143662306a36Sopenharmony_cistatic const struct net_device_ops smsc75xx_netdev_ops = {
143762306a36Sopenharmony_ci	.ndo_open		= usbnet_open,
143862306a36Sopenharmony_ci	.ndo_stop		= usbnet_stop,
143962306a36Sopenharmony_ci	.ndo_start_xmit		= usbnet_start_xmit,
144062306a36Sopenharmony_ci	.ndo_tx_timeout		= usbnet_tx_timeout,
144162306a36Sopenharmony_ci	.ndo_get_stats64	= dev_get_tstats64,
144262306a36Sopenharmony_ci	.ndo_change_mtu		= smsc75xx_change_mtu,
144362306a36Sopenharmony_ci	.ndo_set_mac_address 	= eth_mac_addr,
144462306a36Sopenharmony_ci	.ndo_validate_addr	= eth_validate_addr,
144562306a36Sopenharmony_ci	.ndo_eth_ioctl		= smsc75xx_ioctl,
144662306a36Sopenharmony_ci	.ndo_set_rx_mode	= smsc75xx_set_multicast,
144762306a36Sopenharmony_ci	.ndo_set_features	= smsc75xx_set_features,
144862306a36Sopenharmony_ci};
144962306a36Sopenharmony_ci
145062306a36Sopenharmony_cistatic int smsc75xx_bind(struct usbnet *dev, struct usb_interface *intf)
145162306a36Sopenharmony_ci{
145262306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = NULL;
145362306a36Sopenharmony_ci	int ret;
145462306a36Sopenharmony_ci
145562306a36Sopenharmony_ci	printk(KERN_INFO SMSC_CHIPNAME " v" SMSC_DRIVER_VERSION "\n");
145662306a36Sopenharmony_ci
145762306a36Sopenharmony_ci	ret = usbnet_get_endpoints(dev, intf);
145862306a36Sopenharmony_ci	if (ret < 0) {
145962306a36Sopenharmony_ci		netdev_warn(dev->net, "usbnet_get_endpoints failed: %d\n", ret);
146062306a36Sopenharmony_ci		return ret;
146162306a36Sopenharmony_ci	}
146262306a36Sopenharmony_ci
146362306a36Sopenharmony_ci	dev->data[0] = (unsigned long)kzalloc(sizeof(struct smsc75xx_priv),
146462306a36Sopenharmony_ci					      GFP_KERNEL);
146562306a36Sopenharmony_ci
146662306a36Sopenharmony_ci	pdata = (struct smsc75xx_priv *)(dev->data[0]);
146762306a36Sopenharmony_ci	if (!pdata)
146862306a36Sopenharmony_ci		return -ENOMEM;
146962306a36Sopenharmony_ci
147062306a36Sopenharmony_ci	pdata->dev = dev;
147162306a36Sopenharmony_ci
147262306a36Sopenharmony_ci	spin_lock_init(&pdata->rfe_ctl_lock);
147362306a36Sopenharmony_ci	mutex_init(&pdata->dataport_mutex);
147462306a36Sopenharmony_ci
147562306a36Sopenharmony_ci	INIT_WORK(&pdata->set_multicast, smsc75xx_deferred_multicast_write);
147662306a36Sopenharmony_ci
147762306a36Sopenharmony_ci	if (DEFAULT_TX_CSUM_ENABLE)
147862306a36Sopenharmony_ci		dev->net->features |= NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM;
147962306a36Sopenharmony_ci
148062306a36Sopenharmony_ci	if (DEFAULT_RX_CSUM_ENABLE)
148162306a36Sopenharmony_ci		dev->net->features |= NETIF_F_RXCSUM;
148262306a36Sopenharmony_ci
148362306a36Sopenharmony_ci	dev->net->hw_features = NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
148462306a36Sopenharmony_ci				NETIF_F_RXCSUM;
148562306a36Sopenharmony_ci
148662306a36Sopenharmony_ci	ret = smsc75xx_wait_ready(dev, 0);
148762306a36Sopenharmony_ci	if (ret < 0) {
148862306a36Sopenharmony_ci		netdev_warn(dev->net, "device not ready in smsc75xx_bind\n");
148962306a36Sopenharmony_ci		goto free_pdata;
149062306a36Sopenharmony_ci	}
149162306a36Sopenharmony_ci
149262306a36Sopenharmony_ci	smsc75xx_init_mac_address(dev);
149362306a36Sopenharmony_ci
149462306a36Sopenharmony_ci	/* Init all registers */
149562306a36Sopenharmony_ci	ret = smsc75xx_reset(dev);
149662306a36Sopenharmony_ci	if (ret < 0) {
149762306a36Sopenharmony_ci		netdev_warn(dev->net, "smsc75xx_reset error %d\n", ret);
149862306a36Sopenharmony_ci		goto cancel_work;
149962306a36Sopenharmony_ci	}
150062306a36Sopenharmony_ci
150162306a36Sopenharmony_ci	dev->net->netdev_ops = &smsc75xx_netdev_ops;
150262306a36Sopenharmony_ci	dev->net->ethtool_ops = &smsc75xx_ethtool_ops;
150362306a36Sopenharmony_ci	dev->net->flags |= IFF_MULTICAST;
150462306a36Sopenharmony_ci	dev->net->hard_header_len += SMSC75XX_TX_OVERHEAD;
150562306a36Sopenharmony_ci	dev->hard_mtu = dev->net->mtu + dev->net->hard_header_len;
150662306a36Sopenharmony_ci	dev->net->max_mtu = MAX_SINGLE_PACKET_SIZE;
150762306a36Sopenharmony_ci	return 0;
150862306a36Sopenharmony_ci
150962306a36Sopenharmony_cicancel_work:
151062306a36Sopenharmony_ci	cancel_work_sync(&pdata->set_multicast);
151162306a36Sopenharmony_cifree_pdata:
151262306a36Sopenharmony_ci	kfree(pdata);
151362306a36Sopenharmony_ci	dev->data[0] = 0;
151462306a36Sopenharmony_ci	return ret;
151562306a36Sopenharmony_ci}
151662306a36Sopenharmony_ci
151762306a36Sopenharmony_cistatic void smsc75xx_unbind(struct usbnet *dev, struct usb_interface *intf)
151862306a36Sopenharmony_ci{
151962306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
152062306a36Sopenharmony_ci	if (pdata) {
152162306a36Sopenharmony_ci		cancel_work_sync(&pdata->set_multicast);
152262306a36Sopenharmony_ci		netif_dbg(dev, ifdown, dev->net, "free pdata\n");
152362306a36Sopenharmony_ci		kfree(pdata);
152462306a36Sopenharmony_ci		dev->data[0] = 0;
152562306a36Sopenharmony_ci	}
152662306a36Sopenharmony_ci}
152762306a36Sopenharmony_ci
152862306a36Sopenharmony_cistatic u16 smsc_crc(const u8 *buffer, size_t len)
152962306a36Sopenharmony_ci{
153062306a36Sopenharmony_ci	return bitrev16(crc16(0xFFFF, buffer, len));
153162306a36Sopenharmony_ci}
153262306a36Sopenharmony_ci
153362306a36Sopenharmony_cistatic int smsc75xx_write_wuff(struct usbnet *dev, int filter, u32 wuf_cfg,
153462306a36Sopenharmony_ci			       u32 wuf_mask1)
153562306a36Sopenharmony_ci{
153662306a36Sopenharmony_ci	int cfg_base = WUF_CFGX + filter * 4;
153762306a36Sopenharmony_ci	int mask_base = WUF_MASKX + filter * 16;
153862306a36Sopenharmony_ci	int ret;
153962306a36Sopenharmony_ci
154062306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, cfg_base, wuf_cfg);
154162306a36Sopenharmony_ci	if (ret < 0) {
154262306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing WUF_CFGX\n");
154362306a36Sopenharmony_ci		return ret;
154462306a36Sopenharmony_ci	}
154562306a36Sopenharmony_ci
154662306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, mask_base, wuf_mask1);
154762306a36Sopenharmony_ci	if (ret < 0) {
154862306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing WUF_MASKX\n");
154962306a36Sopenharmony_ci		return ret;
155062306a36Sopenharmony_ci	}
155162306a36Sopenharmony_ci
155262306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, mask_base + 4, 0);
155362306a36Sopenharmony_ci	if (ret < 0) {
155462306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing WUF_MASKX\n");
155562306a36Sopenharmony_ci		return ret;
155662306a36Sopenharmony_ci	}
155762306a36Sopenharmony_ci
155862306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, mask_base + 8, 0);
155962306a36Sopenharmony_ci	if (ret < 0) {
156062306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing WUF_MASKX\n");
156162306a36Sopenharmony_ci		return ret;
156262306a36Sopenharmony_ci	}
156362306a36Sopenharmony_ci
156462306a36Sopenharmony_ci	ret = smsc75xx_write_reg(dev, mask_base + 12, 0);
156562306a36Sopenharmony_ci	if (ret < 0) {
156662306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing WUF_MASKX\n");
156762306a36Sopenharmony_ci		return ret;
156862306a36Sopenharmony_ci	}
156962306a36Sopenharmony_ci
157062306a36Sopenharmony_ci	return 0;
157162306a36Sopenharmony_ci}
157262306a36Sopenharmony_ci
157362306a36Sopenharmony_cistatic int smsc75xx_enter_suspend0(struct usbnet *dev)
157462306a36Sopenharmony_ci{
157562306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
157662306a36Sopenharmony_ci	u32 val;
157762306a36Sopenharmony_ci	int ret;
157862306a36Sopenharmony_ci
157962306a36Sopenharmony_ci	ret = smsc75xx_read_reg_nopm(dev, PMT_CTL, &val);
158062306a36Sopenharmony_ci	if (ret < 0) {
158162306a36Sopenharmony_ci		netdev_warn(dev->net, "Error reading PMT_CTL\n");
158262306a36Sopenharmony_ci		return ret;
158362306a36Sopenharmony_ci	}
158462306a36Sopenharmony_ci
158562306a36Sopenharmony_ci	val &= (~(PMT_CTL_SUS_MODE | PMT_CTL_PHY_RST));
158662306a36Sopenharmony_ci	val |= PMT_CTL_SUS_MODE_0 | PMT_CTL_WOL_EN | PMT_CTL_WUPS;
158762306a36Sopenharmony_ci
158862306a36Sopenharmony_ci	ret = smsc75xx_write_reg_nopm(dev, PMT_CTL, val);
158962306a36Sopenharmony_ci	if (ret < 0) {
159062306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing PMT_CTL\n");
159162306a36Sopenharmony_ci		return ret;
159262306a36Sopenharmony_ci	}
159362306a36Sopenharmony_ci
159462306a36Sopenharmony_ci	pdata->suspend_flags |= SUSPEND_SUSPEND0;
159562306a36Sopenharmony_ci
159662306a36Sopenharmony_ci	return 0;
159762306a36Sopenharmony_ci}
159862306a36Sopenharmony_ci
159962306a36Sopenharmony_cistatic int smsc75xx_enter_suspend1(struct usbnet *dev)
160062306a36Sopenharmony_ci{
160162306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
160262306a36Sopenharmony_ci	u32 val;
160362306a36Sopenharmony_ci	int ret;
160462306a36Sopenharmony_ci
160562306a36Sopenharmony_ci	ret = smsc75xx_read_reg_nopm(dev, PMT_CTL, &val);
160662306a36Sopenharmony_ci	if (ret < 0) {
160762306a36Sopenharmony_ci		netdev_warn(dev->net, "Error reading PMT_CTL\n");
160862306a36Sopenharmony_ci		return ret;
160962306a36Sopenharmony_ci	}
161062306a36Sopenharmony_ci
161162306a36Sopenharmony_ci	val &= ~(PMT_CTL_SUS_MODE | PMT_CTL_WUPS | PMT_CTL_PHY_RST);
161262306a36Sopenharmony_ci	val |= PMT_CTL_SUS_MODE_1;
161362306a36Sopenharmony_ci
161462306a36Sopenharmony_ci	ret = smsc75xx_write_reg_nopm(dev, PMT_CTL, val);
161562306a36Sopenharmony_ci	if (ret < 0) {
161662306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing PMT_CTL\n");
161762306a36Sopenharmony_ci		return ret;
161862306a36Sopenharmony_ci	}
161962306a36Sopenharmony_ci
162062306a36Sopenharmony_ci	/* clear wol status, enable energy detection */
162162306a36Sopenharmony_ci	val &= ~PMT_CTL_WUPS;
162262306a36Sopenharmony_ci	val |= (PMT_CTL_WUPS_ED | PMT_CTL_ED_EN);
162362306a36Sopenharmony_ci
162462306a36Sopenharmony_ci	ret = smsc75xx_write_reg_nopm(dev, PMT_CTL, val);
162562306a36Sopenharmony_ci	if (ret < 0) {
162662306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing PMT_CTL\n");
162762306a36Sopenharmony_ci		return ret;
162862306a36Sopenharmony_ci	}
162962306a36Sopenharmony_ci
163062306a36Sopenharmony_ci	pdata->suspend_flags |= SUSPEND_SUSPEND1;
163162306a36Sopenharmony_ci
163262306a36Sopenharmony_ci	return 0;
163362306a36Sopenharmony_ci}
163462306a36Sopenharmony_ci
163562306a36Sopenharmony_cistatic int smsc75xx_enter_suspend2(struct usbnet *dev)
163662306a36Sopenharmony_ci{
163762306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
163862306a36Sopenharmony_ci	u32 val;
163962306a36Sopenharmony_ci	int ret;
164062306a36Sopenharmony_ci
164162306a36Sopenharmony_ci	ret = smsc75xx_read_reg_nopm(dev, PMT_CTL, &val);
164262306a36Sopenharmony_ci	if (ret < 0) {
164362306a36Sopenharmony_ci		netdev_warn(dev->net, "Error reading PMT_CTL\n");
164462306a36Sopenharmony_ci		return ret;
164562306a36Sopenharmony_ci	}
164662306a36Sopenharmony_ci
164762306a36Sopenharmony_ci	val &= ~(PMT_CTL_SUS_MODE | PMT_CTL_WUPS | PMT_CTL_PHY_RST);
164862306a36Sopenharmony_ci	val |= PMT_CTL_SUS_MODE_2;
164962306a36Sopenharmony_ci
165062306a36Sopenharmony_ci	ret = smsc75xx_write_reg_nopm(dev, PMT_CTL, val);
165162306a36Sopenharmony_ci	if (ret < 0) {
165262306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing PMT_CTL\n");
165362306a36Sopenharmony_ci		return ret;
165462306a36Sopenharmony_ci	}
165562306a36Sopenharmony_ci
165662306a36Sopenharmony_ci	pdata->suspend_flags |= SUSPEND_SUSPEND2;
165762306a36Sopenharmony_ci
165862306a36Sopenharmony_ci	return 0;
165962306a36Sopenharmony_ci}
166062306a36Sopenharmony_ci
166162306a36Sopenharmony_cistatic int smsc75xx_enter_suspend3(struct usbnet *dev)
166262306a36Sopenharmony_ci{
166362306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
166462306a36Sopenharmony_ci	u32 val;
166562306a36Sopenharmony_ci	int ret;
166662306a36Sopenharmony_ci
166762306a36Sopenharmony_ci	ret = smsc75xx_read_reg_nopm(dev, FCT_RX_CTL, &val);
166862306a36Sopenharmony_ci	if (ret < 0) {
166962306a36Sopenharmony_ci		netdev_warn(dev->net, "Error reading FCT_RX_CTL\n");
167062306a36Sopenharmony_ci		return ret;
167162306a36Sopenharmony_ci	}
167262306a36Sopenharmony_ci
167362306a36Sopenharmony_ci	if (val & FCT_RX_CTL_RXUSED) {
167462306a36Sopenharmony_ci		netdev_dbg(dev->net, "rx fifo not empty in autosuspend\n");
167562306a36Sopenharmony_ci		return -EBUSY;
167662306a36Sopenharmony_ci	}
167762306a36Sopenharmony_ci
167862306a36Sopenharmony_ci	ret = smsc75xx_read_reg_nopm(dev, PMT_CTL, &val);
167962306a36Sopenharmony_ci	if (ret < 0) {
168062306a36Sopenharmony_ci		netdev_warn(dev->net, "Error reading PMT_CTL\n");
168162306a36Sopenharmony_ci		return ret;
168262306a36Sopenharmony_ci	}
168362306a36Sopenharmony_ci
168462306a36Sopenharmony_ci	val &= ~(PMT_CTL_SUS_MODE | PMT_CTL_WUPS | PMT_CTL_PHY_RST);
168562306a36Sopenharmony_ci	val |= PMT_CTL_SUS_MODE_3 | PMT_CTL_RES_CLR_WKP_EN;
168662306a36Sopenharmony_ci
168762306a36Sopenharmony_ci	ret = smsc75xx_write_reg_nopm(dev, PMT_CTL, val);
168862306a36Sopenharmony_ci	if (ret < 0) {
168962306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing PMT_CTL\n");
169062306a36Sopenharmony_ci		return ret;
169162306a36Sopenharmony_ci	}
169262306a36Sopenharmony_ci
169362306a36Sopenharmony_ci	/* clear wol status */
169462306a36Sopenharmony_ci	val &= ~PMT_CTL_WUPS;
169562306a36Sopenharmony_ci	val |= PMT_CTL_WUPS_WOL;
169662306a36Sopenharmony_ci
169762306a36Sopenharmony_ci	ret = smsc75xx_write_reg_nopm(dev, PMT_CTL, val);
169862306a36Sopenharmony_ci	if (ret < 0) {
169962306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing PMT_CTL\n");
170062306a36Sopenharmony_ci		return ret;
170162306a36Sopenharmony_ci	}
170262306a36Sopenharmony_ci
170362306a36Sopenharmony_ci	pdata->suspend_flags |= SUSPEND_SUSPEND3;
170462306a36Sopenharmony_ci
170562306a36Sopenharmony_ci	return 0;
170662306a36Sopenharmony_ci}
170762306a36Sopenharmony_ci
170862306a36Sopenharmony_cistatic int smsc75xx_enable_phy_wakeup_interrupts(struct usbnet *dev, u16 mask)
170962306a36Sopenharmony_ci{
171062306a36Sopenharmony_ci	struct mii_if_info *mii = &dev->mii;
171162306a36Sopenharmony_ci	int ret;
171262306a36Sopenharmony_ci
171362306a36Sopenharmony_ci	netdev_dbg(dev->net, "enabling PHY wakeup interrupts\n");
171462306a36Sopenharmony_ci
171562306a36Sopenharmony_ci	/* read to clear */
171662306a36Sopenharmony_ci	ret = smsc75xx_mdio_read_nopm(dev->net, mii->phy_id, PHY_INT_SRC);
171762306a36Sopenharmony_ci	if (ret < 0) {
171862306a36Sopenharmony_ci		netdev_warn(dev->net, "Error reading PHY_INT_SRC\n");
171962306a36Sopenharmony_ci		return ret;
172062306a36Sopenharmony_ci	}
172162306a36Sopenharmony_ci
172262306a36Sopenharmony_ci	/* enable interrupt source */
172362306a36Sopenharmony_ci	ret = smsc75xx_mdio_read_nopm(dev->net, mii->phy_id, PHY_INT_MASK);
172462306a36Sopenharmony_ci	if (ret < 0) {
172562306a36Sopenharmony_ci		netdev_warn(dev->net, "Error reading PHY_INT_MASK\n");
172662306a36Sopenharmony_ci		return ret;
172762306a36Sopenharmony_ci	}
172862306a36Sopenharmony_ci
172962306a36Sopenharmony_ci	ret |= mask;
173062306a36Sopenharmony_ci
173162306a36Sopenharmony_ci	smsc75xx_mdio_write_nopm(dev->net, mii->phy_id, PHY_INT_MASK, ret);
173262306a36Sopenharmony_ci
173362306a36Sopenharmony_ci	return 0;
173462306a36Sopenharmony_ci}
173562306a36Sopenharmony_ci
173662306a36Sopenharmony_cistatic int smsc75xx_link_ok_nopm(struct usbnet *dev)
173762306a36Sopenharmony_ci{
173862306a36Sopenharmony_ci	struct mii_if_info *mii = &dev->mii;
173962306a36Sopenharmony_ci	int ret;
174062306a36Sopenharmony_ci
174162306a36Sopenharmony_ci	/* first, a dummy read, needed to latch some MII phys */
174262306a36Sopenharmony_ci	ret = smsc75xx_mdio_read_nopm(dev->net, mii->phy_id, MII_BMSR);
174362306a36Sopenharmony_ci	if (ret < 0) {
174462306a36Sopenharmony_ci		netdev_warn(dev->net, "Error reading MII_BMSR\n");
174562306a36Sopenharmony_ci		return ret;
174662306a36Sopenharmony_ci	}
174762306a36Sopenharmony_ci
174862306a36Sopenharmony_ci	ret = smsc75xx_mdio_read_nopm(dev->net, mii->phy_id, MII_BMSR);
174962306a36Sopenharmony_ci	if (ret < 0) {
175062306a36Sopenharmony_ci		netdev_warn(dev->net, "Error reading MII_BMSR\n");
175162306a36Sopenharmony_ci		return ret;
175262306a36Sopenharmony_ci	}
175362306a36Sopenharmony_ci
175462306a36Sopenharmony_ci	return !!(ret & BMSR_LSTATUS);
175562306a36Sopenharmony_ci}
175662306a36Sopenharmony_ci
175762306a36Sopenharmony_cistatic int smsc75xx_autosuspend(struct usbnet *dev, u32 link_up)
175862306a36Sopenharmony_ci{
175962306a36Sopenharmony_ci	int ret;
176062306a36Sopenharmony_ci
176162306a36Sopenharmony_ci	if (!netif_running(dev->net)) {
176262306a36Sopenharmony_ci		/* interface is ifconfig down so fully power down hw */
176362306a36Sopenharmony_ci		netdev_dbg(dev->net, "autosuspend entering SUSPEND2\n");
176462306a36Sopenharmony_ci		return smsc75xx_enter_suspend2(dev);
176562306a36Sopenharmony_ci	}
176662306a36Sopenharmony_ci
176762306a36Sopenharmony_ci	if (!link_up) {
176862306a36Sopenharmony_ci		/* link is down so enter EDPD mode */
176962306a36Sopenharmony_ci		netdev_dbg(dev->net, "autosuspend entering SUSPEND1\n");
177062306a36Sopenharmony_ci
177162306a36Sopenharmony_ci		/* enable PHY wakeup events for if cable is attached */
177262306a36Sopenharmony_ci		ret = smsc75xx_enable_phy_wakeup_interrupts(dev,
177362306a36Sopenharmony_ci			PHY_INT_MASK_ANEG_COMP);
177462306a36Sopenharmony_ci		if (ret < 0) {
177562306a36Sopenharmony_ci			netdev_warn(dev->net, "error enabling PHY wakeup ints\n");
177662306a36Sopenharmony_ci			return ret;
177762306a36Sopenharmony_ci		}
177862306a36Sopenharmony_ci
177962306a36Sopenharmony_ci		netdev_info(dev->net, "entering SUSPEND1 mode\n");
178062306a36Sopenharmony_ci		return smsc75xx_enter_suspend1(dev);
178162306a36Sopenharmony_ci	}
178262306a36Sopenharmony_ci
178362306a36Sopenharmony_ci	/* enable PHY wakeup events so we remote wakeup if cable is pulled */
178462306a36Sopenharmony_ci	ret = smsc75xx_enable_phy_wakeup_interrupts(dev,
178562306a36Sopenharmony_ci		PHY_INT_MASK_LINK_DOWN);
178662306a36Sopenharmony_ci	if (ret < 0) {
178762306a36Sopenharmony_ci		netdev_warn(dev->net, "error enabling PHY wakeup ints\n");
178862306a36Sopenharmony_ci		return ret;
178962306a36Sopenharmony_ci	}
179062306a36Sopenharmony_ci
179162306a36Sopenharmony_ci	netdev_dbg(dev->net, "autosuspend entering SUSPEND3\n");
179262306a36Sopenharmony_ci	return smsc75xx_enter_suspend3(dev);
179362306a36Sopenharmony_ci}
179462306a36Sopenharmony_ci
179562306a36Sopenharmony_cistatic int smsc75xx_suspend(struct usb_interface *intf, pm_message_t message)
179662306a36Sopenharmony_ci{
179762306a36Sopenharmony_ci	struct usbnet *dev = usb_get_intfdata(intf);
179862306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
179962306a36Sopenharmony_ci	u32 val, link_up;
180062306a36Sopenharmony_ci	int ret;
180162306a36Sopenharmony_ci
180262306a36Sopenharmony_ci	ret = usbnet_suspend(intf, message);
180362306a36Sopenharmony_ci	if (ret < 0) {
180462306a36Sopenharmony_ci		netdev_warn(dev->net, "usbnet_suspend error\n");
180562306a36Sopenharmony_ci		return ret;
180662306a36Sopenharmony_ci	}
180762306a36Sopenharmony_ci
180862306a36Sopenharmony_ci	if (pdata->suspend_flags) {
180962306a36Sopenharmony_ci		netdev_warn(dev->net, "error during last resume\n");
181062306a36Sopenharmony_ci		pdata->suspend_flags = 0;
181162306a36Sopenharmony_ci	}
181262306a36Sopenharmony_ci
181362306a36Sopenharmony_ci	/* determine if link is up using only _nopm functions */
181462306a36Sopenharmony_ci	link_up = smsc75xx_link_ok_nopm(dev);
181562306a36Sopenharmony_ci
181662306a36Sopenharmony_ci	if (message.event == PM_EVENT_AUTO_SUSPEND) {
181762306a36Sopenharmony_ci		ret = smsc75xx_autosuspend(dev, link_up);
181862306a36Sopenharmony_ci		goto done;
181962306a36Sopenharmony_ci	}
182062306a36Sopenharmony_ci
182162306a36Sopenharmony_ci	/* if we get this far we're not autosuspending */
182262306a36Sopenharmony_ci	/* if no wol options set, or if link is down and we're not waking on
182362306a36Sopenharmony_ci	 * PHY activity, enter lowest power SUSPEND2 mode
182462306a36Sopenharmony_ci	 */
182562306a36Sopenharmony_ci	if (!(pdata->wolopts & SUPPORTED_WAKE) ||
182662306a36Sopenharmony_ci		!(link_up || (pdata->wolopts & WAKE_PHY))) {
182762306a36Sopenharmony_ci		netdev_info(dev->net, "entering SUSPEND2 mode\n");
182862306a36Sopenharmony_ci
182962306a36Sopenharmony_ci		/* disable energy detect (link up) & wake up events */
183062306a36Sopenharmony_ci		ret = smsc75xx_read_reg_nopm(dev, WUCSR, &val);
183162306a36Sopenharmony_ci		if (ret < 0) {
183262306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading WUCSR\n");
183362306a36Sopenharmony_ci			goto done;
183462306a36Sopenharmony_ci		}
183562306a36Sopenharmony_ci
183662306a36Sopenharmony_ci		val &= ~(WUCSR_MPEN | WUCSR_WUEN);
183762306a36Sopenharmony_ci
183862306a36Sopenharmony_ci		ret = smsc75xx_write_reg_nopm(dev, WUCSR, val);
183962306a36Sopenharmony_ci		if (ret < 0) {
184062306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing WUCSR\n");
184162306a36Sopenharmony_ci			goto done;
184262306a36Sopenharmony_ci		}
184362306a36Sopenharmony_ci
184462306a36Sopenharmony_ci		ret = smsc75xx_read_reg_nopm(dev, PMT_CTL, &val);
184562306a36Sopenharmony_ci		if (ret < 0) {
184662306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading PMT_CTL\n");
184762306a36Sopenharmony_ci			goto done;
184862306a36Sopenharmony_ci		}
184962306a36Sopenharmony_ci
185062306a36Sopenharmony_ci		val &= ~(PMT_CTL_ED_EN | PMT_CTL_WOL_EN);
185162306a36Sopenharmony_ci
185262306a36Sopenharmony_ci		ret = smsc75xx_write_reg_nopm(dev, PMT_CTL, val);
185362306a36Sopenharmony_ci		if (ret < 0) {
185462306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing PMT_CTL\n");
185562306a36Sopenharmony_ci			goto done;
185662306a36Sopenharmony_ci		}
185762306a36Sopenharmony_ci
185862306a36Sopenharmony_ci		ret = smsc75xx_enter_suspend2(dev);
185962306a36Sopenharmony_ci		goto done;
186062306a36Sopenharmony_ci	}
186162306a36Sopenharmony_ci
186262306a36Sopenharmony_ci	if (pdata->wolopts & WAKE_PHY) {
186362306a36Sopenharmony_ci		ret = smsc75xx_enable_phy_wakeup_interrupts(dev,
186462306a36Sopenharmony_ci			(PHY_INT_MASK_ANEG_COMP | PHY_INT_MASK_LINK_DOWN));
186562306a36Sopenharmony_ci		if (ret < 0) {
186662306a36Sopenharmony_ci			netdev_warn(dev->net, "error enabling PHY wakeup ints\n");
186762306a36Sopenharmony_ci			goto done;
186862306a36Sopenharmony_ci		}
186962306a36Sopenharmony_ci
187062306a36Sopenharmony_ci		/* if link is down then configure EDPD and enter SUSPEND1,
187162306a36Sopenharmony_ci		 * otherwise enter SUSPEND0 below
187262306a36Sopenharmony_ci		 */
187362306a36Sopenharmony_ci		if (!link_up) {
187462306a36Sopenharmony_ci			struct mii_if_info *mii = &dev->mii;
187562306a36Sopenharmony_ci			netdev_info(dev->net, "entering SUSPEND1 mode\n");
187662306a36Sopenharmony_ci
187762306a36Sopenharmony_ci			/* enable energy detect power-down mode */
187862306a36Sopenharmony_ci			ret = smsc75xx_mdio_read_nopm(dev->net, mii->phy_id,
187962306a36Sopenharmony_ci				PHY_MODE_CTRL_STS);
188062306a36Sopenharmony_ci			if (ret < 0) {
188162306a36Sopenharmony_ci				netdev_warn(dev->net, "Error reading PHY_MODE_CTRL_STS\n");
188262306a36Sopenharmony_ci				goto done;
188362306a36Sopenharmony_ci			}
188462306a36Sopenharmony_ci
188562306a36Sopenharmony_ci			ret |= MODE_CTRL_STS_EDPWRDOWN;
188662306a36Sopenharmony_ci
188762306a36Sopenharmony_ci			smsc75xx_mdio_write_nopm(dev->net, mii->phy_id,
188862306a36Sopenharmony_ci				PHY_MODE_CTRL_STS, ret);
188962306a36Sopenharmony_ci
189062306a36Sopenharmony_ci			/* enter SUSPEND1 mode */
189162306a36Sopenharmony_ci			ret = smsc75xx_enter_suspend1(dev);
189262306a36Sopenharmony_ci			goto done;
189362306a36Sopenharmony_ci		}
189462306a36Sopenharmony_ci	}
189562306a36Sopenharmony_ci
189662306a36Sopenharmony_ci	if (pdata->wolopts & (WAKE_MCAST | WAKE_ARP)) {
189762306a36Sopenharmony_ci		int i, filter = 0;
189862306a36Sopenharmony_ci
189962306a36Sopenharmony_ci		/* disable all filters */
190062306a36Sopenharmony_ci		for (i = 0; i < WUF_NUM; i++) {
190162306a36Sopenharmony_ci			ret = smsc75xx_write_reg_nopm(dev, WUF_CFGX + i * 4, 0);
190262306a36Sopenharmony_ci			if (ret < 0) {
190362306a36Sopenharmony_ci				netdev_warn(dev->net, "Error writing WUF_CFGX\n");
190462306a36Sopenharmony_ci				goto done;
190562306a36Sopenharmony_ci			}
190662306a36Sopenharmony_ci		}
190762306a36Sopenharmony_ci
190862306a36Sopenharmony_ci		if (pdata->wolopts & WAKE_MCAST) {
190962306a36Sopenharmony_ci			const u8 mcast[] = {0x01, 0x00, 0x5E};
191062306a36Sopenharmony_ci			netdev_info(dev->net, "enabling multicast detection\n");
191162306a36Sopenharmony_ci
191262306a36Sopenharmony_ci			val = WUF_CFGX_EN | WUF_CFGX_ATYPE_MULTICAST
191362306a36Sopenharmony_ci				| smsc_crc(mcast, 3);
191462306a36Sopenharmony_ci			ret = smsc75xx_write_wuff(dev, filter++, val, 0x0007);
191562306a36Sopenharmony_ci			if (ret < 0) {
191662306a36Sopenharmony_ci				netdev_warn(dev->net, "Error writing wakeup filter\n");
191762306a36Sopenharmony_ci				goto done;
191862306a36Sopenharmony_ci			}
191962306a36Sopenharmony_ci		}
192062306a36Sopenharmony_ci
192162306a36Sopenharmony_ci		if (pdata->wolopts & WAKE_ARP) {
192262306a36Sopenharmony_ci			const u8 arp[] = {0x08, 0x06};
192362306a36Sopenharmony_ci			netdev_info(dev->net, "enabling ARP detection\n");
192462306a36Sopenharmony_ci
192562306a36Sopenharmony_ci			val = WUF_CFGX_EN | WUF_CFGX_ATYPE_ALL | (0x0C << 16)
192662306a36Sopenharmony_ci				| smsc_crc(arp, 2);
192762306a36Sopenharmony_ci			ret = smsc75xx_write_wuff(dev, filter++, val, 0x0003);
192862306a36Sopenharmony_ci			if (ret < 0) {
192962306a36Sopenharmony_ci				netdev_warn(dev->net, "Error writing wakeup filter\n");
193062306a36Sopenharmony_ci				goto done;
193162306a36Sopenharmony_ci			}
193262306a36Sopenharmony_ci		}
193362306a36Sopenharmony_ci
193462306a36Sopenharmony_ci		/* clear any pending pattern match packet status */
193562306a36Sopenharmony_ci		ret = smsc75xx_read_reg_nopm(dev, WUCSR, &val);
193662306a36Sopenharmony_ci		if (ret < 0) {
193762306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading WUCSR\n");
193862306a36Sopenharmony_ci			goto done;
193962306a36Sopenharmony_ci		}
194062306a36Sopenharmony_ci
194162306a36Sopenharmony_ci		val |= WUCSR_WUFR;
194262306a36Sopenharmony_ci
194362306a36Sopenharmony_ci		ret = smsc75xx_write_reg_nopm(dev, WUCSR, val);
194462306a36Sopenharmony_ci		if (ret < 0) {
194562306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing WUCSR\n");
194662306a36Sopenharmony_ci			goto done;
194762306a36Sopenharmony_ci		}
194862306a36Sopenharmony_ci
194962306a36Sopenharmony_ci		netdev_info(dev->net, "enabling packet match detection\n");
195062306a36Sopenharmony_ci		ret = smsc75xx_read_reg_nopm(dev, WUCSR, &val);
195162306a36Sopenharmony_ci		if (ret < 0) {
195262306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading WUCSR\n");
195362306a36Sopenharmony_ci			goto done;
195462306a36Sopenharmony_ci		}
195562306a36Sopenharmony_ci
195662306a36Sopenharmony_ci		val |= WUCSR_WUEN;
195762306a36Sopenharmony_ci
195862306a36Sopenharmony_ci		ret = smsc75xx_write_reg_nopm(dev, WUCSR, val);
195962306a36Sopenharmony_ci		if (ret < 0) {
196062306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing WUCSR\n");
196162306a36Sopenharmony_ci			goto done;
196262306a36Sopenharmony_ci		}
196362306a36Sopenharmony_ci	} else {
196462306a36Sopenharmony_ci		netdev_info(dev->net, "disabling packet match detection\n");
196562306a36Sopenharmony_ci		ret = smsc75xx_read_reg_nopm(dev, WUCSR, &val);
196662306a36Sopenharmony_ci		if (ret < 0) {
196762306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading WUCSR\n");
196862306a36Sopenharmony_ci			goto done;
196962306a36Sopenharmony_ci		}
197062306a36Sopenharmony_ci
197162306a36Sopenharmony_ci		val &= ~WUCSR_WUEN;
197262306a36Sopenharmony_ci
197362306a36Sopenharmony_ci		ret = smsc75xx_write_reg_nopm(dev, WUCSR, val);
197462306a36Sopenharmony_ci		if (ret < 0) {
197562306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing WUCSR\n");
197662306a36Sopenharmony_ci			goto done;
197762306a36Sopenharmony_ci		}
197862306a36Sopenharmony_ci	}
197962306a36Sopenharmony_ci
198062306a36Sopenharmony_ci	/* disable magic, bcast & unicast wakeup sources */
198162306a36Sopenharmony_ci	ret = smsc75xx_read_reg_nopm(dev, WUCSR, &val);
198262306a36Sopenharmony_ci	if (ret < 0) {
198362306a36Sopenharmony_ci		netdev_warn(dev->net, "Error reading WUCSR\n");
198462306a36Sopenharmony_ci		goto done;
198562306a36Sopenharmony_ci	}
198662306a36Sopenharmony_ci
198762306a36Sopenharmony_ci	val &= ~(WUCSR_MPEN | WUCSR_BCST_EN | WUCSR_PFDA_EN);
198862306a36Sopenharmony_ci
198962306a36Sopenharmony_ci	ret = smsc75xx_write_reg_nopm(dev, WUCSR, val);
199062306a36Sopenharmony_ci	if (ret < 0) {
199162306a36Sopenharmony_ci		netdev_warn(dev->net, "Error writing WUCSR\n");
199262306a36Sopenharmony_ci		goto done;
199362306a36Sopenharmony_ci	}
199462306a36Sopenharmony_ci
199562306a36Sopenharmony_ci	if (pdata->wolopts & WAKE_PHY) {
199662306a36Sopenharmony_ci		netdev_info(dev->net, "enabling PHY wakeup\n");
199762306a36Sopenharmony_ci
199862306a36Sopenharmony_ci		ret = smsc75xx_read_reg_nopm(dev, PMT_CTL, &val);
199962306a36Sopenharmony_ci		if (ret < 0) {
200062306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading PMT_CTL\n");
200162306a36Sopenharmony_ci			goto done;
200262306a36Sopenharmony_ci		}
200362306a36Sopenharmony_ci
200462306a36Sopenharmony_ci		/* clear wol status, enable energy detection */
200562306a36Sopenharmony_ci		val &= ~PMT_CTL_WUPS;
200662306a36Sopenharmony_ci		val |= (PMT_CTL_WUPS_ED | PMT_CTL_ED_EN);
200762306a36Sopenharmony_ci
200862306a36Sopenharmony_ci		ret = smsc75xx_write_reg_nopm(dev, PMT_CTL, val);
200962306a36Sopenharmony_ci		if (ret < 0) {
201062306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing PMT_CTL\n");
201162306a36Sopenharmony_ci			goto done;
201262306a36Sopenharmony_ci		}
201362306a36Sopenharmony_ci	}
201462306a36Sopenharmony_ci
201562306a36Sopenharmony_ci	if (pdata->wolopts & WAKE_MAGIC) {
201662306a36Sopenharmony_ci		netdev_info(dev->net, "enabling magic packet wakeup\n");
201762306a36Sopenharmony_ci		ret = smsc75xx_read_reg_nopm(dev, WUCSR, &val);
201862306a36Sopenharmony_ci		if (ret < 0) {
201962306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading WUCSR\n");
202062306a36Sopenharmony_ci			goto done;
202162306a36Sopenharmony_ci		}
202262306a36Sopenharmony_ci
202362306a36Sopenharmony_ci		/* clear any pending magic packet status */
202462306a36Sopenharmony_ci		val |= WUCSR_MPR | WUCSR_MPEN;
202562306a36Sopenharmony_ci
202662306a36Sopenharmony_ci		ret = smsc75xx_write_reg_nopm(dev, WUCSR, val);
202762306a36Sopenharmony_ci		if (ret < 0) {
202862306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing WUCSR\n");
202962306a36Sopenharmony_ci			goto done;
203062306a36Sopenharmony_ci		}
203162306a36Sopenharmony_ci	}
203262306a36Sopenharmony_ci
203362306a36Sopenharmony_ci	if (pdata->wolopts & WAKE_BCAST) {
203462306a36Sopenharmony_ci		netdev_info(dev->net, "enabling broadcast detection\n");
203562306a36Sopenharmony_ci		ret = smsc75xx_read_reg_nopm(dev, WUCSR, &val);
203662306a36Sopenharmony_ci		if (ret < 0) {
203762306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading WUCSR\n");
203862306a36Sopenharmony_ci			goto done;
203962306a36Sopenharmony_ci		}
204062306a36Sopenharmony_ci
204162306a36Sopenharmony_ci		val |= WUCSR_BCAST_FR | WUCSR_BCST_EN;
204262306a36Sopenharmony_ci
204362306a36Sopenharmony_ci		ret = smsc75xx_write_reg_nopm(dev, WUCSR, val);
204462306a36Sopenharmony_ci		if (ret < 0) {
204562306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing WUCSR\n");
204662306a36Sopenharmony_ci			goto done;
204762306a36Sopenharmony_ci		}
204862306a36Sopenharmony_ci	}
204962306a36Sopenharmony_ci
205062306a36Sopenharmony_ci	if (pdata->wolopts & WAKE_UCAST) {
205162306a36Sopenharmony_ci		netdev_info(dev->net, "enabling unicast detection\n");
205262306a36Sopenharmony_ci		ret = smsc75xx_read_reg_nopm(dev, WUCSR, &val);
205362306a36Sopenharmony_ci		if (ret < 0) {
205462306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading WUCSR\n");
205562306a36Sopenharmony_ci			goto done;
205662306a36Sopenharmony_ci		}
205762306a36Sopenharmony_ci
205862306a36Sopenharmony_ci		val |= WUCSR_WUFR | WUCSR_PFDA_EN;
205962306a36Sopenharmony_ci
206062306a36Sopenharmony_ci		ret = smsc75xx_write_reg_nopm(dev, WUCSR, val);
206162306a36Sopenharmony_ci		if (ret < 0) {
206262306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing WUCSR\n");
206362306a36Sopenharmony_ci			goto done;
206462306a36Sopenharmony_ci		}
206562306a36Sopenharmony_ci	}
206662306a36Sopenharmony_ci
206762306a36Sopenharmony_ci	/* enable receiver to enable frame reception */
206862306a36Sopenharmony_ci	ret = smsc75xx_read_reg_nopm(dev, MAC_RX, &val);
206962306a36Sopenharmony_ci	if (ret < 0) {
207062306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to read MAC_RX: %d\n", ret);
207162306a36Sopenharmony_ci		goto done;
207262306a36Sopenharmony_ci	}
207362306a36Sopenharmony_ci
207462306a36Sopenharmony_ci	val |= MAC_RX_RXEN;
207562306a36Sopenharmony_ci
207662306a36Sopenharmony_ci	ret = smsc75xx_write_reg_nopm(dev, MAC_RX, val);
207762306a36Sopenharmony_ci	if (ret < 0) {
207862306a36Sopenharmony_ci		netdev_warn(dev->net, "Failed to write MAC_RX: %d\n", ret);
207962306a36Sopenharmony_ci		goto done;
208062306a36Sopenharmony_ci	}
208162306a36Sopenharmony_ci
208262306a36Sopenharmony_ci	/* some wol options are enabled, so enter SUSPEND0 */
208362306a36Sopenharmony_ci	netdev_info(dev->net, "entering SUSPEND0 mode\n");
208462306a36Sopenharmony_ci	ret = smsc75xx_enter_suspend0(dev);
208562306a36Sopenharmony_ci
208662306a36Sopenharmony_cidone:
208762306a36Sopenharmony_ci	/*
208862306a36Sopenharmony_ci	 * TODO: resume() might need to handle the suspend failure
208962306a36Sopenharmony_ci	 * in system sleep
209062306a36Sopenharmony_ci	 */
209162306a36Sopenharmony_ci	if (ret && PMSG_IS_AUTO(message))
209262306a36Sopenharmony_ci		usbnet_resume(intf);
209362306a36Sopenharmony_ci	return ret;
209462306a36Sopenharmony_ci}
209562306a36Sopenharmony_ci
209662306a36Sopenharmony_cistatic int smsc75xx_resume(struct usb_interface *intf)
209762306a36Sopenharmony_ci{
209862306a36Sopenharmony_ci	struct usbnet *dev = usb_get_intfdata(intf);
209962306a36Sopenharmony_ci	struct smsc75xx_priv *pdata = (struct smsc75xx_priv *)(dev->data[0]);
210062306a36Sopenharmony_ci	u8 suspend_flags = pdata->suspend_flags;
210162306a36Sopenharmony_ci	int ret;
210262306a36Sopenharmony_ci	u32 val;
210362306a36Sopenharmony_ci
210462306a36Sopenharmony_ci	netdev_dbg(dev->net, "resume suspend_flags=0x%02x\n", suspend_flags);
210562306a36Sopenharmony_ci
210662306a36Sopenharmony_ci	/* do this first to ensure it's cleared even in error case */
210762306a36Sopenharmony_ci	pdata->suspend_flags = 0;
210862306a36Sopenharmony_ci
210962306a36Sopenharmony_ci	if (suspend_flags & SUSPEND_ALLMODES) {
211062306a36Sopenharmony_ci		/* Disable wakeup sources */
211162306a36Sopenharmony_ci		ret = smsc75xx_read_reg_nopm(dev, WUCSR, &val);
211262306a36Sopenharmony_ci		if (ret < 0) {
211362306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading WUCSR\n");
211462306a36Sopenharmony_ci			return ret;
211562306a36Sopenharmony_ci		}
211662306a36Sopenharmony_ci
211762306a36Sopenharmony_ci		val &= ~(WUCSR_WUEN | WUCSR_MPEN | WUCSR_PFDA_EN
211862306a36Sopenharmony_ci			| WUCSR_BCST_EN);
211962306a36Sopenharmony_ci
212062306a36Sopenharmony_ci		ret = smsc75xx_write_reg_nopm(dev, WUCSR, val);
212162306a36Sopenharmony_ci		if (ret < 0) {
212262306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing WUCSR\n");
212362306a36Sopenharmony_ci			return ret;
212462306a36Sopenharmony_ci		}
212562306a36Sopenharmony_ci
212662306a36Sopenharmony_ci		/* clear wake-up status */
212762306a36Sopenharmony_ci		ret = smsc75xx_read_reg_nopm(dev, PMT_CTL, &val);
212862306a36Sopenharmony_ci		if (ret < 0) {
212962306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading PMT_CTL\n");
213062306a36Sopenharmony_ci			return ret;
213162306a36Sopenharmony_ci		}
213262306a36Sopenharmony_ci
213362306a36Sopenharmony_ci		val &= ~PMT_CTL_WOL_EN;
213462306a36Sopenharmony_ci		val |= PMT_CTL_WUPS;
213562306a36Sopenharmony_ci
213662306a36Sopenharmony_ci		ret = smsc75xx_write_reg_nopm(dev, PMT_CTL, val);
213762306a36Sopenharmony_ci		if (ret < 0) {
213862306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing PMT_CTL\n");
213962306a36Sopenharmony_ci			return ret;
214062306a36Sopenharmony_ci		}
214162306a36Sopenharmony_ci	}
214262306a36Sopenharmony_ci
214362306a36Sopenharmony_ci	if (suspend_flags & SUSPEND_SUSPEND2) {
214462306a36Sopenharmony_ci		netdev_info(dev->net, "resuming from SUSPEND2\n");
214562306a36Sopenharmony_ci
214662306a36Sopenharmony_ci		ret = smsc75xx_read_reg_nopm(dev, PMT_CTL, &val);
214762306a36Sopenharmony_ci		if (ret < 0) {
214862306a36Sopenharmony_ci			netdev_warn(dev->net, "Error reading PMT_CTL\n");
214962306a36Sopenharmony_ci			return ret;
215062306a36Sopenharmony_ci		}
215162306a36Sopenharmony_ci
215262306a36Sopenharmony_ci		val |= PMT_CTL_PHY_PWRUP;
215362306a36Sopenharmony_ci
215462306a36Sopenharmony_ci		ret = smsc75xx_write_reg_nopm(dev, PMT_CTL, val);
215562306a36Sopenharmony_ci		if (ret < 0) {
215662306a36Sopenharmony_ci			netdev_warn(dev->net, "Error writing PMT_CTL\n");
215762306a36Sopenharmony_ci			return ret;
215862306a36Sopenharmony_ci		}
215962306a36Sopenharmony_ci	}
216062306a36Sopenharmony_ci
216162306a36Sopenharmony_ci	ret = smsc75xx_wait_ready(dev, 1);
216262306a36Sopenharmony_ci	if (ret < 0) {
216362306a36Sopenharmony_ci		netdev_warn(dev->net, "device not ready in smsc75xx_resume\n");
216462306a36Sopenharmony_ci		return ret;
216562306a36Sopenharmony_ci	}
216662306a36Sopenharmony_ci
216762306a36Sopenharmony_ci	return usbnet_resume(intf);
216862306a36Sopenharmony_ci}
216962306a36Sopenharmony_ci
217062306a36Sopenharmony_cistatic void smsc75xx_rx_csum_offload(struct usbnet *dev, struct sk_buff *skb,
217162306a36Sopenharmony_ci				     u32 rx_cmd_a, u32 rx_cmd_b)
217262306a36Sopenharmony_ci{
217362306a36Sopenharmony_ci	if (!(dev->net->features & NETIF_F_RXCSUM) ||
217462306a36Sopenharmony_ci	    unlikely(rx_cmd_a & RX_CMD_A_LCSM)) {
217562306a36Sopenharmony_ci		skb->ip_summed = CHECKSUM_NONE;
217662306a36Sopenharmony_ci	} else {
217762306a36Sopenharmony_ci		skb->csum = ntohs((u16)(rx_cmd_b >> RX_CMD_B_CSUM_SHIFT));
217862306a36Sopenharmony_ci		skb->ip_summed = CHECKSUM_COMPLETE;
217962306a36Sopenharmony_ci	}
218062306a36Sopenharmony_ci}
218162306a36Sopenharmony_ci
218262306a36Sopenharmony_cistatic int smsc75xx_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
218362306a36Sopenharmony_ci{
218462306a36Sopenharmony_ci	/* This check is no longer done by usbnet */
218562306a36Sopenharmony_ci	if (skb->len < dev->net->hard_header_len)
218662306a36Sopenharmony_ci		return 0;
218762306a36Sopenharmony_ci
218862306a36Sopenharmony_ci	while (skb->len > 0) {
218962306a36Sopenharmony_ci		u32 rx_cmd_a, rx_cmd_b, align_count, size;
219062306a36Sopenharmony_ci		struct sk_buff *ax_skb;
219162306a36Sopenharmony_ci		unsigned char *packet;
219262306a36Sopenharmony_ci
219362306a36Sopenharmony_ci		rx_cmd_a = get_unaligned_le32(skb->data);
219462306a36Sopenharmony_ci		skb_pull(skb, 4);
219562306a36Sopenharmony_ci
219662306a36Sopenharmony_ci		rx_cmd_b = get_unaligned_le32(skb->data);
219762306a36Sopenharmony_ci		skb_pull(skb, 4 + RXW_PADDING);
219862306a36Sopenharmony_ci
219962306a36Sopenharmony_ci		packet = skb->data;
220062306a36Sopenharmony_ci
220162306a36Sopenharmony_ci		/* get the packet length */
220262306a36Sopenharmony_ci		size = (rx_cmd_a & RX_CMD_A_LEN) - RXW_PADDING;
220362306a36Sopenharmony_ci		align_count = (4 - ((size + RXW_PADDING) % 4)) % 4;
220462306a36Sopenharmony_ci
220562306a36Sopenharmony_ci		if (unlikely(size > skb->len)) {
220662306a36Sopenharmony_ci			netif_dbg(dev, rx_err, dev->net,
220762306a36Sopenharmony_ci				  "size err rx_cmd_a=0x%08x\n",
220862306a36Sopenharmony_ci				  rx_cmd_a);
220962306a36Sopenharmony_ci			return 0;
221062306a36Sopenharmony_ci		}
221162306a36Sopenharmony_ci
221262306a36Sopenharmony_ci		if (unlikely(rx_cmd_a & RX_CMD_A_RED)) {
221362306a36Sopenharmony_ci			netif_dbg(dev, rx_err, dev->net,
221462306a36Sopenharmony_ci				  "Error rx_cmd_a=0x%08x\n", rx_cmd_a);
221562306a36Sopenharmony_ci			dev->net->stats.rx_errors++;
221662306a36Sopenharmony_ci			dev->net->stats.rx_dropped++;
221762306a36Sopenharmony_ci
221862306a36Sopenharmony_ci			if (rx_cmd_a & RX_CMD_A_FCS)
221962306a36Sopenharmony_ci				dev->net->stats.rx_crc_errors++;
222062306a36Sopenharmony_ci			else if (rx_cmd_a & (RX_CMD_A_LONG | RX_CMD_A_RUNT))
222162306a36Sopenharmony_ci				dev->net->stats.rx_frame_errors++;
222262306a36Sopenharmony_ci		} else {
222362306a36Sopenharmony_ci			/* MAX_SINGLE_PACKET_SIZE + 4(CRC) + 2(COE) + 4(Vlan) */
222462306a36Sopenharmony_ci			if (unlikely(size > (MAX_SINGLE_PACKET_SIZE + ETH_HLEN + 12))) {
222562306a36Sopenharmony_ci				netif_dbg(dev, rx_err, dev->net,
222662306a36Sopenharmony_ci					  "size err rx_cmd_a=0x%08x\n",
222762306a36Sopenharmony_ci					  rx_cmd_a);
222862306a36Sopenharmony_ci				return 0;
222962306a36Sopenharmony_ci			}
223062306a36Sopenharmony_ci
223162306a36Sopenharmony_ci			/* last frame in this batch */
223262306a36Sopenharmony_ci			if (skb->len == size) {
223362306a36Sopenharmony_ci				smsc75xx_rx_csum_offload(dev, skb, rx_cmd_a,
223462306a36Sopenharmony_ci					rx_cmd_b);
223562306a36Sopenharmony_ci
223662306a36Sopenharmony_ci				skb_trim(skb, skb->len - 4); /* remove fcs */
223762306a36Sopenharmony_ci				skb->truesize = size + sizeof(struct sk_buff);
223862306a36Sopenharmony_ci
223962306a36Sopenharmony_ci				return 1;
224062306a36Sopenharmony_ci			}
224162306a36Sopenharmony_ci
224262306a36Sopenharmony_ci			ax_skb = skb_clone(skb, GFP_ATOMIC);
224362306a36Sopenharmony_ci			if (unlikely(!ax_skb)) {
224462306a36Sopenharmony_ci				netdev_warn(dev->net, "Error allocating skb\n");
224562306a36Sopenharmony_ci				return 0;
224662306a36Sopenharmony_ci			}
224762306a36Sopenharmony_ci
224862306a36Sopenharmony_ci			ax_skb->len = size;
224962306a36Sopenharmony_ci			ax_skb->data = packet;
225062306a36Sopenharmony_ci			skb_set_tail_pointer(ax_skb, size);
225162306a36Sopenharmony_ci
225262306a36Sopenharmony_ci			smsc75xx_rx_csum_offload(dev, ax_skb, rx_cmd_a,
225362306a36Sopenharmony_ci				rx_cmd_b);
225462306a36Sopenharmony_ci
225562306a36Sopenharmony_ci			skb_trim(ax_skb, ax_skb->len - 4); /* remove fcs */
225662306a36Sopenharmony_ci			ax_skb->truesize = size + sizeof(struct sk_buff);
225762306a36Sopenharmony_ci
225862306a36Sopenharmony_ci			usbnet_skb_return(dev, ax_skb);
225962306a36Sopenharmony_ci		}
226062306a36Sopenharmony_ci
226162306a36Sopenharmony_ci		skb_pull(skb, size);
226262306a36Sopenharmony_ci
226362306a36Sopenharmony_ci		/* padding bytes before the next frame starts */
226462306a36Sopenharmony_ci		if (skb->len)
226562306a36Sopenharmony_ci			skb_pull(skb, align_count);
226662306a36Sopenharmony_ci	}
226762306a36Sopenharmony_ci
226862306a36Sopenharmony_ci	return 1;
226962306a36Sopenharmony_ci}
227062306a36Sopenharmony_ci
227162306a36Sopenharmony_cistatic struct sk_buff *smsc75xx_tx_fixup(struct usbnet *dev,
227262306a36Sopenharmony_ci					 struct sk_buff *skb, gfp_t flags)
227362306a36Sopenharmony_ci{
227462306a36Sopenharmony_ci	u32 tx_cmd_a, tx_cmd_b;
227562306a36Sopenharmony_ci	void *ptr;
227662306a36Sopenharmony_ci
227762306a36Sopenharmony_ci	if (skb_cow_head(skb, SMSC75XX_TX_OVERHEAD)) {
227862306a36Sopenharmony_ci		dev_kfree_skb_any(skb);
227962306a36Sopenharmony_ci		return NULL;
228062306a36Sopenharmony_ci	}
228162306a36Sopenharmony_ci
228262306a36Sopenharmony_ci	tx_cmd_a = (u32)(skb->len & TX_CMD_A_LEN) | TX_CMD_A_FCS;
228362306a36Sopenharmony_ci
228462306a36Sopenharmony_ci	if (skb->ip_summed == CHECKSUM_PARTIAL)
228562306a36Sopenharmony_ci		tx_cmd_a |= TX_CMD_A_IPE | TX_CMD_A_TPE;
228662306a36Sopenharmony_ci
228762306a36Sopenharmony_ci	if (skb_is_gso(skb)) {
228862306a36Sopenharmony_ci		u16 mss = max(skb_shinfo(skb)->gso_size, TX_MSS_MIN);
228962306a36Sopenharmony_ci		tx_cmd_b = (mss << TX_CMD_B_MSS_SHIFT) & TX_CMD_B_MSS;
229062306a36Sopenharmony_ci
229162306a36Sopenharmony_ci		tx_cmd_a |= TX_CMD_A_LSO;
229262306a36Sopenharmony_ci	} else {
229362306a36Sopenharmony_ci		tx_cmd_b = 0;
229462306a36Sopenharmony_ci	}
229562306a36Sopenharmony_ci
229662306a36Sopenharmony_ci	ptr = skb_push(skb, 8);
229762306a36Sopenharmony_ci	put_unaligned_le32(tx_cmd_a, ptr);
229862306a36Sopenharmony_ci	put_unaligned_le32(tx_cmd_b, ptr + 4);
229962306a36Sopenharmony_ci
230062306a36Sopenharmony_ci	return skb;
230162306a36Sopenharmony_ci}
230262306a36Sopenharmony_ci
230362306a36Sopenharmony_cistatic int smsc75xx_manage_power(struct usbnet *dev, int on)
230462306a36Sopenharmony_ci{
230562306a36Sopenharmony_ci	dev->intf->needs_remote_wakeup = on;
230662306a36Sopenharmony_ci	return 0;
230762306a36Sopenharmony_ci}
230862306a36Sopenharmony_ci
230962306a36Sopenharmony_cistatic const struct driver_info smsc75xx_info = {
231062306a36Sopenharmony_ci	.description	= "smsc75xx USB 2.0 Gigabit Ethernet",
231162306a36Sopenharmony_ci	.bind		= smsc75xx_bind,
231262306a36Sopenharmony_ci	.unbind		= smsc75xx_unbind,
231362306a36Sopenharmony_ci	.link_reset	= smsc75xx_link_reset,
231462306a36Sopenharmony_ci	.reset		= smsc75xx_reset,
231562306a36Sopenharmony_ci	.rx_fixup	= smsc75xx_rx_fixup,
231662306a36Sopenharmony_ci	.tx_fixup	= smsc75xx_tx_fixup,
231762306a36Sopenharmony_ci	.status		= smsc75xx_status,
231862306a36Sopenharmony_ci	.manage_power	= smsc75xx_manage_power,
231962306a36Sopenharmony_ci	.flags		= FLAG_ETHER | FLAG_SEND_ZLP | FLAG_LINK_INTR,
232062306a36Sopenharmony_ci};
232162306a36Sopenharmony_ci
232262306a36Sopenharmony_cistatic const struct usb_device_id products[] = {
232362306a36Sopenharmony_ci	{
232462306a36Sopenharmony_ci		/* SMSC7500 USB Gigabit Ethernet Device */
232562306a36Sopenharmony_ci		USB_DEVICE(USB_VENDOR_ID_SMSC, USB_PRODUCT_ID_LAN7500),
232662306a36Sopenharmony_ci		.driver_info = (unsigned long) &smsc75xx_info,
232762306a36Sopenharmony_ci	},
232862306a36Sopenharmony_ci	{
232962306a36Sopenharmony_ci		/* SMSC7500 USB Gigabit Ethernet Device */
233062306a36Sopenharmony_ci		USB_DEVICE(USB_VENDOR_ID_SMSC, USB_PRODUCT_ID_LAN7505),
233162306a36Sopenharmony_ci		.driver_info = (unsigned long) &smsc75xx_info,
233262306a36Sopenharmony_ci	},
233362306a36Sopenharmony_ci	{ },		/* END */
233462306a36Sopenharmony_ci};
233562306a36Sopenharmony_ciMODULE_DEVICE_TABLE(usb, products);
233662306a36Sopenharmony_ci
233762306a36Sopenharmony_cistatic struct usb_driver smsc75xx_driver = {
233862306a36Sopenharmony_ci	.name		= SMSC_CHIPNAME,
233962306a36Sopenharmony_ci	.id_table	= products,
234062306a36Sopenharmony_ci	.probe		= usbnet_probe,
234162306a36Sopenharmony_ci	.suspend	= smsc75xx_suspend,
234262306a36Sopenharmony_ci	.resume		= smsc75xx_resume,
234362306a36Sopenharmony_ci	.reset_resume	= smsc75xx_resume,
234462306a36Sopenharmony_ci	.disconnect	= usbnet_disconnect,
234562306a36Sopenharmony_ci	.disable_hub_initiated_lpm = 1,
234662306a36Sopenharmony_ci	.supports_autosuspend = 1,
234762306a36Sopenharmony_ci};
234862306a36Sopenharmony_ci
234962306a36Sopenharmony_cimodule_usb_driver(smsc75xx_driver);
235062306a36Sopenharmony_ci
235162306a36Sopenharmony_ciMODULE_AUTHOR("Nancy Lin");
235262306a36Sopenharmony_ciMODULE_AUTHOR("Steve Glendinning <steve.glendinning@shawell.net>");
235362306a36Sopenharmony_ciMODULE_DESCRIPTION("SMSC75XX USB 2.0 Gigabit Ethernet Devices");
235462306a36Sopenharmony_ciMODULE_LICENSE("GPL");
2355