ASoC: Intel: Skylake: Add support to read firmware registers
This patch adds debugfs support to read fw registers, mailbox offsets and sram address. Signed-off-by: Mousumi Jana <mousumix.jana@intel.com> Signed-off-by: Ramesh Babu <ramesh.babu@intel.com> Signed-off-by: Jayachandran B <jayachandran.b@intel.com> Signed-off-by: Pardha Saradhi K <pardha.saradhi.kesapragada@intel.com> Signed-off-by: Vunny Sodhi <vunnyx.sodhi@intel.com> Signed-off-by: Guneshwor Singh <guneshwor.o.singh@intel.com> Acked-By: Vinod Koul <vinod.koul@intel.com> Signed-off-by: Mark Brown <broonie@kernel.org>
This commit is contained in:
parent
09e914d6b6
commit
bdd0384a5a
1 changed files with 57 additions and 0 deletions
|
@ -16,10 +16,15 @@
|
||||||
#include <linux/pci.h>
|
#include <linux/pci.h>
|
||||||
#include <linux/debugfs.h>
|
#include <linux/debugfs.h>
|
||||||
#include "skl.h"
|
#include "skl.h"
|
||||||
|
#include "skl-sst-dsp.h"
|
||||||
|
#include "skl-sst-ipc.h"
|
||||||
#include "skl-tplg-interface.h"
|
#include "skl-tplg-interface.h"
|
||||||
#include "skl-topology.h"
|
#include "skl-topology.h"
|
||||||
|
#include "../common/sst-dsp-priv.h"
|
||||||
|
|
||||||
#define MOD_BUF PAGE_SIZE
|
#define MOD_BUF PAGE_SIZE
|
||||||
|
#define FW_REG_BUF PAGE_SIZE
|
||||||
|
#define FW_REG_SIZE 0x60
|
||||||
|
|
||||||
struct skl_debug {
|
struct skl_debug {
|
||||||
struct skl *skl;
|
struct skl *skl;
|
||||||
|
@ -27,6 +32,7 @@ struct skl_debug {
|
||||||
|
|
||||||
struct dentry *fs;
|
struct dentry *fs;
|
||||||
struct dentry *modules;
|
struct dentry *modules;
|
||||||
|
u8 fw_read_buff[FW_REG_BUF];
|
||||||
};
|
};
|
||||||
|
|
||||||
static ssize_t skl_print_pins(struct skl_module_pin *m_pin, char *buf,
|
static ssize_t skl_print_pins(struct skl_module_pin *m_pin, char *buf,
|
||||||
|
@ -169,6 +175,51 @@ void skl_debug_init_module(struct skl_debug *d,
|
||||||
dev_err(d->dev, "%s: module debugfs init failed\n", w->name);
|
dev_err(d->dev, "%s: module debugfs init failed\n", w->name);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static ssize_t fw_softreg_read(struct file *file, char __user *user_buf,
|
||||||
|
size_t count, loff_t *ppos)
|
||||||
|
{
|
||||||
|
struct skl_debug *d = file->private_data;
|
||||||
|
struct sst_dsp *sst = d->skl->skl_sst->dsp;
|
||||||
|
size_t w0_stat_sz = sst->addr.w0_stat_sz;
|
||||||
|
void __iomem *in_base = sst->mailbox.in_base;
|
||||||
|
void __iomem *fw_reg_addr;
|
||||||
|
unsigned int offset;
|
||||||
|
char *tmp;
|
||||||
|
ssize_t ret = 0;
|
||||||
|
|
||||||
|
tmp = kzalloc(FW_REG_BUF, GFP_KERNEL);
|
||||||
|
if (!tmp)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
fw_reg_addr = in_base - w0_stat_sz;
|
||||||
|
memset(d->fw_read_buff, 0, FW_REG_BUF);
|
||||||
|
|
||||||
|
if (w0_stat_sz > 0)
|
||||||
|
__iowrite32_copy(d->fw_read_buff, fw_reg_addr, w0_stat_sz >> 2);
|
||||||
|
|
||||||
|
for (offset = 0; offset < FW_REG_SIZE; offset += 16) {
|
||||||
|
ret += snprintf(tmp + ret, FW_REG_BUF - ret, "%#.4x: ", offset);
|
||||||
|
hex_dump_to_buffer(d->fw_read_buff + offset, 16, 16, 4,
|
||||||
|
tmp + ret, FW_REG_BUF - ret, 0);
|
||||||
|
ret += strlen(tmp + ret);
|
||||||
|
|
||||||
|
/* print newline for each offset */
|
||||||
|
if (FW_REG_BUF - ret > 0)
|
||||||
|
tmp[ret++] = '\n';
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = simple_read_from_buffer(user_buf, count, ppos, tmp, ret);
|
||||||
|
kfree(tmp);
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static const struct file_operations soft_regs_ctrl_fops = {
|
||||||
|
.open = simple_open,
|
||||||
|
.read = fw_softreg_read,
|
||||||
|
.llseek = default_llseek,
|
||||||
|
};
|
||||||
|
|
||||||
struct skl_debug *skl_debugfs_init(struct skl *skl)
|
struct skl_debug *skl_debugfs_init(struct skl *skl)
|
||||||
{
|
{
|
||||||
struct skl_debug *d;
|
struct skl_debug *d;
|
||||||
|
@ -195,6 +246,12 @@ struct skl_debug *skl_debugfs_init(struct skl *skl)
|
||||||
goto err;
|
goto err;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
if (!debugfs_create_file("fw_soft_regs_rd", 0444, d->fs, d,
|
||||||
|
&soft_regs_ctrl_fops)) {
|
||||||
|
dev_err(d->dev, "fw soft regs control debugfs init failed\n");
|
||||||
|
goto err;
|
||||||
|
}
|
||||||
|
|
||||||
return d;
|
return d;
|
||||||
|
|
||||||
err:
|
err:
|
||||||
|
|
Loading…
Reference in a new issue