mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-08 21:22:09 -04:00
asoc: wsa881x: Fix crash while capturing swr_slv codec dump
Swr-slv address is overwritten during wsa881x_swr_probe, hence soundwire getting incorrect slave address. While accessing swr master from swr slave due to incorrect address device crashed. To avoid the issue align the debugfs similar to wsa883x codec. Change-Id: Ic8aaa0728a43936cd4c6e1ed590e01ba8f0fbf5b Signed-off-by: Shashi Kant Maurya <smaury@codeaurora.org>
This commit is contained in:
Shashi Kant Maurya
parent
dec796e30a
commit
634e5ba4c0
1 changed files with 140 additions and 87 deletions
|
|
@ -110,6 +110,11 @@ struct wsa881x_priv {
|
|||
int (*register_notifier)(void *handle,
|
||||
struct notifier_block *nblock,
|
||||
bool enable);
|
||||
struct dentry *debugfs_dent;
|
||||
struct dentry *debugfs_peek;
|
||||
struct dentry *debugfs_poke;
|
||||
struct dentry *debugfs_reg_dump;
|
||||
unsigned int read_data;
|
||||
};
|
||||
|
||||
struct wsa_ctrl_platform_data {
|
||||
|
|
@ -137,14 +142,6 @@ static int wsa881x_ocp_poll_timer_sec = WSA881X_OCP_CTL_POLL_TIMER_SEC;
|
|||
module_param(wsa881x_ocp_poll_timer_sec, int, 0664);
|
||||
MODULE_PARM_DESC(wsa881x_ocp_poll_timer_sec, "timer for ocp ctl polling");
|
||||
|
||||
static struct wsa881x_priv *dbgwsa881x;
|
||||
static struct dentry *debugfs_wsa881x_dent;
|
||||
static struct dentry *debugfs_peek;
|
||||
static struct dentry *debugfs_poke;
|
||||
static struct dentry *debugfs_reg_dump;
|
||||
static unsigned int read_data;
|
||||
static unsigned int devnum;
|
||||
|
||||
static int32_t wsa881x_resource_acquire(struct snd_soc_component *component,
|
||||
bool enable);
|
||||
|
||||
|
|
@ -399,30 +396,28 @@ static bool is_swr_slv_reg_readable(int reg)
|
|||
return ret;
|
||||
}
|
||||
|
||||
static ssize_t wsa881x_swrslave_reg_show(char __user *ubuf, size_t count,
|
||||
loff_t *ppos)
|
||||
static ssize_t wsa881x_swrslave_reg_show(struct swr_device *pdev, char __user *ubuf,
|
||||
size_t count, loff_t *ppos)
|
||||
{
|
||||
int i, reg_val, len;
|
||||
ssize_t total = 0;
|
||||
char tmp_buf[SWR_SLV_MAX_BUF_LEN];
|
||||
|
||||
if (!ubuf || !ppos || (devnum == 0))
|
||||
if (!ubuf || !ppos)
|
||||
return 0;
|
||||
|
||||
for (i = (((int) *ppos / BYTES_PER_LINE) + SWR_SLV_START_REG_ADDR);
|
||||
i <= SWR_SLV_MAX_REG_ADDR; i++) {
|
||||
i <= SWR_SLV_MAX_REG_ADDR; i++) {
|
||||
if (!is_swr_slv_reg_readable(i))
|
||||
continue;
|
||||
swr_read(dbgwsa881x->swr_slave, devnum,
|
||||
i, ®_val, 1);
|
||||
len = snprintf(tmp_buf, 25, "0x%.3x: 0x%.2x\n", i,
|
||||
(reg_val & 0xFF));
|
||||
swr_read(pdev, pdev->dev_num, i, ®_val, 1);
|
||||
len = snprintf(tmp_buf, sizeof(tmp_buf), "0x%.3x: 0x%.2x\n", i,
|
||||
(reg_val & 0xFF));
|
||||
if (len < 0) {
|
||||
pr_err("%s: fail to fill the buffer\n", __func__);
|
||||
total = -EFAULT;
|
||||
goto copy_err;
|
||||
}
|
||||
|
||||
if ((total + len) >= count - 1)
|
||||
break;
|
||||
if (copy_to_user((ubuf + total), tmp_buf, len)) {
|
||||
|
|
@ -430,53 +425,84 @@ static ssize_t wsa881x_swrslave_reg_show(char __user *ubuf, size_t count,
|
|||
total = -EFAULT;
|
||||
goto copy_err;
|
||||
}
|
||||
*ppos += len;
|
||||
total += len;
|
||||
*ppos += len;
|
||||
}
|
||||
|
||||
copy_err:
|
||||
*ppos = SWR_SLV_MAX_REG_ADDR * BYTES_PER_LINE;
|
||||
return total;
|
||||
}
|
||||
|
||||
static ssize_t codec_debug_read(struct file *file, char __user *ubuf,
|
||||
size_t count, loff_t *ppos)
|
||||
static ssize_t codec_debug_dump(struct file *file, char __user *ubuf,
|
||||
size_t count, loff_t *ppos)
|
||||
{
|
||||
char lbuf[SWR_SLV_RD_BUF_LEN];
|
||||
char *access_str;
|
||||
ssize_t ret_cnt;
|
||||
struct swr_device *pdev;
|
||||
|
||||
if (!count || !file || !ppos || !ubuf)
|
||||
return -EINVAL;
|
||||
|
||||
access_str = file->private_data;
|
||||
pdev = file->private_data;
|
||||
if (!pdev)
|
||||
return -EINVAL;
|
||||
|
||||
if (*ppos < 0)
|
||||
return -EINVAL;
|
||||
|
||||
if (!strcmp(access_str, "swrslave_peek")) {
|
||||
snprintf(lbuf, sizeof(lbuf), "0x%x\n", (read_data & 0xFF));
|
||||
ret_cnt = simple_read_from_buffer(ubuf, count, ppos, lbuf,
|
||||
strnlen(lbuf, 7));
|
||||
} else if (!strcmp(access_str, "swrslave_reg_dump")) {
|
||||
ret_cnt = wsa881x_swrslave_reg_show(ubuf, count, ppos);
|
||||
} else {
|
||||
pr_err("%s: %s not permitted to read\n", __func__, access_str);
|
||||
ret_cnt = -EPERM;
|
||||
}
|
||||
return ret_cnt;
|
||||
return wsa881x_swrslave_reg_show(pdev, ubuf, count, ppos);
|
||||
}
|
||||
|
||||
static ssize_t codec_debug_write(struct file *filp,
|
||||
const char __user *ubuf, size_t cnt, loff_t *ppos)
|
||||
static ssize_t codec_debug_read(struct file *file, char __user *ubuf,
|
||||
size_t count, loff_t *ppos)
|
||||
{
|
||||
char lbuf[SWR_SLV_WR_BUF_LEN];
|
||||
int rc;
|
||||
u32 param[5];
|
||||
char *access_str;
|
||||
char lbuf[SWR_SLV_RD_BUF_LEN];
|
||||
struct swr_device *pdev = NULL;
|
||||
struct wsa881x_priv *wsa881x = NULL;
|
||||
|
||||
if (!filp || !ppos || !ubuf)
|
||||
if (!count || !file || !ppos || !ubuf)
|
||||
return -EINVAL;
|
||||
|
||||
pdev = file->private_data;
|
||||
if (!pdev)
|
||||
return -EINVAL;
|
||||
|
||||
wsa881x = swr_get_dev_data(pdev);
|
||||
if (!wsa881x)
|
||||
return -EINVAL;
|
||||
|
||||
if (*ppos < 0)
|
||||
return -EINVAL;
|
||||
|
||||
snprintf(lbuf, sizeof(lbuf), "0x%x\n",
|
||||
(wsa881x->read_data & 0xFF));
|
||||
|
||||
return simple_read_from_buffer(ubuf, count, ppos, lbuf,
|
||||
strnlen(lbuf, 7));
|
||||
}
|
||||
|
||||
static ssize_t codec_debug_peek_write(struct file *file,
|
||||
const char __user *ubuf, size_t cnt, loff_t *ppos)
|
||||
{
|
||||
char lbuf[SWR_SLV_WR_BUF_LEN];
|
||||
int rc = 0;
|
||||
u32 param[5];
|
||||
struct swr_device *pdev = NULL;
|
||||
struct wsa881x_priv *wsa881x = NULL;
|
||||
|
||||
if (!cnt || !file || !ppos || !ubuf)
|
||||
return -EINVAL;
|
||||
|
||||
pdev = file->private_data;
|
||||
if (!pdev)
|
||||
return -EINVAL;
|
||||
|
||||
wsa881x = swr_get_dev_data(pdev);
|
||||
if (!wsa881x)
|
||||
return -EINVAL;
|
||||
|
||||
if (*ppos < 0)
|
||||
return -EINVAL;
|
||||
|
||||
access_str = filp->private_data;
|
||||
if (cnt > sizeof(lbuf) - 1)
|
||||
return -EINVAL;
|
||||
|
||||
|
|
@ -485,32 +511,10 @@ static ssize_t codec_debug_write(struct file *filp,
|
|||
return -EFAULT;
|
||||
|
||||
lbuf[cnt] = '\0';
|
||||
if (!strcmp(access_str, "swrslave_poke")) {
|
||||
/* write */
|
||||
rc = get_parameters(lbuf, param, 3);
|
||||
if ((param[0] <= SWR_SLV_MAX_REG_ADDR) && (param[1] <= 0xFF) &&
|
||||
(rc == 0))
|
||||
swr_write(dbgwsa881x->swr_slave, param[2],
|
||||
param[0], ¶m[1]);
|
||||
else
|
||||
rc = -EINVAL;
|
||||
} else if (!strcmp(access_str, "swrslave_peek")) {
|
||||
/* read */
|
||||
rc = get_parameters(lbuf, param, 2);
|
||||
if ((param[0] <= SWR_SLV_MAX_REG_ADDR) && (rc == 0))
|
||||
swr_read(dbgwsa881x->swr_slave, param[1],
|
||||
param[0], &read_data, 1);
|
||||
else
|
||||
rc = -EINVAL;
|
||||
} else if (!strcmp(access_str, "swrslave_reg_dump")) {
|
||||
/* reg dump */
|
||||
rc = get_parameters(lbuf, param, 1);
|
||||
if ((rc == 0) && (param[0] > 0) &&
|
||||
(param[0] <= SWR_SLV_MAX_DEVICES))
|
||||
devnum = param[0];
|
||||
else
|
||||
rc = -EINVAL;
|
||||
}
|
||||
rc = get_parameters(lbuf, param, 1);
|
||||
if (!((param[0] <= SWR_SLV_MAX_REG_ADDR) && (rc == 0)))
|
||||
return -EINVAL;
|
||||
swr_read(pdev, pdev->dev_num, param[0], &wsa881x->read_data, 1);
|
||||
if (rc == 0)
|
||||
rc = cnt;
|
||||
else
|
||||
|
|
@ -519,12 +523,57 @@ static ssize_t codec_debug_write(struct file *filp,
|
|||
return rc;
|
||||
}
|
||||
|
||||
static const struct file_operations codec_debug_ops = {
|
||||
static ssize_t codec_debug_write(struct file *file,
|
||||
const char __user *ubuf, size_t cnt, loff_t *ppos)
|
||||
{
|
||||
char lbuf[SWR_SLV_WR_BUF_LEN];
|
||||
int rc = 0;
|
||||
u32 param[5];
|
||||
struct swr_device *pdev;
|
||||
|
||||
if (!file || !ppos || !ubuf)
|
||||
return -EINVAL;
|
||||
|
||||
pdev = file->private_data;
|
||||
if (!pdev)
|
||||
return -EINVAL;
|
||||
|
||||
if (cnt > sizeof(lbuf) - 1)
|
||||
return -EINVAL;
|
||||
|
||||
rc = copy_from_user(lbuf, ubuf, cnt);
|
||||
if (rc)
|
||||
return -EFAULT;
|
||||
|
||||
lbuf[cnt] = '\0';
|
||||
rc = get_parameters(lbuf, param, 2);
|
||||
if (!((param[0] <= SWR_SLV_MAX_REG_ADDR) &&
|
||||
(param[1] <= 0xFF) && (rc == 0)))
|
||||
return -EINVAL;
|
||||
swr_write(pdev, pdev->dev_num, param[0], ¶m[1]);
|
||||
if (rc == 0)
|
||||
rc = cnt;
|
||||
else
|
||||
pr_err("%s: rc = %d\n", __func__, rc);
|
||||
|
||||
return rc;
|
||||
}
|
||||
|
||||
static const struct file_operations codec_debug_write_ops = {
|
||||
.open = codec_debug_open,
|
||||
.write = codec_debug_write,
|
||||
.read = codec_debug_read,
|
||||
};
|
||||
|
||||
static const struct file_operations codec_debug_read_ops = {
|
||||
.open = codec_debug_open,
|
||||
.read = codec_debug_read,
|
||||
.write = codec_debug_peek_write,
|
||||
};
|
||||
|
||||
static const struct file_operations codec_debug_dump_ops = {
|
||||
.open = codec_debug_open,
|
||||
.read = codec_debug_dump,
|
||||
};
|
||||
static void wsa881x_regcache_sync(struct wsa881x_priv *wsa881x)
|
||||
{
|
||||
mutex_lock(&wsa881x->res_lock);
|
||||
|
|
@ -1452,27 +1501,31 @@ static int wsa881x_swr_probe(struct swr_device *pdev)
|
|||
wsa881x_gpio_ctrl(wsa881x, true);
|
||||
wsa881x->state = WSA881X_DEV_UP;
|
||||
|
||||
if (!debugfs_wsa881x_dent) {
|
||||
dbgwsa881x = wsa881x;
|
||||
debugfs_wsa881x_dent = debugfs_create_dir(
|
||||
"wsa881x_swr_slave", 0);
|
||||
if (!IS_ERR(debugfs_wsa881x_dent)) {
|
||||
debugfs_peek = debugfs_create_file("swrslave_peek",
|
||||
S_IFREG | 0444, debugfs_wsa881x_dent,
|
||||
(void *) "swrslave_peek",
|
||||
&codec_debug_ops);
|
||||
if (!wsa881x->debugfs_dent) {
|
||||
wsa881x->debugfs_dent = debugfs_create_dir(
|
||||
dev_name(&pdev->dev), 0);
|
||||
if (!IS_ERR(wsa881x->debugfs_dent)) {
|
||||
wsa881x->debugfs_peek =
|
||||
debugfs_create_file("swrslave_peek",
|
||||
S_IFREG | 0444,
|
||||
wsa881x->debugfs_dent,
|
||||
(void *) pdev,
|
||||
&codec_debug_read_ops);
|
||||
|
||||
debugfs_poke = debugfs_create_file("swrslave_poke",
|
||||
S_IFREG | 0444, debugfs_wsa881x_dent,
|
||||
(void *) "swrslave_poke",
|
||||
&codec_debug_ops);
|
||||
wsa881x->debugfs_poke =
|
||||
debugfs_create_file("swrslave_poke",
|
||||
S_IFREG | 0444,
|
||||
wsa881x->debugfs_dent,
|
||||
(void *) pdev,
|
||||
&codec_debug_write_ops);
|
||||
|
||||
debugfs_reg_dump = debugfs_create_file(
|
||||
wsa881x->debugfs_reg_dump =
|
||||
debugfs_create_file(
|
||||
"swrslave_reg_dump",
|
||||
S_IFREG | 0444,
|
||||
debugfs_wsa881x_dent,
|
||||
(void *) "swrslave_reg_dump",
|
||||
&codec_debug_ops);
|
||||
wsa881x->debugfs_dent,
|
||||
(void *) pdev,
|
||||
&codec_debug_dump_ops);
|
||||
}
|
||||
}
|
||||
|
||||
|
|
@ -1564,8 +1617,8 @@ static int wsa881x_swr_remove(struct swr_device *pdev)
|
|||
if (wsa881x->register_notifier)
|
||||
wsa881x->register_notifier(wsa881x->handle,
|
||||
&wsa881x->bolero_nblock, false);
|
||||
debugfs_remove_recursive(debugfs_wsa881x_dent);
|
||||
debugfs_wsa881x_dent = NULL;
|
||||
debugfs_remove_recursive(wsa881x->debugfs_dent);
|
||||
wsa881x->debugfs_dent = NULL;
|
||||
mutex_destroy(&wsa881x->res_lock);
|
||||
mutex_destroy(&wsa881x->temp_lock);
|
||||
snd_soc_unregister_component(&pdev->dev);
|
||||
|
|
|
|||
Loading…
Reference in a new issue