Supported Wake On LAN

Change-Id: I06d26ab4dc6c639e438bdc9c9469420359a99d6f
Reviewed-on: https://tp-biosrd-v02/gerrit/82841
Reviewed-by: Alex Cheng(鄭富元) <Alex_Cheng@asus.com>
Tested-by: Alex Cheng(鄭富元) <Alex_Cheng@asus.com>

Author: alex3788

arch/arm/boot/dts/rk3288-miniarm.dts

@@ -292,6 +292,7 @@
 	snps,reset-delays-us = <0 10000 1000000>;
 	assigned-clocks = <&cru SCLK_MAC>;
 	assigned-clock-parents = <&ext_gmac>;
+	wolirq-gpio = <&gpio0 8 GPIO_ACTIVE_LOW>;
 	pinctrl-names = "default";
 	pinctrl-0 = <&rgmii_pins>;
 	tx_delay = <0x30>;

drivers/net/ethernet/stmicro/stmmac/stmmac_main.c

@@ -53,6 +53,8 @@
 #include "stmmac.h"
 #include <linux/reset.h>
 #include <linux/of_mdio.h>
+#include <linux/interrupt.h>
+#include <linux/gpio.h>
 #include "eth_mac_tinker.h"
 
 #define STMMAC_ALIGN(x)	L1_CACHE_ALIGN(x)
@@ -1819,6 +1821,15 @@ static int stmmac_hw_setup(struct net_device *dev, bool init_ptp)
 	return 0;
 }
 
+static irqreturn_t wol_io_isr(int irq, void *dev_id)
+{
+	struct net_device *dev = (struct net_device *)dev_id;
+	struct stmmac_priv *priv = netdev_priv(dev);
+
+	wake_lock_timeout(&priv->plat->wol_wake_lock, msecs_to_jiffies(8000));
+	return IRQ_HANDLED;
+}
+
 /**
  *  stmmac_open - open entry point of the driver
  *  @dev : pointer to the device structure.
@@ -1908,6 +1919,26 @@ static int stmmac_open(struct net_device *dev)
 		}
 	}
 
+	if (priv->plat->wolirq_io > 0) {
+		ret = devm_gpio_request(priv->device, priv->plat->wolirq_io, "gmac_wol_io");
+		if (ret) {
+			pr_err("%s: ERROR: failed to request WOL GPIO %d, err: %d\n",
+				   __func__, priv->plat->wolirq_io, ret);
+			goto lpiirq_error;
+		}
+
+		priv->plat->wol_irq = gpio_to_irq(priv->plat->wolirq_io);
+		ret = devm_request_irq(priv->device, priv->plat->wol_irq, wol_io_isr,
+			IRQF_TRIGGER_FALLING, "gmac_wol_io_irq", dev);
+		if (ret) {
+			pr_err("%s: ERROR: request wol io irq fail: %d", __func__, ret);
+			devm_gpio_free(priv->device, priv->plat->wolirq_io);
+			goto lpiirq_error;
+		}
+		disable_irq(priv->plat->wol_irq);
+		enable_irq_wake(priv->plat->wol_irq);
+	}
+
 	napi_enable(&priv->napi);
 	netif_start_queue(dev);
 
@@ -1961,6 +1992,12 @@ static int stmmac_release(struct net_device *dev)
 	if (priv->lpi_irq > 0)
 		free_irq(priv->lpi_irq, dev);
 
+	if (priv->plat->wol_irq > 0)
+		devm_free_irq(priv->device, priv->plat->wol_irq, dev);
+
+	if (priv->plat->wolirq_io > 0)
+		devm_gpio_free(priv->device, priv->plat->wolirq_io);
+
 	/* Stop TX/RX DMA and clear the descriptors */
 	priv->hw->dma->stop_tx(priv->ioaddr);
 	priv->hw->dma->stop_rx(priv->ioaddr);
@@ -3017,6 +3054,8 @@ int stmmac_dvr_probe(struct device *device,
 		goto error_netdev_register;
 	}
 
+	wake_lock_init(&priv->plat->wol_wake_lock, WAKE_LOCK_SUSPEND, "wol_wake_lock");
+
 	return ret;
 
 error_netdev_register:
@@ -3082,6 +3121,8 @@ int stmmac_suspend(struct device *dev)
 	struct stmmac_priv *priv = netdev_priv(ndev);
 	unsigned long flags;
 
