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

Commit b889587c authored by Sneh Shah's avatar Sneh Shah Committed by Gerrit - the friendly Code Review server
Browse files

net: stmmac: Add debugfs entries 



Add RGMII dump and phy register dump in debugfs.

Change-Id: I00771cb3e7dc97f1cbe394c3342a638b3a3c22d4
Signed-off-by: default avatarSneh Shah <snehshah@codeaurora.org>
parent 02645d3a

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

+175 −1
Original line number Diff line number Diff line
@@ -13,7 +13,6 @@ 
#include <linux/mii.h>

#include <linux/of_mdio.h>

#include <linux/slab.h>

#include <linux/ipc_logging.h>

#include <linux/poll.h>

#include <linux/debugfs.h>
@@ -102,6 +101,8 @@ bool phy_intr_en; 


struct qcom_ethqos *pethqos;



void *ipc_emac_log_ctxt;



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

{

	return readl(ethqos->rgmii_base + offset);
@@ -599,6 +600,172 @@ static void ethqos_pps_irq_config(struct qcom_ethqos *ethqos) 
	}

}



static ssize_t read_phy_reg_dump(struct file *file, char __user *user_buf,

				 size_t count, loff_t *ppos)

{

	struct qcom_ethqos *ethqos = file->private_data;

	unsigned int len = 0, buf_len = 2000;

	char *buf;

	ssize_t ret_cnt;

	int phydata = 0;

	int i = 0;



	struct platform_device *pdev = ethqos->pdev;

	struct net_device *dev = platform_get_drvdata(pdev);

	struct stmmac_priv *priv = netdev_priv(dev);



	if (!ethqos || !dev->phydev) {

		ETHQOSERR("NULL Pointer\n");

		return -EINVAL;

	}



	buf = kzalloc(buf_len, GFP_KERNEL);

	if (!buf)

		return -ENOMEM;



	len += scnprintf(buf + len, buf_len - len,

					 "\n************* PHY Reg dump *************\n");



	for (i = 0; i < 32; i++) {

		phydata = ethqos_mdio_read(priv, priv->plat->phy_addr, i);

		len += scnprintf(buf + len, buf_len - len,

					 "MII Register (%#x) = %#x\n",

					 i, phydata);

	}



	if (len > buf_len) {

		ETHQOSERR("(len > buf_len) buffer not sufficient\n");

		len = buf_len;

	}



	ret_cnt = simple_read_from_buffer(user_buf, count, ppos, buf, len);

	kfree(buf);

	return ret_cnt;

}



static ssize_t read_rgmii_reg_dump(struct file *file,

				   char __user *user_buf, size_t count,

				   loff_t *ppos)

{

	struct qcom_ethqos *ethqos = file->private_data;

	unsigned int len = 0, buf_len = 2000;

	char *buf;

	ssize_t ret_cnt;

	int rgmii_data = 0;

	struct platform_device *pdev = ethqos->pdev;



	struct net_device *dev = platform_get_drvdata(pdev);



	if (!ethqos || !dev->phydev) {

		ETHQOSERR("NULL Pointer\n");

		return -EINVAL;

	}



	buf = kzalloc(buf_len, GFP_KERNEL);

	if (!buf)

		return -ENOMEM;



	len += scnprintf(buf + len, buf_len - len,

					 "\n************* RGMII Reg dump *************\n");

	rgmii_data = rgmii_readl(ethqos, RGMII_IO_MACRO_CONFIG);

	len += scnprintf(buf + len, buf_len - len,

					 "RGMII_IO_MACRO_CONFIG Register = %#x\n",

					 rgmii_data);

	rgmii_data = rgmii_readl(ethqos, SDCC_HC_REG_DLL_CONFIG);

	len += scnprintf(buf + len, buf_len - len,

					 "SDCC_HC_REG_DLL_CONFIG Register = %#x\n",

					 rgmii_data);

	rgmii_data = rgmii_readl(ethqos, SDCC_HC_REG_DDR_CONFIG);

	len += scnprintf(buf + len, buf_len - len,

					 "SDCC_HC_REG_DDR_CONFIG Register = %#x\n",

					 rgmii_data);

	rgmii_data = rgmii_readl(ethqos, SDCC_HC_REG_DLL_CONFIG2);

	len += scnprintf(buf + len, buf_len - len,

					 "SDCC_HC_REG_DLL_CONFIG2 Register = %#x\n",

					 rgmii_data);

	rgmii_data = rgmii_readl(ethqos, SDC4_STATUS);

	len += scnprintf(buf + len, buf_len - len,

					 "SDC4_STATUS Register = %#x\n",

					 rgmii_data);

	rgmii_data = rgmii_readl(ethqos, SDCC_USR_CTL);

	len += scnprintf(buf + len, buf_len - len,

					 "SDCC_USR_CTL Register = %#x\n",

					 rgmii_data);

	rgmii_data = rgmii_readl(ethqos, RGMII_IO_MACRO_CONFIG2);

	len += scnprintf(buf + len, buf_len - len,

					 "RGMII_IO_MACRO_CONFIG2 Register = %#x\n",

					 rgmii_data);

	rgmii_data = rgmii_readl(ethqos, RGMII_IO_MACRO_DEBUG1);

	len += scnprintf(buf + len, buf_len - len,

					 "RGMII_IO_MACRO_DEBUG1 Register = %#x\n",

					 rgmii_data);

	rgmii_data = rgmii_readl(ethqos, EMAC_SYSTEM_LOW_POWER_DEBUG);

	len += scnprintf(buf + len, buf_len - len,

					 "EMAC_SYSTEM_LOW_POWER_DEBUG Register = %#x\n",

					 rgmii_data);



	if (len > buf_len) {

		ETHQOSERR("(len > buf_len) buffer not sufficient\n");

		len = buf_len;

	}



	ret_cnt = simple_read_from_buffer(user_buf, count, ppos, buf, len);

	kfree(buf);

	return ret_cnt;

}



