drivers/net/ethernet/mediatek/star/star_procfs.c

/* Mediatek STAR MAC network driver.
 *
 * Copyright (c) 2016-2017 Mediatek Corporation
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation.
 */

#include "star.h"
#include "star_procfs.h"

static struct star_procfs star_proc;

static bool str_cmp_seq(char **buf, const char *substr)
{
	size_t len = strlen(substr);

	if (!strncmp(*buf, substr, len)) {
		*buf += len + 1;
		return true;
	} else {
		return false;
	}
}

static struct net_device *star_get_net_device(void)
{
	if (!star_proc.ndev)
		star_proc.ndev = dev_get_by_name(&init_net, "eth0");

	return star_proc.ndev;
}

static void star_put_net_device(void)
{
	if (!star_proc.ndev)
		return;

	dev_put(star_proc.ndev);
}

static ssize_t proc_phy_reg_read(struct file *file, char __user *buf,
				 size_t count, loff_t *ppos)
{
	STAR_MSG(STAR_ERR, "read phy register useage:\n");
	STAR_MSG(STAR_ERR, "\t echo rp reg_addr > phy_reg\n");

	STAR_MSG(STAR_ERR, "write phy register useage:\n");
	STAR_MSG(STAR_ERR, "\t echo wp reg_addr value > phy_reg\n");

	return 0;
}

static ssize_t proc_reg_write(struct file *file,
			      const char __user *buffer,
			      size_t count, loff_t *pos)
{
	char *buf, *tmp;
	u16 phy_val;
	u32 i, mac_val, len = 0, address = 0, value = 0;
	struct net_device *dev;
	star_private *star_prv;
	star_dev *star_dev;

	tmp = kmalloc(count + 1, GFP_KERNEL);
	buf = tmp;
	if (copy_from_user(buf, buffer, count))
		return -EFAULT;
	buf[count] = '\0';

	dev = star_get_net_device();
	if (!dev) {
		STAR_MSG(STAR_ERR, "Could not get eth0 device!!!\n");
		return -1;
	}

	star_prv = netdev_priv(dev);
	star_dev = &star_prv->star_dev;

	if (str_cmp_seq(&buf, "rp")) {
		if (!kstrtou32(buf, 0, &address)) {
			STAR_MSG(STAR_ERR, "address(0x%x):0x%x\n",
				 address,
				 star_mdc_mdio_read(star_dev,
						    star_prv->phy_addr,
						    address));
		} else {
			STAR_MSG(STAR_ERR, "kstrtou32 rp(%s) error\n", buf);
		}
	} else if (str_cmp_seq(&buf, "wp")) {
		if (sscanf(buf, "%x %x", &address, &value) == 2) {
			phy_val = star_mdc_mdio_read(star_dev,
						     star_prv->phy_addr,
						     address);
			star_mdc_mdio_write(star_dev, star_prv->phy_addr,
					    address, (u16)value);
			STAR_MSG(STAR_ERR, "0x%x: 0x%x --> 0x%x!\n",
				 address, phy_val,
				 star_mdc_mdio_read(star_dev,
						    star_prv->phy_addr,
						    address));
		} else {
			STAR_MSG(STAR_ERR, "sscanf wp(%s) error\n", buf);
		}
	} else if (str_cmp_seq(&buf, "rr")) {
		if (sscanf(buf, "%x %x", &address, &len) == 2) {
			for (i = 0; i < len / 4; i++) {
				STAR_MSG(STAR_ERR,
					 "%p:\t%08x\t%08x\t%08x\t%08x\t\n",
					 star_dev->base + address + i * 16,
					 star_get_reg(star_dev->base
						    + address + i * 16),
					 star_get_reg(star_dev->base + address
						    + i * 16 + 4),
					 star_get_reg(star_dev->base + address
						    + i * 16 + 8),
					 star_get_reg(star_dev->base + address
						    + i * 16 + 12));
			}
		} else {
			STAR_MSG(STAR_ERR, "sscanf rr(%s) error\n", buf);
		}
	} else if (str_cmp_seq(&buf, "wr")) {
		if (sscanf(buf, "%x %x", &address, &value) == 2) {
			mac_val = star_get_reg(star_dev->base + address);
			star_set_reg(star_dev->base + address, value);
			STAR_MSG(STAR_ERR, "%p: %08x --> %08x!\n",
				 star_dev->base + address,
				 mac_val,
				 star_get_reg(star_dev->base
					    + address));
		} else {
			STAR_MSG(STAR_ERR, "sscanf wr(%s) error\n", buf);
		}
	} else {
		STAR_MSG(STAR_ERR, "wrong arg:%s\n", buf);
	}

	kfree(tmp);
	return count;
}

