Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 7566ee21 authored by Sunil Paidimarri's avatar Sunil Paidimarri
Browse files

net: stmmac: Add suspend resume support 



Add support for low power features like suspend,
resume and wake on lan.

Change-Id: I161b1d6a00e2254cf6b855e81fab7ebd9be244d7
Acked-by: default avatarAbhishek Chauhan <abchauha@qti.qualcomm.com>
Signed-off-by: default avatarSunil Paidimarri <hisunil@codeaurora.org>
parent 4c41cc8b

drivers/net/ethernet/stmicro/stmmac/dwmac-qcom-ethqos.c

+207 −6
Original line number Diff line number Diff line
@@ -82,8 +82,11 @@ static void rgmii_dump(struct qcom_ethqos *ethqos) 
#define RGMII_ID_MODE_10_LOW_SVS_CLK_FREQ	  (5 * 1000 * 1000UL)



static void

ethqos_update_rgmii_clk(struct qcom_ethqos *ethqos, unsigned int speed)

ethqos_update_rgmii_clk_and_bus_cfg(struct qcom_ethqos *ethqos,

				    unsigned int speed)

{

	int ret;



	switch (speed) {

	case SPEED_1000:

		ethqos->rgmii_clk_rate =  RGMII_1000_NOM_CLK_FREQ;
@@ -98,6 +101,28 @@ ethqos_update_rgmii_clk(struct qcom_ethqos *ethqos, unsigned int speed) 
		break;

	}



	switch (speed) {

	case SPEED_1000:

		ethqos->vote_idx = VOTE_IDX_1000MBPS;

		break;

	case SPEED_100:

		ethqos->vote_idx = VOTE_IDX_100MBPS;

		break;

	case SPEED_10:

		ethqos->vote_idx = VOTE_IDX_10MBPS;

		break;

	case 0:

		ethqos->vote_idx = VOTE_IDX_0MBPS;

		ethqos->rgmii_clk_rate = 0;

		break;

	}



	if (ethqos->bus_hdl) {

		ret = msm_bus_scale_client_update_request(ethqos->bus_hdl,

							  ethqos->vote_idx);

		WARN_ON(ret);

	}



	clk_set_rate(ethqos->rgmii_clk, ethqos->rgmii_clk_rate);

}
@@ -411,7 +436,7 @@ static void ethqos_fix_mac_speed(void *priv, unsigned int speed) 
	struct qcom_ethqos *ethqos = priv;



	ethqos->speed = speed;

	ethqos_update_rgmii_clk(ethqos, speed);

	ethqos_update_rgmii_clk_and_bus_cfg(ethqos, speed);

	ethqos_configure(ethqos);

}
@@ -519,6 +544,9 @@ static void ethqos_defer_phy_isr_work(struct work_struct *work) 
	struct qcom_ethqos *ethqos =

		container_of(work, struct qcom_ethqos, emac_phy_work);



	if (ethqos->clks_suspended)

		wait_for_completion(&ethqos->clk_enable_done);



	ethqos_handle_phy_interrupt(ethqos);

}
@@ -526,6 +554,8 @@ static irqreturn_t ETHQOS_PHY_ISR(int irq, void *dev_data) 
{

	struct qcom_ethqos *ethqos = (struct qcom_ethqos *)dev_data;



	pm_wakeup_event(&ethqos->pdev->dev, 5000);



	queue_work(system_wq, &ethqos->emac_phy_work);



	return IRQ_HANDLED;
@@ -536,6 +566,8 @@ static int ethqos_phy_intr_enable(struct qcom_ethqos *ethqos) 
	int ret = 0;



	INIT_WORK(&ethqos->emac_phy_work, ethqos_defer_phy_isr_work);

	init_completion(&ethqos->clk_enable_done);



	ret = request_irq(ethqos->phy_intr, ETHQOS_PHY_ISR,

			  IRQF_SHARED, "stmmac", ethqos);

	if (ret) {
@@ -936,6 +968,108 @@ static int ethqos_update_rgmii_tx_drv_strength(struct qcom_ethqos *ethqos) 
	return ret;

}



static void qcom_ethqos_phy_suspend_clks(struct qcom_ethqos *ethqos)

{

	ETHQOSINFO("Enter\n");



	if (phy_intr_en)

		reinit_completion(&ethqos->clk_enable_done);



	ethqos->clks_suspended = 1;



	ethqos_update_rgmii_clk_and_bus_cfg(ethqos, 0);



	ETHQOSINFO("Exit\n");

}



static bool qcom_ethqos_is_phy_link_up(struct qcom_ethqos *ethqos,

				       struct net_device *ndev)

{

	if (!ethqos) {

		ETHQOSINFO("ethqos addr is NULL");

		return 0;

	}



	if (!ndev) {

		ETHQOSINFO("dev addr is NULL");

		return 0;

	}



	/* PHY driver initializes phydev->link=1.

	 * So, phydev->link is 1 even on booup with no PHY connected.

	 * phydev->link is valid only after adjust_link is called once.

	 * Use (pdata->oldlink != -1) to indicate phy link is not up

	 */

	return ethqos->always_on_phy ? 1 :

		((ethqos->oldlink != -1) && ndev->phydev && ndev->phydev->link);

		return 0;

}



static void qcom_ethqos_phy_resume_clks(struct qcom_ethqos *ethqos,

					struct net_device *ndev)

{

	ETHQOSINFO("Enter\n");



	if (qcom_ethqos_is_phy_link_up(ethqos, ndev))

		ethqos_update_rgmii_clk_and_bus_cfg(ethqos, ethqos->speed);

	else

		ethqos_update_rgmii_clk_and_bus_cfg(ethqos, SPEED_10);



	ethqos->clks_suspended = 0;



	if (phy_intr_en)

		complete_all(&ethqos->clk_enable_done);



	ETHQOSINFO("Exit\n");

}



void qcom_ethqos_request_phy_wol(struct plat_stmmacenet_data *plat)

{

	struct qcom_ethqos *ethqos = plat->bsp_priv;

	struct platform_device *pdev = ethqos->pdev;

	struct net_device *ndev = platform_get_drvdata(pdev);



	ethqos->phy_wol_supported = 0;

	ethqos->phy_wol_wolopts = 0;

	/* Check if phydev is valid*/

	/* Check and enable Wake-on-LAN functionality in PHY*/



	if (ndev->phydev) {

		struct ethtool_wolinfo wol = {.cmd = ETHTOOL_GWOL};



		wol.supported = 0;

		wol.wolopts = 0;

		ETHQOSINFO("phydev addr: 0x%pK\n", ndev->phydev);

		phy_ethtool_get_wol(ndev->phydev, &wol);

		ethqos->phy_wol_supported = wol.supported;

		ETHQOSINFO("Get WoL[0x%x] in %s\n", wol.supported,

			   ndev->phydev->drv->name);



	/* Try to enable supported Wake-on-LAN features in PHY*/

		if (wol.supported) {

			device_set_wakeup_capable(&ethqos->pdev->dev, 1);



			wol.cmd = ETHTOOL_SWOL;

			wol.wolopts = wol.supported;



			if (!phy_ethtool_set_wol(ndev->phydev, &wol)) {

				ethqos->phy_wol_wolopts = wol.wolopts;



				enable_irq_wake(ethqos->phy_intr);

				device_set_wakeup_enable(&ethqos->pdev->dev, 1);



				ETHQOSINFO("Enabled WoL[0x%x] in %s\n",

					   wol.wolopts,

					   ndev->phydev->drv->name);

			} else {

				ETHQOSINFO("Disabled WoL[0x%x] in %s\n",

					   wol.wolopts,

					   ndev->phydev->drv->name);

			}

		}

	}

}



static int qcom_ethqos_probe(struct platform_device *pdev)

{

	struct device_node *np = pdev->dev.of_node;
@@ -963,8 +1097,9 @@ static int qcom_ethqos_probe(struct platform_device *pdev) 
		ret = -ENOMEM;

		goto err_mem;

	}

	ethqos->pdev = pdev;



	ethqos->pdev = pdev;

	ethqos->oldlink = -1;

	ethqos_init_reqgulators(ethqos);

	ethqos_init_gpio(ethqos);
@@ -995,8 +1130,8 @@ static int qcom_ethqos_probe(struct platform_device *pdev) 
	if (ret)

		goto err_mem;



	ethqos->speed = SPEED_1000;

	ethqos_update_rgmii_clk(ethqos, SPEED_1000);

	ethqos->speed = SPEED_10;

	ethqos_update_rgmii_clk_and_bus_cfg(ethqos, SPEED_10);

	ethqos_set_func_clk_en(ethqos);



	plat_dat->bsp_priv = ethqos;
@@ -1074,20 +1209,86 @@ static int qcom_ethqos_remove(struct platform_device *pdev) 


	if (phy_intr_en)

		free_irq(ethqos->phy_intr, ethqos);



	if (phy_intr_en)

		cancel_work_sync(&ethqos->emac_phy_work);



	emac_emb_smmu_exit();

	ethqos_disable_regulators(ethqos);



	return ret;

}



