1// SPDX-License-Identifier: GPL-2.0-only 2/******************************************************************************* 3 STMMAC Ethernet Driver -- MDIO bus implementation 4 Provides Bus interface for MII registers 5 6 Copyright (C) 2007-2009 STMicroelectronics Ltd 7 8 9 Author: Carl Shaw <carl.shaw@st.com> 10 Maintainer: Giuseppe Cavallaro <peppe.cavallaro@st.com> 11*******************************************************************************/ 12 13#include <linux/gpio/consumer.h> 14#include <linux/io.h> 15#include <linux/iopoll.h> 16#include <linux/mii.h> 17#include <linux/of_mdio.h> 18#include <linux/pm_runtime.h> 19#include <linux/phy.h> 20#include <linux/property.h> 21#include <linux/slab.h> 22 23#include "dwxgmac2.h" 24#include "stmmac.h" 25 26#define MII_BUSY 0x00000001 27#define MII_WRITE 0x00000002 28#define MII_DATA_MASK GENMASK(15, 0) 29 30/* GMAC4 defines */ 31#define MII_GMAC4_GOC_SHIFT 2 32#define MII_GMAC4_REG_ADDR_SHIFT 16 33#define MII_GMAC4_WRITE (1 << MII_GMAC4_GOC_SHIFT) 34#define MII_GMAC4_READ (3 << MII_GMAC4_GOC_SHIFT) 35#define MII_GMAC4_C45E BIT(1) 36 37/* XGMAC defines */ 38#define MII_XGMAC_SADDR BIT(18) 39#define MII_XGMAC_CMD_SHIFT 16 40#define MII_XGMAC_WRITE (1 << MII_XGMAC_CMD_SHIFT) 41#define MII_XGMAC_READ (3 << MII_XGMAC_CMD_SHIFT) 42#define MII_XGMAC_BUSY BIT(22) 43#define MII_XGMAC_MAX_C22ADDR 3 44#define MII_XGMAC_C22P_MASK GENMASK(MII_XGMAC_MAX_C22ADDR, 0) 45#define MII_XGMAC_PA_SHIFT 16 46#define MII_XGMAC_DA_SHIFT 21 47 48static int stmmac_xgmac2_c45_format(struct stmmac_priv *priv, int phyaddr, 49 int phyreg, u32 *hw_addr) 50{ 51 u32 tmp; 52 53 /* Set port as Clause 45 */ 54 tmp = readl(priv->ioaddr + XGMAC_MDIO_C22P); 55 tmp &= ~BIT(phyaddr); 56 writel(tmp, priv->ioaddr + XGMAC_MDIO_C22P); 57 58 *hw_addr = (phyaddr << MII_XGMAC_PA_SHIFT) | (phyreg & 0xffff); 59 *hw_addr |= (phyreg >> MII_DEVADDR_C45_SHIFT) << MII_XGMAC_DA_SHIFT; 60 return 0; 61} 62 63static int stmmac_xgmac2_c22_format(struct stmmac_priv *priv, int phyaddr, 64 int phyreg, u32 *hw_addr) 65{ 66 u32 tmp; 67 68 /* HW does not support C22 addr >= 4 */ 69 if (phyaddr > MII_XGMAC_MAX_C22ADDR) 70 return -ENODEV; 71 72 /* Set port as Clause 22 */ 73 tmp = readl(priv->ioaddr + XGMAC_MDIO_C22P); 74 tmp &= ~MII_XGMAC_C22P_MASK; 75 tmp |= BIT(phyaddr); 76 writel(tmp, priv->ioaddr + XGMAC_MDIO_C22P); 77 78 *hw_addr = (phyaddr << MII_XGMAC_PA_SHIFT) | (phyreg & 0x1f); 79 return 0; 80} 81 82static int stmmac_xgmac2_mdio_read(struct mii_bus *bus, int phyaddr, int phyreg) 83{ 84 struct net_device *ndev = bus->priv; 85 struct stmmac_priv *priv = netdev_priv(ndev); 86 unsigned int mii_address = priv->hw->mii.addr; 87 unsigned int mii_data = priv->hw->mii.data; 88 u32 tmp, addr, value = MII_XGMAC_BUSY; 89 int ret; 90 91 ret = pm_runtime_get_sync(priv->device); 92 if (ret < 0) { 93 pm_runtime_put_noidle(priv->device); 94 return ret; 95 } 96 97 /* Wait until any existing MII operation is complete */ 98 if (readl_poll_timeout(priv->ioaddr + mii_data, tmp, 99 !(tmp & MII_XGMAC_BUSY), 100, 10000)) { 100 ret = -EBUSY; 101 goto err_disable_clks; 102 } 103 104 if (phyreg & MII_ADDR_C45) { 105 phyreg &= ~MII_ADDR_C45; 106 107 ret = stmmac_xgmac2_c45_format(priv, phyaddr, phyreg, &addr); 108 if (ret) 109 goto err_disable_clks; 110 } else { 111 ret = stmmac_xgmac2_c22_format(priv, phyaddr, phyreg, &addr); 112 if (ret) 113 goto err_disable_clks; 114 115 value |= MII_XGMAC_SADDR; 116 } 117 118 value |= (priv->clk_csr << priv->hw->mii.clk_csr_shift) 119 & priv->hw->mii.clk_csr_mask; 120 value |= MII_XGMAC_READ; 121 122 /* Wait until any existing MII operation is complete */ 123 if (readl_poll_timeout(priv->ioaddr + mii_data, tmp, 124 !(tmp & MII_XGMAC_BUSY), 100, 10000)) { 125 ret = -EBUSY; 126 goto err_disable_clks; 127 } 128 129 /* Set the MII address register to read */ 130 writel(addr, priv->ioaddr + mii_address); 131 writel(value, priv->ioaddr + mii_data); 132 133 /* Wait until any existing MII operation is complete */ 134 if (readl_poll_timeout(priv->ioaddr + mii_data, tmp, 135 !(tmp & MII_XGMAC_BUSY), 100, 10000)) { 136 ret = -EBUSY; 137 goto err_disable_clks; 138 } 139 140 /* Read the data from the MII data register */ 141 ret = (int)readl(priv->ioaddr + mii_data) & GENMASK(15, 0); 142 143err_disable_clks: 144 pm_runtime_put(priv->device); 145 146 return ret; 147} 148 149static int stmmac_xgmac2_mdio_write(struct mii_bus *bus, int phyaddr, 150 int phyreg, u16 phydata) 151{ 152 struct net_device *ndev = bus->priv; 153 struct stmmac_priv *priv = netdev_priv(ndev); 154 unsigned int mii_address = priv->hw->mii.addr; 155 unsigned int mii_data = priv->hw->mii.data; 156 u32 addr, tmp, value = MII_XGMAC_BUSY; 157 int ret; 158 159 ret = pm_runtime_get_sync(priv->device); 160 if (ret < 0) { 161 pm_runtime_put_noidle(priv->device); 162 return ret; 163 } 164 165 /* Wait until any existing MII operation is complete */ 166 if (readl_poll_timeout(priv->ioaddr + mii_data, tmp, 167 !(tmp & MII_XGMAC_BUSY), 100, 10000)) { 168 ret = -EBUSY; 169 goto err_disable_clks; 170 } 171 172 if (phyreg & MII_ADDR_C45) { 173 phyreg &= ~MII_ADDR_C45; 174 175 ret = stmmac_xgmac2_c45_format(priv, phyaddr, phyreg, &addr); 176 if (ret) 177 goto err_disable_clks; 178 } else { 179 ret = stmmac_xgmac2_c22_format(priv, phyaddr, phyreg, &addr); 180 if (ret) 181 goto err_disable_clks; 182 183 value |= MII_XGMAC_SADDR; 184 } 185 186 value |= (priv->clk_csr << priv->hw->mii.clk_csr_shift) 187 & priv->hw->mii.clk_csr_mask; 188 value |= phydata; 189 value |= MII_XGMAC_WRITE; 190 191 /* Wait until any existing MII operation is complete */ 192 if (readl_poll_timeout(priv->ioaddr + mii_data, tmp, 193 !(tmp & MII_XGMAC_BUSY), 100, 10000)) { 194 ret = -EBUSY; 195 goto err_disable_clks; 196 } 197 198 /* Set the MII address register to write */ 199 writel(addr, priv->ioaddr + mii_address); 200 writel(value, priv->ioaddr + mii_data); 201 202 /* Wait until any existing MII operation is complete */ 203 ret = readl_poll_timeout(priv->ioaddr + mii_data, tmp, 204 !(tmp & MII_XGMAC_BUSY), 100, 10000); 205 206err_disable_clks: 207 pm_runtime_put(priv->device); 208 209 return ret; 210} 211 212/** 213 * stmmac_mdio_read 214 * @bus: points to the mii_bus structure 215 * @phyaddr: MII addr 216 * @phyreg: MII reg 217 * Description: it reads data from the MII register from within the phy device. 218 * For the 7111 GMAC, we must set the bit 0 in the MII address register while 219 * accessing the PHY registers. 220 * Fortunately, it seems this has no drawback for the 7109 MAC. 221 */ 222static int stmmac_mdio_read(struct mii_bus *bus, int phyaddr, int phyreg) 223{ 224 struct net_device *ndev = bus->priv; 225 struct stmmac_priv *priv = netdev_priv(ndev); 226 unsigned int mii_address = priv->hw->mii.addr; 227 unsigned int mii_data = priv->hw->mii.data; 228 u32 value = MII_BUSY; 229 int data = 0; 230 u32 v; 231 232 data = pm_runtime_get_sync(priv->device); 233 if (data < 0) { 234 pm_runtime_put_noidle(priv->device); 235 return data; 236 } 237 238 value |= (phyaddr << priv->hw->mii.addr_shift) 239 & priv->hw->mii.addr_mask; 240 value |= (phyreg << priv->hw->mii.reg_shift) & priv->hw->mii.reg_mask; 241 value |= (priv->clk_csr << priv->hw->mii.clk_csr_shift) 242 & priv->hw->mii.clk_csr_mask; 243 if (priv->plat->has_gmac4) { 244 value |= MII_GMAC4_READ; 245 if (phyreg & MII_ADDR_C45) { 246 value |= MII_GMAC4_C45E; 247 value &= ~priv->hw->mii.reg_mask; 248 value |= ((phyreg >> MII_DEVADDR_C45_SHIFT) << 249 priv->hw->mii.reg_shift) & 250 priv->hw->mii.reg_mask; 251 252 data |= (phyreg & MII_REGADDR_C45_MASK) << 253 MII_GMAC4_REG_ADDR_SHIFT; 254 } 255 } 256 257 if (readl_poll_timeout(priv->ioaddr + mii_address, v, !(v & MII_BUSY), 258 100, 10000)) { 259 data = -EBUSY; 260 goto err_disable_clks; 261 } 262 263 writel(data, priv->ioaddr + mii_data); 264 writel(value, priv->ioaddr + mii_address); 265 266 if (readl_poll_timeout(priv->ioaddr + mii_address, v, !(v & MII_BUSY), 267 100, 10000)) { 268 data = -EBUSY; 269 goto err_disable_clks; 270 } 271 272 /* Read the data from the MII data register */ 273 data = (int)readl(priv->ioaddr + mii_data) & MII_DATA_MASK; 274 275err_disable_clks: 276 pm_runtime_put(priv->device); 277 278 return data; 279} 280 281/** 282 * stmmac_mdio_write 283 * @bus: points to the mii_bus structure 284 * @phyaddr: MII addr 285 * @phyreg: MII reg 286 * @phydata: phy data 287 * Description: it writes the data into the MII register from within the device. 288 */ 289static int stmmac_mdio_write(struct mii_bus *bus, int phyaddr, int phyreg, 290 u16 phydata) 291{ 292 struct net_device *ndev = bus->priv; 293 struct stmmac_priv *priv = netdev_priv(ndev); 294 unsigned int mii_address = priv->hw->mii.addr; 295 unsigned int mii_data = priv->hw->mii.data; 296 int ret, data = phydata; 297 u32 value = MII_BUSY; 298 u32 v; 299 300 ret = pm_runtime_get_sync(priv->device); 301 if (ret < 0) { 302 pm_runtime_put_noidle(priv->device); 303 return ret; 304 } 305 306 value |= (phyaddr << priv->hw->mii.addr_shift) 307 & priv->hw->mii.addr_mask; 308 value |= (phyreg << priv->hw->mii.reg_shift) & priv->hw->mii.reg_mask; 309 310 value |= (priv->clk_csr << priv->hw->mii.clk_csr_shift) 311 & priv->hw->mii.clk_csr_mask; 312 if (priv->plat->has_gmac4) { 313 value |= MII_GMAC4_WRITE; 314 if (phyreg & MII_ADDR_C45) { 315 value |= MII_GMAC4_C45E; 316 value &= ~priv->hw->mii.reg_mask; 317 value |= ((phyreg >> MII_DEVADDR_C45_SHIFT) << 318 priv->hw->mii.reg_shift) & 319 priv->hw->mii.reg_mask; 320 321 data |= (phyreg & MII_REGADDR_C45_MASK) << 322 MII_GMAC4_REG_ADDR_SHIFT; 323 } 324 } else { 325 value |= MII_WRITE; 326 } 327 328 /* Wait until any existing MII operation is complete */ 329 if (readl_poll_timeout(priv->ioaddr + mii_address, v, !(v & MII_BUSY), 330 100, 10000)) { 331 ret = -EBUSY; 332 goto err_disable_clks; 333 } 334 335 /* Set the MII address register to write */ 336 writel(data, priv->ioaddr + mii_data); 337 writel(value, priv->ioaddr + mii_address); 338 339 /* Wait until any existing MII operation is complete */ 340 ret = readl_poll_timeout(priv->ioaddr + mii_address, v, !(v & MII_BUSY), 341 100, 10000); 342 343err_disable_clks: 344 pm_runtime_put(priv->device); 345 346 return ret; 347} 348 349/** 350 * stmmac_mdio_reset 351 * @bus: points to the mii_bus structure 352 * Description: reset the MII bus 353 */ 354int stmmac_mdio_reset(struct mii_bus *bus) 355{ 356#if IS_ENABLED(CONFIG_STMMAC_PLATFORM) 357 struct net_device *ndev = bus->priv; 358 struct stmmac_priv *priv = netdev_priv(ndev); 359 unsigned int mii_address = priv->hw->mii.addr; 360 361#ifdef CONFIG_OF 362 if (priv->device->of_node) { 363 struct gpio_desc *reset_gpio; 364 u32 delays[3] = { 0, 0, 0 }; 365 366 reset_gpio = devm_gpiod_get_optional(priv->device, 367 "snps,reset", 368 GPIOD_OUT_LOW); 369 if (IS_ERR(reset_gpio)) 370 return PTR_ERR(reset_gpio); 371 372 device_property_read_u32_array(priv->device, 373 "snps,reset-delays-us", 374 delays, ARRAY_SIZE(delays)); 375 376 if (delays[0]) 377 msleep(DIV_ROUND_UP(delays[0], 1000)); 378 379 gpiod_set_value_cansleep(reset_gpio, 1); 380 if (delays[1]) 381 msleep(DIV_ROUND_UP(delays[1], 1000)); 382 383 gpiod_set_value_cansleep(reset_gpio, 0); 384 if (delays[2]) 385 msleep(DIV_ROUND_UP(delays[2], 1000)); 386 } 387#endif 388 389 /* This is a workaround for problems with the STE101P PHY. 390 * It doesn't complete its reset until at least one clock cycle 391 * on MDC, so perform a dummy mdio read. To be updated for GMAC4 392 * if needed. 393 */ 394 if (!priv->plat->has_gmac4) 395 writel(0, priv->ioaddr + mii_address); 396#endif 397 return 0; 398} 399 400/** 401 * stmmac_mdio_register 402 * @ndev: net device structure 403 * Description: it registers the MII bus 404 */ 405int stmmac_mdio_register(struct net_device *ndev) 406{ 407 int err = 0; 408 struct mii_bus *new_bus; 409 struct stmmac_priv *priv = netdev_priv(ndev); 410 struct stmmac_mdio_bus_data *mdio_bus_data = priv->plat->mdio_bus_data; 411 struct device_node *mdio_node = priv->plat->mdio_node; 412 struct device *dev = ndev->dev.parent; 413 int addr, found, max_addr; 414 415 if (!mdio_bus_data) 416 return 0; 417 418 new_bus = mdiobus_alloc(); 419 if (!new_bus) 420 return -ENOMEM; 421 422 if (mdio_bus_data->irqs) 423 memcpy(new_bus->irq, mdio_bus_data->irqs, sizeof(new_bus->irq)); 424 425 new_bus->name = "stmmac"; 426 427 if (priv->plat->has_xgmac) { 428 new_bus->read = &stmmac_xgmac2_mdio_read; 429 new_bus->write = &stmmac_xgmac2_mdio_write; 430 431 /* Right now only C22 phys are supported */ 432 max_addr = MII_XGMAC_MAX_C22ADDR + 1; 433 434 /* Check if DT specified an unsupported phy addr */ 435 if (priv->plat->phy_addr > MII_XGMAC_MAX_C22ADDR) 436 dev_err(dev, "Unsupported phy_addr (max=%d)\n", 437 MII_XGMAC_MAX_C22ADDR); 438 } else { 439 new_bus->read = &stmmac_mdio_read; 440 new_bus->write = &stmmac_mdio_write; 441 max_addr = PHY_MAX_ADDR; 442 } 443 444 if (mdio_bus_data->has_xpcs) { 445 priv->hw->xpcs = mdio_xpcs_get_ops(); 446 if (!priv->hw->xpcs) { 447 err = -ENODEV; 448 goto bus_register_fail; 449 } 450 } 451 452 if (mdio_bus_data->needs_reset) 453 new_bus->reset = &stmmac_mdio_reset; 454 455 snprintf(new_bus->id, MII_BUS_ID_SIZE, "%s-%x", 456 new_bus->name, priv->plat->bus_id); 457 new_bus->priv = ndev; 458 new_bus->phy_mask = mdio_bus_data->phy_mask; 459 new_bus->parent = priv->device; 460 461 err = of_mdiobus_register(new_bus, mdio_node); 462 if (err == -ENODEV) { 463 err = 0; 464 dev_info(dev, "MDIO bus is disabled\n"); 465 goto bus_register_fail; 466 } else if (err) { 467 dev_err_probe(dev, err, "Cannot register the MDIO bus\n"); 468 goto bus_register_fail; 469 } 470 471 /* Looks like we need a dummy read for XGMAC only and C45 PHYs */ 472 if (priv->plat->has_xgmac) 473 stmmac_xgmac2_mdio_read(new_bus, 0, MII_ADDR_C45); 474 475 if (priv->plat->phy_node || mdio_node) 476 goto bus_register_done; 477 478 found = 0; 479 for (addr = 0; addr < max_addr; addr++) { 480 struct phy_device *phydev = mdiobus_get_phy(new_bus, addr); 481 482 if (!phydev) 483 continue; 484 485 /* 486 * If an IRQ was provided to be assigned after 487 * the bus probe, do it here. 488 */ 489 if (!mdio_bus_data->irqs && 490 (mdio_bus_data->probed_phy_irq > 0)) { 491 new_bus->irq[addr] = mdio_bus_data->probed_phy_irq; 492 phydev->irq = mdio_bus_data->probed_phy_irq; 493 } 494 495 /* 496 * If we're going to bind the MAC to this PHY bus, 497 * and no PHY number was provided to the MAC, 498 * use the one probed here. 499 */ 500 if (priv->plat->phy_addr == -1) 501 priv->plat->phy_addr = addr; 502 503 phy_attached_info(phydev); 504 found = 1; 505 } 506 507 if (!found && !mdio_node) { 508 dev_warn(dev, "No PHY found\n"); 509 err = -ENODEV; 510 goto no_phy_found; 511 } 512 513 /* Try to probe the XPCS by scanning all addresses. */ 514 if (priv->hw->xpcs) { 515 struct mdio_xpcs_args *xpcs = &priv->hw->xpcs_args; 516 int ret, mode = priv->plat->phy_interface; 517 max_addr = PHY_MAX_ADDR; 518 519 xpcs->bus = new_bus; 520 521 found = 0; 522 for (addr = 0; addr < max_addr; addr++) { 523 xpcs->addr = addr; 524 525 ret = stmmac_xpcs_probe(priv, xpcs, mode); 526 if (!ret) { 527 found = 1; 528 break; 529 } 530 } 531 532 if (!found && !mdio_node) { 533 dev_warn(dev, "No XPCS found\n"); 534 err = -ENODEV; 535 goto no_xpcs_found; 536 } 537 } 538 539bus_register_done: 540 priv->mii = new_bus; 541 542 return 0; 543 544no_xpcs_found: 545no_phy_found: 546 mdiobus_unregister(new_bus); 547bus_register_fail: 548 mdiobus_free(new_bus); 549 return err; 550} 551 552/** 553 * stmmac_mdio_unregister 554 * @ndev: net device structure 555 * Description: it unregisters the MII bus 556 */ 557int stmmac_mdio_unregister(struct net_device *ndev) 558{ 559 struct stmmac_priv *priv = netdev_priv(ndev); 560 561 if (!priv->mii) 562 return 0; 563 564 mdiobus_unregister(priv->mii); 565 priv->mii->priv = NULL; 566 mdiobus_free(priv->mii); 567 priv->mii = NULL; 568 569 return 0; 570} 571