119 lines
2.8 KiB
C
119 lines
2.8 KiB
C
|
// SPDX-License-Identifier: GPL-2.0
|
||
|
|
/*
|
||
|
|
* Copyright (c) 2019 MediaTek Inc.
|
||
|
|
* Author: Kai Chieh Chuang <kaichieh.chuang@mediatek.com>
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/device.h>
|
||
|
|
#include <linux/module.h>
|
||
|
|
#include <linux/regmap.h>
|
||
|
|
#include <linux/uaccess.h>
|
||
|
|
|
||
|
|
#include <sound/soc.h>
|
||
|
|
|
||
|
|
#include "mtk-afe-debug.h"
|
||
|
|
|
||
|
|
#include "mtk-base-afe.h"
|
||
|
|
|
||
|
|
#define MAX_DEBUG_WRITE_INPUT 256
|
||
|
|
|
||
|
|
/* debugfs ops */
|
||
|
|
int mtk_afe_debugfs_open(struct inode *inode, struct file *file)
|
||
|
|
{
|
||
|
|
file->private_data = inode->i_private;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(mtk_afe_debugfs_open);
|
||
|
|
|
||
|
|
ssize_t mtk_afe_debugfs_write(struct file *f, const char __user *buf,
|
||
|
|
size_t count, loff_t *offset)
|
||
|
|
{
|
||
|
|
struct mtk_base_afe *afe = f->private_data;
|
||
|
|
char input[MAX_DEBUG_WRITE_INPUT];
|
||
|
|
char *temp = NULL;
|
||
|
|
char *command = NULL;
|
||
|
|
char *str_begin = NULL;
|
||
|
|
char delim[] = " ,";
|
||
|
|
const struct mtk_afe_debug_cmd *cf;
|
||
|
|
|
||
|
|
if (!count) {
|
||
|
|
dev_info(afe->dev, "%s(), count is 0, return directly\n",
|
||
|
|
__func__);
|
||
|
|
goto exit;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (count > MAX_DEBUG_WRITE_INPUT)
|
||
|
|
count = MAX_DEBUG_WRITE_INPUT;
|
||
|
|
|
||
|
|
memset((void *)input, 0, MAX_DEBUG_WRITE_INPUT);
|
||
|
|
|
||
|
|
if (copy_from_user(input, buf, count))
|
||
|
|
dev_warn(afe->dev, "%s(), copy_from_user fail, count = %zu\n",
|
||
|
|
__func__, count);
|
||
|
|
|
||
|
|
str_begin = kstrndup(input, MAX_DEBUG_WRITE_INPUT - 1,
|
||
|
|
GFP_KERNEL);
|
||
|
|
if (!str_begin) {
|
||
|
|
dev_info(afe->dev, "%s(), kstrdup fail\n", __func__);
|
||
|
|
goto exit;
|
||
|
|
}
|
||
|
|
temp = str_begin;
|
||
|
|
|
||
|
|
command = strsep(&temp, delim);
|
||
|
|
|
||
|
|
dev_info(afe->dev, "%s(), command %s, content %s\n",
|
||
|
|
__func__, command, temp);
|
||
|
|
|
||
|
|
for (cf = afe->debug_cmds; cf->cmd; cf++) {
|
||
|
|
if (strcmp(cf->cmd, command) == 0) {
|
||
|
|
cf->fn(f, temp);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
kfree(str_begin);
|
||
|
|
exit:
|
||
|
|
return count;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(mtk_afe_debugfs_write);
|
||
|
|
|
||
|
|
/* debug function */
|
||
|
|
void mtk_afe_debug_write_reg(struct file *file, void *arg)
|
||
|
|
{
|
||
|
|
struct mtk_base_afe *afe = file->private_data;
|
||
|
|
char *token1 = NULL;
|
||
|
|
char *token2 = NULL;
|
||
|
|
char *temp = arg;
|
||
|
|
char delim[] = " ,";
|
||
|
|
unsigned long reg_addr = 0;
|
||
|
|
unsigned long reg_value = 0;
|
||
|
|
unsigned int reg_value_after;
|
||
|
|
int ret = 0;
|
||
|
|
|
||
|
|
token1 = strsep(&temp, delim);
|
||
|
|
token2 = strsep(&temp, delim);
|
||
|
|
dev_info(afe->dev, "%s(), token1 %s, token2 %s, temp %s\n",
|
||
|
|
__func__, token1, token2, temp);
|
||
|
|
|
||
|
|
if ((token1 != NULL) && (token2 != NULL)) {
|
||
|
|
ret = kstrtoul(token1, 16, ®_addr);
|
||
|
|
ret = kstrtoul(token2, 16, ®_value);
|
||
|
|
dev_info(afe->dev, "%s(), reg_addr 0x%lx, reg_value 0x%lx\n",
|
||
|
|
__func__, reg_addr, reg_value);
|
||
|
|
|
||
|
|
regmap_write(afe->regmap, reg_addr, reg_value);
|
||
|
|
regmap_read(afe->regmap, reg_addr, ®_value_after);
|
||
|
|
|
||
|
|
dev_info(afe->dev, "%s(), reg_addr 0x%lx, reg_value_after 0x%x\n",
|
||
|
|
__func__, reg_addr, reg_value_after);
|
||
|
|
} else {
|
||
|
|
dev_warn(afe->dev, "token1 or token2 is NULL!\n");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(mtk_afe_debug_write_reg);
|
||
|
|
|
||
|
|
MODULE_DESCRIPTION("Mediatek AFE Debug");
|
||
|
|
MODULE_AUTHOR("Kai Chieh Chuang <kaichieh.chuang@mediatek.com>");
|
||
|
|
MODULE_LICENSE("GPL v2");
|
||
|
|
|