+	enable_irq(priv->plat->wol_irq);
+
 	if (!ndev || !netif_running(ndev))
 		return 0;
 
@@ -3115,6 +3156,7 @@ int stmmac_suspend(struct device *dev)
 	priv->oldlink = 0;
 	priv->speed = 0;
 	priv->oldduplex = -1;
+
 	return 0;
 }
 EXPORT_SYMBOL_GPL(stmmac_suspend);
@@ -3131,6 +3173,8 @@ int stmmac_resume(struct device *dev)
 	struct stmmac_priv *priv = netdev_priv(ndev);
 	unsigned long flags;
 
+	disable_irq(priv->plat->wol_irq);
+
 	if (!netif_running(ndev))
 		return 0;
 

drivers/net/ethernet/stmicro/stmmac/stmmac_platform.c

@@ -29,6 +29,7 @@
 #include <linux/of_net.h>
 #include <linux/of_device.h>
 #include <linux/of_mdio.h>
+#include <linux/of_gpio.h>
 
 #include "stmmac.h"
 #include "stmmac_platform.h"
@@ -110,6 +111,7 @@ stmmac_probe_config_dt(struct platform_device *pdev, const char **mac)
 	struct device_node *np = pdev->dev.of_node;
 	struct plat_stmmacenet_data *plat;
 	struct stmmac_dma_cfg *dma_cfg;
+	enum of_gpio_flags flags;
 
 	plat = devm_kzalloc(&pdev->dev, sizeof(*plat), GFP_KERNEL);
 	if (!plat)
@@ -118,6 +120,8 @@ stmmac_probe_config_dt(struct platform_device *pdev, const char **mac)
 	*mac = of_get_mac_address(np);
 	plat->interface = of_get_phy_mode(np);
 
+	plat->wolirq_io = of_get_named_gpio_flags(np, "wolirq-gpio",								                       0, &flags);
+
 	/* Get max speed of operation from device tree */
 	if (of_property_read_u32(np, "max-speed", &plat->max_speed))
 		plat->max_speed = -1;

drivers/net/phy/phy_device.c

@@ -735,8 +735,8 @@ void phy_detach(struct phy_device *phydev)
 	int i;
 
 	phydev->attached_dev->phydev = NULL;
-	phydev->attached_dev = NULL;
 	phy_suspend(phydev);
+	phydev->attached_dev = NULL;
 
 	/* If the device had no specific driver before (i.e. - it
 	 * was using the generic driver), we unbind the device
@@ -1226,7 +1226,70 @@ static int gen10g_config_init(struct phy_device *phydev)
 int genphy_suspend(struct phy_device *phydev)
 {
 	int value;
+	struct net_device * ndev = phydev->attached_dev;
+
+ 	mutex_lock(&phydev->lock);
+
+//#if RTL8211E
+#if 1
+	phy_write(phydev, 31, 0x07);
+	phy_write(phydev, 30, 0x6e);
+
+	phy_write(phydev, 21, ((u16)ndev->dev_addr[1] << 8) + ndev->dev_addr[0]);
+	phy_write(phydev, 22, ((u16)ndev->dev_addr[3] << 8) + ndev->dev_addr[2]);
+	phy_write(phydev, 23, ((u16)ndev->dev_addr[5] << 8) + ndev->dev_addr[4]);
+
+	phy_write(phydev, 31, 0x07);
+	phy_write(phydev, 30, 0x6d);
+	phy_write(phydev, 22, 0x1fff);
+	value = phy_read(phydev, 22);
+
+	phy_write(phydev, 31, 0x07);
+	phy_write(phydev, 30, 0x6d);
+	phy_write(phydev, 21, 0x1000);
+	value = phy_read(phydev, 21);
+
+	phy_write(phydev, 31, 0x07);
+	phy_write(phydev, 30, 0x6d);
+	value =  phy_read(phydev, 25);
+	phy_write(phydev, 25, value | 0x1);
+
+	phy_write(phydev, 31, 0x0);
+        value = phy_read(phydev, 31);
+#endif
+
+//#if RTL8211F
+#if 0
+	//set INTB pin
+	phy_write(priv->phydev, 31, 0x0d40);
+	value = phy_read(priv->phydev, 22);
+	phy_write(priv->phydev, 22, value | BIT(5));
+
+	//set MAC address
+	phy_write(priv->phydev, 31, 0x0d8c);
+	phy_write(priv->phydev, 16, ((u16)ndev->dev_addr[1] << 8) + ndev->dev_addr[0]);
+	phy_write(priv->phydev, 17, ((u16)ndev->dev_addr[3] << 8) + ndev->dev_addr[2]);
+	phy_write(priv->phydev, 18, ((u16)ndev->dev_addr[5] << 8) + ndev->dev_addr[4]);
+
+	//set max packet length
+	phy_write(priv->phydev, 31, 0x0d8a);
+	phy_write(priv->phydev, 17, 0x9fff);
+
+	//enable wol event
+	phy_write(priv->phydev, 31, 0x0d8a);
+	phy_write(priv->phydev, 16, 0x1000);
+
+	//disable rgmii pad
+	phy_write(priv->phydev, 31, 0x0d8a);
+	value = phy_read(priv->phydev, 19);
+	phy_write(priv->phydev, 19, value | BIT(15));
+
+	phy_write(priv->phydev, 31, 0xa42);
+#endif
+	mutex_unlock(&phydev->lock);
 
+	return 0;
+/*
 	mutex_lock(&phydev->lock);
 
 	value = phy_read(phydev, MII_BMCR);
@@ -1235,6 +1298,7 @@ int genphy_suspend(struct phy_device *phydev)
 	mutex_unlock(&phydev->lock);
 
 	return 0;
+*/
 }
 EXPORT_SYMBOL(genphy_suspend);
 
