| 1 |
// SPDX-License-Identifier: GPL-2.0+ |
| 2 |
/* |
| 3 |
* drivers/net/phy/at803x.c |
| 4 |
* |
| 5 |
* Driver for Qualcomm Atheros AR803x PHY |
| 6 |
* |
| 7 |
* Author: Matus Ujhelyi <[email protected]> |
| 8 |
*/ |
| 9 |
|
| 10 |
#include <linux/phy.h> |
| 11 |
#include <linux/module.h> |
| 12 |
#include <linux/string.h> |
| 13 |
#include <linux/netdevice.h> |
| 14 |
#include <linux/etherdevice.h> |
| 15 |
#include <linux/ethtool_netlink.h> |
| 16 |
#include <linux/bitfield.h> |
| 17 |
#include <linux/regulator/of_regulator.h> |
| 18 |
#include <linux/regulator/driver.h> |
| 19 |
#include <linux/regulator/consumer.h> |
| 20 |
#include <linux/of.h> |
| 21 |
#include <linux/phylink.h> |
| 22 |
#include <linux/reset.h> |
| 23 |
#include <linux/phy_port.h> |
| 24 |
#include <dt-bindings/net/qca-ar803x.h> |
| 25 |
|
| 26 |
#include "qcom.h" |
| 27 |
|
| 28 |
#define AT803X_LED_CONTROL 0x18 |
| 29 |
|
| 30 |
#define AT803X_REG_CHIP_CONFIG 0x1f |
| 31 |
#define AT803X_BT_BX_REG_SEL 0x8000 |
| 32 |
|
| 33 |
#define AT803X_MODE_CFG_MASK 0x0F |
| 34 |
#define AT803X_MODE_CFG_BASET_RGMII 0x00 |
| 35 |
#define AT803X_MODE_CFG_BASET_SGMII 0x01 |
| 36 |
#define AT803X_MODE_CFG_BX1000_RGMII_50OHM 0x02 |
| 37 |
#define AT803X_MODE_CFG_BX1000_RGMII_75OHM 0x03 |
| 38 |
#define AT803X_MODE_CFG_BX1000_CONV_50OHM 0x04 |
| 39 |
#define AT803X_MODE_CFG_BX1000_CONV_75OHM 0x05 |
| 40 |
#define AT803X_MODE_CFG_FX100_RGMII_50OHM 0x06 |
| 41 |
#define AT803X_MODE_CFG_FX100_CONV_50OHM 0x07 |
| 42 |
#define AT803X_MODE_CFG_RGMII_AUTO_MDET 0x0B |
| 43 |
#define AT803X_MODE_CFG_FX100_RGMII_75OHM 0x0E |
| 44 |
#define AT803X_MODE_CFG_FX100_CONV_75OHM 0x0F |
| 45 |
|
| 46 |
#define AT803X_PSSR 0x11 /*PHY-Specific Status Register*/ |
| 47 |
#define AT803X_PSSR_MR_AN_COMPLETE 0x0200 |
| 48 |
|
| 49 |
#define AT803X_DEBUG_REG_1F 0x1F |
| 50 |
#define AT803X_DEBUG_PLL_ON BIT(2) |
| 51 |
#define AT803X_DEBUG_RGMII_1V8 BIT(3) |
| 52 |
|
| 53 |
/* AT803x supports either the XTAL input pad, an internal PLL or the |
| 54 |
* DSP as clock reference for the clock output pad. The XTAL reference |
| 55 |
* is only used for 25 MHz output, all other frequencies need the PLL. |
| 56 |
* The DSP as a clock reference is used in synchronous ethernet |
| 57 |
* applications. |
| 58 |
* |
| 59 |
* By default the PLL is only enabled if there is a link. Otherwise |
| 60 |
* the PHY will go into low power state and disabled the PLL. You can |
| 61 |
* set the PLL_ON bit (see debug register 0x1f) to keep the PLL always |
| 62 |
* enabled. |
| 63 |
*/ |
| 64 |
#define AT803X_MMD7_CLK25M 0x8016 |
| 65 |
#define AT803X_CLK_OUT_MASK GENMASK(4, 2) |
| 66 |
#define AT803X_CLK_OUT_25MHZ_XTAL 0 |
| 67 |
#define AT803X_CLK_OUT_25MHZ_DSP 1 |
| 68 |
#define AT803X_CLK_OUT_50MHZ_PLL 2 |
| 69 |
#define AT803X_CLK_OUT_50MHZ_DSP 3 |
| 70 |
#define AT803X_CLK_OUT_62_5MHZ_PLL 4 |
| 71 |
#define AT803X_CLK_OUT_62_5MHZ_DSP 5 |
| 72 |
#define AT803X_CLK_OUT_125MHZ_PLL 6 |
| 73 |
#define AT803X_CLK_OUT_125MHZ_DSP 7 |
| 74 |
|
| 75 |
/* The AR8035 has another mask which is compatible with the AR8031/AR8033 mask |
| 76 |
* but doesn't support choosing between XTAL/PLL and DSP. |
| 77 |
*/ |
| 78 |
#define AT8035_CLK_OUT_MASK GENMASK(4, 3) |
| 79 |
|
| 80 |
#define AT803X_CLK_OUT_STRENGTH_MASK GENMASK(8, 7) |
| 81 |
#define AT803X_CLK_OUT_STRENGTH_FULL 0 |
| 82 |
#define AT803X_CLK_OUT_STRENGTH_HALF 1 |
| 83 |
#define AT803X_CLK_OUT_STRENGTH_QUARTER 2 |
| 84 |
|
| 85 |
#define AT803X_MMD3_SMARTEEE_CTL1 0x805b |
| 86 |
#define AT803X_MMD3_SMARTEEE_CTL2 0x805c |
| 87 |
#define AT803X_MMD3_SMARTEEE_CTL3 0x805d |
| 88 |
#define AT803X_MMD3_SMARTEEE_CTL3_LPI_EN BIT(8) |
| 89 |
|
| 90 |
#define ATH9331_PHY_ID 0x004dd041 |
| 91 |
#define ATH8030_PHY_ID 0x004dd076 |
| 92 |
#define ATH8031_PHY_ID 0x004dd074 |
| 93 |
#define ATH8032_PHY_ID 0x004dd023 |
| 94 |
#define ATH8035_PHY_ID 0x004dd072 |
| 95 |
#define AT8030_PHY_ID_MASK 0xffffffef |
| 96 |
|
| 97 |
#define IPQ5018_PHY_ID 0x004dd0c0 |
| 98 |
|
| 99 |
#define QCA9561_PHY_ID 0x004dd042 |
| 100 |
|
| 101 |
#define AT803X_PAGE_FIBER 0 |
| 102 |
#define AT803X_PAGE_COPPER 1 |
| 103 |
|
| 104 |
/* don't turn off internal PLL */ |
| 105 |
#define AT803X_KEEP_PLL_ENABLED BIT(0) |
| 106 |
#define AT803X_DISABLE_SMARTEEE BIT(1) |
| 107 |
|
| 108 |
/* disable hibernation mode */ |
| 109 |
#define AT803X_DISABLE_HIBERNATION_MODE BIT(2) |
| 110 |
|
| 111 |
#define IPQ5018_PHY_FIFO_CONTROL 0x19 |
| 112 |
#define IPQ5018_PHY_FIFO_RESET GENMASK(1, 0) |
| 113 |
|
| 114 |
#define IPQ5018_PHY_DEBUG_EDAC 0x4380 |
| 115 |
#define IPQ5018_PHY_MMD1_MDAC 0x8100 |
| 116 |
#define IPQ5018_PHY_DAC_MASK GENMASK(15, 8) |
| 117 |
|
| 118 |
/* MDAC and EDAC values for short cable length */ |
| 119 |
#define IPQ5018_PHY_DEBUG_EDAC_VAL 0x10 |
| 120 |
#define IPQ5018_PHY_MMD1_MDAC_VAL 0x10 |
| 121 |
|
| 122 |
#define IPQ5018_PHY_MMD1_MSE_THRESH1 0x1000 |
| 123 |
#define IPQ5018_PHY_MMD1_MSE_THRESH2 0x1001 |
| 124 |
#define IPQ5018_PHY_PCS_EEE_TX_TIMER 0x8008 |
| 125 |
#define IPQ5018_PHY_PCS_EEE_RX_TIMER 0x8009 |
| 126 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL3 0x8074 |
| 127 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL4 0x8075 |
| 128 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL5 0x8076 |
| 129 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL6 0x8077 |
| 130 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL7 0x8078 |
| 131 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL9 0x807a |
| 132 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL13 0x807e |
| 133 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL14 0x807f |
| 134 |
|
| 135 |
#define IPQ5018_PHY_MMD1_MSE_THRESH1_VAL 0xf1 |
| 136 |
#define IPQ5018_PHY_MMD1_MSE_THRESH2_VAL 0x1f6 |
| 137 |
#define IPQ5018_PHY_PCS_EEE_TX_TIMER_VAL 0x7880 |
| 138 |
#define IPQ5018_PHY_PCS_EEE_RX_TIMER_VAL 0xc8 |
| 139 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL3_VAL 0xc040 |
| 140 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL4_VAL 0xa060 |
| 141 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL5_VAL 0xc040 |
| 142 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL6_VAL 0xa060 |
| 143 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL7_VAL 0xc24c |
| 144 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL9_VAL 0xc060 |
| 145 |
#define IPQ5018_PHY_PCS_CDT_THRESH_CTRL13_VAL 0xb060 |
| 146 |
#define IPQ5018_PHY_PCS_NEAR_ECHO_THRESH_VAL 0x90b0 |
| 147 |
|
| 148 |
#define IPQ5018_PHY_DEBUG_ANA_LDO_EFUSE 0x1 |
| 149 |
#define IPQ5018_PHY_DEBUG_ANA_LDO_EFUSE_MASK GENMASK(7, 4) |
| 150 |
#define IPQ5018_PHY_DEBUG_ANA_LDO_EFUSE_DEFAULT 0x50 |
| 151 |
#define IPQ5018_PHY_DEBUG_ANA_DAC_FILTER 0xa080 |
| 152 |
|
| 153 |
MODULE_DESCRIPTION("Qualcomm Atheros AR803x PHY driver"); |
| 154 |
MODULE_AUTHOR("Matus Ujhelyi"); |
| 155 |
MODULE_LICENSE("GPL"); |
| 156 |
|
| 157 |
struct at803x_priv { |
| 158 |
int flags; |
| 159 |
u16 clk_25m_reg; |
| 160 |
u16 clk_25m_mask; |
| 161 |
u8 smarteee_lpi_tw_1g; |
| 162 |
u8 smarteee_lpi_tw_100m; |
| 163 |
bool is_fiber; |
| 164 |
bool is_1000basex; |
| 165 |
struct regulator_dev *vddio_rdev; |
| 166 |
struct regulator_dev *vddh_rdev; |
| 167 |
}; |
| 168 |
|
| 169 |
struct at803x_context { |
| 170 |
u16 bmcr; |
| 171 |
u16 advertise; |
| 172 |
u16 control1000; |
| 173 |
u16 int_enable; |
| 174 |
u16 smart_speed; |
| 175 |
u16 led_control; |
| 176 |
}; |
| 177 |
|
| 178 |
struct ipq5018_priv { |
| 179 |
struct reset_control *rst; |
| 180 |
bool set_short_cable_dac; |
| 181 |
}; |
| 182 |
|
| 183 |
static int at803x_write_page(struct phy_device *phydev, int page) |
| 184 |
{ |
| 185 |
int mask; |
| 186 |
int set; |
| 187 |
|
| 188 |
if (page == AT803X_PAGE_COPPER) { |
| 189 |
set = AT803X_BT_BX_REG_SEL; |
| 190 |
mask = 0; |
| 191 |
} else { |
| 192 |
set = 0; |
| 193 |
mask = AT803X_BT_BX_REG_SEL; |
| 194 |
} |
| 195 |
|
| 196 |
return __phy_modify(phydev, AT803X_REG_CHIP_CONFIG, mask, set); |
| 197 |
} |
| 198 |
|
| 199 |
static int at803x_read_page(struct phy_device *phydev) |
| 200 |
{ |
| 201 |
int ccr = __phy_read(phydev, AT803X_REG_CHIP_CONFIG); |
| 202 |
|
| 203 |
if (ccr < 0) |
| 204 |
return ccr; |
| 205 |
|
| 206 |
if (ccr & AT803X_BT_BX_REG_SEL) |
| 207 |
return AT803X_PAGE_COPPER; |
| 208 |
|
| 209 |
return AT803X_PAGE_FIBER; |
| 210 |
} |
| 211 |
|
| 212 |
static int at803x_enable_rx_delay(struct phy_device *phydev) |
| 213 |
{ |
| 214 |
return at803x_debug_reg_mask(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL, 0, |
| 215 |
AT803X_DEBUG_RX_CLK_DLY_EN); |
| 216 |
} |
| 217 |
|
| 218 |
static int at803x_enable_tx_delay(struct phy_device *phydev) |
| 219 |
{ |
| 220 |
return at803x_debug_reg_mask(phydev, AT803X_DEBUG_SYSTEM_CTRL_MODE, 0, |
| 221 |
AT803X_DEBUG_TX_CLK_DLY_EN); |
| 222 |
} |
| 223 |
|
| 224 |
static int at803x_disable_rx_delay(struct phy_device *phydev) |
| 225 |
{ |
| 226 |
return at803x_debug_reg_mask(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL, |
| 227 |
AT803X_DEBUG_RX_CLK_DLY_EN, 0); |
| 228 |
} |
| 229 |
|
| 230 |
static int at803x_disable_tx_delay(struct phy_device *phydev) |
| 231 |
{ |
| 232 |
return at803x_debug_reg_mask(phydev, AT803X_DEBUG_SYSTEM_CTRL_MODE, |
| 233 |
AT803X_DEBUG_TX_CLK_DLY_EN, 0); |
| 234 |
} |
| 235 |
|
| 236 |
/* save relevant PHY registers to private copy */ |
| 237 |
static void at803x_context_save(struct phy_device *phydev, |
| 238 |
struct at803x_context *context) |
| 239 |
{ |
| 240 |
context->bmcr = phy_read(phydev, MII_BMCR); |
| 241 |
context->advertise = phy_read(phydev, MII_ADVERTISE); |
| 242 |
context->control1000 = phy_read(phydev, MII_CTRL1000); |
| 243 |
context->int_enable = phy_read(phydev, AT803X_INTR_ENABLE); |
| 244 |
context->smart_speed = phy_read(phydev, AT803X_SMART_SPEED); |
| 245 |
context->led_control = phy_read(phydev, AT803X_LED_CONTROL); |
| 246 |
} |
| 247 |
|
| 248 |
/* restore relevant PHY registers from private copy */ |
| 249 |
static void at803x_context_restore(struct phy_device *phydev, |
| 250 |
const struct at803x_context *context) |
| 251 |
{ |
| 252 |
phy_write(phydev, MII_BMCR, context->bmcr); |
| 253 |
phy_write(phydev, MII_ADVERTISE, context->advertise); |
| 254 |
phy_write(phydev, MII_CTRL1000, context->control1000); |
| 255 |
phy_write(phydev, AT803X_INTR_ENABLE, context->int_enable); |
| 256 |
phy_write(phydev, AT803X_SMART_SPEED, context->smart_speed); |
| 257 |
phy_write(phydev, AT803X_LED_CONTROL, context->led_control); |
| 258 |
} |
| 259 |
|
| 260 |
static int at803x_suspend(struct phy_device *phydev) |
| 261 |
{ |
| 262 |
int value; |
| 263 |
int wol_enabled; |
| 264 |
|
| 265 |
value = phy_read(phydev, AT803X_INTR_ENABLE); |
| 266 |
wol_enabled = value & AT803X_INTR_ENABLE_WOL; |
| 267 |
|
| 268 |
if (wol_enabled) |
| 269 |
value = BMCR_ISOLATE; |
| 270 |
else |
| 271 |
value = BMCR_PDOWN; |
| 272 |
|
| 273 |
phy_modify(phydev, MII_BMCR, 0, value); |
| 274 |
|
| 275 |
return 0; |
| 276 |
} |
| 277 |
|
| 278 |
static int at803x_resume(struct phy_device *phydev) |
| 279 |
{ |
| 280 |
return phy_modify(phydev, MII_BMCR, BMCR_PDOWN | BMCR_ISOLATE, 0); |
| 281 |
} |
| 282 |
|
| 283 |
static int at803x_parse_dt(struct phy_device *phydev) |
| 284 |
{ |
| 285 |
struct device_node *node = phydev->mdio.dev.of_node; |
| 286 |
struct at803x_priv *priv = phydev->priv; |
| 287 |
u32 freq, strength, tw; |
| 288 |
unsigned int sel; |
| 289 |
int ret; |
| 290 |
|
| 291 |
if (!IS_ENABLED(CONFIG_OF_MDIO)) |
| 292 |
return 0; |
| 293 |
|
| 294 |
if (of_property_read_bool(node, "qca,disable-smarteee")) |
| 295 |
priv->flags |= AT803X_DISABLE_SMARTEEE; |
| 296 |
|
| 297 |
if (of_property_read_bool(node, "qca,disable-hibernation-mode")) |
| 298 |
priv->flags |= AT803X_DISABLE_HIBERNATION_MODE; |
| 299 |
|
| 300 |
if (!of_property_read_u32(node, "qca,smarteee-tw-us-1g", &tw)) { |
| 301 |
if (!tw || tw > 255) { |
| 302 |
phydev_err(phydev, "invalid qca,smarteee-tw-us-1g\n"); |
| 303 |
return -EINVAL; |
| 304 |
} |
| 305 |
priv->smarteee_lpi_tw_1g = tw; |
| 306 |
} |
| 307 |
|
| 308 |
if (!of_property_read_u32(node, "qca,smarteee-tw-us-100m", &tw)) { |
| 309 |
if (!tw || tw > 255) { |
| 310 |
phydev_err(phydev, "invalid qca,smarteee-tw-us-100m\n"); |
| 311 |
return -EINVAL; |
| 312 |
} |
| 313 |
priv->smarteee_lpi_tw_100m = tw; |
| 314 |
} |
| 315 |
|
| 316 |
ret = of_property_read_u32(node, "qca,clk-out-frequency", &freq); |
| 317 |
if (!ret) { |
| 318 |
switch (freq) { |
| 319 |
case 25000000: |
| 320 |
sel = AT803X_CLK_OUT_25MHZ_XTAL; |
| 321 |
break; |
| 322 |
case 50000000: |
| 323 |
sel = AT803X_CLK_OUT_50MHZ_PLL; |
| 324 |
break; |
| 325 |
case 62500000: |
| 326 |
sel = AT803X_CLK_OUT_62_5MHZ_PLL; |
| 327 |
break; |
| 328 |
case 125000000: |
| 329 |
sel = AT803X_CLK_OUT_125MHZ_PLL; |
| 330 |
break; |
| 331 |
default: |
| 332 |
phydev_err(phydev, "invalid qca,clk-out-frequency\n"); |
| 333 |
return -EINVAL; |
| 334 |
} |
| 335 |
|
| 336 |
priv->clk_25m_reg |= FIELD_PREP(AT803X_CLK_OUT_MASK, sel); |
| 337 |
priv->clk_25m_mask |= AT803X_CLK_OUT_MASK; |
| 338 |
} |
| 339 |
|
| 340 |
ret = of_property_read_u32(node, "qca,clk-out-strength", &strength); |
| 341 |
if (!ret) { |
| 342 |
priv->clk_25m_mask |= AT803X_CLK_OUT_STRENGTH_MASK; |
| 343 |
switch (strength) { |
| 344 |
case AR803X_STRENGTH_FULL: |
| 345 |
priv->clk_25m_reg |= AT803X_CLK_OUT_STRENGTH_FULL; |
| 346 |
break; |
| 347 |
case AR803X_STRENGTH_HALF: |
| 348 |
priv->clk_25m_reg |= AT803X_CLK_OUT_STRENGTH_HALF; |
| 349 |
break; |
| 350 |
case AR803X_STRENGTH_QUARTER: |
| 351 |
priv->clk_25m_reg |= AT803X_CLK_OUT_STRENGTH_QUARTER; |
| 352 |
break; |
| 353 |
default: |
| 354 |
phydev_err(phydev, "invalid qca,clk-out-strength\n"); |
| 355 |
return -EINVAL; |
| 356 |
} |
| 357 |
} |
| 358 |
|
| 359 |
return 0; |
| 360 |
} |
| 361 |
|
| 362 |
static int at803x_probe(struct phy_device *phydev) |
| 363 |
{ |
| 364 |
struct device *dev = &phydev->mdio.dev; |
| 365 |
struct at803x_priv *priv; |
| 366 |
int ret; |
| 367 |
|
| 368 |
priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); |
| 369 |
if (!priv) |
| 370 |
return -ENOMEM; |
| 371 |
|
| 372 |
phydev->priv = priv; |
| 373 |
|
| 374 |
ret = at803x_parse_dt(phydev); |
| 375 |
if (ret) |
| 376 |
return ret; |
| 377 |
|
| 378 |
return 0; |
| 379 |
} |
| 380 |
|
| 381 |
static int at803x_get_features(struct phy_device *phydev) |
| 382 |
{ |
| 383 |
struct at803x_priv *priv = phydev->priv; |
| 384 |
int err; |
| 385 |
|
| 386 |
err = genphy_read_abilities(phydev); |
| 387 |
if (err) |
| 388 |
return err; |
| 389 |
|
| 390 |
if (phydev->drv->phy_id != ATH8031_PHY_ID) |
| 391 |
return 0; |
| 392 |
|
| 393 |
/* AR8031/AR8033 have different status registers |
| 394 |
* for copper and fiber operation. However, the |
| 395 |
* extended status register is the same for both |
| 396 |
* operation modes. |
| 397 |
* |
| 398 |
* As a result of that, ESTATUS_1000_XFULL is set |
| 399 |
* to 1 even when operating in copper TP mode. |
| 400 |
* |
| 401 |
* Remove this mode from the supported link modes |
| 402 |
* when not operating in 1000BaseX mode. |
| 403 |
*/ |
| 404 |
if (!priv->is_1000basex) |
| 405 |
linkmode_clear_bit(ETHTOOL_LINK_MODE_1000baseX_Full_BIT, |
| 406 |
phydev->supported); |
| 407 |
|
| 408 |
return 0; |
| 409 |
} |
| 410 |
|
| 411 |
static int at803x_smarteee_config(struct phy_device *phydev) |
| 412 |
{ |
| 413 |
struct at803x_priv *priv = phydev->priv; |
| 414 |
u16 mask = 0, val = 0; |
| 415 |
int ret; |
| 416 |
|
| 417 |
if (priv->flags & AT803X_DISABLE_SMARTEEE) |
| 418 |
return phy_modify_mmd(phydev, MDIO_MMD_PCS, |
| 419 |
AT803X_MMD3_SMARTEEE_CTL3, |
| 420 |
AT803X_MMD3_SMARTEEE_CTL3_LPI_EN, 0); |
| 421 |
|
| 422 |
if (priv->smarteee_lpi_tw_1g) { |
| 423 |
mask |= 0xff00; |
| 424 |
val |= priv->smarteee_lpi_tw_1g << 8; |
| 425 |
} |
| 426 |
if (priv->smarteee_lpi_tw_100m) { |
| 427 |
mask |= 0x00ff; |
| 428 |
val |= priv->smarteee_lpi_tw_100m; |
| 429 |
} |
| 430 |
if (!mask) |
| 431 |
return 0; |
| 432 |
|
| 433 |
ret = phy_modify_mmd(phydev, MDIO_MMD_PCS, AT803X_MMD3_SMARTEEE_CTL1, |
| 434 |
mask, val); |
| 435 |
if (ret) |
| 436 |
return ret; |
| 437 |
|
| 438 |
return phy_modify_mmd(phydev, MDIO_MMD_PCS, AT803X_MMD3_SMARTEEE_CTL3, |
| 439 |
AT803X_MMD3_SMARTEEE_CTL3_LPI_EN, |
| 440 |
AT803X_MMD3_SMARTEEE_CTL3_LPI_EN); |
| 441 |
} |
| 442 |
|
| 443 |
static int at803x_clk_out_config(struct phy_device *phydev) |
| 444 |
{ |
| 445 |
struct at803x_priv *priv = phydev->priv; |
| 446 |
|
| 447 |
if (!priv->clk_25m_mask) |
| 448 |
return 0; |
| 449 |
|
| 450 |
return phy_modify_mmd(phydev, MDIO_MMD_AN, AT803X_MMD7_CLK25M, |
| 451 |
priv->clk_25m_mask, priv->clk_25m_reg); |
| 452 |
} |
| 453 |
|
| 454 |
static int at8031_pll_config(struct phy_device *phydev) |
| 455 |
{ |
| 456 |
struct at803x_priv *priv = phydev->priv; |
| 457 |
|
| 458 |
/* The default after hardware reset is PLL OFF. After a soft reset, the |
| 459 |
* values are retained. |
| 460 |
*/ |
| 461 |
if (priv->flags & AT803X_KEEP_PLL_ENABLED) |
| 462 |
return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_1F, |
| 463 |
0, AT803X_DEBUG_PLL_ON); |
| 464 |
else |
| 465 |
return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_1F, |
| 466 |
AT803X_DEBUG_PLL_ON, 0); |
| 467 |
} |
| 468 |
|
| 469 |
static int at803x_hibernation_mode_config(struct phy_device *phydev) |
| 470 |
{ |
| 471 |
struct at803x_priv *priv = phydev->priv; |
| 472 |
|
| 473 |
/* The default after hardware reset is hibernation mode enabled. After |
| 474 |
* software reset, the value is retained. |
| 475 |
*/ |
| 476 |
if (!(priv->flags & AT803X_DISABLE_HIBERNATION_MODE) && |
| 477 |
!(phydev->dev_flags & PHY_F_RXC_ALWAYS_ON)) |
| 478 |
return 0; |
| 479 |
|
| 480 |
return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_HIB_CTRL, |
| 481 |
AT803X_DEBUG_HIB_CTRL_PS_HIB_EN, 0); |
| 482 |
} |
| 483 |
|
| 484 |
static int at803x_config_init(struct phy_device *phydev) |
| 485 |
{ |
| 486 |
int ret; |
| 487 |
|
| 488 |
/* The RX and TX delay default is: |
| 489 |
* after HW reset: RX delay enabled and TX delay disabled |
| 490 |
* after SW reset: RX delay enabled, while TX delay retains the |
| 491 |
* value before reset. |
| 492 |
*/ |
| 493 |
if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || |
| 494 |
phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) |
| 495 |
ret = at803x_enable_rx_delay(phydev); |
| 496 |
else |
| 497 |
ret = at803x_disable_rx_delay(phydev); |
| 498 |
if (ret < 0) |
| 499 |
return ret; |
| 500 |
|
| 501 |
if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || |
| 502 |
phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) |
| 503 |
ret = at803x_enable_tx_delay(phydev); |
| 504 |
else |
| 505 |
ret = at803x_disable_tx_delay(phydev); |
| 506 |
if (ret < 0) |
| 507 |
return ret; |
| 508 |
|
| 509 |
ret = at803x_smarteee_config(phydev); |
| 510 |
if (ret < 0) |
| 511 |
return ret; |
| 512 |
|
| 513 |
ret = at803x_clk_out_config(phydev); |
| 514 |
if (ret < 0) |
| 515 |
return ret; |
| 516 |
|
| 517 |
ret = at803x_hibernation_mode_config(phydev); |
| 518 |
if (ret < 0) |
| 519 |
return ret; |
| 520 |
|
| 521 |
/* Ar803x extended next page bit is enabled by default. Cisco |
| 522 |
* multigig switches read this bit and attempt to negotiate 10Gbps |
| 523 |
* rates even if the next page bit is disabled. This is incorrect |
| 524 |
* behaviour but we still need to accommodate it. XNP is only needed |
| 525 |
* for 10Gbps support, so disable XNP. |
| 526 |
*/ |
| 527 |
return phy_modify(phydev, MII_ADVERTISE, ADVERTISE_XNP, 0); |
| 528 |
} |
| 529 |
|
| 530 |
static void at803x_link_change_notify(struct phy_device *phydev) |
| 531 |
{ |
| 532 |
/* |
| 533 |
* Conduct a hardware reset for AT8030 every time a link loss is |
| 534 |
* signalled. This is necessary to circumvent a hardware bug that |
| 535 |
* occurs when the cable is unplugged while TX packets are pending |
| 536 |
* in the FIFO. In such cases, the FIFO enters an error mode it |
| 537 |
* cannot recover from by software. |
| 538 |
*/ |
| 539 |
if (phydev->state == PHY_NOLINK && phydev->mdio.reset_gpio) { |
| 540 |
struct at803x_context context; |
| 541 |
|
| 542 |
at803x_context_save(phydev, &context); |
| 543 |
|
| 544 |
phy_device_reset(phydev, 1); |
| 545 |
usleep_range(1000, 2000); |
| 546 |
phy_device_reset(phydev, 0); |
| 547 |
usleep_range(1000, 2000); |
| 548 |
|
| 549 |
at803x_context_restore(phydev, &context); |
| 550 |
|
| 551 |
phydev_dbg(phydev, "%s(): phy was reset\n", __func__); |
| 552 |
} |
| 553 |
} |
| 554 |
|
| 555 |
static int at803x_config_aneg(struct phy_device *phydev) |
| 556 |
{ |
| 557 |
struct at803x_priv *priv = phydev->priv; |
| 558 |
int ret; |
| 559 |
|
| 560 |
ret = at803x_prepare_config_aneg(phydev); |
| 561 |
if (ret) |
| 562 |
return ret; |
| 563 |
|
| 564 |
if (priv->is_1000basex) |
| 565 |
return genphy_c37_config_aneg(phydev); |
| 566 |
|
| 567 |
return genphy_config_aneg(phydev); |
| 568 |
} |
| 569 |
|
| 570 |
static int at803x_cable_test_result_trans(u16 status) |
| 571 |
{ |
| 572 |
switch (FIELD_GET(AT803X_CDT_STATUS_STAT_MASK, status)) { |
| 573 |
case AT803X_CDT_STATUS_STAT_NORMAL: |
| 574 |
return ETHTOOL_A_CABLE_RESULT_CODE_OK; |
| 575 |
case AT803X_CDT_STATUS_STAT_SHORT: |
| 576 |
return ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT; |
| 577 |
case AT803X_CDT_STATUS_STAT_OPEN: |
| 578 |
return ETHTOOL_A_CABLE_RESULT_CODE_OPEN; |
| 579 |
case AT803X_CDT_STATUS_STAT_FAIL: |
| 580 |
default: |
| 581 |
return ETHTOOL_A_CABLE_RESULT_CODE_UNSPEC; |
| 582 |
} |
| 583 |
} |
| 584 |
|
| 585 |
static bool at803x_cdt_test_failed(u16 status) |
| 586 |
{ |
| 587 |
return FIELD_GET(AT803X_CDT_STATUS_STAT_MASK, status) == |
| 588 |
AT803X_CDT_STATUS_STAT_FAIL; |
| 589 |
} |
| 590 |
|
| 591 |
static bool at803x_cdt_fault_length_valid(u16 status) |
| 592 |
{ |
| 593 |
switch (FIELD_GET(AT803X_CDT_STATUS_STAT_MASK, status)) { |
| 594 |
case AT803X_CDT_STATUS_STAT_OPEN: |
| 595 |
case AT803X_CDT_STATUS_STAT_SHORT: |
| 596 |
return true; |
| 597 |
} |
| 598 |
return false; |
| 599 |
} |
| 600 |
|
| 601 |
static int at803x_cable_test_one_pair(struct phy_device *phydev, int pair) |
| 602 |
{ |
| 603 |
static const int ethtool_pair[] = { |
| 604 |
ETHTOOL_A_CABLE_PAIR_A, |
| 605 |
ETHTOOL_A_CABLE_PAIR_B, |
| 606 |
ETHTOOL_A_CABLE_PAIR_C, |
| 607 |
ETHTOOL_A_CABLE_PAIR_D, |
| 608 |
}; |
| 609 |
int ret, val; |
| 610 |
|
| 611 |
val = FIELD_PREP(AT803X_CDT_MDI_PAIR_MASK, pair) | |
| 612 |
AT803X_CDT_ENABLE_TEST; |
| 613 |
ret = at803x_cdt_start(phydev, val); |
| 614 |
if (ret) |
| 615 |
return ret; |
| 616 |
|
| 617 |
ret = at803x_cdt_wait_for_completion(phydev, AT803X_CDT_ENABLE_TEST); |
| 618 |
if (ret) |
| 619 |
return ret; |
| 620 |
|
| 621 |
val = phy_read(phydev, AT803X_CDT_STATUS); |
| 622 |
if (val < 0) |
| 623 |
return val; |
| 624 |
|
| 625 |
if (at803x_cdt_test_failed(val)) |
| 626 |
return 0; |
| 627 |
|
| 628 |
ethnl_cable_test_result(phydev, ethtool_pair[pair], |
| 629 |
at803x_cable_test_result_trans(val)); |
| 630 |
|
| 631 |
if (at803x_cdt_fault_length_valid(val)) { |
| 632 |
val = FIELD_GET(AT803X_CDT_STATUS_DELTA_TIME_MASK, val); |
| 633 |
ethnl_cable_test_fault_length(phydev, ethtool_pair[pair], |
| 634 |
at803x_cdt_fault_length(val)); |
| 635 |
} |
| 636 |
|
| 637 |
return 1; |
| 638 |
} |
| 639 |
|
| 640 |
static int at803x_cable_test_get_status(struct phy_device *phydev, |
| 641 |
bool *finished, unsigned long pair_mask) |
| 642 |
{ |
| 643 |
int retries = 20; |
| 644 |
int pair, ret; |
| 645 |
|
| 646 |
*finished = false; |
| 647 |
|
| 648 |
/* According to the datasheet the CDT can be performed when |
| 649 |
* there is no link partner or when the link partner is |
| 650 |
* auto-negotiating. Starting the test will restart the AN |
| 651 |
* automatically. It seems that doing this repeatedly we will |
| 652 |
* get a slot where our link partner won't disturb our |
| 653 |
* measurement. |
| 654 |
*/ |
| 655 |
while (pair_mask && retries--) { |
| 656 |
for_each_set_bit(pair, &pair_mask, 4) { |
| 657 |
ret = at803x_cable_test_one_pair(phydev, pair); |
| 658 |
if (ret < 0) |
| 659 |
return ret; |
| 660 |
if (ret) |
| 661 |
clear_bit(pair, &pair_mask); |
| 662 |
} |
| 663 |
if (pair_mask) |
| 664 |
msleep(250); |
| 665 |
} |
| 666 |
|
| 667 |
*finished = true; |
| 668 |
|
| 669 |
return 0; |
| 670 |
} |
| 671 |
|
| 672 |
static void at803x_cable_test_autoneg(struct phy_device *phydev) |
| 673 |
{ |
| 674 |
/* Enable auto-negotiation, but advertise no capabilities, no link |
| 675 |
* will be established. A restart of the auto-negotiation is not |
| 676 |
* required, because the cable test will automatically break the link. |
| 677 |
*/ |
| 678 |
phy_write(phydev, MII_BMCR, BMCR_ANENABLE); |
| 679 |
phy_write(phydev, MII_ADVERTISE, ADVERTISE_CSMA); |
| 680 |
} |
| 681 |
|
| 682 |
static int at803x_cable_test_start(struct phy_device *phydev) |
| 683 |
{ |
| 684 |
at803x_cable_test_autoneg(phydev); |
| 685 |
/* we do all the (time consuming) work later */ |
| 686 |
return 0; |
| 687 |
} |
| 688 |
|
| 689 |
static int at8031_rgmii_reg_set_voltage_sel(struct regulator_dev *rdev, |
| 690 |
unsigned int selector) |
| 691 |
{ |
| 692 |
struct phy_device *phydev = rdev_get_drvdata(rdev); |
| 693 |
|
| 694 |
if (selector) |
| 695 |
return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_1F, |
| 696 |
0, AT803X_DEBUG_RGMII_1V8); |
| 697 |
else |
| 698 |
return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_1F, |
| 699 |
AT803X_DEBUG_RGMII_1V8, 0); |
| 700 |
} |
| 701 |
|
| 702 |
static int at8031_rgmii_reg_get_voltage_sel(struct regulator_dev *rdev) |
| 703 |
{ |
| 704 |
struct phy_device *phydev = rdev_get_drvdata(rdev); |
| 705 |
int val; |
| 706 |
|
| 707 |
val = at803x_debug_reg_read(phydev, AT803X_DEBUG_REG_1F); |
| 708 |
if (val < 0) |
| 709 |
return val; |
| 710 |
|
| 711 |
return (val & AT803X_DEBUG_RGMII_1V8) ? 1 : 0; |
| 712 |
} |
| 713 |
|
| 714 |
static const struct regulator_ops vddio_regulator_ops = { |
| 715 |
.list_voltage = regulator_list_voltage_table, |
| 716 |
.set_voltage_sel = at8031_rgmii_reg_set_voltage_sel, |
| 717 |
.get_voltage_sel = at8031_rgmii_reg_get_voltage_sel, |
| 718 |
}; |
| 719 |
|
| 720 |
static const unsigned int vddio_voltage_table[] = { |
| 721 |
1500000, |
| 722 |
1800000, |
| 723 |
}; |
| 724 |
|
| 725 |
static const struct regulator_desc vddio_desc = { |
| 726 |
.name = "vddio", |
| 727 |
.of_match = of_match_ptr("vddio-regulator"), |
| 728 |
.n_voltages = ARRAY_SIZE(vddio_voltage_table), |
| 729 |
.volt_table = vddio_voltage_table, |
| 730 |
.ops = &vddio_regulator_ops, |
| 731 |
.type = REGULATOR_VOLTAGE, |
| 732 |
.owner = THIS_MODULE, |
| 733 |
}; |
| 734 |
|
| 735 |
static const struct regulator_ops vddh_regulator_ops = { |
| 736 |
}; |
| 737 |
|
| 738 |
static const struct regulator_desc vddh_desc = { |
| 739 |
.name = "vddh", |
| 740 |
.of_match = of_match_ptr("vddh-regulator"), |
| 741 |
.n_voltages = 1, |
| 742 |
.fixed_uV = 2500000, |
| 743 |
.ops = &vddh_regulator_ops, |
| 744 |
.type = REGULATOR_VOLTAGE, |
| 745 |
.owner = THIS_MODULE, |
| 746 |
}; |
| 747 |
|
| 748 |
static int at8031_register_regulators(struct phy_device *phydev) |
| 749 |
{ |
| 750 |
struct at803x_priv *priv = phydev->priv; |
| 751 |
struct device *dev = &phydev->mdio.dev; |
| 752 |
struct regulator_config config = { }; |
| 753 |
|
| 754 |
config.dev = dev; |
| 755 |
config.driver_data = phydev; |
| 756 |
|
| 757 |
priv->vddio_rdev = devm_regulator_register(dev, &vddio_desc, &config); |
| 758 |
if (IS_ERR(priv->vddio_rdev)) { |
| 759 |
phydev_err(phydev, "failed to register VDDIO regulator\n"); |
| 760 |
return PTR_ERR(priv->vddio_rdev); |
| 761 |
} |
| 762 |
|
| 763 |
priv->vddh_rdev = devm_regulator_register(dev, &vddh_desc, &config); |
| 764 |
if (IS_ERR(priv->vddh_rdev)) { |
| 765 |
phydev_err(phydev, "failed to register VDDH regulator\n"); |
| 766 |
return PTR_ERR(priv->vddh_rdev); |
| 767 |
} |
| 768 |
|
| 769 |
return 0; |
| 770 |
} |
| 771 |
|
| 772 |
static int at803x_configure_mii(struct phy_port *port, bool enable, |
| 773 |
phy_interface_t interface) |
| 774 |
{ |
| 775 |
struct phy_device *phydev = port_phydev(port); |
| 776 |
|
| 777 |
if (interface == PHY_INTERFACE_MODE_SGMII) |
| 778 |
dev_warn(&phydev->mdio.dev, |
| 779 |
"module may not function if 1000Base-X not supported\n"); |
| 780 |
|
| 781 |
return 0; |
| 782 |
} |
| 783 |
|
| 784 |
static const struct phy_port_ops at803x_port_ops = { |
| 785 |
.configure_mii = at803x_configure_mii, |
| 786 |
}; |
| 787 |
|
| 788 |
static int at8031_attach_mii_port(struct phy_device *phydev, |
| 789 |
struct phy_port *port) |
| 790 |
{ |
| 791 |
linkmode_zero(port->supported); |
| 792 |
phylink_set(port->supported, 1000baseX_Full); |
| 793 |
phylink_set(port->supported, 1000baseT_Full); |
| 794 |
phylink_set(port->supported, Autoneg); |
| 795 |
phylink_set(port->supported, Pause); |
| 796 |
phylink_set(port->supported, Asym_Pause); |
| 797 |
|
| 798 |
/* This device doesn't really support SGMII. However, do our best |
| 799 |
* to be compatible with copper modules (that usually require SGMII), |
| 800 |
* in a degraded mode as we only allow 1000BaseT Full |
| 801 |
*/ |
| 802 |
__set_bit(PHY_INTERFACE_MODE_SGMII, port->interfaces); |
| 803 |
__set_bit(PHY_INTERFACE_MODE_1000BASEX, port->interfaces); |
| 804 |
|
| 805 |
port->ops = &at803x_port_ops; |
| 806 |
|
| 807 |
return 0; |
| 808 |
} |
| 809 |
|
| 810 |
static int at8031_parse_dt(struct phy_device *phydev) |
| 811 |
{ |
| 812 |
struct device_node *node = phydev->mdio.dev.of_node; |
| 813 |
struct at803x_priv *priv = phydev->priv; |
| 814 |
int ret; |
| 815 |
|
| 816 |
if (of_property_read_bool(node, "qca,keep-pll-enabled")) |
| 817 |
priv->flags |= AT803X_KEEP_PLL_ENABLED; |
| 818 |
|
| 819 |
ret = at8031_register_regulators(phydev); |
| 820 |
if (ret < 0) |
| 821 |
return ret; |
| 822 |
|
| 823 |
ret = devm_regulator_get_enable_optional(&phydev->mdio.dev, |
| 824 |
"vddio"); |
| 825 |
if (ret) { |
| 826 |
phydev_err(phydev, "failed to get VDDIO regulator\n"); |
| 827 |
return ret; |
| 828 |
} |
| 829 |
|
| 830 |
return 0; |
| 831 |
} |
| 832 |
|
| 833 |
static int at8031_probe(struct phy_device *phydev) |
| 834 |
{ |
| 835 |
struct at803x_priv *priv; |
| 836 |
int mode_cfg; |
| 837 |
int ccr; |
| 838 |
int ret; |
| 839 |
|
| 840 |
ret = at803x_probe(phydev); |
| 841 |
if (ret) |
| 842 |
return ret; |
| 843 |
|
| 844 |
priv = phydev->priv; |
| 845 |
|
| 846 |
/* Only supported on AR8031/AR8033, the AR8030/AR8035 use strapping |
| 847 |
* options. |
| 848 |
*/ |
| 849 |
ret = at8031_parse_dt(phydev); |
| 850 |
if (ret) |
| 851 |
return ret; |
| 852 |
|
| 853 |
ccr = phy_read(phydev, AT803X_REG_CHIP_CONFIG); |
| 854 |
if (ccr < 0) |
| 855 |
return ccr; |
| 856 |
mode_cfg = ccr & AT803X_MODE_CFG_MASK; |
| 857 |
|
| 858 |
switch (mode_cfg) { |
| 859 |
case AT803X_MODE_CFG_BX1000_RGMII_50OHM: |
| 860 |
case AT803X_MODE_CFG_BX1000_RGMII_75OHM: |
| 861 |
priv->is_1000basex = true; |
| 862 |
fallthrough; |
| 863 |
case AT803X_MODE_CFG_FX100_RGMII_50OHM: |
| 864 |
case AT803X_MODE_CFG_FX100_RGMII_75OHM: |
| 865 |
priv->is_fiber = true; |
| 866 |
break; |
| 867 |
} |
| 868 |
|
| 869 |
/* Disable WoL in 1588 register which is enabled |
| 870 |
* by default |
| 871 |
*/ |
| 872 |
return phy_modify_mmd(phydev, MDIO_MMD_PCS, |
| 873 |
AT803X_PHY_MMD3_WOL_CTRL, |
| 874 |
AT803X_WOL_EN, 0); |
| 875 |
} |
| 876 |
|
| 877 |
static int at8031_config_init(struct phy_device *phydev) |
| 878 |
{ |
| 879 |
struct at803x_priv *priv = phydev->priv; |
| 880 |
int ret; |
| 881 |
|
| 882 |
/* Some bootloaders leave the fiber page selected. |
| 883 |
* Switch to the appropriate page (fiber or copper), as otherwise we |
| 884 |
* read the PHY capabilities from the wrong page. |
| 885 |
*/ |
| 886 |
phy_lock_mdio_bus(phydev); |
| 887 |
ret = at803x_write_page(phydev, |
| 888 |
priv->is_fiber ? AT803X_PAGE_FIBER : |
| 889 |
AT803X_PAGE_COPPER); |
| 890 |
phy_unlock_mdio_bus(phydev); |
| 891 |
if (ret) |
| 892 |
return ret; |
| 893 |
|
| 894 |
ret = at8031_pll_config(phydev); |
| 895 |
if (ret < 0) |
| 896 |
return ret; |
| 897 |
|
| 898 |
return at803x_config_init(phydev); |
| 899 |
} |
| 900 |
|
| 901 |
static int at8031_config_intr(struct phy_device *phydev) |
| 902 |
{ |
| 903 |
struct at803x_priv *priv = phydev->priv; |
| 904 |
int err, value = 0; |
| 905 |
|
| 906 |
if (phydev->interrupts == PHY_INTERRUPT_ENABLED && |
| 907 |
priv->is_fiber) { |
| 908 |
/* Clear any pending interrupts */ |
| 909 |
err = at803x_ack_interrupt(phydev); |
| 910 |
if (err) |
| 911 |
return err; |
| 912 |
|
| 913 |
value |= AT803X_INTR_ENABLE_LINK_FAIL_BX; |
| 914 |
value |= AT803X_INTR_ENABLE_LINK_SUCCESS_BX; |
| 915 |
|
| 916 |
err = phy_set_bits(phydev, AT803X_INTR_ENABLE, value); |
| 917 |
if (err) |
| 918 |
return err; |
| 919 |
} |
| 920 |
|
| 921 |
return at803x_config_intr(phydev); |
| 922 |
} |
| 923 |
|
| 924 |
/* AR8031 and AR8033 share the same read status logic */ |
| 925 |
static int at8031_read_status(struct phy_device *phydev) |
| 926 |
{ |
| 927 |
struct at803x_priv *priv = phydev->priv; |
| 928 |
bool changed; |
| 929 |
|
| 930 |
if (priv->is_1000basex) |
| 931 |
return genphy_c37_read_status(phydev, &changed); |
| 932 |
|
| 933 |
return at803x_read_status(phydev); |
| 934 |
} |
| 935 |
|
| 936 |
/* AR8031 and AR8035 share the same cable test get status reg */ |
| 937 |
static int at8031_cable_test_get_status(struct phy_device *phydev, |
| 938 |
bool *finished) |
| 939 |
{ |
| 940 |
return at803x_cable_test_get_status(phydev, finished, 0xf); |
| 941 |
} |
| 942 |
|
| 943 |
/* AR8031 and AR8035 share the same cable test start logic */ |
| 944 |
static int at8031_cable_test_start(struct phy_device *phydev) |
| 945 |
{ |
| 946 |
at803x_cable_test_autoneg(phydev); |
| 947 |
phy_write(phydev, MII_CTRL1000, 0); |
| 948 |
/* we do all the (time consuming) work later */ |
| 949 |
return 0; |
| 950 |
} |
| 951 |
|
| 952 |
/* AR8032, AR9331 and QCA9561 share the same cable test get status reg */ |
| 953 |
static int at8032_cable_test_get_status(struct phy_device *phydev, |
| 954 |
bool *finished) |
| 955 |
{ |
| 956 |
return at803x_cable_test_get_status(phydev, finished, 0x3); |
| 957 |
} |
| 958 |
|
| 959 |
static int at8035_parse_dt(struct phy_device *phydev) |
| 960 |
{ |
| 961 |
struct at803x_priv *priv = phydev->priv; |
| 962 |
|
| 963 |
/* Mask is set by the generic at803x_parse_dt |
| 964 |
* if property is set. Assume property is set |
| 965 |
* with the mask not zero. |
| 966 |
*/ |
| 967 |
if (priv->clk_25m_mask) { |
| 968 |
/* Fixup for the AR8030/AR8035. This chip has another mask and |
| 969 |
* doesn't support the DSP reference. Eg. the lowest bit of the |
| 970 |
* mask. The upper two bits select the same frequencies. Mask |
| 971 |
* the lowest bit here. |
| 972 |
* |
| 973 |
* Warning: |
| 974 |
* There was no datasheet for the AR8030 available so this is |
| 975 |
* just a guess. But the AR8035 is listed as pin compatible |
| 976 |
* to the AR8030 so there might be a good chance it works on |
| 977 |
* the AR8030 too. |
| 978 |
*/ |
| 979 |
priv->clk_25m_reg &= AT8035_CLK_OUT_MASK; |
| 980 |
priv->clk_25m_mask &= AT8035_CLK_OUT_MASK; |
| 981 |
} |
| 982 |
|
| 983 |
return 0; |
| 984 |
} |
| 985 |
|
| 986 |
/* AR8030 and AR8035 shared the same special mask for clk_25m */ |
| 987 |
static int at8035_probe(struct phy_device *phydev) |
| 988 |
{ |
| 989 |
int ret; |
| 990 |
|
| 991 |
ret = at803x_probe(phydev); |
| 992 |
if (ret) |
| 993 |
return ret; |
| 994 |
|
| 995 |
return at8035_parse_dt(phydev); |
| 996 |
} |
| 997 |
|
| 998 |
static int ipq5018_cable_test_start(struct phy_device *phydev) |
| 999 |
{ |
| 1000 |
phy_write_mmd(phydev, MDIO_MMD_PCS, IPQ5018_PHY_PCS_CDT_THRESH_CTRL3, |
| 1001 |
IPQ5018_PHY_PCS_CDT_THRESH_CTRL3_VAL); |
| 1002 |
phy_write_mmd(phydev, MDIO_MMD_PCS, IPQ5018_PHY_PCS_CDT_THRESH_CTRL4, |
| 1003 |
IPQ5018_PHY_PCS_CDT_THRESH_CTRL4_VAL); |
| 1004 |
phy_write_mmd(phydev, MDIO_MMD_PCS, IPQ5018_PHY_PCS_CDT_THRESH_CTRL5, |
| 1005 |
IPQ5018_PHY_PCS_CDT_THRESH_CTRL5_VAL); |
| 1006 |
phy_write_mmd(phydev, MDIO_MMD_PCS, IPQ5018_PHY_PCS_CDT_THRESH_CTRL6, |
| 1007 |
IPQ5018_PHY_PCS_CDT_THRESH_CTRL6_VAL); |
| 1008 |
phy_write_mmd(phydev, MDIO_MMD_PCS, IPQ5018_PHY_PCS_CDT_THRESH_CTRL7, |
| 1009 |
IPQ5018_PHY_PCS_CDT_THRESH_CTRL7_VAL); |
| 1010 |
phy_write_mmd(phydev, MDIO_MMD_PCS, IPQ5018_PHY_PCS_CDT_THRESH_CTRL9, |
| 1011 |
IPQ5018_PHY_PCS_CDT_THRESH_CTRL9_VAL); |
| 1012 |
phy_write_mmd(phydev, MDIO_MMD_PCS, IPQ5018_PHY_PCS_CDT_THRESH_CTRL13, |
| 1013 |
IPQ5018_PHY_PCS_CDT_THRESH_CTRL13_VAL); |
| 1014 |
phy_write_mmd(phydev, MDIO_MMD_PCS, IPQ5018_PHY_PCS_CDT_THRESH_CTRL3, |
| 1015 |
IPQ5018_PHY_PCS_NEAR_ECHO_THRESH_VAL); |
| 1016 |
|
| 1017 |
/* we do all the (time consuming) work later */ |
| 1018 |
return 0; |
| 1019 |
} |
| 1020 |
|
| 1021 |
static int ipq5018_config_init(struct phy_device *phydev) |
| 1022 |
{ |
| 1023 |
struct ipq5018_priv *priv = phydev->priv; |
| 1024 |
u16 val; |
| 1025 |
|
| 1026 |
/* |
| 1027 |
* set LDO efuse: first temporarily store ANA_DAC_FILTER value from |
| 1028 |
* debug register as it will be reset once the ANA_LDO_EFUSE register |
| 1029 |
* is written to |
| 1030 |
*/ |
| 1031 |
val = at803x_debug_reg_read(phydev, IPQ5018_PHY_DEBUG_ANA_DAC_FILTER); |
| 1032 |
at803x_debug_reg_mask(phydev, IPQ5018_PHY_DEBUG_ANA_LDO_EFUSE, |
| 1033 |
IPQ5018_PHY_DEBUG_ANA_LDO_EFUSE_MASK, |
| 1034 |
IPQ5018_PHY_DEBUG_ANA_LDO_EFUSE_DEFAULT); |
| 1035 |
at803x_debug_reg_write(phydev, IPQ5018_PHY_DEBUG_ANA_DAC_FILTER, val); |
| 1036 |
|
| 1037 |
/* set 8023AZ EEE TX and RX timer values */ |
| 1038 |
phy_write_mmd(phydev, MDIO_MMD_PCS, IPQ5018_PHY_PCS_EEE_TX_TIMER, |
| 1039 |
IPQ5018_PHY_PCS_EEE_TX_TIMER_VAL); |
| 1040 |
phy_write_mmd(phydev, MDIO_MMD_PCS, IPQ5018_PHY_PCS_EEE_RX_TIMER, |
| 1041 |
IPQ5018_PHY_PCS_EEE_RX_TIMER_VAL); |
| 1042 |
|
| 1043 |
/* set MSE threshold values */ |
| 1044 |
phy_write_mmd(phydev, MDIO_MMD_PMAPMD, IPQ5018_PHY_MMD1_MSE_THRESH1, |
| 1045 |
IPQ5018_PHY_MMD1_MSE_THRESH1_VAL); |
| 1046 |
phy_write_mmd(phydev, MDIO_MMD_PMAPMD, IPQ5018_PHY_MMD1_MSE_THRESH2, |
| 1047 |
IPQ5018_PHY_MMD1_MSE_THRESH2_VAL); |
| 1048 |
|
| 1049 |
/* PHY DAC values are optional and only set in a PHY to PHY link architecture */ |
| 1050 |
if (priv->set_short_cable_dac) { |
| 1051 |
/* setting MDAC (Multi-level Digital-to-Analog Converter) in MMD1 */ |
| 1052 |
phy_modify_mmd(phydev, MDIO_MMD_PMAPMD, IPQ5018_PHY_MMD1_MDAC, |
| 1053 |
IPQ5018_PHY_DAC_MASK, IPQ5018_PHY_MMD1_MDAC_VAL); |
| 1054 |
|
| 1055 |
/* setting EDAC (Error-detection and Correction) in debug register */ |
| 1056 |
at803x_debug_reg_mask(phydev, IPQ5018_PHY_DEBUG_EDAC, |
| 1057 |
IPQ5018_PHY_DAC_MASK, IPQ5018_PHY_DEBUG_EDAC_VAL); |
| 1058 |
} |
| 1059 |
|
| 1060 |
return 0; |
| 1061 |
} |
| 1062 |
|
| 1063 |
static void ipq5018_link_change_notify(struct phy_device *phydev) |
| 1064 |
{ |
| 1065 |
/* |
| 1066 |
* Reset the FIFO buffer upon link disconnects to clear any residual data |
| 1067 |
* which may cause issues with the FIFO which it cannot recover from. |
| 1068 |
*/ |
| 1069 |
mdiobus_modify_changed(phydev->mdio.bus, phydev->mdio.addr, |
| 1070 |
IPQ5018_PHY_FIFO_CONTROL, IPQ5018_PHY_FIFO_RESET, |
| 1071 |
phydev->link ? IPQ5018_PHY_FIFO_RESET : 0); |
| 1072 |
} |
| 1073 |
|
| 1074 |
static int ipq5018_probe(struct phy_device *phydev) |
| 1075 |
{ |
| 1076 |
struct device *dev = &phydev->mdio.dev; |
| 1077 |
struct ipq5018_priv *priv; |
| 1078 |
int ret; |
| 1079 |
|
| 1080 |
priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); |
| 1081 |
if (!priv) |
| 1082 |
return -ENOMEM; |
| 1083 |
|
| 1084 |
priv->set_short_cable_dac = of_property_read_bool(dev->of_node, |
| 1085 |
"qcom,dac-preset-short-cable"); |
| 1086 |
|
| 1087 |
priv->rst = devm_reset_control_array_get_exclusive(dev); |
| 1088 |
if (IS_ERR(priv->rst)) |
| 1089 |
return dev_err_probe(dev, PTR_ERR(priv->rst), |
| 1090 |
"failed to acquire reset\n"); |
| 1091 |
|
| 1092 |
ret = reset_control_reset(priv->rst); |
| 1093 |
if (ret) |
| 1094 |
return dev_err_probe(dev, ret, "failed to reset\n"); |
| 1095 |
|
| 1096 |
phydev->priv = priv; |
| 1097 |
|
| 1098 |
return 0; |
| 1099 |
} |
| 1100 |
|
| 1101 |
static struct phy_driver at803x_driver[] = { |
| 1102 |
{ |
| 1103 |
/* Qualcomm Atheros AR8035 */ |
| 1104 |
PHY_ID_MATCH_EXACT(ATH8035_PHY_ID), |
| 1105 |
.name = "Qualcomm Atheros AR8035", |
| 1106 |
.flags = PHY_POLL_CABLE_TEST, |
| 1107 |
.probe = at8035_probe, |
| 1108 |
.config_aneg = at803x_config_aneg, |
| 1109 |
.config_init = at803x_config_init, |
| 1110 |
.soft_reset = genphy_soft_reset, |
| 1111 |
.set_wol = at803x_set_wol, |
| 1112 |
.get_wol = at803x_get_wol, |
| 1113 |
.suspend = at803x_suspend, |
| 1114 |
.resume = at803x_resume, |
| 1115 |
/* PHY_GBIT_FEATURES */ |
| 1116 |
.read_status = at803x_read_status, |
| 1117 |
.config_intr = at803x_config_intr, |
| 1118 |
.handle_interrupt = at803x_handle_interrupt, |
| 1119 |
.get_tunable = at803x_get_tunable, |
| 1120 |
.set_tunable = at803x_set_tunable, |
| 1121 |
.cable_test_start = at8031_cable_test_start, |
| 1122 |
.cable_test_get_status = at8031_cable_test_get_status, |
| 1123 |
}, { |
| 1124 |
/* Qualcomm Atheros AR8030 */ |
| 1125 |
.phy_id = ATH8030_PHY_ID, |
| 1126 |
.name = "Qualcomm Atheros AR8030", |
| 1127 |
.phy_id_mask = AT8030_PHY_ID_MASK, |
| 1128 |
.probe = at8035_probe, |
| 1129 |
.config_init = at803x_config_init, |
| 1130 |
.link_change_notify = at803x_link_change_notify, |
| 1131 |
.set_wol = at803x_set_wol, |
| 1132 |
.get_wol = at803x_get_wol, |
| 1133 |
.suspend = at803x_suspend, |
| 1134 |
.resume = at803x_resume, |
| 1135 |
/* PHY_BASIC_FEATURES */ |
| 1136 |
.config_intr = at803x_config_intr, |
| 1137 |
.handle_interrupt = at803x_handle_interrupt, |
| 1138 |
}, { |
| 1139 |
/* Qualcomm Atheros AR8031/AR8033 */ |
| 1140 |
PHY_ID_MATCH_EXACT(ATH8031_PHY_ID), |
| 1141 |
.name = "Qualcomm Atheros AR8031/AR8033", |
| 1142 |
.flags = PHY_POLL_CABLE_TEST, |
| 1143 |
.probe = at8031_probe, |
| 1144 |
.config_init = at8031_config_init, |
| 1145 |
.config_aneg = at803x_config_aneg, |
| 1146 |
.soft_reset = genphy_soft_reset, |
| 1147 |
.set_wol = at8031_set_wol, |
| 1148 |
.get_wol = at803x_get_wol, |
| 1149 |
.suspend = at803x_suspend, |
| 1150 |
.resume = at803x_resume, |
| 1151 |
.read_page = at803x_read_page, |
| 1152 |
.write_page = at803x_write_page, |
| 1153 |
.get_features = at803x_get_features, |
| 1154 |
.read_status = at8031_read_status, |
| 1155 |
.config_intr = at8031_config_intr, |
| 1156 |
.handle_interrupt = at803x_handle_interrupt, |
| 1157 |
.get_tunable = at803x_get_tunable, |
| 1158 |
.set_tunable = at803x_set_tunable, |
| 1159 |
.cable_test_start = at8031_cable_test_start, |
| 1160 |
.cable_test_get_status = at8031_cable_test_get_status, |
| 1161 |
.attach_mii_port = at8031_attach_mii_port, |
| 1162 |
}, { |
| 1163 |
/* Qualcomm Atheros AR8032 */ |
| 1164 |
PHY_ID_MATCH_EXACT(ATH8032_PHY_ID), |
| 1165 |
.name = "Qualcomm Atheros AR8032", |
| 1166 |
.probe = at803x_probe, |
| 1167 |
.flags = PHY_POLL_CABLE_TEST, |
| 1168 |
.config_init = at803x_config_init, |
| 1169 |
.link_change_notify = at803x_link_change_notify, |
| 1170 |
.suspend = at803x_suspend, |
| 1171 |
.resume = at803x_resume, |
| 1172 |
/* PHY_BASIC_FEATURES */ |
| 1173 |
.config_intr = at803x_config_intr, |
| 1174 |
.handle_interrupt = at803x_handle_interrupt, |
| 1175 |
.cable_test_start = at803x_cable_test_start, |
| 1176 |
.cable_test_get_status = at8032_cable_test_get_status, |
| 1177 |
}, { |
| 1178 |
/* ATHEROS AR9331 */ |
| 1179 |
PHY_ID_MATCH_EXACT(ATH9331_PHY_ID), |
| 1180 |
.name = "Qualcomm Atheros AR9331 built-in PHY", |
| 1181 |
.probe = at803x_probe, |
| 1182 |
.suspend = at803x_suspend, |
| 1183 |
.resume = at803x_resume, |
| 1184 |
.flags = PHY_POLL_CABLE_TEST, |
| 1185 |
/* PHY_BASIC_FEATURES */ |
| 1186 |
.config_intr = at803x_config_intr, |
| 1187 |
.handle_interrupt = at803x_handle_interrupt, |
| 1188 |
.cable_test_start = at803x_cable_test_start, |
| 1189 |
.cable_test_get_status = at8032_cable_test_get_status, |
| 1190 |
.read_status = at803x_read_status, |
| 1191 |
.soft_reset = genphy_soft_reset, |
| 1192 |
.config_aneg = at803x_config_aneg, |
| 1193 |
}, { |
| 1194 |
PHY_ID_MATCH_EXACT(IPQ5018_PHY_ID), |
| 1195 |
.name = "Qualcomm Atheros IPQ5018 internal PHY", |
| 1196 |
.flags = PHY_IS_INTERNAL | PHY_POLL_CABLE_TEST, |
| 1197 |
.probe = ipq5018_probe, |
| 1198 |
.config_init = ipq5018_config_init, |
| 1199 |
.link_change_notify = ipq5018_link_change_notify, |
| 1200 |
.read_status = at803x_read_status, |
| 1201 |
.config_intr = at803x_config_intr, |
| 1202 |
.handle_interrupt = at803x_handle_interrupt, |
| 1203 |
.cable_test_start = ipq5018_cable_test_start, |
| 1204 |
.cable_test_get_status = qca808x_cable_test_get_status, |
| 1205 |
.soft_reset = genphy_soft_reset, |
| 1206 |
}, { |
| 1207 |
/* Qualcomm Atheros QCA9561 */ |
| 1208 |
PHY_ID_MATCH_EXACT(QCA9561_PHY_ID), |
| 1209 |
.name = "Qualcomm Atheros QCA9561 built-in PHY", |
| 1210 |
.probe = at803x_probe, |
| 1211 |
.suspend = at803x_suspend, |
| 1212 |
.resume = at803x_resume, |
| 1213 |
.flags = PHY_POLL_CABLE_TEST, |
| 1214 |
/* PHY_BASIC_FEATURES */ |
| 1215 |
.config_intr = at803x_config_intr, |
| 1216 |
.handle_interrupt = at803x_handle_interrupt, |
| 1217 |
.cable_test_start = at803x_cable_test_start, |
| 1218 |
.cable_test_get_status = at8032_cable_test_get_status, |
| 1219 |
.read_status = at803x_read_status, |
| 1220 |
.soft_reset = genphy_soft_reset, |
| 1221 |
.config_aneg = at803x_config_aneg, |
| 1222 |
}, }; |
| 1223 |
|
| 1224 |
module_phy_driver(at803x_driver); |
| 1225 |
|
| 1226 |
static const struct mdio_device_id __maybe_unused atheros_tbl[] = { |
| 1227 |
{ ATH8030_PHY_ID, AT8030_PHY_ID_MASK }, |
| 1228 |
{ PHY_ID_MATCH_EXACT(ATH8031_PHY_ID) }, |
| 1229 |
{ PHY_ID_MATCH_EXACT(ATH8032_PHY_ID) }, |
| 1230 |
{ PHY_ID_MATCH_EXACT(ATH8035_PHY_ID) }, |
| 1231 |
{ PHY_ID_MATCH_EXACT(ATH9331_PHY_ID) }, |
| 1232 |
{ PHY_ID_MATCH_EXACT(IPQ5018_PHY_ID) }, |
| 1233 |
{ PHY_ID_MATCH_EXACT(QCA9561_PHY_ID) }, |
| 1234 |
{ } |
| 1235 |
}; |
| 1236 |
|
| 1237 |
MODULE_DEVICE_TABLE(mdio, atheros_tbl); |