1 files changed, 126 insertions, 37 deletions

diff --git a/drivers/net/phy/phy_device.c b/drivers/net/phy/phy_device.c
index 0a06e4fd37d9..a2ece89622d6 100644
--- a/drivers/net/phy/phy_device.c
+++ b/drivers/net/phy/phy_device.c
@@ -39,20 +39,21 @@ MODULE_DESCRIPTION("PHY library");
 MODULE_AUTHOR("Andy Fleming");
 MODULE_LICENSE("GPL");
 
-static struct phy_driver genphy_driver;
-extern int mdio_bus_init(void);
-extern void mdio_bus_exit(void);
-
 void phy_device_free(struct phy_device *phydev)
 {
         kfree(phydev);
 }
+EXPORT_SYMBOL(phy_device_free);
 
 static void phy_device_release(struct device *dev)
 {
         phy_device_free(to_phy_device(dev));
 }
 
+static struct phy_driver genphy_driver;
+extern int mdio_bus_init(void);
+extern void mdio_bus_exit(void);
+
 static LIST_HEAD(phy_fixup_list);
 static DEFINE_MUTEX(phy_fixup_lock);
 
@@ -166,6 +167,10 @@ struct phy_device* phy_device_create(struct mii_bus *bus, int addr, int phy_id)
         dev->addr = addr;
         dev->phy_id = phy_id;
         dev->bus = bus;
+        dev->dev.parent = bus->parent;
+        dev->dev.bus = &mdio_bus_type;
+        dev->irq = bus->irq != NULL ? bus->irq[addr] : PHY_POLL;
+        dev_set_name(&dev->dev, PHY_ID_FMT, bus->id, addr);
 
         dev->state = PHY_DOWN;
 
@@ -235,6 +240,38 @@ struct phy_device * get_phy_device(struct mii_bus *bus, int addr)
 
         return dev;
 }
+EXPORT_SYMBOL(get_phy_device);
+
+/**
+ * phy_device_register - Register the phy device on the MDIO bus
+ * @phy_device: phy_device structure to be added to the MDIO bus
+ */
+int phy_device_register(struct phy_device *phydev)
+{
+        int err;
+
+        /* Don't register a phy if one is already registered at this
+         * address */
+        if (phydev->bus->phy_map[phydev->addr])
+                return -EINVAL;
+        phydev->bus->phy_map[phydev->addr] = phydev;
+
+        /* Run all of the fixups for this PHY */
+        phy_scan_fixups(phydev);
+
+        err = device_register(&phydev->dev);
+        if (err) {
+                pr_err("phy %d failed to register\n", phydev->addr);
+                goto out;
+        }
+
+        return 0;
+
+ out:
+        phydev->bus->phy_map[phydev->addr] = NULL;
+        return err;
+}
+EXPORT_SYMBOL(phy_device_register);
 
 /**
  * phy_prepare_link - prepares the PHY layer to monitor link status
@@ -255,6 +292,33 @@ void phy_prepare_link(struct phy_device *phydev,
 }
 
 /**
+ * phy_connect_direct - connect an ethernet device to a specific phy_device
+ * @dev: the network device to connect
+ * @phydev: the pointer to the phy device
+ * @handler: callback function for state change notifications
+ * @flags: PHY device's dev_flags
+ * @interface: PHY device's interface
+ */
+int phy_connect_direct(struct net_device *dev, struct phy_device *phydev,
+                       void (*handler)(struct net_device *), u32 flags,
+                       phy_interface_t interface)
+{
+        int rc;
+
+        rc = phy_attach_direct(dev, phydev, flags, interface);
+        if (rc)
+                return rc;
+
+        phy_prepare_link(phydev, handler);
+        phy_start_machine(phydev, NULL);
+        if (phydev->irq > 0)
+                phy_start_interrupts(phydev);
+
+        return 0;
+}
+EXPORT_SYMBOL(phy_connect_direct);
+
+/**
  * phy_connect - connect an ethernet device to a PHY device
  * @dev: the network device to connect
  * @bus_id: the id string of the PHY device to connect
@@ -275,18 +339,21 @@ struct phy_device * phy_connect(struct net_device *dev, const char *bus_id,
                 phy_interface_t interface)
 {
         struct phy_device *phydev;
+        struct device *d;
+        int rc;
 
-        phydev = phy_attach(dev, bus_id, flags, interface);
-
-        if (IS_ERR(phydev))
-                return phydev;
-
-        phy_prepare_link(phydev, handler);
-
-        phy_start_machine(phydev, NULL);
+        /* Search the list of PHY devices on the mdio bus for the
+         * PHY with the requested name */
+        d = bus_find_device_by_name(&mdio_bus_type, NULL, bus_id);
+        if (!d) {
+                pr_err("PHY %s not found\n", bus_id);
+                return ERR_PTR(-ENODEV);
+        }
+        phydev = to_phy_device(d);
 
