openEuler_kernel_rk3588/drivers/net/ethernet/mucse/rnpgbe/rnpgbe_debugfs.c

// SPDX-License-Identifier: GPL-2.0
/* Copyright(c) 2022 - 2024 Mucse Corporation. */

#include <linux/debugfs.h>
#include <linux/module.h>

#include "rnpgbe.h"

static struct dentry *rnpgbe_dbg_root;

static char rnpgbe_dbg_reg_ops_buf[256] = "";

/**
 * rnpgbe_dbg_reg_ops_read - read for reg_ops datum
 * @filp: the opened file
 * @buffer: where to write the data for the user to read
 * @count: the size of the user's buffer
 * @ppos: file position offset
 **/
static ssize_t rnpgbe_dbg_reg_ops_read(struct file *filp, char __user *buffer,
				       size_t count, loff_t *ppos)
{
	struct rnpgbe_adapter *adapter = filp->private_data;
	char *buf;
	int len;

	/* don't allow partial reads */
	if (*ppos != 0)
		return 0;

	buf = kasprintf(GFP_KERNEL, "%s: %s\n", adapter->name,
			rnpgbe_dbg_reg_ops_buf);
	if (!buf)
		return -ENOMEM;

	if (count < strlen(buf)) {
		kfree(buf);
		return -ENOSPC;
	}

	len = simple_read_from_buffer(buffer, count, ppos, buf, strlen(buf));

	kfree(buf);
	return len;
}

/**
 * rnpgbe_dbg_reg_ops_write - write into reg_ops datum
 * @filp: the opened file
 * @buffer: where to find the user's data
 * @count: the length of the user's data
 * @ppos: file position offset
 **/
static ssize_t rnpgbe_dbg_reg_ops_write(struct file *filp,
					const char __user *buffer, size_t count,
					loff_t *ppos)
{
	struct rnpgbe_adapter *adapter = filp->private_data;
	struct rnpgbe_hw *hw = &adapter->hw;
	int len;

	/* don't allow partial writes */
	if (*ppos != 0)
		return 0;
	if (count >= sizeof(rnpgbe_dbg_reg_ops_buf))
		return -ENOSPC;

	len = simple_write_to_buffer(rnpgbe_dbg_reg_ops_buf,
				     sizeof(rnpgbe_dbg_reg_ops_buf) - 1, ppos,
				     buffer, count);
	if (len < 0)
		return len;

	rnpgbe_dbg_reg_ops_buf[len] = '\0';

	if (strncmp(rnpgbe_dbg_reg_ops_buf, "write", 5) == 0) {
		u32 reg, value;
		int cnt;

		cnt = sscanf(&rnpgbe_dbg_reg_ops_buf[5], "%x %x", &reg, &value);
		if (cnt == 2) {
			if (reg >= 0x30000000) {
				rnpgbe_mbx_reg_write(hw, reg, value);
				e_dev_info("write: 0x%08x = 0x%08x\n", reg,
					   value);
			} else {
				rnpgbe_wr_reg(hw->hw_addr + reg, value);
				value = rnpgbe_rd_reg(hw->hw_addr + reg);
				e_dev_info("write: 0x%08x = 0x%08x\n", reg,
					   value);
			}
		} else {
			e_dev_info("write <reg> <value>\n");
		}
	} else if (strncmp(rnpgbe_dbg_reg_ops_buf, "read", 4) == 0) {
		u32 reg, value;
		int cnt;

		cnt = sscanf(&rnpgbe_dbg_reg_ops_buf[4], "%x", &reg);
		if (cnt == 1) {
			if (reg >= 0x30000000)
				value = rnpgbe_mbx_fw_reg_read(hw, reg);
			else
				value = rnpgbe_rd_reg(hw->hw_addr + reg);

			snprintf(rnpgbe_dbg_reg_ops_buf,
				 sizeof(rnpgbe_dbg_reg_ops_buf),
				 "0x%08x: 0x%08x", reg, value);
			e_dev_info("read 0x%08x = 0x%08x\n", reg, value);
		} else {
			e_dev_info("read <reg>\n");
		}
	} else {
		e_dev_info("Unknown command %s\n", rnpgbe_dbg_reg_ops_buf);
		e_dev_info("Available commands:\n");
		e_dev_info("   read <reg>\n");
		e_dev_info("   write <reg> <value>\n");
	}
	return count;
}

static const struct file_operations rnpgbe_dbg_reg_ops_fops = {
	.owner = THIS_MODULE,
	.open = simple_open,
	.read = rnpgbe_dbg_reg_ops_read,
	.write = rnpgbe_dbg_reg_ops_write,
};

static char rnpgbe_dbg_netdev_ops_buf[256] = "";

/**
 * rnpgbe_dbg_netdev_ops_read - read for netdev_ops datum
 * @filp: the opened file
 * @buffer: where to write the data for the user to read
 * @count: the size of the user's buffer
 * @ppos: file position offset
 **/
static ssize_t rnpgbe_dbg_netdev_ops_read(struct file *filp,
					  char __user *buffer, size_t count,
					  loff_t *ppos)
{
	struct rnpgbe_adapter *adapter = filp->private_data;
	char *buf;
	int len;

	/* don't allow partial reads */
	if (*ppos != 0)
		return 0;

	buf = kasprintf(GFP_KERNEL, "%s: %s\n", adapter->name,
			rnpgbe_dbg_netdev_ops_buf);
	if (!buf)
		return -ENOMEM;

	if (count < strlen(buf)) {
		kfree(buf);
		return -ENOSPC;
	}

	len = simple_read_from_buffer(buffer, count, ppos, buf, strlen(buf));

	kfree(buf);
	return len;
}

