1 /* 2 * drivers/net/phy/phy_device.c 3 * 4 * Framework for finding and configuring PHYs. 5 * Also contains generic PHY driver 6 * 7 * Author: Andy Fleming 8 * 9 * Copyright (c) 2004 Freescale Semiconductor, Inc. 10 * 11 * This program is free software; you can redistribute it and/or modify it 12 * under the terms of the GNU General Public License as published by the 13 * Free Software Foundation; either version 2 of the License, or (at your 14 * option) any later version. 15 * 16 */ 17 #include <linux/kernel.h> 18 #include <linux/string.h> 19 #include <linux/errno.h> 20 #include <linux/unistd.h> 21 #include <linux/slab.h> 22 #include <linux/interrupt.h> 23 #include <linux/init.h> 24 #include <linux/delay.h> 25 #include <linux/netdevice.h> 26 #include <linux/etherdevice.h> 27 #include <linux/skbuff.h> 28 #include <linux/mm.h> 29 #include <linux/module.h> 30 #include <linux/mii.h> 31 #include <linux/ethtool.h> 32 #include <linux/phy.h> 33 34 #include <asm/io.h> 35 #include <asm/irq.h> 36 #include <asm/uaccess.h> 37 38 MODULE_DESCRIPTION("PHY library"); 39 MODULE_AUTHOR("Andy Fleming"); 40 MODULE_LICENSE("GPL"); 41 42 static struct phy_driver genphy_driver; 43 extern int mdio_bus_init(void); 44 extern void mdio_bus_exit(void); 45 46 void phy_device_free(struct phy_device *phydev) 47 { 48 kfree(phydev); 49 } 50 51 static void phy_device_release(struct device *dev) 52 { 53 phy_device_free(to_phy_device(dev)); 54 } 55 56 static LIST_HEAD(phy_fixup_list); 57 static DEFINE_MUTEX(phy_fixup_lock); 58 59 /* 60 * Creates a new phy_fixup and adds it to the list 61 * @bus_id: A string which matches phydev->dev.bus_id (or PHY_ANY_ID) 62 * @phy_uid: Used to match against phydev->phy_id (the UID of the PHY) 63 * It can also be PHY_ANY_UID 64 * @phy_uid_mask: Applied to phydev->phy_id and fixup->phy_uid before 65 * comparison 66 * @run: The actual code to be run when a matching PHY is found 67 */ 68 int phy_register_fixup(const char *bus_id, u32 phy_uid, u32 phy_uid_mask, 69 int (*run)(struct phy_device *)) 70 { 71 struct phy_fixup *fixup; 72 73 fixup = kzalloc(sizeof(struct phy_fixup), GFP_KERNEL); 74 if (!fixup) 75 return -ENOMEM; 76 77 strncpy(fixup->bus_id, bus_id, BUS_ID_SIZE); 78 fixup->phy_uid = phy_uid; 79 fixup->phy_uid_mask = phy_uid_mask; 80 fixup->run = run; 81 82 mutex_lock(&phy_fixup_lock); 83 list_add_tail(&fixup->list, &phy_fixup_list); 84 mutex_unlock(&phy_fixup_lock); 85 86 return 0; 87 } 88 EXPORT_SYMBOL(phy_register_fixup); 89 90 /* Registers a fixup to be run on any PHY with the UID in phy_uid */ 91 int phy_register_fixup_for_uid(u32 phy_uid, u32 phy_uid_mask, 92 int (*run)(struct phy_device *)) 93 { 94 return phy_register_fixup(PHY_ANY_ID, phy_uid, phy_uid_mask, run); 95 } 96 EXPORT_SYMBOL(phy_register_fixup_for_uid); 97 98 /* Registers a fixup to be run on the PHY with id string bus_id */ 99 int phy_register_fixup_for_id(const char *bus_id, 100 int (*run)(struct phy_device *)) 101 { 102 return phy_register_fixup(bus_id, PHY_ANY_UID, 0xffffffff, run); 103 } 104 EXPORT_SYMBOL(phy_register_fixup_for_id); 105 106 /* 107 * Returns 1 if fixup matches phydev in bus_id and phy_uid. 108 * Fixups can be set to match any in one or more fields. 109 */ 110 static int phy_needs_fixup(struct phy_device *phydev, struct phy_fixup *fixup) 111 { 112 if (strcmp(fixup->bus_id, phydev->dev.bus_id) != 0) 113 if (strcmp(fixup->bus_id, PHY_ANY_ID) != 0) 114 return 0; 115 116 if ((fixup->phy_uid & fixup->phy_uid_mask) != 117 (phydev->phy_id & fixup->phy_uid_mask)) 118 if (fixup->phy_uid != PHY_ANY_UID) 119 return 0; 120 121 return 1; 122 } 123 124 /* Runs any matching fixups for this phydev */ 125 int phy_scan_fixups(struct phy_device *phydev) 126 { 127 struct phy_fixup *fixup; 128 129 mutex_lock(&phy_fixup_lock); 130 list_for_each_entry(fixup, &phy_fixup_list, list) { 131 if (phy_needs_fixup(phydev, fixup)) { 132 int err; 133 134 err = fixup->run(phydev); 135 136 if (err < 0) 137 return err; 138 } 139 } 140 mutex_unlock(&phy_fixup_lock); 141 142 return 0; 143 } 144 EXPORT_SYMBOL(phy_scan_fixups); 145 146 struct phy_device* phy_device_create(struct mii_bus *bus, int addr, int phy_id) 147 { 148 struct phy_device *dev; 149 /* We allocate the device, and initialize the 150 * default values */ 151 dev = kzalloc(sizeof(*dev), GFP_KERNEL); 152 153 if (NULL == dev) 154 return (struct phy_device*) PTR_ERR((void*)-ENOMEM); 155 156 dev->dev.release = phy_device_release; 157 158 dev->speed = 0; 159 dev->duplex = -1; 160 dev->pause = dev->asym_pause = 0; 161 dev->link = 1; 162 dev->interface = PHY_INTERFACE_MODE_GMII; 163 164 dev->autoneg = AUTONEG_ENABLE; 165 166 dev->addr = addr; 167 dev->phy_id = phy_id; 168 dev->bus = bus; 169 170 dev->state = PHY_DOWN; 171 172 mutex_init(&dev->lock); 173 174 return dev; 175 } 176 EXPORT_SYMBOL(phy_device_create); 177 178 /** 179 * get_phy_id - reads the specified addr for its ID. 180 * @bus: the target MII bus 181 * @addr: PHY address on the MII bus 182 * @phy_id: where to store the ID retrieved. 183 * 184 * Description: Reads the ID registers of the PHY at @addr on the 185 * @bus, stores it in @phy_id and returns zero on success. 186 */ 187 int get_phy_id(struct mii_bus *bus, int addr, u32 *phy_id) 188 { 189 int phy_reg; 190 191 /* Grab the bits from PHYIR1, and put them 192 * in the upper half */ 193 phy_reg = bus->read(bus, addr, MII_PHYSID1); 194 195 if (phy_reg < 0) 196 return -EIO; 197 198 *phy_id = (phy_reg & 0xffff) << 16; 199 200 /* Grab the bits from PHYIR2, and put them in the lower half */ 201 phy_reg = bus->read(bus, addr, MII_PHYSID2); 202 203 if (phy_reg < 0) 204 return -EIO; 205 206 *phy_id |= (phy_reg & 0xffff); 207 208 return 0; 209 } 210 EXPORT_SYMBOL(get_phy_id); 211 212 /** 213 * get_phy_device - reads the specified PHY device and returns its @phy_device struct 214 * @bus: the target MII bus 215 * @addr: PHY address on the MII bus 216 * 217 * Description: Reads the ID registers of the PHY at @addr on the 218 * @bus, then allocates and returns the phy_device to represent it. 219 */ 220 struct phy_device * get_phy_device(struct mii_bus *bus, int addr) 221 { 222 struct phy_device *dev = NULL; 223 u32 phy_id; 224 int r; 225 226 r = get_phy_id(bus, addr, &phy_id); 227 if (r) 228 return ERR_PTR(r); 229 230 /* If the phy_id is all Fs, there is no device there */ 231 if (0xffffffff == phy_id) 232 return NULL; 233 234 dev = phy_device_create(bus, addr, phy_id); 235 236 return dev; 237 } 238 239 /** 240 * phy_prepare_link - prepares the PHY layer to monitor link status 241 * @phydev: target phy_device struct 242 * @handler: callback function for link status change notifications 243 * 244 * Description: Tells the PHY infrastructure to handle the 245 * gory details on monitoring link status (whether through 246 * polling or an interrupt), and to call back to the 247 * connected device driver when the link status changes. 248 * If you want to monitor your own link state, don't call 249 * this function. 250 */ 251 void phy_prepare_link(struct phy_device *phydev, 252 void (*handler)(struct net_device *)) 253 { 254 phydev->adjust_link = handler; 255 } 256 257 /** 258 * phy_connect - connect an ethernet device to a PHY device 259 * @dev: the network device to connect 260 * @bus_id: the id string of the PHY device to connect 261 * @handler: callback function for state change notifications 262 * @flags: PHY device's dev_flags 263 * @interface: PHY device's interface 264 * 265 * Description: Convenience function for connecting ethernet 266 * devices to PHY devices. The default behavior is for 267 * the PHY infrastructure to handle everything, and only notify 268 * the connected driver when the link status changes. If you 269 * don't want, or can't use the provided functionality, you may 270 * choose to call only the subset of functions which provide 271 * the desired functionality. 272 */ 273 struct phy_device * phy_connect(struct net_device *dev, const char *bus_id, 274 void (*handler)(struct net_device *), u32 flags, 275 phy_interface_t interface) 276 { 277 struct phy_device *phydev; 278 279 phydev = phy_attach(dev, bus_id, flags, interface); 280 281 if (IS_ERR(phydev)) 282 return phydev; 283 284 phy_prepare_link(phydev, handler); 285 286 phy_start_machine(phydev, NULL); 287 288 if (phydev->irq > 0) 289 phy_start_interrupts(phydev); 290 291 return phydev; 292 } 293 EXPORT_SYMBOL(phy_connect); 294 295 /** 296 * phy_disconnect - disable interrupts, stop state machine, and detach a PHY device 297 * @phydev: target phy_device struct 298 */ 299 void phy_disconnect(struct phy_device *phydev) 300 { 301 if (phydev->irq > 0) 302 phy_stop_interrupts(phydev); 303 304 phy_stop_machine(phydev); 305 306 phydev->adjust_link = NULL; 307 308 phy_detach(phydev); 309 } 310 EXPORT_SYMBOL(phy_disconnect); 311 312 static int phy_compare_id(struct device *dev, void *data) 313 { 314 return strcmp((char *)data, dev->bus_id) ? 0 : 1; 315 } 316 317 /** 318 * phy_attach - attach a network device to a particular PHY device 319 * @dev: network device to attach 320 * @bus_id: PHY device to attach 321 * @flags: PHY device's dev_flags 322 * @interface: PHY device's interface 323 * 324 * Description: Called by drivers to attach to a particular PHY 325 * device. The phy_device is found, and properly hooked up 326 * to the phy_driver. If no driver is attached, then the 327 * genphy_driver is used. The phy_device is given a ptr to 328 * the attaching device, and given a callback for link status 329 * change. The phy_device is returned to the attaching driver. 330 */ 331 struct phy_device *phy_attach(struct net_device *dev, 332 const char *bus_id, u32 flags, phy_interface_t interface) 333 { 334 struct bus_type *bus = &mdio_bus_type; 335 struct phy_device *phydev; 336 struct device *d; 337 338 /* Search the list of PHY devices on the mdio bus for the 339 * PHY with the requested name */ 340 d = bus_find_device(bus, NULL, (void *)bus_id, phy_compare_id); 341 342 if (d) { 343 phydev = to_phy_device(d); 344 } else { 345 printk(KERN_ERR "%s not found\n", bus_id); 346 return ERR_PTR(-ENODEV); 347 } 348 349 /* Assume that if there is no driver, that it doesn't 350 * exist, and we should use the genphy driver. */ 351 if (NULL == d->driver) { 352 int err; 353 d->driver = &genphy_driver.driver; 354 355 err = d->driver->probe(d); 356 if (err >= 0) 357 err = device_bind_driver(d); 358 359 if (err) 360 return ERR_PTR(err); 361 } 362 363 if (phydev->attached_dev) { 364 printk(KERN_ERR "%s: %s already attached\n", 365 dev->name, bus_id); 366 return ERR_PTR(-EBUSY); 367 } 368 369 phydev->attached_dev = dev; 370 371 phydev->dev_flags = flags; 372 373 phydev->interface = interface; 374 375 /* Do initial configuration here, now that 376 * we have certain key parameters 377 * (dev_flags and interface) */ 378 if (phydev->drv->config_init) { 379 int err; 380 381 err = phy_scan_fixups(phydev); 382 383 if (err < 0) 384 return ERR_PTR(err); 385 386 err = phydev->drv->config_init(phydev); 387 388 if (err < 0) 389 return ERR_PTR(err); 390 } 391 392 return phydev; 393 } 394 EXPORT_SYMBOL(phy_attach); 395 396 /** 397 * phy_detach - detach a PHY device from its network device 398 * @phydev: target phy_device struct 399 */ 400 void phy_detach(struct phy_device *phydev) 401 { 402 phydev->attached_dev = NULL; 403 404 /* If the device had no specific driver before (i.e. - it 405 * was using the generic driver), we unbind the device 406 * from the generic driver so that there's a chance a 407 * real driver could be loaded */ 408 if (phydev->dev.driver == &genphy_driver.driver) 409 device_release_driver(&phydev->dev); 410 } 411 EXPORT_SYMBOL(phy_detach); 412 413 414 /* Generic PHY support and helper functions */ 415 416 /** 417 * genphy_config_advert - sanitize and advertise auto-negotation parameters 418 * @phydev: target phy_device struct 419 * 420 * Description: Writes MII_ADVERTISE with the appropriate values, 421 * after sanitizing the values to make sure we only advertise 422 * what is supported. Returns < 0 on error, 0 if the PHY's advertisement 423 * hasn't changed, and > 0 if it has changed. 424 */ 425 int genphy_config_advert(struct phy_device *phydev) 426 { 427 u32 advertise; 428 int oldadv, adv; 429 int err, changed = 0; 430 431 /* Only allow advertising what 432 * this PHY supports */ 433 phydev->advertising &= phydev->supported; 434 advertise = phydev->advertising; 435 436 /* Setup standard advertisement */ 437 oldadv = adv = phy_read(phydev, MII_ADVERTISE); 438 439 if (adv < 0) 440 return adv; 441 442 adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4 | ADVERTISE_PAUSE_CAP | 443 ADVERTISE_PAUSE_ASYM); 444 if (advertise & ADVERTISED_10baseT_Half) 445 adv |= ADVERTISE_10HALF; 446 if (advertise & ADVERTISED_10baseT_Full) 447 adv |= ADVERTISE_10FULL; 448 if (advertise & ADVERTISED_100baseT_Half) 449 adv |= ADVERTISE_100HALF; 450 if (advertise & ADVERTISED_100baseT_Full) 451 adv |= ADVERTISE_100FULL; 452 if (advertise & ADVERTISED_Pause) 453 adv |= ADVERTISE_PAUSE_CAP; 454 if (advertise & ADVERTISED_Asym_Pause) 455 adv |= ADVERTISE_PAUSE_ASYM; 456 457 if (adv != oldadv) { 458 err = phy_write(phydev, MII_ADVERTISE, adv); 459 460 if (err < 0) 461 return err; 462 changed = 1; 463 } 464 465 /* Configure gigabit if it's supported */ 466 if (phydev->supported & (SUPPORTED_1000baseT_Half | 467 SUPPORTED_1000baseT_Full)) { 468 oldadv = adv = phy_read(phydev, MII_CTRL1000); 469 470 if (adv < 0) 471 return adv; 472 473 adv &= ~(ADVERTISE_1000FULL | ADVERTISE_1000HALF); 474 if (advertise & SUPPORTED_1000baseT_Half) 475 adv |= ADVERTISE_1000HALF; 476 if (advertise & SUPPORTED_1000baseT_Full) 477 adv |= ADVERTISE_1000FULL; 478 479 if (adv != oldadv) { 480 err = phy_write(phydev, MII_CTRL1000, adv); 481 482 if (err < 0) 483 return err; 484 changed = 1; 485 } 486 } 487 488 return changed; 489 } 490 EXPORT_SYMBOL(genphy_config_advert); 491 492 /** 493 * genphy_setup_forced - configures/forces speed/duplex from @phydev 494 * @phydev: target phy_device struct 495 * 496 * Description: Configures MII_BMCR to force speed/duplex 497 * to the values in phydev. Assumes that the values are valid. 498 * Please see phy_sanitize_settings(). 499 */ 500 int genphy_setup_forced(struct phy_device *phydev) 501 { 502 int err; 503 int ctl = 0; 504 505 phydev->pause = phydev->asym_pause = 0; 506 507 if (SPEED_1000 == phydev->speed) 508 ctl |= BMCR_SPEED1000; 509 else if (SPEED_100 == phydev->speed) 510 ctl |= BMCR_SPEED100; 511 512 if (DUPLEX_FULL == phydev->duplex) 513 ctl |= BMCR_FULLDPLX; 514 515 err = phy_write(phydev, MII_BMCR, ctl); 516 517 if (err < 0) 518 return err; 519 520 /* 521 * Run the fixups on this PHY, just in case the 522 * board code needs to change something after a reset 523 */ 524 err = phy_scan_fixups(phydev); 525 526 if (err < 0) 527 return err; 528 529 /* We just reset the device, so we'd better configure any 530 * settings the PHY requires to operate */ 531 if (phydev->drv->config_init) 532 err = phydev->drv->config_init(phydev); 533 534 return err; 535 } 536 537 538 /** 539 * genphy_restart_aneg - Enable and Restart Autonegotiation 540 * @phydev: target phy_device struct 541 */ 542 int genphy_restart_aneg(struct phy_device *phydev) 543 { 544 int ctl; 545 546 ctl = phy_read(phydev, MII_BMCR); 547 548 if (ctl < 0) 549 return ctl; 550 551 ctl |= (BMCR_ANENABLE | BMCR_ANRESTART); 552 553 /* Don't isolate the PHY if we're negotiating */ 554 ctl &= ~(BMCR_ISOLATE); 555 556 ctl = phy_write(phydev, MII_BMCR, ctl); 557 558 return ctl; 559 } 560 561 562 /** 563 * genphy_config_aneg - restart auto-negotiation or write BMCR 564 * @phydev: target phy_device struct 565 * 566 * Description: If auto-negotiation is enabled, we configure the 567 * advertising, and then restart auto-negotiation. If it is not 568 * enabled, then we write the BMCR. 569 */ 570 int genphy_config_aneg(struct phy_device *phydev) 571 { 572 int result = 0; 573 574 if (AUTONEG_ENABLE == phydev->autoneg) { 575 int result = genphy_config_advert(phydev); 576 577 if (result < 0) /* error */ 578 return result; 579 580 /* Only restart aneg if we are advertising something different 581 * than we were before. */ 582 if (result > 0) 583 result = genphy_restart_aneg(phydev); 584 } else 585 result = genphy_setup_forced(phydev); 586 587 return result; 588 } 589 EXPORT_SYMBOL(genphy_config_aneg); 590 591 /** 592 * genphy_update_link - update link status in @phydev 593 * @phydev: target phy_device struct 594 * 595 * Description: Update the value in phydev->link to reflect the 596 * current link value. In order to do this, we need to read 597 * the status register twice, keeping the second value. 598 */ 599 int genphy_update_link(struct phy_device *phydev) 600 { 601 int status; 602 603 /* Do a fake read */ 604 status = phy_read(phydev, MII_BMSR); 605 606 if (status < 0) 607 return status; 608 609 /* Read link and autonegotiation status */ 610 status = phy_read(phydev, MII_BMSR); 611 612 if (status < 0) 613 return status; 614 615 if ((status & BMSR_LSTATUS) == 0) 616 phydev->link = 0; 617 else 618 phydev->link = 1; 619 620 return 0; 621 } 622 EXPORT_SYMBOL(genphy_update_link); 623 624 /** 625 * genphy_read_status - check the link status and update current link state 626 * @phydev: target phy_device struct 627 * 628 * Description: Check the link, then figure out the current state 629 * by comparing what we advertise with what the link partner 630 * advertises. Start by checking the gigabit possibilities, 631 * then move on to 10/100. 632 */ 633 int genphy_read_status(struct phy_device *phydev) 634 { 635 int adv; 636 int err; 637 int lpa; 638 int lpagb = 0; 639 640 /* Update the link, but return if there 641 * was an error */ 642 err = genphy_update_link(phydev); 643 if (err) 644 return err; 645 646 if (AUTONEG_ENABLE == phydev->autoneg) { 647 if (phydev->supported & (SUPPORTED_1000baseT_Half 648 | SUPPORTED_1000baseT_Full)) { 649 lpagb = phy_read(phydev, MII_STAT1000); 650 651 if (lpagb < 0) 652 return lpagb; 653 654 adv = phy_read(phydev, MII_CTRL1000); 655 656 if (adv < 0) 657 return adv; 658 659 lpagb &= adv << 2; 660 } 661 662 lpa = phy_read(phydev, MII_LPA); 663 664 if (lpa < 0) 665 return lpa; 666 667 adv = phy_read(phydev, MII_ADVERTISE); 668 669 if (adv < 0) 670 return adv; 671 672 lpa &= adv; 673 674 phydev->speed = SPEED_10; 675 phydev->duplex = DUPLEX_HALF; 676 phydev->pause = phydev->asym_pause = 0; 677 678 if (lpagb & (LPA_1000FULL | LPA_1000HALF)) { 679 phydev->speed = SPEED_1000; 680 681 if (lpagb & LPA_1000FULL) 682 phydev->duplex = DUPLEX_FULL; 683 } else if (lpa & (LPA_100FULL | LPA_100HALF)) { 684 phydev->speed = SPEED_100; 685 686 if (lpa & LPA_100FULL) 687 phydev->duplex = DUPLEX_FULL; 688 } else 689 if (lpa & LPA_10FULL) 690 phydev->duplex = DUPLEX_FULL; 691 692 if (phydev->duplex == DUPLEX_FULL){ 693 phydev->pause = lpa & LPA_PAUSE_CAP ? 1 : 0; 694 phydev->asym_pause = lpa & LPA_PAUSE_ASYM ? 1 : 0; 695 } 696 } else { 697 int bmcr = phy_read(phydev, MII_BMCR); 698 if (bmcr < 0) 699 return bmcr; 700 701 if (bmcr & BMCR_FULLDPLX) 702 phydev->duplex = DUPLEX_FULL; 703 else 704 phydev->duplex = DUPLEX_HALF; 705 706 if (bmcr & BMCR_SPEED1000) 707 phydev->speed = SPEED_1000; 708 else if (bmcr & BMCR_SPEED100) 709 phydev->speed = SPEED_100; 710 else 711 phydev->speed = SPEED_10; 712 713 phydev->pause = phydev->asym_pause = 0; 714 } 715 716 return 0; 717 } 718 EXPORT_SYMBOL(genphy_read_status); 719 720 static int genphy_config_init(struct phy_device *phydev) 721 { 722 int val; 723 u32 features; 724 725 /* For now, I'll claim that the generic driver supports 726 * all possible port types */ 727 features = (SUPPORTED_TP | SUPPORTED_MII 728 | SUPPORTED_AUI | SUPPORTED_FIBRE | 729 SUPPORTED_BNC); 730 731 /* Do we support autonegotiation? */ 732 val = phy_read(phydev, MII_BMSR); 733 734 if (val < 0) 735 return val; 736 737 if (val & BMSR_ANEGCAPABLE) 738 features |= SUPPORTED_Autoneg; 739 740 if (val & BMSR_100FULL) 741 features |= SUPPORTED_100baseT_Full; 742 if (val & BMSR_100HALF) 743 features |= SUPPORTED_100baseT_Half; 744 if (val & BMSR_10FULL) 745 features |= SUPPORTED_10baseT_Full; 746 if (val & BMSR_10HALF) 747 features |= SUPPORTED_10baseT_Half; 748 749 if (val & BMSR_ESTATEN) { 750 val = phy_read(phydev, MII_ESTATUS); 751 752 if (val < 0) 753 return val; 754 755 if (val & ESTATUS_1000_TFULL) 756 features |= SUPPORTED_1000baseT_Full; 757 if (val & ESTATUS_1000_THALF) 758 features |= SUPPORTED_1000baseT_Half; 759 } 760 761 phydev->supported = features; 762 phydev->advertising = features; 763 764 return 0; 765 } 766 767 768 /** 769 * phy_probe - probe and init a PHY device 770 * @dev: device to probe and init 771 * 772 * Description: Take care of setting up the phy_device structure, 773 * set the state to READY (the driver's init function should 774 * set it to STARTING if needed). 775 */ 776 static int phy_probe(struct device *dev) 777 { 778 struct phy_device *phydev; 779 struct phy_driver *phydrv; 780 struct device_driver *drv; 781 int err = 0; 782 783 phydev = to_phy_device(dev); 784 785 /* Make sure the driver is held. 786 * XXX -- Is this correct? */ 787 drv = get_driver(phydev->dev.driver); 788 phydrv = to_phy_driver(drv); 789 phydev->drv = phydrv; 790 791 /* Disable the interrupt if the PHY doesn't support it */ 792 if (!(phydrv->flags & PHY_HAS_INTERRUPT)) 793 phydev->irq = PHY_POLL; 794 795 mutex_lock(&phydev->lock); 796 797 /* Start out supporting everything. Eventually, 798 * a controller will attach, and may modify one 799 * or both of these values */ 800 phydev->supported = phydrv->features; 801 phydev->advertising = phydrv->features; 802 803 /* Set the state to READY by default */ 804 phydev->state = PHY_READY; 805 806 if (phydev->drv->probe) 807 err = phydev->drv->probe(phydev); 808 809 mutex_unlock(&phydev->lock); 810 811 return err; 812 813 } 814 815 static int phy_remove(struct device *dev) 816 { 817 struct phy_device *phydev; 818 819 phydev = to_phy_device(dev); 820 821 mutex_lock(&phydev->lock); 822 phydev->state = PHY_DOWN; 823 mutex_unlock(&phydev->lock); 824 825 if (phydev->drv->remove) 826 phydev->drv->remove(phydev); 827 828 put_driver(dev->driver); 829 phydev->drv = NULL; 830 831 return 0; 832 } 833 834 /** 835 * phy_driver_register - register a phy_driver with the PHY layer 836 * @new_driver: new phy_driver to register 837 */ 838 int phy_driver_register(struct phy_driver *new_driver) 839 { 840 int retval; 841 842 memset(&new_driver->driver, 0, sizeof(new_driver->driver)); 843 new_driver->driver.name = new_driver->name; 844 new_driver->driver.bus = &mdio_bus_type; 845 new_driver->driver.probe = phy_probe; 846 new_driver->driver.remove = phy_remove; 847 848 retval = driver_register(&new_driver->driver); 849 850 if (retval) { 851 printk(KERN_ERR "%s: Error %d in registering driver\n", 852 new_driver->name, retval); 853 854 return retval; 855 } 856 857 pr_debug("%s: Registered new driver\n", new_driver->name); 858 859 return 0; 860 } 861 EXPORT_SYMBOL(phy_driver_register); 862 863 void phy_driver_unregister(struct phy_driver *drv) 864 { 865 driver_unregister(&drv->driver); 866 } 867 EXPORT_SYMBOL(phy_driver_unregister); 868 869 static struct phy_driver genphy_driver = { 870 .phy_id = 0xffffffff, 871 .phy_id_mask = 0xffffffff, 872 .name = "Generic PHY", 873 .config_init = genphy_config_init, 874 .features = 0, 875 .config_aneg = genphy_config_aneg, 876 .read_status = genphy_read_status, 877 .driver = {.owner= THIS_MODULE, }, 878 }; 879 880 static int __init phy_init(void) 881 { 882 int rc; 883 884 rc = mdio_bus_init(); 885 if (rc) 886 return rc; 887 888 rc = phy_driver_register(&genphy_driver); 889 if (rc) 890 mdio_bus_exit(); 891 892 return rc; 893 } 894 895 static void __exit phy_exit(void) 896 { 897 phy_driver_unregister(&genphy_driver); 898 mdio_bus_exit(); 899 } 900 901 subsys_initcall(phy_init); 902 module_exit(phy_exit); 903