[PATCH] net: stmicro: implement basic Wake-On-LAN support

[Qiang Yang <line_walker2016@163.com>]

This patch implements basic Wake-On-LAN support in stmicro driver,
including adding wakeup filter configuration and implementation of
stmmac suspend/resume/wakeup callbacks. Currently only magic packet can
trigger the Wake-On-LAN function.

Signed-off-by: Qiang Yang <line_walker2016@163.com>
Signed-off-by: Weiqiang Su <David.suwq@outlook.com>
---
 .../net/ethernet/stmicro/stmmac/dwmac1000.h   | 26 +++++++++++++++++++
 .../ethernet/stmicro/stmmac/dwmac1000_core.c  |  9 ++++++-
 .../net/ethernet/stmicro/stmmac/stmmac_main.c |  2 ++
 .../net/ethernet/stmicro/stmmac/stmmac_pci.c  |  1 +
 4 files changed, 37 insertions(+), 1 deletion(-)

diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac1000.h b/drivers/net/ethernet/stmicro/stmmac/dwmac1000.h
index 1a84cf459e40..b84765831715 100644
--- a/drivers/net/ethernet/stmicro/stmmac/dwmac1000.h
+++ b/drivers/net/ethernet/stmicro/stmmac/dwmac1000.h
@@ -66,6 +66,32 @@ enum power_event {
 	power_down = 0x00000001,
 };
 
+#define WAKEUP_REG_LENGTH 8
+static u32 stmmac_wakeup_filter_config[] = {
+	/* For Filter0 CRC is not computed may be it is 0x0000 */
+	0x00000000,
+	/* For Filter1 CRC is computed on 0,1,2,3,4,5,6,7 bytes from offset */
+	0x000000FF,
+	/* For Filter2 CRC is not computed may be it is 0x0000 */
+	0x00000000,
+	/* For Filter3 CRC is not computed may be it is 0x0000 */
+	0x00000000,
+	/**
+	 * Filter 0,2,3 are disabled, Filter 1 is enabled and
+	 * filtering applies to only unicast packets
+	 */
+	0x00000100,
+	/**
+	 * Filter 0,2,3 (no significance), filter 1 offset is
+	 * 50 bytes from start of Destination MAC address
+	 */
+	0x00003200,
+	/* No significance of CRC for Filter0, Filter1 CRC is 0x7EED */
+	0x7eED0000,
+	/* No significance of CRC for Filter2 and Filter3 */
+	0x00000000,
+};
+
 /* Energy Efficient Ethernet (EEE)
  *
  * LPI status, timer and control register offset
diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac1000_core.c b/drivers/net/ethernet/stmicro/stmmac/dwmac1000_core.c
index 4d617ba11ecb..adea2346102e 100644
--- a/drivers/net/ethernet/stmicro/stmmac/dwmac1000_core.c
+++ b/drivers/net/ethernet/stmicro/stmmac/dwmac1000_core.c
@@ -267,7 +267,14 @@ static void dwmac1000_flow_ctrl(struct mac_device_info *hw, unsigned int duplex,
 static void dwmac1000_pmt(struct mac_device_info *hw, unsigned long mode)
 {
 	void __iomem *ioaddr = hw->pcsr;
-	unsigned int pmt = 0;
+	unsigned int pmt = 0, i = 0;
+
+	writel(pointer_reset, ioaddr + GMAC_PMT);
+	mdelay(100);
+
+	for (i = 0; i < WAKEUP_REG_LENGTH; i++)
+		writel(*(stmmac_wakeup_filter_config + i),
+		       ioaddr + GMAC_WAKEUP_FILTER);
 
 	if (mode & WAKE_MAGIC) {
 		pr_debug("GMAC: WOL Magic frame\n");
diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
index 0a4d093adfc9..7866f3ec5ef6 100644
--- a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
+++ b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
@@ -4513,6 +4513,7 @@ int stmmac_suspend(struct device *dev)
 
 	/* Enable Power down mode by programming the PMT regs */
 	if (device_may_wakeup(priv->device)) {
+		priv->wolopts |= WAKE_MAGIC;
 		stmmac_pmt(priv, priv->hw, priv->wolopts);
 		priv->irq_wake = 1;
 	} else {
@@ -4598,6 +4599,7 @@ int stmmac_resume(struct device *dev)
 			stmmac_mdio_reset(priv->mii);
 	}
 
+	device_set_wakeup_enable(dev, 0);
 	netif_device_attach(ndev);
 
 	mutex_lock(&priv->lock);
diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac_pci.c b/drivers/net/ethernet/stmicro/stmmac/stmmac_pci.c
index cc1e887e47b5..ec69521f061c 100644
--- a/drivers/net/ethernet/stmicro/stmmac/stmmac_pci.c
+++ b/drivers/net/ethernet/stmicro/stmmac/stmmac_pci.c
@@ -322,6 +322,7 @@ static int __maybe_unused stmmac_pci_suspend(struct device *dev)
 	struct pci_dev *pdev = to_pci_dev(dev);
 	int ret;
 
+	device_set_wakeup_enable(dev, 1);
 	ret = stmmac_suspend(dev);
 	if (ret)
 		return ret;
-- 
2.17.1