static const struct file_operations star_phy_reg_ops = {
	.read = proc_phy_reg_read,
	.write = proc_reg_write,
};

static ssize_t proc_mac_reg_read(struct file *file, char __user *buf,
				 size_t count, loff_t *ppos)
{
	STAR_MSG(STAR_ERR, "read MAC register useage:\n");
	STAR_MSG(STAR_ERR, "\t echo rr reg_addr len > macreg\n");

	STAR_MSG(STAR_ERR, "write MAC register useage:\n");
	STAR_MSG(STAR_ERR, "\t echo wr reg_addr value > macreg\n");

	return 0;
}

static const struct file_operations star_mac_reg_ops = {
	.read = proc_mac_reg_read,
	.write = proc_reg_write,
};

static int get_wol_status(struct seq_file *seq, void *v)
{
	struct net_device *dev;
	star_private *star_prv;

	dev = star_get_net_device();
	if (!dev) {
		STAR_MSG(STAR_ERR, "Could not get eth0 device!!!\n");
		return -1;
	}

	star_prv = netdev_priv(dev);

	seq_printf(seq, "Wake On Lan (WOL) type is (%d)\n", star_prv->wol);
	STAR_MSG(STAR_ERR, "Use 'echo 0 > /proc/driver/star/wol' switch to WOL_NONE\n");
	STAR_MSG(STAR_ERR, "Use 'echo 1 > /proc/driver/star/wol' switch to MAC_WOL\n");
	STAR_MSG(STAR_ERR, "Use 'echo 2 > /proc/driver/star/wol' switch to PHY_WOL\n");

	return 0;
}

static ssize_t wol_write(struct file *file, const char __user *buffer,
		      size_t count, loff_t *data)
{
	struct net_device *dev;
	star_private *star_prv;
	char *buf;

	buf = kmalloc(count + 1, GFP_KERNEL);
	if(copy_from_user(buf, buffer, count))
		return -EFAULT;

	buf[count] = '\0';
	dev = star_get_net_device();
	if (!dev) {
		STAR_MSG(STAR_ERR, "Could not get eth0 device!!!\n");
		return -1;
	}

	star_prv = netdev_priv(dev);
	star_prv->wol = buf[0] - '0';
	STAR_MSG(STAR_ERR, "Wake On Lan (WOL) type is (%d)\n", star_prv->wol);
	kfree(buf);

	return count;
}

static int wol_open(struct inode *inode, struct file *file)
{
	return single_open(file, get_wol_status, NULL);
}

static const struct file_operations star_wol_ops = {
	.owner 		= THIS_MODULE,
	.open	 	= wol_open,
	.read	 	= seq_read,
	.write		= wol_write,
};

static int get_wol_flag_status(struct seq_file *seq, void *v)
{
	struct net_device *dev;
	star_private *star_prv;

	dev = star_get_net_device();
	if (!dev) {
		STAR_MSG(STAR_ERR, "Could not get eth0 device!!!\n");
		return -1;
	}

	star_prv = netdev_priv(dev);
	seq_printf(seq, "Wake On Lan (WOL) flag is (%d)\n", star_prv->wol_flag);

	return 0;
}

