|
@@ -0,0 +1,696 @@
|
|
|
+/* SPDX-License-Identifier: GPL-2.0+ */
|
|
|
+/* Copyright (C) 2018 Microchip Technology Inc. */
|
|
|
+
|
|
|
+#include <linux/netdevice.h>
|
|
|
+#include "lan743x_main.h"
|
|
|
+#include "lan743x_ethtool.h"
|
|
|
+#include <linux/pci.h>
|
|
|
+#include <linux/phy.h>
|
|
|
+
|
|
|
+/* eeprom */
|
|
|
+#define LAN743X_EEPROM_MAGIC (0x74A5)
|
|
|
+#define LAN743X_OTP_MAGIC (0x74F3)
|
|
|
+#define EEPROM_INDICATOR_1 (0xA5)
|
|
|
+#define EEPROM_INDICATOR_2 (0xAA)
|
|
|
+#define EEPROM_MAC_OFFSET (0x01)
|
|
|
+#define MAX_EEPROM_SIZE 512
|
|
|
+#define OTP_INDICATOR_1 (0xF3)
|
|
|
+#define OTP_INDICATOR_2 (0xF7)
|
|
|
+
|
|
|
+static int lan743x_otp_write(struct lan743x_adapter *adapter, u32 offset,
|
|
|
+ u32 length, u8 *data)
|
|
|
+{
|
|
|
+ unsigned long timeout;
|
|
|
+ u32 buf;
|
|
|
+ int i;
|
|
|
+
|
|
|
+ buf = lan743x_csr_read(adapter, OTP_PWR_DN);
|
|
|
+
|
|
|
+ if (buf & OTP_PWR_DN_PWRDN_N_) {
|
|
|
+ /* clear it and wait to be cleared */
|
|
|
+ lan743x_csr_write(adapter, OTP_PWR_DN, 0);
|
|
|
+
|
|
|
+ timeout = jiffies + HZ;
|
|
|
+ do {
|
|
|
+ udelay(1);
|
|
|
+ buf = lan743x_csr_read(adapter, OTP_PWR_DN);
|
|
|
+ if (time_after(jiffies, timeout)) {
|
|
|
+ netif_warn(adapter, drv, adapter->netdev,
|
|
|
+ "timeout on OTP_PWR_DN completion\n");
|
|
|
+ return -EIO;
|
|
|
+ }
|
|
|
+ } while (buf & OTP_PWR_DN_PWRDN_N_);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* set to BYTE program mode */
|
|
|
+ lan743x_csr_write(adapter, OTP_PRGM_MODE, OTP_PRGM_MODE_BYTE_);
|
|
|
+
|
|
|
+ for (i = 0; i < length; i++) {
|
|
|
+ lan743x_csr_write(adapter, OTP_ADDR1,
|
|
|
+ ((offset + i) >> 8) &
|
|
|
+ OTP_ADDR1_15_11_MASK_);
|
|
|
+ lan743x_csr_write(adapter, OTP_ADDR2,
|
|
|
+ ((offset + i) &
|
|
|
+ OTP_ADDR2_10_3_MASK_));
|
|
|
+ lan743x_csr_write(adapter, OTP_PRGM_DATA, data[i]);
|
|
|
+ lan743x_csr_write(adapter, OTP_TST_CMD, OTP_TST_CMD_PRGVRFY_);
|
|
|
+ lan743x_csr_write(adapter, OTP_CMD_GO, OTP_CMD_GO_GO_);
|
|
|
+
|
|
|
+ timeout = jiffies + HZ;
|
|
|
+ do {
|
|
|
+ udelay(1);
|
|
|
+ buf = lan743x_csr_read(adapter, OTP_STATUS);
|
|
|
+ if (time_after(jiffies, timeout)) {
|
|
|
+ netif_warn(adapter, drv, adapter->netdev,
|
|
|
+ "Timeout on OTP_STATUS completion\n");
|
|
|
+ return -EIO;
|
|
|
+ }
|
|
|
+ } while (buf & OTP_STATUS_BUSY_);
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_eeprom_wait(struct lan743x_adapter *adapter)
|
|
|
+{
|
|
|
+ unsigned long start_time = jiffies;
|
|
|
+ u32 val;
|
|
|
+
|
|
|
+ do {
|
|
|
+ val = lan743x_csr_read(adapter, E2P_CMD);
|
|
|
+
|
|
|
+ if (!(val & E2P_CMD_EPC_BUSY_) ||
|
|
|
+ (val & E2P_CMD_EPC_TIMEOUT_))
|
|
|
+ break;
|
|
|
+ usleep_range(40, 100);
|
|
|
+ } while (!time_after(jiffies, start_time + HZ));
|
|
|
+
|
|
|
+ if (val & (E2P_CMD_EPC_TIMEOUT_ | E2P_CMD_EPC_BUSY_)) {
|
|
|
+ netif_warn(adapter, drv, adapter->netdev,
|
|
|
+ "EEPROM read operation timeout\n");
|
|
|
+ return -EIO;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_eeprom_confirm_not_busy(struct lan743x_adapter *adapter)
|
|
|
+{
|
|
|
+ unsigned long start_time = jiffies;
|
|
|
+ u32 val;
|
|
|
+
|
|
|
+ do {
|
|
|
+ val = lan743x_csr_read(adapter, E2P_CMD);
|
|
|
+
|
|
|
+ if (!(val & E2P_CMD_EPC_BUSY_))
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ usleep_range(40, 100);
|
|
|
+ } while (!time_after(jiffies, start_time + HZ));
|
|
|
+
|
|
|
+ netif_warn(adapter, drv, adapter->netdev, "EEPROM is busy\n");
|
|
|
+ return -EIO;
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_eeprom_read(struct lan743x_adapter *adapter,
|
|
|
+ u32 offset, u32 length, u8 *data)
|
|
|
+{
|
|
|
+ int retval;
|
|
|
+ u32 val;
|
|
|
+ int i;
|
|
|
+
|
|
|
+ retval = lan743x_eeprom_confirm_not_busy(adapter);
|
|
|
+ if (retval)
|
|
|
+ return retval;
|
|
|
+
|
|
|
+ for (i = 0; i < length; i++) {
|
|
|
+ val = E2P_CMD_EPC_BUSY_ | E2P_CMD_EPC_CMD_READ_;
|
|
|
+ val |= (offset & E2P_CMD_EPC_ADDR_MASK_);
|
|
|
+ lan743x_csr_write(adapter, E2P_CMD, val);
|
|
|
+
|
|
|
+ retval = lan743x_eeprom_wait(adapter);
|
|
|
+ if (retval < 0)
|
|
|
+ return retval;
|
|
|
+
|
|
|
+ val = lan743x_csr_read(adapter, E2P_DATA);
|
|
|
+ data[i] = val & 0xFF;
|
|
|
+ offset++;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_eeprom_write(struct lan743x_adapter *adapter,
|
|
|
+ u32 offset, u32 length, u8 *data)
|
|
|
+{
|
|
|
+ int retval;
|
|
|
+ u32 val;
|
|
|
+ int i;
|
|
|
+
|
|
|
+ retval = lan743x_eeprom_confirm_not_busy(adapter);
|
|
|
+ if (retval)
|
|
|
+ return retval;
|
|
|
+
|
|
|
+ /* Issue write/erase enable command */
|
|
|
+ val = E2P_CMD_EPC_BUSY_ | E2P_CMD_EPC_CMD_EWEN_;
|
|
|
+ lan743x_csr_write(adapter, E2P_CMD, val);
|
|
|
+
|
|
|
+ retval = lan743x_eeprom_wait(adapter);
|
|
|
+ if (retval < 0)
|
|
|
+ return retval;
|
|
|
+
|
|
|
+ for (i = 0; i < length; i++) {
|
|
|
+ /* Fill data register */
|
|
|
+ val = data[i];
|
|
|
+ lan743x_csr_write(adapter, E2P_DATA, val);
|
|
|
+
|
|
|
+ /* Send "write" command */
|
|
|
+ val = E2P_CMD_EPC_BUSY_ | E2P_CMD_EPC_CMD_WRITE_;
|
|
|
+ val |= (offset & E2P_CMD_EPC_ADDR_MASK_);
|
|
|
+ lan743x_csr_write(adapter, E2P_CMD, val);
|
|
|
+
|
|
|
+ retval = lan743x_eeprom_wait(adapter);
|
|
|
+ if (retval < 0)
|
|
|
+ return retval;
|
|
|
+
|
|
|
+ offset++;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static void lan743x_ethtool_get_drvinfo(struct net_device *netdev,
|
|
|
+ struct ethtool_drvinfo *info)
|
|
|
+{
|
|
|
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
|
|
|
+
|
|
|
+ strlcpy(info->driver, DRIVER_NAME, sizeof(info->driver));
|
|
|
+ strlcpy(info->bus_info,
|
|
|
+ pci_name(adapter->pdev), sizeof(info->bus_info));
|
|
|
+}
|
|
|
+
|
|
|
+static u32 lan743x_ethtool_get_msglevel(struct net_device *netdev)
|
|
|
+{
|
|
|
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
|
|
|
+
|
|
|
+ return adapter->msg_enable;
|
|
|
+}
|
|
|
+
|
|
|
+static void lan743x_ethtool_set_msglevel(struct net_device *netdev,
|
|
|
+ u32 msglevel)
|
|
|
+{
|
|
|
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
|
|
|
+
|
|
|
+ adapter->msg_enable = msglevel;
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_ethtool_get_eeprom_len(struct net_device *netdev)
|
|
|
+{
|
|
|
+ return MAX_EEPROM_SIZE;
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_ethtool_get_eeprom(struct net_device *netdev,
|
|
|
+ struct ethtool_eeprom *ee, u8 *data)
|
|
|
+{
|
|
|
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
|
|
|
+
|
|
|
+ return lan743x_eeprom_read(adapter, ee->offset, ee->len, data);
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_ethtool_set_eeprom(struct net_device *netdev,
|
|
|
+ struct ethtool_eeprom *ee, u8 *data)
|
|
|
+{
|
|
|
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
|
|
|
+ int ret = -EINVAL;
|
|
|
+
|
|
|
+ if (ee->magic == LAN743X_EEPROM_MAGIC)
|
|
|
+ ret = lan743x_eeprom_write(adapter, ee->offset, ee->len,
|
|
|
+ data);
|
|
|
+ /* Beware! OTP is One Time Programming ONLY!
|
|
|
+ * So do some strict condition check before messing up
|
|
|
+ */
|
|
|
+ else if ((ee->magic == LAN743X_OTP_MAGIC) &&
|
|
|
+ (ee->offset == 0) &&
|
|
|
+ (ee->len == MAX_EEPROM_SIZE) &&
|
|
|
+ (data[0] == OTP_INDICATOR_1))
|
|
|
+ ret = lan743x_otp_write(adapter, ee->offset, ee->len, data);
|
|
|
+
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
+static const char lan743x_set0_hw_cnt_strings[][ETH_GSTRING_LEN] = {
|
|
|
+ "RX FCS Errors",
|
|
|
+ "RX Alignment Errors",
|
|
|
+ "Rx Fragment Errors",
|
|
|
+ "RX Jabber Errors",
|
|
|
+ "RX Undersize Frame Errors",
|
|
|
+ "RX Oversize Frame Errors",
|
|
|
+ "RX Dropped Frames",
|
|
|
+ "RX Unicast Byte Count",
|
|
|
+ "RX Broadcast Byte Count",
|
|
|
+ "RX Multicast Byte Count",
|
|
|
+ "RX Unicast Frames",
|
|
|
+ "RX Broadcast Frames",
|
|
|
+ "RX Multicast Frames",
|
|
|
+ "RX Pause Frames",
|
|
|
+ "RX 64 Byte Frames",
|
|
|
+ "RX 65 - 127 Byte Frames",
|
|
|
+ "RX 128 - 255 Byte Frames",
|
|
|
+ "RX 256 - 511 Bytes Frames",
|
|
|
+ "RX 512 - 1023 Byte Frames",
|
|
|
+ "RX 1024 - 1518 Byte Frames",
|
|
|
+ "RX Greater 1518 Byte Frames",
|
|
|
+};
|
|
|
+
|
|
|
+static const char lan743x_set1_sw_cnt_strings[][ETH_GSTRING_LEN] = {
|
|
|
+ "RX Queue 0 Frames",
|
|
|
+ "RX Queue 1 Frames",
|
|
|
+ "RX Queue 2 Frames",
|
|
|
+ "RX Queue 3 Frames",
|
|
|
+};
|
|
|
+
|
|
|
+static const char lan743x_set2_hw_cnt_strings[][ETH_GSTRING_LEN] = {
|
|
|
+ "RX Total Frames",
|
|
|
+ "EEE RX LPI Transitions",
|
|
|
+ "EEE RX LPI Time",
|
|
|
+ "RX Counter Rollover Status",
|
|
|
+ "TX FCS Errors",
|
|
|
+ "TX Excess Deferral Errors",
|
|
|
+ "TX Carrier Errors",
|
|
|
+ "TX Bad Byte Count",
|
|
|
+ "TX Single Collisions",
|
|
|
+ "TX Multiple Collisions",
|
|
|
+ "TX Excessive Collision",
|
|
|
+ "TX Late Collisions",
|
|
|
+ "TX Unicast Byte Count",
|
|
|
+ "TX Broadcast Byte Count",
|
|
|
+ "TX Multicast Byte Count",
|
|
|
+ "TX Unicast Frames",
|
|
|
+ "TX Broadcast Frames",
|
|
|
+ "TX Multicast Frames",
|
|
|
+ "TX Pause Frames",
|
|
|
+ "TX 64 Byte Frames",
|
|
|
+ "TX 65 - 127 Byte Frames",
|
|
|
+ "TX 128 - 255 Byte Frames",
|
|
|
+ "TX 256 - 511 Bytes Frames",
|
|
|
+ "TX 512 - 1023 Byte Frames",
|
|
|
+ "TX 1024 - 1518 Byte Frames",
|
|
|
+ "TX Greater 1518 Byte Frames",
|
|
|
+ "TX Total Frames",
|
|
|
+ "EEE TX LPI Transitions",
|
|
|
+ "EEE TX LPI Time",
|
|
|
+ "TX Counter Rollover Status",
|
|
|
+};
|
|
|
+
|
|
|
+static const u32 lan743x_set0_hw_cnt_addr[] = {
|
|
|
+ STAT_RX_FCS_ERRORS,
|
|
|
+ STAT_RX_ALIGNMENT_ERRORS,
|
|
|
+ STAT_RX_FRAGMENT_ERRORS,
|
|
|
+ STAT_RX_JABBER_ERRORS,
|
|
|
+ STAT_RX_UNDERSIZE_FRAME_ERRORS,
|
|
|
+ STAT_RX_OVERSIZE_FRAME_ERRORS,
|
|
|
+ STAT_RX_DROPPED_FRAMES,
|
|
|
+ STAT_RX_UNICAST_BYTE_COUNT,
|
|
|
+ STAT_RX_BROADCAST_BYTE_COUNT,
|
|
|
+ STAT_RX_MULTICAST_BYTE_COUNT,
|
|
|
+ STAT_RX_UNICAST_FRAMES,
|
|
|
+ STAT_RX_BROADCAST_FRAMES,
|
|
|
+ STAT_RX_MULTICAST_FRAMES,
|
|
|
+ STAT_RX_PAUSE_FRAMES,
|
|
|
+ STAT_RX_64_BYTE_FRAMES,
|
|
|
+ STAT_RX_65_127_BYTE_FRAMES,
|
|
|
+ STAT_RX_128_255_BYTE_FRAMES,
|
|
|
+ STAT_RX_256_511_BYTES_FRAMES,
|
|
|
+ STAT_RX_512_1023_BYTE_FRAMES,
|
|
|
+ STAT_RX_1024_1518_BYTE_FRAMES,
|
|
|
+ STAT_RX_GREATER_1518_BYTE_FRAMES,
|
|
|
+};
|
|
|
+
|
|
|
+static const u32 lan743x_set2_hw_cnt_addr[] = {
|
|
|
+ STAT_RX_TOTAL_FRAMES,
|
|
|
+ STAT_EEE_RX_LPI_TRANSITIONS,
|
|
|
+ STAT_EEE_RX_LPI_TIME,
|
|
|
+ STAT_RX_COUNTER_ROLLOVER_STATUS,
|
|
|
+ STAT_TX_FCS_ERRORS,
|
|
|
+ STAT_TX_EXCESS_DEFERRAL_ERRORS,
|
|
|
+ STAT_TX_CARRIER_ERRORS,
|
|
|
+ STAT_TX_BAD_BYTE_COUNT,
|
|
|
+ STAT_TX_SINGLE_COLLISIONS,
|
|
|
+ STAT_TX_MULTIPLE_COLLISIONS,
|
|
|
+ STAT_TX_EXCESSIVE_COLLISION,
|
|
|
+ STAT_TX_LATE_COLLISIONS,
|
|
|
+ STAT_TX_UNICAST_BYTE_COUNT,
|
|
|
+ STAT_TX_BROADCAST_BYTE_COUNT,
|
|
|
+ STAT_TX_MULTICAST_BYTE_COUNT,
|
|
|
+ STAT_TX_UNICAST_FRAMES,
|
|
|
+ STAT_TX_BROADCAST_FRAMES,
|
|
|
+ STAT_TX_MULTICAST_FRAMES,
|
|
|
+ STAT_TX_PAUSE_FRAMES,
|
|
|
+ STAT_TX_64_BYTE_FRAMES,
|
|
|
+ STAT_TX_65_127_BYTE_FRAMES,
|
|
|
+ STAT_TX_128_255_BYTE_FRAMES,
|
|
|
+ STAT_TX_256_511_BYTES_FRAMES,
|
|
|
+ STAT_TX_512_1023_BYTE_FRAMES,
|
|
|
+ STAT_TX_1024_1518_BYTE_FRAMES,
|
|
|
+ STAT_TX_GREATER_1518_BYTE_FRAMES,
|
|
|
+ STAT_TX_TOTAL_FRAMES,
|
|
|
+ STAT_EEE_TX_LPI_TRANSITIONS,
|
|
|
+ STAT_EEE_TX_LPI_TIME,
|
|
|
+ STAT_TX_COUNTER_ROLLOVER_STATUS
|
|
|
+};
|
|
|
+
|
|
|
+static void lan743x_ethtool_get_strings(struct net_device *netdev,
|
|
|
+ u32 stringset, u8 *data)
|
|
|
+{
|
|
|
+ switch (stringset) {
|
|
|
+ case ETH_SS_STATS:
|
|
|
+ memcpy(data, lan743x_set0_hw_cnt_strings,
|
|
|
+ sizeof(lan743x_set0_hw_cnt_strings));
|
|
|
+ memcpy(&data[sizeof(lan743x_set0_hw_cnt_strings)],
|
|
|
+ lan743x_set1_sw_cnt_strings,
|
|
|
+ sizeof(lan743x_set1_sw_cnt_strings));
|
|
|
+ memcpy(&data[sizeof(lan743x_set0_hw_cnt_strings) +
|
|
|
+ sizeof(lan743x_set1_sw_cnt_strings)],
|
|
|
+ lan743x_set2_hw_cnt_strings,
|
|
|
+ sizeof(lan743x_set2_hw_cnt_strings));
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void lan743x_ethtool_get_ethtool_stats(struct net_device *netdev,
|
|
|
+ struct ethtool_stats *stats,
|
|
|
+ u64 *data)
|
|
|
+{
|
|
|
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
|
|
|
+ int data_index = 0;
|
|
|
+ u32 buf;
|
|
|
+ int i;
|
|
|
+
|
|
|
+ for (i = 0; i < ARRAY_SIZE(lan743x_set0_hw_cnt_addr); i++) {
|
|
|
+ buf = lan743x_csr_read(adapter, lan743x_set0_hw_cnt_addr[i]);
|
|
|
+ data[data_index++] = (u64)buf;
|
|
|
+ }
|
|
|
+ for (i = 0; i < ARRAY_SIZE(adapter->rx); i++)
|
|
|
+ data[data_index++] = (u64)(adapter->rx[i].frame_count);
|
|
|
+ for (i = 0; i < ARRAY_SIZE(lan743x_set2_hw_cnt_addr); i++) {
|
|
|
+ buf = lan743x_csr_read(adapter, lan743x_set2_hw_cnt_addr[i]);
|
|
|
+ data[data_index++] = (u64)buf;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_ethtool_get_sset_count(struct net_device *netdev, int sset)
|
|
|
+{
|
|
|
+ switch (sset) {
|
|
|
+ case ETH_SS_STATS:
|
|
|
+ {
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ ret = ARRAY_SIZE(lan743x_set0_hw_cnt_strings);
|
|
|
+ ret += ARRAY_SIZE(lan743x_set1_sw_cnt_strings);
|
|
|
+ ret += ARRAY_SIZE(lan743x_set2_hw_cnt_strings);
|
|
|
+ return ret;
|
|
|
+ }
|
|
|
+ default:
|
|
|
+ return -EOPNOTSUPP;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_ethtool_get_rxnfc(struct net_device *netdev,
|
|
|
+ struct ethtool_rxnfc *rxnfc,
|
|
|
+ u32 *rule_locs)
|
|
|
+{
|
|
|
+ switch (rxnfc->cmd) {
|
|
|
+ case ETHTOOL_GRXFH:
|
|
|
+ rxnfc->data = 0;
|
|
|
+ switch (rxnfc->flow_type) {
|
|
|
+ case TCP_V4_FLOW:case UDP_V4_FLOW:
|
|
|
+ case TCP_V6_FLOW:case UDP_V6_FLOW:
|
|
|
+ rxnfc->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
|
|
|
+ /* fall through */
|
|
|
+ case IPV4_FLOW: case IPV6_FLOW:
|
|
|
+ rxnfc->data |= RXH_IP_SRC | RXH_IP_DST;
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case ETHTOOL_GRXRINGS:
|
|
|
+ rxnfc->data = LAN743X_USED_RX_CHANNELS;
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+ return -EOPNOTSUPP;
|
|
|
+}
|
|
|
+
|
|
|
+static u32 lan743x_ethtool_get_rxfh_key_size(struct net_device *netdev)
|
|
|
+{
|
|
|
+ return 40;
|
|
|
+}
|
|
|
+
|
|
|
+static u32 lan743x_ethtool_get_rxfh_indir_size(struct net_device *netdev)
|
|
|
+{
|
|
|
+ return 128;
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_ethtool_get_rxfh(struct net_device *netdev,
|
|
|
+ u32 *indir, u8 *key, u8 *hfunc)
|
|
|
+{
|
|
|
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
|
|
|
+
|
|
|
+ if (indir) {
|
|
|
+ int dw_index;
|
|
|
+ int byte_index = 0;
|
|
|
+
|
|
|
+ for (dw_index = 0; dw_index < 32; dw_index++) {
|
|
|
+ u32 four_entries =
|
|
|
+ lan743x_csr_read(adapter, RFE_INDX(dw_index));
|
|
|
+
|
|
|
+ byte_index = dw_index << 2;
|
|
|
+ indir[byte_index + 0] =
|
|
|
+ ((four_entries >> 0) & 0x000000FF);
|
|
|
+ indir[byte_index + 1] =
|
|
|
+ ((four_entries >> 8) & 0x000000FF);
|
|
|
+ indir[byte_index + 2] =
|
|
|
+ ((four_entries >> 16) & 0x000000FF);
|
|
|
+ indir[byte_index + 3] =
|
|
|
+ ((four_entries >> 24) & 0x000000FF);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ if (key) {
|
|
|
+ int dword_index;
|
|
|
+ int byte_index = 0;
|
|
|
+
|
|
|
+ for (dword_index = 0; dword_index < 10; dword_index++) {
|
|
|
+ u32 four_entries =
|
|
|
+ lan743x_csr_read(adapter,
|
|
|
+ RFE_HASH_KEY(dword_index));
|
|
|
+
|
|
|
+ byte_index = dword_index << 2;
|
|
|
+ key[byte_index + 0] =
|
|
|
+ ((four_entries >> 0) & 0x000000FF);
|
|
|
+ key[byte_index + 1] =
|
|
|
+ ((four_entries >> 8) & 0x000000FF);
|
|
|
+ key[byte_index + 2] =
|
|
|
+ ((four_entries >> 16) & 0x000000FF);
|
|
|
+ key[byte_index + 3] =
|
|
|
+ ((four_entries >> 24) & 0x000000FF);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ if (hfunc)
|
|
|
+ (*hfunc) = ETH_RSS_HASH_TOP;
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_ethtool_set_rxfh(struct net_device *netdev,
|
|
|
+ const u32 *indir, const u8 *key,
|
|
|
+ const u8 hfunc)
|
|
|
+{
|
|
|
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
|
|
|
+
|
|
|
+ if (hfunc != ETH_RSS_HASH_NO_CHANGE && hfunc != ETH_RSS_HASH_TOP)
|
|
|
+ return -EOPNOTSUPP;
|
|
|
+
|
|
|
+ if (indir) {
|
|
|
+ u32 indir_value = 0;
|
|
|
+ int dword_index = 0;
|
|
|
+ int byte_index = 0;
|
|
|
+
|
|
|
+ for (dword_index = 0; dword_index < 32; dword_index++) {
|
|
|
+ byte_index = dword_index << 2;
|
|
|
+ indir_value =
|
|
|
+ (((indir[byte_index + 0] & 0x000000FF) << 0) |
|
|
|
+ ((indir[byte_index + 1] & 0x000000FF) << 8) |
|
|
|
+ ((indir[byte_index + 2] & 0x000000FF) << 16) |
|
|
|
+ ((indir[byte_index + 3] & 0x000000FF) << 24));
|
|
|
+ lan743x_csr_write(adapter, RFE_INDX(dword_index),
|
|
|
+ indir_value);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ if (key) {
|
|
|
+ int dword_index = 0;
|
|
|
+ int byte_index = 0;
|
|
|
+ u32 key_value = 0;
|
|
|
+
|
|
|
+ for (dword_index = 0; dword_index < 10; dword_index++) {
|
|
|
+ byte_index = dword_index << 2;
|
|
|
+ key_value =
|
|
|
+ ((((u32)(key[byte_index + 0])) << 0) |
|
|
|
+ (((u32)(key[byte_index + 1])) << 8) |
|
|
|
+ (((u32)(key[byte_index + 2])) << 16) |
|
|
|
+ (((u32)(key[byte_index + 3])) << 24));
|
|
|
+ lan743x_csr_write(adapter, RFE_HASH_KEY(dword_index),
|
|
|
+ key_value);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_ethtool_get_eee(struct net_device *netdev,
|
|
|
+ struct ethtool_eee *eee)
|
|
|
+{
|
|
|
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
|
|
|
+ struct phy_device *phydev = netdev->phydev;
|
|
|
+ u32 buf;
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ if (!phydev)
|
|
|
+ return -EIO;
|
|
|
+ if (!phydev->drv) {
|
|
|
+ netif_err(adapter, drv, adapter->netdev,
|
|
|
+ "Missing PHY Driver\n");
|
|
|
+ return -EIO;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = phy_ethtool_get_eee(phydev, eee);
|
|
|
+ if (ret < 0)
|
|
|
+ return ret;
|
|
|
+
|
|
|
+ buf = lan743x_csr_read(adapter, MAC_CR);
|
|
|
+ if (buf & MAC_CR_EEE_EN_) {
|
|
|
+ eee->eee_enabled = true;
|
|
|
+ eee->eee_active = !!(eee->advertised & eee->lp_advertised);
|
|
|
+ eee->tx_lpi_enabled = true;
|
|
|
+ /* EEE_TX_LPI_REQ_DLY & tx_lpi_timer are same uSec unit */
|
|
|
+ buf = lan743x_csr_read(adapter, MAC_EEE_TX_LPI_REQ_DLY_CNT);
|
|
|
+ eee->tx_lpi_timer = buf;
|
|
|
+ } else {
|
|
|
+ eee->eee_enabled = false;
|
|
|
+ eee->eee_active = false;
|
|
|
+ eee->tx_lpi_enabled = false;
|
|
|
+ eee->tx_lpi_timer = 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_ethtool_set_eee(struct net_device *netdev,
|
|
|
+ struct ethtool_eee *eee)
|
|
|
+{
|
|
|
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
|
|
|
+ struct phy_device *phydev = NULL;
|
|
|
+ u32 buf = 0;
|
|
|
+ int ret = 0;
|
|
|
+
|
|
|
+ if (!netdev)
|
|
|
+ return -EINVAL;
|
|
|
+ adapter = netdev_priv(netdev);
|
|
|
+ if (!adapter)
|
|
|
+ return -EINVAL;
|
|
|
+ phydev = netdev->phydev;
|
|
|
+ if (!phydev)
|
|
|
+ return -EIO;
|
|
|
+ if (!phydev->drv) {
|
|
|
+ netif_err(adapter, drv, adapter->netdev,
|
|
|
+ "Missing PHY Driver\n");
|
|
|
+ return -EIO;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (eee->eee_enabled) {
|
|
|
+ ret = phy_init_eee(phydev, 0);
|
|
|
+ if (ret) {
|
|
|
+ netif_err(adapter, drv, adapter->netdev,
|
|
|
+ "EEE initialization failed\n");
|
|
|
+ return ret;
|
|
|
+ }
|
|
|
+
|
|
|
+ buf = (u32)eee->tx_lpi_timer;
|
|
|
+ lan743x_csr_write(adapter, MAC_EEE_TX_LPI_REQ_DLY_CNT, buf);
|
|
|
+
|
|
|
+ buf = lan743x_csr_read(adapter, MAC_CR);
|
|
|
+ buf |= MAC_CR_EEE_EN_;
|
|
|
+ lan743x_csr_write(adapter, MAC_CR, buf);
|
|
|
+ } else {
|
|
|
+ buf = lan743x_csr_read(adapter, MAC_CR);
|
|
|
+ buf &= ~MAC_CR_EEE_EN_;
|
|
|
+ lan743x_csr_write(adapter, MAC_CR, buf);
|
|
|
+ }
|
|
|
+
|
|
|
+ return phy_ethtool_set_eee(phydev, eee);
|
|
|
+}
|
|
|
+
|
|
|
+#ifdef CONFIG_PM
|
|
|
+static void lan743x_ethtool_get_wol(struct net_device *netdev,
|
|
|
+ struct ethtool_wolinfo *wol)
|
|
|
+{
|
|
|
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
|
|
|
+
|
|
|
+ wol->supported = 0;
|
|
|
+ wol->wolopts = 0;
|
|
|
+ phy_ethtool_get_wol(netdev->phydev, wol);
|
|
|
+
|
|
|
+ wol->supported |= WAKE_BCAST | WAKE_UCAST | WAKE_MCAST |
|
|
|
+ WAKE_MAGIC | WAKE_PHY | WAKE_ARP;
|
|
|
+
|
|
|
+ wol->wolopts |= adapter->wolopts;
|
|
|
+}
|
|
|
+
|
|
|
+static int lan743x_ethtool_set_wol(struct net_device *netdev,
|
|
|
+ struct ethtool_wolinfo *wol)
|
|
|
+{
|
|
|
+ struct lan743x_adapter *adapter = netdev_priv(netdev);
|
|
|
+
|
|
|
+ adapter->wolopts = 0;
|
|
|
+ if (wol->wolopts & WAKE_UCAST)
|
|
|
+ adapter->wolopts |= WAKE_UCAST;
|
|
|
+ if (wol->wolopts & WAKE_MCAST)
|
|
|
+ adapter->wolopts |= WAKE_MCAST;
|
|
|
+ if (wol->wolopts & WAKE_BCAST)
|
|
|
+ adapter->wolopts |= WAKE_BCAST;
|
|
|
+ if (wol->wolopts & WAKE_MAGIC)
|
|
|
+ adapter->wolopts |= WAKE_MAGIC;
|
|
|
+ if (wol->wolopts & WAKE_PHY)
|
|
|
+ adapter->wolopts |= WAKE_PHY;
|
|
|
+ if (wol->wolopts & WAKE_ARP)
|
|
|
+ adapter->wolopts |= WAKE_ARP;
|
|
|
+
|
|
|
+ device_set_wakeup_enable(&adapter->pdev->dev, (bool)wol->wolopts);
|
|
|
+
|
|
|
+ phy_ethtool_set_wol(netdev->phydev, wol);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+#endif /* CONFIG_PM */
|
|
|
+
|
|
|
+const struct ethtool_ops lan743x_ethtool_ops = {
|
|
|
+ .get_drvinfo = lan743x_ethtool_get_drvinfo,
|
|
|
+ .get_msglevel = lan743x_ethtool_get_msglevel,
|
|
|
+ .set_msglevel = lan743x_ethtool_set_msglevel,
|
|
|
+ .get_link = ethtool_op_get_link,
|
|
|
+
|
|
|
+ .get_eeprom_len = lan743x_ethtool_get_eeprom_len,
|
|
|
+ .get_eeprom = lan743x_ethtool_get_eeprom,
|
|
|
+ .set_eeprom = lan743x_ethtool_set_eeprom,
|
|
|
+ .get_strings = lan743x_ethtool_get_strings,
|
|
|
+ .get_ethtool_stats = lan743x_ethtool_get_ethtool_stats,
|
|
|
+ .get_sset_count = lan743x_ethtool_get_sset_count,
|
|
|
+ .get_rxnfc = lan743x_ethtool_get_rxnfc,
|
|
|
+ .get_rxfh_key_size = lan743x_ethtool_get_rxfh_key_size,
|
|
|
+ .get_rxfh_indir_size = lan743x_ethtool_get_rxfh_indir_size,
|
|
|
+ .get_rxfh = lan743x_ethtool_get_rxfh,
|
|
|
+ .set_rxfh = lan743x_ethtool_set_rxfh,
|
|
|
+ .get_eee = lan743x_ethtool_get_eee,
|
|
|
+ .set_eee = lan743x_ethtool_set_eee,
|
|
|
+ .get_link_ksettings = phy_ethtool_get_link_ksettings,
|
|
|
+ .set_link_ksettings = phy_ethtool_set_link_ksettings,
|
|
|
+#ifdef CONFIG_PM
|
|
|
+ .get_wol = lan743x_ethtool_get_wol,
|
|
|
+ .set_wol = lan743x_ethtool_set_wol,
|
|
|
+#endif
|
|
|
+};
|