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