Blame view
drivers/regulator/virtual.c
8.18 KB
2874c5fd2
|
1 |
// SPDX-License-Identifier: GPL-2.0-or-later |
c080909ee
|
2 3 4 5 6 7 |
/* * reg-virtual-consumer.c * * Copyright 2008 Wolfson Microelectronics PLC. * * Author: Mark Brown <broonie@opensource.wolfsonmicro.com> |
c080909ee
|
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
|
14 |
#include <linux/slab.h> |
65602c32e
|
15 |
#include <linux/module.h> |
c080909ee
|
16 17 18 19 |
struct virtual_consumer_data { struct mutex lock; struct regulator *regulator; |
4cf95663c
|
20 |
bool enabled; |
c080909ee
|
21 22 23 24 25 26 |
int min_uV; int max_uV; int min_uA; int max_uA; unsigned int mode; }; |
a07ac2171
|
27 28 |
static void update_voltage_constraints(struct device *dev, struct virtual_consumer_data *data) |
c080909ee
|
29 30 31 32 33 |
{ int ret; if (data->min_uV && data->max_uV && data->min_uV <= data->max_uV) { |
a5d2abce4
|
34 35 36 |
dev_dbg(dev, "Requesting %d-%duV ", data->min_uV, data->max_uV); |
c080909ee
|
37 |
ret = regulator_set_voltage(data->regulator, |
a07ac2171
|
38 |
data->min_uV, data->max_uV); |
c080909ee
|
39 |
if (ret != 0) { |
a07ac2171
|
40 41 42 |
dev_err(dev, "regulator_set_voltage() failed: %d ", ret); |
c080909ee
|
43 44 45 46 47 |
return; } } if (data->min_uV && data->max_uV && !data->enabled) { |
a5d2abce4
|
48 49 |
dev_dbg(dev, "Enabling regulator "); |
c080909ee
|
50 51 |
ret = regulator_enable(data->regulator); if (ret == 0) |
4cf95663c
|
52 |
data->enabled = true; |
c080909ee
|
53 |
else |
a07ac2171
|
54 55 |
dev_err(dev, "regulator_enable() failed: %d ", |
c080909ee
|
56 57 58 59 |
ret); } if (!(data->min_uV && data->max_uV) && data->enabled) { |
a5d2abce4
|
60 61 |
dev_dbg(dev, "Disabling regulator "); |
c080909ee
|
62 63 |
ret = regulator_disable(data->regulator); if (ret == 0) |
4cf95663c
|
64 |
data->enabled = false; |
c080909ee
|
65 |
else |
a07ac2171
|
66 67 |
dev_err(dev, "regulator_disable() failed: %d ", |
c080909ee
|
68 69 70 |
ret); } } |
a07ac2171
|
71 72 |
static void update_current_limit_constraints(struct device *dev, struct virtual_consumer_data *data) |
c080909ee
|
73 74 75 76 77 |
{ int ret; if (data->max_uA && data->min_uA <= data->max_uA) { |
a5d2abce4
|
78 79 80 |
dev_dbg(dev, "Requesting %d-%duA ", data->min_uA, data->max_uA); |
c080909ee
|
81 82 83 |
ret = regulator_set_current_limit(data->regulator, data->min_uA, data->max_uA); if (ret != 0) { |
a07ac2171
|
84 85 86 87 |
dev_err(dev, "regulator_set_current_limit() failed: %d ", ret); |
c080909ee
|
88 89 90 91 92 |
return; } } if (data->max_uA && !data->enabled) { |
a5d2abce4
|
93 94 |
dev_dbg(dev, "Enabling regulator "); |
c080909ee
|
95 96 |
ret = regulator_enable(data->regulator); if (ret == 0) |
4cf95663c
|
97 |
data->enabled = true; |
c080909ee
|
98 |
else |
a07ac2171
|
99 100 |
dev_err(dev, "regulator_enable() failed: %d ", |
c080909ee
|
101 102 103 104 |
ret); } if (!(data->min_uA && data->max_uA) && data->enabled) { |
a5d2abce4
|
105 106 |
dev_dbg(dev, "Disabling regulator "); |
c080909ee
|
107 108 |
ret = regulator_disable(data->regulator); if (ret == 0) |
4cf95663c
|
109 |
data->enabled = false; |
c080909ee
|
110 |
else |
a07ac2171
|
111 112 |
dev_err(dev, "regulator_disable() failed: %d ", |
c080909ee
|
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
|
130 |
if (kstrtol(buf, 10, &val) != 0) |
c080909ee
|
131 132 133 134 135 |
return count; mutex_lock(&data->lock); data->min_uV = val; |
a07ac2171
|
136 |
update_voltage_constraints(dev, data); |
c080909ee
|
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
|
156 |
if (kstrtol(buf, 10, &val) != 0) |
c080909ee
|
157 158 159 160 161 |
return count; mutex_lock(&data->lock); data->max_uV = val; |
a07ac2171
|
162 |
update_voltage_constraints(dev, data); |
c080909ee
|
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
|
182 |
if (kstrtol(buf, 10, &val) != 0) |
c080909ee
|
183 184 185 186 187 |
return count; mutex_lock(&data->lock); data->min_uA = val; |
a07ac2171
|
188 |
update_current_limit_constraints(dev, data); |
c080909ee
|
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
|
208 |
if (kstrtol(buf, 10, &val) != 0) |
c080909ee
|
209 210 211 212 213 |
return count; mutex_lock(&data->lock); data->max_uA = val; |
a07ac2171
|
214 |
update_current_limit_constraints(dev, data); |
c080909ee
|
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
|
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
|
256 257 |
if (sysfs_streq(buf, "fast ")) |
c080909ee
|
258 |
mode = REGULATOR_MODE_FAST; |
aa61d558f
|
259 260 |
else if (sysfs_streq(buf, "normal ")) |
c080909ee
|
261 |
mode = REGULATOR_MODE_NORMAL; |
aa61d558f
|
262 263 |
else if (sysfs_streq(buf, "idle ")) |
c080909ee
|
264 |
mode = REGULATOR_MODE_IDLE; |
aa61d558f
|
265 266 |
else if (sysfs_streq(buf, "standby ")) |
c080909ee
|
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
|
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
|
290 |
|
4cf95663c
|
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
|
298 |
}; |
4cf95663c
|
299 300 301 |
static const struct attribute_group regulator_virtual_attr_group = { .attrs = regulator_virtual_attributes, }; |
a5023574d
|
302 |
static int regulator_virtual_probe(struct platform_device *pdev) |
c080909ee
|
303 |
{ |
dff91d0b7
|
304 |
char *reg_id = dev_get_platdata(&pdev->dev); |
c080909ee
|
305 |
struct virtual_consumer_data *drvdata; |
4cf95663c
|
306 |
int ret; |
c080909ee
|
307 |
|
a81edbdeb
|
308 309 |
drvdata = devm_kzalloc(&pdev->dev, sizeof(struct virtual_consumer_data), GFP_KERNEL); |
4cf95663c
|
310 |
if (drvdata == NULL) |
72b86876d
|
311 |
return -ENOMEM; |
c080909ee
|
312 313 |
mutex_init(&drvdata->lock); |
a81edbdeb
|
314 |
drvdata->regulator = devm_regulator_get(&pdev->dev, reg_id); |
c080909ee
|
315 316 |
if (IS_ERR(drvdata->regulator)) { ret = PTR_ERR(drvdata->regulator); |
d61c3d56e
|
317 318 319 |
dev_err(&pdev->dev, "Failed to obtain supply '%s': %d ", reg_id, ret); |
a81edbdeb
|
320 |
return ret; |
c080909ee
|
321 |
} |
4cf95663c
|
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
|
328 |
return ret; |
c080909ee
|
329 330 331 332 333 334 335 |
} drvdata->mode = regulator_get_mode(drvdata->regulator); platform_set_drvdata(pdev, drvdata); return 0; |
c080909ee
|
336 |
} |
8dc995f56
|
337 |
static int regulator_virtual_remove(struct platform_device *pdev) |
c080909ee
|
338 339 |
{ struct virtual_consumer_data *drvdata = platform_get_drvdata(pdev); |
c080909ee
|
340 |
|
4cf95663c
|
341 |
sysfs_remove_group(&pdev->dev.kobj, ®ulator_virtual_attr_group); |
c080909ee
|
342 343 |
if (drvdata->enabled) regulator_disable(drvdata->regulator); |
c080909ee
|
344 345 346 347 348 |
return 0; } static struct platform_driver regulator_virtual_consumer_driver = { |
4cf95663c
|
349 |
.probe = regulator_virtual_probe, |
5eb9f2b96
|
350 |
.remove = regulator_virtual_remove, |
c080909ee
|
351 352 353 354 |
.driver = { .name = "reg-virt-consumer", }, }; |
005d610f2
|
355 |
module_platform_driver(regulator_virtual_consumer_driver); |
c080909ee
|
356 357 358 359 |
MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>"); MODULE_DESCRIPTION("Virtual regulator consumer"); MODULE_LICENSE("GPL"); |
38c53c891
|
360 |
MODULE_ALIAS("platform:reg-virt-consumer"); |