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

Commit 63c0a5dc authored by Sunil Paidimarri's avatar Sunil Paidimarri
Browse files

net: stmmac: Disable c-tile power collapse 



Disable c-tile PC from stmmac driver.
This stops stmmac power collapse in XO-shutdown.

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

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

+77 −0
Original line number Diff line number Diff line
@@ -31,6 +31,8 @@ struct qcom_ethqos *pethqos; 
struct emac_emb_smmu_cb_ctx emac_emb_smmu_ctx = {0};



void *ipc_emac_log_ctxt;

static struct qmp_pkt pkt;

static char qmp_buf[MAX_QMP_MSG_SIZE + 1] = {0};



static int rgmii_readl(struct qcom_ethqos *ethqos, unsigned int offset)

{
@@ -126,6 +128,74 @@ ethqos_update_rgmii_clk_and_bus_cfg(struct qcom_ethqos *ethqos, 
	clk_set_rate(ethqos->rgmii_clk, ethqos->rgmii_clk_rate);

}



static int qcom_ethqos_qmp_mailbox_init(struct qcom_ethqos *ethqos)

{

	ethqos->qmp_mbox_client = devm_kzalloc(

	&ethqos->pdev->dev, sizeof(*ethqos->qmp_mbox_client), GFP_KERNEL);



	if (IS_ERR(ethqos->qmp_mbox_client)) {

		ETHQOSERR("qmp alloc client failed\n");

		return -EINVAL;

	}



	ethqos->qmp_mbox_client->dev = &ethqos->pdev->dev;

	ethqos->qmp_mbox_client->tx_block = true;

	ethqos->qmp_mbox_client->tx_tout = 1000;

	ethqos->qmp_mbox_client->knows_txdone = false;



	ethqos->qmp_mbox_chan = mbox_request_channel(ethqos->qmp_mbox_client,

						     0);



	if (IS_ERR(ethqos->qmp_mbox_chan)) {

		ETHQOSERR("qmp request channel failed\n");

		return -EINVAL;

	}



	return 0;

}



static int qcom_ethqos_qmp_mailbox_send_message(struct qcom_ethqos *ethqos)

{

	int ret = 0;



	memset(&qmp_buf[0], 0, MAX_QMP_MSG_SIZE + 1);



	snprintf(qmp_buf, MAX_QMP_MSG_SIZE, "{class:ctile, pc:0}");



	pkt.size = ((size_t)strlen(qmp_buf) + 0x3) & ~0x3;

	pkt.data = qmp_buf;



	ret = mbox_send_message(ethqos->qmp_mbox_chan, (void *)&pkt);



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



	if (ret < 0) {

		ETHQOSERR("Disabling c-tile power collapse failed\n");

		return ret;

	}



	ETHQOSDBG("Disabling c-tile power collapse succeded");



	return 0;

}



/**

 *  DWC_ETH_QOS_qmp_mailbox_work - Scheduled from probe

 *  @work: work_struct

 */

static void qcom_ethqos_qmp_mailbox_work(struct work_struct *work)

{

	struct qcom_ethqos *ethqos =

		container_of(work, struct qcom_ethqos, qmp_mailbox_work);



	ETHQOSDBG("Enter\n");



	/* Send QMP message to disable c-tile power collapse */

	qcom_ethqos_qmp_mailbox_send_message(ethqos);



	ETHQOSDBG("Exit\n");

}



static void ethqos_set_func_clk_en(struct qcom_ethqos *ethqos)

{

	rgmii_updatel(ethqos, RGMII_CONFIG_FUNC_CLK_EN,
@@ -1133,6 +1203,8 @@ static int qcom_ethqos_probe(struct platform_device *pdev) 
	ethqos->speed = SPEED_10;

	ethqos_update_rgmii_clk_and_bus_cfg(ethqos, SPEED_10);

	ethqos_set_func_clk_en(ethqos);

	if (ethqos->emac_ver == EMAC_HW_v2_0_0)

		ethqos->disable_ctile_pc = 1;



	plat_dat->bsp_priv = ethqos;

	plat_dat->fix_mac_speed = ethqos_fix_mac_speed;
@@ -1182,6 +1254,11 @@ static int qcom_ethqos_probe(struct platform_device *pdev) 
						 AVB_CLASS_B_POLL_DEV_NODE);

	}



	if (ethqos->disable_ctile_pc && !qcom_ethqos_qmp_mailbox_init(ethqos)) {

		INIT_WORK(&ethqos->qmp_mailbox_work,

			  qcom_ethqos_qmp_mailbox_work);

		queue_work(system_wq, &ethqos->qmp_mailbox_work);

	}

	pethqos = ethqos;

	ethqos_create_debugfs(ethqos);

	return ret;

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

+10 −1
Original line number Diff line number Diff line 
/* Copyright (c) 2019, The Linux Foundation. All rights reserved.

/* Copyright (c) 2020, The Linux Foundation. All rights reserved.

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 and
@@ -14,10 +14,14 @@ 


#include <linux/ipc_logging.h>

#include <linux/msm-bus.h>

#include <linux/mailbox_client.h>

#include <linux/mailbox/qmp.h>

#include <linux/mailbox_controller.h>



extern void *ipc_emac_log_ctxt;



#define IPCLOG_STATE_PAGES 50

#define MAX_QMP_MSG_SIZE 96

#define __FILENAME__ (strrchr(__FILE__, '/') ? \

		strrchr(__FILE__, '/') + 1 : __FILE__)
@@ -343,6 +347,11 @@ struct qcom_ethqos { 
	struct completion clk_enable_done;



	int always_on_phy;

	/* QMP message for disabling ctile power collapse while XO shutdown */

	struct mbox_chan *qmp_mbox_chan;

	struct mbox_client *qmp_mbox_client;

	struct work_struct qmp_mailbox_work;

	int disable_ctile_pc;

};



struct pps_cfg {