mfd: rk808: add sysfs debug node "/sys/rk8xx/rk8xx_dbg"

Change-Id: I197dc97b7337414a7d52426da0e0cb8c7480c917
Signed-off-by: Joseph Chen <chenjh@rock-chips.com>
Signed-off-by: Elaine Zhang <zhangqing@rock-chips.com>
This commit is contained in:
Joseph Chen
2017-02-15 19:48:03 +08:00
committed by Tao Huang
parent d23601e505
commit a4f43f5dbf

View File

@@ -999,6 +999,58 @@ static void rk817_of_property_prepare(struct rk808 *rk808, struct device *dev)
dev_err(dev, "failed to register reboot nb\n");
}
static ssize_t rk8xx_dbg_store(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t count)
{
int ret;
char cmd;
u32 input[2], addr, data;
struct rk808 *rk808 = i2c_get_clientdata(rk808_i2c_client);
ret = sscanf(buf, "%c ", &cmd);
if (ret != 1) {
pr_err("Unknown command\n");
goto out;
}
switch (cmd) {
case 'w':
ret = sscanf(buf, "%c %x %x ", &cmd, &input[0], &input[1]);
if (ret != 3) {
pr_err("error! cmd format: echo w [addr] [value]\n");
goto out;
};
addr = input[0] & 0xff;
data = input[1] & 0xff;
pr_info("cmd : %c %x %x\n\n", cmd, input[0], input[1]);
regmap_write(rk808->regmap, addr, data);
regmap_read(rk808->regmap, addr, &data);
pr_info("new: %x %x\n", addr, data);
break;
case 'r':
ret = sscanf(buf, "%c %x ", &cmd, &input[0]);
if (ret != 2) {
pr_err("error! cmd format: echo r [addr]\n");
goto out;
};
pr_info("cmd : %c %x\n\n", cmd, input[0]);
addr = input[0] & 0xff;
regmap_read(rk808->regmap, addr, &data);
pr_info("%x %x\n", input[0], data);
break;
default:
pr_err("Unknown command\n");
break;
}
out:
return count;
}
static struct kobject *rk8xx_kobj;
static struct device_attribute rk8xx_attrs =
__ATTR(rk8xx_dbg, 0200, NULL, rk8xx_dbg_store);
static const struct of_device_id rk808_of_match[] = {
{ .compatible = "rockchip,rk805" },
{ .compatible = "rockchip,rk808" },
@@ -1224,6 +1276,13 @@ static int rk808_probe(struct i2c_client *client,
pm_power_off = rk808_pm_power_off;
}
rk8xx_kobj = kobject_create_and_add("rk8xx", NULL);
if (rk8xx_kobj) {
ret = sysfs_create_file(rk8xx_kobj, &rk8xx_attrs.attr);
if (ret)
dev_err(&client->dev, "create rk8xx sysfs error\n");
}
return 0;
err_irq: