These changes are the raw update to linux-4.4.6-rt14. Kernel sources

[kvmfornfv.git] / kernel / drivers / phy / phy-core.c

diff --git a/kernel/drivers/phy/phy-core.c b/kernel/drivers/phy/phy-core.c
index 63bc12d..e7e574d 100644 (file)
--- a/kernel/drivers/phy/phy-core.c
+++ b/kernel/drivers/phy/phy-core.c
@@ -275,20 +275,21 @@ EXPORT_SYMBOL_GPL(phy_exit);
 
 int phy_power_on(struct phy *phy)
 {
-       int ret;
+       int ret = 0;
 
        if (!phy)
-               return 0;
+               goto out;
 
        if (phy->pwr) {
                ret = regulator_enable(phy->pwr);
                if (ret)
-                       return ret;
+                       goto out;
        }
 
        ret = phy_pm_runtime_get_sync(phy);
        if (ret < 0 && ret != -ENOTSUPP)
-               return ret;
+               goto err_pm_sync;
+
        ret = 0; /* Override possible ret == -ENOTSUPP */
 
        mutex_lock(&phy->mutex);
@@ -296,19 +297,20 @@ int phy_power_on(struct phy *phy)
                ret = phy->ops->power_on(phy);
                if (ret < 0) {
                        dev_err(&phy->dev, "phy poweron failed --> %d\n", ret);
-                       goto out;
+                       goto err_pwr_on;
                }
        }
        ++phy->power_count;
        mutex_unlock(&phy->mutex);
        return 0;
 
-out:
+err_pwr_on:
        mutex_unlock(&phy->mutex);
        phy_pm_runtime_put_sync(phy);
+err_pm_sync:
        if (phy->pwr)
                regulator_disable(phy->pwr);
-
+out:
        return ret;
 }
 EXPORT_SYMBOL_GPL(phy_power_on);
@@ -367,13 +369,21 @@ static struct phy *_of_phy_get(struct device_node *np, int index)
        phy_provider = of_phy_provider_lookup(args.np);
        if (IS_ERR(phy_provider) || !try_module_get(phy_provider->owner)) {
                phy = ERR_PTR(-EPROBE_DEFER);
-               goto err0;
+               goto out_unlock;
+       }
+
+       if (!of_device_is_available(args.np)) {
+               dev_warn(phy_provider->dev, "Requested PHY is disabled\n");
+               phy = ERR_PTR(-ENODEV);
+               goto out_put_module;
        }
 
        phy = phy_provider->of_xlate(phy_provider->dev, &args);
+
+out_put_module:
        module_put(phy_provider->owner);
 
-err0:
+out_unlock:
        mutex_unlock(&phy_provider_mutex);
        of_node_put(args.np);
 
@@ -622,6 +632,47 @@ struct phy *devm_of_phy_get(struct device *dev, struct device_node *np,
 }
 EXPORT_SYMBOL_GPL(devm_of_phy_get);
 
+/**
+ * devm_of_phy_get_by_index() - lookup and obtain a reference to a phy by index.
+ * @dev: device that requests this phy
+ * @np: node containing the phy
+ * @index: index of the phy
+ *
+ * Gets the phy using _of_phy_get(), then gets a refcount to it,
+ * and associates a device with it using devres. On driver detach,
+ * release function is invoked on the devres data,
+ * then, devres data is freed.
+ *
+ */
+struct phy *devm_of_phy_get_by_index(struct device *dev, struct device_node *np,
+                                    int index)
+{
+       struct phy **ptr, *phy;
+
+       ptr = devres_alloc(devm_phy_release, sizeof(*ptr), GFP_KERNEL);
+       if (!ptr)
+               return ERR_PTR(-ENOMEM);
+
+       phy = _of_phy_get(np, index);
+       if (IS_ERR(phy)) {
+               devres_free(ptr);
+               return phy;
+       }
+
+       if (!try_module_get(phy->ops->owner)) {
+               devres_free(ptr);
+               return ERR_PTR(-EPROBE_DEFER);
+       }
+
+       get_device(&phy->dev);
+
+       *ptr = phy;
+       devres_add(dev, ptr);
+
+       return phy;
+}
+EXPORT_SYMBOL_GPL(devm_of_phy_get_by_index);
+
 /**
  * phy_create() - create a new phy
  * @dev: device that is creating the new phy
@@ -651,16 +702,6 @@ struct phy *phy_create(struct device *dev, struct device_node *node,
                goto free_phy;
        }
 
-       /* phy-supply */
-       phy->pwr = regulator_get_optional(dev, "phy");
-       if (IS_ERR(phy->pwr)) {
-               if (PTR_ERR(phy->pwr) == -EPROBE_DEFER) {
-                       ret = -EPROBE_DEFER;
-                       goto free_ida;
-               }
-               phy->pwr = NULL;
-       }
-
        device_initialize(&phy->dev);
        mutex_init(&phy->mutex);
 
@@ -674,6 +715,16 @@ struct phy *phy_create(struct device *dev, struct device_node *node,
        if (ret)
                goto put_dev;
 
+       /* phy-supply */
+       phy->pwr = regulator_get_optional(&phy->dev, "phy");
+       if (IS_ERR(phy->pwr)) {
+               ret = PTR_ERR(phy->pwr);
+               if (ret == -EPROBE_DEFER)
+                       goto put_dev;
+
+               phy->pwr = NULL;
+       }
+
        ret = device_add(&phy->dev);
        if (ret)
                goto put_dev;
@@ -689,9 +740,6 @@ put_dev:
        put_device(&phy->dev);  /* calls phy_release() which frees resources */
        return ERR_PTR(ret);
 
-free_ida:
-       ida_simple_remove(&phy_ida, phy->id);
-
 free_phy:
        kfree(phy);
        return ERR_PTR(ret);