Blame view

drivers/regulator/virtual.c 8.39 KB
c080909ee   Mark Brown   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   Tejun Heo   include cleanup: ...
18
  #include <linux/slab.h>
65602c32e   Paul Gortmaker   regulator: Add mo...
19
  #include <linux/module.h>
c080909ee   Mark Brown   regulator: regula...
20
21
22
23
  
  struct virtual_consumer_data {
  	struct mutex lock;
  	struct regulator *regulator;
4cf95663c   Dmitry Torokhov   Regulators: virtu...
24
  	bool enabled;
c080909ee   Mark Brown   regulator: regula...
25
26
27
28
29
30
  	int min_uV;
  	int max_uV;
  	int min_uA;
  	int max_uA;
  	unsigned int mode;
  };
a07ac2171   Mark Brown   regulator: Make v...
31
32
  static void update_voltage_constraints(struct device *dev,
  				       struct virtual_consumer_data *data)
c080909ee   Mark Brown   regulator: regula...
33
34
35
36
37
  {
  	int ret;
  
  	if (data->min_uV && data->max_uV
  	    && data->min_uV <= data->max_uV) {
a5d2abce4   Mark Brown   regulator: Make v...
38
39
40
  		dev_dbg(dev, "Requesting %d-%duV
  ",
  			data->min_uV, data->max_uV);
c080909ee   Mark Brown   regulator: regula...
41
  		ret = regulator_set_voltage(data->regulator,
a07ac2171   Mark Brown   regulator: Make v...
42
  					data->min_uV, data->max_uV);
c080909ee   Mark Brown   regulator: regula...
43
  		if (ret != 0) {
a07ac2171   Mark Brown   regulator: Make v...
44
45
46
  			dev_err(dev,
  				"regulator_set_voltage() failed: %d
  ", ret);
c080909ee   Mark Brown   regulator: regula...
47
48
49
50
51
  			return;
  		}
  	}
  
  	if (data->min_uV && data->max_uV && !data->enabled) {
a5d2abce4   Mark Brown   regulator: Make v...
52
53
  		dev_dbg(dev, "Enabling regulator
  ");
c080909ee   Mark Brown   regulator: regula...
54
55
  		ret = regulator_enable(data->regulator);
  		if (ret == 0)
4cf95663c   Dmitry Torokhov   Regulators: virtu...
56
  			data->enabled = true;
c080909ee   Mark Brown   regulator: regula...
57
  		else
a07ac2171   Mark Brown   regulator: Make v...
58
59
  			dev_err(dev, "regulator_enable() failed: %d
  ",
c080909ee   Mark Brown   regulator: regula...
60
61
62
63
  				ret);
  	}
  
  	if (!(data->min_uV && data->max_uV) && data->enabled) {
a5d2abce4   Mark Brown   regulator: Make v...
64
65
  		dev_dbg(dev, "Disabling regulator
  ");
c080909ee   Mark Brown   regulator: regula...
66
67
  		ret = regulator_disable(data->regulator);
  		if (ret == 0)
4cf95663c   Dmitry Torokhov   Regulators: virtu...
68
  			data->enabled = false;
c080909ee   Mark Brown   regulator: regula...
69
  		else
a07ac2171   Mark Brown   regulator: Make v...
70
71
  			dev_err(dev, "regulator_disable() failed: %d
  ",
c080909ee   Mark Brown   regulator: regula...
72
73
74
  				ret);
  	}
  }
a07ac2171   Mark Brown   regulator: Make v...
75
76
  static void update_current_limit_constraints(struct device *dev,
  					  struct virtual_consumer_data *data)
c080909ee   Mark Brown   regulator: regula...
77
78
79
80
81
  {
  	int ret;
  
  	if (data->max_uA
  	    && data->min_uA <= data->max_uA) {
a5d2abce4   Mark Brown   regulator: Make v...
82
83
84
  		dev_dbg(dev, "Requesting %d-%duA
  ",
  			data->min_uA, data->max_uA);
c080909ee   Mark Brown   regulator: regula...
85
86
87
  		ret = regulator_set_current_limit(data->regulator,
  					data->min_uA, data->max_uA);
  		if (ret != 0) {
a07ac2171   Mark Brown   regulator: Make v...
88
89
90
91
  			dev_err(dev,
  				"regulator_set_current_limit() failed: %d
  ",
  				ret);
c080909ee   Mark Brown   regulator: regula...
92
93
94
95
96
  			return;
  		}
  	}
  
  	if (data->max_uA && !data->enabled) {
a5d2abce4   Mark Brown   regulator: Make v...
97
98
  		dev_dbg(dev, "Enabling regulator
  ");
c080909ee   Mark Brown   regulator: regula...
99
100
  		ret = regulator_enable(data->regulator);
  		if (ret == 0)
4cf95663c   Dmitry Torokhov   Regulators: virtu...
101
  			data->enabled = true;
c080909ee   Mark Brown   regulator: regula...
102
  		else
a07ac2171   Mark Brown   regulator: Make v...
103
104
  			dev_err(dev, "regulator_enable() failed: %d
  ",
c080909ee   Mark Brown   regulator: regula...
105
106
107
108
  				ret);
  	}
  
  	if (!(data->min_uA && data->max_uA) && data->enabled) {
a5d2abce4   Mark Brown   regulator: Make v...
109
110
  		dev_dbg(dev, "Disabling regulator
  ");
c080909ee   Mark Brown   regulator: regula...
111
112
  		ret = regulator_disable(data->regulator);
  		if (ret == 0)
4cf95663c   Dmitry Torokhov   Regulators: virtu...
113
  			data->enabled = false;
c080909ee   Mark Brown   regulator: regula...
114
  		else
a07ac2171   Mark Brown   regulator: Make v...
115
116
  			dev_err(dev, "regulator_disable() failed: %d
  ",
c080909ee   Mark Brown   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   Axel Lin   regulator: virtua...
134
  	if (kstrtol(buf, 10, &val) != 0)
c080909ee   Mark Brown   regulator: regula...
135
136
137
138
139
  		return count;
  
  	mutex_lock(&data->lock);
  
  	data->min_uV = val;
a07ac2171   Mark Brown   regulator: Make v...
140
  	update_voltage_constraints(dev, data);
c080909ee   Mark Brown   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   Axel Lin   regulator: virtua...
160
  	if (kstrtol(buf, 10, &val) != 0)
c080909ee   Mark Brown   regulator: regula...
161
162
163
164
165
  		return count;
  
  	mutex_lock(&data->lock);
  
  	data->max_uV = val;
a07ac2171   Mark Brown   regulator: Make v...
166
  	update_voltage_constraints(dev, data);
c080909ee   Mark Brown   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   Axel Lin   regulator: virtua...
186
  	if (kstrtol(buf, 10, &val) != 0)
c080909ee   Mark Brown   regulator: regula...
187
188
189
190
191
  		return count;
  
  	mutex_lock(&data->lock);
  
  	data->min_uA = val;
a07ac2171   Mark Brown   regulator: Make v...
192
  	update_current_limit_constraints(dev, data);
c080909ee   Mark Brown   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   Axel Lin   regulator: virtua...
212
  	if (kstrtol(buf, 10, &val) != 0)
c080909ee   Mark Brown   regulator: regula...
213
214
215
216
217
  		return count;
  
  	mutex_lock(&data->lock);
  
  	data->max_uA = val;
a07ac2171   Mark Brown   regulator: Make v...
218
  	update_current_limit_constraints(dev, data);
c080909ee   Mark Brown   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   Andrew Morton   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   Mike Rapoport   regulator/virtual...
260
261
  	if (sysfs_streq(buf, "fast
  "))
c080909ee   Mark Brown   regulator: regula...
262
  		mode = REGULATOR_MODE_FAST;
aa61d558f   Mike Rapoport   regulator/virtual...
263
264
  	else if (sysfs_streq(buf, "normal
  "))
c080909ee   Mark Brown   regulator: regula...
265
  		mode = REGULATOR_MODE_NORMAL;
aa61d558f   Mike Rapoport   regulator/virtual...
266
267
  	else if (sysfs_streq(buf, "idle
  "))
c080909ee   Mark Brown   regulator: regula...
268
  		mode = REGULATOR_MODE_IDLE;
aa61d558f   Mike Rapoport   regulator/virtual...
269
270
  	else if (sysfs_streq(buf, "standby
  "))
c080909ee   Mark Brown   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   Rusty Russell   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   Mark Brown   regulator: regula...
294

4cf95663c   Dmitry Torokhov   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   Mark Brown   regulator: regula...
302
  };
4cf95663c   Dmitry Torokhov   Regulators: virtu...
303
304
305
  static const struct attribute_group regulator_virtual_attr_group = {
  	.attrs	= regulator_virtual_attributes,
  };
a5023574d   Bill Pemberton   regulator: remove...
306
  static int regulator_virtual_probe(struct platform_device *pdev)
c080909ee   Mark Brown   regulator: regula...
307
  {
dff91d0b7   Jingoo Han   regulator: use de...
308
  	char *reg_id = dev_get_platdata(&pdev->dev);
c080909ee   Mark Brown   regulator: regula...
309
  	struct virtual_consumer_data *drvdata;
4cf95663c   Dmitry Torokhov   Regulators: virtu...
310
  	int ret;
c080909ee   Mark Brown   regulator: regula...
311

a81edbdeb   Axel Lin   regulator: virtua...
312
313
  	drvdata = devm_kzalloc(&pdev->dev, sizeof(struct virtual_consumer_data),
  			       GFP_KERNEL);
4cf95663c   Dmitry Torokhov   Regulators: virtu...
314
  	if (drvdata == NULL)
72b86876d   Mark Brown   regulator: Improv...
315
  		return -ENOMEM;
c080909ee   Mark Brown   regulator: regula...
316
317
  
  	mutex_init(&drvdata->lock);
a81edbdeb   Axel Lin   regulator: virtua...
318
  	drvdata->regulator = devm_regulator_get(&pdev->dev, reg_id);
c080909ee   Mark Brown   regulator: regula...
319
320
  	if (IS_ERR(drvdata->regulator)) {
  		ret = PTR_ERR(drvdata->regulator);
d61c3d56e   Mark Brown   regulator: Report...
321
322
323
  		dev_err(&pdev->dev, "Failed to obtain supply '%s': %d
  ",
  			reg_id, ret);
a81edbdeb   Axel Lin   regulator: virtua...
324
  		return ret;
c080909ee   Mark Brown   regulator: regula...
325
  	}
4cf95663c   Dmitry Torokhov   Regulators: virtu...
326
327
328
329
330
331
  	ret = sysfs_create_group(&pdev->dev.kobj,
  				 &regulator_virtual_attr_group);
  	if (ret != 0) {
  		dev_err(&pdev->dev,
  			"Failed to create attribute group: %d
  ", ret);
a81edbdeb   Axel Lin   regulator: virtua...
332
  		return ret;
c080909ee   Mark Brown   regulator: regula...
333
334
335
336
337
338
339
  	}
  
  	drvdata->mode = regulator_get_mode(drvdata->regulator);
  
  	platform_set_drvdata(pdev, drvdata);
  
  	return 0;
c080909ee   Mark Brown   regulator: regula...
340
  }
8dc995f56   Bill Pemberton   regulator: remove...
341
  static int regulator_virtual_remove(struct platform_device *pdev)
c080909ee   Mark Brown   regulator: regula...
342
343
  {
  	struct virtual_consumer_data *drvdata = platform_get_drvdata(pdev);
c080909ee   Mark Brown   regulator: regula...
344

4cf95663c   Dmitry Torokhov   Regulators: virtu...
345
  	sysfs_remove_group(&pdev->dev.kobj, &regulator_virtual_attr_group);
c080909ee   Mark Brown   regulator: regula...
346
347
  	if (drvdata->enabled)
  		regulator_disable(drvdata->regulator);
c080909ee   Mark Brown   regulator: regula...
348
349
350
351
352
  
  	return 0;
  }
  
  static struct platform_driver regulator_virtual_consumer_driver = {
4cf95663c   Dmitry Torokhov   Regulators: virtu...
353
  	.probe		= regulator_virtual_probe,
5eb9f2b96   Bill Pemberton   regulator: remove...
354
  	.remove		= regulator_virtual_remove,
c080909ee   Mark Brown   regulator: regula...
355
356
357
358
  	.driver		= {
  		.name		= "reg-virt-consumer",
  	},
  };
005d610f2   Axel Lin   regulator: Conver...
359
  module_platform_driver(regulator_virtual_consumer_driver);
c080909ee   Mark Brown   regulator: regula...
360
361
362
363
  
  MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
  MODULE_DESCRIPTION("Virtual regulator consumer");
  MODULE_LICENSE("GPL");
38c53c891   Mark Brown   regulator: Set MO...
364
  MODULE_ALIAS("platform:reg-virt-consumer");