perf tools: Don't clone maps from parent when synthesizing forks
[linux/fpc-iii.git] / drivers / regulator / helpers.c
blob5686a1335bd30db829215b29a97e29ebee06b97d
1 /*
2 * helpers.c -- Voltage/Current Regulator framework helper functions.
4 * Copyright 2007, 2008 Wolfson Microelectronics PLC.
5 * Copyright 2008 SlimLogic Ltd.
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License as published by the
9 * Free Software Foundation; either version 2 of the License, or (at your
10 * option) any later version.
14 #include <linux/kernel.h>
15 #include <linux/err.h>
16 #include <linux/delay.h>
17 #include <linux/regmap.h>
18 #include <linux/regulator/consumer.h>
19 #include <linux/regulator/driver.h>
20 #include <linux/module.h>
22 /**
23 * regulator_is_enabled_regmap - standard is_enabled() for regmap users
25 * @rdev: regulator to operate on
27 * Regulators that use regmap for their register I/O can set the
28 * enable_reg and enable_mask fields in their descriptor and then use
29 * this as their is_enabled operation, saving some code.
31 int regulator_is_enabled_regmap(struct regulator_dev *rdev)
33 unsigned int val;
34 int ret;
36 ret = regmap_read(rdev->regmap, rdev->desc->enable_reg, &val);
37 if (ret != 0)
38 return ret;
40 val &= rdev->desc->enable_mask;
42 if (rdev->desc->enable_is_inverted) {
43 if (rdev->desc->enable_val)
44 return val != rdev->desc->enable_val;
45 return val == 0;
46 } else {
47 if (rdev->desc->enable_val)
48 return val == rdev->desc->enable_val;
49 return val != 0;
52 EXPORT_SYMBOL_GPL(regulator_is_enabled_regmap);
54 /**
55 * regulator_enable_regmap - standard enable() for regmap users
57 * @rdev: regulator to operate on
59 * Regulators that use regmap for their register I/O can set the
60 * enable_reg and enable_mask fields in their descriptor and then use
61 * this as their enable() operation, saving some code.
63 int regulator_enable_regmap(struct regulator_dev *rdev)
65 unsigned int val;
67 if (rdev->desc->enable_is_inverted) {
68 val = rdev->desc->disable_val;
69 } else {
70 val = rdev->desc->enable_val;
71 if (!val)
72 val = rdev->desc->enable_mask;
75 return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
76 rdev->desc->enable_mask, val);
78 EXPORT_SYMBOL_GPL(regulator_enable_regmap);
80 /**
81 * regulator_disable_regmap - standard disable() for regmap users
83 * @rdev: regulator to operate on
85 * Regulators that use regmap for their register I/O can set the
86 * enable_reg and enable_mask fields in their descriptor and then use
87 * this as their disable() operation, saving some code.
89 int regulator_disable_regmap(struct regulator_dev *rdev)
91 unsigned int val;
93 if (rdev->desc->enable_is_inverted) {
94 val = rdev->desc->enable_val;
95 if (!val)
96 val = rdev->desc->enable_mask;
97 } else {
98 val = rdev->desc->disable_val;
101 return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
102 rdev->desc->enable_mask, val);
104 EXPORT_SYMBOL_GPL(regulator_disable_regmap);
106 static int regulator_range_selector_to_index(struct regulator_dev *rdev,
107 unsigned int rval)
109 int i;
111 if (!rdev->desc->linear_range_selectors)
112 return -EINVAL;
114 rval &= rdev->desc->vsel_range_mask;
116 for (i = 0; i < rdev->desc->n_linear_ranges; i++) {
117 if (rdev->desc->linear_range_selectors[i] == rval)
118 return i;
120 return -EINVAL;
124 * regulator_get_voltage_sel_pickable_regmap - pickable range get_voltage_sel
126 * @rdev: regulator to operate on
128 * Regulators that use regmap for their register I/O and use pickable
129 * ranges can set the vsel_reg, vsel_mask, vsel_range_reg and vsel_range_mask
130 * fields in their descriptor and then use this as their get_voltage_vsel
131 * operation, saving some code.
133 int regulator_get_voltage_sel_pickable_regmap(struct regulator_dev *rdev)
135 unsigned int r_val;
136 int range;
137 unsigned int val;
138 int ret, i;
139 unsigned int voltages_in_range = 0;
141 if (!rdev->desc->linear_ranges)
142 return -EINVAL;
144 ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
145 if (ret != 0)
146 return ret;
148 ret = regmap_read(rdev->regmap, rdev->desc->vsel_range_reg, &r_val);
149 if (ret != 0)
150 return ret;
152 val &= rdev->desc->vsel_mask;
153 val >>= ffs(rdev->desc->vsel_mask) - 1;
155 range = regulator_range_selector_to_index(rdev, r_val);
156 if (range < 0)
157 return -EINVAL;
159 for (i = 0; i < range; i++)
160 voltages_in_range += (rdev->desc->linear_ranges[i].max_sel -
161 rdev->desc->linear_ranges[i].min_sel) + 1;
163 return val + voltages_in_range;
165 EXPORT_SYMBOL_GPL(regulator_get_voltage_sel_pickable_regmap);
168 * regulator_set_voltage_sel_pickable_regmap - pickable range set_voltage_sel
170 * @rdev: regulator to operate on
171 * @sel: Selector to set
173 * Regulators that use regmap for their register I/O and use pickable
174 * ranges can set the vsel_reg, vsel_mask, vsel_range_reg and vsel_range_mask
175 * fields in their descriptor and then use this as their set_voltage_vsel
176 * operation, saving some code.
178 int regulator_set_voltage_sel_pickable_regmap(struct regulator_dev *rdev,
179 unsigned int sel)
181 unsigned int range;
182 int ret, i;
183 unsigned int voltages_in_range = 0;
185 for (i = 0; i < rdev->desc->n_linear_ranges; i++) {
186 voltages_in_range = (rdev->desc->linear_ranges[i].max_sel -
187 rdev->desc->linear_ranges[i].min_sel) + 1;
188 if (sel < voltages_in_range)
189 break;
190 sel -= voltages_in_range;
193 if (i == rdev->desc->n_linear_ranges)
194 return -EINVAL;
196 sel <<= ffs(rdev->desc->vsel_mask) - 1;
197 sel += rdev->desc->linear_ranges[i].min_sel;
199 range = rdev->desc->linear_range_selectors[i];
201 if (rdev->desc->vsel_reg == rdev->desc->vsel_range_reg) {
202 ret = regmap_update_bits(rdev->regmap,
203 rdev->desc->vsel_reg,
204 rdev->desc->vsel_range_mask |
205 rdev->desc->vsel_mask, sel | range);
206 } else {
207 ret = regmap_update_bits(rdev->regmap,
208 rdev->desc->vsel_range_reg,
209 rdev->desc->vsel_range_mask, range);
210 if (ret)
211 return ret;
213 ret = regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg,
214 rdev->desc->vsel_mask, sel);
217 if (ret)
218 return ret;
220 if (rdev->desc->apply_bit)
221 ret = regmap_update_bits(rdev->regmap, rdev->desc->apply_reg,
222 rdev->desc->apply_bit,
223 rdev->desc->apply_bit);
224 return ret;
226 EXPORT_SYMBOL_GPL(regulator_set_voltage_sel_pickable_regmap);
229 * regulator_get_voltage_sel_regmap - standard get_voltage_sel for regmap users
231 * @rdev: regulator to operate on
233 * Regulators that use regmap for their register I/O can set the
234 * vsel_reg and vsel_mask fields in their descriptor and then use this
235 * as their get_voltage_vsel operation, saving some code.
237 int regulator_get_voltage_sel_regmap(struct regulator_dev *rdev)
239 unsigned int val;
240 int ret;
242 ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
243 if (ret != 0)
244 return ret;
246 val &= rdev->desc->vsel_mask;
247 val >>= ffs(rdev->desc->vsel_mask) - 1;
249 return val;
251 EXPORT_SYMBOL_GPL(regulator_get_voltage_sel_regmap);
254 * regulator_set_voltage_sel_regmap - standard set_voltage_sel for regmap users
256 * @rdev: regulator to operate on
257 * @sel: Selector to set
259 * Regulators that use regmap for their register I/O can set the
260 * vsel_reg and vsel_mask fields in their descriptor and then use this
261 * as their set_voltage_vsel operation, saving some code.
263 int regulator_set_voltage_sel_regmap(struct regulator_dev *rdev, unsigned sel)
265 int ret;
267 sel <<= ffs(rdev->desc->vsel_mask) - 1;
269 ret = regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg,
270 rdev->desc->vsel_mask, sel);
271 if (ret)
272 return ret;
274 if (rdev->desc->apply_bit)
275 ret = regmap_update_bits(rdev->regmap, rdev->desc->apply_reg,
276 rdev->desc->apply_bit,
277 rdev->desc->apply_bit);
278 return ret;
280 EXPORT_SYMBOL_GPL(regulator_set_voltage_sel_regmap);
283 * regulator_map_voltage_iterate - map_voltage() based on list_voltage()
285 * @rdev: Regulator to operate on
286 * @min_uV: Lower bound for voltage
287 * @max_uV: Upper bound for voltage
289 * Drivers implementing set_voltage_sel() and list_voltage() can use
290 * this as their map_voltage() operation. It will find a suitable
291 * voltage by calling list_voltage() until it gets something in bounds
292 * for the requested voltages.
294 int regulator_map_voltage_iterate(struct regulator_dev *rdev,
295 int min_uV, int max_uV)
297 int best_val = INT_MAX;
298 int selector = 0;
299 int i, ret;
301 /* Find the smallest voltage that falls within the specified
302 * range.
304 for (i = 0; i < rdev->desc->n_voltages; i++) {
305 ret = rdev->desc->ops->list_voltage(rdev, i);
306 if (ret < 0)
307 continue;
309 if (ret < best_val && ret >= min_uV && ret <= max_uV) {
310 best_val = ret;
311 selector = i;
315 if (best_val != INT_MAX)
316 return selector;
317 else
318 return -EINVAL;
320 EXPORT_SYMBOL_GPL(regulator_map_voltage_iterate);
323 * regulator_map_voltage_ascend - map_voltage() for ascendant voltage list
325 * @rdev: Regulator to operate on
326 * @min_uV: Lower bound for voltage
327 * @max_uV: Upper bound for voltage
329 * Drivers that have ascendant voltage list can use this as their
330 * map_voltage() operation.
332 int regulator_map_voltage_ascend(struct regulator_dev *rdev,
333 int min_uV, int max_uV)
335 int i, ret;
337 for (i = 0; i < rdev->desc->n_voltages; i++) {
338 ret = rdev->desc->ops->list_voltage(rdev, i);
339 if (ret < 0)
340 continue;
342 if (ret > max_uV)
343 break;
345 if (ret >= min_uV && ret <= max_uV)
346 return i;
349 return -EINVAL;
351 EXPORT_SYMBOL_GPL(regulator_map_voltage_ascend);
354 * regulator_map_voltage_linear - map_voltage() for simple linear mappings
356 * @rdev: Regulator to operate on
357 * @min_uV: Lower bound for voltage
358 * @max_uV: Upper bound for voltage
360 * Drivers providing min_uV and uV_step in their regulator_desc can
361 * use this as their map_voltage() operation.
363 int regulator_map_voltage_linear(struct regulator_dev *rdev,
364 int min_uV, int max_uV)
366 int ret, voltage;
368 /* Allow uV_step to be 0 for fixed voltage */
369 if (rdev->desc->n_voltages == 1 && rdev->desc->uV_step == 0) {
370 if (min_uV <= rdev->desc->min_uV && rdev->desc->min_uV <= max_uV)
371 return 0;
372 else
373 return -EINVAL;
376 if (!rdev->desc->uV_step) {
377 BUG_ON(!rdev->desc->uV_step);
378 return -EINVAL;
381 if (min_uV < rdev->desc->min_uV)
382 min_uV = rdev->desc->min_uV;
384 ret = DIV_ROUND_UP(min_uV - rdev->desc->min_uV, rdev->desc->uV_step);
385 if (ret < 0)
386 return ret;
388 ret += rdev->desc->linear_min_sel;
390 /* Map back into a voltage to verify we're still in bounds */
391 voltage = rdev->desc->ops->list_voltage(rdev, ret);
392 if (voltage < min_uV || voltage > max_uV)
393 return -EINVAL;
395 return ret;
397 EXPORT_SYMBOL_GPL(regulator_map_voltage_linear);
400 * regulator_map_voltage_linear_range - map_voltage() for multiple linear ranges
402 * @rdev: Regulator to operate on
403 * @min_uV: Lower bound for voltage
404 * @max_uV: Upper bound for voltage
406 * Drivers providing linear_ranges in their descriptor can use this as
407 * their map_voltage() callback.
409 int regulator_map_voltage_linear_range(struct regulator_dev *rdev,
410 int min_uV, int max_uV)
412 const struct regulator_linear_range *range;
413 int ret = -EINVAL;
414 int voltage, i;
416 if (!rdev->desc->n_linear_ranges) {
417 BUG_ON(!rdev->desc->n_linear_ranges);
418 return -EINVAL;
421 for (i = 0; i < rdev->desc->n_linear_ranges; i++) {
422 int linear_max_uV;
424 range = &rdev->desc->linear_ranges[i];
425 linear_max_uV = range->min_uV +
426 (range->max_sel - range->min_sel) * range->uV_step;
428 if (!(min_uV <= linear_max_uV && max_uV >= range->min_uV))
429 continue;
431 if (min_uV <= range->min_uV)
432 min_uV = range->min_uV;
434 /* range->uV_step == 0 means fixed voltage range */
435 if (range->uV_step == 0) {
436 ret = 0;
437 } else {
438 ret = DIV_ROUND_UP(min_uV - range->min_uV,
439 range->uV_step);
440 if (ret < 0)
441 return ret;
444 ret += range->min_sel;
447 * Map back into a voltage to verify we're still in bounds.
448 * If we are not, then continue checking rest of the ranges.
450 voltage = rdev->desc->ops->list_voltage(rdev, ret);
451 if (voltage >= min_uV && voltage <= max_uV)
452 break;
455 if (i == rdev->desc->n_linear_ranges)
456 return -EINVAL;
458 return ret;
460 EXPORT_SYMBOL_GPL(regulator_map_voltage_linear_range);
463 * regulator_map_voltage_pickable_linear_range - map_voltage, pickable ranges
465 * @rdev: Regulator to operate on
466 * @min_uV: Lower bound for voltage
467 * @max_uV: Upper bound for voltage
469 * Drivers providing pickable linear_ranges in their descriptor can use
470 * this as their map_voltage() callback.
472 int regulator_map_voltage_pickable_linear_range(struct regulator_dev *rdev,
473 int min_uV, int max_uV)
475 const struct regulator_linear_range *range;
476 int ret = -EINVAL;
477 int voltage, i;
478 unsigned int selector = 0;
480 if (!rdev->desc->n_linear_ranges) {
481 BUG_ON(!rdev->desc->n_linear_ranges);
482 return -EINVAL;
485 for (i = 0; i < rdev->desc->n_linear_ranges; i++) {
486 int linear_max_uV;
488 range = &rdev->desc->linear_ranges[i];
489 linear_max_uV = range->min_uV +
490 (range->max_sel - range->min_sel) * range->uV_step;
492 if (!(min_uV <= linear_max_uV && max_uV >= range->min_uV)) {
493 selector += (range->max_sel - range->min_sel + 1);
494 continue;
497 if (min_uV <= range->min_uV)
498 min_uV = range->min_uV;
500 /* range->uV_step == 0 means fixed voltage range */
501 if (range->uV_step == 0) {
502 ret = 0;
503 } else {
504 ret = DIV_ROUND_UP(min_uV - range->min_uV,
505 range->uV_step);
506 if (ret < 0)
507 return ret;
510 ret += selector;
512 voltage = rdev->desc->ops->list_voltage(rdev, ret);
515 * Map back into a voltage to verify we're still in bounds.
516 * We may have overlapping voltage ranges. Hence we don't
517 * exit but retry until we have checked all ranges.
519 if (voltage < min_uV || voltage > max_uV)
520 selector += (range->max_sel - range->min_sel + 1);
521 else
522 break;
525 if (i == rdev->desc->n_linear_ranges)
526 return -EINVAL;
528 return ret;
530 EXPORT_SYMBOL_GPL(regulator_map_voltage_pickable_linear_range);
533 * regulator_list_voltage_linear - List voltages with simple calculation
535 * @rdev: Regulator device
536 * @selector: Selector to convert into a voltage
538 * Regulators with a simple linear mapping between voltages and
539 * selectors can set min_uV and uV_step in the regulator descriptor
540 * and then use this function as their list_voltage() operation,
542 int regulator_list_voltage_linear(struct regulator_dev *rdev,
543 unsigned int selector)
545 if (selector >= rdev->desc->n_voltages)
546 return -EINVAL;
547 if (selector < rdev->desc->linear_min_sel)
548 return 0;
550 selector -= rdev->desc->linear_min_sel;
552 return rdev->desc->min_uV + (rdev->desc->uV_step * selector);
554 EXPORT_SYMBOL_GPL(regulator_list_voltage_linear);
557 * regulator_list_voltage_pickable_linear_range - pickable range list voltages
559 * @rdev: Regulator device
560 * @selector: Selector to convert into a voltage
562 * list_voltage() operation, intended to be used by drivers utilizing pickable
563 * ranges helpers.
565 int regulator_list_voltage_pickable_linear_range(struct regulator_dev *rdev,
566 unsigned int selector)
568 const struct regulator_linear_range *range;
569 int i;
570 unsigned int all_sels = 0;
572 if (!rdev->desc->n_linear_ranges) {
573 BUG_ON(!rdev->desc->n_linear_ranges);
574 return -EINVAL;
577 for (i = 0; i < rdev->desc->n_linear_ranges; i++) {
578 unsigned int sels_in_range;
580 range = &rdev->desc->linear_ranges[i];
582 sels_in_range = range->max_sel - range->min_sel;
584 if (all_sels + sels_in_range >= selector) {
585 selector -= all_sels;
586 return range->min_uV + (range->uV_step * selector);
589 all_sels += (sels_in_range + 1);
592 return -EINVAL;
594 EXPORT_SYMBOL_GPL(regulator_list_voltage_pickable_linear_range);
597 * regulator_list_voltage_linear_range - List voltages for linear ranges
599 * @rdev: Regulator device
600 * @selector: Selector to convert into a voltage
602 * Regulators with a series of simple linear mappings between voltages
603 * and selectors can set linear_ranges in the regulator descriptor and
604 * then use this function as their list_voltage() operation,
606 int regulator_list_voltage_linear_range(struct regulator_dev *rdev,
607 unsigned int selector)
609 const struct regulator_linear_range *range;
610 int i;
612 if (!rdev->desc->n_linear_ranges) {
613 BUG_ON(!rdev->desc->n_linear_ranges);
614 return -EINVAL;
617 for (i = 0; i < rdev->desc->n_linear_ranges; i++) {
618 range = &rdev->desc->linear_ranges[i];
620 if (!(selector >= range->min_sel &&
621 selector <= range->max_sel))
622 continue;
624 selector -= range->min_sel;
626 return range->min_uV + (range->uV_step * selector);
629 return -EINVAL;
631 EXPORT_SYMBOL_GPL(regulator_list_voltage_linear_range);
634 * regulator_list_voltage_table - List voltages with table based mapping
636 * @rdev: Regulator device
637 * @selector: Selector to convert into a voltage
639 * Regulators with table based mapping between voltages and
640 * selectors can set volt_table in the regulator descriptor
641 * and then use this function as their list_voltage() operation.
643 int regulator_list_voltage_table(struct regulator_dev *rdev,
644 unsigned int selector)
646 if (!rdev->desc->volt_table) {
647 BUG_ON(!rdev->desc->volt_table);
648 return -EINVAL;
651 if (selector >= rdev->desc->n_voltages)
652 return -EINVAL;
654 return rdev->desc->volt_table[selector];
656 EXPORT_SYMBOL_GPL(regulator_list_voltage_table);
659 * regulator_set_bypass_regmap - Default set_bypass() using regmap
661 * @rdev: device to operate on.
662 * @enable: state to set.
664 int regulator_set_bypass_regmap(struct regulator_dev *rdev, bool enable)
666 unsigned int val;
668 if (enable) {
669 val = rdev->desc->bypass_val_on;
670 if (!val)
671 val = rdev->desc->bypass_mask;
672 } else {
673 val = rdev->desc->bypass_val_off;
676 return regmap_update_bits(rdev->regmap, rdev->desc->bypass_reg,
677 rdev->desc->bypass_mask, val);
679 EXPORT_SYMBOL_GPL(regulator_set_bypass_regmap);
682 * regulator_set_soft_start_regmap - Default set_soft_start() using regmap
684 * @rdev: device to operate on.
686 int regulator_set_soft_start_regmap(struct regulator_dev *rdev)
688 unsigned int val;
690 val = rdev->desc->soft_start_val_on;
691 if (!val)
692 val = rdev->desc->soft_start_mask;
694 return regmap_update_bits(rdev->regmap, rdev->desc->soft_start_reg,
695 rdev->desc->soft_start_mask, val);
697 EXPORT_SYMBOL_GPL(regulator_set_soft_start_regmap);
700 * regulator_set_pull_down_regmap - Default set_pull_down() using regmap
702 * @rdev: device to operate on.
704 int regulator_set_pull_down_regmap(struct regulator_dev *rdev)
706 unsigned int val;
708 val = rdev->desc->pull_down_val_on;
709 if (!val)
710 val = rdev->desc->pull_down_mask;
712 return regmap_update_bits(rdev->regmap, rdev->desc->pull_down_reg,
713 rdev->desc->pull_down_mask, val);
715 EXPORT_SYMBOL_GPL(regulator_set_pull_down_regmap);
718 * regulator_get_bypass_regmap - Default get_bypass() using regmap
720 * @rdev: device to operate on.
721 * @enable: current state.
723 int regulator_get_bypass_regmap(struct regulator_dev *rdev, bool *enable)
725 unsigned int val;
726 unsigned int val_on = rdev->desc->bypass_val_on;
727 int ret;
729 ret = regmap_read(rdev->regmap, rdev->desc->bypass_reg, &val);
730 if (ret != 0)
731 return ret;
733 if (!val_on)
734 val_on = rdev->desc->bypass_mask;
736 *enable = (val & rdev->desc->bypass_mask) == val_on;
738 return 0;
740 EXPORT_SYMBOL_GPL(regulator_get_bypass_regmap);
743 * regulator_set_active_discharge_regmap - Default set_active_discharge()
744 * using regmap
746 * @rdev: device to operate on.
747 * @enable: state to set, 0 to disable and 1 to enable.
749 int regulator_set_active_discharge_regmap(struct regulator_dev *rdev,
750 bool enable)
752 unsigned int val;
754 if (enable)
755 val = rdev->desc->active_discharge_on;
756 else
757 val = rdev->desc->active_discharge_off;
759 return regmap_update_bits(rdev->regmap,
760 rdev->desc->active_discharge_reg,
761 rdev->desc->active_discharge_mask, val);
763 EXPORT_SYMBOL_GPL(regulator_set_active_discharge_regmap);