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