static int qcom_ethqos_suspend(struct device *dev)

{

	struct qcom_ethqos *ethqos;

	struct net_device *ndev = NULL;

	int ret;



	if (of_device_is_compatible(dev->of_node, "qcom,emac-smmu-embedded")) {

		ETHQOSDBG("smmu return\n");

		return 0;

	}



	ethqos = get_stmmac_bsp_priv(dev);

	if (!ethqos)

		return -ENODEV;



	ndev = dev_get_drvdata(dev);



	if (!ndev || !netif_running(ndev))

		return -EINVAL;



	ret = stmmac_suspend(dev);

	qcom_ethqos_phy_suspend_clks(ethqos);



	ETHQOSDBG(" ret = %d\n", ret);

	return ret;

}



static int qcom_ethqos_resume(struct device *dev)

{

	struct net_device *ndev = NULL;

	struct qcom_ethqos *ethqos;

	int ret;



	ETHQOSDBG("Resume Enter\n");

	if (of_device_is_compatible(dev->of_node, "qcom,emac-smmu-embedded"))

		return 0;



	ethqos = get_stmmac_bsp_priv(dev);



	if (!ethqos)

		return -ENODEV;



	ndev = dev_get_drvdata(dev);



	if (!ndev || !netif_running(ndev)) {

		ETHQOSERR(" Resume not possible\n");

		return -EINVAL;

	}



	qcom_ethqos_phy_resume_clks(ethqos, ndev);



	ret = stmmac_resume(dev);



	ETHQOSDBG("<--Resume Exit\n");

	return ret;

}



