1 /*
2  * core.c  --  Voltage/Current Regulator framework.
3  *
4  * Copyright 2007, 2008 Wolfson Microelectronics PLC.
5  * Copyright 2008 SlimLogic Ltd.
6  *
7  * Author: Liam Girdwood <lrg@slimlogic.co.uk>
8  *
9  *  This program is free software; you can redistribute  it and/or modify it
10  *  under  the terms of  the GNU General  Public License as published by the
11  *  Free Software Foundation;  either version 2 of the  License, or (at your
12  *  option) any later version.
13  *
14  */
15 
16 #define pr_fmt(fmt) "%s: " fmt, __func__
17 
18 #include <linux/kernel.h>
19 #include <linux/init.h>
20 #include <linux/debugfs.h>
21 #include <linux/device.h>
22 #include <linux/slab.h>
23 #include <linux/err.h>
24 #include <linux/mutex.h>
25 #include <linux/suspend.h>
26 #include <linux/delay.h>
27 #include <linux/regulator/consumer.h>
28 #include <linux/regulator/driver.h>
29 #include <linux/regulator/machine.h>
30 
31 #define CREATE_TRACE_POINTS
32 #include <trace/events/regulator.h>
33 
34 #include "dummy.h"
35 
36 #define rdev_err(rdev, fmt, ...)					\
37 	pr_err("%s: " fmt, rdev_get_name(rdev), ##__VA_ARGS__)
38 #define rdev_warn(rdev, fmt, ...)					\
39 	pr_warn("%s: " fmt, rdev_get_name(rdev), ##__VA_ARGS__)
40 #define rdev_info(rdev, fmt, ...)					\
41 	pr_info("%s: " fmt, rdev_get_name(rdev), ##__VA_ARGS__)
42 #define rdev_dbg(rdev, fmt, ...)					\
43 	pr_debug("%s: " fmt, rdev_get_name(rdev), ##__VA_ARGS__)
44 
45 static DEFINE_MUTEX(regulator_list_mutex);
46 static LIST_HEAD(regulator_list);
47 static LIST_HEAD(regulator_map_list);
48 static bool has_full_constraints;
49 static bool board_wants_dummy_regulator;
50 
51 #ifdef CONFIG_DEBUG_FS
52 static struct dentry *debugfs_root;
53 #endif
54 
55 /*
56  * struct regulator_map
57  *
58  * Used to provide symbolic supply names to devices.
59  */
60 struct regulator_map {
61 	struct list_head list;
62 	const char *dev_name;   /* The dev_name() for the consumer */
63 	const char *supply;
64 	struct regulator_dev *regulator;
65 };
66 
67 /*
68  * struct regulator
69  *
70  * One for each consumer device.
71  */
72 struct regulator {
73 	struct device *dev;
74 	struct list_head list;
75 	int uA_load;
76 	int min_uV;
77 	int max_uV;
78 	char *supply_name;
79 	struct device_attribute dev_attr;
80 	struct regulator_dev *rdev;
81 };
82 
83 static int _regulator_is_enabled(struct regulator_dev *rdev);
84 static int _regulator_disable(struct regulator_dev *rdev,
85 		struct regulator_dev **supply_rdev_ptr);
86 static int _regulator_get_voltage(struct regulator_dev *rdev);
87 static int _regulator_get_current_limit(struct regulator_dev *rdev);
88 static unsigned int _regulator_get_mode(struct regulator_dev *rdev);
89 static void _notifier_call_chain(struct regulator_dev *rdev,
90 				  unsigned long event, void *data);
91 static int _regulator_do_set_voltage(struct regulator_dev *rdev,
92 				     int min_uV, int max_uV);
93 
rdev_get_name(struct regulator_dev * rdev)94 static const char *rdev_get_name(struct regulator_dev *rdev)
95 {
96 	if (rdev->constraints && rdev->constraints->name)
97 		return rdev->constraints->name;
98 	else if (rdev->desc->name)
99 		return rdev->desc->name;
100 	else
101 		return "";
102 }
103 
104 /* gets the regulator for a given consumer device */
get_device_regulator(struct device * dev)105 static struct regulator *get_device_regulator(struct device *dev)
106 {
107 	struct regulator *regulator = NULL;
108 	struct regulator_dev *rdev;
109 
110 	mutex_lock(&regulator_list_mutex);
111 	list_for_each_entry(rdev, &regulator_list, list) {
112 		mutex_lock(&rdev->mutex);
113 		list_for_each_entry(regulator, &rdev->consumer_list, list) {
114 			if (regulator->dev == dev) {
115 				mutex_unlock(&rdev->mutex);
116 				mutex_unlock(&regulator_list_mutex);
117 				return regulator;
118 			}
119 		}
120 		mutex_unlock(&rdev->mutex);
121 	}
122 	mutex_unlock(&regulator_list_mutex);
123 	return NULL;
124 }
125 
126 /* Platform voltage constraint check */
regulator_check_voltage(struct regulator_dev * rdev,int * min_uV,int * max_uV)127 static int regulator_check_voltage(struct regulator_dev *rdev,
128 				   int *min_uV, int *max_uV)
129 {
130 	BUG_ON(*min_uV > *max_uV);
131 
132 	if (!rdev->constraints) {
133 		rdev_err(rdev, "no constraints\n");
134 		return -ENODEV;
135 	}
136 	if (!(rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_VOLTAGE)) {
137 		rdev_err(rdev, "operation not allowed\n");
138 		return -EPERM;
139 	}
140 
141 	if (*max_uV > rdev->constraints->max_uV)
142 		*max_uV = rdev->constraints->max_uV;
143 	if (*min_uV < rdev->constraints->min_uV)
144 		*min_uV = rdev->constraints->min_uV;
145 
146 	if (*min_uV > *max_uV)
147 		return -EINVAL;
148 
149 	return 0;
150 }
151 
152 /* Make sure we select a voltage that suits the needs of all
153  * regulator consumers
154  */
regulator_check_consumers(struct regulator_dev * rdev,int * min_uV,int * max_uV)155 static int regulator_check_consumers(struct regulator_dev *rdev,
156 				     int *min_uV, int *max_uV)
157 {
158 	struct regulator *regulator;
159 
160 	list_for_each_entry(regulator, &rdev->consumer_list, list) {
161 		if (*max_uV > regulator->max_uV)
162 			*max_uV = regulator->max_uV;
163 		if (*min_uV < regulator->min_uV)
164 			*min_uV = regulator->min_uV;
165 	}
166 
167 	if (*min_uV > *max_uV)
168 		return -EINVAL;
169 
170 	return 0;
171 }
172 
173 /* current constraint check */
regulator_check_current_limit(struct regulator_dev * rdev,int * min_uA,int * max_uA)174 static int regulator_check_current_limit(struct regulator_dev *rdev,
175 					int *min_uA, int *max_uA)
176 {
177 	BUG_ON(*min_uA > *max_uA);
178 
179 	if (!rdev->constraints) {
180 		rdev_err(rdev, "no constraints\n");
181 		return -ENODEV;
182 	}
183 	if (!(rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_CURRENT)) {
184 		rdev_err(rdev, "operation not allowed\n");
185 		return -EPERM;
186 	}
187 
188 	if (*max_uA > rdev->constraints->max_uA)
189 		*max_uA = rdev->constraints->max_uA;
190 	if (*min_uA < rdev->constraints->min_uA)
191 		*min_uA = rdev->constraints->min_uA;
192 
193 	if (*min_uA > *max_uA)
194 		return -EINVAL;
195 
196 	return 0;
197 }
198 
199 /* operating mode constraint check */
regulator_check_mode(struct regulator_dev * rdev,int mode)200 static int regulator_check_mode(struct regulator_dev *rdev, int mode)
201 {
202 	switch (mode) {
203 	case REGULATOR_MODE_FAST:
204 	case REGULATOR_MODE_NORMAL:
205 	case REGULATOR_MODE_IDLE:
206 	case REGULATOR_MODE_STANDBY:
207 		break;
208 	default:
209 		return -EINVAL;
210 	}
211 
212 	if (!rdev->constraints) {
213 		rdev_err(rdev, "no constraints\n");
214 		return -ENODEV;
215 	}
216 	if (!(rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_MODE)) {
217 		rdev_err(rdev, "operation not allowed\n");
218 		return -EPERM;
219 	}
220 	if (!(rdev->constraints->valid_modes_mask & mode)) {
221 		rdev_err(rdev, "invalid mode %x\n", mode);
222 		return -EINVAL;
223 	}
224 	return 0;
225 }
226 
227 /* dynamic regulator mode switching constraint check */
regulator_check_drms(struct regulator_dev * rdev)228 static int regulator_check_drms(struct regulator_dev *rdev)
229 {
230 	if (!rdev->constraints) {
231 		rdev_err(rdev, "no constraints\n");
232 		return -ENODEV;
233 	}
234 	if (!(rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_DRMS)) {
235 		rdev_err(rdev, "operation not allowed\n");
236 		return -EPERM;
237 	}
238 	return 0;
239 }
240 
device_requested_uA_show(struct device * dev,struct device_attribute * attr,char * buf)241 static ssize_t device_requested_uA_show(struct device *dev,
242 			     struct device_attribute *attr, char *buf)
243 {
244 	struct regulator *regulator;
245 
246 	regulator = get_device_regulator(dev);
247 	if (regulator == NULL)
248 		return 0;
249 
250 	return sprintf(buf, "%d\n", regulator->uA_load);
251 }
252 
regulator_uV_show(struct device * dev,struct device_attribute * attr,char * buf)253 static ssize_t regulator_uV_show(struct device *dev,
254 				struct device_attribute *attr, char *buf)
255 {
256 	struct regulator_dev *rdev = dev_get_drvdata(dev);
257 	ssize_t ret;
258 
259 	mutex_lock(&rdev->mutex);
260 	ret = sprintf(buf, "%d\n", _regulator_get_voltage(rdev));
261 	mutex_unlock(&rdev->mutex);
262 
263 	return ret;
264 }
265 static DEVICE_ATTR(microvolts, 0444, regulator_uV_show, NULL);
266 
regulator_uA_show(struct device * dev,struct device_attribute * attr,char * buf)267 static ssize_t regulator_uA_show(struct device *dev,
268 				struct device_attribute *attr, char *buf)
269 {
270 	struct regulator_dev *rdev = dev_get_drvdata(dev);
271 
272 	return sprintf(buf, "%d\n", _regulator_get_current_limit(rdev));
273 }
274 static DEVICE_ATTR(microamps, 0444, regulator_uA_show, NULL);
275 
regulator_name_show(struct device * dev,struct device_attribute * attr,char * buf)276 static ssize_t regulator_name_show(struct device *dev,
277 			     struct device_attribute *attr, char *buf)
278 {
279 	struct regulator_dev *rdev = dev_get_drvdata(dev);
280 
281 	return sprintf(buf, "%s\n", rdev_get_name(rdev));
282 }
283 
regulator_print_opmode(char * buf,int mode)284 static ssize_t regulator_print_opmode(char *buf, int mode)
285 {
286 	switch (mode) {
287 	case REGULATOR_MODE_FAST:
288 		return sprintf(buf, "fast\n");
289 	case REGULATOR_MODE_NORMAL:
290 		return sprintf(buf, "normal\n");
291 	case REGULATOR_MODE_IDLE:
292 		return sprintf(buf, "idle\n");
293 	case REGULATOR_MODE_STANDBY:
294 		return sprintf(buf, "standby\n");
295 	}
296 	return sprintf(buf, "unknown\n");
297 }
298 
regulator_opmode_show(struct device * dev,struct device_attribute * attr,char * buf)299 static ssize_t regulator_opmode_show(struct device *dev,
300 				    struct device_attribute *attr, char *buf)
301 {
302 	struct regulator_dev *rdev = dev_get_drvdata(dev);
303 
304 	return regulator_print_opmode(buf, _regulator_get_mode(rdev));
305 }
306 static DEVICE_ATTR(opmode, 0444, regulator_opmode_show, NULL);
307 
regulator_print_state(char * buf,int state)308 static ssize_t regulator_print_state(char *buf, int state)
309 {
310 	if (state > 0)
311 		return sprintf(buf, "enabled\n");
312 	else if (state == 0)
313 		return sprintf(buf, "disabled\n");
314 	else
315 		return sprintf(buf, "unknown\n");
316 }
317 
regulator_state_show(struct device * dev,struct device_attribute * attr,char * buf)318 static ssize_t regulator_state_show(struct device *dev,
319 				   struct device_attribute *attr, char *buf)
320 {
321 	struct regulator_dev *rdev = dev_get_drvdata(dev);
322 	ssize_t ret;
323 
324 	mutex_lock(&rdev->mutex);
325 	ret = regulator_print_state(buf, _regulator_is_enabled(rdev));
326 	mutex_unlock(&rdev->mutex);
327 
328 	return ret;
329 }
330 static DEVICE_ATTR(state, 0444, regulator_state_show, NULL);
331 
regulator_status_show(struct device * dev,struct device_attribute * attr,char * buf)332 static ssize_t regulator_status_show(struct device *dev,
333 				   struct device_attribute *attr, char *buf)
334 {
335 	struct regulator_dev *rdev = dev_get_drvdata(dev);
336 	int status;
337 	char *label;
338 
339 	status = rdev->desc->ops->get_status(rdev);
340 	if (status < 0)
341 		return status;
342 
343 	switch (status) {
344 	case REGULATOR_STATUS_OFF:
345 		label = "off";
346 		break;
347 	case REGULATOR_STATUS_ON:
348 		label = "on";
349 		break;
350 	case REGULATOR_STATUS_ERROR:
351 		label = "error";
352 		break;
353 	case REGULATOR_STATUS_FAST:
354 		label = "fast";
355 		break;
356 	case REGULATOR_STATUS_NORMAL:
357 		label = "normal";
358 		break;
359 	case REGULATOR_STATUS_IDLE:
360 		label = "idle";
361 		break;
362 	case REGULATOR_STATUS_STANDBY:
363 		label = "standby";
364 		break;
365 	default:
366 		return -ERANGE;
367 	}
368 
369 	return sprintf(buf, "%s\n", label);
370 }
371 static DEVICE_ATTR(status, 0444, regulator_status_show, NULL);
372 
regulator_min_uA_show(struct device * dev,struct device_attribute * attr,char * buf)373 static ssize_t regulator_min_uA_show(struct device *dev,
374 				    struct device_attribute *attr, char *buf)
375 {
376 	struct regulator_dev *rdev = dev_get_drvdata(dev);
377 
378 	if (!rdev->constraints)
379 		return sprintf(buf, "constraint not defined\n");
380 
381 	return sprintf(buf, "%d\n", rdev->constraints->min_uA);
382 }
383 static DEVICE_ATTR(min_microamps, 0444, regulator_min_uA_show, NULL);
384 
regulator_max_uA_show(struct device * dev,struct device_attribute * attr,char * buf)385 static ssize_t regulator_max_uA_show(struct device *dev,
386 				    struct device_attribute *attr, char *buf)
387 {
388 	struct regulator_dev *rdev = dev_get_drvdata(dev);
389 
390 	if (!rdev->constraints)
391 		return sprintf(buf, "constraint not defined\n");
392 
393 	return sprintf(buf, "%d\n", rdev->constraints->max_uA);
394 }
395 static DEVICE_ATTR(max_microamps, 0444, regulator_max_uA_show, NULL);
396 
regulator_min_uV_show(struct device * dev,struct device_attribute * attr,char * buf)397 static ssize_t regulator_min_uV_show(struct device *dev,
398 				    struct device_attribute *attr, char *buf)
399 {
400 	struct regulator_dev *rdev = dev_get_drvdata(dev);
401 
402 	if (!rdev->constraints)
403 		return sprintf(buf, "constraint not defined\n");
404 
405 	return sprintf(buf, "%d\n", rdev->constraints->min_uV);
406 }
407 static DEVICE_ATTR(min_microvolts, 0444, regulator_min_uV_show, NULL);
408 
regulator_max_uV_show(struct device * dev,struct device_attribute * attr,char * buf)409 static ssize_t regulator_max_uV_show(struct device *dev,
410 				    struct device_attribute *attr, char *buf)
411 {
412 	struct regulator_dev *rdev = dev_get_drvdata(dev);
413 
414 	if (!rdev->constraints)
415 		return sprintf(buf, "constraint not defined\n");
416 
417 	return sprintf(buf, "%d\n", rdev->constraints->max_uV);
418 }
419 static DEVICE_ATTR(max_microvolts, 0444, regulator_max_uV_show, NULL);
420 
regulator_total_uA_show(struct device * dev,struct device_attribute * attr,char * buf)421 static ssize_t regulator_total_uA_show(struct device *dev,
422 				      struct device_attribute *attr, char *buf)
423 {
424 	struct regulator_dev *rdev = dev_get_drvdata(dev);
425 	struct regulator *regulator;
426 	int uA = 0;
427 
428 	mutex_lock(&rdev->mutex);
429 	list_for_each_entry(regulator, &rdev->consumer_list, list)
430 		uA += regulator->uA_load;
431 	mutex_unlock(&rdev->mutex);
432 	return sprintf(buf, "%d\n", uA);
433 }
434 static DEVICE_ATTR(requested_microamps, 0444, regulator_total_uA_show, NULL);
435 
regulator_num_users_show(struct device * dev,struct device_attribute * attr,char * buf)436 static ssize_t regulator_num_users_show(struct device *dev,
437 				      struct device_attribute *attr, char *buf)
438 {
439 	struct regulator_dev *rdev = dev_get_drvdata(dev);
440 	return sprintf(buf, "%d\n", rdev->use_count);
441 }
442 
regulator_type_show(struct device * dev,struct device_attribute * attr,char * buf)443 static ssize_t regulator_type_show(struct device *dev,
444 				  struct device_attribute *attr, char *buf)
445 {
446 	struct regulator_dev *rdev = dev_get_drvdata(dev);
447 
448 	switch (rdev->desc->type) {
449 	case REGULATOR_VOLTAGE:
450 		return sprintf(buf, "voltage\n");
451 	case REGULATOR_CURRENT:
452 		return sprintf(buf, "current\n");
453 	}
454 	return sprintf(buf, "unknown\n");
455 }
456 
regulator_suspend_mem_uV_show(struct device * dev,struct device_attribute * attr,char * buf)457 static ssize_t regulator_suspend_mem_uV_show(struct device *dev,
458 				struct device_attribute *attr, char *buf)
459 {
460 	struct regulator_dev *rdev = dev_get_drvdata(dev);
461 
462 	return sprintf(buf, "%d\n", rdev->constraints->state_mem.uV);
463 }
464 static DEVICE_ATTR(suspend_mem_microvolts, 0444,
465 		regulator_suspend_mem_uV_show, NULL);
466 
regulator_suspend_disk_uV_show(struct device * dev,struct device_attribute * attr,char * buf)467 static ssize_t regulator_suspend_disk_uV_show(struct device *dev,
468 				struct device_attribute *attr, char *buf)
469 {
470 	struct regulator_dev *rdev = dev_get_drvdata(dev);
471 
472 	return sprintf(buf, "%d\n", rdev->constraints->state_disk.uV);
473 }
474 static DEVICE_ATTR(suspend_disk_microvolts, 0444,
475 		regulator_suspend_disk_uV_show, NULL);
476 
regulator_suspend_standby_uV_show(struct device * dev,struct device_attribute * attr,char * buf)477 static ssize_t regulator_suspend_standby_uV_show(struct device *dev,
478 				struct device_attribute *attr, char *buf)
479 {
480 	struct regulator_dev *rdev = dev_get_drvdata(dev);
481 
482 	return sprintf(buf, "%d\n", rdev->constraints->state_standby.uV);
483 }
484 static DEVICE_ATTR(suspend_standby_microvolts, 0444,
485 		regulator_suspend_standby_uV_show, NULL);
486 
regulator_suspend_mem_mode_show(struct device * dev,struct device_attribute * attr,char * buf)487 static ssize_t regulator_suspend_mem_mode_show(struct device *dev,
488 				struct device_attribute *attr, char *buf)
489 {
490 	struct regulator_dev *rdev = dev_get_drvdata(dev);
491 
492 	return regulator_print_opmode(buf,
493 		rdev->constraints->state_mem.mode);
494 }
495 static DEVICE_ATTR(suspend_mem_mode, 0444,
496 		regulator_suspend_mem_mode_show, NULL);
497 
regulator_suspend_disk_mode_show(struct device * dev,struct device_attribute * attr,char * buf)498 static ssize_t regulator_suspend_disk_mode_show(struct device *dev,
499 				struct device_attribute *attr, char *buf)
500 {
501 	struct regulator_dev *rdev = dev_get_drvdata(dev);
502 
503 	return regulator_print_opmode(buf,
504 		rdev->constraints->state_disk.mode);
505 }
506 static DEVICE_ATTR(suspend_disk_mode, 0444,
507 		regulator_suspend_disk_mode_show, NULL);
508 
regulator_suspend_standby_mode_show(struct device * dev,struct device_attribute * attr,char * buf)509 static ssize_t regulator_suspend_standby_mode_show(struct device *dev,
510 				struct device_attribute *attr, char *buf)
511 {
512 	struct regulator_dev *rdev = dev_get_drvdata(dev);
513 
514 	return regulator_print_opmode(buf,
515 		rdev->constraints->state_standby.mode);
516 }
517 static DEVICE_ATTR(suspend_standby_mode, 0444,
518 		regulator_suspend_standby_mode_show, NULL);
519 
regulator_suspend_mem_state_show(struct device * dev,struct device_attribute * attr,char * buf)520 static ssize_t regulator_suspend_mem_state_show(struct device *dev,
521 				   struct device_attribute *attr, char *buf)
522 {
523 	struct regulator_dev *rdev = dev_get_drvdata(dev);
524 
525 	return regulator_print_state(buf,
526 			rdev->constraints->state_mem.enabled);
527 }
528 static DEVICE_ATTR(suspend_mem_state, 0444,
529 		regulator_suspend_mem_state_show, NULL);
530 
regulator_suspend_disk_state_show(struct device * dev,struct device_attribute * attr,char * buf)531 static ssize_t regulator_suspend_disk_state_show(struct device *dev,
532 				   struct device_attribute *attr, char *buf)
533 {
534 	struct regulator_dev *rdev = dev_get_drvdata(dev);
535 
536 	return regulator_print_state(buf,
537 			rdev->constraints->state_disk.enabled);
538 }
539 static DEVICE_ATTR(suspend_disk_state, 0444,
540 		regulator_suspend_disk_state_show, NULL);
541 
regulator_suspend_standby_state_show(struct device * dev,struct device_attribute * attr,char * buf)542 static ssize_t regulator_suspend_standby_state_show(struct device *dev,
543 				   struct device_attribute *attr, char *buf)
544 {
545 	struct regulator_dev *rdev = dev_get_drvdata(dev);
546 
547 	return regulator_print_state(buf,
548 			rdev->constraints->state_standby.enabled);
549 }
550 static DEVICE_ATTR(suspend_standby_state, 0444,
551 		regulator_suspend_standby_state_show, NULL);
552 
553 
554 /*
555  * These are the only attributes are present for all regulators.
556  * Other attributes are a function of regulator functionality.
557  */
558 static struct device_attribute regulator_dev_attrs[] = {
559 	__ATTR(name, 0444, regulator_name_show, NULL),
560 	__ATTR(num_users, 0444, regulator_num_users_show, NULL),
561 	__ATTR(type, 0444, regulator_type_show, NULL),
562 	__ATTR_NULL,
563 };
564 
regulator_dev_release(struct device * dev)565 static void regulator_dev_release(struct device *dev)
566 {
567 	struct regulator_dev *rdev = dev_get_drvdata(dev);
568 	kfree(rdev);
569 }
570 
571 static struct class regulator_class = {
572 	.name = "regulator",
573 	.dev_release = regulator_dev_release,
574 	.dev_attrs = regulator_dev_attrs,
575 };
576 
577 /* Calculate the new optimum regulator operating mode based on the new total
578  * consumer load. All locks held by caller */
drms_uA_update(struct regulator_dev * rdev)579 static void drms_uA_update(struct regulator_dev *rdev)
580 {
581 	struct regulator *sibling;
582 	int current_uA = 0, output_uV, input_uV, err;
583 	unsigned int mode;
584 
585 	err = regulator_check_drms(rdev);
586 	if (err < 0 || !rdev->desc->ops->get_optimum_mode ||
587 	    (!rdev->desc->ops->get_voltage &&
588 	     !rdev->desc->ops->get_voltage_sel) ||
589 	    !rdev->desc->ops->set_mode)
590 		return;
591 
592 	/* get output voltage */
593 	output_uV = _regulator_get_voltage(rdev);
594 	if (output_uV <= 0)
595 		return;
596 
597 	/* get input voltage */
598 	input_uV = 0;
599 	if (rdev->supply)
600 		input_uV = _regulator_get_voltage(rdev);
601 	if (input_uV <= 0)
602 		input_uV = rdev->constraints->input_uV;
603 	if (input_uV <= 0)
604 		return;
605 
606 	/* calc total requested load */
607 	list_for_each_entry(sibling, &rdev->consumer_list, list)
608 		current_uA += sibling->uA_load;
609 
610 	/* now get the optimum mode for our new total regulator load */
611 	mode = rdev->desc->ops->get_optimum_mode(rdev, input_uV,
612 						  output_uV, current_uA);
613 
614 	/* check the new mode is allowed */
615 	err = regulator_check_mode(rdev, mode);
616 	if (err == 0)
617 		rdev->desc->ops->set_mode(rdev, mode);
618 }
619 
suspend_set_state(struct regulator_dev * rdev,struct regulator_state * rstate)620 static int suspend_set_state(struct regulator_dev *rdev,
621 	struct regulator_state *rstate)
622 {
623 	int ret = 0;
624 	bool can_set_state;
625 
626 	can_set_state = rdev->desc->ops->set_suspend_enable &&
627 		rdev->desc->ops->set_suspend_disable;
628 
629 	/* If we have no suspend mode configration don't set anything;
630 	 * only warn if the driver actually makes the suspend mode
631 	 * configurable.
632 	 */
633 	if (!rstate->enabled && !rstate->disabled) {
634 		if (can_set_state)
635 			rdev_warn(rdev, "No configuration\n");
636 		return 0;
637 	}
638 
639 	if (rstate->enabled && rstate->disabled) {
640 		rdev_err(rdev, "invalid configuration\n");
641 		return -EINVAL;
642 	}
643 
644 	if (!can_set_state) {
645 		rdev_err(rdev, "no way to set suspend state\n");
646 		return -EINVAL;
647 	}
648 
649 	if (rstate->enabled)
650 		ret = rdev->desc->ops->set_suspend_enable(rdev);
651 	else
652 		ret = rdev->desc->ops->set_suspend_disable(rdev);
653 	if (ret < 0) {
654 		rdev_err(rdev, "failed to enabled/disable\n");
655 		return ret;
656 	}
657 
658 	if (rdev->desc->ops->set_suspend_voltage && rstate->uV > 0) {
659 		ret = rdev->desc->ops->set_suspend_voltage(rdev, rstate->uV);
660 		if (ret < 0) {
661 			rdev_err(rdev, "failed to set voltage\n");
662 			return ret;
663 		}
664 	}
665 
666 	if (rdev->desc->ops->set_suspend_mode && rstate->mode > 0) {
667 		ret = rdev->desc->ops->set_suspend_mode(rdev, rstate->mode);
668 		if (ret < 0) {
669 			rdev_err(rdev, "failed to set mode\n");
670 			return ret;
671 		}
672 	}
673 	return ret;
674 }
675 
676 /* locks held by caller */
suspend_prepare(struct regulator_dev * rdev,suspend_state_t state)677 static int suspend_prepare(struct regulator_dev *rdev, suspend_state_t state)
678 {
679 	if (!rdev->constraints)
680 		return -EINVAL;
681 
682 	switch (state) {
683 	case PM_SUSPEND_STANDBY:
684 		return suspend_set_state(rdev,
685 			&rdev->constraints->state_standby);
686 	case PM_SUSPEND_MEM:
687 		return suspend_set_state(rdev,
688 			&rdev->constraints->state_mem);
689 	case PM_SUSPEND_MAX:
690 		return suspend_set_state(rdev,
691 			&rdev->constraints->state_disk);
692 	default:
693 		return -EINVAL;
694 	}
695 }
696 
print_constraints(struct regulator_dev * rdev)697 static void print_constraints(struct regulator_dev *rdev)
698 {
699 	struct regulation_constraints *constraints = rdev->constraints;
700 	char buf[80] = "";
701 	int count = 0;
702 	int ret;
703 
704 	if (constraints->min_uV && constraints->max_uV) {
705 		if (constraints->min_uV == constraints->max_uV)
706 			count += sprintf(buf + count, "%d mV ",
707 					 constraints->min_uV / 1000);
708 		else
709 			count += sprintf(buf + count, "%d <--> %d mV ",
710 					 constraints->min_uV / 1000,
711 					 constraints->max_uV / 1000);
712 	}
713 
714 	if (!constraints->min_uV ||
715 	    constraints->min_uV != constraints->max_uV) {
716 		ret = _regulator_get_voltage(rdev);
717 		if (ret > 0)
718 			count += sprintf(buf + count, "at %d mV ", ret / 1000);
719 	}
720 
721 	if (constraints->min_uA && constraints->max_uA) {
722 		if (constraints->min_uA == constraints->max_uA)
723 			count += sprintf(buf + count, "%d mA ",
724 					 constraints->min_uA / 1000);
725 		else
726 			count += sprintf(buf + count, "%d <--> %d mA ",
727 					 constraints->min_uA / 1000,
728 					 constraints->max_uA / 1000);
729 	}
730 
731 	if (!constraints->min_uA ||
732 	    constraints->min_uA != constraints->max_uA) {
733 		ret = _regulator_get_current_limit(rdev);
734 		if (ret > 0)
735 			count += sprintf(buf + count, "at %d mA ", ret / 1000);
736 	}
737 
738 	if (constraints->valid_modes_mask & REGULATOR_MODE_FAST)
739 		count += sprintf(buf + count, "fast ");
740 	if (constraints->valid_modes_mask & REGULATOR_MODE_NORMAL)
741 		count += sprintf(buf + count, "normal ");
742 	if (constraints->valid_modes_mask & REGULATOR_MODE_IDLE)
743 		count += sprintf(buf + count, "idle ");
744 	if (constraints->valid_modes_mask & REGULATOR_MODE_STANDBY)
745 		count += sprintf(buf + count, "standby");
746 
747 	rdev_info(rdev, "%s\n", buf);
748 }
749 
machine_constraints_voltage(struct regulator_dev * rdev,struct regulation_constraints * constraints)750 static int machine_constraints_voltage(struct regulator_dev *rdev,
751 	struct regulation_constraints *constraints)
752 {
753 	struct regulator_ops *ops = rdev->desc->ops;
754 	int ret;
755 
756 	/* do we need to apply the constraint voltage */
757 	if (rdev->constraints->apply_uV &&
758 	    rdev->constraints->min_uV == rdev->constraints->max_uV) {
759 		ret = _regulator_do_set_voltage(rdev,
760 						rdev->constraints->min_uV,
761 						rdev->constraints->max_uV);
762 		if (ret < 0) {
763 			rdev_err(rdev, "failed to apply %duV constraint\n",
764 				 rdev->constraints->min_uV);
765 			rdev->constraints = NULL;
766 			return ret;
767 		}
768 	}
769 
770 	/* constrain machine-level voltage specs to fit
771 	 * the actual range supported by this regulator.
772 	 */
773 	if (ops->list_voltage && rdev->desc->n_voltages) {
774 		int	count = rdev->desc->n_voltages;
775 		int	i;
776 		int	min_uV = INT_MAX;
777 		int	max_uV = INT_MIN;
778 		int	cmin = constraints->min_uV;
779 		int	cmax = constraints->max_uV;
780 
781 		/* it's safe to autoconfigure fixed-voltage supplies
782 		   and the constraints are used by list_voltage. */
783 		if (count == 1 && !cmin) {
784 			cmin = 1;
785 			cmax = INT_MAX;
786 			constraints->min_uV = cmin;
787 			constraints->max_uV = cmax;
788 		}
789 
790 		/* voltage constraints are optional */
791 		if ((cmin == 0) && (cmax == 0))
792 			return 0;
793 
794 		/* else require explicit machine-level constraints */
795 		if (cmin <= 0 || cmax <= 0 || cmax < cmin) {
796 			rdev_err(rdev, "invalid voltage constraints\n");
797 			return -EINVAL;
798 		}
799 
800 		/* initial: [cmin..cmax] valid, [min_uV..max_uV] not */
801 		for (i = 0; i < count; i++) {
802 			int	value;
803 
804 			value = ops->list_voltage(rdev, i);
805 			if (value <= 0)
806 				continue;
807 
808 			/* maybe adjust [min_uV..max_uV] */
809 			if (value >= cmin && value < min_uV)
810 				min_uV = value;
811 			if (value <= cmax && value > max_uV)
812 				max_uV = value;
813 		}
814 
815 		/* final: [min_uV..max_uV] valid iff constraints valid */
816 		if (max_uV < min_uV) {
817 			rdev_err(rdev, "unsupportable voltage constraints\n");
818 			return -EINVAL;
819 		}
820 
821 		/* use regulator's subset of machine constraints */
822 		if (constraints->min_uV < min_uV) {
823 			rdev_dbg(rdev, "override min_uV, %d -> %d\n",
824 				 constraints->min_uV, min_uV);
825 			constraints->min_uV = min_uV;
826 		}
827 		if (constraints->max_uV > max_uV) {
828 			rdev_dbg(rdev, "override max_uV, %d -> %d\n",
829 				 constraints->max_uV, max_uV);
830 			constraints->max_uV = max_uV;
831 		}
832 	}
833 
834 	return 0;
835 }
836 
837 /**
838  * set_machine_constraints - sets regulator constraints
839  * @rdev: regulator source
840  * @constraints: constraints to apply
841  *
842  * Allows platform initialisation code to define and constrain
843  * regulator circuits e.g. valid voltage/current ranges, etc.  NOTE:
844  * Constraints *must* be set by platform code in order for some
845  * regulator operations to proceed i.e. set_voltage, set_current_limit,
846  * set_mode.
847  */
set_machine_constraints(struct regulator_dev * rdev,const struct regulation_constraints * constraints)848 static int set_machine_constraints(struct regulator_dev *rdev,
849 	const struct regulation_constraints *constraints)
850 {
851 	int ret = 0;
852 	struct regulator_ops *ops = rdev->desc->ops;
853 
854 	rdev->constraints = kmemdup(constraints, sizeof(*constraints),
855 				    GFP_KERNEL);
856 	if (!rdev->constraints)
857 		return -ENOMEM;
858 
859 	ret = machine_constraints_voltage(rdev, rdev->constraints);
860 	if (ret != 0)
861 		goto out;
862 
863 	/* do we need to setup our suspend state */
864 	if (constraints->initial_state) {
865 		ret = suspend_prepare(rdev, rdev->constraints->initial_state);
866 		if (ret < 0) {
867 			rdev_err(rdev, "failed to set suspend state\n");
868 			rdev->constraints = NULL;
869 			goto out;
870 		}
871 	}
872 
873 	if (constraints->initial_mode) {
874 		if (!ops->set_mode) {
875 			rdev_err(rdev, "no set_mode operation\n");
876 			ret = -EINVAL;
877 			goto out;
878 		}
879 
880 		ret = ops->set_mode(rdev, rdev->constraints->initial_mode);
881 		if (ret < 0) {
882 			rdev_err(rdev, "failed to set initial mode: %d\n", ret);
883 			goto out;
884 		}
885 	}
886 
887 	/* If the constraints say the regulator should be on at this point
888 	 * and we have control then make sure it is enabled.
889 	 */
890 	if ((rdev->constraints->always_on || rdev->constraints->boot_on) &&
891 	    ops->enable) {
892 		ret = ops->enable(rdev);
893 		if (ret < 0) {
894 			rdev_err(rdev, "failed to enable\n");
895 			rdev->constraints = NULL;
896 			goto out;
897 		}
898 	}
899 
900 	print_constraints(rdev);
901 out:
902 	return ret;
903 }
904 
905 /**
906  * set_supply - set regulator supply regulator
907  * @rdev: regulator name
908  * @supply_rdev: supply regulator name
909  *
910  * Called by platform initialisation code to set the supply regulator for this
911  * regulator. This ensures that a regulators supply will also be enabled by the
912  * core if it's child is enabled.
913  */
set_supply(struct regulator_dev * rdev,struct regulator_dev * supply_rdev)914 static int set_supply(struct regulator_dev *rdev,
915 	struct regulator_dev *supply_rdev)
916 {
917 	int err;
918 
919 	err = sysfs_create_link(&rdev->dev.kobj, &supply_rdev->dev.kobj,
920 				"supply");
921 	if (err) {
922 		rdev_err(rdev, "could not add device link %s err %d\n",
923 			 supply_rdev->dev.kobj.name, err);
924 		       goto out;
925 	}
926 	rdev->supply = supply_rdev;
927 	list_add(&rdev->slist, &supply_rdev->supply_list);
928 out:
929 	return err;
930 }
931 
932 /**
933  * set_consumer_device_supply - Bind a regulator to a symbolic supply
934  * @rdev:         regulator source
935  * @consumer_dev: device the supply applies to
936  * @consumer_dev_name: dev_name() string for device supply applies to
937  * @supply:       symbolic name for supply
938  *
939  * Allows platform initialisation code to map physical regulator
940  * sources to symbolic names for supplies for use by devices.  Devices
941  * should use these symbolic names to request regulators, avoiding the
942  * need to provide board-specific regulator names as platform data.
943  *
944  * Only one of consumer_dev and consumer_dev_name may be specified.
945  */
set_consumer_device_supply(struct regulator_dev * rdev,struct device * consumer_dev,const char * consumer_dev_name,const char * supply)946 static int set_consumer_device_supply(struct regulator_dev *rdev,
947 	struct device *consumer_dev, const char *consumer_dev_name,
948 	const char *supply)
949 {
950 	struct regulator_map *node;
951 	int has_dev;
952 
953 	if (consumer_dev && consumer_dev_name)
954 		return -EINVAL;
955 
956 	if (!consumer_dev_name && consumer_dev)
957 		consumer_dev_name = dev_name(consumer_dev);
958 
959 	if (supply == NULL)
960 		return -EINVAL;
961 
962 	if (consumer_dev_name != NULL)
963 		has_dev = 1;
964 	else
965 		has_dev = 0;
966 
967 	list_for_each_entry(node, &regulator_map_list, list) {
968 		if (node->dev_name && consumer_dev_name) {
969 			if (strcmp(node->dev_name, consumer_dev_name) != 0)
970 				continue;
971 		} else if (node->dev_name || consumer_dev_name) {
972 			continue;
973 		}
974 
975 		if (strcmp(node->supply, supply) != 0)
976 			continue;
977 
978 		dev_dbg(consumer_dev, "%s/%s is '%s' supply; fail %s/%s\n",
979 			dev_name(&node->regulator->dev),
980 			node->regulator->desc->name,
981 			supply,
982 			dev_name(&rdev->dev), rdev_get_name(rdev));
983 		return -EBUSY;
984 	}
985 
986 	node = kzalloc(sizeof(struct regulator_map), GFP_KERNEL);
987 	if (node == NULL)
988 		return -ENOMEM;
989 
990 	node->regulator = rdev;
991 	node->supply = supply;
992 
993 	if (has_dev) {
994 		node->dev_name = kstrdup(consumer_dev_name, GFP_KERNEL);
995 		if (node->dev_name == NULL) {
996 			kfree(node);
997 			return -ENOMEM;
998 		}
999 	}
1000 
1001 	list_add(&node->list, &regulator_map_list);
1002 	return 0;
1003 }
1004 
unset_regulator_supplies(struct regulator_dev * rdev)1005 static void unset_regulator_supplies(struct regulator_dev *rdev)
1006 {
1007 	struct regulator_map *node, *n;
1008 
1009 	list_for_each_entry_safe(node, n, &regulator_map_list, list) {
1010 		if (rdev == node->regulator) {
1011 			list_del(&node->list);
1012 			kfree(node->dev_name);
1013 			kfree(node);
1014 		}
1015 	}
1016 }
1017 
1018 #define REG_STR_SIZE	32
1019 
create_regulator(struct regulator_dev * rdev,struct device * dev,const char * supply_name)1020 static struct regulator *create_regulator(struct regulator_dev *rdev,
1021 					  struct device *dev,
1022 					  const char *supply_name)
1023 {
1024 	struct regulator *regulator;
1025 	char buf[REG_STR_SIZE];
1026 	int err, size;
1027 
1028 	regulator = kzalloc(sizeof(*regulator), GFP_KERNEL);
1029 	if (regulator == NULL)
1030 		return NULL;
1031 
1032 	mutex_lock(&rdev->mutex);
1033 	regulator->rdev = rdev;
1034 	list_add(&regulator->list, &rdev->consumer_list);
1035 
1036 	if (dev) {
1037 		/* create a 'requested_microamps_name' sysfs entry */
1038 		size = scnprintf(buf, REG_STR_SIZE, "microamps_requested_%s",
1039 			supply_name);
1040 		if (size >= REG_STR_SIZE)
1041 			goto overflow_err;
1042 
1043 		regulator->dev = dev;
1044 		sysfs_attr_init(&regulator->dev_attr.attr);
1045 		regulator->dev_attr.attr.name = kstrdup(buf, GFP_KERNEL);
1046 		if (regulator->dev_attr.attr.name == NULL)
1047 			goto attr_name_err;
1048 
1049 		regulator->dev_attr.attr.mode = 0444;
1050 		regulator->dev_attr.show = device_requested_uA_show;
1051 		err = device_create_file(dev, &regulator->dev_attr);
1052 		if (err < 0) {
1053 			rdev_warn(rdev, "could not add regulator_dev requested microamps sysfs entry\n");
1054 			goto attr_name_err;
1055 		}
1056 
1057 		/* also add a link to the device sysfs entry */
1058 		size = scnprintf(buf, REG_STR_SIZE, "%s-%s",
1059 				 dev->kobj.name, supply_name);
1060 		if (size >= REG_STR_SIZE)
1061 			goto attr_err;
1062 
1063 		regulator->supply_name = kstrdup(buf, GFP_KERNEL);
1064 		if (regulator->supply_name == NULL)
1065 			goto attr_err;
1066 
1067 		err = sysfs_create_link(&rdev->dev.kobj, &dev->kobj,
1068 					buf);
1069 		if (err) {
1070 			rdev_warn(rdev, "could not add device link %s err %d\n",
1071 				  dev->kobj.name, err);
1072 			goto link_name_err;
1073 		}
1074 	}
1075 	mutex_unlock(&rdev->mutex);
1076 	return regulator;
1077 link_name_err:
1078 	kfree(regulator->supply_name);
1079 attr_err:
1080 	device_remove_file(regulator->dev, &regulator->dev_attr);
1081 attr_name_err:
1082 	kfree(regulator->dev_attr.attr.name);
1083 overflow_err:
1084 	list_del(&regulator->list);
1085 	kfree(regulator);
1086 	mutex_unlock(&rdev->mutex);
1087 	return NULL;
1088 }
1089 
_regulator_get_enable_time(struct regulator_dev * rdev)1090 static int _regulator_get_enable_time(struct regulator_dev *rdev)
1091 {
1092 	if (!rdev->desc->ops->enable_time)
1093 		return 0;
1094 	return rdev->desc->ops->enable_time(rdev);
1095 }
1096 
1097 /* Internal regulator request function */
_regulator_get(struct device * dev,const char * id,int exclusive)1098 static struct regulator *_regulator_get(struct device *dev, const char *id,
1099 					int exclusive)
1100 {
1101 	struct regulator_dev *rdev;
1102 	struct regulator_map *map;
1103 	struct regulator *regulator = ERR_PTR(-ENODEV);
1104 	const char *devname = NULL;
1105 	int ret;
1106 
1107 	if (id == NULL) {
1108 		pr_err("get() with no identifier\n");
1109 		return regulator;
1110 	}
1111 
1112 	if (dev)
1113 		devname = dev_name(dev);
1114 
1115 	mutex_lock(&regulator_list_mutex);
1116 
1117 	list_for_each_entry(map, &regulator_map_list, list) {
1118 		/* If the mapping has a device set up it must match */
1119 		if (map->dev_name &&
1120 		    (!devname || strcmp(map->dev_name, devname)))
1121 			continue;
1122 
1123 		if (strcmp(map->supply, id) == 0) {
1124 			rdev = map->regulator;
1125 			goto found;
1126 		}
1127 	}
1128 
1129 	if (board_wants_dummy_regulator) {
1130 		rdev = dummy_regulator_rdev;
1131 		goto found;
1132 	}
1133 
1134 #ifdef CONFIG_REGULATOR_DUMMY
1135 	if (!devname)
1136 		devname = "deviceless";
1137 
1138 	/* If the board didn't flag that it was fully constrained then
1139 	 * substitute in a dummy regulator so consumers can continue.
1140 	 */
1141 	if (!has_full_constraints) {
1142 		pr_warn("%s supply %s not found, using dummy regulator\n",
1143 			devname, id);
1144 		rdev = dummy_regulator_rdev;
1145 		goto found;
1146 	}
1147 #endif
1148 
1149 	mutex_unlock(&regulator_list_mutex);
1150 	return regulator;
1151 
1152 found:
1153 	if (rdev->exclusive) {
1154 		regulator = ERR_PTR(-EPERM);
1155 		goto out;
1156 	}
1157 
1158 	if (exclusive && rdev->open_count) {
1159 		regulator = ERR_PTR(-EBUSY);
1160 		goto out;
1161 	}
1162 
1163 	if (!try_module_get(rdev->owner))
1164 		goto out;
1165 
1166 	regulator = create_regulator(rdev, dev, id);
1167 	if (regulator == NULL) {
1168 		regulator = ERR_PTR(-ENOMEM);
1169 		module_put(rdev->owner);
1170 	}
1171 
1172 	rdev->open_count++;
1173 	if (exclusive) {
1174 		rdev->exclusive = 1;
1175 
1176 		ret = _regulator_is_enabled(rdev);
1177 		if (ret > 0)
1178 			rdev->use_count = 1;
1179 		else
1180 			rdev->use_count = 0;
1181 	}
1182 
1183 out:
1184 	mutex_unlock(&regulator_list_mutex);
1185 
1186 	return regulator;
1187 }
1188 
1189 /**
1190  * regulator_get - lookup and obtain a reference to a regulator.
1191  * @dev: device for regulator "consumer"
1192  * @id: Supply name or regulator ID.
1193  *
1194  * Returns a struct regulator corresponding to the regulator producer,
1195  * or IS_ERR() condition containing errno.
1196  *
1197  * Use of supply names configured via regulator_set_device_supply() is
1198  * strongly encouraged.  It is recommended that the supply name used
1199  * should match the name used for the supply and/or the relevant
1200  * device pins in the datasheet.
1201  */
regulator_get(struct device * dev,const char * id)1202 struct regulator *regulator_get(struct device *dev, const char *id)
1203 {
1204 	return _regulator_get(dev, id, 0);
1205 }
1206 EXPORT_SYMBOL_GPL(regulator_get);
1207 
1208 /**
1209  * regulator_get_exclusive - obtain exclusive access to a regulator.
1210  * @dev: device for regulator "consumer"
1211  * @id: Supply name or regulator ID.
1212  *
1213  * Returns a struct regulator corresponding to the regulator producer,
1214  * or IS_ERR() condition containing errno.  Other consumers will be
1215  * unable to obtain this reference is held and the use count for the
1216  * regulator will be initialised to reflect the current state of the
1217  * regulator.
1218  *
1219  * This is intended for use by consumers which cannot tolerate shared
1220  * use of the regulator such as those which need to force the
1221  * regulator off for correct operation of the hardware they are
1222  * controlling.
1223  *
1224  * Use of supply names configured via regulator_set_device_supply() is
1225  * strongly encouraged.  It is recommended that the supply name used
1226  * should match the name used for the supply and/or the relevant
1227  * device pins in the datasheet.
1228  */
regulator_get_exclusive(struct device * dev,const char * id)1229 struct regulator *regulator_get_exclusive(struct device *dev, const char *id)
1230 {
1231 	return _regulator_get(dev, id, 1);
1232 }
1233 EXPORT_SYMBOL_GPL(regulator_get_exclusive);
1234 
1235 /**
1236  * regulator_put - "free" the regulator source
1237  * @regulator: regulator source
1238  *
1239  * Note: drivers must ensure that all regulator_enable calls made on this
1240  * regulator source are balanced by regulator_disable calls prior to calling
1241  * this function.
1242  */
regulator_put(struct regulator * regulator)1243 void regulator_put(struct regulator *regulator)
1244 {
1245 	struct regulator_dev *rdev;
1246 
1247 	if (regulator == NULL || IS_ERR(regulator))
1248 		return;
1249 
1250 	mutex_lock(&regulator_list_mutex);
1251 	rdev = regulator->rdev;
1252 
1253 	/* remove any sysfs entries */
1254 	if (regulator->dev) {
1255 		sysfs_remove_link(&rdev->dev.kobj, regulator->supply_name);
1256 		kfree(regulator->supply_name);
1257 		device_remove_file(regulator->dev, &regulator->dev_attr);
1258 		kfree(regulator->dev_attr.attr.name);
1259 	}
1260 	list_del(&regulator->list);
1261 	kfree(regulator);
1262 
1263 	rdev->open_count--;
1264 	rdev->exclusive = 0;
1265 
1266 	module_put(rdev->owner);
1267 	mutex_unlock(&regulator_list_mutex);
1268 }
1269 EXPORT_SYMBOL_GPL(regulator_put);
1270 
_regulator_can_change_status(struct regulator_dev * rdev)1271 static int _regulator_can_change_status(struct regulator_dev *rdev)
1272 {
1273 	if (!rdev->constraints)
1274 		return 0;
1275 
1276 	if (rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_STATUS)
1277 		return 1;
1278 	else
1279 		return 0;
1280 }
1281 
1282 /* locks held by regulator_enable() */
_regulator_enable(struct regulator_dev * rdev)1283 static int _regulator_enable(struct regulator_dev *rdev)
1284 {
1285 	int ret, delay;
1286 
1287 	if (rdev->use_count == 0) {
1288 		/* do we need to enable the supply regulator first */
1289 		if (rdev->supply) {
1290 			mutex_lock(&rdev->supply->mutex);
1291 			ret = _regulator_enable(rdev->supply);
1292 			mutex_unlock(&rdev->supply->mutex);
1293 			if (ret < 0) {
1294 				rdev_err(rdev, "failed to enable: %d\n", ret);
1295 				return ret;
1296 			}
1297 		}
1298 	}
1299 
1300 	/* check voltage and requested load before enabling */
1301 	if (rdev->constraints &&
1302 	    (rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_DRMS))
1303 		drms_uA_update(rdev);
1304 
1305 	if (rdev->use_count == 0) {
1306 		/* The regulator may on if it's not switchable or left on */
1307 		ret = _regulator_is_enabled(rdev);
1308 		if (ret == -EINVAL || ret == 0) {
1309 			if (!_regulator_can_change_status(rdev))
1310 				return -EPERM;
1311 
1312 			if (!rdev->desc->ops->enable)
1313 				return -EINVAL;
1314 
1315 			/* Query before enabling in case configuration
1316 			 * dependent.  */
1317 			ret = _regulator_get_enable_time(rdev);
1318 			if (ret >= 0) {
1319 				delay = ret;
1320 			} else {
1321 				rdev_warn(rdev, "enable_time() failed: %d\n",
1322 					   ret);
1323 				delay = 0;
1324 			}
1325 
1326 			trace_regulator_enable(rdev_get_name(rdev));
1327 
1328 			/* Allow the regulator to ramp; it would be useful
1329 			 * to extend this for bulk operations so that the
1330 			 * regulators can ramp together.  */
1331 			ret = rdev->desc->ops->enable(rdev);
1332 			if (ret < 0)
1333 				return ret;
1334 
1335 			trace_regulator_enable_delay(rdev_get_name(rdev));
1336 
1337 			if (delay >= 1000) {
1338 				mdelay(delay / 1000);
1339 				udelay(delay % 1000);
1340 			} else if (delay) {
1341 				udelay(delay);
1342 			}
1343 
1344 			trace_regulator_enable_complete(rdev_get_name(rdev));
1345 
1346 		} else if (ret < 0) {
1347 			rdev_err(rdev, "is_enabled() failed: %d\n", ret);
1348 			return ret;
1349 		}
1350 		/* Fallthrough on positive return values - already enabled */
1351 	}
1352 
1353 	rdev->use_count++;
1354 
1355 	return 0;
1356 }
1357 
1358 /**
1359  * regulator_enable - enable regulator output
1360  * @regulator: regulator source
1361  *
1362  * Request that the regulator be enabled with the regulator output at
1363  * the predefined voltage or current value.  Calls to regulator_enable()
1364  * must be balanced with calls to regulator_disable().
1365  *
1366  * NOTE: the output value can be set by other drivers, boot loader or may be
1367  * hardwired in the regulator.
1368  */
regulator_enable(struct regulator * regulator)1369 int regulator_enable(struct regulator *regulator)
1370 {
1371 	struct regulator_dev *rdev = regulator->rdev;
1372 	int ret = 0;
1373 
1374 	mutex_lock(&rdev->mutex);
1375 	ret = _regulator_enable(rdev);
1376 	mutex_unlock(&rdev->mutex);
1377 	return ret;
1378 }
1379 EXPORT_SYMBOL_GPL(regulator_enable);
1380 
1381 /* locks held by regulator_disable() */
_regulator_disable(struct regulator_dev * rdev,struct regulator_dev ** supply_rdev_ptr)1382 static int _regulator_disable(struct regulator_dev *rdev,
1383 		struct regulator_dev **supply_rdev_ptr)
1384 {
1385 	int ret = 0;
1386 	*supply_rdev_ptr = NULL;
1387 
1388 	if (WARN(rdev->use_count <= 0,
1389 		 "unbalanced disables for %s\n", rdev_get_name(rdev)))
1390 		return -EIO;
1391 
1392 	/* are we the last user and permitted to disable ? */
1393 	if (rdev->use_count == 1 &&
1394 	    (rdev->constraints && !rdev->constraints->always_on)) {
1395 
1396 		/* we are last user */
1397 		if (_regulator_can_change_status(rdev) &&
1398 		    rdev->desc->ops->disable) {
1399 			trace_regulator_disable(rdev_get_name(rdev));
1400 
1401 			ret = rdev->desc->ops->disable(rdev);
1402 			if (ret < 0) {
1403 				rdev_err(rdev, "failed to disable\n");
1404 				return ret;
1405 			}
1406 
1407 			trace_regulator_disable_complete(rdev_get_name(rdev));
1408 
1409 			_notifier_call_chain(rdev, REGULATOR_EVENT_DISABLE,
1410 					     NULL);
1411 		}
1412 
1413 		/* decrease our supplies ref count and disable if required */
1414 		*supply_rdev_ptr = rdev->supply;
1415 
1416 		rdev->use_count = 0;
1417 	} else if (rdev->use_count > 1) {
1418 
1419 		if (rdev->constraints &&
1420 			(rdev->constraints->valid_ops_mask &
1421 			REGULATOR_CHANGE_DRMS))
1422 			drms_uA_update(rdev);
1423 
1424 		rdev->use_count--;
1425 	}
1426 	return ret;
1427 }
1428 
1429 /**
1430  * regulator_disable - disable regulator output
1431  * @regulator: regulator source
1432  *
1433  * Disable the regulator output voltage or current.  Calls to
1434  * regulator_enable() must be balanced with calls to
1435  * regulator_disable().
1436  *
1437  * NOTE: this will only disable the regulator output if no other consumer
1438  * devices have it enabled, the regulator device supports disabling and
1439  * machine constraints permit this operation.
1440  */
regulator_disable(struct regulator * regulator)1441 int regulator_disable(struct regulator *regulator)
1442 {
1443 	struct regulator_dev *rdev = regulator->rdev;
1444 	struct regulator_dev *supply_rdev = NULL;
1445 	int ret = 0;
1446 
1447 	mutex_lock(&rdev->mutex);
1448 	ret = _regulator_disable(rdev, &supply_rdev);
1449 	mutex_unlock(&rdev->mutex);
1450 
1451 	/* decrease our supplies ref count and disable if required */
1452 	while (supply_rdev != NULL) {
1453 		rdev = supply_rdev;
1454 
1455 		mutex_lock(&rdev->mutex);
1456 		_regulator_disable(rdev, &supply_rdev);
1457 		mutex_unlock(&rdev->mutex);
1458 	}
1459 
1460 	return ret;
1461 }
1462 EXPORT_SYMBOL_GPL(regulator_disable);
1463 
1464 /* locks held by regulator_force_disable() */
_regulator_force_disable(struct regulator_dev * rdev,struct regulator_dev ** supply_rdev_ptr)1465 static int _regulator_force_disable(struct regulator_dev *rdev,
1466 		struct regulator_dev **supply_rdev_ptr)
1467 {
1468 	int ret = 0;
1469 
1470 	/* force disable */
1471 	if (rdev->desc->ops->disable) {
1472 		/* ah well, who wants to live forever... */
1473 		ret = rdev->desc->ops->disable(rdev);
1474 		if (ret < 0) {
1475 			rdev_err(rdev, "failed to force disable\n");
1476 			return ret;
1477 		}
1478 		/* notify other consumers that power has been forced off */
1479 		_notifier_call_chain(rdev, REGULATOR_EVENT_FORCE_DISABLE |
1480 			REGULATOR_EVENT_DISABLE, NULL);
1481 	}
1482 
1483 	/* decrease our supplies ref count and disable if required */
1484 	*supply_rdev_ptr = rdev->supply;
1485 
1486 	rdev->use_count = 0;
1487 	return ret;
1488 }
1489 
1490 /**
1491  * regulator_force_disable - force disable regulator output
1492  * @regulator: regulator source
1493  *
1494  * Forcibly disable the regulator output voltage or current.
1495  * NOTE: this *will* disable the regulator output even if other consumer
1496  * devices have it enabled. This should be used for situations when device
1497  * damage will likely occur if the regulator is not disabled (e.g. over temp).
1498  */
regulator_force_disable(struct regulator * regulator)1499 int regulator_force_disable(struct regulator *regulator)
1500 {
1501 	struct regulator_dev *supply_rdev = NULL;
1502 	int ret;
1503 
1504 	mutex_lock(&regulator->rdev->mutex);
1505 	regulator->uA_load = 0;
1506 	ret = _regulator_force_disable(regulator->rdev, &supply_rdev);
1507 	mutex_unlock(&regulator->rdev->mutex);
1508 
1509 	if (supply_rdev)
1510 		regulator_disable(get_device_regulator(rdev_get_dev(supply_rdev)));
1511 
1512 	return ret;
1513 }
1514 EXPORT_SYMBOL_GPL(regulator_force_disable);
1515 
_regulator_is_enabled(struct regulator_dev * rdev)1516 static int _regulator_is_enabled(struct regulator_dev *rdev)
1517 {
1518 	/* If we don't know then assume that the regulator is always on */
1519 	if (!rdev->desc->ops->is_enabled)
1520 		return 1;
1521 
1522 	return rdev->desc->ops->is_enabled(rdev);
1523 }
1524 
1525 /**
1526  * regulator_is_enabled - is the regulator output enabled
1527  * @regulator: regulator source
1528  *
1529  * Returns positive if the regulator driver backing the source/client
1530  * has requested that the device be enabled, zero if it hasn't, else a
1531  * negative errno code.
1532  *
1533  * Note that the device backing this regulator handle can have multiple
1534  * users, so it might be enabled even if regulator_enable() was never
1535  * called for this particular source.
1536  */
regulator_is_enabled(struct regulator * regulator)1537 int regulator_is_enabled(struct regulator *regulator)
1538 {
1539 	int ret;
1540 
1541 	mutex_lock(&regulator->rdev->mutex);
1542 	ret = _regulator_is_enabled(regulator->rdev);
1543 	mutex_unlock(&regulator->rdev->mutex);
1544 
1545 	return ret;
1546 }
1547 EXPORT_SYMBOL_GPL(regulator_is_enabled);
1548 
1549 /**
1550  * regulator_count_voltages - count regulator_list_voltage() selectors
1551  * @regulator: regulator source
1552  *
1553  * Returns number of selectors, or negative errno.  Selectors are
1554  * numbered starting at zero, and typically correspond to bitfields
1555  * in hardware registers.
1556  */
regulator_count_voltages(struct regulator * regulator)1557 int regulator_count_voltages(struct regulator *regulator)
1558 {
1559 	struct regulator_dev	*rdev = regulator->rdev;
1560 
1561 	return rdev->desc->n_voltages ? : -EINVAL;
1562 }
1563 EXPORT_SYMBOL_GPL(regulator_count_voltages);
1564 
1565 /**
1566  * regulator_list_voltage - enumerate supported voltages
1567  * @regulator: regulator source
1568  * @selector: identify voltage to list
1569  * Context: can sleep
1570  *
1571  * Returns a voltage that can be passed to @regulator_set_voltage(),
1572  * zero if this selector code can't be used on this system, or a
1573  * negative errno.
1574  */
regulator_list_voltage(struct regulator * regulator,unsigned selector)1575 int regulator_list_voltage(struct regulator *regulator, unsigned selector)
1576 {
1577 	struct regulator_dev	*rdev = regulator->rdev;
1578 	struct regulator_ops	*ops = rdev->desc->ops;
1579 	int			ret;
1580 
1581 	if (!ops->list_voltage || selector >= rdev->desc->n_voltages)
1582 		return -EINVAL;
1583 
1584 	mutex_lock(&rdev->mutex);
1585 	ret = ops->list_voltage(rdev, selector);
1586 	mutex_unlock(&rdev->mutex);
1587 
1588 	if (ret > 0) {
1589 		if (ret < rdev->constraints->min_uV)
1590 			ret = 0;
1591 		else if (ret > rdev->constraints->max_uV)
1592 			ret = 0;
1593 	}
1594 
1595 	return ret;
1596 }
1597 EXPORT_SYMBOL_GPL(regulator_list_voltage);
1598 
1599 /**
1600  * regulator_is_supported_voltage - check if a voltage range can be supported
1601  *
1602  * @regulator: Regulator to check.
1603  * @min_uV: Minimum required voltage in uV.
1604  * @max_uV: Maximum required voltage in uV.
1605  *
1606  * Returns a boolean or a negative error code.
1607  */
regulator_is_supported_voltage(struct regulator * regulator,int min_uV,int max_uV)1608 int regulator_is_supported_voltage(struct regulator *regulator,
1609 				   int min_uV, int max_uV)
1610 {
1611 	int i, voltages, ret;
1612 
1613 	ret = regulator_count_voltages(regulator);
1614 	if (ret < 0)
1615 		return ret;
1616 	voltages = ret;
1617 
1618 	for (i = 0; i < voltages; i++) {
1619 		ret = regulator_list_voltage(regulator, i);
1620 
1621 		if (ret >= min_uV && ret <= max_uV)
1622 			return 1;
1623 	}
1624 
1625 	return 0;
1626 }
1627 
_regulator_do_set_voltage(struct regulator_dev * rdev,int min_uV,int max_uV)1628 static int _regulator_do_set_voltage(struct regulator_dev *rdev,
1629 				     int min_uV, int max_uV)
1630 {
1631 	int ret;
1632 	int delay = 0;
1633 	unsigned int selector;
1634 
1635 	trace_regulator_set_voltage(rdev_get_name(rdev), min_uV, max_uV);
1636 
1637 	if (rdev->desc->ops->set_voltage) {
1638 		ret = rdev->desc->ops->set_voltage(rdev, min_uV, max_uV,
1639 						   &selector);
1640 
1641 		if (rdev->desc->ops->list_voltage)
1642 			selector = rdev->desc->ops->list_voltage(rdev,
1643 								 selector);
1644 		else
1645 			selector = -1;
1646 	} else if (rdev->desc->ops->set_voltage_sel) {
1647 		int best_val = INT_MAX;
1648 		int i;
1649 
1650 		selector = 0;
1651 
1652 		/* Find the smallest voltage that falls within the specified
1653 		 * range.
1654 		 */
1655 		for (i = 0; i < rdev->desc->n_voltages; i++) {
1656 			ret = rdev->desc->ops->list_voltage(rdev, i);
1657 			if (ret < 0)
1658 				continue;
1659 
1660 			if (ret < best_val && ret >= min_uV && ret <= max_uV) {
1661 				best_val = ret;
1662 				selector = i;
1663 			}
1664 		}
1665 
1666 		/*
1667 		 * If we can't obtain the old selector there is not enough
1668 		 * info to call set_voltage_time_sel().
1669 		 */
1670 		if (rdev->desc->ops->set_voltage_time_sel &&
1671 		    rdev->desc->ops->get_voltage_sel) {
1672 			unsigned int old_selector = 0;
1673 
1674 			ret = rdev->desc->ops->get_voltage_sel(rdev);
1675 			if (ret < 0)
1676 				return ret;
1677 			old_selector = ret;
1678 			delay = rdev->desc->ops->set_voltage_time_sel(rdev,
1679 						old_selector, selector);
1680 		}
1681 
1682 		if (best_val != INT_MAX) {
1683 			ret = rdev->desc->ops->set_voltage_sel(rdev, selector);
1684 			selector = best_val;
1685 		} else {
1686 			ret = -EINVAL;
1687 		}
1688 	} else {
1689 		ret = -EINVAL;
1690 	}
1691 
1692 	/* Insert any necessary delays */
1693 	if (delay >= 1000) {
1694 		mdelay(delay / 1000);
1695 		udelay(delay % 1000);
1696 	} else if (delay) {
1697 		udelay(delay);
1698 	}
1699 
1700 	if (ret == 0)
1701 		_notifier_call_chain(rdev, REGULATOR_EVENT_VOLTAGE_CHANGE,
1702 				     NULL);
1703 
1704 	trace_regulator_set_voltage_complete(rdev_get_name(rdev), selector);
1705 
1706 	return ret;
1707 }
1708 
1709 /**
1710  * regulator_set_voltage - set regulator output voltage
1711  * @regulator: regulator source
1712  * @min_uV: Minimum required voltage in uV
1713  * @max_uV: Maximum acceptable voltage in uV
1714  *
1715  * Sets a voltage regulator to the desired output voltage. This can be set
1716  * during any regulator state. IOW, regulator can be disabled or enabled.
1717  *
1718  * If the regulator is enabled then the voltage will change to the new value
1719  * immediately otherwise if the regulator is disabled the regulator will
1720  * output at the new voltage when enabled.
1721  *
1722  * NOTE: If the regulator is shared between several devices then the lowest
1723  * request voltage that meets the system constraints will be used.
1724  * Regulator system constraints must be set for this regulator before
1725  * calling this function otherwise this call will fail.
1726  */
regulator_set_voltage(struct regulator * regulator,int min_uV,int max_uV)1727 int regulator_set_voltage(struct regulator *regulator, int min_uV, int max_uV)
1728 {
1729 	struct regulator_dev *rdev = regulator->rdev;
1730 	int ret = 0;
1731 
1732 	mutex_lock(&rdev->mutex);
1733 
1734 	/* If we're setting the same range as last time the change
1735 	 * should be a noop (some cpufreq implementations use the same
1736 	 * voltage for multiple frequencies, for example).
1737 	 */
1738 	if (regulator->min_uV == min_uV && regulator->max_uV == max_uV)
1739 		goto out;
1740 
1741 	/* sanity check */
1742 	if (!rdev->desc->ops->set_voltage &&
1743 	    !rdev->desc->ops->set_voltage_sel) {
1744 		ret = -EINVAL;
1745 		goto out;
1746 	}
1747 
1748 	/* constraints check */
1749 	ret = regulator_check_voltage(rdev, &min_uV, &max_uV);
1750 	if (ret < 0)
1751 		goto out;
1752 	regulator->min_uV = min_uV;
1753 	regulator->max_uV = max_uV;
1754 
1755 	ret = regulator_check_consumers(rdev, &min_uV, &max_uV);
1756 	if (ret < 0)
1757 		goto out;
1758 
1759 	ret = _regulator_do_set_voltage(rdev, min_uV, max_uV);
1760 
1761 out:
1762 	mutex_unlock(&rdev->mutex);
1763 	return ret;
1764 }
1765 EXPORT_SYMBOL_GPL(regulator_set_voltage);
1766 
1767 /**
1768  * regulator_set_voltage_time - get raise/fall time
1769  * @regulator: regulator source
1770  * @old_uV: starting voltage in microvolts
1771  * @new_uV: target voltage in microvolts
1772  *
1773  * Provided with the starting and ending voltage, this function attempts to
1774  * calculate the time in microseconds required to rise or fall to this new
1775  * voltage.
1776  */
regulator_set_voltage_time(struct regulator * regulator,int old_uV,int new_uV)1777 int regulator_set_voltage_time(struct regulator *regulator,
1778 			       int old_uV, int new_uV)
1779 {
1780 	struct regulator_dev	*rdev = regulator->rdev;
1781 	struct regulator_ops	*ops = rdev->desc->ops;
1782 	int old_sel = -1;
1783 	int new_sel = -1;
1784 	int voltage;
1785 	int i;
1786 
1787 	/* Currently requires operations to do this */
1788 	if (!ops->list_voltage || !ops->set_voltage_time_sel
1789 	    || !rdev->desc->n_voltages)
1790 		return -EINVAL;
1791 
1792 	for (i = 0; i < rdev->desc->n_voltages; i++) {
1793 		/* We only look for exact voltage matches here */
1794 		voltage = regulator_list_voltage(regulator, i);
1795 		if (voltage < 0)
1796 			return -EINVAL;
1797 		if (voltage == 0)
1798 			continue;
1799 		if (voltage == old_uV)
1800 			old_sel = i;
1801 		if (voltage == new_uV)
1802 			new_sel = i;
1803 	}
1804 
1805 	if (old_sel < 0 || new_sel < 0)
1806 		return -EINVAL;
1807 
1808 	return ops->set_voltage_time_sel(rdev, old_sel, new_sel);
1809 }
1810 EXPORT_SYMBOL_GPL(regulator_set_voltage_time);
1811 
1812 /**
1813  * regulator_sync_voltage - re-apply last regulator output voltage
1814  * @regulator: regulator source
1815  *
1816  * Re-apply the last configured voltage.  This is intended to be used
1817  * where some external control source the consumer is cooperating with
1818  * has caused the configured voltage to change.
1819  */
regulator_sync_voltage(struct regulator * regulator)1820 int regulator_sync_voltage(struct regulator *regulator)
1821 {
1822 	struct regulator_dev *rdev = regulator->rdev;
1823 	int ret, min_uV, max_uV;
1824 
1825 	mutex_lock(&rdev->mutex);
1826 
1827 	if (!rdev->desc->ops->set_voltage &&
1828 	    !rdev->desc->ops->set_voltage_sel) {
1829 		ret = -EINVAL;
1830 		goto out;
1831 	}
1832 
1833 	/* This is only going to work if we've had a voltage configured. */
1834 	if (!regulator->min_uV && !regulator->max_uV) {
1835 		ret = -EINVAL;
1836 		goto out;
1837 	}
1838 
1839 	min_uV = regulator->min_uV;
1840 	max_uV = regulator->max_uV;
1841 
1842 	/* This should be a paranoia check... */
1843 	ret = regulator_check_voltage(rdev, &min_uV, &max_uV);
1844 	if (ret < 0)
1845 		goto out;
1846 
1847 	ret = regulator_check_consumers(rdev, &min_uV, &max_uV);
1848 	if (ret < 0)
1849 		goto out;
1850 
1851 	ret = _regulator_do_set_voltage(rdev, min_uV, max_uV);
1852 
1853 out:
1854 	mutex_unlock(&rdev->mutex);
1855 	return ret;
1856 }
1857 EXPORT_SYMBOL_GPL(regulator_sync_voltage);
1858 
_regulator_get_voltage(struct regulator_dev * rdev)1859 static int _regulator_get_voltage(struct regulator_dev *rdev)
1860 {
1861 	int sel;
1862 
1863 	if (rdev->desc->ops->get_voltage_sel) {
1864 		sel = rdev->desc->ops->get_voltage_sel(rdev);
1865 		if (sel < 0)
1866 			return sel;
1867 		return rdev->desc->ops->list_voltage(rdev, sel);
1868 	}
1869 	if (rdev->desc->ops->get_voltage)
1870 		return rdev->desc->ops->get_voltage(rdev);
1871 	else
1872 		return -EINVAL;
1873 }
1874 
1875 /**
1876  * regulator_get_voltage - get regulator output voltage
1877  * @regulator: regulator source
1878  *
1879  * This returns the current regulator voltage in uV.
1880  *
1881  * NOTE: If the regulator is disabled it will return the voltage value. This
1882  * function should not be used to determine regulator state.
1883  */
regulator_get_voltage(struct regulator * regulator)1884 int regulator_get_voltage(struct regulator *regulator)
1885 {
1886 	int ret;
1887 
1888 	mutex_lock(&regulator->rdev->mutex);
1889 
1890 	ret = _regulator_get_voltage(regulator->rdev);
1891 
1892 	mutex_unlock(&regulator->rdev->mutex);
1893 
1894 	return ret;
1895 }
1896 EXPORT_SYMBOL_GPL(regulator_get_voltage);
1897 
1898 /**
1899  * regulator_set_current_limit - set regulator output current limit
1900  * @regulator: regulator source
1901  * @min_uA: Minimuum supported current in uA
1902  * @max_uA: Maximum supported current in uA
1903  *
1904  * Sets current sink to the desired output current. This can be set during
1905  * any regulator state. IOW, regulator can be disabled or enabled.
1906  *
1907  * If the regulator is enabled then the current will change to the new value
1908  * immediately otherwise if the regulator is disabled the regulator will
1909  * output at the new current when enabled.
1910  *
1911  * NOTE: Regulator system constraints must be set for this regulator before
1912  * calling this function otherwise this call will fail.
1913  */
regulator_set_current_limit(struct regulator * regulator,int min_uA,int max_uA)1914 int regulator_set_current_limit(struct regulator *regulator,
1915 			       int min_uA, int max_uA)
1916 {
1917 	struct regulator_dev *rdev = regulator->rdev;
1918 	int ret;
1919 
1920 	mutex_lock(&rdev->mutex);
1921 
1922 	/* sanity check */
1923 	if (!rdev->desc->ops->set_current_limit) {
1924 		ret = -EINVAL;
1925 		goto out;
1926 	}
1927 
1928 	/* constraints check */
1929 	ret = regulator_check_current_limit(rdev, &min_uA, &max_uA);
1930 	if (ret < 0)
1931 		goto out;
1932 
1933 	ret = rdev->desc->ops->set_current_limit(rdev, min_uA, max_uA);
1934 out:
1935 	mutex_unlock(&rdev->mutex);
1936 	return ret;
1937 }
1938 EXPORT_SYMBOL_GPL(regulator_set_current_limit);
1939 
_regulator_get_current_limit(struct regulator_dev * rdev)1940 static int _regulator_get_current_limit(struct regulator_dev *rdev)
1941 {
1942 	int ret;
1943 
1944 	mutex_lock(&rdev->mutex);
1945 
1946 	/* sanity check */
1947 	if (!rdev->desc->ops->get_current_limit) {
1948 		ret = -EINVAL;
1949 		goto out;
1950 	}
1951 
1952 	ret = rdev->desc->ops->get_current_limit(rdev);
1953 out:
1954 	mutex_unlock(&rdev->mutex);
1955 	return ret;
1956 }
1957 
1958 /**
1959  * regulator_get_current_limit - get regulator output current
1960  * @regulator: regulator source
1961  *
1962  * This returns the current supplied by the specified current sink in uA.
1963  *
1964  * NOTE: If the regulator is disabled it will return the current value. This
1965  * function should not be used to determine regulator state.
1966  */
regulator_get_current_limit(struct regulator * regulator)1967 int regulator_get_current_limit(struct regulator *regulator)
1968 {
1969 	return _regulator_get_current_limit(regulator->rdev);
1970 }
1971 EXPORT_SYMBOL_GPL(regulator_get_current_limit);
1972 
1973 /**
1974  * regulator_set_mode - set regulator operating mode
1975  * @regulator: regulator source
1976  * @mode: operating mode - one of the REGULATOR_MODE constants
1977  *
1978  * Set regulator operating mode to increase regulator efficiency or improve
1979  * regulation performance.
1980  *
1981  * NOTE: Regulator system constraints must be set for this regulator before
1982  * calling this function otherwise this call will fail.
1983  */
regulator_set_mode(struct regulator * regulator,unsigned int mode)1984 int regulator_set_mode(struct regulator *regulator, unsigned int mode)
1985 {
1986 	struct regulator_dev *rdev = regulator->rdev;
1987 	int ret;
1988 	int regulator_curr_mode;
1989 
1990 	mutex_lock(&rdev->mutex);
1991 
1992 	/* sanity check */
1993 	if (!rdev->desc->ops->set_mode) {
1994 		ret = -EINVAL;
1995 		goto out;
1996 	}
1997 
1998 	/* return if the same mode is requested */
1999 	if (rdev->desc->ops->get_mode) {
2000 		regulator_curr_mode = rdev->desc->ops->get_mode(rdev);
2001 		if (regulator_curr_mode == mode) {
2002 			ret = 0;
2003 			goto out;
2004 		}
2005 	}
2006 
2007 	/* constraints check */
2008 	ret = regulator_check_mode(rdev, mode);
2009 	if (ret < 0)
2010 		goto out;
2011 
2012 	ret = rdev->desc->ops->set_mode(rdev, mode);
2013 out:
2014 	mutex_unlock(&rdev->mutex);
2015 	return ret;
2016 }
2017 EXPORT_SYMBOL_GPL(regulator_set_mode);
2018 
_regulator_get_mode(struct regulator_dev * rdev)2019 static unsigned int _regulator_get_mode(struct regulator_dev *rdev)
2020 {
2021 	int ret;
2022 
2023 	mutex_lock(&rdev->mutex);
2024 
2025 	/* sanity check */
2026 	if (!rdev->desc->ops->get_mode) {
2027 		ret = -EINVAL;
2028 		goto out;
2029 	}
2030 
2031 	ret = rdev->desc->ops->get_mode(rdev);
2032 out:
2033 	mutex_unlock(&rdev->mutex);
2034 	return ret;
2035 }
2036 
2037 /**
2038  * regulator_get_mode - get regulator operating mode
2039  * @regulator: regulator source
2040  *
2041  * Get the current regulator operating mode.
2042  */
regulator_get_mode(struct regulator * regulator)2043 unsigned int regulator_get_mode(struct regulator *regulator)
2044 {
2045 	return _regulator_get_mode(regulator->rdev);
2046 }
2047 EXPORT_SYMBOL_GPL(regulator_get_mode);
2048 
2049 /**
2050  * regulator_set_optimum_mode - set regulator optimum operating mode
2051  * @regulator: regulator source
2052  * @uA_load: load current
2053  *
2054  * Notifies the regulator core of a new device load. This is then used by
2055  * DRMS (if enabled by constraints) to set the most efficient regulator
2056  * operating mode for the new regulator loading.
2057  *
2058  * Consumer devices notify their supply regulator of the maximum power
2059  * they will require (can be taken from device datasheet in the power
2060  * consumption tables) when they change operational status and hence power
2061  * state. Examples of operational state changes that can affect power
2062  * consumption are :-
2063  *
2064  *    o Device is opened / closed.
2065  *    o Device I/O is about to begin or has just finished.
2066  *    o Device is idling in between work.
2067  *
2068  * This information is also exported via sysfs to userspace.
2069  *
2070  * DRMS will sum the total requested load on the regulator and change
2071  * to the most efficient operating mode if platform constraints allow.
2072  *
2073  * Returns the new regulator mode or error.
2074  */
regulator_set_optimum_mode(struct regulator * regulator,int uA_load)2075 int regulator_set_optimum_mode(struct regulator *regulator, int uA_load)
2076 {
2077 	struct regulator_dev *rdev = regulator->rdev;
2078 	struct regulator *consumer;
2079 	int ret, output_uV, input_uV, total_uA_load = 0;
2080 	unsigned int mode;
2081 
2082 	mutex_lock(&rdev->mutex);
2083 
2084 	regulator->uA_load = uA_load;
2085 	ret = regulator_check_drms(rdev);
2086 	if (ret < 0)
2087 		goto out;
2088 	ret = -EINVAL;
2089 
2090 	/* sanity check */
2091 	if (!rdev->desc->ops->get_optimum_mode)
2092 		goto out;
2093 
2094 	/* get output voltage */
2095 	output_uV = _regulator_get_voltage(rdev);
2096 	if (output_uV <= 0) {
2097 		rdev_err(rdev, "invalid output voltage found\n");
2098 		goto out;
2099 	}
2100 
2101 	/* get input voltage */
2102 	input_uV = 0;
2103 	if (rdev->supply)
2104 		input_uV = _regulator_get_voltage(rdev->supply);
2105 	if (input_uV <= 0)
2106 		input_uV = rdev->constraints->input_uV;
2107 	if (input_uV <= 0) {
2108 		rdev_err(rdev, "invalid input voltage found\n");
2109 		goto out;
2110 	}
2111 
2112 	/* calc total requested load for this regulator */
2113 	list_for_each_entry(consumer, &rdev->consumer_list, list)
2114 		total_uA_load += consumer->uA_load;
2115 
2116 	mode = rdev->desc->ops->get_optimum_mode(rdev,
2117 						 input_uV, output_uV,
2118 						 total_uA_load);
2119 	ret = regulator_check_mode(rdev, mode);
2120 	if (ret < 0) {
2121 		rdev_err(rdev, "failed to get optimum mode @ %d uA %d -> %d uV\n",
2122 			 total_uA_load, input_uV, output_uV);
2123 		goto out;
2124 	}
2125 
2126 	ret = rdev->desc->ops->set_mode(rdev, mode);
2127 	if (ret < 0) {
2128 		rdev_err(rdev, "failed to set optimum mode %x\n", mode);
2129 		goto out;
2130 	}
2131 	ret = mode;
2132 out:
2133 	mutex_unlock(&rdev->mutex);
2134 	return ret;
2135 }
2136 EXPORT_SYMBOL_GPL(regulator_set_optimum_mode);
2137 
2138 /**
2139  * regulator_register_notifier - register regulator event notifier
2140  * @regulator: regulator source
2141  * @nb: notifier block
2142  *
2143  * Register notifier block to receive regulator events.
2144  */
regulator_register_notifier(struct regulator * regulator,struct notifier_block * nb)2145 int regulator_register_notifier(struct regulator *regulator,
2146 			      struct notifier_block *nb)
2147 {
2148 	return blocking_notifier_chain_register(&regulator->rdev->notifier,
2149 						nb);
2150 }
2151 EXPORT_SYMBOL_GPL(regulator_register_notifier);
2152 
2153 /**
2154  * regulator_unregister_notifier - unregister regulator event notifier
2155  * @regulator: regulator source
2156  * @nb: notifier block
2157  *
2158  * Unregister regulator event notifier block.
2159  */
regulator_unregister_notifier(struct regulator * regulator,struct notifier_block * nb)2160 int regulator_unregister_notifier(struct regulator *regulator,
2161 				struct notifier_block *nb)
2162 {
2163 	return blocking_notifier_chain_unregister(&regulator->rdev->notifier,
2164 						  nb);
2165 }
2166 EXPORT_SYMBOL_GPL(regulator_unregister_notifier);
2167 
2168 /* notify regulator consumers and downstream regulator consumers.
2169  * Note mutex must be held by caller.
2170  */
_notifier_call_chain(struct regulator_dev * rdev,unsigned long event,void * data)2171 static void _notifier_call_chain(struct regulator_dev *rdev,
2172 				  unsigned long event, void *data)
2173 {
2174 	struct regulator_dev *_rdev;
2175 
2176 	/* call rdev chain first */
2177 	blocking_notifier_call_chain(&rdev->notifier, event, NULL);
2178 
2179 	/* now notify regulator we supply */
2180 	list_for_each_entry(_rdev, &rdev->supply_list, slist) {
2181 		mutex_lock(&_rdev->mutex);
2182 		_notifier_call_chain(_rdev, event, data);
2183 		mutex_unlock(&_rdev->mutex);
2184 	}
2185 }
2186 
2187 /**
2188  * regulator_bulk_get - get multiple regulator consumers
2189  *
2190  * @dev:           Device to supply
2191  * @num_consumers: Number of consumers to register
2192  * @consumers:     Configuration of consumers; clients are stored here.
2193  *
2194  * @return 0 on success, an errno on failure.
2195  *
2196  * This helper function allows drivers to get several regulator
2197  * consumers in one operation.  If any of the regulators cannot be
2198  * acquired then any regulators that were allocated will be freed
2199  * before returning to the caller.
2200  */
regulator_bulk_get(struct device * dev,int num_consumers,struct regulator_bulk_data * consumers)2201 int regulator_bulk_get(struct device *dev, int num_consumers,
2202 		       struct regulator_bulk_data *consumers)
2203 {
2204 	int i;
2205 	int ret;
2206 
2207 	for (i = 0; i < num_consumers; i++)
2208 		consumers[i].consumer = NULL;
2209 
2210 	for (i = 0; i < num_consumers; i++) {
2211 		consumers[i].consumer = regulator_get(dev,
2212 						      consumers[i].supply);
2213 		if (IS_ERR(consumers[i].consumer)) {
2214 			ret = PTR_ERR(consumers[i].consumer);
2215 			dev_err(dev, "Failed to get supply '%s': %d\n",
2216 				consumers[i].supply, ret);
2217 			consumers[i].consumer = NULL;
2218 			goto err;
2219 		}
2220 	}
2221 
2222 	return 0;
2223 
2224 err:
2225 	for (i = 0; i < num_consumers && consumers[i].consumer; i++)
2226 		regulator_put(consumers[i].consumer);
2227 
2228 	return ret;
2229 }
2230 EXPORT_SYMBOL_GPL(regulator_bulk_get);
2231 
2232 /**
2233  * regulator_bulk_enable - enable multiple regulator consumers
2234  *
2235  * @num_consumers: Number of consumers
2236  * @consumers:     Consumer data; clients are stored here.
2237  * @return         0 on success, an errno on failure
2238  *
2239  * This convenience API allows consumers to enable multiple regulator
2240  * clients in a single API call.  If any consumers cannot be enabled
2241  * then any others that were enabled will be disabled again prior to
2242  * return.
2243  */
regulator_bulk_enable(int num_consumers,struct regulator_bulk_data * consumers)2244 int regulator_bulk_enable(int num_consumers,
2245 			  struct regulator_bulk_data *consumers)
2246 {
2247 	int i;
2248 	int ret;
2249 
2250 	for (i = 0; i < num_consumers; i++) {
2251 		ret = regulator_enable(consumers[i].consumer);
2252 		if (ret != 0)
2253 			goto err;
2254 	}
2255 
2256 	return 0;
2257 
2258 err:
2259 	pr_err("Failed to enable %s: %d\n", consumers[i].supply, ret);
2260 	for (--i; i >= 0; --i)
2261 		regulator_disable(consumers[i].consumer);
2262 
2263 	return ret;
2264 }
2265 EXPORT_SYMBOL_GPL(regulator_bulk_enable);
2266 
2267 /**
2268  * regulator_bulk_disable - disable multiple regulator consumers
2269  *
2270  * @num_consumers: Number of consumers
2271  * @consumers:     Consumer data; clients are stored here.
2272  * @return         0 on success, an errno on failure
2273  *
2274  * This convenience API allows consumers to disable multiple regulator
2275  * clients in a single API call.  If any consumers cannot be enabled
2276  * then any others that were disabled will be disabled again prior to
2277  * return.
2278  */
regulator_bulk_disable(int num_consumers,struct regulator_bulk_data * consumers)2279 int regulator_bulk_disable(int num_consumers,
2280 			   struct regulator_bulk_data *consumers)
2281 {
2282 	int i;
2283 	int ret;
2284 
2285 	for (i = 0; i < num_consumers; i++) {
2286 		ret = regulator_disable(consumers[i].consumer);
2287 		if (ret != 0)
2288 			goto err;
2289 	}
2290 
2291 	return 0;
2292 
2293 err:
2294 	pr_err("Failed to disable %s: %d\n", consumers[i].supply, ret);
2295 	for (--i; i >= 0; --i)
2296 		regulator_enable(consumers[i].consumer);
2297 
2298 	return ret;
2299 }
2300 EXPORT_SYMBOL_GPL(regulator_bulk_disable);
2301 
2302 /**
2303  * regulator_bulk_free - free multiple regulator consumers
2304  *
2305  * @num_consumers: Number of consumers
2306  * @consumers:     Consumer data; clients are stored here.
2307  *
2308  * This convenience API allows consumers to free multiple regulator
2309  * clients in a single API call.
2310  */
regulator_bulk_free(int num_consumers,struct regulator_bulk_data * consumers)2311 void regulator_bulk_free(int num_consumers,
2312 			 struct regulator_bulk_data *consumers)
2313 {
2314 	int i;
2315 
2316 	for (i = 0; i < num_consumers; i++) {
2317 		regulator_put(consumers[i].consumer);
2318 		consumers[i].consumer = NULL;
2319 	}
2320 }
2321 EXPORT_SYMBOL_GPL(regulator_bulk_free);
2322 
2323 /**
2324  * regulator_notifier_call_chain - call regulator event notifier
2325  * @rdev: regulator source
2326  * @event: notifier block
2327  * @data: callback-specific data.
2328  *
2329  * Called by regulator drivers to notify clients a regulator event has
2330  * occurred. We also notify regulator clients downstream.
2331  * Note lock must be held by caller.
2332  */
regulator_notifier_call_chain(struct regulator_dev * rdev,unsigned long event,void * data)2333 int regulator_notifier_call_chain(struct regulator_dev *rdev,
2334 				  unsigned long event, void *data)
2335 {
2336 	_notifier_call_chain(rdev, event, data);
2337 	return NOTIFY_DONE;
2338 
2339 }
2340 EXPORT_SYMBOL_GPL(regulator_notifier_call_chain);
2341 
2342 /**
2343  * regulator_mode_to_status - convert a regulator mode into a status
2344  *
2345  * @mode: Mode to convert
2346  *
2347  * Convert a regulator mode into a status.
2348  */
regulator_mode_to_status(unsigned int mode)2349 int regulator_mode_to_status(unsigned int mode)
2350 {
2351 	switch (mode) {
2352 	case REGULATOR_MODE_FAST:
2353 		return REGULATOR_STATUS_FAST;
2354 	case REGULATOR_MODE_NORMAL:
2355 		return REGULATOR_STATUS_NORMAL;
2356 	case REGULATOR_MODE_IDLE:
2357 		return REGULATOR_STATUS_IDLE;
2358 	case REGULATOR_STATUS_STANDBY:
2359 		return REGULATOR_STATUS_STANDBY;
2360 	default:
2361 		return 0;
2362 	}
2363 }
2364 EXPORT_SYMBOL_GPL(regulator_mode_to_status);
2365 
2366 /*
2367  * To avoid cluttering sysfs (and memory) with useless state, only
2368  * create attributes that can be meaningfully displayed.
2369  */
add_regulator_attributes(struct regulator_dev * rdev)2370 static int add_regulator_attributes(struct regulator_dev *rdev)
2371 {
2372 	struct device		*dev = &rdev->dev;
2373 	struct regulator_ops	*ops = rdev->desc->ops;
2374 	int			status = 0;
2375 
2376 	/* some attributes need specific methods to be displayed */
2377 	if (ops->get_voltage || ops->get_voltage_sel) {
2378 		status = device_create_file(dev, &dev_attr_microvolts);
2379 		if (status < 0)
2380 			return status;
2381 	}
2382 	if (ops->get_current_limit) {
2383 		status = device_create_file(dev, &dev_attr_microamps);
2384 		if (status < 0)
2385 			return status;
2386 	}
2387 	if (ops->get_mode) {
2388 		status = device_create_file(dev, &dev_attr_opmode);
2389 		if (status < 0)
2390 			return status;
2391 	}
2392 	if (ops->is_enabled) {
2393 		status = device_create_file(dev, &dev_attr_state);
2394 		if (status < 0)
2395 			return status;
2396 	}
2397 	if (ops->get_status) {
2398 		status = device_create_file(dev, &dev_attr_status);
2399 		if (status < 0)
2400 			return status;
2401 	}
2402 
2403 	/* some attributes are type-specific */
2404 	if (rdev->desc->type == REGULATOR_CURRENT) {
2405 		status = device_create_file(dev, &dev_attr_requested_microamps);
2406 		if (status < 0)
2407 			return status;
2408 	}
2409 
2410 	/* all the other attributes exist to support constraints;
2411 	 * don't show them if there are no constraints, or if the
2412 	 * relevant supporting methods are missing.
2413 	 */
2414 	if (!rdev->constraints)
2415 		return status;
2416 
2417 	/* constraints need specific supporting methods */
2418 	if (ops->set_voltage || ops->set_voltage_sel) {
2419 		status = device_create_file(dev, &dev_attr_min_microvolts);
2420 		if (status < 0)
2421 			return status;
2422 		status = device_create_file(dev, &dev_attr_max_microvolts);
2423 		if (status < 0)
2424 			return status;
2425 	}
2426 	if (ops->set_current_limit) {
2427 		status = device_create_file(dev, &dev_attr_min_microamps);
2428 		if (status < 0)
2429 			return status;
2430 		status = device_create_file(dev, &dev_attr_max_microamps);
2431 		if (status < 0)
2432 			return status;
2433 	}
2434 
2435 	/* suspend mode constraints need multiple supporting methods */
2436 	if (!(ops->set_suspend_enable && ops->set_suspend_disable))
2437 		return status;
2438 
2439 	status = device_create_file(dev, &dev_attr_suspend_standby_state);
2440 	if (status < 0)
2441 		return status;
2442 	status = device_create_file(dev, &dev_attr_suspend_mem_state);
2443 	if (status < 0)
2444 		return status;
2445 	status = device_create_file(dev, &dev_attr_suspend_disk_state);
2446 	if (status < 0)
2447 		return status;
2448 
2449 	if (ops->set_suspend_voltage) {
2450 		status = device_create_file(dev,
2451 				&dev_attr_suspend_standby_microvolts);
2452 		if (status < 0)
2453 			return status;
2454 		status = device_create_file(dev,
2455 				&dev_attr_suspend_mem_microvolts);
2456 		if (status < 0)
2457 			return status;
2458 		status = device_create_file(dev,
2459 				&dev_attr_suspend_disk_microvolts);
2460 		if (status < 0)
2461 			return status;
2462 	}
2463 
2464 	if (ops->set_suspend_mode) {
2465 		status = device_create_file(dev,
2466 				&dev_attr_suspend_standby_mode);
2467 		if (status < 0)
2468 			return status;
2469 		status = device_create_file(dev,
2470 				&dev_attr_suspend_mem_mode);
2471 		if (status < 0)
2472 			return status;
2473 		status = device_create_file(dev,
2474 				&dev_attr_suspend_disk_mode);
2475 		if (status < 0)
2476 			return status;
2477 	}
2478 
2479 	return status;
2480 }
2481 
rdev_init_debugfs(struct regulator_dev * rdev)2482 static void rdev_init_debugfs(struct regulator_dev *rdev)
2483 {
2484 #ifdef CONFIG_DEBUG_FS
2485 	rdev->debugfs = debugfs_create_dir(rdev_get_name(rdev), debugfs_root);
2486 	if (IS_ERR(rdev->debugfs) || !rdev->debugfs) {
2487 		rdev_warn(rdev, "Failed to create debugfs directory\n");
2488 		rdev->debugfs = NULL;
2489 		return;
2490 	}
2491 
2492 	debugfs_create_u32("use_count", 0444, rdev->debugfs,
2493 			   &rdev->use_count);
2494 	debugfs_create_u32("open_count", 0444, rdev->debugfs,
2495 			   &rdev->open_count);
2496 #endif
2497 }
2498 
2499 /**
2500  * regulator_register - register regulator
2501  * @regulator_desc: regulator to register
2502  * @dev: struct device for the regulator
2503  * @init_data: platform provided init data, passed through by driver
2504  * @driver_data: private regulator data
2505  *
2506  * Called by regulator drivers to register a regulator.
2507  * Returns 0 on success.
2508  */
regulator_register(struct regulator_desc * regulator_desc,struct device * dev,const struct regulator_init_data * init_data,void * driver_data)2509 struct regulator_dev *regulator_register(struct regulator_desc *regulator_desc,
2510 	struct device *dev, const struct regulator_init_data *init_data,
2511 	void *driver_data)
2512 {
2513 	static atomic_t regulator_no = ATOMIC_INIT(0);
2514 	struct regulator_dev *rdev;
2515 	int ret, i;
2516 
2517 	if (regulator_desc == NULL)
2518 		return ERR_PTR(-EINVAL);
2519 
2520 	if (regulator_desc->name == NULL || regulator_desc->ops == NULL)
2521 		return ERR_PTR(-EINVAL);
2522 
2523 	if (regulator_desc->type != REGULATOR_VOLTAGE &&
2524 	    regulator_desc->type != REGULATOR_CURRENT)
2525 		return ERR_PTR(-EINVAL);
2526 
2527 	if (!init_data)
2528 		return ERR_PTR(-EINVAL);
2529 
2530 	/* Only one of each should be implemented */
2531 	WARN_ON(regulator_desc->ops->get_voltage &&
2532 		regulator_desc->ops->get_voltage_sel);
2533 	WARN_ON(regulator_desc->ops->set_voltage &&
2534 		regulator_desc->ops->set_voltage_sel);
2535 
2536 	/* If we're using selectors we must implement list_voltage. */
2537 	if (regulator_desc->ops->get_voltage_sel &&
2538 	    !regulator_desc->ops->list_voltage) {
2539 		return ERR_PTR(-EINVAL);
2540 	}
2541 	if (regulator_desc->ops->set_voltage_sel &&
2542 	    !regulator_desc->ops->list_voltage) {
2543 		return ERR_PTR(-EINVAL);
2544 	}
2545 
2546 	rdev = kzalloc(sizeof(struct regulator_dev), GFP_KERNEL);
2547 	if (rdev == NULL)
2548 		return ERR_PTR(-ENOMEM);
2549 
2550 	mutex_lock(&regulator_list_mutex);
2551 
2552 	mutex_init(&rdev->mutex);
2553 	rdev->reg_data = driver_data;
2554 	rdev->owner = regulator_desc->owner;
2555 	rdev->desc = regulator_desc;
2556 	INIT_LIST_HEAD(&rdev->consumer_list);
2557 	INIT_LIST_HEAD(&rdev->supply_list);
2558 	INIT_LIST_HEAD(&rdev->list);
2559 	INIT_LIST_HEAD(&rdev->slist);
2560 	BLOCKING_INIT_NOTIFIER_HEAD(&rdev->notifier);
2561 
2562 	/* preform any regulator specific init */
2563 	if (init_data->regulator_init) {
2564 		ret = init_data->regulator_init(rdev->reg_data);
2565 		if (ret < 0)
2566 			goto clean;
2567 	}
2568 
2569 	/* register with sysfs */
2570 	rdev->dev.class = &regulator_class;
2571 	rdev->dev.parent = dev;
2572 	dev_set_name(&rdev->dev, "regulator.%d",
2573 		     atomic_inc_return(&regulator_no) - 1);
2574 	ret = device_register(&rdev->dev);
2575 	if (ret != 0) {
2576 		put_device(&rdev->dev);
2577 		goto clean;
2578 	}
2579 
2580 	dev_set_drvdata(&rdev->dev, rdev);
2581 
2582 	/* set regulator constraints */
2583 	ret = set_machine_constraints(rdev, &init_data->constraints);
2584 	if (ret < 0)
2585 		goto scrub;
2586 
2587 	/* add attributes supported by this regulator */
2588 	ret = add_regulator_attributes(rdev);
2589 	if (ret < 0)
2590 		goto scrub;
2591 
2592 	/* set supply regulator if it exists */
2593 	if (init_data->supply_regulator && init_data->supply_regulator_dev) {
2594 		dev_err(dev,
2595 			"Supply regulator specified by both name and dev\n");
2596 		ret = -EINVAL;
2597 		goto scrub;
2598 	}
2599 
2600 	if (init_data->supply_regulator) {
2601 		struct regulator_dev *r;
2602 		int found = 0;
2603 
2604 		list_for_each_entry(r, &regulator_list, list) {
2605 			if (strcmp(rdev_get_name(r),
2606 				   init_data->supply_regulator) == 0) {
2607 				found = 1;
2608 				break;
2609 			}
2610 		}
2611 
2612 		if (!found) {
2613 			dev_err(dev, "Failed to find supply %s\n",
2614 				init_data->supply_regulator);
2615 			ret = -ENODEV;
2616 			goto scrub;
2617 		}
2618 
2619 		ret = set_supply(rdev, r);
2620 		if (ret < 0)
2621 			goto scrub;
2622 	}
2623 
2624 	if (init_data->supply_regulator_dev) {
2625 		dev_warn(dev, "Uses supply_regulator_dev instead of regulator_supply\n");
2626 		ret = set_supply(rdev,
2627 			dev_get_drvdata(init_data->supply_regulator_dev));
2628 		if (ret < 0)
2629 			goto scrub;
2630 	}
2631 
2632 	/* add consumers devices */
2633 	for (i = 0; i < init_data->num_consumer_supplies; i++) {
2634 		ret = set_consumer_device_supply(rdev,
2635 			init_data->consumer_supplies[i].dev,
2636 			init_data->consumer_supplies[i].dev_name,
2637 			init_data->consumer_supplies[i].supply);
2638 		if (ret < 0) {
2639 			dev_err(dev, "Failed to set supply %s\n",
2640 				init_data->consumer_supplies[i].supply);
2641 			goto unset_supplies;
2642 		}
2643 	}
2644 
2645 	list_add(&rdev->list, &regulator_list);
2646 
2647 	rdev_init_debugfs(rdev);
2648 out:
2649 	mutex_unlock(&regulator_list_mutex);
2650 	return rdev;
2651 
2652 unset_supplies:
2653 	unset_regulator_supplies(rdev);
2654 
2655 scrub:
2656 	device_unregister(&rdev->dev);
2657 	/* device core frees rdev */
2658 	rdev = ERR_PTR(ret);
2659 	goto out;
2660 
2661 clean:
2662 	kfree(rdev);
2663 	rdev = ERR_PTR(ret);
2664 	goto out;
2665 }
2666 EXPORT_SYMBOL_GPL(regulator_register);
2667 
2668 /**
2669  * regulator_unregister - unregister regulator
2670  * @rdev: regulator to unregister
2671  *
2672  * Called by regulator drivers to unregister a regulator.
2673  */
regulator_unregister(struct regulator_dev * rdev)2674 void regulator_unregister(struct regulator_dev *rdev)
2675 {
2676 	if (rdev == NULL)
2677 		return;
2678 
2679 	mutex_lock(&regulator_list_mutex);
2680 #ifdef CONFIG_DEBUG_FS
2681 	debugfs_remove_recursive(rdev->debugfs);
2682 #endif
2683 	WARN_ON(rdev->open_count);
2684 	unset_regulator_supplies(rdev);
2685 	list_del(&rdev->list);
2686 	if (rdev->supply)
2687 		sysfs_remove_link(&rdev->dev.kobj, "supply");
2688 	device_unregister(&rdev->dev);
2689 	kfree(rdev->constraints);
2690 	mutex_unlock(&regulator_list_mutex);
2691 }
2692 EXPORT_SYMBOL_GPL(regulator_unregister);
2693 
2694 /**
2695  * regulator_suspend_prepare - prepare regulators for system wide suspend
2696  * @state: system suspend state
2697  *
2698  * Configure each regulator with it's suspend operating parameters for state.
2699  * This will usually be called by machine suspend code prior to supending.
2700  */
regulator_suspend_prepare(suspend_state_t state)2701 int regulator_suspend_prepare(suspend_state_t state)
2702 {
2703 	struct regulator_dev *rdev;
2704 	int ret = 0;
2705 
2706 	/* ON is handled by regulator active state */
2707 	if (state == PM_SUSPEND_ON)
2708 		return -EINVAL;
2709 
2710 	mutex_lock(&regulator_list_mutex);
2711 	list_for_each_entry(rdev, &regulator_list, list) {
2712 
2713 		mutex_lock(&rdev->mutex);
2714 		ret = suspend_prepare(rdev, state);
2715 		mutex_unlock(&rdev->mutex);
2716 
2717 		if (ret < 0) {
2718 			rdev_err(rdev, "failed to prepare\n");
2719 			goto out;
2720 		}
2721 	}
2722 out:
2723 	mutex_unlock(&regulator_list_mutex);
2724 	return ret;
2725 }
2726 EXPORT_SYMBOL_GPL(regulator_suspend_prepare);
2727 
2728 /**
2729  * regulator_suspend_finish - resume regulators from system wide suspend
2730  *
2731  * Turn on regulators that might be turned off by regulator_suspend_prepare
2732  * and that should be turned on according to the regulators properties.
2733  */
regulator_suspend_finish(void)2734 int regulator_suspend_finish(void)
2735 {
2736 	struct regulator_dev *rdev;
2737 	int ret = 0, error;
2738 
2739 	mutex_lock(&regulator_list_mutex);
2740 	list_for_each_entry(rdev, &regulator_list, list) {
2741 		struct regulator_ops *ops = rdev->desc->ops;
2742 
2743 		mutex_lock(&rdev->mutex);
2744 		if ((rdev->use_count > 0  || rdev->constraints->always_on) &&
2745 				ops->enable) {
2746 			error = ops->enable(rdev);
2747 			if (error)
2748 				ret = error;
2749 		} else {
2750 			if (!has_full_constraints)
2751 				goto unlock;
2752 			if (!ops->disable)
2753 				goto unlock;
2754 			if (ops->is_enabled && !ops->is_enabled(rdev))
2755 				goto unlock;
2756 
2757 			error = ops->disable(rdev);
2758 			if (error)
2759 				ret = error;
2760 		}
2761 unlock:
2762 		mutex_unlock(&rdev->mutex);
2763 	}
2764 	mutex_unlock(&regulator_list_mutex);
2765 	return ret;
2766 }
2767 EXPORT_SYMBOL_GPL(regulator_suspend_finish);
2768 
2769 /**
2770  * regulator_has_full_constraints - the system has fully specified constraints
2771  *
2772  * Calling this function will cause the regulator API to disable all
2773  * regulators which have a zero use count and don't have an always_on
2774  * constraint in a late_initcall.
2775  *
2776  * The intention is that this will become the default behaviour in a
2777  * future kernel release so users are encouraged to use this facility
2778  * now.
2779  */
regulator_has_full_constraints(void)2780 void regulator_has_full_constraints(void)
2781 {
2782 	has_full_constraints = 1;
2783 }
2784 EXPORT_SYMBOL_GPL(regulator_has_full_constraints);
2785 
2786 /**
2787  * regulator_use_dummy_regulator - Provide a dummy regulator when none is found
2788  *
2789  * Calling this function will cause the regulator API to provide a
2790  * dummy regulator to consumers if no physical regulator is found,
2791  * allowing most consumers to proceed as though a regulator were
2792  * configured.  This allows systems such as those with software
2793  * controllable regulators for the CPU core only to be brought up more
2794  * readily.
2795  */
regulator_use_dummy_regulator(void)2796 void regulator_use_dummy_regulator(void)
2797 {
2798 	board_wants_dummy_regulator = true;
2799 }
2800 EXPORT_SYMBOL_GPL(regulator_use_dummy_regulator);
2801 
2802 /**
2803  * rdev_get_drvdata - get rdev regulator driver data
2804  * @rdev: regulator
2805  *
2806  * Get rdev regulator driver private data. This call can be used in the
2807  * regulator driver context.
2808  */
rdev_get_drvdata(struct regulator_dev * rdev)2809 void *rdev_get_drvdata(struct regulator_dev *rdev)
2810 {
2811 	return rdev->reg_data;
2812 }
2813 EXPORT_SYMBOL_GPL(rdev_get_drvdata);
2814 
2815 /**
2816  * regulator_get_drvdata - get regulator driver data
2817  * @regulator: regulator
2818  *
2819  * Get regulator driver private data. This call can be used in the consumer
2820  * driver context when non API regulator specific functions need to be called.
2821  */
regulator_get_drvdata(struct regulator * regulator)2822 void *regulator_get_drvdata(struct regulator *regulator)
2823 {
2824 	return regulator->rdev->reg_data;
2825 }
2826 EXPORT_SYMBOL_GPL(regulator_get_drvdata);
2827 
2828 /**
2829  * regulator_set_drvdata - set regulator driver data
2830  * @regulator: regulator
2831  * @data: data
2832  */
regulator_set_drvdata(struct regulator * regulator,void * data)2833 void regulator_set_drvdata(struct regulator *regulator, void *data)
2834 {
2835 	regulator->rdev->reg_data = data;
2836 }
2837 EXPORT_SYMBOL_GPL(regulator_set_drvdata);
2838 
2839 /**
2840  * regulator_get_id - get regulator ID
2841  * @rdev: regulator
2842  */
rdev_get_id(struct regulator_dev * rdev)2843 int rdev_get_id(struct regulator_dev *rdev)
2844 {
2845 	return rdev->desc->id;
2846 }
2847 EXPORT_SYMBOL_GPL(rdev_get_id);
2848 
rdev_get_dev(struct regulator_dev * rdev)2849 struct device *rdev_get_dev(struct regulator_dev *rdev)
2850 {
2851 	return &rdev->dev;
2852 }
2853 EXPORT_SYMBOL_GPL(rdev_get_dev);
2854 
regulator_get_init_drvdata(struct regulator_init_data * reg_init_data)2855 void *regulator_get_init_drvdata(struct regulator_init_data *reg_init_data)
2856 {
2857 	return reg_init_data->driver_data;
2858 }
2859 EXPORT_SYMBOL_GPL(regulator_get_init_drvdata);
2860 
regulator_init(void)2861 static int __init regulator_init(void)
2862 {
2863 	int ret;
2864 
2865 	ret = class_register(&regulator_class);
2866 
2867 #ifdef CONFIG_DEBUG_FS
2868 	debugfs_root = debugfs_create_dir("regulator", NULL);
2869 	if (IS_ERR(debugfs_root) || !debugfs_root) {
2870 		pr_warn("regulator: Failed to create debugfs directory\n");
2871 		debugfs_root = NULL;
2872 	}
2873 #endif
2874 
2875 	regulator_dummy_init();
2876 
2877 	return ret;
2878 }
2879 
2880 /* init early to allow our consumers to complete system booting */
2881 core_initcall(regulator_init);
2882 
regulator_init_complete(void)2883 static int __init regulator_init_complete(void)
2884 {
2885 	struct regulator_dev *rdev;
2886 	struct regulator_ops *ops;
2887 	struct regulation_constraints *c;
2888 	int enabled, ret;
2889 
2890 	mutex_lock(&regulator_list_mutex);
2891 
2892 	/* If we have a full configuration then disable any regulators
2893 	 * which are not in use or always_on.  This will become the
2894 	 * default behaviour in the future.
2895 	 */
2896 	list_for_each_entry(rdev, &regulator_list, list) {
2897 		ops = rdev->desc->ops;
2898 		c = rdev->constraints;
2899 
2900 		if (!ops->disable || (c && c->always_on))
2901 			continue;
2902 
2903 		mutex_lock(&rdev->mutex);
2904 
2905 		if (rdev->use_count)
2906 			goto unlock;
2907 
2908 		/* If we can't read the status assume it's on. */
2909 		if (ops->is_enabled)
2910 			enabled = ops->is_enabled(rdev);
2911 		else
2912 			enabled = 1;
2913 
2914 		if (!enabled)
2915 			goto unlock;
2916 
2917 		if (has_full_constraints) {
2918 			/* We log since this may kill the system if it
2919 			 * goes wrong. */
2920 			rdev_info(rdev, "disabling\n");
2921 			ret = ops->disable(rdev);
2922 			if (ret != 0) {
2923 				rdev_err(rdev, "couldn't disable: %d\n", ret);
2924 			}
2925 		} else {
2926 			/* The intention is that in future we will
2927 			 * assume that full constraints are provided
2928 			 * so warn even if we aren't going to do
2929 			 * anything here.
2930 			 */
2931 			rdev_warn(rdev, "incomplete constraints, leaving on\n");
2932 		}
2933 
2934 unlock:
2935 		mutex_unlock(&rdev->mutex);
2936 	}
2937 
2938 	mutex_unlock(&regulator_list_mutex);
2939 
2940 	return 0;
2941 }
2942 late_initcall(regulator_init_complete);
2943