static ssize_t wol_flag_write(struct file *file, const char __user *buffer,
		      size_t count, loff_t *data)
{
	struct net_device *dev;
	star_private *star_prv;
	star_dev *star_dev;
	char *buf;

	buf = kmalloc(count + 1, GFP_KERNEL);
	if(copy_from_user(buf, buffer, count))
		return -EFAULT;

	buf[count] = '\0';
	dev = star_get_net_device();
	if (!dev) {
		STAR_MSG(STAR_ERR, "Could not get eth0 device!!!\n");
		return -1;
	}

	star_prv = netdev_priv(dev);
	star_dev = &star_prv->star_dev;
	star_prv->wol_flag = buf[0] - '0';
	pr_err("Wake On Lan (WOL) flag is (%d)\n", star_prv->wol_flag);
	if (star_prv->wol == MAC_WOL) {
		if (star_prv->wol_flag == true) {
			star_config_wol(star_dev, true);
		} else {
			star_config_wol(star_dev, false);
		}
	} else if (star_prv->wol == PHY_WOL) {
		if (star_prv->wol_flag == true) {
			/*set ethernet phy wol setting*/
			if (star_dev->phy_ops->wol_enable)
				star_dev->phy_ops->wol_enable(star_prv->dev);
			enable_irq_wake(star_prv->eint_irq);
			pr_err("set ethernet phy wol setting done.\n");
		} else {
			/*clear ethernet phy wol setting*/
			if (star_dev->phy_ops->wol_disable)
				star_dev->phy_ops->wol_disable(star_prv->dev);
			disable_irq_wake(star_prv->eint_irq);
			pr_err("clear ethernet phy wol setting done.\n");
		}
	}
	kfree(buf);

	return count;
}

static int wol_flag_open(struct inode *inode, struct file *file)
{
	return single_open(file, get_wol_flag_status, NULL);
}

static const struct file_operations star_wol_flag_ops = {
	.owner 		= THIS_MODULE,
	.open	 	= wol_flag_open,
	.read	 	= seq_read,
	.write		= wol_flag_write,
};


static ssize_t proc_dump_net_stat(struct file *file,
				  char __user *buf, size_t count, loff_t *ppos)
{
	struct net_device *dev;
	star_private *star_prv;
	star_dev *star_dev;

	dev = star_get_net_device();
	if (!dev) {
		STAR_MSG(STAR_ERR, "Could not get eth0 device!!!\n");
		return -1;
	}

	star_prv = netdev_priv(dev);
	star_dev = &star_prv->star_dev;
	STAR_MSG(STAR_ERR, "\n");
	STAR_MSG(STAR_ERR, "rx_packets	=%lu  <total packets received>\n",
		 star_dev->stats.rx_packets);
	STAR_MSG(STAR_ERR, "tx_packets	=%lu  <total packets transmitted>\n",
		 star_dev->stats.tx_packets);
	STAR_MSG(STAR_ERR, "rx_bytes	=%lu  <total bytes received>\n",
		 star_dev->stats.rx_bytes);
	STAR_MSG(STAR_ERR, "tx_bytes	=%lu  <total bytes transmitted>\n",
		 star_dev->stats.tx_bytes);
	STAR_MSG(STAR_ERR, "rx_errors;	=%lu  <bad packets received>\n",
		 star_dev->stats.rx_errors);
	STAR_MSG(STAR_ERR, "tx_errors;	=%lu  <packet transmit problems>\n",
		 star_dev->stats.tx_errors);
	STAR_MSG(STAR_ERR, "rx_crc_errors =%lu  <recved pkt with crc error>\n",
		 star_dev->stats.rx_crc_errors);
	STAR_MSG(STAR_ERR, "\n");
	STAR_MSG(STAR_ERR,
		 "Use 'cat /proc/driver/star/stat' to dump net info\n");
	STAR_MSG(STAR_ERR,
		 "Use 'echo clear > /proc/driver/star/stat' to clear info\n");

	return 0;
}

static ssize_t proc_clear_net_stat(struct file *file,
				   const char __user *buffer,
				   size_t count, loff_t *pos)
{
	char *buf;
	struct net_device *ndev;
	star_private *star_prv;
	star_dev *star_dev;

	buf = kmalloc(count + 1, GFP_KERNEL);
	if (copy_from_user(buf, buffer, count))
		return -EFAULT;
	buf[count] = '\0';

	ndev = star_get_net_device();
	if (!ndev) {
		STAR_MSG(STAR_ERR, "Could not get eth0 device!!!\n");
		return -1;
	}

	star_prv = netdev_priv(ndev);
	star_dev = &star_prv->star_dev;

	if (!strncmp(buf, "clear", count - 1))
		memset(&star_dev->stats, 0, sizeof(struct net_device_stats));
	else
		STAR_MSG(STAR_ERR, "fail to clear stat, buf:%s\n", buf);

	kfree(buf);

	return count;
}

static const struct file_operations star_net_status_ops = {
	.read = proc_dump_net_stat,
	.write = proc_clear_net_stat,
};

void star_set_dbg_level(int dbg)
{
	star_dbg_level = dbg;
}