-        if (phydev->irq > 0)
-                phy_start_interrupts(phydev);
+        rc = phy_connect_direct(dev, phydev, handler, flags, interface);
+        if (rc)
+                return ERR_PTR(rc);
 
         return phydev;
 }
@@ -310,9 +377,9 @@ void phy_disconnect(struct phy_device *phydev)
 EXPORT_SYMBOL(phy_disconnect);
 
 /**
- * phy_attach - attach a network device to a particular PHY device
+ * phy_attach_direct - attach a network device to a given PHY device pointer
  * @dev: network device to attach
- * @bus_id: PHY device to attach
+ * @phydev: Pointer to phy_device to attach
  * @flags: PHY device's dev_flags
  * @interface: PHY device's interface
  *
@@ -323,22 +390,10 @@ EXPORT_SYMBOL(phy_disconnect);
  *     the attaching device, and given a callback for link status
  *     change.  The phy_device is returned to the attaching driver.
  */
-struct phy_device *phy_attach(struct net_device *dev,
-                const char *bus_id, u32 flags, phy_interface_t interface)
+int phy_attach_direct(struct net_device *dev, struct phy_device *phydev,
+                      u32 flags, phy_interface_t interface)
 {
-        struct bus_type *bus = &mdio_bus_type;
-        struct phy_device *phydev;
-        struct device *d;
-
-        /* Search the list of PHY devices on the mdio bus for the
-         * PHY with the requested name */
-        d = bus_find_device_by_name(bus, NULL, bus_id);
-        if (d) {
-                phydev = to_phy_device(d);
-        } else {
-                printk(KERN_ERR "%s not found\n", bus_id);
-                return ERR_PTR(-ENODEV);
-        }
+        struct device *d = &phydev->dev;
 
         /* Assume that if there is no driver, that it doesn't
          * exist, and we should use the genphy driver. */
@@ -351,13 +406,12 @@ struct phy_device *phy_attach(struct net_device *dev,
                         err = device_bind_driver(d);
 
                 if (err)
-                        return ERR_PTR(err);
+                        return err;
         }
 
         if (phydev->attached_dev) {
-                printk(KERN_ERR "%s: %s already attached\n",
-                                dev->name, bus_id);
-                return ERR_PTR(-EBUSY);
+                dev_err(&dev->dev, "PHY already attached\n");
+                return -EBUSY;
         }
 
         phydev->attached_dev = dev;
@@ -375,14 +429,49 @@ struct phy_device *phy_attach(struct net_device *dev,
                 err = phy_scan_fixups(phydev);
 
                 if (err < 0)
-                        return ERR_PTR(err);
+                        return err;
 
                 err = phydev->drv->config_init(phydev);
 
                 if (err < 0)
-                        return ERR_PTR(err);
+                        return err;
         }
 
+        return 0;
+}
+EXPORT_SYMBOL(phy_attach_direct);
+
+/**
+ * phy_attach - attach a network device to a particular PHY device
+ * @dev: network device to attach
+ * @bus_id: Bus ID of PHY device to attach
+ * @flags: PHY device's dev_flags
+ * @interface: PHY device's interface
+ *
+ * Description: Same as phy_attach_direct() except that a PHY bus_id
+ *     string is passed instead of a pointer to a struct phy_device.
+ */
+struct phy_device *phy_attach(struct net_device *dev,
+                const char *bus_id, u32 flags, phy_interface_t interface)
+{
+        struct bus_type *bus = &mdio_bus_type;
+        struct phy_device *phydev;
+        struct device *d;
+        int rc;
+
+        /* Search the list of PHY devices on the mdio bus for the
+         * PHY with the requested name */
+        d = bus_find_device_by_name(bus, NULL, bus_id);
+        if (!d) {
+                pr_err("PHY %s not found\n", bus_id);
+                return ERR_PTR(-ENODEV);
+        }
+        phydev = to_phy_device(d);
+
+        rc = phy_attach_direct(dev, phydev, flags, interface);
+        if (rc)
+                return ERR_PTR(rc);
+
         return phydev;
 }
 EXPORT_SYMBOL(phy_attach);