/**
 * rnpgbe_dbg_netdev_ops_write - write into netdev_ops datum
 * @filp: the opened file
 * @buffer: where to find the user's data
 * @count: the length of the user's data
 * @ppos: file position offset
 **/
static ssize_t rnpgbe_dbg_netdev_ops_write(struct file *filp,
					   const char __user *buffer,
					   size_t count, loff_t *ppos)
{
	struct rnpgbe_adapter *adapter = filp->private_data;
	int len;

	/* don't allow partial writes */
	if (*ppos != 0)
		return 0;
	if (count >= sizeof(rnpgbe_dbg_netdev_ops_buf))
		return -ENOSPC;

	len = simple_write_to_buffer(rnpgbe_dbg_netdev_ops_buf,
				     sizeof(rnpgbe_dbg_netdev_ops_buf) - 1,
				     ppos, buffer, count);
	if (len < 0)
		return len;

	rnpgbe_dbg_netdev_ops_buf[len] = '\0';

	if (strncmp(rnpgbe_dbg_netdev_ops_buf, "stat", 4) == 0) {
		rnpgbe_info("adapter->stat=0x%lx\n", adapter->state);
		rnpgbe_info("adapter->tx_timeout_count=%d\n",
			    adapter->tx_timeout_count);
	} else if (strncmp(rnpgbe_dbg_netdev_ops_buf, "tx_timeout", 10) == 0) {
		adapter->netdev->netdev_ops->ndo_tx_timeout(adapter->netdev,
				UINT_MAX);
		e_dev_info("tx_timeout called\n");
	} else {
		e_dev_info("Unknown command: %s\n", rnpgbe_dbg_netdev_ops_buf);
		e_dev_info("Available commands:\n");
		e_dev_info("    tx_timeout\n");
	}
	return count;
}

static const struct file_operations rnpgbe_dbg_netdev_ops_fops = {
	.owner = THIS_MODULE,
	.open = simple_open,
	.read = rnpgbe_dbg_netdev_ops_read,
	.write = rnpgbe_dbg_netdev_ops_write,
};

static ssize_t rnpgbe_dbg_netdev_temp_read(struct file *filp,
					   char __user *buffer, size_t count,
					   loff_t *ppos)
{
	struct rnpgbe_adapter *adapter = filp->private_data;
	struct rnpgbe_hw *hw = &adapter->hw;
	char *buf;
	int len;
	int temp = 0, voltage = 0;

	/* don't allow partial reads */
	if (*ppos != 0)
		return 0;

	temp = rnpgbe_mbx_get_temp(hw, &voltage);

	buf = kasprintf(GFP_KERNEL, "%s: temp: %d oC voltage:%d mV\n",
			adapter->name, temp, voltage);
	if (!buf)
		return -ENOMEM;

	if (count < strlen(buf)) {
		kfree(buf);
		return -ENOSPC;
	}

	len = simple_read_from_buffer(buffer, count, ppos, buf, strlen(buf));

	kfree(buf);
	return len;
}

static const struct file_operations rnpgbe_dbg_netdev_temp = {
	.owner = THIS_MODULE,
	.open = simple_open,
	.read = rnpgbe_dbg_netdev_temp_read,
};

/**
 * rnpgbe_dbg_adapter_init - setup the debugfs directory for the adapter
 * @adapter: the adapter that is starting up
 **/
void rnpgbe_dbg_adapter_init(struct rnpgbe_adapter *adapter)
{
	const char *name = adapter->name;
	struct dentry *pfile;

	adapter->rnpgbe_dbg_adapter = debugfs_create_dir(name, rnpgbe_dbg_root);
	if (adapter->rnpgbe_dbg_adapter) {
		pfile = debugfs_create_file("reg_ops", 0600,
					    adapter->rnpgbe_dbg_adapter,
					    adapter, &rnpgbe_dbg_reg_ops_fops);
		if (!pfile)
			e_dev_err("debugfs reg_ops for %s failed\n", name);
		pfile = debugfs_create_file("netdev_ops", 0600,
					    adapter->rnpgbe_dbg_adapter,
					    adapter,
					    &rnpgbe_dbg_netdev_ops_fops);
		if (!pfile)
			e_dev_err("debugfs netdev_ops for %s failed\n", name);

		pfile = debugfs_create_file("temp", 0600,
					    adapter->rnpgbe_dbg_adapter,
					    adapter, &rnpgbe_dbg_netdev_temp);
		if (!pfile)
			e_dev_err("debugfs temp for %s failed\n", name);
	} else {
		e_dev_err("debugfs entry for %s failed\n", name);
	}
}

/**
 * rnpgbe_dbg_adapter_exit - clear out the adapter's debugfs entries
 * @adapter: the pf that is stopping
 **/
void rnpgbe_dbg_adapter_exit(struct rnpgbe_adapter *adapter)
{
	debugfs_remove_recursive(adapter->rnpgbe_dbg_adapter);
	adapter->rnpgbe_dbg_adapter = NULL;
}

/**
 * rnpgbe_dbg_init - start up debugfs for the driver
 **/
void rnpgbe_dbg_init(void)
{
	rnpgbe_dbg_root = debugfs_create_dir(rnpgbe_driver_name, NULL);
	if (!rnpgbe_dbg_root)
		pr_err("init of debugfs failed\n");
}

/**
 * rnpgbe_dbg_exit - clean out the driver's debugfs entries
 **/
void rnpgbe_dbg_exit(void)
{
	debugfs_remove_recursive(rnpgbe_dbg_root);
}