int star_get_dbg_level(void)
{
	return star_dbg_level;
}

static ssize_t proc_get_dbg_lvl(struct file *file,
					char __user *buf, size_t count, loff_t *ppos)
{
	switch(star_get_dbg_level()) {
		case STAR_ERR:
			STAR_MSG(STAR_ERR, "star dbglvl: STAR_ERR\n");
			break;
		case STAR_WARN:
			STAR_MSG(STAR_ERR, "star dbglvl: STAR_WARN\n");
			break;
		case STAR_DBG:
			STAR_MSG(STAR_ERR, "star dbglvl: STAR_DBG\n");
			break;
		case STAR_VERB:
			STAR_MSG(STAR_ERR, "star dbglvl: STAR_VERB\n");
			break;
		case STAR_DBG_MAX:
			STAR_MSG(STAR_ERR, "star dbglvl: STAR_DBG_MAX\n");
			break;
	}

	STAR_MSG(STAR_ERR, "Useage:\n");
	STAR_MSG(STAR_ERR, "  echo err > dbglvl\n");
	STAR_MSG(STAR_ERR, "  echo warn > dbglvl\n");
	STAR_MSG(STAR_ERR, "  echo dbg > dbglvl\n");
	STAR_MSG(STAR_ERR, "  echo verb > dbglvl\n");
	STAR_MSG(STAR_ERR, "  echo max > dbglvl\n");

    return 0;
}

static ssize_t proc_set_dbg_lvl(struct file *file,
				const char __user *buffer,
				size_t count, loff_t *pos)
{
	char *buf, *tmp;

	tmp = kmalloc(count + 1, GFP_KERNEL);
	buf = tmp;
	if (copy_from_user(buf, buffer, count))
	        return -EFAULT;
	buf[count] = '\0';

	if (str_cmp_seq(&buf, "err"))
		star_set_dbg_level(STAR_ERR);
	else if (str_cmp_seq(&buf, "warn"))
		star_set_dbg_level(STAR_WARN);
	else if (str_cmp_seq(&buf, "dbg"))
		star_set_dbg_level(STAR_DBG);
	else if (str_cmp_seq(&buf, "verb"))
		star_set_dbg_level(STAR_VERB);
	else if (str_cmp_seq(&buf, "max"))
		star_set_dbg_level(STAR_DBG_MAX);
	else
		STAR_MSG(STAR_ERR, "wrong arg:%s\n", buf);

	kfree(tmp);

	return count;
}

static const struct file_operations star_dbg_lvl_ops = {
    .read = proc_get_dbg_lvl,
    .write = proc_set_dbg_lvl,
};

static struct star_proc_file star_file_tbl[] = {
	{"phy_reg", &star_phy_reg_ops},
	{"macreg", &star_mac_reg_ops},
	{"wol", &star_wol_ops},
	{"wol_flag", &star_wol_flag_ops},
	{"stat", &star_net_status_ops},
	{"dbglvl", &star_dbg_lvl_ops},
};

int star_init_procfs(void)
{
	int i;

	STAR_MSG(STAR_ERR, "%s entered\n", __func__);
	star_proc.root = proc_mkdir("driver/star", NULL);
	if (!star_proc.root) {
		STAR_MSG(STAR_ERR, "star_proc_dir create failed\n");
		return -1;
	}

	star_proc.entry = kmalloc(ARRAY_SIZE(star_file_tbl) *
				  sizeof(struct star_proc_file), GFP_KERNEL);
	for (i = 0 ; i < ARRAY_SIZE(star_file_tbl); i++) {
		star_proc.entry[i] = proc_create(star_file_tbl[i].name,
			0755, star_proc.root, star_file_tbl[i].fops);
		if (!star_proc.entry[i]) {
			STAR_MSG(STAR_ERR,
				 "%s create failed\n", star_file_tbl[i].name);
			return -1;
		}
	}

	return 0;
}

void star_exit_procfs(void)
{
	int i;

	STAR_MSG(STAR_ERR, "%s entered\n", __func__);
	for (i = 0 ; i < ARRAY_SIZE(star_file_tbl); i++)
		remove_proc_entry(star_file_tbl[i].name, star_proc.root);

	kfree(star_proc.entry);
	remove_proc_entry("driver/star", NULL);
	star_put_net_device();
}