2 * drivers/mfd/rt5036-debug.c
3 * Driver for Richtek RT5036 PMIC debug
5 * Copyright (C) 2014 Richtek Technology Corp.
6 * cy_huang <cy_huang@richtek.com>
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation; either version 2
11 * of the License, or (at your option) any later version.
14 #include <linux/module.h>
15 #include <linux/kernel.h>
16 #include <linux/err.h>
17 #include <linux/platform_device.h>
18 #include <linux/i2c.h>
19 #include <linux/debugfs.h>
20 #include <linux/uaccess.h>
22 #include <linux/mfd/rt5036/rt5036.h>
24 struct rt5036_debug_info {
25 struct i2c_client *i2c;
26 unsigned char reg_addr;
27 unsigned char reg_data;
42 static struct dentry *debugfs_rt_dent;
43 static struct dentry *debugfs_file[RT5036_DBG_MAX];
44 static struct rt_debug_st rtdbg_data[RT5036_DBG_MAX];
46 static int reg_debug_open(struct inode *inode, struct file *file)
48 file->private_data = inode->i_private;
52 static int get_parameters(char *buf, long int *param1, int num_of_par)
57 token = strsep(&buf, " ");
59 for (cnt = 0; cnt < num_of_par; cnt++) {
61 if ((token[1] == 'x') || (token[1] == 'X'))
66 if (kstrtoul(token, base, ¶m1[cnt]) != 0)
69 token = strsep(&buf, " ");
77 static ssize_t reg_debug_read(struct file *filp, char __user *ubuf,
78 size_t count, loff_t *ppos)
80 struct rt_debug_st *st = filp->private_data;
81 struct rt5036_debug_info *di = st->info;
88 snprintf(lbuf, sizeof(lbuf), "0x%x\n", di->reg_addr);
92 (unsigned char)rt5036_reg_read(di->i2c, di->reg_addr);
93 snprintf(lbuf, sizeof(lbuf), "0x%x\n", di->reg_data);
96 for (i = RT5036_REG_RANGE1START; i <= RT5036_REG_RANGE1END; i++)
97 j += sprintf(lbuf + j, "reg_%02x:%02x\n", i,
98 rt5036_reg_read(di->i2c, i));
99 for (i = RT5036_REG_RANGE2START; i <= RT5036_REG_RANGE2END; i++)
100 j += sprintf(lbuf + j, "reg_%02x:%02x\n", i,
101 rt5036_reg_read(di->i2c, i));
102 for (i = RT5036_REG_RANGE3START; i <= RT5036_REG_RANGE3END; i++)
103 j += sprintf(lbuf + j, "reg_%02x:%02x\n", i,
104 rt5036_reg_read(di->i2c, i));
105 for (i = RT5036_REG_RANGE4START; i <= RT5036_REG_RANGE4END; i++)
106 j += sprintf(lbuf + j, "reg_%02x:%02x\n", i,
107 rt5036_reg_read(di->i2c, i));
108 for (i = RT5036_REG_RANGE5START; i <= RT5036_REG_RANGE5END; i++)
109 j += sprintf(lbuf + j, "reg_%02x:%02x\n", i,
110 rt5036_reg_read(di->i2c, i));
111 for (i = RT5036_REG_RANGE6START; i <= RT5036_REG_RANGE6END; i++)
112 j += sprintf(lbuf + j, "reg_%02x:%02x\n", i,
113 rt5036_reg_read(di->i2c, i));
118 return simple_read_from_buffer(ubuf, count, ppos, lbuf, strlen(lbuf));
121 static ssize_t reg_debug_write(struct file *filp,
122 const char __user *ubuf, size_t cnt,
125 struct rt_debug_st *st = filp->private_data;
126 struct rt5036_debug_info *di = st->info;
131 if (cnt > sizeof(lbuf) - 1)
134 rc = copy_from_user(lbuf, ubuf, cnt);
142 rc = get_parameters(lbuf, param, 1);
143 if ((param[0] < RT5036_REG_MAX) && (rc == 0)) {
144 if ((param[0] >= RT5036_REG_RANGE1START
145 && param[0] <= RT5036_REG_RANGE1END)
146 || (param[0] >= RT5036_REG_RANGE2START
147 && param[0] <= RT5036_REG_RANGE2END)
148 || (param[0] >= RT5036_REG_RANGE3START
149 && param[0] <= RT5036_REG_RANGE3END)
150 || (param[0] >= RT5036_REG_RANGE4START
151 && param[0] <= RT5036_REG_RANGE4END)
152 || (param[0] >= RT5036_REG_RANGE5START
153 && param[0] <= RT5036_REG_RANGE5END))
154 di->reg_addr = (unsigned char)param[0];
160 case RT5036_DBG_DATA:
161 rc = get_parameters(lbuf, param, 1);
162 if ((param[0] <= 0xff) && (rc == 0))
163 rt5036_reg_write(di->i2c, di->reg_addr, param[0]);
175 static const struct file_operations reg_debug_ops = {
176 .open = reg_debug_open,
177 .write = reg_debug_write,
178 .read = reg_debug_read
181 static int rt5036_debug_probe(struct platform_device *pdev)
183 struct rt5036_chip *chip = dev_get_drvdata(pdev->dev.parent);
184 struct rt5036_debug_info *di;
186 di = devm_kzalloc(&pdev->dev, sizeof(*di), GFP_KERNEL);
192 RTINFO("add debugfs for RT5036");
193 debugfs_rt_dent = debugfs_create_dir("rt5036_dbg", 0);
194 if (!IS_ERR(debugfs_rt_dent)) {
195 rtdbg_data[0].info = di;
196 rtdbg_data[0].id = RT5036_DBG_REG;
197 debugfs_file[0] = debugfs_create_file("reg",
200 (void *)&rtdbg_data[0],
203 rtdbg_data[1].info = di;
204 rtdbg_data[1].id = RT5036_DBG_DATA;
205 debugfs_file[1] = debugfs_create_file("data",
208 (void *)&rtdbg_data[1],
211 rtdbg_data[2].info = di;
212 rtdbg_data[2].id = RT5036_DBG_REGS;
213 debugfs_file[2] = debugfs_create_file("regs",
216 (void *)&rtdbg_data[2],
219 platform_set_drvdata(pdev, di);
223 static int rt5036_debug_remove(struct platform_device *pdev)
225 if (!IS_ERR(debugfs_rt_dent))
226 debugfs_remove_recursive(debugfs_rt_dent);
230 static const struct of_device_id rt_match_table[] = {
231 {.compatible = "rt,rt5036-debug",},
235 static struct platform_driver rt5036_debug_driver = {
237 .name = RT5036_DEV_NAME "-debug",
238 .owner = THIS_MODULE,
239 .of_match_table = rt_match_table,
241 .probe = rt5036_debug_probe,
242 .remove = rt5036_debug_remove,
245 static int __init rt5036_debug_init(void)
247 return platform_driver_register(&rt5036_debug_driver);
249 module_init(rt5036_debug_init);
251 static void __exit rt5036_debug_exit(void)
253 platform_driver_unregister(&rt5036_debug_driver);
255 module_exit(rt5036_debug_exit);
257 MODULE_LICENSE("GPL");
258 MODULE_AUTHOR("CY Huang <cy_huang@richtek.com");
259 MODULE_DESCRIPTION("Debugfs driver for RT5036");
260 MODULE_ALIAS("platform:" RT5036_DEV_NAME "-debug");
261 MODULE_VERSION(RT5036_DRV_VER);