drivers/net/phy/phy_device.c

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