1 // SPDX-License-Identifier: GPL-2.0-or-later
2 //
3 // core.c -- Voltage/Current Regulator framework.
4 //
5 // Copyright 2007, 2008 Wolfson Microelectronics PLC.
6 // Copyright 2008 SlimLogic Ltd.
7 //
8 // Author: Liam Girdwood <lrg@slimlogic.co.uk>
9
10 #include <linux/kernel.h>
11 #include <linux/init.h>
12 #include <linux/debugfs.h>
13 #include <linux/device.h>
14 #include <linux/slab.h>
15 #include <linux/async.h>
16 #include <linux/err.h>
17 #include <linux/mutex.h>
18 #include <linux/suspend.h>
19 #include <linux/delay.h>
20 #include <linux/gpio/consumer.h>
21 #include <linux/of.h>
22 #include <linux/reboot.h>
23 #include <linux/regmap.h>
24 #include <linux/regulator/of_regulator.h>
25 #include <linux/regulator/consumer.h>
26 #include <linux/regulator/coupler.h>
27 #include <linux/regulator/driver.h>
28 #include <linux/regulator/machine.h>
29 #include <linux/module.h>
30
31 #define CREATE_TRACE_POINTS
32 #include <trace/events/regulator.h>
33
34 #include "dummy.h"
35 #include "internal.h"
36 #include "regnl.h"
37
38 static DEFINE_WW_CLASS(regulator_ww_class);
39 static DEFINE_MUTEX(regulator_nesting_mutex);
40 static DEFINE_MUTEX(regulator_list_mutex);
41 static LIST_HEAD(regulator_map_list);
42 static LIST_HEAD(regulator_ena_gpio_list);
43 static LIST_HEAD(regulator_supply_alias_list);
44 static LIST_HEAD(regulator_coupler_list);
45 static bool has_full_constraints;
46
47 static const struct bus_type regulator_bus;
48
49 static struct dentry *debugfs_root;
50
51 /*
52 * struct regulator_map
53 *
54 * Used to provide symbolic supply names to devices.
55 */
56 struct regulator_map {
57 struct list_head list;
58 const char *dev_name; /* The dev_name() for the consumer */
59 const char *supply;
60 struct regulator_dev *regulator;
61 };
62
63 /*
64 * struct regulator_enable_gpio
65 *
66 * Management for shared enable GPIO pin
67 */
68 struct regulator_enable_gpio {
69 struct list_head list;
70 struct gpio_desc *gpiod;
71 u32 enable_count; /* a number of enabled shared GPIO */
72 u32 request_count; /* a number of requested shared GPIO */
73 };
74
75 /*
76 * struct regulator_supply_alias
77 *
78 * Used to map lookups for a supply onto an alternative device.
79 */
80 struct regulator_supply_alias {
81 struct list_head list;
82 struct device *src_dev;
83 const char *src_supply;
84 struct device *alias_dev;
85 const char *alias_supply;
86 };
87
88 /*
89 * Work item used to forward regulator events.
90 *
91 * @work: workqueue entry
92 * @rdev: regulator device to notify (consumer receiving the forwarded event)
93 * @event: event code to be forwarded
94 */
95 struct regulator_event_work {
96 struct work_struct work;
97 struct regulator_dev *rdev;
98 unsigned long event;
99 };
100
101 static int _regulator_enable(struct regulator *regulator);
102 static int _regulator_is_enabled(struct regulator_dev *rdev);
103 static int _regulator_disable(struct regulator *regulator);
104 static int _regulator_get_error_flags(struct regulator_dev *rdev, unsigned int *flags);
105 static int _regulator_get_current_limit(struct regulator_dev *rdev);
106 static unsigned int _regulator_get_mode(struct regulator_dev *rdev);
107 static int _notifier_call_chain(struct regulator_dev *rdev,
108 unsigned long event, void *data);
109 static int _regulator_do_set_voltage(struct regulator_dev *rdev,
110 int min_uV, int max_uV);
111 static int regulator_balance_voltage(struct regulator_dev *rdev,
112 suspend_state_t state);
113 static struct regulator *create_regulator(struct regulator_dev *rdev,
114 struct device *dev,
115 const char *supply_name);
116 static void destroy_regulator(struct regulator *regulator);
117 static void _regulator_put(struct regulator *regulator);
118
rdev_get_name(struct regulator_dev * rdev)119 const char *rdev_get_name(struct regulator_dev *rdev)
120 {
121 if (rdev->constraints && rdev->constraints->name)
122 return rdev->constraints->name;
123 else if (rdev->desc->name)
124 return rdev->desc->name;
125 else
126 return "";
127 }
128 EXPORT_SYMBOL_GPL(rdev_get_name);
129
have_full_constraints(void)130 static bool have_full_constraints(void)
131 {
132 return has_full_constraints || of_have_populated_dt();
133 }
134
regulator_ops_is_valid(struct regulator_dev * rdev,int ops)135 static bool regulator_ops_is_valid(struct regulator_dev *rdev, int ops)
136 {
137 if (!rdev->constraints) {
138 rdev_err(rdev, "no constraints\n");
139 return false;
140 }
141
142 if (rdev->constraints->valid_ops_mask & ops)
143 return true;
144
145 return false;
146 }
147
148 /**
149 * regulator_lock_nested - lock a single regulator
150 * @rdev: regulator source
151 * @ww_ctx: w/w mutex acquire context
152 *
153 * This function can be called many times by one task on
154 * a single regulator and its mutex will be locked only
155 * once. If a task, which is calling this function is other
156 * than the one, which initially locked the mutex, it will
157 * wait on mutex.
158 *
159 * Return: 0 on success or a negative error number on failure.
160 */
regulator_lock_nested(struct regulator_dev * rdev,struct ww_acquire_ctx * ww_ctx)161 static inline int regulator_lock_nested(struct regulator_dev *rdev,
162 struct ww_acquire_ctx *ww_ctx)
163 {
164 bool lock = false;
165 int ret = 0;
166
167 mutex_lock(®ulator_nesting_mutex);
168
169 if (!ww_mutex_trylock(&rdev->mutex, ww_ctx)) {
170 if (rdev->mutex_owner == current)
171 rdev->ref_cnt++;
172 else
173 lock = true;
174
175 if (lock) {
176 mutex_unlock(®ulator_nesting_mutex);
177 ret = ww_mutex_lock(&rdev->mutex, ww_ctx);
178 mutex_lock(®ulator_nesting_mutex);
179 }
180 } else {
181 lock = true;
182 }
183
184 if (lock && ret != -EDEADLK) {
185 rdev->ref_cnt++;
186 rdev->mutex_owner = current;
187 }
188
189 mutex_unlock(®ulator_nesting_mutex);
190
191 return ret;
192 }
193
194 /**
195 * regulator_lock - lock a single regulator
196 * @rdev: regulator source
197 *
198 * This function can be called many times by one task on
199 * a single regulator and its mutex will be locked only
200 * once. If a task, which is calling this function is other
201 * than the one, which initially locked the mutex, it will
202 * wait on mutex.
203 */
regulator_lock(struct regulator_dev * rdev)204 static void regulator_lock(struct regulator_dev *rdev)
205 {
206 regulator_lock_nested(rdev, NULL);
207 }
208
209 /**
210 * regulator_unlock - unlock a single regulator
211 * @rdev: regulator_source
212 *
213 * This function unlocks the mutex when the
214 * reference counter reaches 0.
215 */
regulator_unlock(struct regulator_dev * rdev)216 static void regulator_unlock(struct regulator_dev *rdev)
217 {
218 mutex_lock(®ulator_nesting_mutex);
219
220 if (--rdev->ref_cnt == 0) {
221 rdev->mutex_owner = NULL;
222 ww_mutex_unlock(&rdev->mutex);
223 }
224
225 WARN_ON_ONCE(rdev->ref_cnt < 0);
226
227 mutex_unlock(®ulator_nesting_mutex);
228 }
229
230 /**
231 * regulator_lock_two - lock two regulators
232 * @rdev1: first regulator
233 * @rdev2: second regulator
234 * @ww_ctx: w/w mutex acquire context
235 *
236 * Locks both rdevs using the regulator_ww_class.
237 */
regulator_lock_two(struct regulator_dev * rdev1,struct regulator_dev * rdev2,struct ww_acquire_ctx * ww_ctx)238 static void regulator_lock_two(struct regulator_dev *rdev1,
239 struct regulator_dev *rdev2,
240 struct ww_acquire_ctx *ww_ctx)
241 {
242 struct regulator_dev *held, *contended;
243 int ret;
244
245 ww_acquire_init(ww_ctx, ®ulator_ww_class);
246
247 /* Try to just grab both of them */
248 ret = regulator_lock_nested(rdev1, ww_ctx);
249 WARN_ON(ret);
250 ret = regulator_lock_nested(rdev2, ww_ctx);
251 if (ret != -EDEADLOCK) {
252 WARN_ON(ret);
253 goto exit;
254 }
255
256 held = rdev1;
257 contended = rdev2;
258 while (true) {
259 regulator_unlock(held);
260
261 ww_mutex_lock_slow(&contended->mutex, ww_ctx);
262 contended->ref_cnt++;
263 contended->mutex_owner = current;
264 swap(held, contended);
265 ret = regulator_lock_nested(contended, ww_ctx);
266
267 if (ret != -EDEADLOCK) {
268 WARN_ON(ret);
269 break;
270 }
271 }
272
273 exit:
274 ww_acquire_done(ww_ctx);
275 }
276
277 /**
278 * regulator_unlock_two - unlock two regulators
279 * @rdev1: first regulator
280 * @rdev2: second regulator
281 * @ww_ctx: w/w mutex acquire context
282 *
283 * The inverse of regulator_lock_two().
284 */
285
regulator_unlock_two(struct regulator_dev * rdev1,struct regulator_dev * rdev2,struct ww_acquire_ctx * ww_ctx)286 static void regulator_unlock_two(struct regulator_dev *rdev1,
287 struct regulator_dev *rdev2,
288 struct ww_acquire_ctx *ww_ctx)
289 {
290 regulator_unlock(rdev2);
291 regulator_unlock(rdev1);
292 ww_acquire_fini(ww_ctx);
293 }
294
regulator_supply_is_couple(struct regulator_dev * rdev)295 static bool regulator_supply_is_couple(struct regulator_dev *rdev)
296 {
297 struct regulator_dev *c_rdev;
298 int i;
299
300 for (i = 1; i < rdev->coupling_desc.n_coupled; i++) {
301 c_rdev = rdev->coupling_desc.coupled_rdevs[i];
302
303 if (rdev->supply->rdev == c_rdev)
304 return true;
305 }
306
307 return false;
308 }
309
regulator_unlock_recursive(struct regulator_dev * rdev,unsigned int n_coupled)310 static void regulator_unlock_recursive(struct regulator_dev *rdev,
311 unsigned int n_coupled)
312 {
313 struct regulator_dev *c_rdev, *supply_rdev;
314 int i, supply_n_coupled;
315
316 for (i = n_coupled; i > 0; i--) {
317 c_rdev = rdev->coupling_desc.coupled_rdevs[i - 1];
318
319 if (!c_rdev)
320 continue;
321
322 if (c_rdev->supply && !regulator_supply_is_couple(c_rdev)) {
323 supply_rdev = c_rdev->supply->rdev;
324 supply_n_coupled = supply_rdev->coupling_desc.n_coupled;
325
326 regulator_unlock_recursive(supply_rdev,
327 supply_n_coupled);
328 }
329
330 regulator_unlock(c_rdev);
331 }
332 }
333
regulator_lock_recursive(struct regulator_dev * rdev,struct regulator_dev ** new_contended_rdev,struct regulator_dev ** old_contended_rdev,struct ww_acquire_ctx * ww_ctx)334 static int regulator_lock_recursive(struct regulator_dev *rdev,
335 struct regulator_dev **new_contended_rdev,
336 struct regulator_dev **old_contended_rdev,
337 struct ww_acquire_ctx *ww_ctx)
338 {
339 struct regulator_dev *c_rdev;
340 int i, err;
341
342 for (i = 0; i < rdev->coupling_desc.n_coupled; i++) {
343 c_rdev = rdev->coupling_desc.coupled_rdevs[i];
344
345 if (!c_rdev)
346 continue;
347
348 if (c_rdev != *old_contended_rdev) {
349 err = regulator_lock_nested(c_rdev, ww_ctx);
350 if (err) {
351 if (err == -EDEADLK) {
352 *new_contended_rdev = c_rdev;
353 goto err_unlock;
354 }
355
356 /* shouldn't happen */
357 WARN_ON_ONCE(err != -EALREADY);
358 }
359 } else {
360 *old_contended_rdev = NULL;
361 }
362
363 if (c_rdev->supply && !regulator_supply_is_couple(c_rdev)) {
364 err = regulator_lock_recursive(c_rdev->supply->rdev,
365 new_contended_rdev,
366 old_contended_rdev,
367 ww_ctx);
368 if (err) {
369 regulator_unlock(c_rdev);
370 goto err_unlock;
371 }
372 }
373 }
374
375 return 0;
376
377 err_unlock:
378 regulator_unlock_recursive(rdev, i);
379
380 return err;
381 }
382
383 /**
384 * regulator_unlock_dependent - unlock regulator's suppliers and coupled
385 * regulators
386 * @rdev: regulator source
387 * @ww_ctx: w/w mutex acquire context
388 *
389 * Unlock all regulators related with rdev by coupling or supplying.
390 */
regulator_unlock_dependent(struct regulator_dev * rdev,struct ww_acquire_ctx * ww_ctx)391 static void regulator_unlock_dependent(struct regulator_dev *rdev,
392 struct ww_acquire_ctx *ww_ctx)
393 {
394 regulator_unlock_recursive(rdev, rdev->coupling_desc.n_coupled);
395 ww_acquire_fini(ww_ctx);
396 }
397
398 /**
399 * regulator_lock_dependent - lock regulator's suppliers and coupled regulators
400 * @rdev: regulator source
401 * @ww_ctx: w/w mutex acquire context
402 *
403 * This function as a wrapper on regulator_lock_recursive(), which locks
404 * all regulators related with rdev by coupling or supplying.
405 */
regulator_lock_dependent(struct regulator_dev * rdev,struct ww_acquire_ctx * ww_ctx)406 static void regulator_lock_dependent(struct regulator_dev *rdev,
407 struct ww_acquire_ctx *ww_ctx)
408 {
409 struct regulator_dev *new_contended_rdev = NULL;
410 struct regulator_dev *old_contended_rdev = NULL;
411 int err;
412
413 mutex_lock(®ulator_list_mutex);
414
415 ww_acquire_init(ww_ctx, ®ulator_ww_class);
416
417 do {
418 if (new_contended_rdev) {
419 ww_mutex_lock_slow(&new_contended_rdev->mutex, ww_ctx);
420 old_contended_rdev = new_contended_rdev;
421 old_contended_rdev->ref_cnt++;
422 old_contended_rdev->mutex_owner = current;
423 }
424
425 err = regulator_lock_recursive(rdev,
426 &new_contended_rdev,
427 &old_contended_rdev,
428 ww_ctx);
429
430 if (old_contended_rdev)
431 regulator_unlock(old_contended_rdev);
432
433 } while (err == -EDEADLK);
434
435 ww_acquire_done(ww_ctx);
436
437 mutex_unlock(®ulator_list_mutex);
438 }
439
440 /* Platform voltage constraint check */
regulator_check_voltage(struct regulator_dev * rdev,int * min_uV,int * max_uV)441 int regulator_check_voltage(struct regulator_dev *rdev,
442 int *min_uV, int *max_uV)
443 {
444 BUG_ON(*min_uV > *max_uV);
445
446 if (!regulator_ops_is_valid(rdev, REGULATOR_CHANGE_VOLTAGE)) {
447 rdev_err(rdev, "voltage operation not allowed\n");
448 return -EPERM;
449 }
450
451 if (*max_uV > rdev->constraints->max_uV)
452 *max_uV = rdev->constraints->max_uV;
453 if (*min_uV < rdev->constraints->min_uV)
454 *min_uV = rdev->constraints->min_uV;
455
456 if (*min_uV > *max_uV) {
457 rdev_err(rdev, "unsupportable voltage range: %d-%duV\n",
458 *min_uV, *max_uV);
459 return -EINVAL;
460 }
461
462 return 0;
463 }
464
465 /* return 0 if the state is valid */
regulator_check_states(suspend_state_t state)466 static int regulator_check_states(suspend_state_t state)
467 {
468 return (state > PM_SUSPEND_MAX || state == PM_SUSPEND_TO_IDLE);
469 }
470
471 /* Make sure we select a voltage that suits the needs of all
472 * regulator consumers
473 */
regulator_check_consumers(struct regulator_dev * rdev,int * min_uV,int * max_uV,suspend_state_t state)474 int regulator_check_consumers(struct regulator_dev *rdev,
475 int *min_uV, int *max_uV,
476 suspend_state_t state)
477 {
478 struct regulator *regulator;
479 struct regulator_voltage *voltage;
480
481 list_for_each_entry(regulator, &rdev->consumer_list, list) {
482 voltage = ®ulator->voltage[state];
483 /*
484 * Assume consumers that didn't say anything are OK
485 * with anything in the constraint range.
486 */
487 if (!voltage->min_uV && !voltage->max_uV)
488 continue;
489
490 if (*max_uV > voltage->max_uV)
491 *max_uV = voltage->max_uV;
492 if (*min_uV < voltage->min_uV)
493 *min_uV = voltage->min_uV;
494 }
495
496 if (*min_uV > *max_uV) {
497 rdev_err(rdev, "Restricting voltage, %u-%uuV\n",
498 *min_uV, *max_uV);
499 return -EINVAL;
500 }
501
502 return 0;
503 }
504
505 /* current constraint check */
regulator_check_current_limit(struct regulator_dev * rdev,int * min_uA,int * max_uA)506 static int regulator_check_current_limit(struct regulator_dev *rdev,
507 int *min_uA, int *max_uA)
508 {
509 BUG_ON(*min_uA > *max_uA);
510
511 if (!regulator_ops_is_valid(rdev, REGULATOR_CHANGE_CURRENT)) {
512 rdev_err(rdev, "current operation not allowed\n");
513 return -EPERM;
514 }
515
516 if (*max_uA > rdev->constraints->max_uA &&
517 rdev->constraints->max_uA)
518 *max_uA = rdev->constraints->max_uA;
519 if (*min_uA < rdev->constraints->min_uA)
520 *min_uA = rdev->constraints->min_uA;
521
522 if (*min_uA > *max_uA) {
523 rdev_err(rdev, "unsupportable current range: %d-%duA\n",
524 *min_uA, *max_uA);
525 return -EINVAL;
526 }
527
528 return 0;
529 }
530
531 /* operating mode constraint check */
regulator_mode_constrain(struct regulator_dev * rdev,unsigned int * mode)532 static int regulator_mode_constrain(struct regulator_dev *rdev,
533 unsigned int *mode)
534 {
535 switch (*mode) {
536 case REGULATOR_MODE_FAST:
537 case REGULATOR_MODE_NORMAL:
538 case REGULATOR_MODE_IDLE:
539 case REGULATOR_MODE_STANDBY:
540 break;
541 default:
542 rdev_err(rdev, "invalid mode %x specified\n", *mode);
543 return -EINVAL;
544 }
545
546 if (!regulator_ops_is_valid(rdev, REGULATOR_CHANGE_MODE)) {
547 rdev_err(rdev, "mode operation not allowed\n");
548 return -EPERM;
549 }
550
551 /* The modes are bitmasks, the most power hungry modes having
552 * the lowest values. If the requested mode isn't supported
553 * try higher modes.
554 */
555 while (*mode) {
556 if (rdev->constraints->valid_modes_mask & *mode)
557 return 0;
558 *mode /= 2;
559 }
560
561 return -EINVAL;
562 }
563
564 static inline struct regulator_state *
regulator_get_suspend_state(struct regulator_dev * rdev,suspend_state_t state)565 regulator_get_suspend_state(struct regulator_dev *rdev, suspend_state_t state)
566 {
567 if (rdev->constraints == NULL)
568 return NULL;
569
570 switch (state) {
571 case PM_SUSPEND_STANDBY:
572 return &rdev->constraints->state_standby;
573 case PM_SUSPEND_MEM:
574 return &rdev->constraints->state_mem;
575 case PM_SUSPEND_MAX:
576 return &rdev->constraints->state_disk;
577 default:
578 return NULL;
579 }
580 }
581
582 static const struct regulator_state *
regulator_get_suspend_state_check(struct regulator_dev * rdev,suspend_state_t state)583 regulator_get_suspend_state_check(struct regulator_dev *rdev, suspend_state_t state)
584 {
585 const struct regulator_state *rstate;
586
587 rstate = regulator_get_suspend_state(rdev, state);
588 if (rstate == NULL)
589 return NULL;
590
591 /* If we have no suspend mode configuration don't set anything;
592 * only warn if the driver implements set_suspend_voltage or
593 * set_suspend_mode callback.
594 */
595 if (rstate->enabled != ENABLE_IN_SUSPEND &&
596 rstate->enabled != DISABLE_IN_SUSPEND) {
597 if (rdev->desc->ops->set_suspend_voltage ||
598 rdev->desc->ops->set_suspend_mode)
599 rdev_warn(rdev, "No configuration\n");
600 return NULL;
601 }
602
603 return rstate;
604 }
605
microvolts_show(struct device * dev,struct device_attribute * attr,char * buf)606 static ssize_t microvolts_show(struct device *dev,
607 struct device_attribute *attr, char *buf)
608 {
609 struct regulator_dev *rdev = dev_get_drvdata(dev);
610 int uV;
611
612 regulator_lock(rdev);
613 uV = regulator_get_voltage_rdev(rdev);
614 regulator_unlock(rdev);
615
616 if (uV < 0)
617 return uV;
618 return sprintf(buf, "%d\n", uV);
619 }
620 static DEVICE_ATTR_RO(microvolts);
621
microamps_show(struct device * dev,struct device_attribute * attr,char * buf)622 static ssize_t microamps_show(struct device *dev,
623 struct device_attribute *attr, char *buf)
624 {
625 struct regulator_dev *rdev = dev_get_drvdata(dev);
626
627 return sprintf(buf, "%d\n", _regulator_get_current_limit(rdev));
628 }
629 static DEVICE_ATTR_RO(microamps);
630
name_show(struct device * dev,struct device_attribute * attr,char * buf)631 static ssize_t name_show(struct device *dev, struct device_attribute *attr,
632 char *buf)
633 {
634 struct regulator_dev *rdev = dev_get_drvdata(dev);
635
636 return sprintf(buf, "%s\n", rdev_get_name(rdev));
637 }
638 static DEVICE_ATTR_RO(name);
639
regulator_opmode_to_str(int mode)640 static const char *regulator_opmode_to_str(int mode)
641 {
642 switch (mode) {
643 case REGULATOR_MODE_FAST:
644 return "fast";
645 case REGULATOR_MODE_NORMAL:
646 return "normal";
647 case REGULATOR_MODE_IDLE:
648 return "idle";
649 case REGULATOR_MODE_STANDBY:
650 return "standby";
651 }
652 return "unknown";
653 }
654
regulator_print_opmode(char * buf,int mode)655 static ssize_t regulator_print_opmode(char *buf, int mode)
656 {
657 return sprintf(buf, "%s\n", regulator_opmode_to_str(mode));
658 }
659
opmode_show(struct device * dev,struct device_attribute * attr,char * buf)660 static ssize_t opmode_show(struct device *dev,
661 struct device_attribute *attr, char *buf)
662 {
663 struct regulator_dev *rdev = dev_get_drvdata(dev);
664
665 return regulator_print_opmode(buf, _regulator_get_mode(rdev));
666 }
667 static DEVICE_ATTR_RO(opmode);
668
regulator_print_state(char * buf,int state)669 static ssize_t regulator_print_state(char *buf, int state)
670 {
671 if (state > 0)
672 return sprintf(buf, "enabled\n");
673 else if (state == 0)
674 return sprintf(buf, "disabled\n");
675 else
676 return sprintf(buf, "unknown\n");
677 }
678
state_show(struct device * dev,struct device_attribute * attr,char * buf)679 static ssize_t state_show(struct device *dev,
680 struct device_attribute *attr, char *buf)
681 {
682 struct regulator_dev *rdev = dev_get_drvdata(dev);
683 ssize_t ret;
684
685 regulator_lock(rdev);
686 ret = regulator_print_state(buf, _regulator_is_enabled(rdev));
687 regulator_unlock(rdev);
688
689 return ret;
690 }
691 static DEVICE_ATTR_RO(state);
692
status_show(struct device * dev,struct device_attribute * attr,char * buf)693 static ssize_t status_show(struct device *dev,
694 struct device_attribute *attr, char *buf)
695 {
696 struct regulator_dev *rdev = dev_get_drvdata(dev);
697 int status;
698 char *label;
699
700 status = rdev->desc->ops->get_status(rdev);
701 if (status < 0)
702 return status;
703
704 switch (status) {
705 case REGULATOR_STATUS_OFF:
706 label = "off";
707 break;
708 case REGULATOR_STATUS_ON:
709 label = "on";
710 break;
711 case REGULATOR_STATUS_ERROR:
712 label = "error";
713 break;
714 case REGULATOR_STATUS_FAST:
715 label = "fast";
716 break;
717 case REGULATOR_STATUS_NORMAL:
718 label = "normal";
719 break;
720 case REGULATOR_STATUS_IDLE:
721 label = "idle";
722 break;
723 case REGULATOR_STATUS_STANDBY:
724 label = "standby";
725 break;
726 case REGULATOR_STATUS_BYPASS:
727 label = "bypass";
728 break;
729 case REGULATOR_STATUS_UNDEFINED:
730 label = "undefined";
731 break;
732 default:
733 return -ERANGE;
734 }
735
736 return sprintf(buf, "%s\n", label);
737 }
738 static DEVICE_ATTR_RO(status);
739
min_microamps_show(struct device * dev,struct device_attribute * attr,char * buf)740 static ssize_t min_microamps_show(struct device *dev,
741 struct device_attribute *attr, char *buf)
742 {
743 struct regulator_dev *rdev = dev_get_drvdata(dev);
744
745 if (!rdev->constraints)
746 return sprintf(buf, "constraint not defined\n");
747
748 return sprintf(buf, "%d\n", rdev->constraints->min_uA);
749 }
750 static DEVICE_ATTR_RO(min_microamps);
751
max_microamps_show(struct device * dev,struct device_attribute * attr,char * buf)752 static ssize_t max_microamps_show(struct device *dev,
753 struct device_attribute *attr, char *buf)
754 {
755 struct regulator_dev *rdev = dev_get_drvdata(dev);
756
757 if (!rdev->constraints)
758 return sprintf(buf, "constraint not defined\n");
759
760 return sprintf(buf, "%d\n", rdev->constraints->max_uA);
761 }
762 static DEVICE_ATTR_RO(max_microamps);
763
min_microvolts_show(struct device * dev,struct device_attribute * attr,char * buf)764 static ssize_t min_microvolts_show(struct device *dev,
765 struct device_attribute *attr, char *buf)
766 {
767 struct regulator_dev *rdev = dev_get_drvdata(dev);
768
769 if (!rdev->constraints)
770 return sprintf(buf, "constraint not defined\n");
771
772 return sprintf(buf, "%d\n", rdev->constraints->min_uV);
773 }
774 static DEVICE_ATTR_RO(min_microvolts);
775
max_microvolts_show(struct device * dev,struct device_attribute * attr,char * buf)776 static ssize_t max_microvolts_show(struct device *dev,
777 struct device_attribute *attr, char *buf)
778 {
779 struct regulator_dev *rdev = dev_get_drvdata(dev);
780
781 if (!rdev->constraints)
782 return sprintf(buf, "constraint not defined\n");
783
784 return sprintf(buf, "%d\n", rdev->constraints->max_uV);
785 }
786 static DEVICE_ATTR_RO(max_microvolts);
787
requested_microamps_show(struct device * dev,struct device_attribute * attr,char * buf)788 static ssize_t requested_microamps_show(struct device *dev,
789 struct device_attribute *attr, char *buf)
790 {
791 struct regulator_dev *rdev = dev_get_drvdata(dev);
792 struct regulator *regulator;
793 int uA = 0;
794
795 regulator_lock(rdev);
796 list_for_each_entry(regulator, &rdev->consumer_list, list) {
797 if (regulator->enable_count)
798 uA += regulator->uA_load;
799 }
800 regulator_unlock(rdev);
801 return sprintf(buf, "%d\n", uA);
802 }
803 static DEVICE_ATTR_RO(requested_microamps);
804
num_users_show(struct device * dev,struct device_attribute * attr,char * buf)805 static ssize_t num_users_show(struct device *dev, struct device_attribute *attr,
806 char *buf)
807 {
808 struct regulator_dev *rdev = dev_get_drvdata(dev);
809 return sprintf(buf, "%d\n", rdev->use_count);
810 }
811 static DEVICE_ATTR_RO(num_users);
812
type_show(struct device * dev,struct device_attribute * attr,char * buf)813 static ssize_t type_show(struct device *dev, struct device_attribute *attr,
814 char *buf)
815 {
816 struct regulator_dev *rdev = dev_get_drvdata(dev);
817
818 switch (rdev->desc->type) {
819 case REGULATOR_VOLTAGE:
820 return sprintf(buf, "voltage\n");
821 case REGULATOR_CURRENT:
822 return sprintf(buf, "current\n");
823 }
824 return sprintf(buf, "unknown\n");
825 }
826 static DEVICE_ATTR_RO(type);
827
suspend_mem_microvolts_show(struct device * dev,struct device_attribute * attr,char * buf)828 static ssize_t suspend_mem_microvolts_show(struct device *dev,
829 struct device_attribute *attr, char *buf)
830 {
831 struct regulator_dev *rdev = dev_get_drvdata(dev);
832
833 return sprintf(buf, "%d\n", rdev->constraints->state_mem.uV);
834 }
835 static DEVICE_ATTR_RO(suspend_mem_microvolts);
836
suspend_disk_microvolts_show(struct device * dev,struct device_attribute * attr,char * buf)837 static ssize_t suspend_disk_microvolts_show(struct device *dev,
838 struct device_attribute *attr, char *buf)
839 {
840 struct regulator_dev *rdev = dev_get_drvdata(dev);
841
842 return sprintf(buf, "%d\n", rdev->constraints->state_disk.uV);
843 }
844 static DEVICE_ATTR_RO(suspend_disk_microvolts);
845
suspend_standby_microvolts_show(struct device * dev,struct device_attribute * attr,char * buf)846 static ssize_t suspend_standby_microvolts_show(struct device *dev,
847 struct device_attribute *attr, char *buf)
848 {
849 struct regulator_dev *rdev = dev_get_drvdata(dev);
850
851 return sprintf(buf, "%d\n", rdev->constraints->state_standby.uV);
852 }
853 static DEVICE_ATTR_RO(suspend_standby_microvolts);
854
suspend_mem_mode_show(struct device * dev,struct device_attribute * attr,char * buf)855 static ssize_t suspend_mem_mode_show(struct device *dev,
856 struct device_attribute *attr, char *buf)
857 {
858 struct regulator_dev *rdev = dev_get_drvdata(dev);
859
860 return regulator_print_opmode(buf,
861 rdev->constraints->state_mem.mode);
862 }
863 static DEVICE_ATTR_RO(suspend_mem_mode);
864
suspend_disk_mode_show(struct device * dev,struct device_attribute * attr,char * buf)865 static ssize_t suspend_disk_mode_show(struct device *dev,
866 struct device_attribute *attr, char *buf)
867 {
868 struct regulator_dev *rdev = dev_get_drvdata(dev);
869
870 return regulator_print_opmode(buf,
871 rdev->constraints->state_disk.mode);
872 }
873 static DEVICE_ATTR_RO(suspend_disk_mode);
874
suspend_standby_mode_show(struct device * dev,struct device_attribute * attr,char * buf)875 static ssize_t suspend_standby_mode_show(struct device *dev,
876 struct device_attribute *attr, char *buf)
877 {
878 struct regulator_dev *rdev = dev_get_drvdata(dev);
879
880 return regulator_print_opmode(buf,
881 rdev->constraints->state_standby.mode);
882 }
883 static DEVICE_ATTR_RO(suspend_standby_mode);
884
suspend_mem_state_show(struct device * dev,struct device_attribute * attr,char * buf)885 static ssize_t suspend_mem_state_show(struct device *dev,
886 struct device_attribute *attr, char *buf)
887 {
888 struct regulator_dev *rdev = dev_get_drvdata(dev);
889
890 return regulator_print_state(buf,
891 rdev->constraints->state_mem.enabled);
892 }
893 static DEVICE_ATTR_RO(suspend_mem_state);
894
suspend_disk_state_show(struct device * dev,struct device_attribute * attr,char * buf)895 static ssize_t suspend_disk_state_show(struct device *dev,
896 struct device_attribute *attr, char *buf)
897 {
898 struct regulator_dev *rdev = dev_get_drvdata(dev);
899
900 return regulator_print_state(buf,
901 rdev->constraints->state_disk.enabled);
902 }
903 static DEVICE_ATTR_RO(suspend_disk_state);
904
suspend_standby_state_show(struct device * dev,struct device_attribute * attr,char * buf)905 static ssize_t suspend_standby_state_show(struct device *dev,
906 struct device_attribute *attr, char *buf)
907 {
908 struct regulator_dev *rdev = dev_get_drvdata(dev);
909
910 return regulator_print_state(buf,
911 rdev->constraints->state_standby.enabled);
912 }
913 static DEVICE_ATTR_RO(suspend_standby_state);
914
bypass_show(struct device * dev,struct device_attribute * attr,char * buf)915 static ssize_t bypass_show(struct device *dev,
916 struct device_attribute *attr, char *buf)
917 {
918 struct regulator_dev *rdev = dev_get_drvdata(dev);
919 const char *report;
920 bool bypass;
921 int ret;
922
923 ret = rdev->desc->ops->get_bypass(rdev, &bypass);
924
925 if (ret != 0)
926 report = "unknown";
927 else if (bypass)
928 report = "enabled";
929 else
930 report = "disabled";
931
932 return sprintf(buf, "%s\n", report);
933 }
934 static DEVICE_ATTR_RO(bypass);
935
power_budget_milliwatt_show(struct device * dev,struct device_attribute * attr,char * buf)936 static ssize_t power_budget_milliwatt_show(struct device *dev,
937 struct device_attribute *attr,
938 char *buf)
939 {
940 struct regulator_dev *rdev = dev_get_drvdata(dev);
941
942 return sprintf(buf, "%d\n", rdev->constraints->pw_budget_mW);
943 }
944 static DEVICE_ATTR_RO(power_budget_milliwatt);
945
power_requested_milliwatt_show(struct device * dev,struct device_attribute * attr,char * buf)946 static ssize_t power_requested_milliwatt_show(struct device *dev,
947 struct device_attribute *attr,
948 char *buf)
949 {
950 struct regulator_dev *rdev = dev_get_drvdata(dev);
951
952 return sprintf(buf, "%d\n", rdev->pw_requested_mW);
953 }
954 static DEVICE_ATTR_RO(power_requested_milliwatt);
955
956 #define REGULATOR_ERROR_ATTR(name, bit) \
957 static ssize_t name##_show(struct device *dev, struct device_attribute *attr, \
958 char *buf) \
959 { \
960 int ret; \
961 unsigned int flags; \
962 struct regulator_dev *rdev = dev_get_drvdata(dev); \
963 ret = _regulator_get_error_flags(rdev, &flags); \
964 if (ret) \
965 return ret; \
966 return sysfs_emit(buf, "%d\n", !!(flags & (bit))); \
967 } \
968 static DEVICE_ATTR_RO(name)
969
970 REGULATOR_ERROR_ATTR(under_voltage, REGULATOR_ERROR_UNDER_VOLTAGE);
971 REGULATOR_ERROR_ATTR(over_current, REGULATOR_ERROR_OVER_CURRENT);
972 REGULATOR_ERROR_ATTR(regulation_out, REGULATOR_ERROR_REGULATION_OUT);
973 REGULATOR_ERROR_ATTR(fail, REGULATOR_ERROR_FAIL);
974 REGULATOR_ERROR_ATTR(over_temp, REGULATOR_ERROR_OVER_TEMP);
975 REGULATOR_ERROR_ATTR(under_voltage_warn, REGULATOR_ERROR_UNDER_VOLTAGE_WARN);
976 REGULATOR_ERROR_ATTR(over_current_warn, REGULATOR_ERROR_OVER_CURRENT_WARN);
977 REGULATOR_ERROR_ATTR(over_voltage_warn, REGULATOR_ERROR_OVER_VOLTAGE_WARN);
978 REGULATOR_ERROR_ATTR(over_temp_warn, REGULATOR_ERROR_OVER_TEMP_WARN);
979
980 /* Calculate the new optimum regulator operating mode based on the new total
981 * consumer load. All locks held by caller
982 */
drms_uA_update(struct regulator_dev * rdev)983 static int drms_uA_update(struct regulator_dev *rdev)
984 {
985 struct regulator *sibling;
986 int current_uA = 0, output_uV, input_uV, err;
987 unsigned int mode;
988
989 /*
990 * first check to see if we can set modes at all, otherwise just
991 * tell the consumer everything is OK.
992 */
993 if (!regulator_ops_is_valid(rdev, REGULATOR_CHANGE_DRMS)) {
994 rdev_dbg(rdev, "DRMS operation not allowed\n");
995 return 0;
996 }
997
998 if (!rdev->desc->ops->get_optimum_mode &&
999 !rdev->desc->ops->set_load)
1000 return 0;
1001
1002 if (!rdev->desc->ops->set_mode &&
1003 !rdev->desc->ops->set_load)
1004 return -EINVAL;
1005
1006 /* calc total requested load */
1007 list_for_each_entry(sibling, &rdev->consumer_list, list) {
1008 if (sibling->enable_count)
1009 current_uA += sibling->uA_load;
1010 }
1011
1012 current_uA += rdev->constraints->system_load;
1013
1014 if (rdev->desc->ops->set_load) {
1015 /* set the optimum mode for our new total regulator load */
1016 err = rdev->desc->ops->set_load(rdev, current_uA);
1017 if (err < 0)
1018 rdev_err(rdev, "failed to set load %d: %pe\n",
1019 current_uA, ERR_PTR(err));
1020 } else {
1021 /*
1022 * Unfortunately in some cases the constraints->valid_ops has
1023 * REGULATOR_CHANGE_DRMS but there are no valid modes listed.
1024 * That's not really legit but we won't consider it a fatal
1025 * error here. We'll treat it as if REGULATOR_CHANGE_DRMS
1026 * wasn't set.
1027 */
1028 if (!rdev->constraints->valid_modes_mask) {
1029 rdev_dbg(rdev, "Can change modes; but no valid mode\n");
1030 return 0;
1031 }
1032
1033 /* get output voltage */
1034 output_uV = regulator_get_voltage_rdev(rdev);
1035
1036 /*
1037 * Don't return an error; if regulator driver cares about
1038 * output_uV then it's up to the driver to validate.
1039 */
1040 if (output_uV <= 0)
1041 rdev_dbg(rdev, "invalid output voltage found\n");
1042
1043 /* get input voltage */
1044 input_uV = 0;
1045 if (rdev->supply)
1046 input_uV = regulator_get_voltage_rdev(rdev->supply->rdev);
1047 if (input_uV <= 0)
1048 input_uV = rdev->constraints->input_uV;
1049
1050 /*
1051 * Don't return an error; if regulator driver cares about
1052 * input_uV then it's up to the driver to validate.
1053 */
1054 if (input_uV <= 0)
1055 rdev_dbg(rdev, "invalid input voltage found\n");
1056
1057 /* now get the optimum mode for our new total regulator load */
1058 mode = rdev->desc->ops->get_optimum_mode(rdev, input_uV,
1059 output_uV, current_uA);
1060
1061 /* check the new mode is allowed */
1062 err = regulator_mode_constrain(rdev, &mode);
1063 if (err < 0) {
1064 rdev_err(rdev, "failed to get optimum mode @ %d uA %d -> %d uV: %pe\n",
1065 current_uA, input_uV, output_uV, ERR_PTR(err));
1066 return err;
1067 }
1068
1069 err = rdev->desc->ops->set_mode(rdev, mode);
1070 if (err < 0)
1071 rdev_err(rdev, "failed to set optimum mode %x: %pe\n",
1072 mode, ERR_PTR(err));
1073 }
1074
1075 return err;
1076 }
1077
__suspend_set_state(struct regulator_dev * rdev,const struct regulator_state * rstate)1078 static int __suspend_set_state(struct regulator_dev *rdev,
1079 const struct regulator_state *rstate)
1080 {
1081 int ret = 0;
1082
1083 if (rstate->enabled == ENABLE_IN_SUSPEND &&
1084 rdev->desc->ops->set_suspend_enable)
1085 ret = rdev->desc->ops->set_suspend_enable(rdev);
1086 else if (rstate->enabled == DISABLE_IN_SUSPEND &&
1087 rdev->desc->ops->set_suspend_disable)
1088 ret = rdev->desc->ops->set_suspend_disable(rdev);
1089 else /* OK if set_suspend_enable or set_suspend_disable is NULL */
1090 ret = 0;
1091
1092 if (ret < 0) {
1093 rdev_err(rdev, "failed to enabled/disable: %pe\n", ERR_PTR(ret));
1094 return ret;
1095 }
1096
1097 if (rdev->desc->ops->set_suspend_voltage && rstate->uV > 0) {
1098 ret = rdev->desc->ops->set_suspend_voltage(rdev, rstate->uV);
1099 if (ret < 0) {
1100 rdev_err(rdev, "failed to set voltage: %pe\n", ERR_PTR(ret));
1101 return ret;
1102 }
1103 }
1104
1105 if (rdev->desc->ops->set_suspend_mode && rstate->mode > 0) {
1106 ret = rdev->desc->ops->set_suspend_mode(rdev, rstate->mode);
1107 if (ret < 0) {
1108 rdev_err(rdev, "failed to set mode: %pe\n", ERR_PTR(ret));
1109 return ret;
1110 }
1111 }
1112
1113 return ret;
1114 }
1115
suspend_set_initial_state(struct regulator_dev * rdev)1116 static int suspend_set_initial_state(struct regulator_dev *rdev)
1117 {
1118 const struct regulator_state *rstate;
1119
1120 rstate = regulator_get_suspend_state_check(rdev,
1121 rdev->constraints->initial_state);
1122 if (!rstate)
1123 return 0;
1124
1125 return __suspend_set_state(rdev, rstate);
1126 }
1127
1128 #if defined(DEBUG) || defined(CONFIG_DYNAMIC_DEBUG)
print_constraints_debug(struct regulator_dev * rdev)1129 static void print_constraints_debug(struct regulator_dev *rdev)
1130 {
1131 struct regulation_constraints *constraints = rdev->constraints;
1132 char buf[160] = "";
1133 size_t len = sizeof(buf) - 1;
1134 int count = 0;
1135 int ret;
1136
1137 if (constraints->min_uV && constraints->max_uV) {
1138 if (constraints->min_uV == constraints->max_uV)
1139 count += scnprintf(buf + count, len - count, "%d mV ",
1140 constraints->min_uV / 1000);
1141 else
1142 count += scnprintf(buf + count, len - count,
1143 "%d <--> %d mV ",
1144 constraints->min_uV / 1000,
1145 constraints->max_uV / 1000);
1146 }
1147
1148 if (!constraints->min_uV ||
1149 constraints->min_uV != constraints->max_uV) {
1150 ret = regulator_get_voltage_rdev(rdev);
1151 if (ret > 0)
1152 count += scnprintf(buf + count, len - count,
1153 "at %d mV ", ret / 1000);
1154 }
1155
1156 if (constraints->uV_offset)
1157 count += scnprintf(buf + count, len - count, "%dmV offset ",
1158 constraints->uV_offset / 1000);
1159
1160 if (constraints->min_uA && constraints->max_uA) {
1161 if (constraints->min_uA == constraints->max_uA)
1162 count += scnprintf(buf + count, len - count, "%d mA ",
1163 constraints->min_uA / 1000);
1164 else
1165 count += scnprintf(buf + count, len - count,
1166 "%d <--> %d mA ",
1167 constraints->min_uA / 1000,
1168 constraints->max_uA / 1000);
1169 }
1170
1171 if (!constraints->min_uA ||
1172 constraints->min_uA != constraints->max_uA) {
1173 ret = _regulator_get_current_limit(rdev);
1174 if (ret > 0)
1175 count += scnprintf(buf + count, len - count,
1176 "at %d mA ", ret / 1000);
1177 }
1178
1179 if (constraints->valid_modes_mask & REGULATOR_MODE_FAST)
1180 count += scnprintf(buf + count, len - count, "fast ");
1181 if (constraints->valid_modes_mask & REGULATOR_MODE_NORMAL)
1182 count += scnprintf(buf + count, len - count, "normal ");
1183 if (constraints->valid_modes_mask & REGULATOR_MODE_IDLE)
1184 count += scnprintf(buf + count, len - count, "idle ");
1185 if (constraints->valid_modes_mask & REGULATOR_MODE_STANDBY)
1186 count += scnprintf(buf + count, len - count, "standby ");
1187
1188 if (constraints->pw_budget_mW)
1189 count += scnprintf(buf + count, len - count, "%d mW budget ",
1190 constraints->pw_budget_mW);
1191
1192 if (!count)
1193 count = scnprintf(buf, len, "no parameters");
1194 else
1195 --count;
1196
1197 count += scnprintf(buf + count, len - count, ", %s",
1198 _regulator_is_enabled(rdev) ? "enabled" : "disabled");
1199
1200 rdev_dbg(rdev, "%s\n", buf);
1201 }
1202 #else /* !DEBUG && !CONFIG_DYNAMIC_DEBUG */
print_constraints_debug(struct regulator_dev * rdev)1203 static inline void print_constraints_debug(struct regulator_dev *rdev) {}
1204 #endif /* !DEBUG && !CONFIG_DYNAMIC_DEBUG */
1205
print_constraints(struct regulator_dev * rdev)1206 static void print_constraints(struct regulator_dev *rdev)
1207 {
1208 struct regulation_constraints *constraints = rdev->constraints;
1209
1210 print_constraints_debug(rdev);
1211
1212 if ((constraints->min_uV != constraints->max_uV) &&
1213 !regulator_ops_is_valid(rdev, REGULATOR_CHANGE_VOLTAGE))
1214 rdev_warn(rdev,
1215 "Voltage range but no REGULATOR_CHANGE_VOLTAGE\n");
1216 }
1217
machine_constraints_voltage(struct regulator_dev * rdev,struct regulation_constraints * constraints)1218 static int machine_constraints_voltage(struct regulator_dev *rdev,
1219 struct regulation_constraints *constraints)
1220 {
1221 const struct regulator_ops *ops = rdev->desc->ops;
1222 int ret;
1223
1224 /* do we need to apply the constraint voltage */
1225 if (rdev->constraints->apply_uV &&
1226 rdev->constraints->min_uV && rdev->constraints->max_uV) {
1227 int target_min, target_max;
1228 int current_uV = regulator_get_voltage_rdev(rdev);
1229
1230 if (current_uV == -ENOTRECOVERABLE) {
1231 /* This regulator can't be read and must be initialized */
1232 rdev_info(rdev, "Setting %d-%duV\n",
1233 rdev->constraints->min_uV,
1234 rdev->constraints->max_uV);
1235 _regulator_do_set_voltage(rdev,
1236 rdev->constraints->min_uV,
1237 rdev->constraints->max_uV);
1238 current_uV = regulator_get_voltage_rdev(rdev);
1239 }
1240
1241 if (current_uV < 0) {
1242 if (current_uV != -EPROBE_DEFER)
1243 rdev_err(rdev,
1244 "failed to get the current voltage: %pe\n",
1245 ERR_PTR(current_uV));
1246 return current_uV;
1247 }
1248
1249 /*
1250 * If we're below the minimum voltage move up to the
1251 * minimum voltage, if we're above the maximum voltage
1252 * then move down to the maximum.
1253 */
1254 target_min = current_uV;
1255 target_max = current_uV;
1256
1257 if (current_uV < rdev->constraints->min_uV) {
1258 target_min = rdev->constraints->min_uV;
1259 target_max = rdev->constraints->min_uV;
1260 }
1261
1262 if (current_uV > rdev->constraints->max_uV) {
1263 target_min = rdev->constraints->max_uV;
1264 target_max = rdev->constraints->max_uV;
1265 }
1266
1267 if (target_min != current_uV || target_max != current_uV) {
1268 rdev_info(rdev, "Bringing %duV into %d-%duV\n",
1269 current_uV, target_min, target_max);
1270 ret = _regulator_do_set_voltage(
1271 rdev, target_min, target_max);
1272 if (ret < 0) {
1273 rdev_err(rdev,
1274 "failed to apply %d-%duV constraint: %pe\n",
1275 target_min, target_max, ERR_PTR(ret));
1276 return ret;
1277 }
1278 }
1279 }
1280
1281 /* constrain machine-level voltage specs to fit
1282 * the actual range supported by this regulator.
1283 */
1284 if (ops->list_voltage && rdev->desc->n_voltages) {
1285 int count = rdev->desc->n_voltages;
1286 int i;
1287 int min_uV = INT_MAX;
1288 int max_uV = INT_MIN;
1289 int cmin = constraints->min_uV;
1290 int cmax = constraints->max_uV;
1291
1292 /* it's safe to autoconfigure fixed-voltage supplies
1293 * and the constraints are used by list_voltage.
1294 */
1295 if (count == 1 && !cmin) {
1296 cmin = 1;
1297 cmax = INT_MAX;
1298 constraints->min_uV = cmin;
1299 constraints->max_uV = cmax;
1300 }
1301
1302 /* voltage constraints are optional */
1303 if ((cmin == 0) && (cmax == 0))
1304 return 0;
1305
1306 /* else require explicit machine-level constraints */
1307 if (cmin <= 0 || cmax <= 0 || cmax < cmin) {
1308 rdev_err(rdev, "invalid voltage constraints\n");
1309 return -EINVAL;
1310 }
1311
1312 /* no need to loop voltages if range is continuous */
1313 if (rdev->desc->continuous_voltage_range)
1314 return 0;
1315
1316 /* initial: [cmin..cmax] valid, [min_uV..max_uV] not */
1317 for (i = 0; i < count; i++) {
1318 int value;
1319
1320 value = ops->list_voltage(rdev, i);
1321 if (value <= 0)
1322 continue;
1323
1324 /* maybe adjust [min_uV..max_uV] */
1325 if (value >= cmin && value < min_uV)
1326 min_uV = value;
1327 if (value <= cmax && value > max_uV)
1328 max_uV = value;
1329 }
1330
1331 /* final: [min_uV..max_uV] valid iff constraints valid */
1332 if (max_uV < min_uV) {
1333 rdev_err(rdev,
1334 "unsupportable voltage constraints %u-%uuV\n",
1335 min_uV, max_uV);
1336 return -EINVAL;
1337 }
1338
1339 /* use regulator's subset of machine constraints */
1340 if (constraints->min_uV < min_uV) {
1341 rdev_dbg(rdev, "override min_uV, %d -> %d\n",
1342 constraints->min_uV, min_uV);
1343 constraints->min_uV = min_uV;
1344 }
1345 if (constraints->max_uV > max_uV) {
1346 rdev_dbg(rdev, "override max_uV, %d -> %d\n",
1347 constraints->max_uV, max_uV);
1348 constraints->max_uV = max_uV;
1349 }
1350 }
1351
1352 return 0;
1353 }
1354
machine_constraints_current(struct regulator_dev * rdev,struct regulation_constraints * constraints)1355 static int machine_constraints_current(struct regulator_dev *rdev,
1356 struct regulation_constraints *constraints)
1357 {
1358 const struct regulator_ops *ops = rdev->desc->ops;
1359 int ret;
1360
1361 if (!constraints->min_uA && !constraints->max_uA)
1362 return 0;
1363
1364 if (constraints->min_uA > constraints->max_uA) {
1365 rdev_err(rdev, "Invalid current constraints\n");
1366 return -EINVAL;
1367 }
1368
1369 if (!ops->set_current_limit || !ops->get_current_limit) {
1370 rdev_warn(rdev, "Operation of current configuration missing\n");
1371 return 0;
1372 }
1373
1374 /* Set regulator current in constraints range */
1375 ret = ops->set_current_limit(rdev, constraints->min_uA,
1376 constraints->max_uA);
1377 if (ret < 0) {
1378 rdev_err(rdev, "Failed to set current constraint, %d\n", ret);
1379 return ret;
1380 }
1381
1382 return 0;
1383 }
1384
1385 static int _regulator_do_enable(struct regulator_dev *rdev);
1386
notif_set_limit(struct regulator_dev * rdev,int (* set)(struct regulator_dev *,int,int,bool),int limit,int severity)1387 static int notif_set_limit(struct regulator_dev *rdev,
1388 int (*set)(struct regulator_dev *, int, int, bool),
1389 int limit, int severity)
1390 {
1391 bool enable;
1392
1393 if (limit == REGULATOR_NOTIF_LIMIT_DISABLE) {
1394 enable = false;
1395 limit = 0;
1396 } else {
1397 enable = true;
1398 }
1399
1400 if (limit == REGULATOR_NOTIF_LIMIT_ENABLE)
1401 limit = 0;
1402
1403 return set(rdev, limit, severity, enable);
1404 }
1405
handle_notify_limits(struct regulator_dev * rdev,int (* set)(struct regulator_dev *,int,int,bool),struct notification_limit * limits)1406 static int handle_notify_limits(struct regulator_dev *rdev,
1407 int (*set)(struct regulator_dev *, int, int, bool),
1408 struct notification_limit *limits)
1409 {
1410 int ret = 0;
1411
1412 if (!set)
1413 return -EOPNOTSUPP;
1414
1415 if (limits->prot)
1416 ret = notif_set_limit(rdev, set, limits->prot,
1417 REGULATOR_SEVERITY_PROT);
1418 if (ret)
1419 return ret;
1420
1421 if (limits->err)
1422 ret = notif_set_limit(rdev, set, limits->err,
1423 REGULATOR_SEVERITY_ERR);
1424 if (ret)
1425 return ret;
1426
1427 if (limits->warn)
1428 ret = notif_set_limit(rdev, set, limits->warn,
1429 REGULATOR_SEVERITY_WARN);
1430
1431 return ret;
1432 }
1433 /**
1434 * set_machine_constraints - sets regulator constraints
1435 * @rdev: regulator source
1436 * @is_locked: whether or not this is called with locks held already
1437 *
1438 * Allows platform initialisation code to define and constrain
1439 * regulator circuits e.g. valid voltage/current ranges, etc. NOTE:
1440 * Constraints *must* be set by platform code in order for some
1441 * regulator operations to proceed i.e. set_voltage, set_current_limit,
1442 * set_mode.
1443 *
1444 * Return: 0 on success or a negative error number on failure.
1445 */
set_machine_constraints(struct regulator_dev * rdev,bool is_locked)1446 static int set_machine_constraints(struct regulator_dev *rdev,
1447 bool is_locked)
1448 {
1449 int ret = 0;
1450 const struct regulator_ops *ops = rdev->desc->ops;
1451
1452 /*
1453 * If there is no mechanism for controlling the regulator then
1454 * flag it as always_on so we don't end up duplicating checks
1455 * for this so much. Note that we could control the state of
1456 * a supply to control the output on a regulator that has no
1457 * direct control.
1458 */
1459 if (!rdev->ena_pin && !ops->enable) {
1460 if (rdev->supply_name && !rdev->supply)
1461 return -EPROBE_DEFER;
1462
1463 if (rdev->supply)
1464 rdev->constraints->always_on =
1465 rdev->supply->rdev->constraints->always_on;
1466 else
1467 rdev->constraints->always_on = true;
1468 }
1469
1470 /*
1471 * If we want to enable this regulator, make sure that we know the
1472 * supplying regulator.
1473 */
1474 if (rdev->constraints->always_on || rdev->constraints->boot_on) {
1475 if (rdev->supply_name && !rdev->supply)
1476 return -EPROBE_DEFER;
1477 }
1478
1479 ret = machine_constraints_voltage(rdev, rdev->constraints);
1480 if (ret != 0)
1481 return ret;
1482
1483 ret = machine_constraints_current(rdev, rdev->constraints);
1484 if (ret != 0)
1485 return ret;
1486
1487 if (rdev->constraints->ilim_uA && ops->set_input_current_limit) {
1488 ret = ops->set_input_current_limit(rdev,
1489 rdev->constraints->ilim_uA);
1490 if (ret < 0) {
1491 rdev_err(rdev, "failed to set input limit: %pe\n", ERR_PTR(ret));
1492 return ret;
1493 }
1494 }
1495
1496 /* do we need to setup our suspend state */
1497 if (rdev->constraints->initial_state) {
1498 ret = suspend_set_initial_state(rdev);
1499 if (ret < 0) {
1500 rdev_err(rdev, "failed to set suspend state: %pe\n", ERR_PTR(ret));
1501 return ret;
1502 }
1503 }
1504
1505 if (rdev->constraints->initial_mode) {
1506 if (!ops->set_mode) {
1507 rdev_err(rdev, "no set_mode operation\n");
1508 return -EINVAL;
1509 }
1510
1511 ret = ops->set_mode(rdev, rdev->constraints->initial_mode);
1512 if (ret < 0) {
1513 rdev_err(rdev, "failed to set initial mode: %pe\n", ERR_PTR(ret));
1514 return ret;
1515 }
1516 } else if (rdev->constraints->system_load) {
1517 /*
1518 * We'll only apply the initial system load if an
1519 * initial mode wasn't specified.
1520 */
1521 drms_uA_update(rdev);
1522 }
1523
1524 if ((rdev->constraints->ramp_delay || rdev->constraints->ramp_disable)
1525 && ops->set_ramp_delay) {
1526 ret = ops->set_ramp_delay(rdev, rdev->constraints->ramp_delay);
1527 if (ret < 0) {
1528 rdev_err(rdev, "failed to set ramp_delay: %pe\n", ERR_PTR(ret));
1529 return ret;
1530 }
1531 }
1532
1533 if (rdev->constraints->pull_down && ops->set_pull_down) {
1534 ret = ops->set_pull_down(rdev);
1535 if (ret < 0) {
1536 rdev_err(rdev, "failed to set pull down: %pe\n", ERR_PTR(ret));
1537 return ret;
1538 }
1539 }
1540
1541 if (rdev->constraints->soft_start && ops->set_soft_start) {
1542 ret = ops->set_soft_start(rdev);
1543 if (ret < 0) {
1544 rdev_err(rdev, "failed to set soft start: %pe\n", ERR_PTR(ret));
1545 return ret;
1546 }
1547 }
1548
1549 /*
1550 * Existing logic does not warn if over_current_protection is given as
1551 * a constraint but driver does not support that. I think we should
1552 * warn about this type of issues as it is possible someone changes
1553 * PMIC on board to another type - and the another PMIC's driver does
1554 * not support setting protection. Board composer may happily believe
1555 * the DT limits are respected - especially if the new PMIC HW also
1556 * supports protection but the driver does not. I won't change the logic
1557 * without hearing more experienced opinion on this though.
1558 *
1559 * If warning is seen as a good idea then we can merge handling the
1560 * over-curret protection and detection and get rid of this special
1561 * handling.
1562 */
1563 if (rdev->constraints->over_current_protection
1564 && ops->set_over_current_protection) {
1565 int lim = rdev->constraints->over_curr_limits.prot;
1566
1567 ret = ops->set_over_current_protection(rdev, lim,
1568 REGULATOR_SEVERITY_PROT,
1569 true);
1570 if (ret < 0) {
1571 rdev_err(rdev, "failed to set over current protection: %pe\n",
1572 ERR_PTR(ret));
1573 return ret;
1574 }
1575 }
1576
1577 if (rdev->constraints->over_current_detection)
1578 ret = handle_notify_limits(rdev,
1579 ops->set_over_current_protection,
1580 &rdev->constraints->over_curr_limits);
1581 if (ret) {
1582 if (ret != -EOPNOTSUPP) {
1583 rdev_err(rdev, "failed to set over current limits: %pe\n",
1584 ERR_PTR(ret));
1585 return ret;
1586 }
1587 rdev_warn(rdev,
1588 "IC does not support requested over-current limits\n");
1589 }
1590
1591 if (rdev->constraints->over_voltage_detection)
1592 ret = handle_notify_limits(rdev,
1593 ops->set_over_voltage_protection,
1594 &rdev->constraints->over_voltage_limits);
1595 if (ret) {
1596 if (ret != -EOPNOTSUPP) {
1597 rdev_err(rdev, "failed to set over voltage limits %pe\n",
1598 ERR_PTR(ret));
1599 return ret;
1600 }
1601 rdev_warn(rdev,
1602 "IC does not support requested over voltage limits\n");
1603 }
1604
1605 if (rdev->constraints->under_voltage_detection)
1606 ret = handle_notify_limits(rdev,
1607 ops->set_under_voltage_protection,
1608 &rdev->constraints->under_voltage_limits);
1609 if (ret) {
1610 if (ret != -EOPNOTSUPP) {
1611 rdev_err(rdev, "failed to set under voltage limits %pe\n",
1612 ERR_PTR(ret));
1613 return ret;
1614 }
1615 rdev_warn(rdev,
1616 "IC does not support requested under voltage limits\n");
1617 }
1618
1619 if (rdev->constraints->over_temp_detection)
1620 ret = handle_notify_limits(rdev,
1621 ops->set_thermal_protection,
1622 &rdev->constraints->temp_limits);
1623 if (ret) {
1624 if (ret != -EOPNOTSUPP) {
1625 rdev_err(rdev, "failed to set temperature limits %pe\n",
1626 ERR_PTR(ret));
1627 return ret;
1628 }
1629 rdev_warn(rdev,
1630 "IC does not support requested temperature limits\n");
1631 }
1632
1633 if (rdev->constraints->active_discharge && ops->set_active_discharge) {
1634 bool ad_state = rdev->constraints->active_discharge ==
1635 REGULATOR_ACTIVE_DISCHARGE_ENABLE;
1636
1637 ret = ops->set_active_discharge(rdev, ad_state);
1638 if (ret < 0) {
1639 rdev_err(rdev, "failed to set active discharge: %pe\n", ERR_PTR(ret));
1640 return ret;
1641 }
1642 }
1643
1644 /* If the constraints say the regulator should be on at this point
1645 * and we have control then make sure it is enabled.
1646 */
1647 if (rdev->constraints->always_on || rdev->constraints->boot_on) {
1648 bool supply_enabled = false;
1649
1650 /* We have ensured a potential supply has been resolved above.
1651 *
1652 * If supplying regulator has already been enabled,
1653 * it's not intended to have use_count increment
1654 * when rdev is only boot-on.
1655 */
1656 if (rdev->supply &&
1657 (rdev->constraints->always_on ||
1658 !regulator_is_enabled(rdev->supply))) {
1659 ret = (is_locked
1660 ? _regulator_enable(rdev->supply)
1661 : regulator_enable(rdev->supply));
1662 if (ret < 0) {
1663 _regulator_put(rdev->supply);
1664 rdev->supply = NULL;
1665 return ret;
1666 }
1667 supply_enabled = true;
1668 }
1669
1670 ret = _regulator_do_enable(rdev);
1671 if (ret < 0 && ret != -EINVAL) {
1672 rdev_err(rdev, "failed to enable: %pe\n", ERR_PTR(ret));
1673 if (supply_enabled)
1674 regulator_disable(rdev->supply);
1675 return ret;
1676 }
1677
1678 if (rdev->constraints->always_on)
1679 rdev->use_count++;
1680 } else if (rdev->desc->off_on_delay) {
1681 rdev->last_off = ktime_get();
1682 }
1683
1684 if (!rdev->constraints->pw_budget_mW)
1685 rdev->constraints->pw_budget_mW = INT_MAX;
1686
1687 print_constraints(rdev);
1688 return 0;
1689 }
1690
1691 /**
1692 * regulator_event_work_fn - process a deferred regulator event
1693 * @work: work_struct queued by the notifier
1694 *
1695 * Calls the regulator's notifier chain in process context while holding
1696 * the rdev lock, then releases the device reference.
1697 */
regulator_event_work_fn(struct work_struct * work)1698 static void regulator_event_work_fn(struct work_struct *work)
1699 {
1700 struct regulator_event_work *rew =
1701 container_of(work, struct regulator_event_work, work);
1702 struct regulator_dev *rdev = rew->rdev;
1703 int ret;
1704
1705 regulator_lock(rdev);
1706 ret = regulator_notifier_call_chain(rdev, rew->event, NULL);
1707 regulator_unlock(rdev);
1708 if (ret == NOTIFY_BAD)
1709 dev_err(rdev_get_dev(rdev), "failed to forward regulator event\n");
1710
1711 put_device(rdev_get_dev(rdev));
1712 kfree(rew);
1713 }
1714
1715 /**
1716 * regulator_event_forward_notifier - notifier callback for supply events
1717 * @nb: notifier block embedded in the regulator
1718 * @event: regulator event code
1719 * @data: unused
1720 *
1721 * Packages the event into a work item and schedules it in process context.
1722 * Takes a reference on @rdev->dev to pin the regulator until the work
1723 * completes (see put_device() in the worker).
1724 *
1725 * Return: NOTIFY_OK on success, NOTIFY_DONE for events that are not forwarded.
1726 */
regulator_event_forward_notifier(struct notifier_block * nb,unsigned long event,void __always_unused * data)1727 static int regulator_event_forward_notifier(struct notifier_block *nb,
1728 unsigned long event,
1729 void __always_unused *data)
1730 {
1731 struct regulator_dev *rdev = container_of(nb, struct regulator_dev,
1732 supply_fwd_nb);
1733 struct regulator_event_work *rew;
1734
1735 switch (event) {
1736 case REGULATOR_EVENT_UNDER_VOLTAGE:
1737 break;
1738 default:
1739 /* Only forward allowed events downstream. */
1740 return NOTIFY_DONE;
1741 }
1742
1743 rew = kmalloc_obj(*rew, GFP_ATOMIC);
1744 if (!rew)
1745 return NOTIFY_DONE;
1746
1747 get_device(rdev_get_dev(rdev));
1748 rew->rdev = rdev;
1749 rew->event = event;
1750 INIT_WORK(&rew->work, regulator_event_work_fn);
1751
1752 queue_work(system_highpri_wq, &rew->work);
1753
1754 return NOTIFY_OK;
1755 }
1756
1757 /**
1758 * register_regulator_event_forwarding - enable supply event forwarding
1759 * @rdev: regulator device
1760 *
1761 * Registers a notifier on the regulator's supply so that supply events
1762 * are forwarded to the consumer regulator via the deferred work handler.
1763 *
1764 * Return: 0 on success, -EALREADY if already enabled, or a negative error code.
1765 */
register_regulator_event_forwarding(struct regulator_dev * rdev)1766 static int register_regulator_event_forwarding(struct regulator_dev *rdev)
1767 {
1768 int ret;
1769
1770 if (!rdev->supply)
1771 return 0; /* top-level regulator: nothing to forward */
1772
1773 if (rdev->supply_fwd_nb.notifier_call)
1774 return -EALREADY;
1775
1776 rdev->supply_fwd_nb.notifier_call = regulator_event_forward_notifier;
1777
1778 ret = regulator_register_notifier(rdev->supply, &rdev->supply_fwd_nb);
1779 if (ret) {
1780 dev_err(&rdev->dev, "failed to register supply notifier: %pe\n",
1781 ERR_PTR(ret));
1782 rdev->supply_fwd_nb.notifier_call = NULL;
1783 return ret;
1784 }
1785
1786 return 0;
1787 }
1788
unregister_regulator_event_forwarding(struct regulator_dev * rdev)1789 static void unregister_regulator_event_forwarding(struct regulator_dev *rdev)
1790 {
1791 if (!rdev->supply_fwd_nb.notifier_call)
1792 return;
1793
1794 regulator_unregister_notifier(rdev->supply, &rdev->supply_fwd_nb);
1795 rdev->supply_fwd_nb.notifier_call = NULL;
1796 }
1797
1798 /**
1799 * set_supply - set regulator supply regulator
1800 * @rdev: regulator (locked)
1801 * @supply_rdev: supply regulator (locked))
1802 *
1803 * Called by platform initialisation code to set the supply regulator for this
1804 * regulator. This ensures that a regulators supply will also be enabled by the
1805 * core if it's child is enabled.
1806 *
1807 * Return: 0 on success or a negative error number on failure.
1808 */
set_supply(struct regulator_dev * rdev,struct regulator_dev * supply_rdev)1809 static int set_supply(struct regulator_dev *rdev,
1810 struct regulator_dev *supply_rdev)
1811 {
1812 int err;
1813
1814 rdev_dbg(rdev, "supplied by %s\n", rdev_get_name(supply_rdev));
1815
1816 if (!try_module_get(supply_rdev->owner))
1817 return -ENODEV;
1818
1819 rdev->supply = create_regulator(supply_rdev, &rdev->dev, "SUPPLY");
1820 if (rdev->supply == NULL) {
1821 module_put(supply_rdev->owner);
1822 err = -ENOMEM;
1823 return err;
1824 }
1825 supply_rdev->open_count++;
1826
1827 return 0;
1828 }
1829
1830 /**
1831 * set_consumer_device_supply - Bind a regulator to a symbolic supply
1832 * @rdev: regulator source
1833 * @consumer_dev_name: dev_name() string for device supply applies to
1834 * @supply: symbolic name for supply
1835 *
1836 * Allows platform initialisation code to map physical regulator
1837 * sources to symbolic names for supplies for use by devices. Devices
1838 * should use these symbolic names to request regulators, avoiding the
1839 * need to provide board-specific regulator names as platform data.
1840 *
1841 * Return: 0 on success or a negative error number on failure.
1842 */
set_consumer_device_supply(struct regulator_dev * rdev,const char * consumer_dev_name,const char * supply)1843 static int set_consumer_device_supply(struct regulator_dev *rdev,
1844 const char *consumer_dev_name,
1845 const char *supply)
1846 {
1847 struct regulator_map *node, *new_node;
1848 int has_dev;
1849
1850 if (supply == NULL)
1851 return -EINVAL;
1852
1853 if (consumer_dev_name != NULL)
1854 has_dev = 1;
1855 else
1856 has_dev = 0;
1857
1858 new_node = kzalloc_obj(struct regulator_map);
1859 if (new_node == NULL)
1860 return -ENOMEM;
1861
1862 new_node->regulator = rdev;
1863 new_node->supply = supply;
1864
1865 if (has_dev) {
1866 new_node->dev_name = kstrdup(consumer_dev_name, GFP_KERNEL);
1867 if (new_node->dev_name == NULL) {
1868 kfree(new_node);
1869 return -ENOMEM;
1870 }
1871 }
1872
1873 mutex_lock(®ulator_list_mutex);
1874 list_for_each_entry(node, ®ulator_map_list, list) {
1875 if (node->dev_name && consumer_dev_name) {
1876 if (strcmp(node->dev_name, consumer_dev_name) != 0)
1877 continue;
1878 } else if (node->dev_name || consumer_dev_name) {
1879 continue;
1880 }
1881
1882 if (strcmp(node->supply, supply) != 0)
1883 continue;
1884
1885 pr_debug("%s: %s/%s is '%s' supply; fail %s/%s\n",
1886 consumer_dev_name,
1887 dev_name(&node->regulator->dev),
1888 node->regulator->desc->name,
1889 supply,
1890 dev_name(&rdev->dev), rdev_get_name(rdev));
1891 goto fail;
1892 }
1893
1894 list_add(&new_node->list, ®ulator_map_list);
1895 mutex_unlock(®ulator_list_mutex);
1896
1897 return 0;
1898
1899 fail:
1900 mutex_unlock(®ulator_list_mutex);
1901 kfree(new_node->dev_name);
1902 kfree(new_node);
1903 return -EBUSY;
1904 }
1905
unset_regulator_supplies(struct regulator_dev * rdev)1906 static void unset_regulator_supplies(struct regulator_dev *rdev)
1907 {
1908 struct regulator_map *node, *n;
1909
1910 list_for_each_entry_safe(node, n, ®ulator_map_list, list) {
1911 if (rdev == node->regulator) {
1912 list_del(&node->list);
1913 kfree(node->dev_name);
1914 kfree(node);
1915 }
1916 }
1917 }
1918
1919 #ifdef CONFIG_DEBUG_FS
constraint_flags_read_file(struct file * file,char __user * user_buf,size_t count,loff_t * ppos)1920 static ssize_t constraint_flags_read_file(struct file *file,
1921 char __user *user_buf,
1922 size_t count, loff_t *ppos)
1923 {
1924 const struct regulator *regulator = file->private_data;
1925 const struct regulation_constraints *c = regulator->rdev->constraints;
1926 char *buf;
1927 ssize_t ret;
1928
1929 if (!c)
1930 return 0;
1931
1932 buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
1933 if (!buf)
1934 return -ENOMEM;
1935
1936 ret = snprintf(buf, PAGE_SIZE,
1937 "always_on: %u\n"
1938 "boot_on: %u\n"
1939 "apply_uV: %u\n"
1940 "ramp_disable: %u\n"
1941 "soft_start: %u\n"
1942 "pull_down: %u\n"
1943 "over_current_protection: %u\n",
1944 c->always_on,
1945 c->boot_on,
1946 c->apply_uV,
1947 c->ramp_disable,
1948 c->soft_start,
1949 c->pull_down,
1950 c->over_current_protection);
1951
1952 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
1953 kfree(buf);
1954
1955 return ret;
1956 }
1957
1958 #endif
1959
1960 static const struct file_operations constraint_flags_fops = {
1961 #ifdef CONFIG_DEBUG_FS
1962 .open = simple_open,
1963 .read = constraint_flags_read_file,
1964 .llseek = default_llseek,
1965 #endif
1966 };
1967
link_and_create_debugfs(struct regulator * regulator,struct regulator_dev * rdev,struct device * dev)1968 static void link_and_create_debugfs(struct regulator *regulator, struct regulator_dev *rdev,
1969 struct device *dev)
1970 {
1971 int err = 0;
1972
1973 if (dev) {
1974 regulator->dev = dev;
1975
1976 /* Add a link to the device sysfs entry */
1977 err = sysfs_create_link_nowarn(&rdev->dev.kobj, &dev->kobj,
1978 regulator->supply_name);
1979 if (err) {
1980 rdev_dbg(rdev, "could not add device link %s: %pe\n",
1981 dev->kobj.name, ERR_PTR(err));
1982 /* non-fatal */
1983 }
1984 }
1985
1986 if (err != -EEXIST) {
1987 regulator->debugfs = debugfs_create_dir(regulator->supply_name, rdev->debugfs);
1988 if (IS_ERR(regulator->debugfs)) {
1989 rdev_dbg(rdev, "Failed to create debugfs directory\n");
1990 regulator->debugfs = NULL;
1991 }
1992 }
1993
1994 if (regulator->debugfs) {
1995 debugfs_create_u32("uA_load", 0444, regulator->debugfs,
1996 ®ulator->uA_load);
1997 debugfs_create_u32("min_uV", 0444, regulator->debugfs,
1998 ®ulator->voltage[PM_SUSPEND_ON].min_uV);
1999 debugfs_create_u32("max_uV", 0444, regulator->debugfs,
2000 ®ulator->voltage[PM_SUSPEND_ON].max_uV);
2001 debugfs_create_file("constraint_flags", 0444, regulator->debugfs,
2002 regulator, &constraint_flags_fops);
2003 }
2004 }
2005
create_regulator(struct regulator_dev * rdev,struct device * dev,const char * supply_name)2006 static struct regulator *create_regulator(struct regulator_dev *rdev,
2007 struct device *dev,
2008 const char *supply_name)
2009 {
2010 struct regulator *regulator;
2011
2012 lockdep_assert_held_once(&rdev->mutex.base);
2013
2014 if (dev) {
2015 supply_name = kasprintf(GFP_KERNEL, "%s-%s", dev->kobj.name, supply_name);
2016 if (supply_name == NULL)
2017 return NULL;
2018 } else {
2019 supply_name = kstrdup_const(supply_name, GFP_KERNEL);
2020 if (supply_name == NULL)
2021 return NULL;
2022 }
2023
2024 regulator = kzalloc_obj(*regulator);
2025 if (regulator == NULL) {
2026 kfree_const(supply_name);
2027 return NULL;
2028 }
2029
2030 regulator->rdev = rdev;
2031 regulator->supply_name = supply_name;
2032
2033 list_add(®ulator->list, &rdev->consumer_list);
2034
2035 /*
2036 * Check now if the regulator is an always on regulator - if
2037 * it is then we don't need to do nearly so much work for
2038 * enable/disable calls.
2039 */
2040 if (!regulator_ops_is_valid(rdev, REGULATOR_CHANGE_STATUS) &&
2041 _regulator_is_enabled(rdev))
2042 regulator->always_on = true;
2043
2044 return regulator;
2045 }
2046
_regulator_get_enable_time(struct regulator_dev * rdev)2047 static int _regulator_get_enable_time(struct regulator_dev *rdev)
2048 {
2049 if (rdev->constraints && rdev->constraints->enable_time)
2050 return rdev->constraints->enable_time;
2051 if (rdev->desc->ops->enable_time)
2052 return rdev->desc->ops->enable_time(rdev);
2053 return rdev->desc->enable_time;
2054 }
2055
regulator_find_supply_alias(struct device * dev,const char * supply)2056 static struct regulator_supply_alias *regulator_find_supply_alias(
2057 struct device *dev, const char *supply)
2058 {
2059 struct regulator_supply_alias *map;
2060
2061 list_for_each_entry(map, ®ulator_supply_alias_list, list)
2062 if (map->src_dev == dev && strcmp(map->src_supply, supply) == 0)
2063 return map;
2064
2065 return NULL;
2066 }
2067
regulator_supply_alias(struct device ** dev,const char ** supply)2068 static void regulator_supply_alias(struct device **dev, const char **supply)
2069 {
2070 struct regulator_supply_alias *map;
2071
2072 mutex_lock(®ulator_list_mutex);
2073 map = regulator_find_supply_alias(*dev, *supply);
2074 if (map) {
2075 dev_dbg(*dev, "Mapping supply %s to %s,%s\n",
2076 *supply, map->alias_supply,
2077 dev_name(map->alias_dev));
2078 *dev = map->alias_dev;
2079 *supply = map->alias_supply;
2080 }
2081 mutex_unlock(®ulator_list_mutex);
2082 }
2083
regulator_match(struct device * dev,const void * data)2084 static int regulator_match(struct device *dev, const void *data)
2085 {
2086 struct regulator_dev *r = dev_to_rdev(dev);
2087
2088 return strcmp(rdev_get_name(r), data) == 0;
2089 }
2090
regulator_lookup_by_name(const char * name)2091 static struct regulator_dev *regulator_lookup_by_name(const char *name)
2092 {
2093 struct device *dev;
2094
2095 dev = class_find_device(®ulator_class, NULL, name, regulator_match);
2096
2097 return dev ? dev_to_rdev(dev) : NULL;
2098 }
2099
regulator_dt_lookup(struct device * dev,const char * supply)2100 static struct regulator_dev *regulator_dt_lookup(struct device *dev,
2101 const char *supply)
2102 {
2103 struct regulator_dev *r = NULL;
2104
2105 if (dev_of_node(dev)) {
2106 r = of_regulator_dev_lookup(dev, dev_of_node(dev), supply);
2107 if (PTR_ERR(r) == -ENODEV)
2108 r = NULL;
2109 }
2110
2111 return r;
2112 }
2113
2114 /**
2115 * regulator_dev_lookup - lookup a regulator device.
2116 * @dev: device for regulator "consumer".
2117 * @supply: Supply name or regulator ID.
2118 *
2119 * Return: pointer to &struct regulator_dev or ERR_PTR() encoded negative error number.
2120 *
2121 * If successful, returns a struct regulator_dev that corresponds to the name
2122 * @supply and with the embedded struct device refcount incremented by one.
2123 * The refcount must be dropped by calling put_device().
2124 * On failure one of the following ERR_PTR() encoded values is returned:
2125 * -%ENODEV if lookup fails permanently, -%EPROBE_DEFER if lookup could succeed
2126 * in the future.
2127 */
regulator_dev_lookup(struct device * dev,const char * supply)2128 static struct regulator_dev *regulator_dev_lookup(struct device *dev,
2129 const char *supply)
2130 {
2131 struct regulator_dev *r = NULL;
2132 struct regulator_map *map;
2133 const char *devname = NULL;
2134
2135 regulator_supply_alias(&dev, &supply);
2136
2137 /* first do a dt based lookup */
2138 r = regulator_dt_lookup(dev, supply);
2139 if (r)
2140 return r;
2141
2142 /* if not found, try doing it non-dt way */
2143 if (dev)
2144 devname = dev_name(dev);
2145
2146 mutex_lock(®ulator_list_mutex);
2147 list_for_each_entry(map, ®ulator_map_list, list) {
2148 /* If the mapping has a device set up it must match */
2149 if (map->dev_name &&
2150 (!devname || strcmp(map->dev_name, devname)))
2151 continue;
2152
2153 if (strcmp(map->supply, supply) == 0 &&
2154 get_device(&map->regulator->dev)) {
2155 r = map->regulator;
2156 break;
2157 }
2158 }
2159 mutex_unlock(®ulator_list_mutex);
2160
2161 if (r)
2162 return r;
2163
2164 r = regulator_lookup_by_name(supply);
2165 if (r)
2166 return r;
2167
2168 return ERR_PTR(-ENODEV);
2169 }
2170
regulator_resolve_supply(struct regulator_dev * rdev)2171 static int regulator_resolve_supply(struct regulator_dev *rdev)
2172 {
2173 struct regulator_dev *r;
2174 struct device *dev = rdev->dev.parent;
2175 struct ww_acquire_ctx ww_ctx;
2176 struct regulator *supply;
2177 bool do_final_setup;
2178 int ret = 0;
2179
2180 /* No supply to resolve? */
2181 if (!rdev->supply_name)
2182 return 0;
2183
2184 /* Supply already resolved? (fast-path without locking contention) */
2185 if (rdev->supply && !rdev->constraints_pending)
2186 return 0;
2187
2188 /* first do a dt based lookup on the node described in the virtual
2189 * device.
2190 */
2191 r = regulator_dt_lookup(&rdev->dev, rdev->supply_name);
2192
2193 /* If regulator not found use usual search path in the parent
2194 * device.
2195 */
2196 if (!r)
2197 r = regulator_dev_lookup(dev, rdev->supply_name);
2198
2199 if (IS_ERR(r)) {
2200 ret = PTR_ERR(r);
2201
2202 /* Did the lookup explicitly defer for us? */
2203 if (ret == -EPROBE_DEFER)
2204 goto out;
2205
2206 if (have_full_constraints()) {
2207 r = dummy_regulator_rdev;
2208 if (!r) {
2209 ret = -EPROBE_DEFER;
2210 goto out;
2211 }
2212 get_device(&r->dev);
2213 } else {
2214 dev_err(dev, "Failed to resolve %s-supply for %s\n",
2215 rdev->supply_name, rdev->desc->name);
2216 ret = -EPROBE_DEFER;
2217 goto out;
2218 }
2219 }
2220
2221 if (r == rdev) {
2222 dev_err(dev, "Supply for %s (%s) resolved to itself\n",
2223 rdev->desc->name, rdev->supply_name);
2224 if (!have_full_constraints()) {
2225 ret = -EINVAL;
2226 goto out;
2227 }
2228 r = dummy_regulator_rdev;
2229 if (!r) {
2230 ret = -EPROBE_DEFER;
2231 goto out;
2232 }
2233 get_device(&r->dev);
2234 }
2235
2236 /*
2237 * If the supply's parent device is not the same as the
2238 * regulator's parent device, then ensure the parent device
2239 * is bound before we resolve the supply, in case the parent
2240 * device get probe deferred and unregisters the supply.
2241 */
2242 if (r->dev.parent && r->dev.parent != rdev->dev.parent) {
2243 if (!device_is_bound(r->dev.parent)) {
2244 put_device(&r->dev);
2245 ret = -EPROBE_DEFER;
2246 goto out;
2247 }
2248 }
2249
2250 /* Recursively resolve the supply of the supply */
2251 ret = regulator_resolve_supply(r);
2252 if (ret < 0) {
2253 put_device(&r->dev);
2254 goto out;
2255 }
2256
2257 /*
2258 * Recheck rdev->supply with rdev->mutex lock held to avoid a race
2259 * between rdev->supply null check and setting rdev->supply in
2260 * set_supply() from concurrent tasks.
2261 */
2262 regulator_lock_two(rdev, r, &ww_ctx);
2263
2264 /* Supply just resolved by a concurrent task? */
2265 if (rdev->supply) {
2266 /* Constraints might still be pending due to concurrency. */
2267 bool done = !rdev->constraints_pending;
2268
2269 supply = rdev->supply;
2270
2271 regulator_unlock_two(rdev, r, &ww_ctx);
2272 put_device(&r->dev);
2273
2274 /*
2275 * Supply resolved by concurrent task, and constraints set as
2276 * well (or not required): fast path.
2277 */
2278 if (done)
2279 goto out;
2280
2281 do_final_setup = false;
2282 } else {
2283 ret = set_supply(rdev, r);
2284 if (ret < 0) {
2285 regulator_unlock_two(rdev, r, &ww_ctx);
2286 put_device(&r->dev);
2287 goto out;
2288 }
2289
2290 supply = rdev->supply;
2291
2292 /*
2293 * Automatically register for event forwarding from the new
2294 * supply. This creates the downstream propagation link for
2295 * events like under-voltage.
2296 */
2297 ret = register_regulator_event_forwarding(rdev);
2298 if (ret < 0) {
2299 rdev_warn(rdev,
2300 "Failed to register event forwarding: %pe\n",
2301 ERR_PTR(ret));
2302
2303 goto unset_supply;
2304 }
2305
2306 regulator_unlock_two(rdev, r, &ww_ctx);
2307
2308 do_final_setup = true;
2309 }
2310
2311 /*
2312 * Now that we have the supply, we can retry setting the machine
2313 * constraints, if necessary.
2314 */
2315 regulator_lock_dependent(rdev, &ww_ctx);
2316 if (rdev->constraints_pending) {
2317 if (!rdev->supply) {
2318 /*
2319 * Supply could have been released by another task that
2320 * failed to set the constraints or event forwarding.
2321 */
2322 regulator_unlock_dependent(rdev, &ww_ctx);
2323 ret = -EPROBE_DEFER;
2324 goto out;
2325 }
2326
2327 ret = set_machine_constraints(rdev, true);
2328 if (ret < 0) {
2329 regulator_unlock_dependent(rdev, &ww_ctx);
2330
2331 rdev_warn(rdev,
2332 "Failed to set machine constraints: %pe\n",
2333 ERR_PTR(ret));
2334
2335 regulator_lock_two(rdev, r, &ww_ctx);
2336
2337 if (supply != rdev->supply) {
2338 /*
2339 * Supply could have been released by another
2340 * task that got here before us. If it did, it
2341 * will have released 'supply' (i.e. the
2342 * previous rdev->supply) and we shouldn't do
2343 * that again via unset_supply.
2344 */
2345 regulator_unlock_two(rdev, r, &ww_ctx);
2346 goto out;
2347 }
2348
2349 unregister_regulator_event_forwarding(rdev);
2350 rdev->constraints_pending = true;
2351 goto unset_supply;
2352 }
2353 rdev->constraints_pending = false;
2354 }
2355 regulator_unlock_dependent(rdev, &ww_ctx);
2356
2357 if (!do_final_setup)
2358 goto out;
2359
2360 /* rdev->supply was created in set_supply() */
2361 link_and_create_debugfs(rdev->supply, rdev->supply->rdev, &rdev->dev);
2362
2363 out:
2364 return ret;
2365
2366 unset_supply:
2367 lockdep_assert_held_once(&rdev->mutex.base);
2368 lockdep_assert_held_once(&r->mutex.base);
2369 rdev->supply = NULL;
2370 regulator_unlock_two(rdev, supply->rdev, &ww_ctx);
2371
2372 regulator_put(supply);
2373
2374 return ret;
2375 }
2376
2377 /* common pre-checks for regulator requests */
_regulator_get_common_check(struct device * dev,const char * id,enum regulator_get_type get_type)2378 int _regulator_get_common_check(struct device *dev, const char *id,
2379 enum regulator_get_type get_type)
2380 {
2381 if (get_type >= MAX_GET_TYPE) {
2382 dev_err(dev, "invalid type %d in %s\n", get_type, __func__);
2383 return -EINVAL;
2384 }
2385
2386 if (id == NULL) {
2387 dev_err(dev, "regulator request with no identifier\n");
2388 return -EINVAL;
2389 }
2390
2391 return 0;
2392 }
2393
2394 /**
2395 * _regulator_get_common - Common code for regulator requests
2396 * @rdev: regulator device pointer as returned by *regulator_dev_lookup()
2397 * Its reference count is expected to have been incremented.
2398 * @dev: device used for dev_printk messages
2399 * @id: Supply name or regulator ID
2400 * @get_type: enum regulator_get_type value corresponding to type of request
2401 *
2402 * Returns: pointer to struct regulator corresponding to @rdev, or ERR_PTR()
2403 * encoded error.
2404 *
2405 * This function should be chained with *regulator_dev_lookup() functions.
2406 */
_regulator_get_common(struct regulator_dev * rdev,struct device * dev,const char * id,enum regulator_get_type get_type)2407 struct regulator *_regulator_get_common(struct regulator_dev *rdev, struct device *dev,
2408 const char *id, enum regulator_get_type get_type)
2409 {
2410 struct regulator *regulator;
2411 struct device_link *link;
2412 int ret;
2413
2414 if (IS_ERR(rdev)) {
2415 ret = PTR_ERR(rdev);
2416
2417 /*
2418 * If regulator_dev_lookup() fails with error other
2419 * than -ENODEV our job here is done, we simply return it.
2420 */
2421 if (ret != -ENODEV)
2422 return ERR_PTR(ret);
2423
2424 if (!have_full_constraints()) {
2425 dev_warn(dev,
2426 "incomplete constraints, dummy supplies not allowed (id=%s)\n", id);
2427 return ERR_PTR(-ENODEV);
2428 }
2429
2430 switch (get_type) {
2431 case NORMAL_GET:
2432 /*
2433 * Assume that a regulator is physically present and
2434 * enabled, even if it isn't hooked up, and just
2435 * provide a dummy.
2436 */
2437 rdev = dummy_regulator_rdev;
2438 if (!rdev)
2439 return ERR_PTR(-EPROBE_DEFER);
2440 dev_warn(dev, "supply %s not found, using dummy regulator\n", id);
2441 get_device(&rdev->dev);
2442 break;
2443
2444 case EXCLUSIVE_GET:
2445 dev_warn(dev,
2446 "dummy supplies not allowed for exclusive requests (id=%s)\n", id);
2447 fallthrough;
2448
2449 default:
2450 return ERR_PTR(-ENODEV);
2451 }
2452 }
2453
2454 if (rdev->exclusive) {
2455 regulator = ERR_PTR(-EPERM);
2456 put_device(&rdev->dev);
2457 return regulator;
2458 }
2459
2460 if (get_type == EXCLUSIVE_GET && rdev->open_count) {
2461 regulator = ERR_PTR(-EBUSY);
2462 put_device(&rdev->dev);
2463 return regulator;
2464 }
2465
2466 mutex_lock(®ulator_list_mutex);
2467 ret = (rdev->coupling_desc.n_resolved != rdev->coupling_desc.n_coupled);
2468 mutex_unlock(®ulator_list_mutex);
2469
2470 if (ret != 0) {
2471 regulator = ERR_PTR(-EPROBE_DEFER);
2472 put_device(&rdev->dev);
2473 return regulator;
2474 }
2475
2476 ret = regulator_resolve_supply(rdev);
2477 if (ret < 0) {
2478 regulator = ERR_PTR(ret);
2479 put_device(&rdev->dev);
2480 return regulator;
2481 }
2482
2483 if (!try_module_get(rdev->owner)) {
2484 regulator = ERR_PTR(-EPROBE_DEFER);
2485 put_device(&rdev->dev);
2486 return regulator;
2487 }
2488
2489 regulator_lock(rdev);
2490 regulator = create_regulator(rdev, dev, id);
2491 regulator_unlock(rdev);
2492 if (regulator == NULL) {
2493 regulator = ERR_PTR(-ENOMEM);
2494 module_put(rdev->owner);
2495 put_device(&rdev->dev);
2496 return regulator;
2497 }
2498
2499 link_and_create_debugfs(regulator, rdev, dev);
2500
2501 rdev->open_count++;
2502 if (get_type == EXCLUSIVE_GET) {
2503 rdev->exclusive = 1;
2504
2505 ret = _regulator_is_enabled(rdev);
2506 if (ret > 0) {
2507 rdev->use_count = 1;
2508 regulator->enable_count = 1;
2509
2510 /* Propagate the regulator state to its supply */
2511 if (rdev->supply) {
2512 ret = regulator_enable(rdev->supply);
2513 if (ret < 0) {
2514 destroy_regulator(regulator);
2515 module_put(rdev->owner);
2516 put_device(&rdev->dev);
2517 return ERR_PTR(ret);
2518 }
2519 }
2520 } else {
2521 rdev->use_count = 0;
2522 regulator->enable_count = 0;
2523 }
2524 }
2525
2526 link = device_link_add(dev, &rdev->dev, DL_FLAG_STATELESS);
2527 if (!IS_ERR_OR_NULL(link))
2528 regulator->device_link = true;
2529
2530 return regulator;
2531 }
2532
2533 /* Internal regulator request function */
_regulator_get(struct device * dev,const char * id,enum regulator_get_type get_type)2534 struct regulator *_regulator_get(struct device *dev, const char *id,
2535 enum regulator_get_type get_type)
2536 {
2537 struct regulator_dev *rdev;
2538 int ret;
2539
2540 ret = _regulator_get_common_check(dev, id, get_type);
2541 if (ret)
2542 return ERR_PTR(ret);
2543
2544 rdev = regulator_dev_lookup(dev, id);
2545 return _regulator_get_common(rdev, dev, id, get_type);
2546 }
2547
2548 /**
2549 * regulator_get - lookup and obtain a reference to a regulator.
2550 * @dev: device for regulator "consumer"
2551 * @id: Supply name or regulator ID.
2552 *
2553 * Use of supply names configured via set_consumer_device_supply() is
2554 * strongly encouraged. It is recommended that the supply name used
2555 * should match the name used for the supply and/or the relevant
2556 * device pins in the datasheet.
2557 *
2558 * Return: Pointer to a &struct regulator corresponding to the regulator
2559 * producer, or an ERR_PTR() encoded negative error number.
2560 */
regulator_get(struct device * dev,const char * id)2561 struct regulator *regulator_get(struct device *dev, const char *id)
2562 {
2563 return _regulator_get(dev, id, NORMAL_GET);
2564 }
2565 EXPORT_SYMBOL_GPL(regulator_get);
2566
2567 /**
2568 * regulator_get_exclusive - obtain exclusive access to a regulator.
2569 * @dev: device for regulator "consumer"
2570 * @id: Supply name or regulator ID.
2571 *
2572 * Other consumers will be unable to obtain this regulator while this
2573 * reference is held and the use count for the regulator will be
2574 * initialised to reflect the current state of the regulator.
2575 *
2576 * This is intended for use by consumers which cannot tolerate shared
2577 * use of the regulator such as those which need to force the
2578 * regulator off for correct operation of the hardware they are
2579 * controlling.
2580 *
2581 * Use of supply names configured via set_consumer_device_supply() is
2582 * strongly encouraged. It is recommended that the supply name used
2583 * should match the name used for the supply and/or the relevant
2584 * device pins in the datasheet.
2585 *
2586 * Return: Pointer to a &struct regulator corresponding to the regulator
2587 * producer, or an ERR_PTR() encoded negative error number.
2588 */
regulator_get_exclusive(struct device * dev,const char * id)2589 struct regulator *regulator_get_exclusive(struct device *dev, const char *id)
2590 {
2591 return _regulator_get(dev, id, EXCLUSIVE_GET);
2592 }
2593 EXPORT_SYMBOL_GPL(regulator_get_exclusive);
2594
2595 /**
2596 * regulator_get_optional - obtain optional access to a regulator.
2597 * @dev: device for regulator "consumer"
2598 * @id: Supply name or regulator ID.
2599 *
2600 * This is intended for use by consumers for devices which can have
2601 * some supplies unconnected in normal use, such as some MMC devices.
2602 * It can allow the regulator core to provide stub supplies for other
2603 * supplies requested using normal regulator_get() calls without
2604 * disrupting the operation of drivers that can handle absent
2605 * supplies.
2606 *
2607 * Use of supply names configured via set_consumer_device_supply() is
2608 * strongly encouraged. It is recommended that the supply name used
2609 * should match the name used for the supply and/or the relevant
2610 * device pins in the datasheet.
2611 *
2612 * Return: Pointer to a &struct regulator corresponding to the regulator
2613 * producer, or an ERR_PTR() encoded negative error number.
2614 */
regulator_get_optional(struct device * dev,const char * id)2615 struct regulator *regulator_get_optional(struct device *dev, const char *id)
2616 {
2617 return _regulator_get(dev, id, OPTIONAL_GET);
2618 }
2619 EXPORT_SYMBOL_GPL(regulator_get_optional);
2620
destroy_regulator(struct regulator * regulator)2621 static void destroy_regulator(struct regulator *regulator)
2622 {
2623 struct regulator_dev *rdev = regulator->rdev;
2624
2625 debugfs_remove_recursive(regulator->debugfs);
2626
2627 if (regulator->dev) {
2628 if (regulator->device_link)
2629 device_link_remove(regulator->dev, &rdev->dev);
2630
2631 /* remove any sysfs entries */
2632 sysfs_remove_link(&rdev->dev.kobj, regulator->supply_name);
2633 }
2634
2635 regulator_lock(rdev);
2636 list_del(®ulator->list);
2637
2638 rdev->open_count--;
2639 rdev->exclusive = 0;
2640 regulator_unlock(rdev);
2641
2642 kfree_const(regulator->supply_name);
2643 kfree(regulator);
2644 }
2645
2646 /* regulator_list_mutex lock held by regulator_put() */
_regulator_put(struct regulator * regulator)2647 static void _regulator_put(struct regulator *regulator)
2648 {
2649 struct regulator_dev *rdev;
2650
2651 if (IS_ERR_OR_NULL(regulator))
2652 return;
2653
2654 lockdep_assert_held_once(®ulator_list_mutex);
2655
2656 /* Docs say you must disable before calling regulator_put() */
2657 WARN_ON(regulator->enable_count);
2658
2659 rdev = regulator->rdev;
2660
2661 destroy_regulator(regulator);
2662
2663 module_put(rdev->owner);
2664 put_device(&rdev->dev);
2665 }
2666
2667 /**
2668 * regulator_put - "free" the regulator source
2669 * @regulator: regulator source
2670 *
2671 * Note: drivers must ensure that all regulator_enable calls made on this
2672 * regulator source are balanced by regulator_disable calls prior to calling
2673 * this function.
2674 */
regulator_put(struct regulator * regulator)2675 void regulator_put(struct regulator *regulator)
2676 {
2677 mutex_lock(®ulator_list_mutex);
2678 _regulator_put(regulator);
2679 mutex_unlock(®ulator_list_mutex);
2680 }
2681 EXPORT_SYMBOL_GPL(regulator_put);
2682
2683 /**
2684 * regulator_register_supply_alias - Provide device alias for supply lookup
2685 *
2686 * @dev: device that will be given as the regulator "consumer"
2687 * @id: Supply name or regulator ID
2688 * @alias_dev: device that should be used to lookup the supply
2689 * @alias_id: Supply name or regulator ID that should be used to lookup the
2690 * supply
2691 *
2692 * All lookups for id on dev will instead be conducted for alias_id on
2693 * alias_dev.
2694 *
2695 * Return: 0 on success or a negative error number on failure.
2696 */
regulator_register_supply_alias(struct device * dev,const char * id,struct device * alias_dev,const char * alias_id)2697 int regulator_register_supply_alias(struct device *dev, const char *id,
2698 struct device *alias_dev,
2699 const char *alias_id)
2700 {
2701 struct regulator_supply_alias *map;
2702 struct regulator_supply_alias *new_map;
2703
2704 new_map = kzalloc_obj(struct regulator_supply_alias);
2705 if (!new_map)
2706 return -ENOMEM;
2707
2708 mutex_lock(®ulator_list_mutex);
2709 map = regulator_find_supply_alias(dev, id);
2710 if (map) {
2711 mutex_unlock(®ulator_list_mutex);
2712 kfree(new_map);
2713 return -EEXIST;
2714 }
2715
2716 new_map->src_dev = dev;
2717 new_map->src_supply = id;
2718 new_map->alias_dev = alias_dev;
2719 new_map->alias_supply = alias_id;
2720 list_add(&new_map->list, ®ulator_supply_alias_list);
2721 mutex_unlock(®ulator_list_mutex);
2722 pr_info("Adding alias for supply %s,%s -> %s,%s\n",
2723 id, dev_name(dev), alias_id, dev_name(alias_dev));
2724
2725 return 0;
2726 }
2727 EXPORT_SYMBOL_GPL(regulator_register_supply_alias);
2728
2729 /**
2730 * regulator_unregister_supply_alias - Remove device alias
2731 *
2732 * @dev: device that will be given as the regulator "consumer"
2733 * @id: Supply name or regulator ID
2734 *
2735 * Remove a lookup alias if one exists for id on dev.
2736 */
regulator_unregister_supply_alias(struct device * dev,const char * id)2737 void regulator_unregister_supply_alias(struct device *dev, const char *id)
2738 {
2739 struct regulator_supply_alias *map;
2740
2741 mutex_lock(®ulator_list_mutex);
2742 map = regulator_find_supply_alias(dev, id);
2743 if (map) {
2744 list_del(&map->list);
2745 kfree(map);
2746 }
2747 mutex_unlock(®ulator_list_mutex);
2748 }
2749 EXPORT_SYMBOL_GPL(regulator_unregister_supply_alias);
2750
2751 /**
2752 * regulator_bulk_register_supply_alias - register multiple aliases
2753 *
2754 * @dev: device that will be given as the regulator "consumer"
2755 * @id: List of supply names or regulator IDs
2756 * @alias_dev: device that should be used to lookup the supply
2757 * @alias_id: List of supply names or regulator IDs that should be used to
2758 * lookup the supply
2759 * @num_id: Number of aliases to register
2760 *
2761 * This helper function allows drivers to register several supply
2762 * aliases in one operation. If any of the aliases cannot be
2763 * registered any aliases that were registered will be removed
2764 * before returning to the caller.
2765 *
2766 * Return: 0 on success or a negative error number on failure.
2767 */
regulator_bulk_register_supply_alias(struct device * dev,const char * const * id,struct device * alias_dev,const char * const * alias_id,int num_id)2768 int regulator_bulk_register_supply_alias(struct device *dev,
2769 const char *const *id,
2770 struct device *alias_dev,
2771 const char *const *alias_id,
2772 int num_id)
2773 {
2774 int i;
2775 int ret;
2776
2777 for (i = 0; i < num_id; ++i) {
2778 ret = regulator_register_supply_alias(dev, id[i], alias_dev,
2779 alias_id[i]);
2780 if (ret < 0)
2781 goto err;
2782 }
2783
2784 return 0;
2785
2786 err:
2787 dev_err(dev,
2788 "Failed to create supply alias %s,%s -> %s,%s\n",
2789 id[i], dev_name(dev), alias_id[i], dev_name(alias_dev));
2790
2791 while (--i >= 0)
2792 regulator_unregister_supply_alias(dev, id[i]);
2793
2794 return ret;
2795 }
2796 EXPORT_SYMBOL_GPL(regulator_bulk_register_supply_alias);
2797
2798 /**
2799 * regulator_bulk_unregister_supply_alias - unregister multiple aliases
2800 *
2801 * @dev: device that will be given as the regulator "consumer"
2802 * @id: List of supply names or regulator IDs
2803 * @num_id: Number of aliases to unregister
2804 *
2805 * This helper function allows drivers to unregister several supply
2806 * aliases in one operation.
2807 */
regulator_bulk_unregister_supply_alias(struct device * dev,const char * const * id,int num_id)2808 void regulator_bulk_unregister_supply_alias(struct device *dev,
2809 const char *const *id,
2810 int num_id)
2811 {
2812 int i;
2813
2814 for (i = 0; i < num_id; ++i)
2815 regulator_unregister_supply_alias(dev, id[i]);
2816 }
2817 EXPORT_SYMBOL_GPL(regulator_bulk_unregister_supply_alias);
2818
2819
2820 /* Manage enable GPIO list. Same GPIO pin can be shared among regulators */
regulator_ena_gpio_request(struct regulator_dev * rdev,const struct regulator_config * config)2821 static int regulator_ena_gpio_request(struct regulator_dev *rdev,
2822 const struct regulator_config *config)
2823 {
2824 struct regulator_enable_gpio *pin, *new_pin;
2825 struct gpio_desc *gpiod;
2826
2827 gpiod = config->ena_gpiod;
2828 new_pin = kzalloc_obj(*new_pin);
2829
2830 mutex_lock(®ulator_list_mutex);
2831
2832 if (gpiod_is_shared(gpiod))
2833 /*
2834 * The sharing of this GPIO pin is managed internally by
2835 * GPIOLIB. We don't need to keep track of its enable count.
2836 */
2837 goto skip_compare;
2838
2839 list_for_each_entry(pin, ®ulator_ena_gpio_list, list) {
2840 if (gpiod_is_equal(pin->gpiod, gpiod)) {
2841 rdev_dbg(rdev, "GPIO is already used\n");
2842 goto update_ena_gpio_to_rdev;
2843 }
2844 }
2845
2846 if (new_pin == NULL) {
2847 mutex_unlock(®ulator_list_mutex);
2848 return -ENOMEM;
2849 }
2850
2851 skip_compare:
2852 pin = new_pin;
2853 new_pin = NULL;
2854
2855 pin->gpiod = gpiod;
2856 list_add(&pin->list, ®ulator_ena_gpio_list);
2857
2858 update_ena_gpio_to_rdev:
2859 pin->request_count++;
2860 rdev->ena_pin = pin;
2861
2862 mutex_unlock(®ulator_list_mutex);
2863 kfree(new_pin);
2864
2865 return 0;
2866 }
2867
regulator_ena_gpio_free(struct regulator_dev * rdev)2868 static void regulator_ena_gpio_free(struct regulator_dev *rdev)
2869 {
2870 struct regulator_enable_gpio *pin, *n;
2871
2872 if (!rdev->ena_pin)
2873 return;
2874
2875 /* Free the GPIO only in case of no use */
2876 list_for_each_entry_safe(pin, n, ®ulator_ena_gpio_list, list) {
2877 if (pin != rdev->ena_pin)
2878 continue;
2879
2880 if (--pin->request_count)
2881 break;
2882
2883 gpiod_put(pin->gpiod);
2884 list_del(&pin->list);
2885 kfree(pin);
2886 break;
2887 }
2888
2889 rdev->ena_pin = NULL;
2890 }
2891
2892 /**
2893 * regulator_ena_gpio_ctrl - balance enable_count of each GPIO and actual GPIO pin control
2894 * @rdev: regulator_dev structure
2895 * @enable: enable GPIO at initial use?
2896 *
2897 * GPIO is enabled in case of initial use. (enable_count is 0)
2898 * GPIO is disabled when it is not shared any more. (enable_count <= 1)
2899 *
2900 * Return: 0 on success or a negative error number on failure.
2901 */
regulator_ena_gpio_ctrl(struct regulator_dev * rdev,bool enable)2902 static int regulator_ena_gpio_ctrl(struct regulator_dev *rdev, bool enable)
2903 {
2904 struct regulator_enable_gpio *pin = rdev->ena_pin;
2905 int ret;
2906
2907 if (!pin)
2908 return -EINVAL;
2909
2910 if (enable) {
2911 /* Enable GPIO at initial use */
2912 if (pin->enable_count == 0) {
2913 ret = gpiod_set_value_cansleep(pin->gpiod, 1);
2914 if (ret)
2915 return ret;
2916 }
2917
2918 pin->enable_count++;
2919 } else {
2920 if (pin->enable_count > 1) {
2921 pin->enable_count--;
2922 return 0;
2923 }
2924
2925 /* Disable GPIO if not used */
2926 if (pin->enable_count <= 1) {
2927 ret = gpiod_set_value_cansleep(pin->gpiod, 0);
2928 if (ret)
2929 return ret;
2930
2931 pin->enable_count = 0;
2932 }
2933 }
2934
2935 return 0;
2936 }
2937
2938 /**
2939 * _regulator_check_status_enabled - check if regulator status can be
2940 * interpreted as "regulator is enabled"
2941 * @rdev: the regulator device to check
2942 *
2943 * Return:
2944 * * 1 - if status shows regulator is in enabled state
2945 * * 0 - if not enabled state
2946 * * Error Value - as received from ops->get_status()
2947 */
_regulator_check_status_enabled(struct regulator_dev * rdev)2948 static inline int _regulator_check_status_enabled(struct regulator_dev *rdev)
2949 {
2950 int ret = rdev->desc->ops->get_status(rdev);
2951
2952 if (ret < 0) {
2953 rdev_info(rdev, "get_status returned error: %d\n", ret);
2954 return ret;
2955 }
2956
2957 switch (ret) {
2958 case REGULATOR_STATUS_OFF:
2959 case REGULATOR_STATUS_ERROR:
2960 case REGULATOR_STATUS_UNDEFINED:
2961 return 0;
2962 default:
2963 return 1;
2964 }
2965 }
2966
_regulator_do_enable(struct regulator_dev * rdev)2967 static int _regulator_do_enable(struct regulator_dev *rdev)
2968 {
2969 int ret, delay;
2970
2971 /* Query before enabling in case configuration dependent. */
2972 ret = _regulator_get_enable_time(rdev);
2973 if (ret >= 0) {
2974 delay = ret;
2975 } else {
2976 rdev_warn(rdev, "enable_time() failed: %pe\n", ERR_PTR(ret));
2977 delay = 0;
2978 }
2979
2980 trace_regulator_enable(rdev_get_name(rdev));
2981
2982 if (rdev->desc->off_on_delay) {
2983 /* if needed, keep a distance of off_on_delay from last time
2984 * this regulator was disabled.
2985 */
2986 ktime_t end = ktime_add_us(rdev->last_off, rdev->desc->off_on_delay);
2987 s64 remaining = ktime_us_delta(end, ktime_get_boottime());
2988
2989 if (remaining > 0)
2990 fsleep(remaining);
2991 }
2992
2993 if (rdev->ena_pin) {
2994 if (!rdev->ena_gpio_state) {
2995 ret = regulator_ena_gpio_ctrl(rdev, true);
2996 if (ret < 0)
2997 return ret;
2998 rdev->ena_gpio_state = 1;
2999 }
3000 } else if (rdev->desc->ops->enable) {
3001 ret = rdev->desc->ops->enable(rdev);
3002 if (ret < 0)
3003 return ret;
3004 } else {
3005 return -EINVAL;
3006 }
3007
3008 /* Allow the regulator to ramp; it would be useful to extend
3009 * this for bulk operations so that the regulators can ramp
3010 * together.
3011 */
3012 trace_regulator_enable_delay(rdev_get_name(rdev));
3013
3014 /* If poll_enabled_time is set, poll upto the delay calculated
3015 * above, delaying poll_enabled_time uS to check if the regulator
3016 * actually got enabled.
3017 * If the regulator isn't enabled after our delay helper has expired,
3018 * return -ETIMEDOUT.
3019 */
3020 if (rdev->desc->poll_enabled_time) {
3021 int time_remaining = delay;
3022
3023 while (time_remaining > 0) {
3024 fsleep(rdev->desc->poll_enabled_time);
3025
3026 if (rdev->desc->ops->get_status) {
3027 ret = _regulator_check_status_enabled(rdev);
3028 if (ret < 0)
3029 return ret;
3030 else if (ret)
3031 break;
3032 } else if (rdev->desc->ops->is_enabled(rdev))
3033 break;
3034
3035 time_remaining -= rdev->desc->poll_enabled_time;
3036 }
3037
3038 if (time_remaining <= 0) {
3039 rdev_err(rdev, "Enabled check timed out\n");
3040 return -ETIMEDOUT;
3041 }
3042 } else {
3043 fsleep(delay);
3044 }
3045
3046 trace_regulator_enable_complete(rdev_get_name(rdev));
3047
3048 return 0;
3049 }
3050
3051 /**
3052 * _regulator_handle_consumer_enable - handle that a consumer enabled
3053 * @regulator: regulator source
3054 *
3055 * Some things on a regulator consumer (like the contribution towards total
3056 * load on the regulator) only have an effect when the consumer wants the
3057 * regulator enabled. Explained in example with two consumers of the same
3058 * regulator:
3059 * consumer A: set_load(100); => total load = 0
3060 * consumer A: regulator_enable(); => total load = 100
3061 * consumer B: set_load(1000); => total load = 100
3062 * consumer B: regulator_enable(); => total load = 1100
3063 * consumer A: regulator_disable(); => total_load = 1000
3064 *
3065 * This function (together with _regulator_handle_consumer_disable) is
3066 * responsible for keeping track of the refcount for a given regulator consumer
3067 * and applying / unapplying these things.
3068 *
3069 * Return: 0 on success or negative error number on failure.
3070 */
_regulator_handle_consumer_enable(struct regulator * regulator)3071 static int _regulator_handle_consumer_enable(struct regulator *regulator)
3072 {
3073 int ret;
3074 struct regulator_dev *rdev = regulator->rdev;
3075
3076 lockdep_assert_held_once(&rdev->mutex.base);
3077
3078 regulator->enable_count++;
3079 if (regulator->uA_load && regulator->enable_count == 1) {
3080 ret = drms_uA_update(rdev);
3081 if (ret)
3082 regulator->enable_count--;
3083 return ret;
3084 }
3085
3086 return 0;
3087 }
3088
3089 /**
3090 * _regulator_handle_consumer_disable - handle that a consumer disabled
3091 * @regulator: regulator source
3092 *
3093 * The opposite of _regulator_handle_consumer_enable().
3094 *
3095 * Return: 0 on success or a negative error number on failure.
3096 */
_regulator_handle_consumer_disable(struct regulator * regulator)3097 static int _regulator_handle_consumer_disable(struct regulator *regulator)
3098 {
3099 struct regulator_dev *rdev = regulator->rdev;
3100
3101 lockdep_assert_held_once(&rdev->mutex.base);
3102
3103 if (!regulator->enable_count) {
3104 rdev_err(rdev, "Underflow of regulator enable count\n");
3105 return -EINVAL;
3106 }
3107
3108 regulator->enable_count--;
3109 if (regulator->uA_load && regulator->enable_count == 0)
3110 return drms_uA_update(rdev);
3111
3112 return 0;
3113 }
3114
3115 /* locks held by regulator_enable() */
_regulator_enable(struct regulator * regulator)3116 static int _regulator_enable(struct regulator *regulator)
3117 {
3118 struct regulator_dev *rdev = regulator->rdev;
3119 int ret;
3120
3121 lockdep_assert_held_once(&rdev->mutex.base);
3122
3123 if (rdev->use_count == 0 && rdev->supply) {
3124 ret = _regulator_enable(rdev->supply);
3125 if (ret < 0)
3126 return ret;
3127 }
3128
3129 /* balance only if there are regulators coupled */
3130 if (rdev->coupling_desc.n_coupled > 1) {
3131 ret = regulator_balance_voltage(rdev, PM_SUSPEND_ON);
3132 if (ret < 0)
3133 goto err_disable_supply;
3134 }
3135
3136 ret = _regulator_handle_consumer_enable(regulator);
3137 if (ret < 0)
3138 goto err_disable_supply;
3139
3140 if (rdev->use_count == 0) {
3141 /*
3142 * The regulator may already be enabled if it's not switchable
3143 * or was left on
3144 */
3145 ret = _regulator_is_enabled(rdev);
3146 if (ret == -EINVAL || ret == 0) {
3147 if (!regulator_ops_is_valid(rdev,
3148 REGULATOR_CHANGE_STATUS)) {
3149 ret = -EPERM;
3150 goto err_consumer_disable;
3151 }
3152
3153 ret = _regulator_do_enable(rdev);
3154 if (ret < 0)
3155 goto err_consumer_disable;
3156
3157 _notifier_call_chain(rdev, REGULATOR_EVENT_ENABLE,
3158 NULL);
3159 } else if (ret < 0) {
3160 rdev_err(rdev, "is_enabled() failed: %pe\n", ERR_PTR(ret));
3161 goto err_consumer_disable;
3162 }
3163 /* Fallthrough on positive return values - already enabled */
3164 }
3165
3166 if (regulator->enable_count == 1)
3167 rdev->use_count++;
3168
3169 return 0;
3170
3171 err_consumer_disable:
3172 _regulator_handle_consumer_disable(regulator);
3173
3174 err_disable_supply:
3175 if (rdev->use_count == 0 && rdev->supply)
3176 _regulator_disable(rdev->supply);
3177
3178 return ret;
3179 }
3180
3181 /**
3182 * regulator_enable - enable regulator output
3183 * @regulator: regulator source
3184 *
3185 * Request that the regulator be enabled with the regulator output at
3186 * the predefined voltage or current value. Calls to regulator_enable()
3187 * must be balanced with calls to regulator_disable().
3188 *
3189 * NOTE: the output value can be set by other drivers, boot loader or may be
3190 * hardwired in the regulator.
3191 *
3192 * Return: 0 on success or a negative error number on failure.
3193 */
regulator_enable(struct regulator * regulator)3194 int regulator_enable(struct regulator *regulator)
3195 {
3196 struct regulator_dev *rdev = regulator->rdev;
3197 struct ww_acquire_ctx ww_ctx;
3198 int ret;
3199
3200 regulator_lock_dependent(rdev, &ww_ctx);
3201 ret = _regulator_enable(regulator);
3202 regulator_unlock_dependent(rdev, &ww_ctx);
3203
3204 return ret;
3205 }
3206 EXPORT_SYMBOL_GPL(regulator_enable);
3207
_regulator_do_disable(struct regulator_dev * rdev)3208 static int _regulator_do_disable(struct regulator_dev *rdev)
3209 {
3210 int ret;
3211
3212 trace_regulator_disable(rdev_get_name(rdev));
3213
3214 if (rdev->ena_pin) {
3215 if (rdev->ena_gpio_state) {
3216 ret = regulator_ena_gpio_ctrl(rdev, false);
3217 if (ret < 0)
3218 return ret;
3219 rdev->ena_gpio_state = 0;
3220 }
3221
3222 } else if (rdev->desc->ops->disable) {
3223 ret = rdev->desc->ops->disable(rdev);
3224 if (ret != 0)
3225 return ret;
3226 }
3227
3228 if (rdev->desc->off_on_delay)
3229 rdev->last_off = ktime_get_boottime();
3230
3231 trace_regulator_disable_complete(rdev_get_name(rdev));
3232
3233 return 0;
3234 }
3235
3236 /* locks held by regulator_disable() */
_regulator_disable(struct regulator * regulator)3237 static int _regulator_disable(struct regulator *regulator)
3238 {
3239 struct regulator_dev *rdev = regulator->rdev;
3240 int ret = 0;
3241
3242 lockdep_assert_held_once(&rdev->mutex.base);
3243
3244 if (WARN(regulator->enable_count == 0,
3245 "unbalanced disables for %s\n", rdev_get_name(rdev)))
3246 return -EIO;
3247
3248 if (regulator->enable_count == 1) {
3249 /* disabling last enable_count from this regulator */
3250 /* are we the last user and permitted to disable ? */
3251 if (rdev->use_count == 1 &&
3252 (rdev->constraints && !rdev->constraints->always_on)) {
3253
3254 /* we are last user */
3255 if (regulator_ops_is_valid(rdev, REGULATOR_CHANGE_STATUS)) {
3256 ret = _notifier_call_chain(rdev,
3257 REGULATOR_EVENT_PRE_DISABLE,
3258 NULL);
3259 if (ret & NOTIFY_STOP_MASK)
3260 return -EINVAL;
3261
3262 ret = _regulator_do_disable(rdev);
3263 if (ret < 0) {
3264 rdev_err(rdev, "failed to disable: %pe\n", ERR_PTR(ret));
3265 _notifier_call_chain(rdev,
3266 REGULATOR_EVENT_ABORT_DISABLE,
3267 NULL);
3268 return ret;
3269 }
3270 _notifier_call_chain(rdev, REGULATOR_EVENT_DISABLE,
3271 NULL);
3272 }
3273
3274 rdev->use_count = 0;
3275 } else if (rdev->use_count > 1) {
3276 rdev->use_count--;
3277 }
3278 }
3279
3280 if (ret == 0)
3281 ret = _regulator_handle_consumer_disable(regulator);
3282
3283 if (ret == 0 && rdev->coupling_desc.n_coupled > 1)
3284 ret = regulator_balance_voltage(rdev, PM_SUSPEND_ON);
3285
3286 if (ret == 0 && rdev->use_count == 0 && rdev->supply)
3287 ret = _regulator_disable(rdev->supply);
3288
3289 return ret;
3290 }
3291
3292 /**
3293 * regulator_disable - disable regulator output
3294 * @regulator: regulator source
3295 *
3296 * Disable the regulator output voltage or current. Calls to
3297 * regulator_enable() must be balanced with calls to
3298 * regulator_disable().
3299 *
3300 * NOTE: this will only disable the regulator output if no other consumer
3301 * devices have it enabled, the regulator device supports disabling and
3302 * machine constraints permit this operation.
3303 *
3304 * Return: 0 on success or a negative error number on failure.
3305 */
regulator_disable(struct regulator * regulator)3306 int regulator_disable(struct regulator *regulator)
3307 {
3308 struct regulator_dev *rdev = regulator->rdev;
3309 struct ww_acquire_ctx ww_ctx;
3310 int ret;
3311
3312 regulator_lock_dependent(rdev, &ww_ctx);
3313 ret = _regulator_disable(regulator);
3314 regulator_unlock_dependent(rdev, &ww_ctx);
3315
3316 return ret;
3317 }
3318 EXPORT_SYMBOL_GPL(regulator_disable);
3319
3320 /* locks held by regulator_force_disable() */
_regulator_force_disable(struct regulator_dev * rdev)3321 static int _regulator_force_disable(struct regulator_dev *rdev)
3322 {
3323 int ret = 0;
3324
3325 lockdep_assert_held_once(&rdev->mutex.base);
3326
3327 ret = _notifier_call_chain(rdev, REGULATOR_EVENT_FORCE_DISABLE |
3328 REGULATOR_EVENT_PRE_DISABLE, NULL);
3329 if (ret & NOTIFY_STOP_MASK)
3330 return -EINVAL;
3331
3332 ret = _regulator_do_disable(rdev);
3333 if (ret < 0) {
3334 rdev_err(rdev, "failed to force disable: %pe\n", ERR_PTR(ret));
3335 _notifier_call_chain(rdev, REGULATOR_EVENT_FORCE_DISABLE |
3336 REGULATOR_EVENT_ABORT_DISABLE, NULL);
3337 return ret;
3338 }
3339
3340 _notifier_call_chain(rdev, REGULATOR_EVENT_FORCE_DISABLE |
3341 REGULATOR_EVENT_DISABLE, NULL);
3342
3343 return 0;
3344 }
3345
3346 /**
3347 * regulator_force_disable - force disable regulator output
3348 * @regulator: regulator source
3349 *
3350 * Forcibly disable the regulator output voltage or current.
3351 * NOTE: this *will* disable the regulator output even if other consumer
3352 * devices have it enabled. This should be used for situations when device
3353 * damage will likely occur if the regulator is not disabled (e.g. over temp).
3354 *
3355 * Return: 0 on success or a negative error number on failure.
3356 */
regulator_force_disable(struct regulator * regulator)3357 int regulator_force_disable(struct regulator *regulator)
3358 {
3359 struct regulator_dev *rdev = regulator->rdev;
3360 struct ww_acquire_ctx ww_ctx;
3361 int ret;
3362
3363 regulator_lock_dependent(rdev, &ww_ctx);
3364
3365 ret = _regulator_force_disable(regulator->rdev);
3366
3367 if (rdev->coupling_desc.n_coupled > 1)
3368 regulator_balance_voltage(rdev, PM_SUSPEND_ON);
3369
3370 if (regulator->uA_load) {
3371 regulator->uA_load = 0;
3372 ret = drms_uA_update(rdev);
3373 }
3374
3375 if (rdev->use_count != 0 && rdev->supply)
3376 _regulator_disable(rdev->supply);
3377
3378 regulator_unlock_dependent(rdev, &ww_ctx);
3379
3380 return ret;
3381 }
3382 EXPORT_SYMBOL_GPL(regulator_force_disable);
3383
regulator_disable_work(struct work_struct * work)3384 static void regulator_disable_work(struct work_struct *work)
3385 {
3386 struct regulator_dev *rdev = container_of(work, struct regulator_dev,
3387 disable_work.work);
3388 struct ww_acquire_ctx ww_ctx;
3389 int count, i, ret;
3390 struct regulator *regulator;
3391 int total_count = 0;
3392
3393 regulator_lock_dependent(rdev, &ww_ctx);
3394
3395 /*
3396 * Workqueue functions queue the new work instance while the previous
3397 * work instance is being processed. Cancel the queued work instance
3398 * as the work instance under processing does the job of the queued
3399 * work instance.
3400 */
3401 cancel_delayed_work(&rdev->disable_work);
3402
3403 list_for_each_entry(regulator, &rdev->consumer_list, list) {
3404 count = regulator->deferred_disables;
3405
3406 if (!count)
3407 continue;
3408
3409 total_count += count;
3410 regulator->deferred_disables = 0;
3411
3412 for (i = 0; i < count; i++) {
3413 ret = _regulator_disable(regulator);
3414 if (ret != 0)
3415 rdev_err(rdev, "Deferred disable failed: %pe\n",
3416 ERR_PTR(ret));
3417 }
3418 }
3419 WARN_ON(!total_count);
3420
3421 if (rdev->coupling_desc.n_coupled > 1)
3422 regulator_balance_voltage(rdev, PM_SUSPEND_ON);
3423
3424 regulator_unlock_dependent(rdev, &ww_ctx);
3425 }
3426
3427 /**
3428 * regulator_disable_deferred - disable regulator output with delay
3429 * @regulator: regulator source
3430 * @ms: milliseconds until the regulator is disabled
3431 *
3432 * Execute regulator_disable() on the regulator after a delay. This
3433 * is intended for use with devices that require some time to quiesce.
3434 *
3435 * NOTE: this will only disable the regulator output if no other consumer
3436 * devices have it enabled, the regulator device supports disabling and
3437 * machine constraints permit this operation.
3438 *
3439 * Return: 0 on success or a negative error number on failure.
3440 */
regulator_disable_deferred(struct regulator * regulator,int ms)3441 int regulator_disable_deferred(struct regulator *regulator, int ms)
3442 {
3443 struct regulator_dev *rdev = regulator->rdev;
3444
3445 if (!ms)
3446 return regulator_disable(regulator);
3447
3448 regulator_lock(rdev);
3449 regulator->deferred_disables++;
3450 mod_delayed_work(system_power_efficient_wq, &rdev->disable_work,
3451 msecs_to_jiffies(ms));
3452 regulator_unlock(rdev);
3453
3454 return 0;
3455 }
3456 EXPORT_SYMBOL_GPL(regulator_disable_deferred);
3457
_regulator_is_enabled(struct regulator_dev * rdev)3458 static int _regulator_is_enabled(struct regulator_dev *rdev)
3459 {
3460 /* A GPIO control always takes precedence */
3461 if (rdev->ena_pin)
3462 return rdev->ena_gpio_state;
3463
3464 /* If we don't know then assume that the regulator is always on */
3465 if (!rdev->desc->ops->is_enabled)
3466 return 1;
3467
3468 return rdev->desc->ops->is_enabled(rdev);
3469 }
3470
_regulator_list_voltage(struct regulator_dev * rdev,unsigned selector,int lock)3471 static int _regulator_list_voltage(struct regulator_dev *rdev,
3472 unsigned selector, int lock)
3473 {
3474 const struct regulator_ops *ops = rdev->desc->ops;
3475 int ret;
3476
3477 if (rdev->desc->fixed_uV && rdev->desc->n_voltages == 1 && !selector)
3478 return rdev->desc->fixed_uV;
3479
3480 if (ops->list_voltage) {
3481 if (selector >= rdev->desc->n_voltages)
3482 return -EINVAL;
3483 if (selector < rdev->desc->linear_min_sel)
3484 return 0;
3485 if (lock)
3486 regulator_lock(rdev);
3487 ret = ops->list_voltage(rdev, selector);
3488 if (lock)
3489 regulator_unlock(rdev);
3490 } else if (rdev->is_switch && rdev->supply) {
3491 ret = _regulator_list_voltage(rdev->supply->rdev,
3492 selector, lock);
3493 } else {
3494 return -EINVAL;
3495 }
3496
3497 if (ret > 0) {
3498 if (ret < rdev->constraints->min_uV)
3499 ret = 0;
3500 else if (ret > rdev->constraints->max_uV)
3501 ret = 0;
3502 }
3503
3504 return ret;
3505 }
3506
3507 /**
3508 * regulator_is_enabled - is the regulator output enabled
3509 * @regulator: regulator source
3510 *
3511 * Note that the device backing this regulator handle can have multiple
3512 * users, so it might be enabled even if regulator_enable() was never
3513 * called for this particular source.
3514 *
3515 * Return: Positive if the regulator driver backing the source/client
3516 * has requested that the device be enabled, zero if it hasn't,
3517 * else a negative error number.
3518 */
regulator_is_enabled(struct regulator * regulator)3519 int regulator_is_enabled(struct regulator *regulator)
3520 {
3521 int ret;
3522
3523 if (regulator->always_on)
3524 return 1;
3525
3526 regulator_lock(regulator->rdev);
3527 ret = _regulator_is_enabled(regulator->rdev);
3528 regulator_unlock(regulator->rdev);
3529
3530 return ret;
3531 }
3532 EXPORT_SYMBOL_GPL(regulator_is_enabled);
3533
3534 /**
3535 * regulator_count_voltages - count regulator_list_voltage() selectors
3536 * @regulator: regulator source
3537 *
3538 * Return: Number of selectors for @regulator, or negative error number.
3539 *
3540 * Selectors are numbered starting at zero, and typically correspond to
3541 * bitfields in hardware registers.
3542 */
regulator_count_voltages(struct regulator * regulator)3543 int regulator_count_voltages(struct regulator *regulator)
3544 {
3545 struct regulator_dev *rdev = regulator->rdev;
3546
3547 if (rdev->desc->n_voltages)
3548 return rdev->desc->n_voltages;
3549
3550 if (!rdev->is_switch || !rdev->supply)
3551 return -EINVAL;
3552
3553 return regulator_count_voltages(rdev->supply);
3554 }
3555 EXPORT_SYMBOL_GPL(regulator_count_voltages);
3556
3557 /**
3558 * regulator_list_voltage - enumerate supported voltages
3559 * @regulator: regulator source
3560 * @selector: identify voltage to list
3561 * Context: can sleep
3562 *
3563 * Return: Voltage for @selector that can be passed to regulator_set_voltage(),
3564 * 0 if @selector can't be used on this system, or a negative error
3565 * number on failure.
3566 */
regulator_list_voltage(struct regulator * regulator,unsigned selector)3567 int regulator_list_voltage(struct regulator *regulator, unsigned selector)
3568 {
3569 return _regulator_list_voltage(regulator->rdev, selector, 1);
3570 }
3571 EXPORT_SYMBOL_GPL(regulator_list_voltage);
3572
3573 /**
3574 * regulator_get_regmap - get the regulator's register map
3575 * @regulator: regulator source
3576 *
3577 * Return: Pointer to the &struct regmap for @regulator, or ERR_PTR()
3578 * encoded -%EOPNOTSUPP if @regulator doesn't use regmap.
3579 */
regulator_get_regmap(struct regulator * regulator)3580 struct regmap *regulator_get_regmap(struct regulator *regulator)
3581 {
3582 struct regmap *map = regulator->rdev->regmap;
3583
3584 return map ? map : ERR_PTR(-EOPNOTSUPP);
3585 }
3586 EXPORT_SYMBOL_GPL(regulator_get_regmap);
3587
3588 /**
3589 * regulator_get_hardware_vsel_register - get the HW voltage selector register
3590 * @regulator: regulator source
3591 * @vsel_reg: voltage selector register, output parameter
3592 * @vsel_mask: mask for voltage selector bitfield, output parameter
3593 *
3594 * Returns the hardware register offset and bitmask used for setting the
3595 * regulator voltage. This might be useful when configuring voltage-scaling
3596 * hardware or firmware that can make I2C requests behind the kernel's back,
3597 * for example.
3598 *
3599 * Return: 0 on success, or -%EOPNOTSUPP if the regulator does not support
3600 * voltage selectors.
3601 *
3602 * On success, the output parameters @vsel_reg and @vsel_mask are filled in
3603 * and 0 is returned, otherwise a negative error number is returned.
3604 */
regulator_get_hardware_vsel_register(struct regulator * regulator,unsigned * vsel_reg,unsigned * vsel_mask)3605 int regulator_get_hardware_vsel_register(struct regulator *regulator,
3606 unsigned *vsel_reg,
3607 unsigned *vsel_mask)
3608 {
3609 struct regulator_dev *rdev = regulator->rdev;
3610 const struct regulator_ops *ops = rdev->desc->ops;
3611
3612 if (ops->set_voltage_sel != regulator_set_voltage_sel_regmap)
3613 return -EOPNOTSUPP;
3614
3615 *vsel_reg = rdev->desc->vsel_reg;
3616 *vsel_mask = rdev->desc->vsel_mask;
3617
3618 return 0;
3619 }
3620 EXPORT_SYMBOL_GPL(regulator_get_hardware_vsel_register);
3621
3622 /**
3623 * regulator_list_hardware_vsel - get the HW-specific register value for a selector
3624 * @regulator: regulator source
3625 * @selector: identify voltage to list
3626 *
3627 * Converts the selector to a hardware-specific voltage selector that can be
3628 * directly written to the regulator registers. The address of the voltage
3629 * register can be determined by calling @regulator_get_hardware_vsel_register.
3630 *
3631 * Return: 0 on success, -%EINVAL if the selector is outside the supported
3632 * range, or -%EOPNOTSUPP if the regulator does not support voltage
3633 * selectors.
3634 */
regulator_list_hardware_vsel(struct regulator * regulator,unsigned selector)3635 int regulator_list_hardware_vsel(struct regulator *regulator,
3636 unsigned selector)
3637 {
3638 struct regulator_dev *rdev = regulator->rdev;
3639 const struct regulator_ops *ops = rdev->desc->ops;
3640
3641 if (selector >= rdev->desc->n_voltages)
3642 return -EINVAL;
3643 if (selector < rdev->desc->linear_min_sel)
3644 return 0;
3645 if (ops->set_voltage_sel != regulator_set_voltage_sel_regmap)
3646 return -EOPNOTSUPP;
3647
3648 return selector;
3649 }
3650 EXPORT_SYMBOL_GPL(regulator_list_hardware_vsel);
3651
3652 /**
3653 * regulator_hardware_enable - access the HW for enable/disable regulator
3654 * @regulator: regulator source
3655 * @enable: true for enable, false for disable
3656 *
3657 * Request that the regulator be enabled/disabled with the regulator output at
3658 * the predefined voltage or current value.
3659 *
3660 * Return: 0 on success or a negative error number on failure.
3661 */
regulator_hardware_enable(struct regulator * regulator,bool enable)3662 int regulator_hardware_enable(struct regulator *regulator, bool enable)
3663 {
3664 struct regulator_dev *rdev = regulator->rdev;
3665 const struct regulator_ops *ops = rdev->desc->ops;
3666 int ret = -EOPNOTSUPP;
3667
3668 if (!rdev->exclusive || !ops || !ops->enable || !ops->disable)
3669 return ret;
3670
3671 if (enable)
3672 ret = ops->enable(rdev);
3673 else
3674 ret = ops->disable(rdev);
3675
3676 return ret;
3677 }
3678 EXPORT_SYMBOL_GPL(regulator_hardware_enable);
3679
3680 /**
3681 * regulator_get_linear_step - return the voltage step size between VSEL values
3682 * @regulator: regulator source
3683 *
3684 * Return: The voltage step size between VSEL values for linear regulators,
3685 * or 0 if the regulator isn't a linear regulator.
3686 */
regulator_get_linear_step(struct regulator * regulator)3687 unsigned int regulator_get_linear_step(struct regulator *regulator)
3688 {
3689 struct regulator_dev *rdev = regulator->rdev;
3690
3691 return rdev->desc->uV_step;
3692 }
3693 EXPORT_SYMBOL_GPL(regulator_get_linear_step);
3694
3695 /**
3696 * regulator_is_supported_voltage - check if a voltage range can be supported
3697 *
3698 * @regulator: Regulator to check.
3699 * @min_uV: Minimum required voltage in uV.
3700 * @max_uV: Maximum required voltage in uV.
3701 *
3702 * Return: 1 if the voltage range is supported, 0 if not, or a negative error
3703 * number if @regulator's voltage can't be changed and voltage readback
3704 * failed.
3705 */
regulator_is_supported_voltage(struct regulator * regulator,int min_uV,int max_uV)3706 int regulator_is_supported_voltage(struct regulator *regulator,
3707 int min_uV, int max_uV)
3708 {
3709 struct regulator_dev *rdev = regulator->rdev;
3710 int i, voltages, ret;
3711
3712 /* If we can't change voltage check the current voltage */
3713 if (!regulator_ops_is_valid(rdev, REGULATOR_CHANGE_VOLTAGE)) {
3714 ret = regulator_get_voltage(regulator);
3715 if (ret >= 0)
3716 return min_uV <= ret && ret <= max_uV;
3717 else
3718 return ret;
3719 }
3720
3721 /* Any voltage within constrains range is fine? */
3722 if (rdev->desc->continuous_voltage_range)
3723 return min_uV >= rdev->constraints->min_uV &&
3724 max_uV <= rdev->constraints->max_uV;
3725
3726 ret = regulator_count_voltages(regulator);
3727 if (ret < 0)
3728 return 0;
3729 voltages = ret;
3730
3731 for (i = 0; i < voltages; i++) {
3732 ret = regulator_list_voltage(regulator, i);
3733
3734 if (ret >= min_uV && ret <= max_uV)
3735 return 1;
3736 }
3737
3738 return 0;
3739 }
3740 EXPORT_SYMBOL_GPL(regulator_is_supported_voltage);
3741
regulator_map_voltage(struct regulator_dev * rdev,int min_uV,int max_uV)3742 static int regulator_map_voltage(struct regulator_dev *rdev, int min_uV,
3743 int max_uV)
3744 {
3745 const struct regulator_desc *desc = rdev->desc;
3746
3747 if (desc->ops->map_voltage)
3748 return desc->ops->map_voltage(rdev, min_uV, max_uV);
3749
3750 if (desc->ops->list_voltage == regulator_list_voltage_linear)
3751 return regulator_map_voltage_linear(rdev, min_uV, max_uV);
3752
3753 if (desc->ops->list_voltage == regulator_list_voltage_linear_range)
3754 return regulator_map_voltage_linear_range(rdev, min_uV, max_uV);
3755
3756 if (desc->ops->list_voltage ==
3757 regulator_list_voltage_pickable_linear_range)
3758 return regulator_map_voltage_pickable_linear_range(rdev,
3759 min_uV, max_uV);
3760
3761 return regulator_map_voltage_iterate(rdev, min_uV, max_uV);
3762 }
3763
_regulator_call_set_voltage(struct regulator_dev * rdev,int min_uV,int max_uV,unsigned * selector)3764 static int _regulator_call_set_voltage(struct regulator_dev *rdev,
3765 int min_uV, int max_uV,
3766 unsigned *selector)
3767 {
3768 struct pre_voltage_change_data data;
3769 int ret;
3770
3771 data.old_uV = regulator_get_voltage_rdev(rdev);
3772 data.min_uV = min_uV;
3773 data.max_uV = max_uV;
3774 ret = _notifier_call_chain(rdev, REGULATOR_EVENT_PRE_VOLTAGE_CHANGE,
3775 &data);
3776 if (ret & NOTIFY_STOP_MASK)
3777 return -EINVAL;
3778
3779 ret = rdev->desc->ops->set_voltage(rdev, min_uV, max_uV, selector);
3780 if (ret >= 0)
3781 return ret;
3782
3783 _notifier_call_chain(rdev, REGULATOR_EVENT_ABORT_VOLTAGE_CHANGE,
3784 (void *)data.old_uV);
3785
3786 return ret;
3787 }
3788
_regulator_call_set_voltage_sel(struct regulator_dev * rdev,int uV,unsigned selector)3789 static int _regulator_call_set_voltage_sel(struct regulator_dev *rdev,
3790 int uV, unsigned selector)
3791 {
3792 struct pre_voltage_change_data data;
3793 int ret;
3794
3795 data.old_uV = regulator_get_voltage_rdev(rdev);
3796 data.min_uV = uV;
3797 data.max_uV = uV;
3798 ret = _notifier_call_chain(rdev, REGULATOR_EVENT_PRE_VOLTAGE_CHANGE,
3799 &data);
3800 if (ret & NOTIFY_STOP_MASK)
3801 return -EINVAL;
3802
3803 ret = rdev->desc->ops->set_voltage_sel(rdev, selector);
3804 if (ret >= 0)
3805 return ret;
3806
3807 _notifier_call_chain(rdev, REGULATOR_EVENT_ABORT_VOLTAGE_CHANGE,
3808 (void *)data.old_uV);
3809
3810 return ret;
3811 }
3812
_regulator_set_voltage_sel_step(struct regulator_dev * rdev,int uV,int new_selector)3813 static int _regulator_set_voltage_sel_step(struct regulator_dev *rdev,
3814 int uV, int new_selector)
3815 {
3816 const struct regulator_ops *ops = rdev->desc->ops;
3817 int diff, old_sel, curr_sel, ret;
3818
3819 /* Stepping is only needed if the regulator is enabled. */
3820 if (!_regulator_is_enabled(rdev))
3821 goto final_set;
3822
3823 if (!ops->get_voltage_sel)
3824 return -EINVAL;
3825
3826 old_sel = ops->get_voltage_sel(rdev);
3827 if (old_sel < 0)
3828 return old_sel;
3829
3830 diff = new_selector - old_sel;
3831 if (diff == 0)
3832 return 0; /* No change needed. */
3833
3834 if (diff > 0) {
3835 /* Stepping up. */
3836 for (curr_sel = old_sel + rdev->desc->vsel_step;
3837 curr_sel < new_selector;
3838 curr_sel += rdev->desc->vsel_step) {
3839 /*
3840 * Call the callback directly instead of using
3841 * _regulator_call_set_voltage_sel() as we don't
3842 * want to notify anyone yet. Same in the branch
3843 * below.
3844 */
3845 ret = ops->set_voltage_sel(rdev, curr_sel);
3846 if (ret)
3847 goto try_revert;
3848 }
3849 } else {
3850 /* Stepping down. */
3851 for (curr_sel = old_sel - rdev->desc->vsel_step;
3852 curr_sel > new_selector;
3853 curr_sel -= rdev->desc->vsel_step) {
3854 ret = ops->set_voltage_sel(rdev, curr_sel);
3855 if (ret)
3856 goto try_revert;
3857 }
3858 }
3859
3860 final_set:
3861 /* The final selector will trigger the notifiers. */
3862 return _regulator_call_set_voltage_sel(rdev, uV, new_selector);
3863
3864 try_revert:
3865 /*
3866 * At least try to return to the previous voltage if setting a new
3867 * one failed.
3868 */
3869 (void)ops->set_voltage_sel(rdev, old_sel);
3870 return ret;
3871 }
3872
_regulator_set_voltage_time(struct regulator_dev * rdev,int old_uV,int new_uV)3873 static int _regulator_set_voltage_time(struct regulator_dev *rdev,
3874 int old_uV, int new_uV)
3875 {
3876 unsigned int ramp_delay = 0;
3877
3878 if (rdev->constraints->ramp_delay)
3879 ramp_delay = rdev->constraints->ramp_delay;
3880 else if (rdev->desc->ramp_delay)
3881 ramp_delay = rdev->desc->ramp_delay;
3882 else if (rdev->constraints->settling_time)
3883 return rdev->constraints->settling_time;
3884 else if (rdev->constraints->settling_time_up &&
3885 (new_uV > old_uV))
3886 return rdev->constraints->settling_time_up;
3887 else if (rdev->constraints->settling_time_down &&
3888 (new_uV < old_uV))
3889 return rdev->constraints->settling_time_down;
3890
3891 if (ramp_delay == 0)
3892 return 0;
3893
3894 return DIV_ROUND_UP(abs(new_uV - old_uV), ramp_delay);
3895 }
3896
_regulator_do_set_voltage(struct regulator_dev * rdev,int min_uV,int max_uV)3897 static int _regulator_do_set_voltage(struct regulator_dev *rdev,
3898 int min_uV, int max_uV)
3899 {
3900 int ret;
3901 int delay = 0;
3902 int best_val = 0;
3903 unsigned int selector;
3904 int old_selector = -1;
3905 const struct regulator_ops *ops = rdev->desc->ops;
3906 int old_uV = regulator_get_voltage_rdev(rdev);
3907
3908 trace_regulator_set_voltage(rdev_get_name(rdev), min_uV, max_uV);
3909
3910 min_uV += rdev->constraints->uV_offset;
3911 max_uV += rdev->constraints->uV_offset;
3912
3913 /*
3914 * If we can't obtain the old selector there is not enough
3915 * info to call set_voltage_time_sel().
3916 */
3917 if (_regulator_is_enabled(rdev) &&
3918 ops->set_voltage_time_sel && ops->get_voltage_sel) {
3919 old_selector = ops->get_voltage_sel(rdev);
3920 if (old_selector < 0)
3921 return old_selector;
3922 }
3923
3924 if (ops->set_voltage) {
3925 ret = _regulator_call_set_voltage(rdev, min_uV, max_uV,
3926 &selector);
3927
3928 if (ret >= 0) {
3929 if (ops->list_voltage)
3930 best_val = ops->list_voltage(rdev,
3931 selector);
3932 else
3933 best_val = regulator_get_voltage_rdev(rdev);
3934 }
3935
3936 } else if (ops->set_voltage_sel) {
3937 ret = regulator_map_voltage(rdev, min_uV, max_uV);
3938 if (ret >= 0) {
3939 best_val = ops->list_voltage(rdev, ret);
3940 if (min_uV <= best_val && max_uV >= best_val) {
3941 selector = ret;
3942 if (old_selector == selector)
3943 ret = 0;
3944 else if (rdev->desc->vsel_step)
3945 ret = _regulator_set_voltage_sel_step(
3946 rdev, best_val, selector);
3947 else
3948 ret = _regulator_call_set_voltage_sel(
3949 rdev, best_val, selector);
3950 } else {
3951 ret = -EINVAL;
3952 }
3953 }
3954 } else {
3955 ret = -EINVAL;
3956 }
3957
3958 if (ret)
3959 goto out;
3960
3961 if (ops->set_voltage_time_sel) {
3962 /*
3963 * Call set_voltage_time_sel if successfully obtained
3964 * old_selector
3965 */
3966 if (old_selector >= 0 && old_selector != selector)
3967 delay = ops->set_voltage_time_sel(rdev, old_selector,
3968 selector);
3969 } else {
3970 if (old_uV != best_val) {
3971 if (ops->set_voltage_time)
3972 delay = ops->set_voltage_time(rdev, old_uV,
3973 best_val);
3974 else
3975 delay = _regulator_set_voltage_time(rdev,
3976 old_uV,
3977 best_val);
3978 }
3979 }
3980
3981 if (delay < 0) {
3982 rdev_warn(rdev, "failed to get delay: %pe\n", ERR_PTR(delay));
3983 delay = 0;
3984 }
3985
3986 /* Insert any necessary delays */
3987 fsleep(delay);
3988
3989 if (best_val >= 0) {
3990 unsigned long data = best_val;
3991
3992 _notifier_call_chain(rdev, REGULATOR_EVENT_VOLTAGE_CHANGE,
3993 (void *)data);
3994 }
3995
3996 out:
3997 trace_regulator_set_voltage_complete(rdev_get_name(rdev), best_val);
3998
3999 return ret;
4000 }
4001
_regulator_do_set_suspend_voltage(struct regulator_dev * rdev,int min_uV,int max_uV,suspend_state_t state)4002 static int _regulator_do_set_suspend_voltage(struct regulator_dev *rdev,
4003 int min_uV, int max_uV, suspend_state_t state)
4004 {
4005 struct regulator_state *rstate;
4006 int uV, sel;
4007
4008 rstate = regulator_get_suspend_state(rdev, state);
4009 if (rstate == NULL)
4010 return -EINVAL;
4011
4012 if (min_uV < rstate->min_uV)
4013 min_uV = rstate->min_uV;
4014 if (max_uV > rstate->max_uV)
4015 max_uV = rstate->max_uV;
4016
4017 sel = regulator_map_voltage(rdev, min_uV, max_uV);
4018 if (sel < 0)
4019 return sel;
4020
4021 uV = rdev->desc->ops->list_voltage(rdev, sel);
4022 if (uV >= min_uV && uV <= max_uV)
4023 rstate->uV = uV;
4024
4025 return 0;
4026 }
4027
regulator_get_voltage_delta(struct regulator_dev * rdev,int uV)4028 static int regulator_get_voltage_delta(struct regulator_dev *rdev, int uV)
4029 {
4030 int current_uV = regulator_get_voltage_rdev(rdev);
4031
4032 if (current_uV < 0)
4033 return current_uV;
4034
4035 return abs(current_uV - uV);
4036 }
4037
regulator_set_voltage_unlocked(struct regulator * regulator,int min_uV,int max_uV,suspend_state_t state)4038 static int regulator_set_voltage_unlocked(struct regulator *regulator,
4039 int min_uV, int max_uV,
4040 suspend_state_t state)
4041 {
4042 struct regulator_dev *rdev = regulator->rdev;
4043 struct regulator_voltage *voltage = ®ulator->voltage[state];
4044 int ret = 0;
4045 int current_uV, delta, new_delta;
4046 int old_min_uV, old_max_uV;
4047
4048 /* If we're setting the same range as last time the change
4049 * should be a noop (some cpufreq implementations use the same
4050 * voltage for multiple frequencies, for example).
4051 */
4052 if (voltage->min_uV == min_uV && voltage->max_uV == max_uV)
4053 goto out;
4054
4055 /* If we're trying to set a range that overlaps the current voltage,
4056 * return successfully even though the regulator does not support
4057 * changing the voltage.
4058 */
4059 if (!regulator_ops_is_valid(rdev, REGULATOR_CHANGE_VOLTAGE)) {
4060 current_uV = regulator_get_voltage_rdev(rdev);
4061 if (min_uV <= current_uV && current_uV <= max_uV) {
4062 voltage->min_uV = min_uV;
4063 voltage->max_uV = max_uV;
4064 goto out;
4065 }
4066 }
4067
4068 /* sanity check */
4069 if (!rdev->desc->ops->set_voltage &&
4070 !rdev->desc->ops->set_voltage_sel) {
4071 ret = -EINVAL;
4072 goto out;
4073 }
4074
4075 /* constraints check */
4076 ret = regulator_check_voltage(rdev, &min_uV, &max_uV);
4077 if (ret < 0)
4078 goto out;
4079
4080 /* restore original values in case of error */
4081 old_min_uV = voltage->min_uV;
4082 old_max_uV = voltage->max_uV;
4083 voltage->min_uV = min_uV;
4084 voltage->max_uV = max_uV;
4085
4086 /* for not coupled regulators this will just set the voltage */
4087 ret = regulator_balance_voltage(rdev, state);
4088 if (ret < 0) {
4089 voltage->min_uV = old_min_uV;
4090 voltage->max_uV = old_max_uV;
4091 }
4092
4093 if (rdev->constraints->max_uV_step > 0) {
4094 /* For regulators with a maximum voltage step, reaching the desired
4095 * voltage might take a few retries.
4096 */
4097 ret = regulator_get_voltage_delta(rdev, min_uV);
4098 if (ret < 0)
4099 goto out;
4100
4101 delta = ret;
4102
4103 while (delta > 0) {
4104 ret = regulator_balance_voltage(rdev, state);
4105 if (ret < 0)
4106 goto out;
4107
4108 ret = regulator_get_voltage_delta(rdev, min_uV);
4109 if (ret < 0)
4110 goto out;
4111
4112 new_delta = ret;
4113
4114 /* check that voltage is converging quickly enough */
4115 if (delta - new_delta < rdev->constraints->max_uV_step) {
4116 ret = -EWOULDBLOCK;
4117 goto out;
4118 }
4119
4120 delta = new_delta;
4121 }
4122 }
4123
4124 out:
4125 return ret;
4126 }
4127
regulator_set_voltage_rdev(struct regulator_dev * rdev,int min_uV,int max_uV,suspend_state_t state)4128 int regulator_set_voltage_rdev(struct regulator_dev *rdev, int min_uV,
4129 int max_uV, suspend_state_t state)
4130 {
4131 int best_supply_uV = 0;
4132 int supply_change_uV = 0;
4133 int ret;
4134
4135 if (rdev->supply &&
4136 regulator_ops_is_valid(rdev->supply->rdev,
4137 REGULATOR_CHANGE_VOLTAGE) &&
4138 (rdev->desc->min_dropout_uV || !(rdev->desc->ops->get_voltage ||
4139 rdev->desc->ops->get_voltage_sel))) {
4140 int current_supply_uV;
4141 int selector;
4142
4143 selector = regulator_map_voltage(rdev, min_uV, max_uV);
4144 if (selector < 0) {
4145 ret = selector;
4146 goto out;
4147 }
4148
4149 best_supply_uV = _regulator_list_voltage(rdev, selector, 0);
4150 if (best_supply_uV < 0) {
4151 ret = best_supply_uV;
4152 goto out;
4153 }
4154
4155 best_supply_uV += rdev->desc->min_dropout_uV;
4156
4157 current_supply_uV = regulator_get_voltage_rdev(rdev->supply->rdev);
4158 if (current_supply_uV < 0) {
4159 ret = current_supply_uV;
4160 goto out;
4161 }
4162
4163 supply_change_uV = best_supply_uV - current_supply_uV;
4164 }
4165
4166 if (supply_change_uV > 0) {
4167 ret = regulator_set_voltage_unlocked(rdev->supply,
4168 best_supply_uV, INT_MAX, state);
4169 if (ret) {
4170 dev_err(&rdev->dev, "Failed to increase supply voltage: %pe\n",
4171 ERR_PTR(ret));
4172 goto out;
4173 }
4174 }
4175
4176 if (state == PM_SUSPEND_ON)
4177 ret = _regulator_do_set_voltage(rdev, min_uV, max_uV);
4178 else
4179 ret = _regulator_do_set_suspend_voltage(rdev, min_uV,
4180 max_uV, state);
4181 if (ret < 0)
4182 goto out;
4183
4184 if (supply_change_uV < 0) {
4185 ret = regulator_set_voltage_unlocked(rdev->supply,
4186 best_supply_uV, INT_MAX, state);
4187 if (ret)
4188 dev_warn(&rdev->dev, "Failed to decrease supply voltage: %pe\n",
4189 ERR_PTR(ret));
4190 /* No need to fail here */
4191 ret = 0;
4192 }
4193
4194 out:
4195 return ret;
4196 }
4197 EXPORT_SYMBOL_GPL(regulator_set_voltage_rdev);
4198
regulator_limit_voltage_step(struct regulator_dev * rdev,int * current_uV,int * min_uV)4199 static int regulator_limit_voltage_step(struct regulator_dev *rdev,
4200 int *current_uV, int *min_uV)
4201 {
4202 struct regulation_constraints *constraints = rdev->constraints;
4203
4204 /* Limit voltage change only if necessary */
4205 if (!constraints->max_uV_step || !_regulator_is_enabled(rdev))
4206 return 1;
4207
4208 if (*current_uV < 0) {
4209 *current_uV = regulator_get_voltage_rdev(rdev);
4210
4211 if (*current_uV < 0)
4212 return *current_uV;
4213 }
4214
4215 if (abs(*current_uV - *min_uV) <= constraints->max_uV_step)
4216 return 1;
4217
4218 /* Clamp target voltage within the given step */
4219 if (*current_uV < *min_uV)
4220 *min_uV = min(*current_uV + constraints->max_uV_step,
4221 *min_uV);
4222 else
4223 *min_uV = max(*current_uV - constraints->max_uV_step,
4224 *min_uV);
4225
4226 return 0;
4227 }
4228
regulator_get_optimal_voltage(struct regulator_dev * rdev,int * current_uV,int * min_uV,int * max_uV,suspend_state_t state,int n_coupled)4229 static int regulator_get_optimal_voltage(struct regulator_dev *rdev,
4230 int *current_uV,
4231 int *min_uV, int *max_uV,
4232 suspend_state_t state,
4233 int n_coupled)
4234 {
4235 struct coupling_desc *c_desc = &rdev->coupling_desc;
4236 struct regulator_dev **c_rdevs = c_desc->coupled_rdevs;
4237 struct regulation_constraints *constraints = rdev->constraints;
4238 int desired_min_uV = 0, desired_max_uV = INT_MAX;
4239 int max_current_uV = 0, min_current_uV = INT_MAX;
4240 int highest_min_uV = 0, target_uV, possible_uV;
4241 int i, ret, max_spread;
4242 bool done;
4243
4244 *current_uV = -1;
4245
4246 /*
4247 * If there are no coupled regulators, simply set the voltage
4248 * demanded by consumers.
4249 */
4250 if (n_coupled == 1) {
4251 /*
4252 * If consumers don't provide any demands, set voltage
4253 * to min_uV
4254 */
4255 desired_min_uV = constraints->min_uV;
4256 desired_max_uV = constraints->max_uV;
4257
4258 ret = regulator_check_consumers(rdev,
4259 &desired_min_uV,
4260 &desired_max_uV, state);
4261 if (ret < 0)
4262 return ret;
4263
4264 done = true;
4265
4266 goto finish;
4267 }
4268
4269 /* Find highest min desired voltage */
4270 for (i = 0; i < n_coupled; i++) {
4271 int tmp_min = 0;
4272 int tmp_max = INT_MAX;
4273
4274 lockdep_assert_held_once(&c_rdevs[i]->mutex.base);
4275
4276 ret = regulator_check_consumers(c_rdevs[i],
4277 &tmp_min,
4278 &tmp_max, state);
4279 if (ret < 0)
4280 return ret;
4281
4282 ret = regulator_check_voltage(c_rdevs[i], &tmp_min, &tmp_max);
4283 if (ret < 0)
4284 return ret;
4285
4286 highest_min_uV = max(highest_min_uV, tmp_min);
4287
4288 if (i == 0) {
4289 desired_min_uV = tmp_min;
4290 desired_max_uV = tmp_max;
4291 }
4292 }
4293
4294 max_spread = constraints->max_spread[0];
4295
4296 /*
4297 * Let target_uV be equal to the desired one if possible.
4298 * If not, set it to minimum voltage, allowed by other coupled
4299 * regulators.
4300 */
4301 target_uV = max(desired_min_uV, highest_min_uV - max_spread);
4302
4303 /*
4304 * Find min and max voltages, which currently aren't violating
4305 * max_spread.
4306 */
4307 for (i = 1; i < n_coupled; i++) {
4308 int tmp_act;
4309
4310 if (!_regulator_is_enabled(c_rdevs[i]))
4311 continue;
4312
4313 tmp_act = regulator_get_voltage_rdev(c_rdevs[i]);
4314 if (tmp_act < 0)
4315 return tmp_act;
4316
4317 min_current_uV = min(tmp_act, min_current_uV);
4318 max_current_uV = max(tmp_act, max_current_uV);
4319 }
4320
4321 /* There aren't any other regulators enabled */
4322 if (max_current_uV == 0) {
4323 possible_uV = target_uV;
4324 } else {
4325 /*
4326 * Correct target voltage, so as it currently isn't
4327 * violating max_spread
4328 */
4329 possible_uV = max(target_uV, max_current_uV - max_spread);
4330 possible_uV = min(possible_uV, min_current_uV + max_spread);
4331 }
4332
4333 if (possible_uV > desired_max_uV)
4334 return -EINVAL;
4335
4336 done = (possible_uV == target_uV);
4337 desired_min_uV = possible_uV;
4338
4339 finish:
4340 /* Apply max_uV_step constraint if necessary */
4341 if (state == PM_SUSPEND_ON) {
4342 ret = regulator_limit_voltage_step(rdev, current_uV,
4343 &desired_min_uV);
4344 if (ret < 0)
4345 return ret;
4346
4347 if (ret == 0)
4348 done = false;
4349 }
4350
4351 /* Set current_uV if wasn't done earlier in the code and if necessary */
4352 if (n_coupled > 1 && *current_uV == -1) {
4353
4354 if (_regulator_is_enabled(rdev)) {
4355 ret = regulator_get_voltage_rdev(rdev);
4356 if (ret < 0)
4357 return ret;
4358
4359 *current_uV = ret;
4360 } else {
4361 *current_uV = desired_min_uV;
4362 }
4363 }
4364
4365 *min_uV = desired_min_uV;
4366 *max_uV = desired_max_uV;
4367
4368 return done;
4369 }
4370
regulator_do_balance_voltage(struct regulator_dev * rdev,suspend_state_t state,bool skip_coupled)4371 int regulator_do_balance_voltage(struct regulator_dev *rdev,
4372 suspend_state_t state, bool skip_coupled)
4373 {
4374 struct regulator_dev **c_rdevs;
4375 struct regulator_dev *best_rdev;
4376 struct coupling_desc *c_desc = &rdev->coupling_desc;
4377 int i, ret, n_coupled, best_min_uV, best_max_uV, best_c_rdev;
4378 unsigned int delta, best_delta;
4379 unsigned long c_rdev_done = 0;
4380 bool best_c_rdev_done;
4381
4382 c_rdevs = c_desc->coupled_rdevs;
4383 n_coupled = skip_coupled ? 1 : c_desc->n_coupled;
4384
4385 /*
4386 * Find the best possible voltage change on each loop. Leave the loop
4387 * if there isn't any possible change.
4388 */
4389 do {
4390 best_c_rdev_done = false;
4391 best_delta = 0;
4392 best_min_uV = 0;
4393 best_max_uV = 0;
4394 best_c_rdev = 0;
4395 best_rdev = NULL;
4396
4397 /*
4398 * Find highest difference between optimal voltage
4399 * and current voltage.
4400 */
4401 for (i = 0; i < n_coupled; i++) {
4402 /*
4403 * optimal_uV is the best voltage that can be set for
4404 * i-th regulator at the moment without violating
4405 * max_spread constraint in order to balance
4406 * the coupled voltages.
4407 */
4408 int optimal_uV = 0, optimal_max_uV = 0, current_uV = 0;
4409
4410 if (test_bit(i, &c_rdev_done))
4411 continue;
4412
4413 ret = regulator_get_optimal_voltage(c_rdevs[i],
4414 ¤t_uV,
4415 &optimal_uV,
4416 &optimal_max_uV,
4417 state, n_coupled);
4418 if (ret < 0)
4419 goto out;
4420
4421 delta = abs(optimal_uV - current_uV);
4422
4423 if (delta && best_delta <= delta) {
4424 best_c_rdev_done = ret;
4425 best_delta = delta;
4426 best_rdev = c_rdevs[i];
4427 best_min_uV = optimal_uV;
4428 best_max_uV = optimal_max_uV;
4429 best_c_rdev = i;
4430 }
4431 }
4432
4433 /* Nothing to change, return successfully */
4434 if (!best_rdev) {
4435 ret = 0;
4436 goto out;
4437 }
4438
4439 ret = regulator_set_voltage_rdev(best_rdev, best_min_uV,
4440 best_max_uV, state);
4441
4442 if (ret < 0)
4443 goto out;
4444
4445 if (best_c_rdev_done)
4446 set_bit(best_c_rdev, &c_rdev_done);
4447
4448 } while (n_coupled > 1);
4449
4450 out:
4451 return ret;
4452 }
4453
regulator_balance_voltage(struct regulator_dev * rdev,suspend_state_t state)4454 static int regulator_balance_voltage(struct regulator_dev *rdev,
4455 suspend_state_t state)
4456 {
4457 struct coupling_desc *c_desc = &rdev->coupling_desc;
4458 struct regulator_coupler *coupler = c_desc->coupler;
4459 bool skip_coupled = false;
4460
4461 /*
4462 * If system is in a state other than PM_SUSPEND_ON, don't check
4463 * other coupled regulators.
4464 */
4465 if (state != PM_SUSPEND_ON)
4466 skip_coupled = true;
4467
4468 if (c_desc->n_resolved < c_desc->n_coupled) {
4469 rdev_err(rdev, "Not all coupled regulators registered\n");
4470 return -EPERM;
4471 }
4472
4473 /* Invoke custom balancer for customized couplers */
4474 if (coupler && coupler->balance_voltage)
4475 return coupler->balance_voltage(coupler, rdev, state);
4476
4477 return regulator_do_balance_voltage(rdev, state, skip_coupled);
4478 }
4479
4480 /**
4481 * regulator_set_voltage - set regulator output voltage
4482 * @regulator: regulator source
4483 * @min_uV: Minimum required voltage in uV
4484 * @max_uV: Maximum acceptable voltage in uV
4485 *
4486 * Sets a voltage regulator to the desired output voltage. This can be set
4487 * during any regulator state. IOW, regulator can be disabled or enabled.
4488 *
4489 * If the regulator is enabled then the voltage will change to the new value
4490 * immediately otherwise if the regulator is disabled the regulator will
4491 * output at the new voltage when enabled.
4492 *
4493 * NOTE: If the regulator is shared between several devices then the lowest
4494 * request voltage that meets the system constraints will be used.
4495 * Regulator system constraints must be set for this regulator before
4496 * calling this function otherwise this call will fail.
4497 *
4498 * Return: 0 on success or a negative error number on failure.
4499 */
regulator_set_voltage(struct regulator * regulator,int min_uV,int max_uV)4500 int regulator_set_voltage(struct regulator *regulator, int min_uV, int max_uV)
4501 {
4502 struct ww_acquire_ctx ww_ctx;
4503 int ret;
4504
4505 regulator_lock_dependent(regulator->rdev, &ww_ctx);
4506
4507 ret = regulator_set_voltage_unlocked(regulator, min_uV, max_uV,
4508 PM_SUSPEND_ON);
4509
4510 regulator_unlock_dependent(regulator->rdev, &ww_ctx);
4511
4512 return ret;
4513 }
4514 EXPORT_SYMBOL_GPL(regulator_set_voltage);
4515
regulator_suspend_toggle(struct regulator_dev * rdev,suspend_state_t state,bool en)4516 static inline int regulator_suspend_toggle(struct regulator_dev *rdev,
4517 suspend_state_t state, bool en)
4518 {
4519 struct regulator_state *rstate;
4520
4521 rstate = regulator_get_suspend_state(rdev, state);
4522 if (rstate == NULL)
4523 return -EINVAL;
4524
4525 if (!rstate->changeable)
4526 return -EPERM;
4527
4528 rstate->enabled = (en) ? ENABLE_IN_SUSPEND : DISABLE_IN_SUSPEND;
4529
4530 return 0;
4531 }
4532
regulator_suspend_enable(struct regulator_dev * rdev,suspend_state_t state)4533 int regulator_suspend_enable(struct regulator_dev *rdev,
4534 suspend_state_t state)
4535 {
4536 return regulator_suspend_toggle(rdev, state, true);
4537 }
4538 EXPORT_SYMBOL_GPL(regulator_suspend_enable);
4539
regulator_suspend_disable(struct regulator_dev * rdev,suspend_state_t state)4540 int regulator_suspend_disable(struct regulator_dev *rdev,
4541 suspend_state_t state)
4542 {
4543 struct regulator *regulator;
4544 struct regulator_voltage *voltage;
4545
4546 /*
4547 * if any consumer wants this regulator device keeping on in
4548 * suspend states, don't set it as disabled.
4549 */
4550 list_for_each_entry(regulator, &rdev->consumer_list, list) {
4551 voltage = ®ulator->voltage[state];
4552 if (voltage->min_uV || voltage->max_uV)
4553 return 0;
4554 }
4555
4556 return regulator_suspend_toggle(rdev, state, false);
4557 }
4558 EXPORT_SYMBOL_GPL(regulator_suspend_disable);
4559
_regulator_set_suspend_voltage(struct regulator * regulator,int min_uV,int max_uV,suspend_state_t state)4560 static int _regulator_set_suspend_voltage(struct regulator *regulator,
4561 int min_uV, int max_uV,
4562 suspend_state_t state)
4563 {
4564 struct regulator_dev *rdev = regulator->rdev;
4565 struct regulator_state *rstate;
4566
4567 rstate = regulator_get_suspend_state(rdev, state);
4568 if (rstate == NULL)
4569 return -EINVAL;
4570
4571 if (rstate->min_uV == rstate->max_uV) {
4572 rdev_err(rdev, "The suspend voltage can't be changed!\n");
4573 return -EPERM;
4574 }
4575
4576 return regulator_set_voltage_unlocked(regulator, min_uV, max_uV, state);
4577 }
4578
regulator_set_suspend_voltage(struct regulator * regulator,int min_uV,int max_uV,suspend_state_t state)4579 int regulator_set_suspend_voltage(struct regulator *regulator, int min_uV,
4580 int max_uV, suspend_state_t state)
4581 {
4582 struct ww_acquire_ctx ww_ctx;
4583 int ret;
4584
4585 /* PM_SUSPEND_ON is handled by regulator_set_voltage() */
4586 if (regulator_check_states(state) || state == PM_SUSPEND_ON)
4587 return -EINVAL;
4588
4589 regulator_lock_dependent(regulator->rdev, &ww_ctx);
4590
4591 ret = _regulator_set_suspend_voltage(regulator, min_uV,
4592 max_uV, state);
4593
4594 regulator_unlock_dependent(regulator->rdev, &ww_ctx);
4595
4596 return ret;
4597 }
4598 EXPORT_SYMBOL_GPL(regulator_set_suspend_voltage);
4599
4600 /**
4601 * regulator_set_voltage_time - get raise/fall time
4602 * @regulator: regulator source
4603 * @old_uV: starting voltage in microvolts
4604 * @new_uV: target voltage in microvolts
4605 *
4606 * Provided with the starting and ending voltage, this function attempts to
4607 * calculate the time in microseconds required to rise or fall to this new
4608 * voltage.
4609 *
4610 * Return: ramp time in microseconds, or a negative error number if calculation failed.
4611 */
regulator_set_voltage_time(struct regulator * regulator,int old_uV,int new_uV)4612 int regulator_set_voltage_time(struct regulator *regulator,
4613 int old_uV, int new_uV)
4614 {
4615 struct regulator_dev *rdev = regulator->rdev;
4616 const struct regulator_ops *ops = rdev->desc->ops;
4617 int old_sel = -1;
4618 int new_sel = -1;
4619 int voltage;
4620 int i;
4621
4622 if (ops->set_voltage_time)
4623 return ops->set_voltage_time(rdev, old_uV, new_uV);
4624 else if (!ops->set_voltage_time_sel)
4625 return _regulator_set_voltage_time(rdev, old_uV, new_uV);
4626
4627 /* Currently requires operations to do this */
4628 if (!ops->list_voltage || !rdev->desc->n_voltages)
4629 return -EINVAL;
4630
4631 for (i = 0; i < rdev->desc->n_voltages; i++) {
4632 /* We only look for exact voltage matches here */
4633 if (i < rdev->desc->linear_min_sel)
4634 continue;
4635
4636 if (old_sel >= 0 && new_sel >= 0)
4637 break;
4638
4639 voltage = regulator_list_voltage(regulator, i);
4640 if (voltage < 0)
4641 return -EINVAL;
4642 if (voltage == 0)
4643 continue;
4644 if (voltage == old_uV)
4645 old_sel = i;
4646 if (voltage == new_uV)
4647 new_sel = i;
4648 }
4649
4650 if (old_sel < 0 || new_sel < 0)
4651 return -EINVAL;
4652
4653 return ops->set_voltage_time_sel(rdev, old_sel, new_sel);
4654 }
4655 EXPORT_SYMBOL_GPL(regulator_set_voltage_time);
4656
4657 /**
4658 * regulator_set_voltage_time_sel - get raise/fall time
4659 * @rdev: regulator source device
4660 * @old_selector: selector for starting voltage
4661 * @new_selector: selector for target voltage
4662 *
4663 * Provided with the starting and target voltage selectors, this function
4664 * returns time in microseconds required to rise or fall to this new voltage
4665 *
4666 * Drivers providing ramp_delay in regulation_constraints can use this as their
4667 * set_voltage_time_sel() operation.
4668 *
4669 * Return: ramp time in microseconds, or a negative error number if calculation failed.
4670 */
regulator_set_voltage_time_sel(struct regulator_dev * rdev,unsigned int old_selector,unsigned int new_selector)4671 int regulator_set_voltage_time_sel(struct regulator_dev *rdev,
4672 unsigned int old_selector,
4673 unsigned int new_selector)
4674 {
4675 int old_volt, new_volt;
4676
4677 /* sanity check */
4678 if (!rdev->desc->ops->list_voltage)
4679 return -EINVAL;
4680
4681 old_volt = rdev->desc->ops->list_voltage(rdev, old_selector);
4682 new_volt = rdev->desc->ops->list_voltage(rdev, new_selector);
4683
4684 if (rdev->desc->ops->set_voltage_time)
4685 return rdev->desc->ops->set_voltage_time(rdev, old_volt,
4686 new_volt);
4687 else
4688 return _regulator_set_voltage_time(rdev, old_volt, new_volt);
4689 }
4690 EXPORT_SYMBOL_GPL(regulator_set_voltage_time_sel);
4691
regulator_sync_voltage_rdev(struct regulator_dev * rdev)4692 int regulator_sync_voltage_rdev(struct regulator_dev *rdev)
4693 {
4694 int ret;
4695
4696 regulator_lock(rdev);
4697
4698 if (!rdev->desc->ops->set_voltage &&
4699 !rdev->desc->ops->set_voltage_sel) {
4700 ret = -EINVAL;
4701 goto out;
4702 }
4703
4704 /* balance only, if regulator is coupled */
4705 if (rdev->coupling_desc.n_coupled > 1)
4706 ret = regulator_balance_voltage(rdev, PM_SUSPEND_ON);
4707 else
4708 ret = -EOPNOTSUPP;
4709
4710 out:
4711 regulator_unlock(rdev);
4712 return ret;
4713 }
4714
4715 /**
4716 * regulator_sync_voltage - re-apply last regulator output voltage
4717 * @regulator: regulator source
4718 *
4719 * Re-apply the last configured voltage. This is intended to be used
4720 * where some external control source the consumer is cooperating with
4721 * has caused the configured voltage to change.
4722 *
4723 * Return: 0 on success or a negative error number on failure.
4724 */
regulator_sync_voltage(struct regulator * regulator)4725 int regulator_sync_voltage(struct regulator *regulator)
4726 {
4727 struct regulator_dev *rdev = regulator->rdev;
4728 struct regulator_voltage *voltage = ®ulator->voltage[PM_SUSPEND_ON];
4729 int ret, min_uV, max_uV;
4730
4731 if (!regulator_ops_is_valid(rdev, REGULATOR_CHANGE_VOLTAGE))
4732 return 0;
4733
4734 regulator_lock(rdev);
4735
4736 if (!rdev->desc->ops->set_voltage &&
4737 !rdev->desc->ops->set_voltage_sel) {
4738 ret = -EINVAL;
4739 goto out;
4740 }
4741
4742 /* This is only going to work if we've had a voltage configured. */
4743 if (!voltage->min_uV && !voltage->max_uV) {
4744 ret = -EINVAL;
4745 goto out;
4746 }
4747
4748 min_uV = voltage->min_uV;
4749 max_uV = voltage->max_uV;
4750
4751 /* This should be a paranoia check... */
4752 ret = regulator_check_voltage(rdev, &min_uV, &max_uV);
4753 if (ret < 0)
4754 goto out;
4755
4756 ret = regulator_check_consumers(rdev, &min_uV, &max_uV, 0);
4757 if (ret < 0)
4758 goto out;
4759
4760 /* balance only, if regulator is coupled */
4761 if (rdev->coupling_desc.n_coupled > 1)
4762 ret = regulator_balance_voltage(rdev, PM_SUSPEND_ON);
4763 else
4764 ret = _regulator_do_set_voltage(rdev, min_uV, max_uV);
4765
4766 out:
4767 regulator_unlock(rdev);
4768 return ret;
4769 }
4770 EXPORT_SYMBOL_GPL(regulator_sync_voltage);
4771
regulator_get_voltage_rdev(struct regulator_dev * rdev)4772 int regulator_get_voltage_rdev(struct regulator_dev *rdev)
4773 {
4774 int sel, ret;
4775 bool bypassed;
4776
4777 if (rdev->desc->ops->get_bypass) {
4778 ret = rdev->desc->ops->get_bypass(rdev, &bypassed);
4779 if (ret < 0)
4780 return ret;
4781 if (bypassed) {
4782 /* if bypassed the regulator must have a supply */
4783 if (!rdev->supply) {
4784 rdev_err(rdev,
4785 "bypassed regulator has no supply!\n");
4786 return -EPROBE_DEFER;
4787 }
4788
4789 return regulator_get_voltage_rdev(rdev->supply->rdev);
4790 }
4791 }
4792
4793 if (rdev->desc->ops->get_voltage_sel) {
4794 sel = rdev->desc->ops->get_voltage_sel(rdev);
4795 if (sel < 0)
4796 return sel;
4797 ret = rdev->desc->ops->list_voltage(rdev, sel);
4798 } else if (rdev->desc->ops->get_voltage) {
4799 ret = rdev->desc->ops->get_voltage(rdev);
4800 } else if (rdev->desc->ops->list_voltage) {
4801 ret = rdev->desc->ops->list_voltage(rdev, 0);
4802 } else if (rdev->desc->fixed_uV && (rdev->desc->n_voltages == 1)) {
4803 ret = rdev->desc->fixed_uV;
4804 } else if (rdev->supply) {
4805 ret = regulator_get_voltage_rdev(rdev->supply->rdev);
4806 } else if (rdev->supply_name) {
4807 return -EPROBE_DEFER;
4808 } else {
4809 return -EINVAL;
4810 }
4811
4812 if (ret < 0)
4813 return ret;
4814 return ret - rdev->constraints->uV_offset;
4815 }
4816 EXPORT_SYMBOL_GPL(regulator_get_voltage_rdev);
4817
4818 /**
4819 * regulator_get_voltage - get regulator output voltage
4820 * @regulator: regulator source
4821 *
4822 * Return: Current regulator voltage in uV, or a negative error number on failure.
4823 *
4824 * NOTE: If the regulator is disabled it will return the voltage value. This
4825 * function should not be used to determine regulator state.
4826 */
regulator_get_voltage(struct regulator * regulator)4827 int regulator_get_voltage(struct regulator *regulator)
4828 {
4829 struct ww_acquire_ctx ww_ctx;
4830 int ret;
4831
4832 regulator_lock_dependent(regulator->rdev, &ww_ctx);
4833 ret = regulator_get_voltage_rdev(regulator->rdev);
4834 regulator_unlock_dependent(regulator->rdev, &ww_ctx);
4835
4836 return ret;
4837 }
4838 EXPORT_SYMBOL_GPL(regulator_get_voltage);
4839
4840 /**
4841 * regulator_set_current_limit - set regulator output current limit
4842 * @regulator: regulator source
4843 * @min_uA: Minimum supported current in uA
4844 * @max_uA: Maximum supported current in uA
4845 *
4846 * Sets current sink to the desired output current. This can be set during
4847 * any regulator state. IOW, regulator can be disabled or enabled.
4848 *
4849 * If the regulator is enabled then the current will change to the new value
4850 * immediately otherwise if the regulator is disabled the regulator will
4851 * output at the new current when enabled.
4852 *
4853 * NOTE: Regulator system constraints must be set for this regulator before
4854 * calling this function otherwise this call will fail.
4855 *
4856 * Return: 0 on success or a negative error number on failure.
4857 */
regulator_set_current_limit(struct regulator * regulator,int min_uA,int max_uA)4858 int regulator_set_current_limit(struct regulator *regulator,
4859 int min_uA, int max_uA)
4860 {
4861 struct regulator_dev *rdev = regulator->rdev;
4862 int ret;
4863
4864 regulator_lock(rdev);
4865
4866 /* sanity check */
4867 if (!rdev->desc->ops->set_current_limit) {
4868 ret = -EINVAL;
4869 goto out;
4870 }
4871
4872 /* constraints check */
4873 ret = regulator_check_current_limit(rdev, &min_uA, &max_uA);
4874 if (ret < 0)
4875 goto out;
4876
4877 ret = rdev->desc->ops->set_current_limit(rdev, min_uA, max_uA);
4878 out:
4879 regulator_unlock(rdev);
4880 return ret;
4881 }
4882 EXPORT_SYMBOL_GPL(regulator_set_current_limit);
4883
_regulator_get_current_limit_unlocked(struct regulator_dev * rdev)4884 static int _regulator_get_current_limit_unlocked(struct regulator_dev *rdev)
4885 {
4886 /* sanity check */
4887 if (!rdev->desc->ops->get_current_limit)
4888 return -EINVAL;
4889
4890 return rdev->desc->ops->get_current_limit(rdev);
4891 }
4892
_regulator_get_current_limit(struct regulator_dev * rdev)4893 static int _regulator_get_current_limit(struct regulator_dev *rdev)
4894 {
4895 int ret;
4896
4897 regulator_lock(rdev);
4898 ret = _regulator_get_current_limit_unlocked(rdev);
4899 regulator_unlock(rdev);
4900
4901 return ret;
4902 }
4903
4904 /**
4905 * regulator_get_current_limit - get regulator output current
4906 * @regulator: regulator source
4907 *
4908 * Return: Current supplied by the specified current sink in uA,
4909 * or a negative error number on failure.
4910 *
4911 * NOTE: If the regulator is disabled it will return the current value. This
4912 * function should not be used to determine regulator state.
4913 */
regulator_get_current_limit(struct regulator * regulator)4914 int regulator_get_current_limit(struct regulator *regulator)
4915 {
4916 return _regulator_get_current_limit(regulator->rdev);
4917 }
4918 EXPORT_SYMBOL_GPL(regulator_get_current_limit);
4919
4920 /**
4921 * regulator_get_unclaimed_power_budget - get regulator unclaimed power budget
4922 * @regulator: regulator source
4923 *
4924 * Return: Unclaimed power budget of the regulator in mW.
4925 */
regulator_get_unclaimed_power_budget(struct regulator * regulator)4926 int regulator_get_unclaimed_power_budget(struct regulator *regulator)
4927 {
4928 return regulator->rdev->constraints->pw_budget_mW -
4929 regulator->rdev->pw_requested_mW;
4930 }
4931 EXPORT_SYMBOL_GPL(regulator_get_unclaimed_power_budget);
4932
4933 /**
4934 * regulator_request_power_budget - request power budget on a regulator
4935 * @regulator: regulator source
4936 * @pw_req: Power requested
4937 *
4938 * Return: 0 on success or a negative error number on failure.
4939 */
regulator_request_power_budget(struct regulator * regulator,unsigned int pw_req)4940 int regulator_request_power_budget(struct regulator *regulator,
4941 unsigned int pw_req)
4942 {
4943 struct regulator_dev *rdev = regulator->rdev;
4944 int ret = 0, pw_tot_req;
4945
4946 regulator_lock(rdev);
4947 if (rdev->supply) {
4948 ret = regulator_request_power_budget(rdev->supply, pw_req);
4949 if (ret < 0)
4950 goto out;
4951 }
4952
4953 pw_tot_req = rdev->pw_requested_mW + pw_req;
4954 if (pw_tot_req > rdev->constraints->pw_budget_mW) {
4955 rdev_warn(rdev, "power requested %d mW out of budget %d mW",
4956 pw_req,
4957 rdev->constraints->pw_budget_mW - rdev->pw_requested_mW);
4958 regulator_notifier_call_chain(rdev,
4959 REGULATOR_EVENT_OVER_CURRENT_WARN,
4960 NULL);
4961 ret = -ERANGE;
4962 goto out;
4963 }
4964
4965 rdev->pw_requested_mW = pw_tot_req;
4966 out:
4967 regulator_unlock(rdev);
4968 return ret;
4969 }
4970 EXPORT_SYMBOL_GPL(regulator_request_power_budget);
4971
4972 /**
4973 * regulator_free_power_budget - free power budget on a regulator
4974 * @regulator: regulator source
4975 * @pw: Power to be released.
4976 *
4977 * Return: Power budget of the regulator in mW.
4978 */
regulator_free_power_budget(struct regulator * regulator,unsigned int pw)4979 void regulator_free_power_budget(struct regulator *regulator,
4980 unsigned int pw)
4981 {
4982 struct regulator_dev *rdev = regulator->rdev;
4983 int pw_tot_req;
4984
4985 regulator_lock(rdev);
4986 if (rdev->supply)
4987 regulator_free_power_budget(rdev->supply, pw);
4988
4989 pw_tot_req = rdev->pw_requested_mW - pw;
4990 if (pw_tot_req >= 0)
4991 rdev->pw_requested_mW = pw_tot_req;
4992 else
4993 rdev_warn(rdev,
4994 "too much power freed %d mW (already requested %d mW)",
4995 pw, rdev->pw_requested_mW);
4996
4997 regulator_unlock(rdev);
4998 }
4999 EXPORT_SYMBOL_GPL(regulator_free_power_budget);
5000
5001 /**
5002 * regulator_set_mode - set regulator operating mode
5003 * @regulator: regulator source
5004 * @mode: operating mode - one of the REGULATOR_MODE constants
5005 *
5006 * Set regulator operating mode to increase regulator efficiency or improve
5007 * regulation performance.
5008 *
5009 * NOTE: Regulator system constraints must be set for this regulator before
5010 * calling this function otherwise this call will fail.
5011 *
5012 * Return: 0 on success or a negative error number on failure.
5013 */
regulator_set_mode(struct regulator * regulator,unsigned int mode)5014 int regulator_set_mode(struct regulator *regulator, unsigned int mode)
5015 {
5016 struct regulator_dev *rdev = regulator->rdev;
5017 int ret;
5018 int regulator_curr_mode;
5019
5020 regulator_lock(rdev);
5021
5022 /* sanity check */
5023 if (!rdev->desc->ops->set_mode) {
5024 ret = -EINVAL;
5025 goto out;
5026 }
5027
5028 /* return if the same mode is requested */
5029 if (rdev->desc->ops->get_mode) {
5030 regulator_curr_mode = rdev->desc->ops->get_mode(rdev);
5031 if (regulator_curr_mode == mode) {
5032 ret = 0;
5033 goto out;
5034 }
5035 }
5036
5037 /* constraints check */
5038 ret = regulator_mode_constrain(rdev, &mode);
5039 if (ret < 0)
5040 goto out;
5041
5042 ret = rdev->desc->ops->set_mode(rdev, mode);
5043 out:
5044 regulator_unlock(rdev);
5045 return ret;
5046 }
5047 EXPORT_SYMBOL_GPL(regulator_set_mode);
5048
_regulator_get_mode_unlocked(struct regulator_dev * rdev)5049 static unsigned int _regulator_get_mode_unlocked(struct regulator_dev *rdev)
5050 {
5051 /* sanity check */
5052 if (!rdev->desc->ops->get_mode)
5053 return -EINVAL;
5054
5055 return rdev->desc->ops->get_mode(rdev);
5056 }
5057
_regulator_get_mode(struct regulator_dev * rdev)5058 static unsigned int _regulator_get_mode(struct regulator_dev *rdev)
5059 {
5060 int ret;
5061
5062 regulator_lock(rdev);
5063 ret = _regulator_get_mode_unlocked(rdev);
5064 regulator_unlock(rdev);
5065
5066 return ret;
5067 }
5068
5069 /**
5070 * regulator_get_mode - get regulator operating mode
5071 * @regulator: regulator source
5072 *
5073 * Get the current regulator operating mode.
5074 *
5075 * Return: Current operating mode as %REGULATOR_MODE_* values,
5076 * or a negative error number on failure.
5077 */
regulator_get_mode(struct regulator * regulator)5078 unsigned int regulator_get_mode(struct regulator *regulator)
5079 {
5080 return _regulator_get_mode(regulator->rdev);
5081 }
5082 EXPORT_SYMBOL_GPL(regulator_get_mode);
5083
rdev_get_cached_err_flags(struct regulator_dev * rdev)5084 static int rdev_get_cached_err_flags(struct regulator_dev *rdev)
5085 {
5086 int ret = 0;
5087
5088 if (rdev->use_cached_err) {
5089 spin_lock(&rdev->err_lock);
5090 ret = rdev->cached_err;
5091 spin_unlock(&rdev->err_lock);
5092 }
5093 return ret;
5094 }
5095
_regulator_get_error_flags(struct regulator_dev * rdev,unsigned int * flags)5096 static int _regulator_get_error_flags(struct regulator_dev *rdev,
5097 unsigned int *flags)
5098 {
5099 int cached_flags, ret = 0;
5100
5101 regulator_lock(rdev);
5102
5103 cached_flags = rdev_get_cached_err_flags(rdev);
5104
5105 if (rdev->desc->ops->get_error_flags)
5106 ret = rdev->desc->ops->get_error_flags(rdev, flags);
5107 else if (!rdev->use_cached_err)
5108 ret = -EINVAL;
5109
5110 *flags |= cached_flags;
5111
5112 regulator_unlock(rdev);
5113
5114 return ret;
5115 }
5116
5117 /**
5118 * regulator_get_error_flags - get regulator error information
5119 * @regulator: regulator source
5120 * @flags: pointer to store error flags
5121 *
5122 * Get the current regulator error information.
5123 *
5124 * Return: 0 on success or a negative error number on failure.
5125 */
regulator_get_error_flags(struct regulator * regulator,unsigned int * flags)5126 int regulator_get_error_flags(struct regulator *regulator,
5127 unsigned int *flags)
5128 {
5129 return _regulator_get_error_flags(regulator->rdev, flags);
5130 }
5131 EXPORT_SYMBOL_GPL(regulator_get_error_flags);
5132
5133 /**
5134 * regulator_set_load - set regulator load
5135 * @regulator: regulator source
5136 * @uA_load: load current
5137 *
5138 * Notifies the regulator core of a new device load. This is then used by
5139 * DRMS (if enabled by constraints) to set the most efficient regulator
5140 * operating mode for the new regulator loading.
5141 *
5142 * Consumer devices notify their supply regulator of the maximum power
5143 * they will require (can be taken from device datasheet in the power
5144 * consumption tables) when they change operational status and hence power
5145 * state. Examples of operational state changes that can affect power
5146 * consumption are :-
5147 *
5148 * o Device is opened / closed.
5149 * o Device I/O is about to begin or has just finished.
5150 * o Device is idling in between work.
5151 *
5152 * This information is also exported via sysfs to userspace.
5153 *
5154 * DRMS will sum the total requested load on the regulator and change
5155 * to the most efficient operating mode if platform constraints allow.
5156 *
5157 * NOTE: when a regulator consumer requests to have a regulator
5158 * disabled then any load that consumer requested no longer counts
5159 * toward the total requested load. If the regulator is re-enabled
5160 * then the previously requested load will start counting again.
5161 *
5162 * If a regulator is an always-on regulator then an individual consumer's
5163 * load will still be removed if that consumer is fully disabled.
5164 *
5165 * Return: 0 on success or a negative error number on failure.
5166 */
regulator_set_load(struct regulator * regulator,int uA_load)5167 int regulator_set_load(struct regulator *regulator, int uA_load)
5168 {
5169 struct regulator_dev *rdev = regulator->rdev;
5170 int old_uA_load;
5171 int ret = 0;
5172
5173 regulator_lock(rdev);
5174 old_uA_load = regulator->uA_load;
5175 regulator->uA_load = uA_load;
5176 if (regulator->enable_count && old_uA_load != uA_load) {
5177 ret = drms_uA_update(rdev);
5178 if (ret < 0)
5179 regulator->uA_load = old_uA_load;
5180 }
5181 regulator_unlock(rdev);
5182
5183 return ret;
5184 }
5185 EXPORT_SYMBOL_GPL(regulator_set_load);
5186
5187 /**
5188 * regulator_allow_bypass - allow the regulator to go into bypass mode
5189 *
5190 * @regulator: Regulator to configure
5191 * @enable: enable or disable bypass mode
5192 *
5193 * Allow the regulator to go into bypass mode if all other consumers
5194 * for the regulator also enable bypass mode and the machine
5195 * constraints allow this. Bypass mode means that the regulator is
5196 * simply passing the input directly to the output with no regulation.
5197 *
5198 * Return: 0 on success or if changing bypass is not possible, or
5199 * a negative error number on failure.
5200 */
regulator_allow_bypass(struct regulator * regulator,bool enable)5201 int regulator_allow_bypass(struct regulator *regulator, bool enable)
5202 {
5203 struct regulator_dev *rdev = regulator->rdev;
5204 const char *name = rdev_get_name(rdev);
5205 int ret = 0;
5206
5207 if (!rdev->desc->ops->set_bypass)
5208 return 0;
5209
5210 if (!regulator_ops_is_valid(rdev, REGULATOR_CHANGE_BYPASS))
5211 return 0;
5212
5213 regulator_lock(rdev);
5214
5215 if (enable && !regulator->bypass) {
5216 rdev->bypass_count++;
5217
5218 if (rdev->bypass_count == rdev->open_count) {
5219 trace_regulator_bypass_enable(name);
5220
5221 ret = rdev->desc->ops->set_bypass(rdev, enable);
5222 if (ret != 0)
5223 rdev->bypass_count--;
5224 else
5225 trace_regulator_bypass_enable_complete(name);
5226 }
5227
5228 } else if (!enable && regulator->bypass) {
5229 rdev->bypass_count--;
5230
5231 if (rdev->bypass_count != rdev->open_count) {
5232 trace_regulator_bypass_disable(name);
5233
5234 ret = rdev->desc->ops->set_bypass(rdev, enable);
5235 if (ret != 0)
5236 rdev->bypass_count++;
5237 else
5238 trace_regulator_bypass_disable_complete(name);
5239 }
5240 }
5241
5242 if (ret == 0)
5243 regulator->bypass = enable;
5244
5245 regulator_unlock(rdev);
5246
5247 return ret;
5248 }
5249 EXPORT_SYMBOL_GPL(regulator_allow_bypass);
5250
5251 /**
5252 * regulator_register_notifier - register regulator event notifier
5253 * @regulator: regulator source
5254 * @nb: notifier block
5255 *
5256 * Register notifier block to receive regulator events.
5257 *
5258 * Return: 0 on success or a negative error number on failure.
5259 */
regulator_register_notifier(struct regulator * regulator,struct notifier_block * nb)5260 int regulator_register_notifier(struct regulator *regulator,
5261 struct notifier_block *nb)
5262 {
5263 return blocking_notifier_chain_register(®ulator->rdev->notifier,
5264 nb);
5265 }
5266 EXPORT_SYMBOL_GPL(regulator_register_notifier);
5267
5268 /**
5269 * regulator_unregister_notifier - unregister regulator event notifier
5270 * @regulator: regulator source
5271 * @nb: notifier block
5272 *
5273 * Unregister regulator event notifier block.
5274 *
5275 * Return: 0 on success or a negative error number on failure.
5276 */
regulator_unregister_notifier(struct regulator * regulator,struct notifier_block * nb)5277 int regulator_unregister_notifier(struct regulator *regulator,
5278 struct notifier_block *nb)
5279 {
5280 return blocking_notifier_chain_unregister(®ulator->rdev->notifier,
5281 nb);
5282 }
5283 EXPORT_SYMBOL_GPL(regulator_unregister_notifier);
5284
5285 /* notify regulator consumers and downstream regulator consumers.
5286 * Note mutex must be held by caller.
5287 */
_notifier_call_chain(struct regulator_dev * rdev,unsigned long event,void * data)5288 static int _notifier_call_chain(struct regulator_dev *rdev,
5289 unsigned long event, void *data)
5290 {
5291 /* call rdev chain first */
5292 int ret = blocking_notifier_call_chain(&rdev->notifier, event, data);
5293
5294 if (IS_REACHABLE(CONFIG_REGULATOR_NETLINK_EVENTS)) {
5295 struct device *parent = rdev->dev.parent;
5296 const char *rname = rdev_get_name(rdev);
5297 char name[32];
5298
5299 /* Avoid duplicate debugfs directory names */
5300 if (parent && rname == rdev->desc->name) {
5301 snprintf(name, sizeof(name), "%s-%s", dev_name(parent),
5302 rname);
5303 rname = name;
5304 }
5305 reg_generate_netlink_event(rname, event);
5306 }
5307
5308 return ret;
5309 }
5310
_regulator_bulk_get(struct device * dev,int num_consumers,struct regulator_bulk_data * consumers,enum regulator_get_type get_type)5311 int _regulator_bulk_get(struct device *dev, int num_consumers,
5312 struct regulator_bulk_data *consumers, enum regulator_get_type get_type)
5313 {
5314 int i;
5315 int ret;
5316
5317 for (i = 0; i < num_consumers; i++)
5318 consumers[i].consumer = NULL;
5319
5320 for (i = 0; i < num_consumers; i++) {
5321 consumers[i].consumer = _regulator_get(dev,
5322 consumers[i].supply, get_type);
5323 if (IS_ERR(consumers[i].consumer)) {
5324 ret = dev_err_probe(dev, PTR_ERR(consumers[i].consumer),
5325 "Failed to get supply '%s'\n",
5326 consumers[i].supply);
5327 consumers[i].consumer = NULL;
5328 goto err;
5329 }
5330
5331 if (consumers[i].init_load_uA > 0) {
5332 ret = regulator_set_load(consumers[i].consumer,
5333 consumers[i].init_load_uA);
5334 if (ret) {
5335 i++;
5336 goto err;
5337 }
5338 }
5339 }
5340
5341 return 0;
5342
5343 err:
5344 while (--i >= 0)
5345 regulator_put(consumers[i].consumer);
5346
5347 return ret;
5348 }
5349
5350 /**
5351 * regulator_bulk_get - get multiple regulator consumers
5352 *
5353 * @dev: Device to supply
5354 * @num_consumers: Number of consumers to register
5355 * @consumers: Configuration of consumers; clients are stored here.
5356 *
5357 * This helper function allows drivers to get several regulator
5358 * consumers in one operation. If any of the regulators cannot be
5359 * acquired then any regulators that were allocated will be freed
5360 * before returning to the caller.
5361 *
5362 * Return: 0 on success or a negative error number on failure.
5363 */
regulator_bulk_get(struct device * dev,int num_consumers,struct regulator_bulk_data * consumers)5364 int regulator_bulk_get(struct device *dev, int num_consumers,
5365 struct regulator_bulk_data *consumers)
5366 {
5367 return _regulator_bulk_get(dev, num_consumers, consumers, NORMAL_GET);
5368 }
5369 EXPORT_SYMBOL_GPL(regulator_bulk_get);
5370
regulator_bulk_enable_async(void * data,async_cookie_t cookie)5371 static void regulator_bulk_enable_async(void *data, async_cookie_t cookie)
5372 {
5373 struct regulator_bulk_data *bulk = data;
5374
5375 bulk->ret = regulator_enable(bulk->consumer);
5376 }
5377
5378 /**
5379 * regulator_bulk_enable - enable multiple regulator consumers
5380 *
5381 * @num_consumers: Number of consumers
5382 * @consumers: Consumer data; clients are stored here.
5383 *
5384 * This convenience API allows consumers to enable multiple regulator
5385 * clients in a single API call. If any consumers cannot be enabled
5386 * then any others that were enabled will be disabled again prior to
5387 * return.
5388 *
5389 * Return: 0 on success or a negative error number on failure.
5390 */
regulator_bulk_enable(int num_consumers,struct regulator_bulk_data * consumers)5391 int regulator_bulk_enable(int num_consumers,
5392 struct regulator_bulk_data *consumers)
5393 {
5394 ASYNC_DOMAIN_EXCLUSIVE(async_domain);
5395 int i;
5396 int ret = 0;
5397
5398 for (i = 0; i < num_consumers; i++) {
5399 async_schedule_domain(regulator_bulk_enable_async,
5400 &consumers[i], &async_domain);
5401 }
5402
5403 async_synchronize_full_domain(&async_domain);
5404
5405 /* If any consumer failed we need to unwind any that succeeded */
5406 for (i = 0; i < num_consumers; i++) {
5407 if (consumers[i].ret != 0) {
5408 ret = consumers[i].ret;
5409 goto err;
5410 }
5411 }
5412
5413 return 0;
5414
5415 err:
5416 for (i = 0; i < num_consumers; i++) {
5417 if (consumers[i].ret < 0)
5418 pr_err("Failed to enable %s: %pe\n", consumers[i].supply,
5419 ERR_PTR(consumers[i].ret));
5420 else
5421 regulator_disable(consumers[i].consumer);
5422 }
5423
5424 return ret;
5425 }
5426 EXPORT_SYMBOL_GPL(regulator_bulk_enable);
5427
5428 /**
5429 * regulator_bulk_disable - disable multiple regulator consumers
5430 *
5431 * @num_consumers: Number of consumers
5432 * @consumers: Consumer data; clients are stored here.
5433 *
5434 * This convenience API allows consumers to disable multiple regulator
5435 * clients in a single API call. If any consumers cannot be disabled
5436 * then any others that were disabled will be enabled again prior to
5437 * return.
5438 *
5439 * Return: 0 on success or a negative error number on failure.
5440 */
regulator_bulk_disable(int num_consumers,struct regulator_bulk_data * consumers)5441 int regulator_bulk_disable(int num_consumers,
5442 struct regulator_bulk_data *consumers)
5443 {
5444 int i;
5445 int ret, r;
5446
5447 for (i = num_consumers - 1; i >= 0; --i) {
5448 ret = regulator_disable(consumers[i].consumer);
5449 if (ret != 0)
5450 goto err;
5451 }
5452
5453 return 0;
5454
5455 err:
5456 pr_err("Failed to disable %s: %pe\n", consumers[i].supply, ERR_PTR(ret));
5457 for (++i; i < num_consumers; ++i) {
5458 r = regulator_enable(consumers[i].consumer);
5459 if (r != 0)
5460 pr_err("Failed to re-enable %s: %pe\n",
5461 consumers[i].supply, ERR_PTR(r));
5462 }
5463
5464 return ret;
5465 }
5466 EXPORT_SYMBOL_GPL(regulator_bulk_disable);
5467
5468 /**
5469 * regulator_bulk_force_disable - force disable multiple regulator consumers
5470 *
5471 * @num_consumers: Number of consumers
5472 * @consumers: Consumer data; clients are stored here.
5473 *
5474 * This convenience API allows consumers to forcibly disable multiple regulator
5475 * clients in a single API call.
5476 * NOTE: This should be used for situations when device damage will
5477 * likely occur if the regulators are not disabled (e.g. over temp).
5478 * Although regulator_force_disable function call for some consumers can
5479 * return error numbers, the function is called for all consumers.
5480 *
5481 * Return: 0 on success or a negative error number on failure.
5482 */
regulator_bulk_force_disable(int num_consumers,struct regulator_bulk_data * consumers)5483 int regulator_bulk_force_disable(int num_consumers,
5484 struct regulator_bulk_data *consumers)
5485 {
5486 int i;
5487 int ret = 0;
5488
5489 for (i = 0; i < num_consumers; i++) {
5490 consumers[i].ret =
5491 regulator_force_disable(consumers[i].consumer);
5492
5493 /* Store first error for reporting */
5494 if (consumers[i].ret && !ret)
5495 ret = consumers[i].ret;
5496 }
5497
5498 return ret;
5499 }
5500 EXPORT_SYMBOL_GPL(regulator_bulk_force_disable);
5501
5502 /**
5503 * regulator_bulk_free - free multiple regulator consumers
5504 *
5505 * @num_consumers: Number of consumers
5506 * @consumers: Consumer data; clients are stored here.
5507 *
5508 * This convenience API allows consumers to free multiple regulator
5509 * clients in a single API call.
5510 */
regulator_bulk_free(int num_consumers,struct regulator_bulk_data * consumers)5511 void regulator_bulk_free(int num_consumers,
5512 struct regulator_bulk_data *consumers)
5513 {
5514 int i;
5515
5516 for (i = 0; i < num_consumers; i++) {
5517 regulator_put(consumers[i].consumer);
5518 consumers[i].consumer = NULL;
5519 }
5520 }
5521 EXPORT_SYMBOL_GPL(regulator_bulk_free);
5522
5523 /**
5524 * regulator_handle_critical - Handle events for system-critical regulators.
5525 * @rdev: The regulator device.
5526 * @event: The event being handled.
5527 *
5528 * This function handles critical events such as under-voltage, over-current,
5529 * and unknown errors for regulators deemed system-critical. On detecting such
5530 * events, it triggers a hardware protection shutdown with a defined timeout.
5531 */
regulator_handle_critical(struct regulator_dev * rdev,unsigned long event)5532 static void regulator_handle_critical(struct regulator_dev *rdev,
5533 unsigned long event)
5534 {
5535 const char *reason = NULL;
5536
5537 if (!rdev->constraints->system_critical)
5538 return;
5539
5540 switch (event) {
5541 case REGULATOR_EVENT_UNDER_VOLTAGE:
5542 reason = "System critical regulator: voltage drop detected";
5543 break;
5544 case REGULATOR_EVENT_OVER_CURRENT:
5545 reason = "System critical regulator: over-current detected";
5546 break;
5547 case REGULATOR_EVENT_FAIL:
5548 reason = "System critical regulator: unknown error";
5549 }
5550
5551 if (!reason)
5552 return;
5553
5554 hw_protection_trigger(reason,
5555 rdev->constraints->uv_less_critical_window_ms);
5556 }
5557
5558 /**
5559 * regulator_notifier_call_chain - call regulator event notifier
5560 * @rdev: regulator source
5561 * @event: notifier block
5562 * @data: callback-specific data.
5563 *
5564 * Called by regulator drivers to notify clients a regulator event has
5565 * occurred.
5566 *
5567 * Return: %NOTIFY_DONE.
5568 */
regulator_notifier_call_chain(struct regulator_dev * rdev,unsigned long event,void * data)5569 int regulator_notifier_call_chain(struct regulator_dev *rdev,
5570 unsigned long event, void *data)
5571 {
5572 regulator_handle_critical(rdev, event);
5573
5574 _notifier_call_chain(rdev, event, data);
5575 return NOTIFY_DONE;
5576
5577 }
5578 EXPORT_SYMBOL_GPL(regulator_notifier_call_chain);
5579
5580 /**
5581 * regulator_mode_to_status - convert a regulator mode into a status
5582 *
5583 * @mode: Mode to convert
5584 *
5585 * Convert a regulator mode into a status.
5586 *
5587 * Return: %REGULATOR_STATUS_* value corresponding to given mode.
5588 */
regulator_mode_to_status(unsigned int mode)5589 int regulator_mode_to_status(unsigned int mode)
5590 {
5591 switch (mode) {
5592 case REGULATOR_MODE_FAST:
5593 return REGULATOR_STATUS_FAST;
5594 case REGULATOR_MODE_NORMAL:
5595 return REGULATOR_STATUS_NORMAL;
5596 case REGULATOR_MODE_IDLE:
5597 return REGULATOR_STATUS_IDLE;
5598 case REGULATOR_MODE_STANDBY:
5599 return REGULATOR_STATUS_STANDBY;
5600 default:
5601 return REGULATOR_STATUS_UNDEFINED;
5602 }
5603 }
5604 EXPORT_SYMBOL_GPL(regulator_mode_to_status);
5605
5606 static struct attribute *regulator_dev_attrs[] = {
5607 &dev_attr_name.attr,
5608 &dev_attr_num_users.attr,
5609 &dev_attr_type.attr,
5610 &dev_attr_microvolts.attr,
5611 &dev_attr_microamps.attr,
5612 &dev_attr_opmode.attr,
5613 &dev_attr_state.attr,
5614 &dev_attr_status.attr,
5615 &dev_attr_bypass.attr,
5616 &dev_attr_requested_microamps.attr,
5617 &dev_attr_min_microvolts.attr,
5618 &dev_attr_max_microvolts.attr,
5619 &dev_attr_min_microamps.attr,
5620 &dev_attr_max_microamps.attr,
5621 &dev_attr_under_voltage.attr,
5622 &dev_attr_over_current.attr,
5623 &dev_attr_regulation_out.attr,
5624 &dev_attr_fail.attr,
5625 &dev_attr_over_temp.attr,
5626 &dev_attr_under_voltage_warn.attr,
5627 &dev_attr_over_current_warn.attr,
5628 &dev_attr_over_voltage_warn.attr,
5629 &dev_attr_over_temp_warn.attr,
5630 &dev_attr_suspend_standby_state.attr,
5631 &dev_attr_suspend_mem_state.attr,
5632 &dev_attr_suspend_disk_state.attr,
5633 &dev_attr_suspend_standby_microvolts.attr,
5634 &dev_attr_suspend_mem_microvolts.attr,
5635 &dev_attr_suspend_disk_microvolts.attr,
5636 &dev_attr_suspend_standby_mode.attr,
5637 &dev_attr_suspend_mem_mode.attr,
5638 &dev_attr_suspend_disk_mode.attr,
5639 &dev_attr_power_budget_milliwatt.attr,
5640 &dev_attr_power_requested_milliwatt.attr,
5641 NULL
5642 };
5643
5644 /*
5645 * To avoid cluttering sysfs (and memory) with useless state, only
5646 * create attributes that can be meaningfully displayed.
5647 */
regulator_attr_is_visible(struct kobject * kobj,struct attribute * attr,int idx)5648 static umode_t regulator_attr_is_visible(struct kobject *kobj,
5649 struct attribute *attr, int idx)
5650 {
5651 struct device *dev = kobj_to_dev(kobj);
5652 struct regulator_dev *rdev = dev_to_rdev(dev);
5653 const struct regulator_ops *ops = rdev->desc->ops;
5654 umode_t mode = attr->mode;
5655
5656 /* these three are always present */
5657 if (attr == &dev_attr_name.attr ||
5658 attr == &dev_attr_num_users.attr ||
5659 attr == &dev_attr_type.attr)
5660 return mode;
5661
5662 /* some attributes need specific methods to be displayed */
5663 if (attr == &dev_attr_microvolts.attr) {
5664 if ((ops->get_voltage && ops->get_voltage(rdev) >= 0) ||
5665 (ops->get_voltage_sel && ops->get_voltage_sel(rdev) >= 0) ||
5666 (ops->list_voltage && ops->list_voltage(rdev, 0) >= 0) ||
5667 (rdev->desc->fixed_uV && rdev->desc->n_voltages == 1))
5668 return mode;
5669 return 0;
5670 }
5671
5672 if (attr == &dev_attr_microamps.attr)
5673 return ops->get_current_limit ? mode : 0;
5674
5675 if (attr == &dev_attr_opmode.attr)
5676 return ops->get_mode ? mode : 0;
5677
5678 if (attr == &dev_attr_state.attr)
5679 return (rdev->ena_pin || ops->is_enabled) ? mode : 0;
5680
5681 if (attr == &dev_attr_status.attr)
5682 return ops->get_status ? mode : 0;
5683
5684 if (attr == &dev_attr_bypass.attr)
5685 return ops->get_bypass ? mode : 0;
5686
5687 if (attr == &dev_attr_under_voltage.attr ||
5688 attr == &dev_attr_over_current.attr ||
5689 attr == &dev_attr_regulation_out.attr ||
5690 attr == &dev_attr_fail.attr ||
5691 attr == &dev_attr_over_temp.attr ||
5692 attr == &dev_attr_under_voltage_warn.attr ||
5693 attr == &dev_attr_over_current_warn.attr ||
5694 attr == &dev_attr_over_voltage_warn.attr ||
5695 attr == &dev_attr_over_temp_warn.attr)
5696 return ops->get_error_flags ? mode : 0;
5697
5698 /* constraints need specific supporting methods */
5699 if (attr == &dev_attr_min_microvolts.attr ||
5700 attr == &dev_attr_max_microvolts.attr)
5701 return (ops->set_voltage || ops->set_voltage_sel) ? mode : 0;
5702
5703 if (attr == &dev_attr_min_microamps.attr ||
5704 attr == &dev_attr_max_microamps.attr)
5705 return ops->set_current_limit ? mode : 0;
5706
5707 if (attr == &dev_attr_suspend_standby_state.attr ||
5708 attr == &dev_attr_suspend_mem_state.attr ||
5709 attr == &dev_attr_suspend_disk_state.attr)
5710 return mode;
5711
5712 if (attr == &dev_attr_suspend_standby_microvolts.attr ||
5713 attr == &dev_attr_suspend_mem_microvolts.attr ||
5714 attr == &dev_attr_suspend_disk_microvolts.attr)
5715 return ops->set_suspend_voltage ? mode : 0;
5716
5717 if (attr == &dev_attr_suspend_standby_mode.attr ||
5718 attr == &dev_attr_suspend_mem_mode.attr ||
5719 attr == &dev_attr_suspend_disk_mode.attr)
5720 return ops->set_suspend_mode ? mode : 0;
5721
5722 if (attr == &dev_attr_power_budget_milliwatt.attr ||
5723 attr == &dev_attr_power_requested_milliwatt.attr)
5724 return rdev->constraints->pw_budget_mW != INT_MAX ? mode : 0;
5725
5726 return mode;
5727 }
5728
5729 static const struct attribute_group regulator_dev_group = {
5730 .attrs = regulator_dev_attrs,
5731 .is_visible = regulator_attr_is_visible,
5732 };
5733
5734 static const struct attribute_group *regulator_dev_groups[] = {
5735 ®ulator_dev_group,
5736 NULL
5737 };
5738
regulator_dev_release(struct device * dev)5739 static void regulator_dev_release(struct device *dev)
5740 {
5741 struct regulator_dev *rdev = dev_get_drvdata(dev);
5742
5743 debugfs_remove_recursive(rdev->debugfs);
5744 kfree(rdev->constraints);
5745 of_node_put(rdev->dev.of_node);
5746 kfree(rdev);
5747 }
5748
rdev_init_debugfs(struct regulator_dev * rdev)5749 static void rdev_init_debugfs(struct regulator_dev *rdev)
5750 {
5751 struct device *parent = rdev->dev.parent;
5752 const char *rname = rdev_get_name(rdev);
5753 char name[NAME_MAX];
5754
5755 /* Avoid duplicate debugfs directory names */
5756 if (parent && rname == rdev->desc->name) {
5757 snprintf(name, sizeof(name), "%s-%s", dev_name(parent),
5758 rname);
5759 rname = name;
5760 }
5761
5762 rdev->debugfs = debugfs_create_dir(rname, debugfs_root);
5763 if (IS_ERR(rdev->debugfs))
5764 rdev_dbg(rdev, "Failed to create debugfs directory\n");
5765
5766 debugfs_create_u32("use_count", 0444, rdev->debugfs,
5767 &rdev->use_count);
5768 debugfs_create_u32("open_count", 0444, rdev->debugfs,
5769 &rdev->open_count);
5770 debugfs_create_u32("bypass_count", 0444, rdev->debugfs,
5771 &rdev->bypass_count);
5772 }
5773
regulator_coupler_register(struct regulator_coupler * coupler)5774 int regulator_coupler_register(struct regulator_coupler *coupler)
5775 {
5776 mutex_lock(®ulator_list_mutex);
5777 list_add_tail(&coupler->list, ®ulator_coupler_list);
5778 mutex_unlock(®ulator_list_mutex);
5779
5780 return 0;
5781 }
5782
5783 static struct regulator_coupler *
regulator_find_coupler(struct regulator_dev * rdev)5784 regulator_find_coupler(struct regulator_dev *rdev)
5785 {
5786 struct regulator_coupler *coupler;
5787 int err;
5788
5789 /*
5790 * Note that regulators are appended to the list and the generic
5791 * coupler is registered first, hence it will be attached at last
5792 * if nobody cared.
5793 */
5794 list_for_each_entry_reverse(coupler, ®ulator_coupler_list, list) {
5795 err = coupler->attach_regulator(coupler, rdev);
5796 if (!err) {
5797 if (!coupler->balance_voltage &&
5798 rdev->coupling_desc.n_coupled > 2)
5799 goto err_unsupported;
5800
5801 return coupler;
5802 }
5803
5804 if (err < 0)
5805 return ERR_PTR(err);
5806
5807 if (err == 1)
5808 continue;
5809
5810 break;
5811 }
5812
5813 return ERR_PTR(-EINVAL);
5814
5815 err_unsupported:
5816 if (coupler->detach_regulator)
5817 coupler->detach_regulator(coupler, rdev);
5818
5819 rdev_err(rdev,
5820 "Voltage balancing for multiple regulator couples is unimplemented\n");
5821
5822 return ERR_PTR(-EPERM);
5823 }
5824
regulator_resolve_coupling(struct regulator_dev * rdev)5825 static void regulator_resolve_coupling(struct regulator_dev *rdev)
5826 {
5827 struct regulator_coupler *coupler = rdev->coupling_desc.coupler;
5828 struct coupling_desc *c_desc = &rdev->coupling_desc;
5829 int n_coupled = c_desc->n_coupled;
5830 struct regulator_dev *c_rdev;
5831 int i;
5832
5833 for (i = 1; i < n_coupled; i++) {
5834 /* already resolved */
5835 if (c_desc->coupled_rdevs[i])
5836 continue;
5837
5838 c_rdev = of_parse_coupled_regulator(rdev, i - 1);
5839
5840 if (!c_rdev)
5841 continue;
5842
5843 if (c_rdev->coupling_desc.coupler != coupler) {
5844 rdev_err(rdev, "coupler mismatch with %s\n",
5845 rdev_get_name(c_rdev));
5846 return;
5847 }
5848
5849 c_desc->coupled_rdevs[i] = c_rdev;
5850 c_desc->n_resolved++;
5851
5852 regulator_resolve_coupling(c_rdev);
5853 }
5854 }
5855
regulator_remove_coupling(struct regulator_dev * rdev)5856 static void regulator_remove_coupling(struct regulator_dev *rdev)
5857 {
5858 struct regulator_coupler *coupler = rdev->coupling_desc.coupler;
5859 struct coupling_desc *__c_desc, *c_desc = &rdev->coupling_desc;
5860 struct regulator_dev *__c_rdev, *c_rdev;
5861 unsigned int __n_coupled, n_coupled;
5862 int i, k;
5863 int err;
5864
5865 n_coupled = c_desc->n_coupled;
5866
5867 for (i = 1; i < n_coupled; i++) {
5868 c_rdev = c_desc->coupled_rdevs[i];
5869
5870 if (!c_rdev)
5871 continue;
5872
5873 regulator_lock(c_rdev);
5874
5875 __c_desc = &c_rdev->coupling_desc;
5876 __n_coupled = __c_desc->n_coupled;
5877
5878 for (k = 1; k < __n_coupled; k++) {
5879 __c_rdev = __c_desc->coupled_rdevs[k];
5880
5881 if (__c_rdev == rdev) {
5882 __c_desc->coupled_rdevs[k] = NULL;
5883 __c_desc->n_resolved--;
5884 break;
5885 }
5886 }
5887
5888 regulator_unlock(c_rdev);
5889
5890 c_desc->coupled_rdevs[i] = NULL;
5891 c_desc->n_resolved--;
5892 }
5893
5894 if (coupler && coupler->detach_regulator) {
5895 err = coupler->detach_regulator(coupler, rdev);
5896 if (err)
5897 rdev_err(rdev, "failed to detach from coupler: %pe\n",
5898 ERR_PTR(err));
5899 }
5900
5901 rdev->coupling_desc.n_coupled = 0;
5902 kfree(rdev->coupling_desc.coupled_rdevs);
5903 rdev->coupling_desc.coupled_rdevs = NULL;
5904 }
5905
regulator_init_coupling(struct regulator_dev * rdev)5906 static int regulator_init_coupling(struct regulator_dev *rdev)
5907 {
5908 struct regulator_dev **coupled;
5909 int err, n_phandles;
5910
5911 if (!IS_ENABLED(CONFIG_OF))
5912 n_phandles = 0;
5913 else
5914 n_phandles = of_get_n_coupled(rdev);
5915
5916 coupled = kzalloc_objs(*coupled, n_phandles + 1);
5917 if (!coupled)
5918 return -ENOMEM;
5919
5920 rdev->coupling_desc.coupled_rdevs = coupled;
5921
5922 /*
5923 * Every regulator should always have coupling descriptor filled with
5924 * at least pointer to itself.
5925 */
5926 rdev->coupling_desc.coupled_rdevs[0] = rdev;
5927 rdev->coupling_desc.n_coupled = n_phandles + 1;
5928 rdev->coupling_desc.n_resolved++;
5929
5930 /* regulator isn't coupled */
5931 if (n_phandles == 0)
5932 return 0;
5933
5934 if (!of_check_coupling_data(rdev))
5935 return -EPERM;
5936
5937 mutex_lock(®ulator_list_mutex);
5938 rdev->coupling_desc.coupler = regulator_find_coupler(rdev);
5939 mutex_unlock(®ulator_list_mutex);
5940
5941 if (IS_ERR(rdev->coupling_desc.coupler)) {
5942 err = PTR_ERR(rdev->coupling_desc.coupler);
5943 rdev_err(rdev, "failed to get coupler: %pe\n", ERR_PTR(err));
5944 return err;
5945 }
5946
5947 return 0;
5948 }
5949
generic_coupler_attach(struct regulator_coupler * coupler,struct regulator_dev * rdev)5950 static int generic_coupler_attach(struct regulator_coupler *coupler,
5951 struct regulator_dev *rdev)
5952 {
5953 if (rdev->coupling_desc.n_coupled > 2) {
5954 rdev_err(rdev,
5955 "Voltage balancing for multiple regulator couples is unimplemented\n");
5956 return -EPERM;
5957 }
5958
5959 if (!rdev->constraints->always_on) {
5960 rdev_err(rdev,
5961 "Coupling of a non always-on regulator is unimplemented\n");
5962 return -ENOTSUPP;
5963 }
5964
5965 return 0;
5966 }
5967
5968 static struct regulator_coupler generic_regulator_coupler = {
5969 .attach_regulator = generic_coupler_attach,
5970 };
5971
5972 /**
5973 * regulator_register - register regulator
5974 * @dev: the device that drive the regulator
5975 * @regulator_desc: regulator to register
5976 * @cfg: runtime configuration for regulator
5977 *
5978 * Called by regulator drivers to register a regulator.
5979 *
5980 * Return: Pointer to a valid &struct regulator_dev on success or
5981 * an ERR_PTR() encoded negative error number on failure.
5982 */
5983 struct regulator_dev *
regulator_register(struct device * dev,const struct regulator_desc * regulator_desc,const struct regulator_config * cfg)5984 regulator_register(struct device *dev,
5985 const struct regulator_desc *regulator_desc,
5986 const struct regulator_config *cfg)
5987 {
5988 const struct regulator_init_data *init_data;
5989 struct regulator_config *config = NULL;
5990 static atomic_t regulator_no = ATOMIC_INIT(-1);
5991 struct regulator_dev *rdev;
5992 bool tried_supply_resolve = false;
5993 bool dangling_cfg_gpiod = false;
5994 bool dangling_of_gpiod = false;
5995 int ret, i;
5996
5997 if (cfg == NULL)
5998 return ERR_PTR(-EINVAL);
5999 if (cfg->ena_gpiod)
6000 dangling_cfg_gpiod = true;
6001 if (regulator_desc == NULL) {
6002 ret = -EINVAL;
6003 goto rinse;
6004 }
6005
6006 WARN_ON(!dev || !cfg->dev);
6007
6008 if (regulator_desc->name == NULL || regulator_desc->ops == NULL) {
6009 ret = -EINVAL;
6010 goto rinse;
6011 }
6012
6013 if (regulator_desc->type != REGULATOR_VOLTAGE &&
6014 regulator_desc->type != REGULATOR_CURRENT) {
6015 ret = -EINVAL;
6016 goto rinse;
6017 }
6018
6019 /* Only one of each should be implemented */
6020 WARN_ON(regulator_desc->ops->get_voltage &&
6021 regulator_desc->ops->get_voltage_sel);
6022 WARN_ON(regulator_desc->ops->set_voltage &&
6023 regulator_desc->ops->set_voltage_sel);
6024
6025 /* If we're using selectors we must implement list_voltage. */
6026 if (regulator_desc->ops->get_voltage_sel &&
6027 !regulator_desc->ops->list_voltage) {
6028 ret = -EINVAL;
6029 goto rinse;
6030 }
6031 if (regulator_desc->ops->set_voltage_sel &&
6032 !regulator_desc->ops->list_voltage) {
6033 ret = -EINVAL;
6034 goto rinse;
6035 }
6036
6037 rdev = kzalloc_obj(struct regulator_dev);
6038 if (rdev == NULL) {
6039 ret = -ENOMEM;
6040 goto rinse;
6041 }
6042 device_initialize(&rdev->dev);
6043 dev_set_drvdata(&rdev->dev, rdev);
6044 rdev->dev.class = ®ulator_class;
6045 spin_lock_init(&rdev->err_lock);
6046
6047 /*
6048 * Duplicate the config so the driver could override it after
6049 * parsing init data.
6050 */
6051 config = kmemdup(cfg, sizeof(*cfg), GFP_KERNEL);
6052 if (config == NULL) {
6053 ret = -ENOMEM;
6054 goto clean;
6055 }
6056
6057 /*
6058 * DT may override the config->init_data provided if the platform
6059 * needs to do so. If so, config->init_data is completely ignored.
6060 */
6061 init_data = regulator_of_get_init_data(dev, regulator_desc, config,
6062 &rdev->dev.of_node);
6063
6064 /*
6065 * Sometimes not all resources are probed already so we need to take
6066 * that into account. This happens most the time if the ena_gpiod comes
6067 * from a gpio extender or something else.
6068 */
6069 if (PTR_ERR(init_data) == -EPROBE_DEFER) {
6070 ret = -EPROBE_DEFER;
6071 goto clean;
6072 }
6073
6074 /*
6075 * We need to keep track of any GPIO descriptor coming from the
6076 * device tree until we have handled it over to the core. If the
6077 * config that was passed in to this function DOES NOT contain
6078 * a descriptor, and the config after this call DOES contain
6079 * a descriptor, we definitely got one from parsing the device
6080 * tree.
6081 */
6082 if (!cfg->ena_gpiod && config->ena_gpiod)
6083 dangling_of_gpiod = true;
6084 if (!init_data) {
6085 init_data = config->init_data;
6086 rdev->dev.of_node = of_node_get(config->of_node);
6087 }
6088
6089 ww_mutex_init(&rdev->mutex, ®ulator_ww_class);
6090 rdev->reg_data = config->driver_data;
6091 rdev->owner = regulator_desc->owner;
6092 rdev->desc = regulator_desc;
6093 if (config->regmap)
6094 rdev->regmap = config->regmap;
6095 else if (dev_get_regmap(dev, NULL))
6096 rdev->regmap = dev_get_regmap(dev, NULL);
6097 else if (dev->parent)
6098 rdev->regmap = dev_get_regmap(dev->parent, NULL);
6099 INIT_LIST_HEAD(&rdev->consumer_list);
6100 INIT_LIST_HEAD(&rdev->list);
6101 BLOCKING_INIT_NOTIFIER_HEAD(&rdev->notifier);
6102 INIT_DELAYED_WORK(&rdev->disable_work, regulator_disable_work);
6103
6104 if (init_data && init_data->supply_regulator)
6105 rdev->supply_name = init_data->supply_regulator;
6106 else if (regulator_desc->supply_name)
6107 rdev->supply_name = regulator_desc->supply_name;
6108
6109 /* register with sysfs */
6110 rdev->dev.parent = config->dev;
6111 dev_set_name(&rdev->dev, "regulator.%lu",
6112 (unsigned long) atomic_inc_return(®ulator_no));
6113
6114 /* set regulator constraints */
6115 if (init_data)
6116 rdev->constraints = kmemdup(&init_data->constraints,
6117 sizeof(*rdev->constraints),
6118 GFP_KERNEL);
6119 else
6120 rdev->constraints = kzalloc_obj(*rdev->constraints);
6121 if (!rdev->constraints) {
6122 ret = -ENOMEM;
6123 goto wash;
6124 }
6125
6126 if (regulator_desc->init_cb) {
6127 ret = regulator_desc->init_cb(rdev, config);
6128 if (ret < 0)
6129 goto wash;
6130 }
6131
6132 if (config->ena_gpiod) {
6133 ret = regulator_ena_gpio_request(rdev, config);
6134 if (ret != 0) {
6135 rdev_err(rdev, "Failed to request enable GPIO: %pe\n",
6136 ERR_PTR(ret));
6137 goto wash;
6138 }
6139 /* The regulator core took over the GPIO descriptor */
6140 dangling_cfg_gpiod = false;
6141 dangling_of_gpiod = false;
6142 }
6143
6144 ret = set_machine_constraints(rdev, false);
6145 if (ret == -EPROBE_DEFER) {
6146 /* Regulator might be in bypass mode or an always-on or boot-on
6147 * regulator and so needs its supply to set the constraints or
6148 * for enable.
6149 */
6150 /* FIXME: this currently triggers a chicken-and-egg problem
6151 * when creating -SUPPLY symlink in sysfs to a regulator
6152 * that is just being created
6153 */
6154 rdev_dbg(rdev, "will resolve supply early: %s\n",
6155 rdev->supply_name);
6156 ret = regulator_resolve_supply(rdev);
6157 if (!ret)
6158 ret = set_machine_constraints(rdev, false);
6159 else
6160 rdev_dbg(rdev, "unable to resolve supply early: %pe\n",
6161 ERR_PTR(ret));
6162 tried_supply_resolve = true;
6163 }
6164 if (ret < 0) {
6165 if (ret != -EPROBE_DEFER)
6166 goto wash;
6167 rdev->constraints_pending = true;
6168 }
6169
6170 ret = regulator_init_coupling(rdev);
6171 if (ret < 0)
6172 goto wash;
6173
6174 /* add consumers devices */
6175 if (init_data) {
6176 for (i = 0; i < init_data->num_consumer_supplies; i++) {
6177 ret = set_consumer_device_supply(rdev,
6178 init_data->consumer_supplies[i].dev_name,
6179 init_data->consumer_supplies[i].supply);
6180 if (ret < 0) {
6181 dev_err(dev, "Failed to set supply %s\n",
6182 init_data->consumer_supplies[i].supply);
6183 goto unset_supplies;
6184 }
6185 }
6186 }
6187
6188 if (!rdev->desc->ops->get_voltage &&
6189 !rdev->desc->ops->list_voltage &&
6190 !rdev->desc->fixed_uV)
6191 rdev->is_switch = true;
6192
6193 ret = device_add(&rdev->dev);
6194 if (ret != 0)
6195 goto unset_supplies;
6196
6197 if (!tried_supply_resolve) {
6198 /*
6199 * As an optimisation, try to resolve our supply (if any) now to
6200 * avoid adding the bus device. Errors are not fatal at this
6201 * stage, we'll simply try again later.
6202 */
6203 ret = regulator_resolve_supply(rdev);
6204 if (ret)
6205 rdev_dbg(rdev,
6206 "unable to resolve supply (ignoring): %pe\n",
6207 ERR_PTR(ret));
6208 }
6209
6210 /*
6211 * If we have a supply but couldn't resolve it yet, register a device
6212 * with our bus, so that the bus probe gets called whenever any new
6213 * driver binds, allowing us to retry matching supplies and which then
6214 * triggers (re)probe of consumers if successful.
6215 */
6216 if (rdev->supply_name && !rdev->supply) {
6217 device_initialize(&rdev->bdev);
6218 rdev->bdev.bus = ®ulator_bus;
6219 rdev->bdev.parent = &rdev->dev;
6220 device_set_pm_not_required(&rdev->dev);
6221 dev_set_name(&rdev->bdev, "%s.bdev", dev_name(&rdev->dev));
6222
6223 ret = device_add(&rdev->bdev);
6224 if (ret)
6225 goto del_cdev_and_bdev;
6226 }
6227
6228 rdev_init_debugfs(rdev);
6229
6230 /* try to resolve regulators coupling since a new one was registered */
6231 mutex_lock(®ulator_list_mutex);
6232 regulator_resolve_coupling(rdev);
6233 mutex_unlock(®ulator_list_mutex);
6234
6235 kfree(config);
6236 return rdev;
6237
6238 del_cdev_and_bdev:
6239 if (rdev->bdev.bus == ®ulator_bus)
6240 put_device(&rdev->bdev);
6241 device_del(&rdev->dev);
6242 unset_supplies:
6243 mutex_lock(®ulator_list_mutex);
6244 unset_regulator_supplies(rdev);
6245 regulator_remove_coupling(rdev);
6246 mutex_unlock(®ulator_list_mutex);
6247 wash:
6248 regulator_put(rdev->supply);
6249 kfree(rdev->coupling_desc.coupled_rdevs);
6250 mutex_lock(®ulator_list_mutex);
6251 regulator_ena_gpio_free(rdev);
6252 mutex_unlock(®ulator_list_mutex);
6253 clean:
6254 if (dangling_of_gpiod)
6255 gpiod_put(config->ena_gpiod);
6256 kfree(config);
6257 put_device(&rdev->dev);
6258 rinse:
6259 if (dangling_cfg_gpiod)
6260 gpiod_put(cfg->ena_gpiod);
6261 return ERR_PTR(ret);
6262 }
6263 EXPORT_SYMBOL_GPL(regulator_register);
6264
6265 /**
6266 * regulator_unregister - unregister regulator
6267 * @rdev: regulator to unregister
6268 *
6269 * Called by regulator drivers to unregister a regulator.
6270 */
regulator_unregister(struct regulator_dev * rdev)6271 void regulator_unregister(struct regulator_dev *rdev)
6272 {
6273 if (rdev == NULL)
6274 return;
6275
6276 if (rdev->supply) {
6277 regulator_unregister_notifier(rdev->supply,
6278 &rdev->supply_fwd_nb);
6279
6280 while (rdev->use_count--)
6281 regulator_disable(rdev->supply);
6282 regulator_put(rdev->supply);
6283 }
6284
6285 flush_work(&rdev->disable_work.work);
6286
6287 mutex_lock(®ulator_list_mutex);
6288
6289 WARN_ON(rdev->open_count);
6290 regulator_remove_coupling(rdev);
6291 unset_regulator_supplies(rdev);
6292 list_del(&rdev->list);
6293 regulator_ena_gpio_free(rdev);
6294 if (rdev->bdev.bus == ®ulator_bus)
6295 /* only if the device was added in the first place */
6296 device_unregister(&rdev->bdev);
6297 device_unregister(&rdev->dev);
6298
6299 mutex_unlock(®ulator_list_mutex);
6300 }
6301 EXPORT_SYMBOL_GPL(regulator_unregister);
6302
6303 #ifdef CONFIG_SUSPEND
6304 /**
6305 * regulator_suspend - prepare regulators for system wide suspend
6306 * @dev: ``&struct device`` pointer that is passed to _regulator_suspend()
6307 *
6308 * Configure each regulator with it's suspend operating parameters for state.
6309 *
6310 * Return: 0 on success or a negative error number on failure.
6311 */
regulator_suspend(struct device * dev)6312 static int regulator_suspend(struct device *dev)
6313 {
6314 struct regulator_dev *rdev = dev_to_rdev(dev);
6315 suspend_state_t state = pm_suspend_target_state;
6316 int ret;
6317 const struct regulator_state *rstate;
6318
6319 rstate = regulator_get_suspend_state_check(rdev, state);
6320 if (!rstate)
6321 return 0;
6322
6323 regulator_lock(rdev);
6324 ret = __suspend_set_state(rdev, rstate);
6325 regulator_unlock(rdev);
6326
6327 return ret;
6328 }
6329
regulator_resume(struct device * dev)6330 static int regulator_resume(struct device *dev)
6331 {
6332 suspend_state_t state = pm_suspend_target_state;
6333 struct regulator_dev *rdev = dev_to_rdev(dev);
6334 struct regulator_state *rstate;
6335 int ret = 0;
6336
6337 rstate = regulator_get_suspend_state(rdev, state);
6338 if (rstate == NULL)
6339 return 0;
6340
6341 /* Avoid grabbing the lock if we don't need to */
6342 if (!rdev->desc->ops->resume)
6343 return 0;
6344
6345 regulator_lock(rdev);
6346
6347 if (rstate->enabled == ENABLE_IN_SUSPEND ||
6348 rstate->enabled == DISABLE_IN_SUSPEND)
6349 ret = rdev->desc->ops->resume(rdev);
6350
6351 regulator_unlock(rdev);
6352
6353 return ret;
6354 }
6355 #else /* !CONFIG_SUSPEND */
6356
6357 #define regulator_suspend NULL
6358 #define regulator_resume NULL
6359
6360 #endif /* !CONFIG_SUSPEND */
6361
6362 #ifdef CONFIG_PM
6363 static const struct dev_pm_ops __maybe_unused regulator_pm_ops = {
6364 .suspend = regulator_suspend,
6365 .resume = regulator_resume,
6366 };
6367 #endif
6368
6369 const struct class regulator_class = {
6370 .name = "regulator",
6371 .dev_release = regulator_dev_release,
6372 .dev_groups = regulator_dev_groups,
6373 #ifdef CONFIG_PM
6374 .pm = ®ulator_pm_ops,
6375 #endif
6376 };
6377
6378 #define bdev_to_rdev(__bdev) container_of_const(__bdev, struct regulator_dev, bdev)
6379
regulator_bus_match(struct device * bdev,const struct device_driver * drv)6380 static int regulator_bus_match(struct device *bdev,
6381 const struct device_driver *drv)
6382 {
6383 /* Match always succeeds, we only have one driver */
6384 return 1;
6385 }
6386
regulator_bus_probe(struct device * bdev)6387 static int regulator_bus_probe(struct device *bdev)
6388 {
6389 struct regulator_dev *rdev = bdev_to_rdev(bdev);
6390 int ret;
6391
6392 ret = regulator_resolve_supply(rdev);
6393 if (ret)
6394 rdev_dbg(rdev,
6395 "unable to resolve supply or constraints '%s': %pe\n",
6396 rdev->supply_name, ERR_PTR(ret));
6397 else
6398 rdev_dbg(rdev, "resolved supply '%s'\n", rdev->supply_name);
6399
6400 return ret;
6401 }
6402
6403 static const struct bus_type regulator_bus = {
6404 .name = "regulator",
6405 .match = regulator_bus_match,
6406 .probe = regulator_bus_probe,
6407 };
6408
6409 static struct device_driver regulator_bus_driver = {
6410 .name = "regulator-bus-drv",
6411 .bus = ®ulator_bus,
6412 .suppress_bind_attrs = true,
6413 .probe_type = PROBE_PREFER_ASYNCHRONOUS,
6414 };
6415
6416 /**
6417 * regulator_has_full_constraints - the system has fully specified constraints
6418 *
6419 * Calling this function will cause the regulator API to disable all
6420 * regulators which have a zero use count and don't have an always_on
6421 * constraint in a late_initcall.
6422 *
6423 * The intention is that this will become the default behaviour in a
6424 * future kernel release so users are encouraged to use this facility
6425 * now.
6426 */
regulator_has_full_constraints(void)6427 void regulator_has_full_constraints(void)
6428 {
6429 has_full_constraints = 1;
6430 }
6431 EXPORT_SYMBOL_GPL(regulator_has_full_constraints);
6432
6433 /**
6434 * rdev_get_drvdata - get rdev regulator driver data
6435 * @rdev: regulator
6436 *
6437 * Get rdev regulator driver private data. This call can be used in the
6438 * regulator driver context.
6439 *
6440 * Return: Pointer to regulator driver private data.
6441 */
rdev_get_drvdata(struct regulator_dev * rdev)6442 void *rdev_get_drvdata(struct regulator_dev *rdev)
6443 {
6444 return rdev->reg_data;
6445 }
6446 EXPORT_SYMBOL_GPL(rdev_get_drvdata);
6447
6448 /**
6449 * regulator_get_drvdata - get regulator driver data
6450 * @regulator: regulator
6451 *
6452 * Get regulator driver private data. This call can be used in the consumer
6453 * driver context when non API regulator specific functions need to be called.
6454 *
6455 * Return: Pointer to regulator driver private data.
6456 */
regulator_get_drvdata(struct regulator * regulator)6457 void *regulator_get_drvdata(struct regulator *regulator)
6458 {
6459 return regulator->rdev->reg_data;
6460 }
6461 EXPORT_SYMBOL_GPL(regulator_get_drvdata);
6462
6463 /**
6464 * regulator_set_drvdata - set regulator driver data
6465 * @regulator: regulator
6466 * @data: data
6467 */
regulator_set_drvdata(struct regulator * regulator,void * data)6468 void regulator_set_drvdata(struct regulator *regulator, void *data)
6469 {
6470 regulator->rdev->reg_data = data;
6471 }
6472 EXPORT_SYMBOL_GPL(regulator_set_drvdata);
6473
6474 /**
6475 * rdev_get_id - get regulator ID
6476 * @rdev: regulator
6477 *
6478 * Return: Regulator ID for @rdev.
6479 */
rdev_get_id(struct regulator_dev * rdev)6480 int rdev_get_id(struct regulator_dev *rdev)
6481 {
6482 return rdev->desc->id;
6483 }
6484 EXPORT_SYMBOL_GPL(rdev_get_id);
6485
rdev_get_dev(struct regulator_dev * rdev)6486 struct device *rdev_get_dev(struct regulator_dev *rdev)
6487 {
6488 return &rdev->dev;
6489 }
6490 EXPORT_SYMBOL_GPL(rdev_get_dev);
6491
rdev_get_regmap(struct regulator_dev * rdev)6492 struct regmap *rdev_get_regmap(struct regulator_dev *rdev)
6493 {
6494 return rdev->regmap;
6495 }
6496 EXPORT_SYMBOL_GPL(rdev_get_regmap);
6497
regulator_get_init_drvdata(struct regulator_init_data * reg_init_data)6498 void *regulator_get_init_drvdata(struct regulator_init_data *reg_init_data)
6499 {
6500 return reg_init_data->driver_data;
6501 }
6502 EXPORT_SYMBOL_GPL(regulator_get_init_drvdata);
6503
6504 #ifdef CONFIG_DEBUG_FS
supply_map_show(struct seq_file * sf,void * data)6505 static int supply_map_show(struct seq_file *sf, void *data)
6506 {
6507 struct regulator_map *map;
6508
6509 list_for_each_entry(map, ®ulator_map_list, list) {
6510 seq_printf(sf, "%s -> %s.%s\n",
6511 rdev_get_name(map->regulator), map->dev_name,
6512 map->supply);
6513 }
6514
6515 return 0;
6516 }
6517 DEFINE_SHOW_ATTRIBUTE(supply_map);
6518
6519 struct summary_data {
6520 struct seq_file *s;
6521 struct regulator_dev *parent;
6522 int level;
6523 };
6524
6525 static void regulator_summary_show_subtree(struct seq_file *s,
6526 struct regulator_dev *rdev,
6527 int level);
6528
regulator_summary_show_children(struct device * dev,void * data)6529 static int regulator_summary_show_children(struct device *dev, void *data)
6530 {
6531 struct regulator_dev *rdev = dev_to_rdev(dev);
6532 struct summary_data *summary_data = data;
6533
6534 if (rdev->supply && rdev->supply->rdev == summary_data->parent)
6535 regulator_summary_show_subtree(summary_data->s, rdev,
6536 summary_data->level + 1);
6537
6538 return 0;
6539 }
6540
regulator_summary_show_subtree(struct seq_file * s,struct regulator_dev * rdev,int level)6541 static void regulator_summary_show_subtree(struct seq_file *s,
6542 struct regulator_dev *rdev,
6543 int level)
6544 {
6545 struct regulation_constraints *c;
6546 struct regulator *consumer;
6547 struct summary_data summary_data;
6548 unsigned int opmode;
6549
6550 if (!rdev)
6551 return;
6552
6553 opmode = _regulator_get_mode_unlocked(rdev);
6554 seq_printf(s, "%*s%-*s %3d %4d %6d %7s ",
6555 level * 3 + 1, "",
6556 30 - level * 3, rdev_get_name(rdev),
6557 rdev->use_count, rdev->open_count, rdev->bypass_count,
6558 regulator_opmode_to_str(opmode));
6559
6560 seq_printf(s, "%5dmV ", regulator_get_voltage_rdev(rdev) / 1000);
6561 seq_printf(s, "%5dmA ",
6562 _regulator_get_current_limit_unlocked(rdev) / 1000);
6563
6564 c = rdev->constraints;
6565 if (c) {
6566 switch (rdev->desc->type) {
6567 case REGULATOR_VOLTAGE:
6568 seq_printf(s, "%5dmV %5dmV ",
6569 c->min_uV / 1000, c->max_uV / 1000);
6570 break;
6571 case REGULATOR_CURRENT:
6572 seq_printf(s, "%5dmA %5dmA ",
6573 c->min_uA / 1000, c->max_uA / 1000);
6574 break;
6575 }
6576 }
6577
6578 seq_puts(s, "\n");
6579
6580 list_for_each_entry(consumer, &rdev->consumer_list, list) {
6581 if (consumer->dev && consumer->dev->class == ®ulator_class)
6582 continue;
6583
6584 seq_printf(s, "%*s%-*s ",
6585 (level + 1) * 3 + 1, "",
6586 30 - (level + 1) * 3,
6587 consumer->supply_name ? consumer->supply_name :
6588 consumer->dev ? dev_name(consumer->dev) : "deviceless");
6589
6590 switch (rdev->desc->type) {
6591 case REGULATOR_VOLTAGE:
6592 seq_printf(s, "%3d %33dmA%c%5dmV %5dmV",
6593 consumer->enable_count,
6594 consumer->uA_load / 1000,
6595 consumer->uA_load && !consumer->enable_count ?
6596 '*' : ' ',
6597 consumer->voltage[PM_SUSPEND_ON].min_uV / 1000,
6598 consumer->voltage[PM_SUSPEND_ON].max_uV / 1000);
6599 break;
6600 case REGULATOR_CURRENT:
6601 break;
6602 }
6603
6604 seq_puts(s, "\n");
6605 }
6606
6607 summary_data.s = s;
6608 summary_data.level = level;
6609 summary_data.parent = rdev;
6610
6611 class_for_each_device(®ulator_class, NULL, &summary_data,
6612 regulator_summary_show_children);
6613 }
6614
6615 struct summary_lock_data {
6616 struct ww_acquire_ctx *ww_ctx;
6617 struct regulator_dev **new_contended_rdev;
6618 struct regulator_dev **old_contended_rdev;
6619 };
6620
regulator_summary_lock_one(struct device * dev,void * data)6621 static int regulator_summary_lock_one(struct device *dev, void *data)
6622 {
6623 struct regulator_dev *rdev = dev_to_rdev(dev);
6624 struct summary_lock_data *lock_data = data;
6625 int ret = 0;
6626
6627 if (rdev != *lock_data->old_contended_rdev) {
6628 ret = regulator_lock_nested(rdev, lock_data->ww_ctx);
6629
6630 if (ret == -EDEADLK)
6631 *lock_data->new_contended_rdev = rdev;
6632 else
6633 WARN_ON_ONCE(ret);
6634 } else {
6635 *lock_data->old_contended_rdev = NULL;
6636 }
6637
6638 return ret;
6639 }
6640
regulator_summary_unlock_one(struct device * dev,void * data)6641 static int regulator_summary_unlock_one(struct device *dev, void *data)
6642 {
6643 struct regulator_dev *rdev = dev_to_rdev(dev);
6644 struct summary_lock_data *lock_data = data;
6645
6646 if (lock_data) {
6647 if (rdev == *lock_data->new_contended_rdev)
6648 return -EDEADLK;
6649 }
6650
6651 regulator_unlock(rdev);
6652
6653 return 0;
6654 }
6655
regulator_summary_lock_all(struct ww_acquire_ctx * ww_ctx,struct regulator_dev ** new_contended_rdev,struct regulator_dev ** old_contended_rdev)6656 static int regulator_summary_lock_all(struct ww_acquire_ctx *ww_ctx,
6657 struct regulator_dev **new_contended_rdev,
6658 struct regulator_dev **old_contended_rdev)
6659 {
6660 struct summary_lock_data lock_data;
6661 int ret;
6662
6663 lock_data.ww_ctx = ww_ctx;
6664 lock_data.new_contended_rdev = new_contended_rdev;
6665 lock_data.old_contended_rdev = old_contended_rdev;
6666
6667 ret = class_for_each_device(®ulator_class, NULL, &lock_data,
6668 regulator_summary_lock_one);
6669 if (ret)
6670 class_for_each_device(®ulator_class, NULL, &lock_data,
6671 regulator_summary_unlock_one);
6672
6673 return ret;
6674 }
6675
regulator_summary_lock(struct ww_acquire_ctx * ww_ctx)6676 static void regulator_summary_lock(struct ww_acquire_ctx *ww_ctx)
6677 {
6678 struct regulator_dev *new_contended_rdev = NULL;
6679 struct regulator_dev *old_contended_rdev = NULL;
6680 int err;
6681
6682 mutex_lock(®ulator_list_mutex);
6683
6684 ww_acquire_init(ww_ctx, ®ulator_ww_class);
6685
6686 do {
6687 if (new_contended_rdev) {
6688 ww_mutex_lock_slow(&new_contended_rdev->mutex, ww_ctx);
6689 old_contended_rdev = new_contended_rdev;
6690 old_contended_rdev->ref_cnt++;
6691 old_contended_rdev->mutex_owner = current;
6692 }
6693
6694 err = regulator_summary_lock_all(ww_ctx,
6695 &new_contended_rdev,
6696 &old_contended_rdev);
6697
6698 if (old_contended_rdev)
6699 regulator_unlock(old_contended_rdev);
6700
6701 } while (err == -EDEADLK);
6702
6703 ww_acquire_done(ww_ctx);
6704 }
6705
regulator_summary_unlock(struct ww_acquire_ctx * ww_ctx)6706 static void regulator_summary_unlock(struct ww_acquire_ctx *ww_ctx)
6707 {
6708 class_for_each_device(®ulator_class, NULL, NULL,
6709 regulator_summary_unlock_one);
6710 ww_acquire_fini(ww_ctx);
6711
6712 mutex_unlock(®ulator_list_mutex);
6713 }
6714
regulator_summary_show_roots(struct device * dev,void * data)6715 static int regulator_summary_show_roots(struct device *dev, void *data)
6716 {
6717 struct regulator_dev *rdev = dev_to_rdev(dev);
6718 struct seq_file *s = data;
6719
6720 if (!rdev->supply)
6721 regulator_summary_show_subtree(s, rdev, 0);
6722
6723 return 0;
6724 }
6725
regulator_summary_show(struct seq_file * s,void * data)6726 static int regulator_summary_show(struct seq_file *s, void *data)
6727 {
6728 struct ww_acquire_ctx ww_ctx;
6729
6730 seq_puts(s, " regulator use open bypass opmode voltage current min max\n");
6731 seq_puts(s, "---------------------------------------------------------------------------------------\n");
6732
6733 regulator_summary_lock(&ww_ctx);
6734
6735 class_for_each_device(®ulator_class, NULL, s,
6736 regulator_summary_show_roots);
6737
6738 regulator_summary_unlock(&ww_ctx);
6739
6740 return 0;
6741 }
6742 DEFINE_SHOW_ATTRIBUTE(regulator_summary);
6743 #endif /* CONFIG_DEBUG_FS */
6744
regulator_init(void)6745 static int __init regulator_init(void)
6746 {
6747 int ret;
6748
6749 ret = bus_register(®ulator_bus);
6750 if (ret)
6751 return ret;
6752
6753 ret = class_register(®ulator_class);
6754 if (ret)
6755 goto err_class;
6756
6757 ret = driver_register(®ulator_bus_driver);
6758 if (ret)
6759 goto err_driver;
6760
6761 debugfs_root = debugfs_create_dir("regulator", NULL);
6762 if (IS_ERR(debugfs_root))
6763 pr_debug("regulator: Failed to create debugfs directory\n");
6764
6765 #ifdef CONFIG_DEBUG_FS
6766 debugfs_create_file("supply_map", 0444, debugfs_root, NULL,
6767 &supply_map_fops);
6768
6769 debugfs_create_file("regulator_summary", 0444, debugfs_root,
6770 NULL, ®ulator_summary_fops);
6771 #endif
6772 regulator_dummy_init();
6773
6774 regulator_coupler_register(&generic_regulator_coupler);
6775
6776 return 0;
6777
6778 err_driver:
6779 class_unregister(®ulator_class);
6780 err_class:
6781 bus_unregister(®ulator_bus);
6782 return ret;
6783 }
6784
6785 /* init early to allow our consumers to complete system booting */
6786 core_initcall(regulator_init);
6787
regulator_late_cleanup(struct device * dev,void * data)6788 static int regulator_late_cleanup(struct device *dev, void *data)
6789 {
6790 struct regulator_dev *rdev = dev_to_rdev(dev);
6791 struct regulation_constraints *c = rdev->constraints;
6792 int ret;
6793
6794 if (c && c->always_on)
6795 return 0;
6796
6797 if (!regulator_ops_is_valid(rdev, REGULATOR_CHANGE_STATUS))
6798 return 0;
6799
6800 regulator_lock(rdev);
6801
6802 if (rdev->use_count)
6803 goto unlock;
6804
6805 /* If reading the status failed, assume that it's off. */
6806 if (_regulator_is_enabled(rdev) <= 0)
6807 goto unlock;
6808
6809 if (have_full_constraints()) {
6810 /* We log since this may kill the system if it goes
6811 * wrong.
6812 */
6813 rdev_info(rdev, "disabling\n");
6814 ret = _regulator_do_disable(rdev);
6815 if (ret != 0)
6816 rdev_err(rdev, "couldn't disable: %pe\n", ERR_PTR(ret));
6817 } else {
6818 /* The intention is that in future we will
6819 * assume that full constraints are provided
6820 * so warn even if we aren't going to do
6821 * anything here.
6822 */
6823 rdev_warn(rdev, "incomplete constraints, leaving on\n");
6824 }
6825
6826 unlock:
6827 regulator_unlock(rdev);
6828
6829 return 0;
6830 }
6831
6832 static bool regulator_ignore_unused;
regulator_ignore_unused_setup(char * __unused)6833 static int __init regulator_ignore_unused_setup(char *__unused)
6834 {
6835 regulator_ignore_unused = true;
6836 return 1;
6837 }
6838 __setup("regulator_ignore_unused", regulator_ignore_unused_setup);
6839
regulator_init_complete_work_function(struct work_struct * work)6840 static void regulator_init_complete_work_function(struct work_struct *work)
6841 {
6842 /*
6843 * For debugging purposes, it may be useful to prevent unused
6844 * regulators from being disabled.
6845 */
6846 if (regulator_ignore_unused) {
6847 pr_warn("regulator: Not disabling unused regulators\n");
6848 return;
6849 }
6850
6851 /* If we have a full configuration then disable any regulators
6852 * we have permission to change the status for and which are
6853 * not in use or always_on. This is effectively the default
6854 * for DT and ACPI as they have full constraints.
6855 */
6856 class_for_each_device(®ulator_class, NULL, NULL,
6857 regulator_late_cleanup);
6858 }
6859
6860 static DECLARE_DELAYED_WORK(regulator_init_complete_work,
6861 regulator_init_complete_work_function);
6862
regulator_init_complete(void)6863 static int __init regulator_init_complete(void)
6864 {
6865 /*
6866 * Since DT doesn't provide an idiomatic mechanism for
6867 * enabling full constraints and since it's much more natural
6868 * with DT to provide them just assume that a DT enabled
6869 * system has full constraints.
6870 */
6871 if (of_have_populated_dt())
6872 has_full_constraints = true;
6873
6874 /*
6875 * We punt completion for an arbitrary amount of time since
6876 * systems like distros will load many drivers from userspace
6877 * so consumers might not always be ready yet, this is
6878 * particularly an issue with laptops where this might bounce
6879 * the display off then on. Ideally we'd get a notification
6880 * from userspace when this happens but we don't so just wait
6881 * a bit and hope we waited long enough. It'd be better if
6882 * we'd only do this on systems that need it, and a kernel
6883 * command line option might be useful.
6884 */
6885 schedule_delayed_work(®ulator_init_complete_work,
6886 msecs_to_jiffies(30000));
6887
6888 return 0;
6889 }
6890 late_initcall_sync(regulator_init_complete);
6891