Blame view
drivers/regulator/virtual.c
8.18 KB
2874c5fd2 treewide: Replace... |
1 |
// SPDX-License-Identifier: GPL-2.0-or-later |
c080909ee regulator: regula... |
2 3 4 5 6 7 |
/* * reg-virtual-consumer.c * * Copyright 2008 Wolfson Microelectronics PLC. * * Author: Mark Brown <broonie@opensource.wolfsonmicro.com> |
c080909ee regulator: regula... |
8 9 10 11 12 13 |
*/ #include <linux/err.h> #include <linux/mutex.h> #include <linux/platform_device.h> #include <linux/regulator/consumer.h> |
5a0e3ad6a include cleanup: ... |
14 |
#include <linux/slab.h> |
65602c32e regulator: Add mo... |
15 |
#include <linux/module.h> |
c080909ee regulator: regula... |
16 17 18 19 |
struct virtual_consumer_data { struct mutex lock; struct regulator *regulator; |
4cf95663c Regulators: virtu... |
20 |
bool enabled; |
c080909ee regulator: regula... |
21 22 23 24 25 26 |
int min_uV; int max_uV; int min_uA; int max_uA; unsigned int mode; }; |
a07ac2171 regulator: Make v... |
27 28 |
static void update_voltage_constraints(struct device *dev, struct virtual_consumer_data *data) |
c080909ee regulator: regula... |
29 30 31 32 33 |
{ int ret; if (data->min_uV && data->max_uV && data->min_uV <= data->max_uV) { |
a5d2abce4 regulator: Make v... |
34 35 36 |
dev_dbg(dev, "Requesting %d-%duV ", data->min_uV, data->max_uV); |
c080909ee regulator: regula... |
37 |
ret = regulator_set_voltage(data->regulator, |
a07ac2171 regulator: Make v... |
38 |
data->min_uV, data->max_uV); |
c080909ee regulator: regula... |
39 |
if (ret != 0) { |
a07ac2171 regulator: Make v... |
40 41 42 |
dev_err(dev, "regulator_set_voltage() failed: %d ", ret); |
c080909ee regulator: regula... |
43 44 45 46 47 |
return; } } if (data->min_uV && data->max_uV && !data->enabled) { |
a5d2abce4 regulator: Make v... |
48 49 |
dev_dbg(dev, "Enabling regulator "); |
c080909ee regulator: regula... |
50 51 |
ret = regulator_enable(data->regulator); if (ret == 0) |
4cf95663c Regulators: virtu... |
52 |
data->enabled = true; |
c080909ee regulator: regula... |
53 |
else |
a07ac2171 regulator: Make v... |
54 55 |
dev_err(dev, "regulator_enable() failed: %d ", |
c080909ee regulator: regula... |
56 57 58 59 |
ret); } if (!(data->min_uV && data->max_uV) && data->enabled) { |
a5d2abce4 regulator: Make v... |
60 61 |
dev_dbg(dev, "Disabling regulator "); |
c080909ee regulator: regula... |
62 63 |
ret = regulator_disable(data->regulator); if (ret == 0) |
4cf95663c Regulators: virtu... |
64 |
data->enabled = false; |
c080909ee regulator: regula... |
65 |
else |
a07ac2171 regulator: Make v... |
66 67 |
dev_err(dev, "regulator_disable() failed: %d ", |
c080909ee regulator: regula... |
68 69 70 |
ret); } } |
a07ac2171 regulator: Make v... |
71 72 |
static void update_current_limit_constraints(struct device *dev, struct virtual_consumer_data *data) |
c080909ee regulator: regula... |
73 74 75 76 77 |
{ int ret; if (data->max_uA && data->min_uA <= data->max_uA) { |
a5d2abce4 regulator: Make v... |
78 79 80 |
dev_dbg(dev, "Requesting %d-%duA ", data->min_uA, data->max_uA); |
c080909ee regulator: regula... |
81 82 83 |
ret = regulator_set_current_limit(data->regulator, data->min_uA, data->max_uA); if (ret != 0) { |
a07ac2171 regulator: Make v... |
84 85 86 87 |
dev_err(dev, "regulator_set_current_limit() failed: %d ", ret); |
c080909ee regulator: regula... |
88 89 90 91 92 |
return; } } if (data->max_uA && !data->enabled) { |
a5d2abce4 regulator: Make v... |
93 94 |
dev_dbg(dev, "Enabling regulator "); |
c080909ee regulator: regula... |
95 96 |
ret = regulator_enable(data->regulator); if (ret == 0) |
4cf95663c Regulators: virtu... |
97 |
data->enabled = true; |
c080909ee regulator: regula... |
98 |
else |
a07ac2171 regulator: Make v... |
99 100 |
dev_err(dev, "regulator_enable() failed: %d ", |
c080909ee regulator: regula... |
101 102 103 104 |
ret); } if (!(data->min_uA && data->max_uA) && data->enabled) { |
a5d2abce4 regulator: Make v... |
105 106 |
dev_dbg(dev, "Disabling regulator "); |
c080909ee regulator: regula... |
107 108 |
ret = regulator_disable(data->regulator); if (ret == 0) |
4cf95663c Regulators: virtu... |
109 |
data->enabled = false; |
c080909ee regulator: regula... |
110 |
else |
a07ac2171 regulator: Make v... |
111 112 |
dev_err(dev, "regulator_disable() failed: %d ", |
c080909ee regulator: regula... |
113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 |
ret); } } static ssize_t show_min_uV(struct device *dev, struct device_attribute *attr, char *buf) { struct virtual_consumer_data *data = dev_get_drvdata(dev); return sprintf(buf, "%d ", data->min_uV); } static ssize_t set_min_uV(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct virtual_consumer_data *data = dev_get_drvdata(dev); long val; |
85960e7b3 regulator: virtua... |
130 |
if (kstrtol(buf, 10, &val) != 0) |
c080909ee regulator: regula... |
131 132 133 134 135 |
return count; mutex_lock(&data->lock); data->min_uV = val; |
a07ac2171 regulator: Make v... |
136 |
update_voltage_constraints(dev, data); |
c080909ee regulator: regula... |
137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 |
mutex_unlock(&data->lock); return count; } static ssize_t show_max_uV(struct device *dev, struct device_attribute *attr, char *buf) { struct virtual_consumer_data *data = dev_get_drvdata(dev); return sprintf(buf, "%d ", data->max_uV); } static ssize_t set_max_uV(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct virtual_consumer_data *data = dev_get_drvdata(dev); long val; |
85960e7b3 regulator: virtua... |
156 |
if (kstrtol(buf, 10, &val) != 0) |
c080909ee regulator: regula... |
157 158 159 160 161 |
return count; mutex_lock(&data->lock); data->max_uV = val; |
a07ac2171 regulator: Make v... |
162 |
update_voltage_constraints(dev, data); |
c080909ee regulator: regula... |
163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 |
mutex_unlock(&data->lock); return count; } static ssize_t show_min_uA(struct device *dev, struct device_attribute *attr, char *buf) { struct virtual_consumer_data *data = dev_get_drvdata(dev); return sprintf(buf, "%d ", data->min_uA); } static ssize_t set_min_uA(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct virtual_consumer_data *data = dev_get_drvdata(dev); long val; |
85960e7b3 regulator: virtua... |
182 |
if (kstrtol(buf, 10, &val) != 0) |
c080909ee regulator: regula... |
183 184 185 186 187 |
return count; mutex_lock(&data->lock); data->min_uA = val; |
a07ac2171 regulator: Make v... |
188 |
update_current_limit_constraints(dev, data); |
c080909ee regulator: regula... |
189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 |
mutex_unlock(&data->lock); return count; } static ssize_t show_max_uA(struct device *dev, struct device_attribute *attr, char *buf) { struct virtual_consumer_data *data = dev_get_drvdata(dev); return sprintf(buf, "%d ", data->max_uA); } static ssize_t set_max_uA(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct virtual_consumer_data *data = dev_get_drvdata(dev); long val; |
85960e7b3 regulator: virtua... |
208 |
if (kstrtol(buf, 10, &val) != 0) |
c080909ee regulator: regula... |
209 210 211 212 213 |
return count; mutex_lock(&data->lock); data->max_uA = val; |
a07ac2171 regulator: Make v... |
214 |
update_current_limit_constraints(dev, data); |
c080909ee regulator: regula... |
215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 |
mutex_unlock(&data->lock); return count; } static ssize_t show_mode(struct device *dev, struct device_attribute *attr, char *buf) { struct virtual_consumer_data *data = dev_get_drvdata(dev); switch (data->mode) { case REGULATOR_MODE_FAST: return sprintf(buf, "fast "); case REGULATOR_MODE_NORMAL: return sprintf(buf, "normal "); case REGULATOR_MODE_IDLE: return sprintf(buf, "idle "); case REGULATOR_MODE_STANDBY: return sprintf(buf, "standby "); default: return sprintf(buf, "unknown "); } } static ssize_t set_mode(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct virtual_consumer_data *data = dev_get_drvdata(dev); unsigned int mode; int ret; |
9485397aa regulator: minor ... |
251 252 253 254 255 |
/* * sysfs_streq() doesn't need the 's, but we add them so the strings * will be shared with show_mode(), above. */ |
aa61d558f regulator/virtual... |
256 257 |
if (sysfs_streq(buf, "fast ")) |
c080909ee regulator: regula... |
258 |
mode = REGULATOR_MODE_FAST; |
aa61d558f regulator/virtual... |
259 260 |
else if (sysfs_streq(buf, "normal ")) |
c080909ee regulator: regula... |
261 |
mode = REGULATOR_MODE_NORMAL; |
aa61d558f regulator/virtual... |
262 263 |
else if (sysfs_streq(buf, "idle ")) |
c080909ee regulator: regula... |
264 |
mode = REGULATOR_MODE_IDLE; |
aa61d558f regulator/virtual... |
265 266 |
else if (sysfs_streq(buf, "standby ")) |
c080909ee regulator: regula... |
267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 |
mode = REGULATOR_MODE_STANDBY; else { dev_err(dev, "Configuring invalid mode "); return count; } mutex_lock(&data->lock); ret = regulator_set_mode(data->regulator, mode); if (ret == 0) data->mode = mode; else dev_err(dev, "Failed to configure mode: %d ", ret); mutex_unlock(&data->lock); return count; } |
71e06af26 drivers/regulator... |
285 286 287 288 289 |
static DEVICE_ATTR(min_microvolts, 0664, show_min_uV, set_min_uV); static DEVICE_ATTR(max_microvolts, 0664, show_max_uV, set_max_uV); static DEVICE_ATTR(min_microamps, 0664, show_min_uA, set_min_uA); static DEVICE_ATTR(max_microamps, 0664, show_max_uA, set_max_uA); static DEVICE_ATTR(mode, 0664, show_mode, set_mode); |
c080909ee regulator: regula... |
290 |
|
4cf95663c Regulators: virtu... |
291 292 293 294 295 296 297 |
static struct attribute *regulator_virtual_attributes[] = { &dev_attr_min_microvolts.attr, &dev_attr_max_microvolts.attr, &dev_attr_min_microamps.attr, &dev_attr_max_microamps.attr, &dev_attr_mode.attr, NULL |
c080909ee regulator: regula... |
298 |
}; |
4cf95663c Regulators: virtu... |
299 300 301 |
static const struct attribute_group regulator_virtual_attr_group = { .attrs = regulator_virtual_attributes, }; |
a5023574d regulator: remove... |
302 |
static int regulator_virtual_probe(struct platform_device *pdev) |
c080909ee regulator: regula... |
303 |
{ |
dff91d0b7 regulator: use de... |
304 |
char *reg_id = dev_get_platdata(&pdev->dev); |
c080909ee regulator: regula... |
305 |
struct virtual_consumer_data *drvdata; |
4cf95663c Regulators: virtu... |
306 |
int ret; |
c080909ee regulator: regula... |
307 |
|
a81edbdeb regulator: virtua... |
308 309 |
drvdata = devm_kzalloc(&pdev->dev, sizeof(struct virtual_consumer_data), GFP_KERNEL); |
4cf95663c Regulators: virtu... |
310 |
if (drvdata == NULL) |
72b86876d regulator: Improv... |
311 |
return -ENOMEM; |
c080909ee regulator: regula... |
312 313 |
mutex_init(&drvdata->lock); |
a81edbdeb regulator: virtua... |
314 |
drvdata->regulator = devm_regulator_get(&pdev->dev, reg_id); |
c080909ee regulator: regula... |
315 316 |
if (IS_ERR(drvdata->regulator)) { ret = PTR_ERR(drvdata->regulator); |
d61c3d56e regulator: Report... |
317 318 319 |
dev_err(&pdev->dev, "Failed to obtain supply '%s': %d ", reg_id, ret); |
a81edbdeb regulator: virtua... |
320 |
return ret; |
c080909ee regulator: regula... |
321 |
} |
4cf95663c Regulators: virtu... |
322 323 324 325 326 327 |
ret = sysfs_create_group(&pdev->dev.kobj, ®ulator_virtual_attr_group); if (ret != 0) { dev_err(&pdev->dev, "Failed to create attribute group: %d ", ret); |
a81edbdeb regulator: virtua... |
328 |
return ret; |
c080909ee regulator: regula... |
329 330 331 332 333 334 335 |
} drvdata->mode = regulator_get_mode(drvdata->regulator); platform_set_drvdata(pdev, drvdata); return 0; |
c080909ee regulator: regula... |
336 |
} |
8dc995f56 regulator: remove... |
337 |
static int regulator_virtual_remove(struct platform_device *pdev) |
c080909ee regulator: regula... |
338 339 |
{ struct virtual_consumer_data *drvdata = platform_get_drvdata(pdev); |
c080909ee regulator: regula... |
340 |
|
4cf95663c Regulators: virtu... |
341 |
sysfs_remove_group(&pdev->dev.kobj, ®ulator_virtual_attr_group); |
c080909ee regulator: regula... |
342 343 |
if (drvdata->enabled) regulator_disable(drvdata->regulator); |
c080909ee regulator: regula... |
344 345 346 347 348 |
return 0; } static struct platform_driver regulator_virtual_consumer_driver = { |
4cf95663c Regulators: virtu... |
349 |
.probe = regulator_virtual_probe, |
5eb9f2b96 regulator: remove... |
350 |
.remove = regulator_virtual_remove, |
c080909ee regulator: regula... |
351 352 353 354 |
.driver = { .name = "reg-virt-consumer", }, }; |
005d610f2 regulator: Conver... |
355 |
module_platform_driver(regulator_virtual_consumer_driver); |
c080909ee regulator: regula... |
356 357 358 359 |
MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>"); MODULE_DESCRIPTION("Virtual regulator consumer"); MODULE_LICENSE("GPL"); |
38c53c891 regulator: Set MO... |
360 |
MODULE_ALIAS("platform:reg-virt-consumer"); |