@@ -1247,6 +1311,60 @@ int genphy_resume(struct phy_device *phydev)
 {
 	int value;
 
+	if (phydev->suspended) {
+		mutex_lock(&phydev->lock);
+//#if RTL8211E
+#if 1
+		phy_write(phydev, 31, 0x07);
+		phy_write(phydev, 30, 0x6d);
+		phy_write(phydev, 21, 0x0);
+		value = phy_read(phydev, 21);
+
+		phy_write(phydev, 31, 0x07);
+		phy_write(phydev, 30, 0x6d);
+		value =  phy_read(phydev, 22);
+		phy_write(phydev, 22, value | BIT(15));
+		value = phy_read(phydev, 22);
+
+		phy_write(phydev, 31, 0x07);
+		phy_write(phydev, 30, 0x6d);
+		value =  phy_read(phydev, 25);
+		phy_write(phydev, 25, value & (~(0x1)));
+
+		phy_write(phydev, 31, 0x0);
+                value = phy_read(phydev, 31);
+#endif
+
+//#if RTL8211F
+#if 0
+		//disable wol event
+		phy_write(priv->phydev, 31, 0x0d8a);
+		phy_write(priv->phydev, 16, 0x0);
+
+		//reset wol
+		phy_write(priv->phydev, 31, 0x0d8a);
+		value = phy_read(priv->phydev, 17);
+		phy_write(priv->phydev, 17, value & (~BIT(15)));
+
+		//enable rgmii pad
+		phy_write(priv->phydev, 31, 0x0d8a);
+		value = phy_read(priv->phydev, 19);
+		phy_write(priv->phydev, 19, value & (~BIT(15)));
+
+		//set INTB pin
+		phy_write(priv->phydev, 31, 0x0d40);
+		value = phy_read(priv->phydev, 22);
+		phy_write(priv->phydev, 22, value & (~BIT(5)));
+
+		phy_write(priv->phydev, 31, 0xa42);
+#endif
+		mutex_unlock(&phydev->lock);
+
+		msleep(100);
+
+		return 0;
+	}
+
 	mutex_lock(&phydev->lock);
 
 	value = phy_read(phydev, MII_BMCR);

include/linux/stmmac.h

@@ -27,6 +27,7 @@
 #define __STMMAC_PLATFORM_DATA
 
 #include <linux/platform_device.h>
+#include <linux/wakelock.h>
 
 #define STMMAC_RX_COE_NONE	0
 #define STMMAC_RX_COE_TYPE1	1
@@ -123,5 +124,9 @@ struct plat_stmmacenet_data {
 	void (*exit)(struct platform_device *pdev, void *priv);
 	void (*get_eth_addr)(void *priv, unsigned char *addr);
 	void *bsp_priv;
+        int wolirq_io;
+        int wolirq_io_level;
+        int wol_irq;
+        struct wake_lock wol_wake_lock;
 };
 #endif