Commit | Line | Data |
---|---|---|
2874c5fd | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
c4a54b8d MB |
2 | /* |
3 | * helpers.c -- Voltage/Current Regulator framework helper functions. | |
4 | * | |
5 | * Copyright 2007, 2008 Wolfson Microelectronics PLC. | |
6 | * Copyright 2008 SlimLogic Ltd. | |
c4a54b8d MB |
7 | */ |
8 | ||
9 | #include <linux/kernel.h> | |
10 | #include <linux/err.h> | |
11 | #include <linux/delay.h> | |
12 | #include <linux/regmap.h> | |
13 | #include <linux/regulator/consumer.h> | |
14 | #include <linux/regulator/driver.h> | |
15 | #include <linux/module.h> | |
16 | ||
17 | /** | |
18 | * regulator_is_enabled_regmap - standard is_enabled() for regmap users | |
19 | * | |
20 | * @rdev: regulator to operate on | |
21 | * | |
22 | * Regulators that use regmap for their register I/O can set the | |
23 | * enable_reg and enable_mask fields in their descriptor and then use | |
24 | * this as their is_enabled operation, saving some code. | |
25 | */ | |
26 | int regulator_is_enabled_regmap(struct regulator_dev *rdev) | |
27 | { | |
28 | unsigned int val; | |
29 | int ret; | |
30 | ||
31 | ret = regmap_read(rdev->regmap, rdev->desc->enable_reg, &val); | |
32 | if (ret != 0) | |
33 | return ret; | |
34 | ||
ca5d1b35 CC |
35 | val &= rdev->desc->enable_mask; |
36 | ||
37 | if (rdev->desc->enable_is_inverted) { | |
38 | if (rdev->desc->enable_val) | |
39 | return val != rdev->desc->enable_val; | |
40 | return val == 0; | |
41 | } else { | |
42 | if (rdev->desc->enable_val) | |
43 | return val == rdev->desc->enable_val; | |
44 | return val != 0; | |
45 | } | |
c4a54b8d MB |
46 | } |
47 | EXPORT_SYMBOL_GPL(regulator_is_enabled_regmap); | |
48 | ||
49 | /** | |
50 | * regulator_enable_regmap - standard enable() for regmap users | |
51 | * | |
52 | * @rdev: regulator to operate on | |
53 | * | |
54 | * Regulators that use regmap for their register I/O can set the | |
55 | * enable_reg and enable_mask fields in their descriptor and then use | |
56 | * this as their enable() operation, saving some code. | |
57 | */ | |
58 | int regulator_enable_regmap(struct regulator_dev *rdev) | |
59 | { | |
60 | unsigned int val; | |
61 | ||
ca5d1b35 CC |
62 | if (rdev->desc->enable_is_inverted) { |
63 | val = rdev->desc->disable_val; | |
64 | } else { | |
65 | val = rdev->desc->enable_val; | |
66 | if (!val) | |
67 | val = rdev->desc->enable_mask; | |
68 | } | |
c4a54b8d MB |
69 | |
70 | return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg, | |
71 | rdev->desc->enable_mask, val); | |
72 | } | |
73 | EXPORT_SYMBOL_GPL(regulator_enable_regmap); | |
74 | ||
75 | /** | |
76 | * regulator_disable_regmap - standard disable() for regmap users | |
77 | * | |
78 | * @rdev: regulator to operate on | |
79 | * | |
80 | * Regulators that use regmap for their register I/O can set the | |
81 | * enable_reg and enable_mask fields in their descriptor and then use | |
82 | * this as their disable() operation, saving some code. | |
83 | */ | |
84 | int regulator_disable_regmap(struct regulator_dev *rdev) | |
85 | { | |
86 | unsigned int val; | |
87 | ||
ca5d1b35 CC |
88 | if (rdev->desc->enable_is_inverted) { |
89 | val = rdev->desc->enable_val; | |
90 | if (!val) | |
91 | val = rdev->desc->enable_mask; | |
92 | } else { | |
93 | val = rdev->desc->disable_val; | |
94 | } | |
c4a54b8d MB |
95 | |
96 | return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg, | |
97 | rdev->desc->enable_mask, val); | |
98 | } | |
99 | EXPORT_SYMBOL_GPL(regulator_disable_regmap); | |
100 | ||
18e4b55f MV |
101 | static int regulator_range_selector_to_index(struct regulator_dev *rdev, |
102 | unsigned int rval) | |
103 | { | |
104 | int i; | |
105 | ||
106 | if (!rdev->desc->linear_range_selectors) | |
107 | return -EINVAL; | |
108 | ||
109 | rval &= rdev->desc->vsel_range_mask; | |
110 | ||
111 | for (i = 0; i < rdev->desc->n_linear_ranges; i++) { | |
112 | if (rdev->desc->linear_range_selectors[i] == rval) | |
113 | return i; | |
114 | } | |
115 | return -EINVAL; | |
116 | } | |
117 | ||
118 | /** | |
119 | * regulator_get_voltage_sel_pickable_regmap - pickable range get_voltage_sel | |
120 | * | |
121 | * @rdev: regulator to operate on | |
122 | * | |
123 | * Regulators that use regmap for their register I/O and use pickable | |
124 | * ranges can set the vsel_reg, vsel_mask, vsel_range_reg and vsel_range_mask | |
125 | * fields in their descriptor and then use this as their get_voltage_vsel | |
126 | * operation, saving some code. | |
127 | */ | |
128 | int regulator_get_voltage_sel_pickable_regmap(struct regulator_dev *rdev) | |
129 | { | |
130 | unsigned int r_val; | |
131 | int range; | |
132 | unsigned int val; | |
133 | int ret, i; | |
134 | unsigned int voltages_in_range = 0; | |
135 | ||
136 | if (!rdev->desc->linear_ranges) | |
137 | return -EINVAL; | |
138 | ||
139 | ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val); | |
140 | if (ret != 0) | |
141 | return ret; | |
142 | ||
143 | ret = regmap_read(rdev->regmap, rdev->desc->vsel_range_reg, &r_val); | |
144 | if (ret != 0) | |
145 | return ret; | |
146 | ||
147 | val &= rdev->desc->vsel_mask; | |
148 | val >>= ffs(rdev->desc->vsel_mask) - 1; | |
149 | ||
150 | range = regulator_range_selector_to_index(rdev, r_val); | |
151 | if (range < 0) | |
152 | return -EINVAL; | |
153 | ||
154 | for (i = 0; i < range; i++) | |
155 | voltages_in_range += (rdev->desc->linear_ranges[i].max_sel - | |
156 | rdev->desc->linear_ranges[i].min_sel) + 1; | |
157 | ||
158 | return val + voltages_in_range; | |
159 | } | |
160 | EXPORT_SYMBOL_GPL(regulator_get_voltage_sel_pickable_regmap); | |
161 | ||
162 | /** | |
163 | * regulator_set_voltage_sel_pickable_regmap - pickable range set_voltage_sel | |
164 | * | |
165 | * @rdev: regulator to operate on | |
166 | * @sel: Selector to set | |
167 | * | |
168 | * Regulators that use regmap for their register I/O and use pickable | |
169 | * ranges can set the vsel_reg, vsel_mask, vsel_range_reg and vsel_range_mask | |
170 | * fields in their descriptor and then use this as their set_voltage_vsel | |
171 | * operation, saving some code. | |
172 | */ | |
173 | int regulator_set_voltage_sel_pickable_regmap(struct regulator_dev *rdev, | |
174 | unsigned int sel) | |
175 | { | |
176 | unsigned int range; | |
177 | int ret, i; | |
178 | unsigned int voltages_in_range = 0; | |
179 | ||
180 | for (i = 0; i < rdev->desc->n_linear_ranges; i++) { | |
181 | voltages_in_range = (rdev->desc->linear_ranges[i].max_sel - | |
182 | rdev->desc->linear_ranges[i].min_sel) + 1; | |
183 | if (sel < voltages_in_range) | |
184 | break; | |
185 | sel -= voltages_in_range; | |
186 | } | |
187 | ||
188 | if (i == rdev->desc->n_linear_ranges) | |
189 | return -EINVAL; | |
190 | ||
191 | sel <<= ffs(rdev->desc->vsel_mask) - 1; | |
192 | sel += rdev->desc->linear_ranges[i].min_sel; | |
193 | ||
194 | range = rdev->desc->linear_range_selectors[i]; | |
195 | ||
196 | if (rdev->desc->vsel_reg == rdev->desc->vsel_range_reg) { | |
197 | ret = regmap_update_bits(rdev->regmap, | |
198 | rdev->desc->vsel_reg, | |
199 | rdev->desc->vsel_range_mask | | |
200 | rdev->desc->vsel_mask, sel | range); | |
201 | } else { | |
202 | ret = regmap_update_bits(rdev->regmap, | |
203 | rdev->desc->vsel_range_reg, | |
204 | rdev->desc->vsel_range_mask, range); | |
205 | if (ret) | |
206 | return ret; | |
207 | ||
208 | ret = regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg, | |
209 | rdev->desc->vsel_mask, sel); | |
210 | } | |
211 | ||
212 | if (ret) | |
213 | return ret; | |
214 | ||
215 | if (rdev->desc->apply_bit) | |
216 | ret = regmap_update_bits(rdev->regmap, rdev->desc->apply_reg, | |
217 | rdev->desc->apply_bit, | |
218 | rdev->desc->apply_bit); | |
219 | return ret; | |
220 | } | |
221 | EXPORT_SYMBOL_GPL(regulator_set_voltage_sel_pickable_regmap); | |
222 | ||
c4a54b8d MB |
223 | /** |
224 | * regulator_get_voltage_sel_regmap - standard get_voltage_sel for regmap users | |
225 | * | |
226 | * @rdev: regulator to operate on | |
227 | * | |
228 | * Regulators that use regmap for their register I/O can set the | |
229 | * vsel_reg and vsel_mask fields in their descriptor and then use this | |
230 | * as their get_voltage_vsel operation, saving some code. | |
231 | */ | |
232 | int regulator_get_voltage_sel_regmap(struct regulator_dev *rdev) | |
233 | { | |
234 | unsigned int val; | |
235 | int ret; | |
236 | ||
237 | ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val); | |
238 | if (ret != 0) | |
239 | return ret; | |
240 | ||
241 | val &= rdev->desc->vsel_mask; | |
242 | val >>= ffs(rdev->desc->vsel_mask) - 1; | |
243 | ||
244 | return val; | |
245 | } | |
246 | EXPORT_SYMBOL_GPL(regulator_get_voltage_sel_regmap); | |
247 | ||
248 | /** | |
249 | * regulator_set_voltage_sel_regmap - standard set_voltage_sel for regmap users | |
250 | * | |
251 | * @rdev: regulator to operate on | |
252 | * @sel: Selector to set | |
253 | * | |
254 | * Regulators that use regmap for their register I/O can set the | |
255 | * vsel_reg and vsel_mask fields in their descriptor and then use this | |
256 | * as their set_voltage_vsel operation, saving some code. | |
257 | */ | |
258 | int regulator_set_voltage_sel_regmap(struct regulator_dev *rdev, unsigned sel) | |
259 | { | |
260 | int ret; | |
261 | ||
262 | sel <<= ffs(rdev->desc->vsel_mask) - 1; | |
263 | ||
264 | ret = regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg, | |
265 | rdev->desc->vsel_mask, sel); | |
266 | if (ret) | |
267 | return ret; | |
268 | ||
269 | if (rdev->desc->apply_bit) | |
270 | ret = regmap_update_bits(rdev->regmap, rdev->desc->apply_reg, | |
271 | rdev->desc->apply_bit, | |
272 | rdev->desc->apply_bit); | |
273 | return ret; | |
274 | } | |
275 | EXPORT_SYMBOL_GPL(regulator_set_voltage_sel_regmap); | |
276 | ||
277 | /** | |
278 | * regulator_map_voltage_iterate - map_voltage() based on list_voltage() | |
279 | * | |
280 | * @rdev: Regulator to operate on | |
281 | * @min_uV: Lower bound for voltage | |
282 | * @max_uV: Upper bound for voltage | |
283 | * | |
284 | * Drivers implementing set_voltage_sel() and list_voltage() can use | |
285 | * this as their map_voltage() operation. It will find a suitable | |
286 | * voltage by calling list_voltage() until it gets something in bounds | |
287 | * for the requested voltages. | |
288 | */ | |
289 | int regulator_map_voltage_iterate(struct regulator_dev *rdev, | |
290 | int min_uV, int max_uV) | |
291 | { | |
292 | int best_val = INT_MAX; | |
293 | int selector = 0; | |
294 | int i, ret; | |
295 | ||
296 | /* Find the smallest voltage that falls within the specified | |
297 | * range. | |
298 | */ | |
299 | for (i = 0; i < rdev->desc->n_voltages; i++) { | |
300 | ret = rdev->desc->ops->list_voltage(rdev, i); | |
301 | if (ret < 0) | |
302 | continue; | |
303 | ||
304 | if (ret < best_val && ret >= min_uV && ret <= max_uV) { | |
305 | best_val = ret; | |
306 | selector = i; | |
307 | } | |
308 | } | |
309 | ||
310 | if (best_val != INT_MAX) | |
311 | return selector; | |
312 | else | |
313 | return -EINVAL; | |
314 | } | |
315 | EXPORT_SYMBOL_GPL(regulator_map_voltage_iterate); | |
316 | ||
317 | /** | |
318 | * regulator_map_voltage_ascend - map_voltage() for ascendant voltage list | |
319 | * | |
320 | * @rdev: Regulator to operate on | |
321 | * @min_uV: Lower bound for voltage | |
322 | * @max_uV: Upper bound for voltage | |
323 | * | |
324 | * Drivers that have ascendant voltage list can use this as their | |
325 | * map_voltage() operation. | |
326 | */ | |
327 | int regulator_map_voltage_ascend(struct regulator_dev *rdev, | |
328 | int min_uV, int max_uV) | |
329 | { | |
330 | int i, ret; | |
331 | ||
332 | for (i = 0; i < rdev->desc->n_voltages; i++) { | |
333 | ret = rdev->desc->ops->list_voltage(rdev, i); | |
334 | if (ret < 0) | |
335 | continue; | |
336 | ||
337 | if (ret > max_uV) | |
338 | break; | |
339 | ||
340 | if (ret >= min_uV && ret <= max_uV) | |
341 | return i; | |
342 | } | |
343 | ||
344 | return -EINVAL; | |
345 | } | |
346 | EXPORT_SYMBOL_GPL(regulator_map_voltage_ascend); | |
347 | ||
348 | /** | |
349 | * regulator_map_voltage_linear - map_voltage() for simple linear mappings | |
350 | * | |
351 | * @rdev: Regulator to operate on | |
352 | * @min_uV: Lower bound for voltage | |
353 | * @max_uV: Upper bound for voltage | |
354 | * | |
355 | * Drivers providing min_uV and uV_step in their regulator_desc can | |
356 | * use this as their map_voltage() operation. | |
357 | */ | |
358 | int regulator_map_voltage_linear(struct regulator_dev *rdev, | |
359 | int min_uV, int max_uV) | |
360 | { | |
361 | int ret, voltage; | |
362 | ||
363 | /* Allow uV_step to be 0 for fixed voltage */ | |
364 | if (rdev->desc->n_voltages == 1 && rdev->desc->uV_step == 0) { | |
365 | if (min_uV <= rdev->desc->min_uV && rdev->desc->min_uV <= max_uV) | |
366 | return 0; | |
367 | else | |
368 | return -EINVAL; | |
369 | } | |
370 | ||
371 | if (!rdev->desc->uV_step) { | |
372 | BUG_ON(!rdev->desc->uV_step); | |
373 | return -EINVAL; | |
374 | } | |
375 | ||
376 | if (min_uV < rdev->desc->min_uV) | |
377 | min_uV = rdev->desc->min_uV; | |
378 | ||
379 | ret = DIV_ROUND_UP(min_uV - rdev->desc->min_uV, rdev->desc->uV_step); | |
380 | if (ret < 0) | |
381 | return ret; | |
382 | ||
383 | ret += rdev->desc->linear_min_sel; | |
384 | ||
385 | /* Map back into a voltage to verify we're still in bounds */ | |
386 | voltage = rdev->desc->ops->list_voltage(rdev, ret); | |
387 | if (voltage < min_uV || voltage > max_uV) | |
388 | return -EINVAL; | |
389 | ||
390 | return ret; | |
391 | } | |
392 | EXPORT_SYMBOL_GPL(regulator_map_voltage_linear); | |
393 | ||
394 | /** | |
43343f8d | 395 | * regulator_map_voltage_linear_range - map_voltage() for multiple linear ranges |
c4a54b8d MB |
396 | * |
397 | * @rdev: Regulator to operate on | |
398 | * @min_uV: Lower bound for voltage | |
399 | * @max_uV: Upper bound for voltage | |
400 | * | |
401 | * Drivers providing linear_ranges in their descriptor can use this as | |
402 | * their map_voltage() callback. | |
403 | */ | |
404 | int regulator_map_voltage_linear_range(struct regulator_dev *rdev, | |
405 | int min_uV, int max_uV) | |
406 | { | |
407 | const struct regulator_linear_range *range; | |
408 | int ret = -EINVAL; | |
409 | int voltage, i; | |
410 | ||
411 | if (!rdev->desc->n_linear_ranges) { | |
412 | BUG_ON(!rdev->desc->n_linear_ranges); | |
413 | return -EINVAL; | |
414 | } | |
415 | ||
416 | for (i = 0; i < rdev->desc->n_linear_ranges; i++) { | |
e277e656 AL |
417 | int linear_max_uV; |
418 | ||
c4a54b8d | 419 | range = &rdev->desc->linear_ranges[i]; |
e277e656 AL |
420 | linear_max_uV = range->min_uV + |
421 | (range->max_sel - range->min_sel) * range->uV_step; | |
c4a54b8d | 422 | |
e277e656 | 423 | if (!(min_uV <= linear_max_uV && max_uV >= range->min_uV)) |
c4a54b8d MB |
424 | continue; |
425 | ||
426 | if (min_uV <= range->min_uV) | |
427 | min_uV = range->min_uV; | |
428 | ||
429 | /* range->uV_step == 0 means fixed voltage range */ | |
430 | if (range->uV_step == 0) { | |
431 | ret = 0; | |
432 | } else { | |
433 | ret = DIV_ROUND_UP(min_uV - range->min_uV, | |
434 | range->uV_step); | |
435 | if (ret < 0) | |
436 | return ret; | |
437 | } | |
438 | ||
439 | ret += range->min_sel; | |
440 | ||
e7d80b6b MV |
441 | /* |
442 | * Map back into a voltage to verify we're still in bounds. | |
443 | * If we are not, then continue checking rest of the ranges. | |
444 | */ | |
445 | voltage = rdev->desc->ops->list_voltage(rdev, ret); | |
446 | if (voltage >= min_uV && voltage <= max_uV) | |
447 | break; | |
c4a54b8d MB |
448 | } |
449 | ||
450 | if (i == rdev->desc->n_linear_ranges) | |
451 | return -EINVAL; | |
452 | ||
c4a54b8d MB |
453 | return ret; |
454 | } | |
455 | EXPORT_SYMBOL_GPL(regulator_map_voltage_linear_range); | |
456 | ||
18e4b55f MV |
457 | /** |
458 | * regulator_map_voltage_pickable_linear_range - map_voltage, pickable ranges | |
459 | * | |
460 | * @rdev: Regulator to operate on | |
461 | * @min_uV: Lower bound for voltage | |
462 | * @max_uV: Upper bound for voltage | |
463 | * | |
464 | * Drivers providing pickable linear_ranges in their descriptor can use | |
465 | * this as their map_voltage() callback. | |
466 | */ | |
467 | int regulator_map_voltage_pickable_linear_range(struct regulator_dev *rdev, | |
468 | int min_uV, int max_uV) | |
469 | { | |
470 | const struct regulator_linear_range *range; | |
471 | int ret = -EINVAL; | |
472 | int voltage, i; | |
473 | unsigned int selector = 0; | |
474 | ||
475 | if (!rdev->desc->n_linear_ranges) { | |
476 | BUG_ON(!rdev->desc->n_linear_ranges); | |
477 | return -EINVAL; | |
478 | } | |
479 | ||
480 | for (i = 0; i < rdev->desc->n_linear_ranges; i++) { | |
481 | int linear_max_uV; | |
482 | ||
483 | range = &rdev->desc->linear_ranges[i]; | |
484 | linear_max_uV = range->min_uV + | |
485 | (range->max_sel - range->min_sel) * range->uV_step; | |
486 | ||
487 | if (!(min_uV <= linear_max_uV && max_uV >= range->min_uV)) { | |
488 | selector += (range->max_sel - range->min_sel + 1); | |
489 | continue; | |
490 | } | |
491 | ||
492 | if (min_uV <= range->min_uV) | |
493 | min_uV = range->min_uV; | |
494 | ||
495 | /* range->uV_step == 0 means fixed voltage range */ | |
496 | if (range->uV_step == 0) { | |
497 | ret = 0; | |
498 | } else { | |
499 | ret = DIV_ROUND_UP(min_uV - range->min_uV, | |
500 | range->uV_step); | |
501 | if (ret < 0) | |
502 | return ret; | |
503 | } | |
504 | ||
505 | ret += selector; | |
506 | ||
507 | voltage = rdev->desc->ops->list_voltage(rdev, ret); | |
508 | ||
509 | /* | |
510 | * Map back into a voltage to verify we're still in bounds. | |
511 | * We may have overlapping voltage ranges. Hence we don't | |
512 | * exit but retry until we have checked all ranges. | |
513 | */ | |
514 | if (voltage < min_uV || voltage > max_uV) | |
515 | selector += (range->max_sel - range->min_sel + 1); | |
516 | else | |
517 | break; | |
518 | } | |
519 | ||
520 | if (i == rdev->desc->n_linear_ranges) | |
521 | return -EINVAL; | |
522 | ||
523 | return ret; | |
524 | } | |
525 | EXPORT_SYMBOL_GPL(regulator_map_voltage_pickable_linear_range); | |
526 | ||
d295f767 AL |
527 | /** |
528 | * regulator_list_voltage_linear - List voltages with simple calculation | |
529 | * | |
530 | * @rdev: Regulator device | |
531 | * @selector: Selector to convert into a voltage | |
532 | * | |
533 | * Regulators with a simple linear mapping between voltages and | |
534 | * selectors can set min_uV and uV_step in the regulator descriptor | |
535 | * and then use this function as their list_voltage() operation, | |
536 | */ | |
537 | int regulator_list_voltage_linear(struct regulator_dev *rdev, | |
538 | unsigned int selector) | |
539 | { | |
540 | if (selector >= rdev->desc->n_voltages) | |
541 | return -EINVAL; | |
542 | if (selector < rdev->desc->linear_min_sel) | |
543 | return 0; | |
544 | ||
545 | selector -= rdev->desc->linear_min_sel; | |
546 | ||
547 | return rdev->desc->min_uV + (rdev->desc->uV_step * selector); | |
548 | } | |
549 | EXPORT_SYMBOL_GPL(regulator_list_voltage_linear); | |
550 | ||
18e4b55f MV |
551 | /** |
552 | * regulator_list_voltage_pickable_linear_range - pickable range list voltages | |
553 | * | |
554 | * @rdev: Regulator device | |
555 | * @selector: Selector to convert into a voltage | |
556 | * | |
557 | * list_voltage() operation, intended to be used by drivers utilizing pickable | |
558 | * ranges helpers. | |
559 | */ | |
560 | int regulator_list_voltage_pickable_linear_range(struct regulator_dev *rdev, | |
561 | unsigned int selector) | |
562 | { | |
563 | const struct regulator_linear_range *range; | |
564 | int i; | |
565 | unsigned int all_sels = 0; | |
566 | ||
567 | if (!rdev->desc->n_linear_ranges) { | |
568 | BUG_ON(!rdev->desc->n_linear_ranges); | |
569 | return -EINVAL; | |
570 | } | |
571 | ||
572 | for (i = 0; i < rdev->desc->n_linear_ranges; i++) { | |
573 | unsigned int sels_in_range; | |
574 | ||
575 | range = &rdev->desc->linear_ranges[i]; | |
576 | ||
577 | sels_in_range = range->max_sel - range->min_sel; | |
578 | ||
579 | if (all_sels + sels_in_range >= selector) { | |
580 | selector -= all_sels; | |
581 | return range->min_uV + (range->uV_step * selector); | |
582 | } | |
583 | ||
584 | all_sels += (sels_in_range + 1); | |
585 | } | |
586 | ||
587 | return -EINVAL; | |
588 | } | |
589 | EXPORT_SYMBOL_GPL(regulator_list_voltage_pickable_linear_range); | |
590 | ||
d295f767 | 591 | /** |
6a47b4da | 592 | * regulator_desc_list_voltage_linear_range - List voltages for linear ranges |
d295f767 | 593 | * |
6a47b4da | 594 | * @desc: Regulator desc for regulator which volatges are to be listed |
d295f767 AL |
595 | * @selector: Selector to convert into a voltage |
596 | * | |
597 | * Regulators with a series of simple linear mappings between voltages | |
6a47b4da MV |
598 | * and selectors who have set linear_ranges in the regulator descriptor |
599 | * can use this function prior regulator registration to list voltages. | |
600 | * This is useful when voltages need to be listed during device-tree | |
601 | * parsing. | |
d295f767 | 602 | */ |
6a47b4da MV |
603 | int regulator_desc_list_voltage_linear_range(const struct regulator_desc *desc, |
604 | unsigned int selector) | |
d295f767 AL |
605 | { |
606 | const struct regulator_linear_range *range; | |
607 | int i; | |
608 | ||
6a47b4da MV |
609 | if (!desc->n_linear_ranges) { |
610 | BUG_ON(!desc->n_linear_ranges); | |
d295f767 AL |
611 | return -EINVAL; |
612 | } | |
613 | ||
6a47b4da MV |
614 | for (i = 0; i < desc->n_linear_ranges; i++) { |
615 | range = &desc->linear_ranges[i]; | |
d295f767 AL |
616 | |
617 | if (!(selector >= range->min_sel && | |
618 | selector <= range->max_sel)) | |
619 | continue; | |
620 | ||
621 | selector -= range->min_sel; | |
622 | ||
623 | return range->min_uV + (range->uV_step * selector); | |
624 | } | |
625 | ||
626 | return -EINVAL; | |
627 | } | |
6a47b4da MV |
628 | EXPORT_SYMBOL_GPL(regulator_desc_list_voltage_linear_range); |
629 | ||
630 | /** | |
631 | * regulator_list_voltage_linear_range - List voltages for linear ranges | |
632 | * | |
633 | * @rdev: Regulator device | |
634 | * @selector: Selector to convert into a voltage | |
635 | * | |
636 | * Regulators with a series of simple linear mappings between voltages | |
637 | * and selectors can set linear_ranges in the regulator descriptor and | |
638 | * then use this function as their list_voltage() operation, | |
639 | */ | |
640 | int regulator_list_voltage_linear_range(struct regulator_dev *rdev, | |
641 | unsigned int selector) | |
642 | { | |
643 | return regulator_desc_list_voltage_linear_range(rdev->desc, selector); | |
644 | } | |
d295f767 AL |
645 | EXPORT_SYMBOL_GPL(regulator_list_voltage_linear_range); |
646 | ||
647 | /** | |
648 | * regulator_list_voltage_table - List voltages with table based mapping | |
649 | * | |
650 | * @rdev: Regulator device | |
651 | * @selector: Selector to convert into a voltage | |
652 | * | |
653 | * Regulators with table based mapping between voltages and | |
654 | * selectors can set volt_table in the regulator descriptor | |
655 | * and then use this function as their list_voltage() operation. | |
656 | */ | |
657 | int regulator_list_voltage_table(struct regulator_dev *rdev, | |
658 | unsigned int selector) | |
659 | { | |
660 | if (!rdev->desc->volt_table) { | |
661 | BUG_ON(!rdev->desc->volt_table); | |
662 | return -EINVAL; | |
663 | } | |
664 | ||
665 | if (selector >= rdev->desc->n_voltages) | |
666 | return -EINVAL; | |
667 | ||
668 | return rdev->desc->volt_table[selector]; | |
669 | } | |
670 | EXPORT_SYMBOL_GPL(regulator_list_voltage_table); | |
671 | ||
c4a54b8d MB |
672 | /** |
673 | * regulator_set_bypass_regmap - Default set_bypass() using regmap | |
674 | * | |
675 | * @rdev: device to operate on. | |
676 | * @enable: state to set. | |
677 | */ | |
678 | int regulator_set_bypass_regmap(struct regulator_dev *rdev, bool enable) | |
679 | { | |
680 | unsigned int val; | |
681 | ||
ca5d1b35 CC |
682 | if (enable) { |
683 | val = rdev->desc->bypass_val_on; | |
684 | if (!val) | |
685 | val = rdev->desc->bypass_mask; | |
686 | } else { | |
687 | val = rdev->desc->bypass_val_off; | |
688 | } | |
c4a54b8d MB |
689 | |
690 | return regmap_update_bits(rdev->regmap, rdev->desc->bypass_reg, | |
691 | rdev->desc->bypass_mask, val); | |
692 | } | |
693 | EXPORT_SYMBOL_GPL(regulator_set_bypass_regmap); | |
694 | ||
a7a453f5 CK |
695 | /** |
696 | * regulator_set_soft_start_regmap - Default set_soft_start() using regmap | |
697 | * | |
698 | * @rdev: device to operate on. | |
699 | */ | |
700 | int regulator_set_soft_start_regmap(struct regulator_dev *rdev) | |
701 | { | |
702 | unsigned int val; | |
703 | ||
704 | val = rdev->desc->soft_start_val_on; | |
705 | if (!val) | |
706 | val = rdev->desc->soft_start_mask; | |
707 | ||
708 | return regmap_update_bits(rdev->regmap, rdev->desc->soft_start_reg, | |
709 | rdev->desc->soft_start_mask, val); | |
710 | } | |
711 | EXPORT_SYMBOL_GPL(regulator_set_soft_start_regmap); | |
712 | ||
f7d37bc3 CK |
713 | /** |
714 | * regulator_set_pull_down_regmap - Default set_pull_down() using regmap | |
715 | * | |
716 | * @rdev: device to operate on. | |
717 | */ | |
718 | int regulator_set_pull_down_regmap(struct regulator_dev *rdev) | |
719 | { | |
720 | unsigned int val; | |
721 | ||
722 | val = rdev->desc->pull_down_val_on; | |
723 | if (!val) | |
724 | val = rdev->desc->pull_down_mask; | |
725 | ||
726 | return regmap_update_bits(rdev->regmap, rdev->desc->pull_down_reg, | |
727 | rdev->desc->pull_down_mask, val); | |
728 | } | |
729 | EXPORT_SYMBOL_GPL(regulator_set_pull_down_regmap); | |
730 | ||
c4a54b8d MB |
731 | /** |
732 | * regulator_get_bypass_regmap - Default get_bypass() using regmap | |
733 | * | |
734 | * @rdev: device to operate on. | |
735 | * @enable: current state. | |
736 | */ | |
737 | int regulator_get_bypass_regmap(struct regulator_dev *rdev, bool *enable) | |
738 | { | |
739 | unsigned int val; | |
85b03744 | 740 | unsigned int val_on = rdev->desc->bypass_val_on; |
c4a54b8d MB |
741 | int ret; |
742 | ||
743 | ret = regmap_read(rdev->regmap, rdev->desc->bypass_reg, &val); | |
744 | if (ret != 0) | |
745 | return ret; | |
746 | ||
85b03744 CK |
747 | if (!val_on) |
748 | val_on = rdev->desc->bypass_mask; | |
749 | ||
750 | *enable = (val & rdev->desc->bypass_mask) == val_on; | |
c4a54b8d MB |
751 | |
752 | return 0; | |
753 | } | |
754 | EXPORT_SYMBOL_GPL(regulator_get_bypass_regmap); | |
354794da LD |
755 | |
756 | /** | |
757 | * regulator_set_active_discharge_regmap - Default set_active_discharge() | |
758 | * using regmap | |
759 | * | |
760 | * @rdev: device to operate on. | |
761 | * @enable: state to set, 0 to disable and 1 to enable. | |
762 | */ | |
763 | int regulator_set_active_discharge_regmap(struct regulator_dev *rdev, | |
764 | bool enable) | |
765 | { | |
766 | unsigned int val; | |
767 | ||
768 | if (enable) | |
769 | val = rdev->desc->active_discharge_on; | |
770 | else | |
771 | val = rdev->desc->active_discharge_off; | |
772 | ||
773 | return regmap_update_bits(rdev->regmap, | |
774 | rdev->desc->active_discharge_reg, | |
775 | rdev->desc->active_discharge_mask, val); | |
776 | } | |
777 | EXPORT_SYMBOL_GPL(regulator_set_active_discharge_regmap); | |
a32e0c77 AL |
778 | |
779 | /** | |
780 | * regulator_set_current_limit_regmap - set_current_limit for regmap users | |
781 | * | |
782 | * @rdev: regulator to operate on | |
783 | * @min_uA: Lower bound for current limit | |
784 | * @max_uA: Upper bound for current limit | |
785 | * | |
786 | * Regulators that use regmap for their register I/O can set curr_table, | |
787 | * csel_reg and csel_mask fields in their descriptor and then use this | |
788 | * as their set_current_limit operation, saving some code. | |
789 | */ | |
790 | int regulator_set_current_limit_regmap(struct regulator_dev *rdev, | |
791 | int min_uA, int max_uA) | |
792 | { | |
793 | unsigned int n_currents = rdev->desc->n_current_limits; | |
794 | int i, sel = -1; | |
795 | ||
796 | if (n_currents == 0) | |
797 | return -EINVAL; | |
798 | ||
799 | if (rdev->desc->curr_table) { | |
800 | const unsigned int *curr_table = rdev->desc->curr_table; | |
801 | bool ascend = curr_table[n_currents - 1] > curr_table[0]; | |
802 | ||
803 | /* search for closest to maximum */ | |
804 | if (ascend) { | |
805 | for (i = n_currents - 1; i >= 0; i--) { | |
806 | if (min_uA <= curr_table[i] && | |
807 | curr_table[i] <= max_uA) { | |
808 | sel = i; | |
809 | break; | |
810 | } | |
811 | } | |
812 | } else { | |
813 | for (i = 0; i < n_currents; i++) { | |
814 | if (min_uA <= curr_table[i] && | |
815 | curr_table[i] <= max_uA) { | |
816 | sel = i; | |
817 | break; | |
818 | } | |
819 | } | |
820 | } | |
821 | } | |
822 | ||
823 | if (sel < 0) | |
824 | return -EINVAL; | |
825 | ||
826 | sel <<= ffs(rdev->desc->csel_mask) - 1; | |
827 | ||
828 | return regmap_update_bits(rdev->regmap, rdev->desc->csel_reg, | |
829 | rdev->desc->csel_mask, sel); | |
830 | } | |
831 | EXPORT_SYMBOL_GPL(regulator_set_current_limit_regmap); | |
832 | ||
833 | /** | |
834 | * regulator_get_current_limit_regmap - get_current_limit for regmap users | |
835 | * | |
836 | * @rdev: regulator to operate on | |
837 | * | |
838 | * Regulators that use regmap for their register I/O can set the | |
839 | * csel_reg and csel_mask fields in their descriptor and then use this | |
840 | * as their get_current_limit operation, saving some code. | |
841 | */ | |
842 | int regulator_get_current_limit_regmap(struct regulator_dev *rdev) | |
843 | { | |
844 | unsigned int val; | |
845 | int ret; | |
846 | ||
847 | ret = regmap_read(rdev->regmap, rdev->desc->csel_reg, &val); | |
848 | if (ret != 0) | |
849 | return ret; | |
850 | ||
851 | val &= rdev->desc->csel_mask; | |
852 | val >>= ffs(rdev->desc->csel_mask) - 1; | |
853 | ||
854 | if (rdev->desc->curr_table) { | |
855 | if (val >= rdev->desc->n_current_limits) | |
856 | return -EINVAL; | |
857 | ||
858 | return rdev->desc->curr_table[val]; | |
859 | } | |
860 | ||
861 | return -EINVAL; | |
862 | } | |
863 | EXPORT_SYMBOL_GPL(regulator_get_current_limit_regmap); |