12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 21d98cccfSMike Rapoport /* 31d98cccfSMike Rapoport * userspace-consumer.c 41d98cccfSMike Rapoport * 51d98cccfSMike Rapoport * Copyright 2009 CompuLab, Ltd. 61d98cccfSMike Rapoport * 71d98cccfSMike Rapoport * Author: Mike Rapoport <mike@compulab.co.il> 81d98cccfSMike Rapoport * 91d98cccfSMike Rapoport * Based of virtual consumer driver: 101d98cccfSMike Rapoport * Copyright 2008 Wolfson Microelectronics PLC. 111d98cccfSMike Rapoport * Author: Mark Brown <broonie@opensource.wolfsonmicro.com> 121d98cccfSMike Rapoport */ 131d98cccfSMike Rapoport 141d98cccfSMike Rapoport #include <linux/err.h> 151d98cccfSMike Rapoport #include <linux/mutex.h> 1665602c32SPaul Gortmaker #include <linux/module.h> 17*5c51d4afSZev Weiss #include <linux/of.h> 181d98cccfSMike Rapoport #include <linux/platform_device.h> 191d98cccfSMike Rapoport #include <linux/regulator/consumer.h> 201d98cccfSMike Rapoport #include <linux/regulator/userspace-consumer.h> 215a0e3ad6STejun Heo #include <linux/slab.h> 221d98cccfSMike Rapoport 231d98cccfSMike Rapoport struct userspace_consumer_data { 241d98cccfSMike Rapoport const char *name; 251d98cccfSMike Rapoport 261d98cccfSMike Rapoport struct mutex lock; 271d98cccfSMike Rapoport bool enabled; 28*5c51d4afSZev Weiss bool no_autoswitch; 291d98cccfSMike Rapoport 301d98cccfSMike Rapoport int num_supplies; 311d98cccfSMike Rapoport struct regulator_bulk_data *supplies; 321d98cccfSMike Rapoport }; 331d98cccfSMike Rapoport 34ba499a50SZhen Lei static ssize_t name_show(struct device *dev, 351d98cccfSMike Rapoport struct device_attribute *attr, char *buf) 361d98cccfSMike Rapoport { 371d98cccfSMike Rapoport struct userspace_consumer_data *data = dev_get_drvdata(dev); 381d98cccfSMike Rapoport 391d98cccfSMike Rapoport return sprintf(buf, "%s\n", data->name); 401d98cccfSMike Rapoport } 411d98cccfSMike Rapoport 42ba499a50SZhen Lei static ssize_t state_show(struct device *dev, 431d98cccfSMike Rapoport struct device_attribute *attr, char *buf) 441d98cccfSMike Rapoport { 451d98cccfSMike Rapoport struct userspace_consumer_data *data = dev_get_drvdata(dev); 461d98cccfSMike Rapoport 471d98cccfSMike Rapoport if (data->enabled) 481d98cccfSMike Rapoport return sprintf(buf, "enabled\n"); 491d98cccfSMike Rapoport 501d98cccfSMike Rapoport return sprintf(buf, "disabled\n"); 511d98cccfSMike Rapoport } 521d98cccfSMike Rapoport 53ba499a50SZhen Lei static ssize_t state_store(struct device *dev, struct device_attribute *attr, 541d98cccfSMike Rapoport const char *buf, size_t count) 551d98cccfSMike Rapoport { 561d98cccfSMike Rapoport struct userspace_consumer_data *data = dev_get_drvdata(dev); 571d98cccfSMike Rapoport bool enabled; 581d98cccfSMike Rapoport int ret; 591d98cccfSMike Rapoport 601d98cccfSMike Rapoport /* 611d98cccfSMike Rapoport * sysfs_streq() doesn't need the \n's, but we add them so the strings 621d98cccfSMike Rapoport * will be shared with show_state(), above. 631d98cccfSMike Rapoport */ 641d98cccfSMike Rapoport if (sysfs_streq(buf, "enabled\n") || sysfs_streq(buf, "1")) 651d98cccfSMike Rapoport enabled = true; 661d98cccfSMike Rapoport else if (sysfs_streq(buf, "disabled\n") || sysfs_streq(buf, "0")) 671d98cccfSMike Rapoport enabled = false; 681d98cccfSMike Rapoport else { 691d98cccfSMike Rapoport dev_err(dev, "Configuring invalid mode\n"); 701d98cccfSMike Rapoport return count; 711d98cccfSMike Rapoport } 721d98cccfSMike Rapoport 731d98cccfSMike Rapoport mutex_lock(&data->lock); 741d98cccfSMike Rapoport if (enabled != data->enabled) { 751d98cccfSMike Rapoport if (enabled) 761d98cccfSMike Rapoport ret = regulator_bulk_enable(data->num_supplies, 771d98cccfSMike Rapoport data->supplies); 781d98cccfSMike Rapoport else 791d98cccfSMike Rapoport ret = regulator_bulk_disable(data->num_supplies, 801d98cccfSMike Rapoport data->supplies); 811d98cccfSMike Rapoport 821d98cccfSMike Rapoport if (ret == 0) 831d98cccfSMike Rapoport data->enabled = enabled; 841d98cccfSMike Rapoport else 851d98cccfSMike Rapoport dev_err(dev, "Failed to configure state: %d\n", ret); 861d98cccfSMike Rapoport } 871d98cccfSMike Rapoport mutex_unlock(&data->lock); 881d98cccfSMike Rapoport 891d98cccfSMike Rapoport return count; 901d98cccfSMike Rapoport } 911d98cccfSMike Rapoport 92ba499a50SZhen Lei static DEVICE_ATTR_RO(name); 93ba499a50SZhen Lei static DEVICE_ATTR_RW(state); 941d98cccfSMike Rapoport 95e9d62698SFelipe Balbi static struct attribute *attributes[] = { 96e9d62698SFelipe Balbi &dev_attr_name.attr, 97e9d62698SFelipe Balbi &dev_attr_state.attr, 98e9d62698SFelipe Balbi NULL, 99e9d62698SFelipe Balbi }; 100e9d62698SFelipe Balbi 101*5c51d4afSZev Weiss static umode_t attr_visible(struct kobject *kobj, struct attribute *attr, int idx) 102*5c51d4afSZev Weiss { 103*5c51d4afSZev Weiss struct device *dev = kobj_to_dev(kobj); 104*5c51d4afSZev Weiss struct userspace_consumer_data *data = dev_get_drvdata(dev); 105*5c51d4afSZev Weiss 106*5c51d4afSZev Weiss /* If a name hasn't been set, don't bother with the attribute */ 107*5c51d4afSZev Weiss if (attr == &dev_attr_name.attr && !data->name) 108*5c51d4afSZev Weiss return 0; 109*5c51d4afSZev Weiss 110*5c51d4afSZev Weiss return attr->mode; 111*5c51d4afSZev Weiss } 112*5c51d4afSZev Weiss 113e9d62698SFelipe Balbi static const struct attribute_group attr_group = { 114e9d62698SFelipe Balbi .attrs = attributes, 115*5c51d4afSZev Weiss .is_visible = attr_visible, 1161d98cccfSMike Rapoport }; 1171d98cccfSMike Rapoport 1181d98cccfSMike Rapoport static int regulator_userspace_consumer_probe(struct platform_device *pdev) 1191d98cccfSMike Rapoport { 120*5c51d4afSZev Weiss struct regulator_userspace_consumer_data tmpdata; 1211d98cccfSMike Rapoport struct regulator_userspace_consumer_data *pdata; 1221d98cccfSMike Rapoport struct userspace_consumer_data *drvdata; 123e9d62698SFelipe Balbi int ret; 1241d98cccfSMike Rapoport 125dff91d0bSJingoo Han pdata = dev_get_platdata(&pdev->dev); 126*5c51d4afSZev Weiss if (!pdata) { 127*5c51d4afSZev Weiss if (!pdev->dev.of_node) 1281d98cccfSMike Rapoport return -EINVAL; 1291d98cccfSMike Rapoport 130*5c51d4afSZev Weiss pdata = &tmpdata; 131*5c51d4afSZev Weiss memset(pdata, 0, sizeof(*pdata)); 132*5c51d4afSZev Weiss 133*5c51d4afSZev Weiss pdata->no_autoswitch = true; 134*5c51d4afSZev Weiss pdata->num_supplies = 1; 135*5c51d4afSZev Weiss pdata->supplies = devm_kzalloc(&pdev->dev, sizeof(*pdata->supplies), GFP_KERNEL); 136*5c51d4afSZev Weiss if (!pdata->supplies) 137*5c51d4afSZev Weiss return -ENOMEM; 138*5c51d4afSZev Weiss pdata->supplies[0].supply = "vout"; 139*5c51d4afSZev Weiss } 140*5c51d4afSZev Weiss 141*5c51d4afSZev Weiss if (pdata->num_supplies < 1) { 142*5c51d4afSZev Weiss dev_err(&pdev->dev, "At least one supply required\n"); 143*5c51d4afSZev Weiss return -EINVAL; 144*5c51d4afSZev Weiss } 145*5c51d4afSZev Weiss 1465abe0c40SAxel Lin drvdata = devm_kzalloc(&pdev->dev, 1475abe0c40SAxel Lin sizeof(struct userspace_consumer_data), 1485abe0c40SAxel Lin GFP_KERNEL); 1491d98cccfSMike Rapoport if (drvdata == NULL) 1501d98cccfSMike Rapoport return -ENOMEM; 1511d98cccfSMike Rapoport 1521d98cccfSMike Rapoport drvdata->name = pdata->name; 1531d98cccfSMike Rapoport drvdata->num_supplies = pdata->num_supplies; 1541d98cccfSMike Rapoport drvdata->supplies = pdata->supplies; 155*5c51d4afSZev Weiss drvdata->no_autoswitch = pdata->no_autoswitch; 1561d98cccfSMike Rapoport 1571d98cccfSMike Rapoport mutex_init(&drvdata->lock); 1581d98cccfSMike Rapoport 159*5c51d4afSZev Weiss ret = devm_regulator_bulk_get_exclusive(&pdev->dev, drvdata->num_supplies, 1601d98cccfSMike Rapoport drvdata->supplies); 1611d98cccfSMike Rapoport if (ret) { 1621d98cccfSMike Rapoport dev_err(&pdev->dev, "Failed to get supplies: %d\n", ret); 1635abe0c40SAxel Lin return ret; 1641d98cccfSMike Rapoport } 1651d98cccfSMike Rapoport 166*5c51d4afSZev Weiss platform_set_drvdata(pdev, drvdata); 167*5c51d4afSZev Weiss 168e9d62698SFelipe Balbi ret = sysfs_create_group(&pdev->dev.kobj, &attr_group); 1691d98cccfSMike Rapoport if (ret != 0) 1705abe0c40SAxel Lin return ret; 1711d98cccfSMike Rapoport 172*5c51d4afSZev Weiss if (pdata->init_on && !pdata->no_autoswitch) { 1731d98cccfSMike Rapoport ret = regulator_bulk_enable(drvdata->num_supplies, 1741d98cccfSMike Rapoport drvdata->supplies); 1751d98cccfSMike Rapoport if (ret) { 176e9d62698SFelipe Balbi dev_err(&pdev->dev, 177e9d62698SFelipe Balbi "Failed to set initial state: %d\n", ret); 178e9d62698SFelipe Balbi goto err_enable; 179e9d62698SFelipe Balbi } 1801d98cccfSMike Rapoport } 1811d98cccfSMike Rapoport 182*5c51d4afSZev Weiss ret = regulator_is_enabled(pdata->supplies[0].consumer); 183*5c51d4afSZev Weiss if (ret < 0) { 184*5c51d4afSZev Weiss dev_err(&pdev->dev, "Failed to get regulator status\n"); 185*5c51d4afSZev Weiss goto err_enable; 186*5c51d4afSZev Weiss } 187*5c51d4afSZev Weiss drvdata->enabled = !!ret; 1881d98cccfSMike Rapoport 1891d98cccfSMike Rapoport return 0; 1901d98cccfSMike Rapoport 191e9d62698SFelipe Balbi err_enable: 192e9d62698SFelipe Balbi sysfs_remove_group(&pdev->dev.kobj, &attr_group); 1931d98cccfSMike Rapoport 1941d98cccfSMike Rapoport return ret; 1951d98cccfSMike Rapoport } 1961d98cccfSMike Rapoport 1971d98cccfSMike Rapoport static int regulator_userspace_consumer_remove(struct platform_device *pdev) 1981d98cccfSMike Rapoport { 1991d98cccfSMike Rapoport struct userspace_consumer_data *data = platform_get_drvdata(pdev); 2001d98cccfSMike Rapoport 201e9d62698SFelipe Balbi sysfs_remove_group(&pdev->dev.kobj, &attr_group); 2021d98cccfSMike Rapoport 203*5c51d4afSZev Weiss if (data->enabled && !data->no_autoswitch) 2041d98cccfSMike Rapoport regulator_bulk_disable(data->num_supplies, data->supplies); 2051d98cccfSMike Rapoport 2061d98cccfSMike Rapoport return 0; 2071d98cccfSMike Rapoport } 2081d98cccfSMike Rapoport 209*5c51d4afSZev Weiss static const struct of_device_id regulator_userspace_consumer_of_match[] = { 210*5c51d4afSZev Weiss { .compatible = "regulator-output", }, 211*5c51d4afSZev Weiss {}, 212*5c51d4afSZev Weiss }; 213*5c51d4afSZev Weiss 2141d98cccfSMike Rapoport static struct platform_driver regulator_userspace_consumer_driver = { 2151d98cccfSMike Rapoport .probe = regulator_userspace_consumer_probe, 2161d98cccfSMike Rapoport .remove = regulator_userspace_consumer_remove, 2171d98cccfSMike Rapoport .driver = { 2181d98cccfSMike Rapoport .name = "reg-userspace-consumer", 219*5c51d4afSZev Weiss .of_match_table = regulator_userspace_consumer_of_match, 2201d98cccfSMike Rapoport }, 2211d98cccfSMike Rapoport }; 2221d98cccfSMike Rapoport 223005d610fSAxel Lin module_platform_driver(regulator_userspace_consumer_driver); 2241d98cccfSMike Rapoport 2251d98cccfSMike Rapoport MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>"); 2261d98cccfSMike Rapoport MODULE_DESCRIPTION("Userspace consumer for voltage and current regulators"); 2271d98cccfSMike Rapoport MODULE_LICENSE("GPL"); 228