Blame view

drivers/regulator/virtual.c 8.18 KB
2874c5fd2   Thomas Gleixner   treewide: Replace...
1
  // SPDX-License-Identifier: GPL-2.0-or-later
c080909ee   Mark Brown   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   Mark Brown   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   Tejun Heo   include cleanup: ...
14
  #include <linux/slab.h>
65602c32e   Paul Gortmaker   regulator: Add mo...
15
  #include <linux/module.h>
c080909ee   Mark Brown   regulator: regula...
16
17
18
19
  
  struct virtual_consumer_data {
  	struct mutex lock;
  	struct regulator *regulator;
4cf95663c   Dmitry Torokhov   Regulators: virtu...
20
  	bool enabled;
c080909ee   Mark Brown   regulator: regula...
21
22
23
24
25
26
  	int min_uV;
  	int max_uV;
  	int min_uA;
  	int max_uA;
  	unsigned int mode;
  };
a07ac2171   Mark Brown   regulator: Make v...
27
28
  static void update_voltage_constraints(struct device *dev,
  				       struct virtual_consumer_data *data)
c080909ee   Mark Brown   regulator: regula...
29
30
31
32
33
  {
  	int ret;
  
  	if (data->min_uV && data->max_uV
  	    && data->min_uV <= data->max_uV) {
a5d2abce4   Mark Brown   regulator: Make v...
34
35
36
  		dev_dbg(dev, "Requesting %d-%duV
  ",
  			data->min_uV, data->max_uV);
c080909ee   Mark Brown   regulator: regula...
37
  		ret = regulator_set_voltage(data->regulator,
a07ac2171   Mark Brown   regulator: Make v...
38
  					data->min_uV, data->max_uV);
c080909ee   Mark Brown   regulator: regula...
39
  		if (ret != 0) {
a07ac2171   Mark Brown   regulator: Make v...
40
41
42
  			dev_err(dev,
  				"regulator_set_voltage() failed: %d
  ", ret);
c080909ee   Mark Brown   regulator: regula...
43
44
45
46
47
  			return;
  		}
  	}
  
  	if (data->min_uV && data->max_uV && !data->enabled) {
a5d2abce4   Mark Brown   regulator: Make v...
48
49
  		dev_dbg(dev, "Enabling regulator
  ");
c080909ee   Mark Brown   regulator: regula...
50
51
  		ret = regulator_enable(data->regulator);
  		if (ret == 0)
4cf95663c   Dmitry Torokhov   Regulators: virtu...
52
  			data->enabled = true;
c080909ee   Mark Brown   regulator: regula...
53
  		else
a07ac2171   Mark Brown   regulator: Make v...
54
55
  			dev_err(dev, "regulator_enable() failed: %d
  ",
c080909ee   Mark Brown   regulator: regula...
56
57
58
59
  				ret);
  	}
  
  	if (!(data->min_uV && data->max_uV) && data->enabled) {
a5d2abce4   Mark Brown   regulator: Make v...
60
61
  		dev_dbg(dev, "Disabling regulator
  ");
c080909ee   Mark Brown   regulator: regula...
62
63
  		ret = regulator_disable(data->regulator);
  		if (ret == 0)
4cf95663c   Dmitry Torokhov   Regulators: virtu...
64
  			data->enabled = false;
c080909ee   Mark Brown   regulator: regula...
65
  		else
a07ac2171   Mark Brown   regulator: Make v...
66
67
  			dev_err(dev, "regulator_disable() failed: %d
  ",
c080909ee   Mark Brown   regulator: regula...
68
69
70
  				ret);
  	}
  }
a07ac2171   Mark Brown   regulator: Make v...
71
72
  static void update_current_limit_constraints(struct device *dev,
  					  struct virtual_consumer_data *data)
c080909ee   Mark Brown   regulator: regula...
73
74
75
76
77
  {
  	int ret;
  
  	if (data->max_uA
  	    && data->min_uA <= data->max_uA) {
a5d2abce4   Mark Brown   regulator: Make v...
78
79
80
  		dev_dbg(dev, "Requesting %d-%duA
  ",
  			data->min_uA, data->max_uA);
c080909ee   Mark Brown   regulator: regula...
81
82
83
  		ret = regulator_set_current_limit(data->regulator,
  					data->min_uA, data->max_uA);
  		if (ret != 0) {
a07ac2171   Mark Brown   regulator: Make v...
84
85
86
87
  			dev_err(dev,
  				"regulator_set_current_limit() failed: %d
  ",
  				ret);
c080909ee   Mark Brown   regulator: regula...
88
89
90
91
92
  			return;
  		}
  	}
  
  	if (data->max_uA && !data->enabled) {
a5d2abce4   Mark Brown   regulator: Make v...
93
94
  		dev_dbg(dev, "Enabling regulator
  ");
c080909ee   Mark Brown   regulator: regula...
95
96
  		ret = regulator_enable(data->regulator);
  		if (ret == 0)
4cf95663c   Dmitry Torokhov   Regulators: virtu...
97
  			data->enabled = true;
c080909ee   Mark Brown   regulator: regula...
98
  		else
a07ac2171   Mark Brown   regulator: Make v...
99
100
  			dev_err(dev, "regulator_enable() failed: %d
  ",
c080909ee   Mark Brown   regulator: regula...
101
102
103
104
  				ret);
  	}
  
  	if (!(data->min_uA && data->max_uA) && data->enabled) {
a5d2abce4   Mark Brown   regulator: Make v...
105
106
  		dev_dbg(dev, "Disabling regulator
  ");
c080909ee   Mark Brown   regulator: regula...
107
108
  		ret = regulator_disable(data->regulator);
  		if (ret == 0)
4cf95663c   Dmitry Torokhov   Regulators: virtu...
109
  			data->enabled = false;
c080909ee   Mark Brown   regulator: regula...
110
  		else
a07ac2171   Mark Brown   regulator: Make v...
111
112
  			dev_err(dev, "regulator_disable() failed: %d
  ",
c080909ee   Mark Brown   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   Axel Lin   regulator: virtua...
130
  	if (kstrtol(buf, 10, &val) != 0)
c080909ee   Mark Brown   regulator: regula...
131
132
133
134
135
  		return count;
  
  	mutex_lock(&data->lock);
  
  	data->min_uV = val;
a07ac2171   Mark Brown   regulator: Make v...
136
  	update_voltage_constraints(dev, data);
c080909ee   Mark Brown   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   Axel Lin   regulator: virtua...
156
  	if (kstrtol(buf, 10, &val) != 0)
c080909ee   Mark Brown   regulator: regula...
157
158
159
160
161
  		return count;
  
  	mutex_lock(&data->lock);
  
  	data->max_uV = val;
a07ac2171   Mark Brown   regulator: Make v...
162
  	update_voltage_constraints(dev, data);
c080909ee   Mark Brown   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   Axel Lin   regulator: virtua...
182
  	if (kstrtol(buf, 10, &val) != 0)
c080909ee   Mark Brown   regulator: regula...
183
184
185
186
187
  		return count;
  
  	mutex_lock(&data->lock);
  
  	data->min_uA = val;
a07ac2171   Mark Brown   regulator: Make v...
188
  	update_current_limit_constraints(dev, data);
c080909ee   Mark Brown   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   Axel Lin   regulator: virtua...
208
  	if (kstrtol(buf, 10, &val) != 0)
c080909ee   Mark Brown   regulator: regula...
209
210
211
212
213
  		return count;
  
  	mutex_lock(&data->lock);
  
  	data->max_uA = val;
a07ac2171   Mark Brown   regulator: Make v...
214
  	update_current_limit_constraints(dev, data);
c080909ee   Mark Brown   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   Andrew Morton   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   Mike Rapoport   regulator/virtual...
256
257
  	if (sysfs_streq(buf, "fast
  "))
c080909ee   Mark Brown   regulator: regula...
258
  		mode = REGULATOR_MODE_FAST;
aa61d558f   Mike Rapoport   regulator/virtual...
259
260
  	else if (sysfs_streq(buf, "normal
  "))
c080909ee   Mark Brown   regulator: regula...
261
  		mode = REGULATOR_MODE_NORMAL;
aa61d558f   Mike Rapoport   regulator/virtual...
262
263
  	else if (sysfs_streq(buf, "idle
  "))
c080909ee   Mark Brown   regulator: regula...
264
  		mode = REGULATOR_MODE_IDLE;
aa61d558f   Mike Rapoport   regulator/virtual...
265
266
  	else if (sysfs_streq(buf, "standby
  "))
c080909ee   Mark Brown   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   Rusty Russell   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   Mark Brown   regulator: regula...
290

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

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

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