Allow the user to read and edit regulator information in user space through the debugfs file system.
Signed-off-by: Brandon Leong <[email protected]> --- drivers/regulator/core.c | 335 ++++++++++++++++++++++++++++++++++++++++++++++ 1 files changed, 335 insertions(+), 0 deletions(-) diff --git a/drivers/regulator/core.c b/drivers/regulator/core.c index e63366f..2004e17 100644 --- a/drivers/regulator/core.c +++ b/drivers/regulator/core.c @@ -23,6 +23,8 @@ #include <linux/mutex.h> #include <linux/suspend.h> #include <linux/delay.h> +#include <linux/debugfs.h> +#include <linux/uaccess.h> #include <linux/regulator/consumer.h> #include <linux/regulator/driver.h> #include <linux/regulator/machine.h> @@ -2270,6 +2272,336 @@ static int add_regulator_attributes(struct regulator_dev *rdev) return status; } +#ifdef CONFIG_DEBUG_FS + +#define MAX_DEBUG_BUF_LEN 50 + +static DEFINE_MUTEX(debug_buf_mutex); +static char debug_buf[MAX_DEBUG_BUF_LEN]; + +static int reg_debug_enable_set(void *data, u64 val) +{ + int err_info; + if (IS_ERR(data) || data == NULL) { + pr_err("Function Input Error %ld\n", PTR_ERR(data)); + return -ENOMEM; + } + + if (val) + err_info = regulator_enable(data); + else + err_info = regulator_disable(data); + + return err_info; +} + +static int reg_debug_enable_get(void *data, u64 *val) +{ + if (IS_ERR(data) || data == NULL) { + pr_err("Function Input Error %ld\n", PTR_ERR(data)); + return -ENOMEM; + } + + *val = regulator_is_enabled(data); + return 0; +} + +DEFINE_SIMPLE_ATTRIBUTE(reg_enable_fops, reg_debug_enable_get, + reg_debug_enable_set, "%llu\n"); + +static int reg_debug_fdisable_set(void *data, u64 val) +{ + int err_info; + if (IS_ERR(data) || data == NULL) { + pr_err("Function Input Error %ld\n", PTR_ERR(data)); + return -ENOMEM; + } + + if (val > 0) + err_info = regulator_force_disable(data); + else + err_info = 0; + + return err_info; +} + +DEFINE_SIMPLE_ATTRIBUTE(reg_fdisable_fops, reg_debug_enable_get, + reg_debug_fdisable_set, "%llu\n"); + +static ssize_t reg_debug_volt_set(struct file *file, const char __user *buf, + size_t count, loff_t *ppos) +{ + int err_info, filled; + int min, max = -1; + if (IS_ERR(file) || file == NULL) { + pr_err("Function Input Error %ld\n", PTR_ERR(file)); + return -ENOMEM; + } + + if (count < MAX_DEBUG_BUF_LEN) { + mutex_lock(&debug_buf_mutex); + + if (copy_from_user(debug_buf, (void __user *) buf, count)) + return -EFAULT; + + debug_buf[count] = '\0'; + filled = sscanf(debug_buf, "%d %d", &min, &max); + + mutex_unlock(&debug_buf_mutex); + /* check that user entered two numbers */ + if (filled < 2 || min < 0 || max < min) { + pr_info("Error, correct format: 'echo \"min max\"" + " > voltage"); + return -ENOMEM; + } else { + err_info = regulator_set_voltage(file->private_data, + min, max); + } + } else { + pr_err("Error-Input voltage pair" + "string exceeds maximum buffer length"); + + return -ENOMEM; + } + + return count; +} + +static ssize_t reg_debug_volt_get(struct file *file, char __user *buf, + size_t count, loff_t *ppos) +{ + int voltage, output, rc; + if (IS_ERR(file) || file == NULL) { + pr_err("Function Input Error %ld\n", PTR_ERR(file)); + return -ENOMEM; + } + + voltage = regulator_get_voltage(file->private_data); + mutex_lock(&debug_buf_mutex); + + output = snprintf(debug_buf, MAX_DEBUG_BUF_LEN-1, "%d\n", voltage); + rc = simple_read_from_buffer((void __user *) buf, output, ppos, + (void *) debug_buf, output); + + mutex_unlock(&debug_buf_mutex); + + return rc; +} + +static int reg_debug_volt_open(struct inode *inode, struct file *file) +{ + if (IS_ERR(file) || file == NULL) { + pr_err("Function Input Error %ld\n", PTR_ERR(file)); + return -ENOMEM; + } + + file->private_data = inode->i_private; + return 0; +} + +static const struct file_operations reg_volt_fops = { + .write = reg_debug_volt_set, + .open = reg_debug_volt_open, + .read = reg_debug_volt_get, +}; + +static int reg_debug_mode_set(void *data, u64 val) +{ + int err_info; + if (IS_ERR(data) || data == NULL) { + pr_err("Function Input Error %ld\n", PTR_ERR(data)); + return -ENOMEM; + } + + err_info = regulator_set_mode(data, (unsigned int)val); + + return err_info; +} + +static int reg_debug_mode_get(void *data, u64 *val) +{ + int err_info; + if (IS_ERR(data) || data == NULL) { + pr_err("Function Input Error %ld\n", PTR_ERR(data)); + return -ENOMEM; + } + + err_info = regulator_get_mode(data); + + if (err_info < 0) { + pr_err("regulator_get_mode returned an error!\n"); + return -ENOMEM; + } else { + *val = err_info; + return 0; + } +} + +DEFINE_SIMPLE_ATTRIBUTE(reg_mode_fops, reg_debug_mode_get, + reg_debug_mode_set, "%llu\n"); + +static int reg_debug_optimum_mode_set(void *data, u64 val) +{ + int err_info; + if (IS_ERR(data) || data == NULL) { + pr_err("Function Input Error %ld\n", PTR_ERR(data)); + return -ENOMEM; + } + + err_info = regulator_set_optimum_mode(data, (unsigned int)val); + + if (err_info < 0) { + pr_err("regulator_set_optimum_mode returned an error!\n"); + return err_info; + } + + return 0; +} + +DEFINE_SIMPLE_ATTRIBUTE(reg_optimum_mode_fops, reg_debug_mode_get, + reg_debug_optimum_mode_set, "%llu\n"); + +static struct dentry *debugfs_base; + +static int reg_debug_init(void) +{ + debugfs_base = debugfs_create_dir("regulator", NULL); + if (IS_ERR(debugfs_base) || debugfs_base == NULL) { + pr_err("debugfs_create_dir returned error" + " %ld\n", PTR_ERR(debugfs_base)); + return -ENOMEM; + } + + return 0; +} + +/** + * regulator_debug_create_directory - Creates debugfs directories and files + * for each regulator + * + * @param regulator_dev Voltage/Current regulator class device. + * + * Description: This function is run everytime "regulator_register" is run. + * It is called for every regulator and initilaizes both the + * regulator directory and the data files inside (ex. enable, + * get/set voltage etc). + */ +static int regulator_debug_create_directory(struct regulator_dev *regulator_dev) +{ + struct dentry *reg_subdir; + struct dentry *err_ptr; + struct regulator *reg; + struct regulator_ops *reg_ops; + mode_t mode; + if (IS_ERR(regulator_dev) || regulator_dev == NULL || + IS_ERR(debugfs_base) || debugfs_base == NULL) { + pr_err("Error-Bad Input\n"); + goto error; + } + + reg_subdir = debugfs_create_dir(regulator_dev->desc->name, + debugfs_base); + + reg = regulator_get(NULL, regulator_dev->desc->name); + if (IS_ERR(reg) || reg == NULL) { + pr_err("Error-Bad Input\n"); + goto error; + } + + reg_ops = regulator_dev->desc->ops; + mode = 0; + /* Enabled File */ + if (reg_ops->is_enabled) + mode |= S_IRUGO; + if (reg_ops->enable || reg_ops->disable) + mode |= S_IWUSR; + if (mode) + err_ptr = debugfs_create_file("enable", mode, reg_subdir, + reg, ®_enable_fops); + if (IS_ERR(err_ptr)) { + pr_err("Error-Could not create enable file\n"); + debugfs_remove_recursive(reg_subdir); + goto error; + } + + mode = 0; + /* Force-Disable File */ + if (reg_ops->is_enabled) + mode |= S_IRUGO; + if (reg_ops->enable || reg_ops->disable) + mode |= S_IWUSR; + if (mode) + err_ptr = debugfs_create_file("force_disable", mode, + reg_subdir, reg, ®_fdisable_fops); + if (IS_ERR(err_ptr)) { + pr_err("Error-Could not create force_disable file\n"); + debugfs_remove_recursive(reg_subdir); + goto error; + } + + mode = 0; + /* Voltage File */ + if (reg_ops->get_voltage) + mode |= S_IRUGO; + if (reg_ops->set_voltage) + mode |= S_IWUSR; + if (mode) + err_ptr = debugfs_create_file("voltage", mode, reg_subdir, + reg, ®_volt_fops); + if (IS_ERR(err_ptr)) { + pr_err("Error-Could not create voltage file\n"); + debugfs_remove_recursive(reg_subdir); + goto error; + } + + mode = 0; + /* Mode File */ + if (reg_ops->get_mode) + mode |= S_IRUGO; + if (reg_ops->set_mode) + mode |= S_IWUSR; + if (mode) + err_ptr = debugfs_create_file("mode", mode, reg_subdir, + reg, ®_mode_fops); + if (IS_ERR(err_ptr)) { + pr_err("Error-Could not create mode file\n"); + debugfs_remove_recursive(reg_subdir); + goto error; + } + + mode = 0; + /* Optimum Mode File */ + if (reg_ops->get_mode) + mode |= S_IRUGO; + if (reg_ops->set_mode) + mode |= S_IWUSR; + if (mode) + err_ptr = debugfs_create_file("optimum_mode", mode, + reg_subdir, reg, ®_optimum_mode_fops); + if (IS_ERR(err_ptr)) { + pr_err("Error-Could not create optimum_mode file\n"); + debugfs_remove_recursive(reg_subdir); + goto error; + } + + return 0; + +error: + return -ENOMEM; +} +#else +static inline void regulator_debug_create_directory(struct regulator_dev + *regulator_dev) +{ + return; +} + +static inline void reg_debug_init(void) +{ + return; +} +#endif + /** * regulator_register - register regulator * @regulator_desc: regulator to register @@ -2400,6 +2732,7 @@ struct regulator_dev *regulator_register(struct regulator_desc *regulator_desc, list_add(&rdev->list, ®ulator_list); out: mutex_unlock(®ulator_list_mutex); + regulator_debug_create_directory(rdev); return rdev; unset_supplies: @@ -2575,6 +2908,8 @@ static int __init regulator_init(void) regulator_dummy_init(); + reg_debug_init(); + return ret; } -- 1.7.3.1 -- Sent by an employee of the Qualcomm Innovation Center, Inc. The Qualcomm Innovation Center, Inc. is a member of the Code Aurora Forum. -- To unsubscribe from this list: send the line "unsubscribe linux-arm-msm" in the body of a message to [email protected] More majordomo info at http://vger.kernel.org/majordomo-info.html
