162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci *  skl-debug.c - Debugfs for skl driver
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci *  Copyright (C) 2016-17 Intel Corp
662306a36Sopenharmony_ci */
762306a36Sopenharmony_ci
862306a36Sopenharmony_ci#include <linux/pci.h>
962306a36Sopenharmony_ci#include <linux/debugfs.h>
1062306a36Sopenharmony_ci#include <uapi/sound/skl-tplg-interface.h>
1162306a36Sopenharmony_ci#include "skl.h"
1262306a36Sopenharmony_ci#include "skl-sst-dsp.h"
1362306a36Sopenharmony_ci#include "skl-sst-ipc.h"
1462306a36Sopenharmony_ci#include "skl-topology.h"
1562306a36Sopenharmony_ci#include "../common/sst-dsp.h"
1662306a36Sopenharmony_ci#include "../common/sst-dsp-priv.h"
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ci#define MOD_BUF		PAGE_SIZE
1962306a36Sopenharmony_ci#define FW_REG_BUF	PAGE_SIZE
2062306a36Sopenharmony_ci#define FW_REG_SIZE	0x60
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_cistruct skl_debug {
2362306a36Sopenharmony_ci	struct skl_dev *skl;
2462306a36Sopenharmony_ci	struct device *dev;
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_ci	struct dentry *fs;
2762306a36Sopenharmony_ci	struct dentry *modules;
2862306a36Sopenharmony_ci	u8 fw_read_buff[FW_REG_BUF];
2962306a36Sopenharmony_ci};
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_cistatic ssize_t skl_print_pins(struct skl_module_pin *m_pin, char *buf,
3262306a36Sopenharmony_ci				int max_pin, ssize_t size, bool direction)
3362306a36Sopenharmony_ci{
3462306a36Sopenharmony_ci	int i;
3562306a36Sopenharmony_ci	ssize_t ret = 0;
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_ci	for (i = 0; i < max_pin; i++) {
3862306a36Sopenharmony_ci		ret += scnprintf(buf + size, MOD_BUF - size,
3962306a36Sopenharmony_ci				"%s %d\n\tModule %d\n\tInstance %d\n\t"
4062306a36Sopenharmony_ci				"In-used %s\n\tType %s\n"
4162306a36Sopenharmony_ci				"\tState %d\n\tIndex %d\n",
4262306a36Sopenharmony_ci				direction ? "Input Pin:" : "Output Pin:",
4362306a36Sopenharmony_ci				i, m_pin[i].id.module_id,
4462306a36Sopenharmony_ci				m_pin[i].id.instance_id,
4562306a36Sopenharmony_ci				m_pin[i].in_use ? "Used" : "Unused",
4662306a36Sopenharmony_ci				m_pin[i].is_dynamic ? "Dynamic" : "Static",
4762306a36Sopenharmony_ci				m_pin[i].pin_state, i);
4862306a36Sopenharmony_ci		size += ret;
4962306a36Sopenharmony_ci	}
5062306a36Sopenharmony_ci	return ret;
5162306a36Sopenharmony_ci}
5262306a36Sopenharmony_ci
5362306a36Sopenharmony_cistatic ssize_t skl_print_fmt(struct skl_module_fmt *fmt, char *buf,
5462306a36Sopenharmony_ci					ssize_t size, bool direction)
5562306a36Sopenharmony_ci{
5662306a36Sopenharmony_ci	return scnprintf(buf + size, MOD_BUF - size,
5762306a36Sopenharmony_ci			"%s\n\tCh %d\n\tFreq %d\n\tBit depth %d\n\t"
5862306a36Sopenharmony_ci			"Valid bit depth %d\n\tCh config %#x\n\tInterleaving %d\n\t"
5962306a36Sopenharmony_ci			"Sample Type %d\n\tCh Map %#x\n",
6062306a36Sopenharmony_ci			direction ? "Input Format:" : "Output Format:",
6162306a36Sopenharmony_ci			fmt->channels, fmt->s_freq, fmt->bit_depth,
6262306a36Sopenharmony_ci			fmt->valid_bit_depth, fmt->ch_cfg,
6362306a36Sopenharmony_ci			fmt->interleaving_style, fmt->sample_type,
6462306a36Sopenharmony_ci			fmt->ch_map);
6562306a36Sopenharmony_ci}
6662306a36Sopenharmony_ci
6762306a36Sopenharmony_cistatic ssize_t module_read(struct file *file, char __user *user_buf,
6862306a36Sopenharmony_ci			   size_t count, loff_t *ppos)
6962306a36Sopenharmony_ci{
7062306a36Sopenharmony_ci	struct skl_module_cfg *mconfig = file->private_data;
7162306a36Sopenharmony_ci	struct skl_module *module = mconfig->module;
7262306a36Sopenharmony_ci	struct skl_module_res *res = &module->resources[mconfig->res_idx];
7362306a36Sopenharmony_ci	char *buf;
7462306a36Sopenharmony_ci	ssize_t ret;
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_ci	buf = kzalloc(MOD_BUF, GFP_KERNEL);
7762306a36Sopenharmony_ci	if (!buf)
7862306a36Sopenharmony_ci		return -ENOMEM;
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_ci	ret = scnprintf(buf, MOD_BUF, "Module:\n\tUUID %pUL\n\tModule id %d\n"
8162306a36Sopenharmony_ci			"\tInstance id %d\n\tPvt_id %d\n", mconfig->guid,
8262306a36Sopenharmony_ci			mconfig->id.module_id, mconfig->id.instance_id,
8362306a36Sopenharmony_ci			mconfig->id.pvt_id);
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_ci	ret += scnprintf(buf + ret, MOD_BUF - ret,
8662306a36Sopenharmony_ci			"Resources:\n\tCPC %#x\n\tIBS %#x\n\tOBS %#x\t\n",
8762306a36Sopenharmony_ci			res->cpc, res->ibs, res->obs);
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_ci	ret += scnprintf(buf + ret, MOD_BUF - ret,
9062306a36Sopenharmony_ci			"Module data:\n\tCore %d\n\tIn queue %d\n\t"
9162306a36Sopenharmony_ci			"Out queue %d\n\tType %s\n",
9262306a36Sopenharmony_ci			mconfig->core_id, mconfig->max_in_queue,
9362306a36Sopenharmony_ci			mconfig->max_out_queue,
9462306a36Sopenharmony_ci			mconfig->is_loadable ? "loadable" : "inbuilt");
9562306a36Sopenharmony_ci
9662306a36Sopenharmony_ci	ret += skl_print_fmt(mconfig->in_fmt, buf, ret, true);
9762306a36Sopenharmony_ci	ret += skl_print_fmt(mconfig->out_fmt, buf, ret, false);
9862306a36Sopenharmony_ci
9962306a36Sopenharmony_ci	ret += scnprintf(buf + ret, MOD_BUF - ret,
10062306a36Sopenharmony_ci			"Fixup:\n\tParams %#x\n\tConverter %#x\n",
10162306a36Sopenharmony_ci			mconfig->params_fixup, mconfig->converter);
10262306a36Sopenharmony_ci
10362306a36Sopenharmony_ci	ret += scnprintf(buf + ret, MOD_BUF - ret,
10462306a36Sopenharmony_ci			"Module Gateway:\n\tType %#x\n\tVbus %#x\n\tHW conn %#x\n\tSlot %#x\n",
10562306a36Sopenharmony_ci			mconfig->dev_type, mconfig->vbus_id,
10662306a36Sopenharmony_ci			mconfig->hw_conn_type, mconfig->time_slot);
10762306a36Sopenharmony_ci
10862306a36Sopenharmony_ci	ret += scnprintf(buf + ret, MOD_BUF - ret,
10962306a36Sopenharmony_ci			"Pipeline:\n\tID %d\n\tPriority %d\n\tConn Type %d\n\t"
11062306a36Sopenharmony_ci			"Pages %#x\n", mconfig->pipe->ppl_id,
11162306a36Sopenharmony_ci			mconfig->pipe->pipe_priority, mconfig->pipe->conn_type,
11262306a36Sopenharmony_ci			mconfig->pipe->memory_pages);
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_ci	ret += scnprintf(buf + ret, MOD_BUF - ret,
11562306a36Sopenharmony_ci			"\tParams:\n\t\tHost DMA %d\n\t\tLink DMA %d\n",
11662306a36Sopenharmony_ci			mconfig->pipe->p_params->host_dma_id,
11762306a36Sopenharmony_ci			mconfig->pipe->p_params->link_dma_id);
11862306a36Sopenharmony_ci
11962306a36Sopenharmony_ci	ret += scnprintf(buf + ret, MOD_BUF - ret,
12062306a36Sopenharmony_ci			"\tPCM params:\n\t\tCh %d\n\t\tFreq %d\n\t\tFormat %d\n",
12162306a36Sopenharmony_ci			mconfig->pipe->p_params->ch,
12262306a36Sopenharmony_ci			mconfig->pipe->p_params->s_freq,
12362306a36Sopenharmony_ci			mconfig->pipe->p_params->s_fmt);
12462306a36Sopenharmony_ci
12562306a36Sopenharmony_ci	ret += scnprintf(buf + ret, MOD_BUF - ret,
12662306a36Sopenharmony_ci			"\tLink %#x\n\tStream %#x\n",
12762306a36Sopenharmony_ci			mconfig->pipe->p_params->linktype,
12862306a36Sopenharmony_ci			mconfig->pipe->p_params->stream);
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_ci	ret += scnprintf(buf + ret, MOD_BUF - ret,
13162306a36Sopenharmony_ci			"\tState %d\n\tPassthru %s\n",
13262306a36Sopenharmony_ci			mconfig->pipe->state,
13362306a36Sopenharmony_ci			mconfig->pipe->passthru ? "true" : "false");
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_ci	ret += skl_print_pins(mconfig->m_in_pin, buf,
13662306a36Sopenharmony_ci			mconfig->max_in_queue, ret, true);
13762306a36Sopenharmony_ci	ret += skl_print_pins(mconfig->m_out_pin, buf,
13862306a36Sopenharmony_ci			mconfig->max_out_queue, ret, false);
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_ci	ret += scnprintf(buf + ret, MOD_BUF - ret,
14162306a36Sopenharmony_ci			"Other:\n\tDomain %d\n\tHomogeneous Input %s\n\t"
14262306a36Sopenharmony_ci			"Homogeneous Output %s\n\tIn Queue Mask %d\n\t"
14362306a36Sopenharmony_ci			"Out Queue Mask %d\n\tDMA ID %d\n\tMem Pages %d\n\t"
14462306a36Sopenharmony_ci			"Module Type %d\n\tModule State %d\n",
14562306a36Sopenharmony_ci			mconfig->domain,
14662306a36Sopenharmony_ci			mconfig->homogenous_inputs ? "true" : "false",
14762306a36Sopenharmony_ci			mconfig->homogenous_outputs ? "true" : "false",
14862306a36Sopenharmony_ci			mconfig->in_queue_mask, mconfig->out_queue_mask,
14962306a36Sopenharmony_ci			mconfig->dma_id, mconfig->mem_pages, mconfig->m_state,
15062306a36Sopenharmony_ci			mconfig->m_type);
15162306a36Sopenharmony_ci
15262306a36Sopenharmony_ci	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
15362306a36Sopenharmony_ci
15462306a36Sopenharmony_ci	kfree(buf);
15562306a36Sopenharmony_ci	return ret;
15662306a36Sopenharmony_ci}
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_cistatic const struct file_operations mcfg_fops = {
15962306a36Sopenharmony_ci	.open = simple_open,
16062306a36Sopenharmony_ci	.read = module_read,
16162306a36Sopenharmony_ci	.llseek = default_llseek,
16262306a36Sopenharmony_ci};
16362306a36Sopenharmony_ci
16462306a36Sopenharmony_ci
16562306a36Sopenharmony_civoid skl_debug_init_module(struct skl_debug *d,
16662306a36Sopenharmony_ci			struct snd_soc_dapm_widget *w,
16762306a36Sopenharmony_ci			struct skl_module_cfg *mconfig)
16862306a36Sopenharmony_ci{
16962306a36Sopenharmony_ci	debugfs_create_file(w->name, 0444, d->modules, mconfig,
17062306a36Sopenharmony_ci			    &mcfg_fops);
17162306a36Sopenharmony_ci}
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_cistatic ssize_t fw_softreg_read(struct file *file, char __user *user_buf,
17462306a36Sopenharmony_ci			       size_t count, loff_t *ppos)
17562306a36Sopenharmony_ci{
17662306a36Sopenharmony_ci	struct skl_debug *d = file->private_data;
17762306a36Sopenharmony_ci	struct sst_dsp *sst = d->skl->dsp;
17862306a36Sopenharmony_ci	size_t w0_stat_sz = sst->addr.w0_stat_sz;
17962306a36Sopenharmony_ci	void __iomem *in_base = sst->mailbox.in_base;
18062306a36Sopenharmony_ci	void __iomem *fw_reg_addr;
18162306a36Sopenharmony_ci	unsigned int offset;
18262306a36Sopenharmony_ci	char *tmp;
18362306a36Sopenharmony_ci	ssize_t ret = 0;
18462306a36Sopenharmony_ci
18562306a36Sopenharmony_ci	tmp = kzalloc(FW_REG_BUF, GFP_KERNEL);
18662306a36Sopenharmony_ci	if (!tmp)
18762306a36Sopenharmony_ci		return -ENOMEM;
18862306a36Sopenharmony_ci
18962306a36Sopenharmony_ci	fw_reg_addr = in_base - w0_stat_sz;
19062306a36Sopenharmony_ci	memset(d->fw_read_buff, 0, FW_REG_BUF);
19162306a36Sopenharmony_ci
19262306a36Sopenharmony_ci	if (w0_stat_sz > 0)
19362306a36Sopenharmony_ci		__ioread32_copy(d->fw_read_buff, fw_reg_addr, w0_stat_sz >> 2);
19462306a36Sopenharmony_ci
19562306a36Sopenharmony_ci	for (offset = 0; offset < FW_REG_SIZE; offset += 16) {
19662306a36Sopenharmony_ci		ret += scnprintf(tmp + ret, FW_REG_BUF - ret, "%#.4x: ", offset);
19762306a36Sopenharmony_ci		hex_dump_to_buffer(d->fw_read_buff + offset, 16, 16, 4,
19862306a36Sopenharmony_ci				   tmp + ret, FW_REG_BUF - ret, 0);
19962306a36Sopenharmony_ci		ret += strlen(tmp + ret);
20062306a36Sopenharmony_ci
20162306a36Sopenharmony_ci		/* print newline for each offset */
20262306a36Sopenharmony_ci		if (FW_REG_BUF - ret > 0)
20362306a36Sopenharmony_ci			tmp[ret++] = '\n';
20462306a36Sopenharmony_ci	}
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_ci	ret = simple_read_from_buffer(user_buf, count, ppos, tmp, ret);
20762306a36Sopenharmony_ci	kfree(tmp);
20862306a36Sopenharmony_ci
20962306a36Sopenharmony_ci	return ret;
21062306a36Sopenharmony_ci}
21162306a36Sopenharmony_ci
21262306a36Sopenharmony_cistatic const struct file_operations soft_regs_ctrl_fops = {
21362306a36Sopenharmony_ci	.open = simple_open,
21462306a36Sopenharmony_ci	.read = fw_softreg_read,
21562306a36Sopenharmony_ci	.llseek = default_llseek,
21662306a36Sopenharmony_ci};
21762306a36Sopenharmony_ci
21862306a36Sopenharmony_cistruct skl_debug *skl_debugfs_init(struct skl_dev *skl)
21962306a36Sopenharmony_ci{
22062306a36Sopenharmony_ci	struct skl_debug *d;
22162306a36Sopenharmony_ci
22262306a36Sopenharmony_ci	d = devm_kzalloc(&skl->pci->dev, sizeof(*d), GFP_KERNEL);
22362306a36Sopenharmony_ci	if (!d)
22462306a36Sopenharmony_ci		return NULL;
22562306a36Sopenharmony_ci
22662306a36Sopenharmony_ci	/* create the debugfs dir with platform component's debugfs as parent */
22762306a36Sopenharmony_ci	d->fs = debugfs_create_dir("dsp", skl->component->debugfs_root);
22862306a36Sopenharmony_ci
22962306a36Sopenharmony_ci	d->skl = skl;
23062306a36Sopenharmony_ci	d->dev = &skl->pci->dev;
23162306a36Sopenharmony_ci
23262306a36Sopenharmony_ci	/* now create the module dir */
23362306a36Sopenharmony_ci	d->modules = debugfs_create_dir("modules", d->fs);
23462306a36Sopenharmony_ci
23562306a36Sopenharmony_ci	debugfs_create_file("fw_soft_regs_rd", 0444, d->fs, d,
23662306a36Sopenharmony_ci			    &soft_regs_ctrl_fops);
23762306a36Sopenharmony_ci
23862306a36Sopenharmony_ci	return d;
23962306a36Sopenharmony_ci}
24062306a36Sopenharmony_ci
24162306a36Sopenharmony_civoid skl_debugfs_exit(struct skl_dev *skl)
24262306a36Sopenharmony_ci{
24362306a36Sopenharmony_ci	struct skl_debug *d = skl->debugfs;
24462306a36Sopenharmony_ci
24562306a36Sopenharmony_ci	debugfs_remove_recursive(d->fs);
24662306a36Sopenharmony_ci
24762306a36Sopenharmony_ci	d = NULL;
24862306a36Sopenharmony_ci}
249