static const struct file_operations fops_phy_reg_dump = {

	.read = read_phy_reg_dump,

	.open = simple_open,

	.owner = THIS_MODULE,

	.llseek = default_llseek,

};



static const struct file_operations fops_rgmii_reg_dump = {

	.read = read_rgmii_reg_dump,

	.open = simple_open,

	.owner = THIS_MODULE,

	.llseek = default_llseek,

};



static int ethqos_create_debugfs(struct qcom_ethqos        *ethqos)

{

	static struct dentry *phy_reg_dump;

	static struct dentry *rgmii_reg_dump;



	if (!ethqos) {

		ETHQOSERR("Null Param %s\n", __func__);

		return -ENOMEM;

	}



	ethqos->debugfs_dir = debugfs_create_dir("eth", NULL);



	if (!ethqos->debugfs_dir || IS_ERR(ethqos->debugfs_dir)) {

		ETHQOSERR("Can't create debugfs dir\n");

		return -ENOMEM;

	}



	phy_reg_dump = debugfs_create_file("phy_reg_dump", 0400,

					   ethqos->debugfs_dir, ethqos,

					   &fops_phy_reg_dump);

	if (!phy_reg_dump || IS_ERR(phy_reg_dump)) {

		ETHQOSERR("Can't create phy_dump %d\n", (int)phy_reg_dump);

		goto fail;

	}



	rgmii_reg_dump = debugfs_create_file("rgmii_reg_dump", 0400,

					     ethqos->debugfs_dir, ethqos,

					     &fops_rgmii_reg_dump);

	if (!rgmii_reg_dump || IS_ERR(rgmii_reg_dump)) {

		ETHQOSERR("Can't create rgmii_dump %d\n", (int)rgmii_reg_dump);

		goto fail;

	}

	return 0;



fail:

	debugfs_remove_recursive(ethqos->debugfs_dir);

	return -ENOMEM;

}

static int qcom_ethqos_probe(struct platform_device *pdev)

{

	struct device_node *np = pdev->dev.of_node;
@@ -608,6 +775,12 @@ static int qcom_ethqos_probe(struct platform_device *pdev) 
	struct resource *res;

	int ret;



	ipc_emac_log_ctxt = ipc_log_context_create(IPCLOG_STATE_PAGES,

						   "emac", 0);

	if (!ipc_emac_log_ctxt)

		ETHQOSERR("Error creating logging context for emac\n");

	else

		ETHQOSDBG("IPC logging has been enabled for emac\n");

	ret = stmmac_get_platform_resources(pdev, &stmmac_res);

	if (ret)

		return ret;
@@ -686,6 +859,7 @@ static int qcom_ethqos_probe(struct platform_device *pdev) 
	}



	pethqos = ethqos;

	ethqos_create_debugfs(ethqos);

	return ret;



err_clk:

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

+17 −2
Original line number Diff line number Diff line
@@ -12,14 +12,28 @@ 
#ifndef	_DWMAC_QCOM_ETHQOS_H

#define	_DWMAC_QCOM_ETHQOS_H



#include <linux/ipc_logging.h>



extern void *ipc_emac_log_ctxt;



#define IPCLOG_STATE_PAGES 50

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

		strrchr(__FILE__, '/') + 1 : __FILE__)



#define DRV_NAME "qcom-ethqos"

#define ETHQOSDBG(fmt, args...) \

	pr_debug(DRV_NAME " %s:%d " fmt, __func__, ## args)

#define ETHQOSERR(fmt, args...) \

	pr_err(DRV_NAME " %s:%d " fmt, __func__, ## args)

do {\

	pr_err(DRV_NAME " %s:%d " fmt, __func__, ## args);\

	if (ipc_emac_log_ctxt) { \

		ipc_log_string(ipc_emac_log_ctxt, \

		"%s: %s[%u]:[emac] ERROR:" fmt, __FILENAME__,\

		__func__, __LINE__, ## args); \

	} \

} while (0)

#define ETHQOSINFO(fmt, args...) \

	pr_info(DRV_NAME " %s:%d " fmt, __func__, ## args)



#define RGMII_IO_MACRO_CONFIG		0x0

#define SDCC_HC_REG_DLL_CONFIG		0x4

#define SDCC_HC_REG_DDR_CONFIG		0xC
@@ -130,6 +144,7 @@ struct qcom_ethqos { 


	unsigned long avb_class_a_intr_cnt;

	unsigned long avb_class_b_intr_cnt;

	struct dentry *debugfs_dir;

};



struct pps_cfg {