ath6kl: Add debugfs support to write a chip register
To write a value to register: echo <register_offset>=<register_value> > <degfs_root>/ieee80211/phyX/ath6kl/reg_write kvalo: rename file to reg_write to follow the style of other debugfs files Signed-off-by: Vasanthakumar Thiagarajan <vthiagar@qca.qualcomm.com> Signed-off-by: Kalle Valo <kvalo@qca.qualcomm.com>
This commit is contained in:
parent
f9ea0753a1
commit
252c068b9f
|
@ -478,6 +478,8 @@ struct ath6kl {
|
|||
void *fwlog_tmp;
|
||||
u32 fwlog_mask;
|
||||
unsigned int dbgfs_diag_reg;
|
||||
u32 diag_reg_addr_wr;
|
||||
u32 diag_reg_val_wr;
|
||||
} debug;
|
||||
#endif /* CONFIG_ATH6KL_DEBUG */
|
||||
};
|
||||
|
|
|
@ -759,6 +759,68 @@ static const struct file_operations fops_lrssi_roam_threshold = {
|
|||
.llseek = default_llseek,
|
||||
};
|
||||
|
||||
static ssize_t ath6kl_regwrite_read(struct file *file,
|
||||
char __user *user_buf,
|
||||
size_t count, loff_t *ppos)
|
||||
{
|
||||
struct ath6kl *ar = file->private_data;
|
||||
u8 buf[32];
|
||||
unsigned int len = 0;
|
||||
|
||||
len = scnprintf(buf, sizeof(buf), "Addr: 0x%x Val: 0x%x\n",
|
||||
ar->debug.diag_reg_addr_wr, ar->debug.diag_reg_val_wr);
|
||||
|
||||
return simple_read_from_buffer(user_buf, count, ppos, buf, len);
|
||||
}
|
||||
|
||||
static ssize_t ath6kl_regwrite_write(struct file *file,
|
||||
const char __user *user_buf,
|
||||
size_t count, loff_t *ppos)
|
||||
{
|
||||
struct ath6kl *ar = file->private_data;
|
||||
char buf[32];
|
||||
char *sptr, *token;
|
||||
unsigned int len = 0;
|
||||
u32 reg_addr, reg_val;
|
||||
|
||||
len = min(count, sizeof(buf) - 1);
|
||||
if (copy_from_user(buf, user_buf, len))
|
||||
return -EFAULT;
|
||||
|
||||
buf[len] = '\0';
|
||||
sptr = buf;
|
||||
|
||||
token = strsep(&sptr, "=");
|
||||
if (!token)
|
||||
return -EINVAL;
|
||||
|
||||
if (kstrtou32(token, 0, ®_addr))
|
||||
return -EINVAL;
|
||||
|
||||
if (!ath6kl_dbg_is_diag_reg_valid(reg_addr))
|
||||
return -EINVAL;
|
||||
|
||||
if (kstrtou32(sptr, 0, ®_val))
|
||||
return -EINVAL;
|
||||
|
||||
ar->debug.diag_reg_addr_wr = reg_addr;
|
||||
ar->debug.diag_reg_val_wr = reg_val;
|
||||
|
||||
if (ath6kl_diag_write32(ar, ar->debug.diag_reg_addr_wr,
|
||||
cpu_to_le32(ar->debug.diag_reg_val_wr)))
|
||||
return -EIO;
|
||||
|
||||
return count;
|
||||
}
|
||||
|
||||
static const struct file_operations fops_diag_reg_write = {
|
||||
.read = ath6kl_regwrite_read,
|
||||
.write = ath6kl_regwrite_write,
|
||||
.open = ath6kl_debugfs_open,
|
||||
.owner = THIS_MODULE,
|
||||
.llseek = default_llseek,
|
||||
};
|
||||
|
||||
int ath6kl_debug_init(struct ath6kl *ar)
|
||||
{
|
||||
ar->debug.fwlog_buf.buf = vmalloc(ATH6KL_FWLOG_SIZE);
|
||||
|
@ -807,6 +869,10 @@ int ath6kl_debug_init(struct ath6kl *ar)
|
|||
|
||||
debugfs_create_file("lrssi_roam_threshold", S_IRUSR | S_IWUSR,
|
||||
ar->debugfs_phy, ar, &fops_lrssi_roam_threshold);
|
||||
|
||||
debugfs_create_file("reg_write", S_IRUSR | S_IWUSR,
|
||||
ar->debugfs_phy, ar, &fops_diag_reg_write);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in New Issue