@@ -27,6 +27,7 @@
#include <linux/of_gpio.h>
#include <linux/of_mdio.h>
#include <linux/phy.h>
+#include <linux/regulator/consumer.h>
#include <linux/reset.h>
#include <linux/skbuff.h>
#include <linux/slab.h>
@@ -67,6 +68,22 @@ static int mdiobus_register_reset(struct mdio_device *mdiodev)
return 0;
}
+static int mdiobus_register_regulator(struct mdio_device *mdiodev)
+{
+ struct regulator *phy_supply;
+
+ phy_supply = regulator_get_optional(&mdiodev->dev, "phy");
+ if (IS_ERR(phy_supply)) {
+ if (PTR_ERR(phy_supply) == -EPROBE_DEFER)
+ return -EPROBE_DEFER;
+ phy_supply = NULL;
+ }
+
+ mdiodev->phy_supply = phy_supply;
+
+ return 0;
+}
+
int mdiobus_register_device(struct mdio_device *mdiodev)
{
int err;
@@ -83,6 +100,10 @@ int mdiobus_register_device(struct mdio_device *mdiodev)
if (err)
return err;
+ err = mdiobus_register_regulator(mdiodev);
+ if (err)
+ return err;
+
/* Assert the reset signal */
mdio_device_reset(mdiodev, 1);
}
@@ -17,6 +17,7 @@
#include <linux/mii.h>
#include <linux/module.h>
#include <linux/phy.h>
+#include <linux/regulator/consumer.h>
#include <linux/reset.h>
#include <linux/slab.h>
#include <linux/string.h>
@@ -136,6 +137,32 @@ void mdio_device_reset(struct mdio_device *mdiodev, int value)
}
EXPORT_SYMBOL(mdio_device_reset);
+int mdio_device_power_on(struct mdio_device *mdiodev)
+{
+ int ret = 0;
+
+ if (mdiodev->phy_supply)
+ /* TODO We may need a delay here just like reset_assert_delay
+ * but since no user currently needs it, I'm not adding it just
+ * yet.
+ */
+ ret = regulator_enable(mdiodev->phy_supply);
+
+ return ret;
+}
+EXPORT_SYMBOL(mdio_device_power_on);
+
+int mdio_device_power_off(struct mdio_device *mdiodev)
+{
+ int ret = 0;
+
+ if (mdiodev->phy_supply)
+ ret = regulator_disable(mdiodev->phy_supply);
+
+ return ret;
+}
+EXPORT_SYMBOL(mdio_device_power_off);
+
/**
* mdio_probe - probe an MDIO device
* @dev: device to probe
@@ -150,6 +177,11 @@ static int mdio_probe(struct device *dev)
struct mdio_driver *mdiodrv = to_mdio_driver(drv);
int err = 0;
+ /* Enable the power supply */
+ err = mdio_device_power_on(mdiodev);
+ if (err)
+ return err;
+
/* Deassert the reset signal */
mdio_device_reset(mdiodev, 0);
@@ -158,6 +190,8 @@ static int mdio_probe(struct device *dev)
if (err) {
/* Assert the reset signal */
mdio_device_reset(mdiodev, 1);
+ /* Disable the power supply */
+ mdio_device_power_off(mdiodev);
}
}
@@ -175,6 +209,8 @@ static int mdio_remove(struct device *dev)
/* Assert the reset signal */
mdio_device_reset(mdiodev, 1);
+ /* Disable the power supply */
+ mdio_device_power_off(mdiodev);
return 0;
}
@@ -46,6 +46,7 @@ struct mdio_device {
int flags;
struct gpio_desc *reset_gpio;
struct reset_control *reset_ctrl;
+ struct regulator *phy_supply;
unsigned int reset_assert_delay;
unsigned int reset_deassert_delay;
};
@@ -92,6 +93,8 @@ struct mdio_device *mdio_device_create(struct mii_bus *bus, int addr);
int mdio_device_register(struct mdio_device *mdiodev);
void mdio_device_remove(struct mdio_device *mdiodev);
void mdio_device_reset(struct mdio_device *mdiodev, int value);
+int mdio_device_power_on(struct mdio_device *mdiodev);
+int mdio_device_power_off(struct mdio_device *mdiodev);
int mdio_driver_register(struct mdio_driver *drv);
void mdio_driver_unregister(struct mdio_driver *drv);
int mdio_device_bus_match(struct device *dev, struct device_driver *drv);