[PATCH 2/3] ARM: i.mx53: Parse Reset GPIO pin in FEC driver from Devicetree

[Rostislav Lisovy]

Signed-off-by: Rostislav Lisovy <lisovy at gmail.com>

diff --git a/drivers/net/fec_imx.c b/drivers/net/fec_imx.c
index 2f31352..9855e8c 100644
--- a/drivers/net/fec_imx.c
+++ b/drivers/net/fec_imx.c
@@ -27,6 +27,8 @@
 #include <linux/clk.h>
 #include <linux/err.h>
 #include <of_net.h>
+#include <of_gpio.h>
+#include <gpio.h>
 
 #include <asm/mmu.h>
 
@@ -643,6 +645,7 @@ static int fec_probe(struct device_d *dev)
 	void *base;
 	int ret;
 	enum fec_type type;
+	int phy_reset;
 
 	ret = dev_get_drvdata(dev, (unsigned long *)&type);
 	if (ret)
@@ -671,6 +674,36 @@ static int fec_probe(struct device_d *dev)
 
 	fec->regs = dev_request_mem_region(dev, 0);
 
+	if (IS_ENABLED(CONFIG_OFDEVICE)) {
+		phy_reset = of_get_named_gpio(dev->device_node, "phy-reset-gpios", 0);
+		if (phy_reset < 0) {
+			pr_info("%s: 'phy-reset-gpios' not used. Skipping hardware PHY reset.\n", __func__);
+		} else {
+			if (!gpio_is_valid(phy_reset)) {
+				pr_err("%s: 'phy-reset' gpio is not valid:\n",
+					__func__);
+				goto err_free;
+			}
+
+			ret = gpio_request(phy_reset, "phy-reset");
+			if (ret) {
+				pr_err("%s: can not request gpio %d (phy-reset): %d\n",
+					__func__, phy_reset, ret);
+				goto err_free;
+			}
+
+			ret = gpio_direction_output(phy_reset, 0);
+			if (ret) {
+				pr_err("%s: can not set gpio %d (phy-reset) direction: %d\n",
+					__func__, phy_reset, ret);
+				goto err_free;
+			}
+
+			udelay(10);
+			gpio_set_value(phy_reset, 1);
+		}
+	}
+
 	/* Reset chip. */
 	writel(FEC_ECNTRL_RESET, fec->regs + FEC_ECNTRL);
 	while(readl(fec->regs + FEC_ECNTRL) & 1) {
-- 
1.7.10.4