1// SPDX-License-Identifier: GPL-2.0+ 2/* 3 * Core PHY library, taken from phy.c 4 */ 5#include <linux/export.h> 6#include <linux/phy.h> 7#include <linux/of.h> 8 9/** 10 * phy_speed_to_str - Return a string representing the PHY link speed 11 * 12 * @speed: Speed of the link 13 */ 14const char *phy_speed_to_str(int speed) 15{ 16 BUILD_BUG_ON_MSG(__ETHTOOL_LINK_MODE_MASK_NBITS != 92, 17 "Enum ethtool_link_mode_bit_indices and phylib are out of sync. " 18 "If a speed or mode has been added please update phy_speed_to_str " 19 "and the PHY settings array.\n"); 20 21 switch (speed) { 22 case SPEED_10: 23 return "10Mbps"; 24 case SPEED_100: 25 return "100Mbps"; 26 case SPEED_1000: 27 return "1Gbps"; 28 case SPEED_2500: 29 return "2.5Gbps"; 30 case SPEED_5000: 31 return "5Gbps"; 32 case SPEED_10000: 33 return "10Gbps"; 34 case SPEED_14000: 35 return "14Gbps"; 36 case SPEED_20000: 37 return "20Gbps"; 38 case SPEED_25000: 39 return "25Gbps"; 40 case SPEED_40000: 41 return "40Gbps"; 42 case SPEED_50000: 43 return "50Gbps"; 44 case SPEED_56000: 45 return "56Gbps"; 46 case SPEED_100000: 47 return "100Gbps"; 48 case SPEED_200000: 49 return "200Gbps"; 50 case SPEED_400000: 51 return "400Gbps"; 52 case SPEED_UNKNOWN: 53 return "Unknown"; 54 default: 55 return "Unsupported (update phy-core.c)"; 56 } 57} 58EXPORT_SYMBOL_GPL(phy_speed_to_str); 59 60/** 61 * phy_duplex_to_str - Return string describing the duplex 62 * 63 * @duplex: Duplex setting to describe 64 */ 65const char *phy_duplex_to_str(unsigned int duplex) 66{ 67 if (duplex == DUPLEX_HALF) 68 return "Half"; 69 if (duplex == DUPLEX_FULL) 70 return "Full"; 71 if (duplex == DUPLEX_UNKNOWN) 72 return "Unknown"; 73 return "Unsupported (update phy-core.c)"; 74} 75EXPORT_SYMBOL_GPL(phy_duplex_to_str); 76 77/* A mapping of all SUPPORTED settings to speed/duplex. This table 78 * must be grouped by speed and sorted in descending match priority 79 * - iow, descending speed. */ 80 81#define PHY_SETTING(s, d, b) { .speed = SPEED_ ## s, .duplex = DUPLEX_ ## d, \ 82 .bit = ETHTOOL_LINK_MODE_ ## b ## _BIT} 83 84static const struct phy_setting settings[] = { 85 /* 400G */ 86 PHY_SETTING( 400000, FULL, 400000baseCR8_Full ), 87 PHY_SETTING( 400000, FULL, 400000baseKR8_Full ), 88 PHY_SETTING( 400000, FULL, 400000baseLR8_ER8_FR8_Full ), 89 PHY_SETTING( 400000, FULL, 400000baseDR8_Full ), 90 PHY_SETTING( 400000, FULL, 400000baseSR8_Full ), 91 PHY_SETTING( 400000, FULL, 400000baseCR4_Full ), 92 PHY_SETTING( 400000, FULL, 400000baseKR4_Full ), 93 PHY_SETTING( 400000, FULL, 400000baseLR4_ER4_FR4_Full ), 94 PHY_SETTING( 400000, FULL, 400000baseDR4_Full ), 95 PHY_SETTING( 400000, FULL, 400000baseSR4_Full ), 96 /* 200G */ 97 PHY_SETTING( 200000, FULL, 200000baseCR4_Full ), 98 PHY_SETTING( 200000, FULL, 200000baseKR4_Full ), 99 PHY_SETTING( 200000, FULL, 200000baseLR4_ER4_FR4_Full ), 100 PHY_SETTING( 200000, FULL, 200000baseDR4_Full ), 101 PHY_SETTING( 200000, FULL, 200000baseSR4_Full ), 102 PHY_SETTING( 200000, FULL, 200000baseCR2_Full ), 103 PHY_SETTING( 200000, FULL, 200000baseKR2_Full ), 104 PHY_SETTING( 200000, FULL, 200000baseLR2_ER2_FR2_Full ), 105 PHY_SETTING( 200000, FULL, 200000baseDR2_Full ), 106 PHY_SETTING( 200000, FULL, 200000baseSR2_Full ), 107 /* 100G */ 108 PHY_SETTING( 100000, FULL, 100000baseCR4_Full ), 109 PHY_SETTING( 100000, FULL, 100000baseKR4_Full ), 110 PHY_SETTING( 100000, FULL, 100000baseLR4_ER4_Full ), 111 PHY_SETTING( 100000, FULL, 100000baseSR4_Full ), 112 PHY_SETTING( 100000, FULL, 100000baseCR2_Full ), 113 PHY_SETTING( 100000, FULL, 100000baseKR2_Full ), 114 PHY_SETTING( 100000, FULL, 100000baseLR2_ER2_FR2_Full ), 115 PHY_SETTING( 100000, FULL, 100000baseDR2_Full ), 116 PHY_SETTING( 100000, FULL, 100000baseSR2_Full ), 117 PHY_SETTING( 100000, FULL, 100000baseCR_Full ), 118 PHY_SETTING( 100000, FULL, 100000baseKR_Full ), 119 PHY_SETTING( 100000, FULL, 100000baseLR_ER_FR_Full ), 120 PHY_SETTING( 100000, FULL, 100000baseDR_Full ), 121 PHY_SETTING( 100000, FULL, 100000baseSR_Full ), 122 /* 56G */ 123 PHY_SETTING( 56000, FULL, 56000baseCR4_Full ), 124 PHY_SETTING( 56000, FULL, 56000baseKR4_Full ), 125 PHY_SETTING( 56000, FULL, 56000baseLR4_Full ), 126 PHY_SETTING( 56000, FULL, 56000baseSR4_Full ), 127 /* 50G */ 128 PHY_SETTING( 50000, FULL, 50000baseCR2_Full ), 129 PHY_SETTING( 50000, FULL, 50000baseKR2_Full ), 130 PHY_SETTING( 50000, FULL, 50000baseSR2_Full ), 131 PHY_SETTING( 50000, FULL, 50000baseCR_Full ), 132 PHY_SETTING( 50000, FULL, 50000baseKR_Full ), 133 PHY_SETTING( 50000, FULL, 50000baseLR_ER_FR_Full ), 134 PHY_SETTING( 50000, FULL, 50000baseDR_Full ), 135 PHY_SETTING( 50000, FULL, 50000baseSR_Full ), 136 /* 40G */ 137 PHY_SETTING( 40000, FULL, 40000baseCR4_Full ), 138 PHY_SETTING( 40000, FULL, 40000baseKR4_Full ), 139 PHY_SETTING( 40000, FULL, 40000baseLR4_Full ), 140 PHY_SETTING( 40000, FULL, 40000baseSR4_Full ), 141 /* 25G */ 142 PHY_SETTING( 25000, FULL, 25000baseCR_Full ), 143 PHY_SETTING( 25000, FULL, 25000baseKR_Full ), 144 PHY_SETTING( 25000, FULL, 25000baseSR_Full ), 145 /* 20G */ 146 PHY_SETTING( 20000, FULL, 20000baseKR2_Full ), 147 PHY_SETTING( 20000, FULL, 20000baseMLD2_Full ), 148 /* 10G */ 149 PHY_SETTING( 10000, FULL, 10000baseCR_Full ), 150 PHY_SETTING( 10000, FULL, 10000baseER_Full ), 151 PHY_SETTING( 10000, FULL, 10000baseKR_Full ), 152 PHY_SETTING( 10000, FULL, 10000baseKX4_Full ), 153 PHY_SETTING( 10000, FULL, 10000baseLR_Full ), 154 PHY_SETTING( 10000, FULL, 10000baseLRM_Full ), 155 PHY_SETTING( 10000, FULL, 10000baseR_FEC ), 156 PHY_SETTING( 10000, FULL, 10000baseSR_Full ), 157 PHY_SETTING( 10000, FULL, 10000baseT_Full ), 158 /* 5G */ 159 PHY_SETTING( 5000, FULL, 5000baseT_Full ), 160 /* 2.5G */ 161 PHY_SETTING( 2500, FULL, 2500baseT_Full ), 162 PHY_SETTING( 2500, FULL, 2500baseX_Full ), 163 /* 1G */ 164 PHY_SETTING( 1000, FULL, 1000baseT_Full ), 165 PHY_SETTING( 1000, HALF, 1000baseT_Half ), 166 PHY_SETTING( 1000, FULL, 1000baseT1_Full ), 167 PHY_SETTING( 1000, FULL, 1000baseX_Full ), 168 PHY_SETTING( 1000, FULL, 1000baseKX_Full ), 169 /* 100M */ 170 PHY_SETTING( 100, FULL, 100baseT_Full ), 171 PHY_SETTING( 100, FULL, 100baseT1_Full ), 172 PHY_SETTING( 100, HALF, 100baseT_Half ), 173 PHY_SETTING( 100, HALF, 100baseFX_Half ), 174 PHY_SETTING( 100, FULL, 100baseFX_Full ), 175 /* 10M */ 176 PHY_SETTING( 10, FULL, 10baseT_Full ), 177 PHY_SETTING( 10, HALF, 10baseT_Half ), 178}; 179#undef PHY_SETTING 180 181/** 182 * phy_lookup_setting - lookup a PHY setting 183 * @speed: speed to match 184 * @duplex: duplex to match 185 * @mask: allowed link modes 186 * @exact: an exact match is required 187 * 188 * Search the settings array for a setting that matches the speed and 189 * duplex, and which is supported. 190 * 191 * If @exact is unset, either an exact match or %NULL for no match will 192 * be returned. 193 * 194 * If @exact is set, an exact match, the fastest supported setting at 195 * or below the specified speed, the slowest supported setting, or if 196 * they all fail, %NULL will be returned. 197 */ 198const struct phy_setting * 199phy_lookup_setting(int speed, int duplex, const unsigned long *mask, bool exact) 200{ 201 const struct phy_setting *p, *match = NULL, *last = NULL; 202 int i; 203 204 for (i = 0, p = settings; i < ARRAY_SIZE(settings); i++, p++) { 205 if (p->bit < __ETHTOOL_LINK_MODE_MASK_NBITS && 206 test_bit(p->bit, mask)) { 207 last = p; 208 if (p->speed == speed && p->duplex == duplex) { 209 /* Exact match for speed and duplex */ 210 match = p; 211 break; 212 } else if (!exact) { 213 if (!match && p->speed <= speed) 214 /* Candidate */ 215 match = p; 216 217 if (p->speed < speed) 218 break; 219 } 220 } 221 } 222 223 if (!match && !exact) 224 match = last; 225 226 return match; 227} 228EXPORT_SYMBOL_GPL(phy_lookup_setting); 229 230size_t phy_speeds(unsigned int *speeds, size_t size, 231 unsigned long *mask) 232{ 233 size_t count; 234 int i; 235 236 for (i = 0, count = 0; i < ARRAY_SIZE(settings) && count < size; i++) 237 if (settings[i].bit < __ETHTOOL_LINK_MODE_MASK_NBITS && 238 test_bit(settings[i].bit, mask) && 239 (count == 0 || speeds[count - 1] != settings[i].speed)) 240 speeds[count++] = settings[i].speed; 241 242 return count; 243} 244 245static int __set_linkmode_max_speed(u32 max_speed, unsigned long *addr) 246{ 247 const struct phy_setting *p; 248 int i; 249 250 for (i = 0, p = settings; i < ARRAY_SIZE(settings); i++, p++) { 251 if (p->speed > max_speed) 252 linkmode_clear_bit(p->bit, addr); 253 else 254 break; 255 } 256 257 return 0; 258} 259 260static int __set_phy_supported(struct phy_device *phydev, u32 max_speed) 261{ 262 return __set_linkmode_max_speed(max_speed, phydev->supported); 263} 264 265/** 266 * phy_set_max_speed - Set the maximum speed the PHY should support 267 * 268 * @phydev: The phy_device struct 269 * @max_speed: Maximum speed 270 * 271 * The PHY might be more capable than the MAC. For example a Fast Ethernet 272 * is connected to a 1G PHY. This function allows the MAC to indicate its 273 * maximum speed, and so limit what the PHY will advertise. 274 */ 275int phy_set_max_speed(struct phy_device *phydev, u32 max_speed) 276{ 277 int err; 278 279 err = __set_phy_supported(phydev, max_speed); 280 if (err) 281 return err; 282 283 phy_advertise_supported(phydev); 284 285 return 0; 286} 287EXPORT_SYMBOL(phy_set_max_speed); 288 289void of_set_phy_supported(struct phy_device *phydev) 290{ 291 struct device_node *node = phydev->mdio.dev.of_node; 292 u32 max_speed; 293 294 if (!IS_ENABLED(CONFIG_OF_MDIO)) 295 return; 296 297 if (!node) 298 return; 299 300 if (!of_property_read_u32(node, "max-speed", &max_speed)) 301 __set_phy_supported(phydev, max_speed); 302} 303 304void of_set_phy_eee_broken(struct phy_device *phydev) 305{ 306 struct device_node *node = phydev->mdio.dev.of_node; 307 u32 broken = 0; 308 309 if (!IS_ENABLED(CONFIG_OF_MDIO)) 310 return; 311 312 if (!node) 313 return; 314 315 if (of_property_read_bool(node, "eee-broken-100tx")) 316 broken |= MDIO_EEE_100TX; 317 if (of_property_read_bool(node, "eee-broken-1000t")) 318 broken |= MDIO_EEE_1000T; 319 if (of_property_read_bool(node, "eee-broken-10gt")) 320 broken |= MDIO_EEE_10GT; 321 if (of_property_read_bool(node, "eee-broken-1000kx")) 322 broken |= MDIO_EEE_1000KX; 323 if (of_property_read_bool(node, "eee-broken-10gkx4")) 324 broken |= MDIO_EEE_10GKX4; 325 if (of_property_read_bool(node, "eee-broken-10gkr")) 326 broken |= MDIO_EEE_10GKR; 327 328 phydev->eee_broken_modes = broken; 329} 330 331/** 332 * phy_resolve_aneg_pause - Determine pause autoneg results 333 * 334 * @phydev: The phy_device struct 335 * 336 * Once autoneg has completed the local pause settings can be 337 * resolved. Determine if pause and asymmetric pause should be used 338 * by the MAC. 339 */ 340 341void phy_resolve_aneg_pause(struct phy_device *phydev) 342{ 343 if (phydev->duplex == DUPLEX_FULL) { 344 phydev->pause = linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT, 345 phydev->lp_advertising); 346 phydev->asym_pause = linkmode_test_bit( 347 ETHTOOL_LINK_MODE_Asym_Pause_BIT, 348 phydev->lp_advertising); 349 } 350} 351EXPORT_SYMBOL_GPL(phy_resolve_aneg_pause); 352 353/** 354 * phy_resolve_aneg_linkmode - resolve the advertisements into PHY settings 355 * @phydev: The phy_device struct 356 * 357 * Resolve our and the link partner advertisements into their corresponding 358 * speed and duplex. If full duplex was negotiated, extract the pause mode 359 * from the link partner mask. 360 */ 361void phy_resolve_aneg_linkmode(struct phy_device *phydev) 362{ 363 __ETHTOOL_DECLARE_LINK_MODE_MASK(common); 364 int i; 365 366 linkmode_and(common, phydev->lp_advertising, phydev->advertising); 367 368 for (i = 0; i < ARRAY_SIZE(settings); i++) 369 if (test_bit(settings[i].bit, common)) { 370 phydev->speed = settings[i].speed; 371 phydev->duplex = settings[i].duplex; 372 break; 373 } 374 375 phy_resolve_aneg_pause(phydev); 376} 377EXPORT_SYMBOL_GPL(phy_resolve_aneg_linkmode); 378 379/** 380 * phy_check_downshift - check whether downshift occurred 381 * @phydev: The phy_device struct 382 * 383 * Check whether a downshift to a lower speed occurred. If this should be the 384 * case warn the user. 385 * Prerequisite for detecting downshift is that PHY driver implements the 386 * read_status callback and sets phydev->speed to the actual link speed. 387 */ 388void phy_check_downshift(struct phy_device *phydev) 389{ 390 __ETHTOOL_DECLARE_LINK_MODE_MASK(common); 391 int i, speed = SPEED_UNKNOWN; 392 393 phydev->downshifted_rate = 0; 394 395 if (phydev->autoneg == AUTONEG_DISABLE || 396 phydev->speed == SPEED_UNKNOWN) 397 return; 398 399 linkmode_and(common, phydev->lp_advertising, phydev->advertising); 400 401 for (i = 0; i < ARRAY_SIZE(settings); i++) 402 if (test_bit(settings[i].bit, common)) { 403 speed = settings[i].speed; 404 break; 405 } 406 407 if (speed == SPEED_UNKNOWN || phydev->speed >= speed) 408 return; 409 410 phydev_warn(phydev, "Downshift occurred from negotiated speed %s to actual speed %s, check cabling!\n", 411 phy_speed_to_str(speed), phy_speed_to_str(phydev->speed)); 412 413 phydev->downshifted_rate = 1; 414} 415EXPORT_SYMBOL_GPL(phy_check_downshift); 416 417static int phy_resolve_min_speed(struct phy_device *phydev, bool fdx_only) 418{ 419 __ETHTOOL_DECLARE_LINK_MODE_MASK(common); 420 int i = ARRAY_SIZE(settings); 421 422 linkmode_and(common, phydev->lp_advertising, phydev->advertising); 423 424 while (--i >= 0) { 425 if (test_bit(settings[i].bit, common)) { 426 if (fdx_only && settings[i].duplex != DUPLEX_FULL) 427 continue; 428 return settings[i].speed; 429 } 430 } 431 432 return SPEED_UNKNOWN; 433} 434 435int phy_speed_down_core(struct phy_device *phydev) 436{ 437 int min_common_speed = phy_resolve_min_speed(phydev, true); 438 439 if (min_common_speed == SPEED_UNKNOWN) 440 return -EINVAL; 441 442 return __set_linkmode_max_speed(min_common_speed, phydev->advertising); 443} 444 445static void mmd_phy_indirect(struct mii_bus *bus, int phy_addr, int devad, 446 u16 regnum) 447{ 448 /* Write the desired MMD Devad */ 449 __mdiobus_write(bus, phy_addr, MII_MMD_CTRL, devad); 450 451 /* Write the desired MMD register address */ 452 __mdiobus_write(bus, phy_addr, MII_MMD_DATA, regnum); 453 454 /* Select the Function : DATA with no post increment */ 455 __mdiobus_write(bus, phy_addr, MII_MMD_CTRL, 456 devad | MII_MMD_CTRL_NOINCR); 457} 458 459/** 460 * __phy_read_mmd - Convenience function for reading a register 461 * from an MMD on a given PHY. 462 * @phydev: The phy_device struct 463 * @devad: The MMD to read from (0..31) 464 * @regnum: The register on the MMD to read (0..65535) 465 * 466 * Same rules as for __phy_read(); 467 */ 468int __phy_read_mmd(struct phy_device *phydev, int devad, u32 regnum) 469{ 470 int val; 471 472 if (regnum > (u16)~0 || devad > 32) 473 return -EINVAL; 474 475 if (phydev->drv && phydev->drv->read_mmd) { 476 val = phydev->drv->read_mmd(phydev, devad, regnum); 477 } else if (phydev->is_c45) { 478 val = __mdiobus_c45_read(phydev->mdio.bus, phydev->mdio.addr, 479 devad, regnum); 480 } else { 481 struct mii_bus *bus = phydev->mdio.bus; 482 int phy_addr = phydev->mdio.addr; 483 484 mmd_phy_indirect(bus, phy_addr, devad, regnum); 485 486 /* Read the content of the MMD's selected register */ 487 val = __mdiobus_read(bus, phy_addr, MII_MMD_DATA); 488 } 489 return val; 490} 491EXPORT_SYMBOL(__phy_read_mmd); 492 493/** 494 * phy_read_mmd - Convenience function for reading a register 495 * from an MMD on a given PHY. 496 * @phydev: The phy_device struct 497 * @devad: The MMD to read from 498 * @regnum: The register on the MMD to read 499 * 500 * Same rules as for phy_read(); 501 */ 502int phy_read_mmd(struct phy_device *phydev, int devad, u32 regnum) 503{ 504 int ret; 505 506 phy_lock_mdio_bus(phydev); 507 ret = __phy_read_mmd(phydev, devad, regnum); 508 phy_unlock_mdio_bus(phydev); 509 510 return ret; 511} 512EXPORT_SYMBOL(phy_read_mmd); 513 514/** 515 * __phy_write_mmd - Convenience function for writing a register 516 * on an MMD on a given PHY. 517 * @phydev: The phy_device struct 518 * @devad: The MMD to read from 519 * @regnum: The register on the MMD to read 520 * @val: value to write to @regnum 521 * 522 * Same rules as for __phy_write(); 523 */ 524int __phy_write_mmd(struct phy_device *phydev, int devad, u32 regnum, u16 val) 525{ 526 int ret; 527 528 if (regnum > (u16)~0 || devad > 32) 529 return -EINVAL; 530 531 if (phydev->drv && phydev->drv->write_mmd) { 532 ret = phydev->drv->write_mmd(phydev, devad, regnum, val); 533 } else if (phydev->is_c45) { 534 ret = __mdiobus_c45_write(phydev->mdio.bus, phydev->mdio.addr, 535 devad, regnum, val); 536 } else { 537 struct mii_bus *bus = phydev->mdio.bus; 538 int phy_addr = phydev->mdio.addr; 539 540 mmd_phy_indirect(bus, phy_addr, devad, regnum); 541 542 /* Write the data into MMD's selected register */ 543 __mdiobus_write(bus, phy_addr, MII_MMD_DATA, val); 544 545 ret = 0; 546 } 547 return ret; 548} 549EXPORT_SYMBOL(__phy_write_mmd); 550 551/** 552 * phy_write_mmd - Convenience function for writing a register 553 * on an MMD on a given PHY. 554 * @phydev: The phy_device struct 555 * @devad: The MMD to read from 556 * @regnum: The register on the MMD to read 557 * @val: value to write to @regnum 558 * 559 * Same rules as for phy_write(); 560 */ 561int phy_write_mmd(struct phy_device *phydev, int devad, u32 regnum, u16 val) 562{ 563 int ret; 564 565 phy_lock_mdio_bus(phydev); 566 ret = __phy_write_mmd(phydev, devad, regnum, val); 567 phy_unlock_mdio_bus(phydev); 568 569 return ret; 570} 571EXPORT_SYMBOL(phy_write_mmd); 572 573/** 574 * phy_modify_changed - Function for modifying a PHY register 575 * @phydev: the phy_device struct 576 * @regnum: register number to modify 577 * @mask: bit mask of bits to clear 578 * @set: new value of bits set in mask to write to @regnum 579 * 580 * NOTE: MUST NOT be called from interrupt context, 581 * because the bus read/write functions may wait for an interrupt 582 * to conclude the operation. 583 * 584 * Returns negative errno, 0 if there was no change, and 1 in case of change 585 */ 586int phy_modify_changed(struct phy_device *phydev, u32 regnum, u16 mask, u16 set) 587{ 588 int ret; 589 590 phy_lock_mdio_bus(phydev); 591 ret = __phy_modify_changed(phydev, regnum, mask, set); 592 phy_unlock_mdio_bus(phydev); 593 594 return ret; 595} 596EXPORT_SYMBOL_GPL(phy_modify_changed); 597 598/** 599 * __phy_modify - Convenience function for modifying a PHY register 600 * @phydev: the phy_device struct 601 * @regnum: register number to modify 602 * @mask: bit mask of bits to clear 603 * @set: new value of bits set in mask to write to @regnum 604 * 605 * NOTE: MUST NOT be called from interrupt context, 606 * because the bus read/write functions may wait for an interrupt 607 * to conclude the operation. 608 */ 609int __phy_modify(struct phy_device *phydev, u32 regnum, u16 mask, u16 set) 610{ 611 int ret; 612 613 ret = __phy_modify_changed(phydev, regnum, mask, set); 614 615 return ret < 0 ? ret : 0; 616} 617EXPORT_SYMBOL_GPL(__phy_modify); 618 619/** 620 * phy_modify - Convenience function for modifying a given PHY register 621 * @phydev: the phy_device struct 622 * @regnum: register number to write 623 * @mask: bit mask of bits to clear 624 * @set: new value of bits set in mask to write to @regnum 625 * 626 * NOTE: MUST NOT be called from interrupt context, 627 * because the bus read/write functions may wait for an interrupt 628 * to conclude the operation. 629 */ 630int phy_modify(struct phy_device *phydev, u32 regnum, u16 mask, u16 set) 631{ 632 int ret; 633 634 phy_lock_mdio_bus(phydev); 635 ret = __phy_modify(phydev, regnum, mask, set); 636 phy_unlock_mdio_bus(phydev); 637 638 return ret; 639} 640EXPORT_SYMBOL_GPL(phy_modify); 641 642/** 643 * __phy_modify_mmd_changed - Function for modifying a register on MMD 644 * @phydev: the phy_device struct 645 * @devad: the MMD containing register to modify 646 * @regnum: register number to modify 647 * @mask: bit mask of bits to clear 648 * @set: new value of bits set in mask to write to @regnum 649 * 650 * Unlocked helper function which allows a MMD register to be modified as 651 * new register value = (old register value & ~mask) | set 652 * 653 * Returns negative errno, 0 if there was no change, and 1 in case of change 654 */ 655int __phy_modify_mmd_changed(struct phy_device *phydev, int devad, u32 regnum, 656 u16 mask, u16 set) 657{ 658 int new, ret; 659 660 ret = __phy_read_mmd(phydev, devad, regnum); 661 if (ret < 0) 662 return ret; 663 664 new = (ret & ~mask) | set; 665 if (new == ret) 666 return 0; 667 668 ret = __phy_write_mmd(phydev, devad, regnum, new); 669 670 return ret < 0 ? ret : 1; 671} 672EXPORT_SYMBOL_GPL(__phy_modify_mmd_changed); 673 674/** 675 * phy_modify_mmd_changed - Function for modifying a register on MMD 676 * @phydev: the phy_device struct 677 * @devad: the MMD containing register to modify 678 * @regnum: register number to modify 679 * @mask: bit mask of bits to clear 680 * @set: new value of bits set in mask to write to @regnum 681 * 682 * NOTE: MUST NOT be called from interrupt context, 683 * because the bus read/write functions may wait for an interrupt 684 * to conclude the operation. 685 * 686 * Returns negative errno, 0 if there was no change, and 1 in case of change 687 */ 688int phy_modify_mmd_changed(struct phy_device *phydev, int devad, u32 regnum, 689 u16 mask, u16 set) 690{ 691 int ret; 692 693 phy_lock_mdio_bus(phydev); 694 ret = __phy_modify_mmd_changed(phydev, devad, regnum, mask, set); 695 phy_unlock_mdio_bus(phydev); 696 697 return ret; 698} 699EXPORT_SYMBOL_GPL(phy_modify_mmd_changed); 700 701/** 702 * __phy_modify_mmd - Convenience function for modifying a register on MMD 703 * @phydev: the phy_device struct 704 * @devad: the MMD containing register to modify 705 * @regnum: register number to modify 706 * @mask: bit mask of bits to clear 707 * @set: new value of bits set in mask to write to @regnum 708 * 709 * NOTE: MUST NOT be called from interrupt context, 710 * because the bus read/write functions may wait for an interrupt 711 * to conclude the operation. 712 */ 713int __phy_modify_mmd(struct phy_device *phydev, int devad, u32 regnum, 714 u16 mask, u16 set) 715{ 716 int ret; 717 718 ret = __phy_modify_mmd_changed(phydev, devad, regnum, mask, set); 719 720 return ret < 0 ? ret : 0; 721} 722EXPORT_SYMBOL_GPL(__phy_modify_mmd); 723 724/** 725 * phy_modify_mmd - Convenience function for modifying a register on MMD 726 * @phydev: the phy_device struct 727 * @devad: the MMD containing register to modify 728 * @regnum: register number to modify 729 * @mask: bit mask of bits to clear 730 * @set: new value of bits set in mask to write to @regnum 731 * 732 * NOTE: MUST NOT be called from interrupt context, 733 * because the bus read/write functions may wait for an interrupt 734 * to conclude the operation. 735 */ 736int phy_modify_mmd(struct phy_device *phydev, int devad, u32 regnum, 737 u16 mask, u16 set) 738{ 739 int ret; 740 741 phy_lock_mdio_bus(phydev); 742 ret = __phy_modify_mmd(phydev, devad, regnum, mask, set); 743 phy_unlock_mdio_bus(phydev); 744 745 return ret; 746} 747EXPORT_SYMBOL_GPL(phy_modify_mmd); 748 749static int __phy_read_page(struct phy_device *phydev) 750{ 751 if (WARN_ONCE(!phydev->drv->read_page, "read_page callback not available, PHY driver not loaded?\n")) 752 return -EOPNOTSUPP; 753 754 return phydev->drv->read_page(phydev); 755} 756 757static int __phy_write_page(struct phy_device *phydev, int page) 758{ 759 if (WARN_ONCE(!phydev->drv->write_page, "write_page callback not available, PHY driver not loaded?\n")) 760 return -EOPNOTSUPP; 761 762 return phydev->drv->write_page(phydev, page); 763} 764 765/** 766 * phy_save_page() - take the bus lock and save the current page 767 * @phydev: a pointer to a &struct phy_device 768 * 769 * Take the MDIO bus lock, and return the current page number. On error, 770 * returns a negative errno. phy_restore_page() must always be called 771 * after this, irrespective of success or failure of this call. 772 */ 773int phy_save_page(struct phy_device *phydev) 774{ 775 phy_lock_mdio_bus(phydev); 776 return __phy_read_page(phydev); 777} 778EXPORT_SYMBOL_GPL(phy_save_page); 779 780/** 781 * phy_select_page() - take the bus lock, save the current page, and set a page 782 * @phydev: a pointer to a &struct phy_device 783 * @page: desired page 784 * 785 * Take the MDIO bus lock to protect against concurrent access, save the 786 * current PHY page, and set the current page. On error, returns a 787 * negative errno, otherwise returns the previous page number. 788 * phy_restore_page() must always be called after this, irrespective 789 * of success or failure of this call. 790 */ 791int phy_select_page(struct phy_device *phydev, int page) 792{ 793 int ret, oldpage; 794 795 oldpage = ret = phy_save_page(phydev); 796 if (ret < 0) 797 return ret; 798 799 if (oldpage != page) { 800 ret = __phy_write_page(phydev, page); 801 if (ret < 0) 802 return ret; 803 } 804 805 return oldpage; 806} 807EXPORT_SYMBOL_GPL(phy_select_page); 808 809/** 810 * phy_restore_page() - restore the page register and release the bus lock 811 * @phydev: a pointer to a &struct phy_device 812 * @oldpage: the old page, return value from phy_save_page() or phy_select_page() 813 * @ret: operation's return code 814 * 815 * Release the MDIO bus lock, restoring @oldpage if it is a valid page. 816 * This function propagates the earliest error code from the group of 817 * operations. 818 * 819 * Returns: 820 * @oldpage if it was a negative value, otherwise 821 * @ret if it was a negative errno value, otherwise 822 * phy_write_page()'s negative value if it were in error, otherwise 823 * @ret. 824 */ 825int phy_restore_page(struct phy_device *phydev, int oldpage, int ret) 826{ 827 int r; 828 829 if (oldpage >= 0) { 830 r = __phy_write_page(phydev, oldpage); 831 832 /* Propagate the operation return code if the page write 833 * was successful. 834 */ 835 if (ret >= 0 && r < 0) 836 ret = r; 837 } else { 838 /* Propagate the phy page selection error code */ 839 ret = oldpage; 840 } 841 842 phy_unlock_mdio_bus(phydev); 843 844 return ret; 845} 846EXPORT_SYMBOL_GPL(phy_restore_page); 847 848/** 849 * phy_read_paged() - Convenience function for reading a paged register 850 * @phydev: a pointer to a &struct phy_device 851 * @page: the page for the phy 852 * @regnum: register number 853 * 854 * Same rules as for phy_read(). 855 */ 856int phy_read_paged(struct phy_device *phydev, int page, u32 regnum) 857{ 858 int ret = 0, oldpage; 859 860 oldpage = phy_select_page(phydev, page); 861 if (oldpage >= 0) 862 ret = __phy_read(phydev, regnum); 863 864 return phy_restore_page(phydev, oldpage, ret); 865} 866EXPORT_SYMBOL(phy_read_paged); 867 868/** 869 * phy_write_paged() - Convenience function for writing a paged register 870 * @phydev: a pointer to a &struct phy_device 871 * @page: the page for the phy 872 * @regnum: register number 873 * @val: value to write 874 * 875 * Same rules as for phy_write(). 876 */ 877int phy_write_paged(struct phy_device *phydev, int page, u32 regnum, u16 val) 878{ 879 int ret = 0, oldpage; 880 881 oldpage = phy_select_page(phydev, page); 882 if (oldpage >= 0) 883 ret = __phy_write(phydev, regnum, val); 884 885 return phy_restore_page(phydev, oldpage, ret); 886} 887EXPORT_SYMBOL(phy_write_paged); 888 889/** 890 * phy_modify_paged_changed() - Function for modifying a paged register 891 * @phydev: a pointer to a &struct phy_device 892 * @page: the page for the phy 893 * @regnum: register number 894 * @mask: bit mask of bits to clear 895 * @set: bit mask of bits to set 896 * 897 * Returns negative errno, 0 if there was no change, and 1 in case of change 898 */ 899int phy_modify_paged_changed(struct phy_device *phydev, int page, u32 regnum, 900 u16 mask, u16 set) 901{ 902 int ret = 0, oldpage; 903 904 oldpage = phy_select_page(phydev, page); 905 if (oldpage >= 0) 906 ret = __phy_modify_changed(phydev, regnum, mask, set); 907 908 return phy_restore_page(phydev, oldpage, ret); 909} 910EXPORT_SYMBOL(phy_modify_paged_changed); 911 912/** 913 * phy_modify_paged() - Convenience function for modifying a paged register 914 * @phydev: a pointer to a &struct phy_device 915 * @page: the page for the phy 916 * @regnum: register number 917 * @mask: bit mask of bits to clear 918 * @set: bit mask of bits to set 919 * 920 * Same rules as for phy_read() and phy_write(). 921 */ 922int phy_modify_paged(struct phy_device *phydev, int page, u32 regnum, 923 u16 mask, u16 set) 924{ 925 int ret = phy_modify_paged_changed(phydev, page, regnum, mask, set); 926 927 return ret < 0 ? ret : 0; 928} 929EXPORT_SYMBOL(phy_modify_paged); 930