|
| 1 | +// SPDX-License-Identifier: GPL-2.0-only |
| 2 | +/* |
| 3 | + * Copyright (c) 2010 ASIX Electronics Corporation |
| 4 | + * Copyright (c) 2020 Samsung Electronics Co., Ltd. |
| 5 | + * |
| 6 | + * ASIX AX88796C SPI Fast Ethernet Linux driver |
| 7 | + */ |
| 8 | + |
| 9 | +#define pr_fmt(fmt) "ax88796c: " fmt |
| 10 | + |
| 11 | +#include <linux/bitmap.h> |
| 12 | +#include <linux/iopoll.h> |
| 13 | +#include <linux/phy.h> |
| 14 | +#include <linux/netdevice.h> |
| 15 | + |
| 16 | +#include "ax88796c_main.h" |
| 17 | +#include "ax88796c_ioctl.h" |
| 18 | + |
| 19 | +static const char ax88796c_priv_flag_names[][ETH_GSTRING_LEN] = { |
| 20 | + "SPICompression", |
| 21 | +}; |
| 22 | + |
| 23 | +static void |
| 24 | +ax88796c_get_drvinfo(struct net_device *ndev, struct ethtool_drvinfo *info) |
| 25 | +{ |
| 26 | + /* Inherit standard device info */ |
| 27 | + strncpy(info->driver, DRV_NAME, sizeof(info->driver)); |
| 28 | +} |
| 29 | + |
| 30 | +static u32 ax88796c_get_msglevel(struct net_device *ndev) |
| 31 | +{ |
| 32 | + struct ax88796c_device *ax_local = to_ax88796c_device(ndev); |
| 33 | + |
| 34 | + return ax_local->msg_enable; |
| 35 | +} |
| 36 | + |
| 37 | +static void ax88796c_set_msglevel(struct net_device *ndev, u32 level) |
| 38 | +{ |
| 39 | + struct ax88796c_device *ax_local = to_ax88796c_device(ndev); |
| 40 | + |
| 41 | + ax_local->msg_enable = level; |
| 42 | +} |
| 43 | + |
| 44 | +static void |
| 45 | +ax88796c_get_pauseparam(struct net_device *ndev, struct ethtool_pauseparam *pause) |
| 46 | +{ |
| 47 | + struct ax88796c_device *ax_local = to_ax88796c_device(ndev); |
| 48 | + |
| 49 | + pause->tx_pause = !!(ax_local->flowctrl & AX_FC_TX); |
| 50 | + pause->rx_pause = !!(ax_local->flowctrl & AX_FC_RX); |
| 51 | + pause->autoneg = (ax_local->flowctrl & AX_FC_ANEG) ? |
| 52 | + AUTONEG_ENABLE : |
| 53 | + AUTONEG_DISABLE; |
| 54 | +} |
| 55 | + |
| 56 | +static int |
| 57 | +ax88796c_set_pauseparam(struct net_device *ndev, struct ethtool_pauseparam *pause) |
| 58 | +{ |
| 59 | + struct ax88796c_device *ax_local = to_ax88796c_device(ndev); |
| 60 | + int fc; |
| 61 | + |
| 62 | + /* The following logic comes from phylink_ethtool_set_pauseparam() */ |
| 63 | + fc = pause->tx_pause ? AX_FC_TX : 0; |
| 64 | + fc |= pause->rx_pause ? AX_FC_RX : 0; |
| 65 | + fc |= pause->autoneg ? AX_FC_ANEG : 0; |
| 66 | + |
| 67 | + ax_local->flowctrl = fc; |
| 68 | + |
| 69 | + if (pause->autoneg) { |
| 70 | + phy_set_asym_pause(ax_local->phydev, pause->tx_pause, |
| 71 | + pause->rx_pause); |
| 72 | + } else { |
| 73 | + int maccr = 0; |
| 74 | + |
| 75 | + phy_set_asym_pause(ax_local->phydev, 0, 0); |
| 76 | + maccr |= (ax_local->flowctrl & AX_FC_RX) ? MACCR_RXFC_ENABLE : 0; |
| 77 | + maccr |= (ax_local->flowctrl & AX_FC_TX) ? MACCR_TXFC_ENABLE : 0; |
| 78 | + |
| 79 | + mutex_lock(&ax_local->spi_lock); |
| 80 | + |
| 81 | + maccr |= AX_READ(&ax_local->ax_spi, P0_MACCR) & |
| 82 | + ~(MACCR_TXFC_ENABLE | MACCR_RXFC_ENABLE); |
| 83 | + AX_WRITE(&ax_local->ax_spi, maccr, P0_MACCR); |
| 84 | + |
| 85 | + mutex_unlock(&ax_local->spi_lock); |
| 86 | + } |
| 87 | + |
| 88 | + return 0; |
| 89 | +} |
| 90 | + |
| 91 | +static int ax88796c_get_regs_len(struct net_device *ndev) |
| 92 | +{ |
| 93 | + return AX88796C_REGDUMP_LEN + AX88796C_PHY_REGDUMP_LEN; |
| 94 | +} |
| 95 | + |
| 96 | +static void |
| 97 | +ax88796c_get_regs(struct net_device *ndev, struct ethtool_regs *regs, void *_p) |
| 98 | +{ |
| 99 | + struct ax88796c_device *ax_local = to_ax88796c_device(ndev); |
| 100 | + int offset, i; |
| 101 | + u16 *p = _p; |
| 102 | + |
| 103 | + memset(p, 0, ax88796c_get_regs_len(ndev)); |
| 104 | + |
| 105 | + mutex_lock(&ax_local->spi_lock); |
| 106 | + |
| 107 | + for (offset = 0; offset < AX88796C_REGDUMP_LEN; offset += 2) { |
| 108 | + if (!test_bit(offset / 2, ax88796c_no_regs_mask)) |
| 109 | + *p = AX_READ(&ax_local->ax_spi, offset); |
| 110 | + p++; |
| 111 | + } |
| 112 | + |
| 113 | + mutex_unlock(&ax_local->spi_lock); |
| 114 | + |
| 115 | + for (i = 0; i < AX88796C_PHY_REGDUMP_LEN / 2; i++) { |
| 116 | + *p = phy_read(ax_local->phydev, i); |
| 117 | + p++; |
| 118 | + } |
| 119 | +} |
| 120 | + |
| 121 | +static void |
| 122 | +ax88796c_get_strings(struct net_device *ndev, u32 stringset, u8 *data) |
| 123 | +{ |
| 124 | + switch (stringset) { |
| 125 | + case ETH_SS_PRIV_FLAGS: |
| 126 | + memcpy(data, ax88796c_priv_flag_names, |
| 127 | + sizeof(ax88796c_priv_flag_names)); |
| 128 | + break; |
| 129 | + } |
| 130 | +} |
| 131 | + |
| 132 | +static int |
| 133 | +ax88796c_get_sset_count(struct net_device *ndev, int stringset) |
| 134 | +{ |
| 135 | + int ret = 0; |
| 136 | + |
| 137 | + switch (stringset) { |
| 138 | + case ETH_SS_PRIV_FLAGS: |
| 139 | + ret = ARRAY_SIZE(ax88796c_priv_flag_names); |
| 140 | + break; |
| 141 | + default: |
| 142 | + ret = -EOPNOTSUPP; |
| 143 | + } |
| 144 | + |
| 145 | + return ret; |
| 146 | +} |
| 147 | + |
| 148 | +static int ax88796c_set_priv_flags(struct net_device *ndev, u32 flags) |
| 149 | +{ |
| 150 | + struct ax88796c_device *ax_local = to_ax88796c_device(ndev); |
| 151 | + |
| 152 | + if (flags & ~AX_PRIV_FLAGS_MASK) |
| 153 | + return -EOPNOTSUPP; |
| 154 | + |
| 155 | + if ((ax_local->priv_flags ^ flags) & AX_CAP_COMP) |
| 156 | + if (netif_running(ndev)) |
| 157 | + return -EBUSY; |
| 158 | + |
| 159 | + ax_local->priv_flags = flags; |
| 160 | + |
| 161 | + return 0; |
| 162 | +} |
| 163 | + |
| 164 | +static u32 ax88796c_get_priv_flags(struct net_device *ndev) |
| 165 | +{ |
| 166 | + struct ax88796c_device *ax_local = to_ax88796c_device(ndev); |
| 167 | + |
| 168 | + return ax_local->priv_flags; |
| 169 | +} |
| 170 | + |
| 171 | +int ax88796c_mdio_read(struct mii_bus *mdiobus, int phy_id, int loc) |
| 172 | +{ |
| 173 | + struct ax88796c_device *ax_local = mdiobus->priv; |
| 174 | + int ret; |
| 175 | + |
| 176 | + mutex_lock(&ax_local->spi_lock); |
| 177 | + AX_WRITE(&ax_local->ax_spi, MDIOCR_RADDR(loc) |
| 178 | + | MDIOCR_FADDR(phy_id) | MDIOCR_READ, P2_MDIOCR); |
| 179 | + |
| 180 | + ret = read_poll_timeout(AX_READ, ret, |
| 181 | + (ret != 0), |
| 182 | + 0, jiffies_to_usecs(HZ / 100), false, |
| 183 | + &ax_local->ax_spi, P2_MDIOCR); |
| 184 | + if (!ret) |
| 185 | + ret = AX_READ(&ax_local->ax_spi, P2_MDIODR); |
| 186 | + |
| 187 | + mutex_unlock(&ax_local->spi_lock); |
| 188 | + |
| 189 | + return ret; |
| 190 | +} |
| 191 | + |
| 192 | +int |
| 193 | +ax88796c_mdio_write(struct mii_bus *mdiobus, int phy_id, int loc, u16 val) |
| 194 | +{ |
| 195 | + struct ax88796c_device *ax_local = mdiobus->priv; |
| 196 | + int ret; |
| 197 | + |
| 198 | + mutex_lock(&ax_local->spi_lock); |
| 199 | + AX_WRITE(&ax_local->ax_spi, val, P2_MDIODR); |
| 200 | + |
| 201 | + AX_WRITE(&ax_local->ax_spi, |
| 202 | + MDIOCR_RADDR(loc) | MDIOCR_FADDR(phy_id) |
| 203 | + | MDIOCR_WRITE, P2_MDIOCR); |
| 204 | + |
| 205 | + ret = read_poll_timeout(AX_READ, ret, |
| 206 | + ((ret & MDIOCR_VALID) != 0), 0, |
| 207 | + jiffies_to_usecs(HZ / 100), false, |
| 208 | + &ax_local->ax_spi, P2_MDIOCR); |
| 209 | + mutex_unlock(&ax_local->spi_lock); |
| 210 | + |
| 211 | + return ret; |
| 212 | +} |
| 213 | + |
| 214 | +const struct ethtool_ops ax88796c_ethtool_ops = { |
| 215 | + .get_drvinfo = ax88796c_get_drvinfo, |
| 216 | + .get_link = ethtool_op_get_link, |
| 217 | + .get_msglevel = ax88796c_get_msglevel, |
| 218 | + .set_msglevel = ax88796c_set_msglevel, |
| 219 | + .get_link_ksettings = phy_ethtool_get_link_ksettings, |
| 220 | + .set_link_ksettings = phy_ethtool_set_link_ksettings, |
| 221 | + .nway_reset = phy_ethtool_nway_reset, |
| 222 | + .get_pauseparam = ax88796c_get_pauseparam, |
| 223 | + .set_pauseparam = ax88796c_set_pauseparam, |
| 224 | + .get_regs_len = ax88796c_get_regs_len, |
| 225 | + .get_regs = ax88796c_get_regs, |
| 226 | + .get_strings = ax88796c_get_strings, |
| 227 | + .get_sset_count = ax88796c_get_sset_count, |
| 228 | + .get_priv_flags = ax88796c_get_priv_flags, |
| 229 | + .set_priv_flags = ax88796c_set_priv_flags, |
| 230 | +}; |
| 231 | + |
| 232 | +int ax88796c_ioctl(struct net_device *ndev, struct ifreq *ifr, int cmd) |
| 233 | +{ |
| 234 | + int ret; |
| 235 | + |
| 236 | + ret = phy_mii_ioctl(ndev->phydev, ifr, cmd); |
| 237 | + |
| 238 | + return ret; |
| 239 | +} |
0 commit comments