MODULE_DEVICE_TABLE(of, qcom_ethqos_match);



static const struct dev_pm_ops qcom_ethqos_pm_ops = {

	.suspend = qcom_ethqos_suspend,

	.resume = qcom_ethqos_resume,

};



static struct platform_driver qcom_ethqos_driver = {

	.probe  = qcom_ethqos_probe,

	.remove = qcom_ethqos_remove,

	.driver = {

		.name           = "qcom-ethqos",

		.pm		= &stmmac_pltfr_pm_ops,

		.pm = &qcom_ethqos_pm_ops,

		.of_match_table = of_match_ptr(qcom_ethqos_match),

	},

};

drivers/net/ethernet/stmicro/stmmac/dwmac-qcom-ethqos.h

+29 −2
Original line number Diff line number Diff line
@@ -13,6 +13,7 @@ 
#define	_DWMAC_QCOM_ETHQOS_H



#include <linux/ipc_logging.h>

#include <linux/msm-bus.h>



extern void *ipc_emac_log_ctxt;
@@ -153,12 +154,16 @@ do {\ 
#define MICREL_PHY_ID PHY_ID_KSZ9031

#define DWC_ETH_QOS_MICREL_PHY_INTCS 0x1b

#define DWC_ETH_QOS_MICREL_PHY_CTL 0x1f

#define DWC_ETH_QOS_MICREL_INTR_LEVEL 0x4000

#define DWC_ETH_QOS_BASIC_STATUS     0x0001

#define LINK_STATE_MASK 0x4

#define AUTONEG_STATE_MASK 0x20

#define MICREL_LINK_UP_INTR_STATUS BIT(0)



#define VOTE_IDX_0MBPS 0

#define VOTE_IDX_10MBPS 1

#define VOTE_IDX_100MBPS 2

#define VOTE_IDX_1000MBPS 3



#define TLMM_BASE_ADDRESS (tlmm_central_base_addr)



#define TLMM_RGMII_HDRV_PULL_CTL1_ADDRESS_OFFSET\
@@ -235,7 +240,6 @@ do {\ 


#define TLMM_RGMII_RX_HV_MODE_CTL_RGRD(data)\

	((data) = ioread32((void __iomem *)TLMM_RGMII_RX_HV_MODE_CTL_ADDRESS))



static inline u32 PPSCMDX(u32 x, u32 val)

{

	return (GENMASK(PPS_MINIDX(x) + 3, PPS_MINIDX(x)) &
@@ -253,6 +257,12 @@ static inline u32 PPSX_MASK(u32 x) 
	return GENMASK(PPS_MAXIDX(x), PPS_MINIDX(x));

}



enum IO_MACRO_PHY_MODE {

		RGMII_MODE,

		RMII_MODE,

		MII_MODE

};



struct ethqos_emac_por {

	unsigned int offset;

	unsigned int value;
@@ -280,9 +290,12 @@ struct qcom_ethqos { 
	struct platform_device *pdev;

	void __iomem *rgmii_base;



	struct msm_bus_scale_pdata *bus_scale_vec;

	u32 bus_hdl;

	unsigned int rgmii_clk_rate;

	struct clk *rgmii_clk;

	unsigned int speed;

	unsigned int vote_idx;



	int gpio_phy_intr_redirect;

	u32 phy_intr;
@@ -317,6 +330,18 @@ struct qcom_ethqos { 
	unsigned long avb_class_b_intr_cnt;

	struct dentry *debugfs_dir;



	int oldlink;

	/* saving state for Wake-on-LAN */

	int wolopts;

	/* state of enabled wol options in PHY*/

	u32 phy_wol_wolopts;

	/* state of supported wol options in PHY*/

	u32 phy_wol_supported;

	/* Boolean to check if clock is suspended*/

	int clks_suspended;

	/* Structure which holds done and wait members */

	struct completion clk_enable_done;



	int always_on_phy;

};
@@ -353,4 +378,6 @@ int create_pps_interrupt_device_node(dev_t *pps_dev_t, 
				     struct cdev **pps_cdev,

				     struct class **pps_class,

				     char *pps_dev_node_name);

void qcom_ethqos_request_phy_wol(struct plat_stmmacenet_data *plat);



#endif

drivers/net/ethernet/stmicro/stmmac/stmmac.h

+2 −0
Original line number Diff line number Diff line
@@ -170,6 +170,8 @@ int ethqos_handle_prv_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); 
int ethqos_init_pps(struct stmmac_priv *priv);



extern bool phy_intr_en;

void qcom_ethqos_request_phy_wol(struct plat_stmmacenet_data *plat_dat);



int stmmac_mdio_unregister(struct net_device *ndev);

int stmmac_mdio_register(struct net_device *ndev);

int stmmac_mdio_reset(struct mii_bus *mii);

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

+4 −5
Original line number Diff line number Diff line
@@ -293,11 +293,8 @@ static inline u32 stmmac_rx_dirty(struct stmmac_priv *priv, u32 queue) 
 */

static inline void stmmac_hw_fix_mac_speed(struct stmmac_priv *priv)

{

	struct net_device *ndev = priv->dev;

	struct phy_device *phydev = ndev->phydev;



	if (likely(priv->plat->fix_mac_speed))

		priv->plat->fix_mac_speed(priv->plat->bsp_priv, phydev->speed);

		priv->plat->fix_mac_speed(priv->plat->bsp_priv, priv->speed);

}



/**
@@ -832,9 +829,10 @@ static void stmmac_adjust_link(struct net_device *dev) 
				phydev->speed = SPEED_UNKNOWN;

				break;

			}

			priv->speed = phydev->speed;

			if (phydev->speed != SPEED_UNKNOWN)

				stmmac_hw_fix_mac_speed(priv);

			priv->speed = phydev->speed;



		}



		writel(ctrl, priv->ioaddr + MAC_CTRL_REG);
@@ -981,6 +979,7 @@ static int stmmac_init_phy(struct net_device *dev) 
			pr_debug(" qcom-ethqos: %s config_phy_intr successful\n",

				 __func__);

		}

		qcom_ethqos_request_phy_wol(priv->plat);

	}

	phy_attached_info(phydev);

	return 0;