1 /*
2 * wm8350.c -- Voltage and current regulation for the Wolfson WM8350 PMIC
3 *
4 * Copyright 2007, 2008 Wolfson Microelectronics PLC.
5 *
6 * Author: Liam Girdwood
7 * linux@wolfsonmicro.com
8 *
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms of the GNU General Public License as published by the
11 * Free Software Foundation; either version 2 of the License, or (at your
12 * option) any later version.
13 */
14
15 #include <linux/module.h>
16 #include <linux/moduleparam.h>
17 #include <linux/init.h>
18 #include <linux/bitops.h>
19 #include <linux/err.h>
20 #include <linux/i2c.h>
21 #include <linux/mfd/wm8350/core.h>
22 #include <linux/mfd/wm8350/pmic.h>
23 #include <linux/platform_device.h>
24 #include <linux/regulator/driver.h>
25 #include <linux/regulator/machine.h>
26
27 /* Maximum value possible for VSEL */
28 #define WM8350_DCDC_MAX_VSEL 0x66
29
30 /* Microamps */
31 static const int isink_cur[] = {
32 4,
33 5,
34 6,
35 7,
36 8,
37 10,
38 11,
39 14,
40 16,
41 19,
42 23,
43 27,
44 32,
45 39,
46 46,
47 54,
48 65,
49 77,
50 92,
51 109,
52 130,
53 154,
54 183,
55 218,
56 259,
57 308,
58 367,
59 436,
60 518,
61 616,
62 733,
63 872,
64 1037,
65 1233,
66 1466,
67 1744,
68 2073,
69 2466,
70 2933,
71 3487,
72 4147,
73 4932,
74 5865,
75 6975,
76 8294,
77 9864,
78 11730,
79 13949,
80 16589,
81 19728,
82 23460,
83 27899,
84 33178,
85 39455,
86 46920,
87 55798,
88 66355,
89 78910,
90 93840,
91 111596,
92 132710,
93 157820,
94 187681,
95 223191
96 };
97
get_isink_val(int min_uA,int max_uA,u16 * setting)98 static int get_isink_val(int min_uA, int max_uA, u16 *setting)
99 {
100 int i;
101
102 for (i = ARRAY_SIZE(isink_cur) - 1; i >= 0; i--) {
103 if (min_uA <= isink_cur[i] && max_uA >= isink_cur[i]) {
104 *setting = i;
105 return 0;
106 }
107 }
108 return -EINVAL;
109 }
110
wm8350_ldo_val_to_mvolts(unsigned int val)111 static inline int wm8350_ldo_val_to_mvolts(unsigned int val)
112 {
113 if (val < 16)
114 return (val * 50) + 900;
115 else
116 return ((val - 16) * 100) + 1800;
117
118 }
119
wm8350_ldo_mvolts_to_val(int mV)120 static inline unsigned int wm8350_ldo_mvolts_to_val(int mV)
121 {
122 if (mV < 1800)
123 return (mV - 900) / 50;
124 else
125 return ((mV - 1800) / 100) + 16;
126 }
127
wm8350_dcdc_val_to_mvolts(unsigned int val)128 static inline int wm8350_dcdc_val_to_mvolts(unsigned int val)
129 {
130 return (val * 25) + 850;
131 }
132
wm8350_dcdc_mvolts_to_val(int mV)133 static inline unsigned int wm8350_dcdc_mvolts_to_val(int mV)
134 {
135 return (mV - 850) / 25;
136 }
137
wm8350_isink_set_current(struct regulator_dev * rdev,int min_uA,int max_uA)138 static int wm8350_isink_set_current(struct regulator_dev *rdev, int min_uA,
139 int max_uA)
140 {
141 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
142 int isink = rdev_get_id(rdev);
143 u16 val, setting;
144 int ret;
145
146 ret = get_isink_val(min_uA, max_uA, &setting);
147 if (ret != 0)
148 return ret;
149
150 switch (isink) {
151 case WM8350_ISINK_A:
152 val = wm8350_reg_read(wm8350, WM8350_CURRENT_SINK_DRIVER_A) &
153 ~WM8350_CS1_ISEL_MASK;
154 wm8350_reg_write(wm8350, WM8350_CURRENT_SINK_DRIVER_A,
155 val | setting);
156 break;
157 case WM8350_ISINK_B:
158 val = wm8350_reg_read(wm8350, WM8350_CURRENT_SINK_DRIVER_B) &
159 ~WM8350_CS1_ISEL_MASK;
160 wm8350_reg_write(wm8350, WM8350_CURRENT_SINK_DRIVER_B,
161 val | setting);
162 break;
163 default:
164 return -EINVAL;
165 }
166
167 return 0;
168 }
169
wm8350_isink_get_current(struct regulator_dev * rdev)170 static int wm8350_isink_get_current(struct regulator_dev *rdev)
171 {
172 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
173 int isink = rdev_get_id(rdev);
174 u16 val;
175
176 switch (isink) {
177 case WM8350_ISINK_A:
178 val = wm8350_reg_read(wm8350, WM8350_CURRENT_SINK_DRIVER_A) &
179 WM8350_CS1_ISEL_MASK;
180 break;
181 case WM8350_ISINK_B:
182 val = wm8350_reg_read(wm8350, WM8350_CURRENT_SINK_DRIVER_B) &
183 WM8350_CS1_ISEL_MASK;
184 break;
185 default:
186 return 0;
187 }
188
189 return (isink_cur[val] + 50) / 100;
190 }
191
192 /* turn on ISINK followed by DCDC */
wm8350_isink_enable(struct regulator_dev * rdev)193 static int wm8350_isink_enable(struct regulator_dev *rdev)
194 {
195 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
196 int isink = rdev_get_id(rdev);
197
198 switch (isink) {
199 case WM8350_ISINK_A:
200 switch (wm8350->pmic.isink_A_dcdc) {
201 case WM8350_DCDC_2:
202 case WM8350_DCDC_5:
203 wm8350_set_bits(wm8350, WM8350_POWER_MGMT_7,
204 WM8350_CS1_ENA);
205 wm8350_set_bits(wm8350, WM8350_CSA_FLASH_CONTROL,
206 WM8350_CS1_DRIVE);
207 wm8350_set_bits(wm8350, WM8350_DCDC_LDO_REQUESTED,
208 1 << (wm8350->pmic.isink_A_dcdc -
209 WM8350_DCDC_1));
210 break;
211 default:
212 return -EINVAL;
213 }
214 break;
215 case WM8350_ISINK_B:
216 switch (wm8350->pmic.isink_B_dcdc) {
217 case WM8350_DCDC_2:
218 case WM8350_DCDC_5:
219 wm8350_set_bits(wm8350, WM8350_POWER_MGMT_7,
220 WM8350_CS2_ENA);
221 wm8350_set_bits(wm8350, WM8350_CSB_FLASH_CONTROL,
222 WM8350_CS2_DRIVE);
223 wm8350_set_bits(wm8350, WM8350_DCDC_LDO_REQUESTED,
224 1 << (wm8350->pmic.isink_B_dcdc -
225 WM8350_DCDC_1));
226 break;
227 default:
228 return -EINVAL;
229 }
230 break;
231 default:
232 return -EINVAL;
233 }
234 return 0;
235 }
236
wm8350_isink_disable(struct regulator_dev * rdev)237 static int wm8350_isink_disable(struct regulator_dev *rdev)
238 {
239 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
240 int isink = rdev_get_id(rdev);
241
242 switch (isink) {
243 case WM8350_ISINK_A:
244 switch (wm8350->pmic.isink_A_dcdc) {
245 case WM8350_DCDC_2:
246 case WM8350_DCDC_5:
247 wm8350_clear_bits(wm8350, WM8350_DCDC_LDO_REQUESTED,
248 1 << (wm8350->pmic.isink_A_dcdc -
249 WM8350_DCDC_1));
250 wm8350_clear_bits(wm8350, WM8350_POWER_MGMT_7,
251 WM8350_CS1_ENA);
252 break;
253 default:
254 return -EINVAL;
255 }
256 break;
257 case WM8350_ISINK_B:
258 switch (wm8350->pmic.isink_B_dcdc) {
259 case WM8350_DCDC_2:
260 case WM8350_DCDC_5:
261 wm8350_clear_bits(wm8350, WM8350_DCDC_LDO_REQUESTED,
262 1 << (wm8350->pmic.isink_B_dcdc -
263 WM8350_DCDC_1));
264 wm8350_clear_bits(wm8350, WM8350_POWER_MGMT_7,
265 WM8350_CS2_ENA);
266 break;
267 default:
268 return -EINVAL;
269 }
270 break;
271 default:
272 return -EINVAL;
273 }
274 return 0;
275 }
276
wm8350_isink_is_enabled(struct regulator_dev * rdev)277 static int wm8350_isink_is_enabled(struct regulator_dev *rdev)
278 {
279 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
280 int isink = rdev_get_id(rdev);
281
282 switch (isink) {
283 case WM8350_ISINK_A:
284 return wm8350_reg_read(wm8350, WM8350_CURRENT_SINK_DRIVER_A) &
285 0x8000;
286 case WM8350_ISINK_B:
287 return wm8350_reg_read(wm8350, WM8350_CURRENT_SINK_DRIVER_B) &
288 0x8000;
289 }
290 return -EINVAL;
291 }
292
wm8350_isink_enable_time(struct regulator_dev * rdev)293 static int wm8350_isink_enable_time(struct regulator_dev *rdev)
294 {
295 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
296 int isink = rdev_get_id(rdev);
297 int reg;
298
299 switch (isink) {
300 case WM8350_ISINK_A:
301 reg = wm8350_reg_read(wm8350, WM8350_CSA_FLASH_CONTROL);
302 break;
303 case WM8350_ISINK_B:
304 reg = wm8350_reg_read(wm8350, WM8350_CSB_FLASH_CONTROL);
305 break;
306 default:
307 return -EINVAL;
308 }
309
310 if (reg & WM8350_CS1_FLASH_MODE) {
311 switch (reg & WM8350_CS1_ON_RAMP_MASK) {
312 case 0:
313 return 0;
314 case 1:
315 return 1950;
316 case 2:
317 return 3910;
318 case 3:
319 return 7800;
320 }
321 } else {
322 switch (reg & WM8350_CS1_ON_RAMP_MASK) {
323 case 0:
324 return 0;
325 case 1:
326 return 250000;
327 case 2:
328 return 500000;
329 case 3:
330 return 1000000;
331 }
332 }
333
334 return -EINVAL;
335 }
336
337
wm8350_isink_set_flash(struct wm8350 * wm8350,int isink,u16 mode,u16 trigger,u16 duration,u16 on_ramp,u16 off_ramp,u16 drive)338 int wm8350_isink_set_flash(struct wm8350 *wm8350, int isink, u16 mode,
339 u16 trigger, u16 duration, u16 on_ramp, u16 off_ramp,
340 u16 drive)
341 {
342 switch (isink) {
343 case WM8350_ISINK_A:
344 wm8350_reg_write(wm8350, WM8350_CSA_FLASH_CONTROL,
345 (mode ? WM8350_CS1_FLASH_MODE : 0) |
346 (trigger ? WM8350_CS1_TRIGSRC : 0) |
347 duration | on_ramp | off_ramp | drive);
348 break;
349 case WM8350_ISINK_B:
350 wm8350_reg_write(wm8350, WM8350_CSB_FLASH_CONTROL,
351 (mode ? WM8350_CS2_FLASH_MODE : 0) |
352 (trigger ? WM8350_CS2_TRIGSRC : 0) |
353 duration | on_ramp | off_ramp | drive);
354 break;
355 default:
356 return -EINVAL;
357 }
358 return 0;
359 }
360 EXPORT_SYMBOL_GPL(wm8350_isink_set_flash);
361
wm8350_dcdc_set_voltage(struct regulator_dev * rdev,int min_uV,int max_uV,unsigned * selector)362 static int wm8350_dcdc_set_voltage(struct regulator_dev *rdev, int min_uV,
363 int max_uV, unsigned *selector)
364 {
365 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
366 int volt_reg, dcdc = rdev_get_id(rdev), mV,
367 min_mV = min_uV / 1000, max_mV = max_uV / 1000;
368 u16 val;
369
370 if (min_mV < 850 || min_mV > 4025)
371 return -EINVAL;
372 if (max_mV < 850 || max_mV > 4025)
373 return -EINVAL;
374
375 /* step size is 25mV */
376 mV = (min_mV - 826) / 25;
377 if (wm8350_dcdc_val_to_mvolts(mV) > max_mV)
378 return -EINVAL;
379 BUG_ON(wm8350_dcdc_val_to_mvolts(mV) < min_mV);
380
381 switch (dcdc) {
382 case WM8350_DCDC_1:
383 volt_reg = WM8350_DCDC1_CONTROL;
384 break;
385 case WM8350_DCDC_3:
386 volt_reg = WM8350_DCDC3_CONTROL;
387 break;
388 case WM8350_DCDC_4:
389 volt_reg = WM8350_DCDC4_CONTROL;
390 break;
391 case WM8350_DCDC_6:
392 volt_reg = WM8350_DCDC6_CONTROL;
393 break;
394 case WM8350_DCDC_2:
395 case WM8350_DCDC_5:
396 default:
397 return -EINVAL;
398 }
399
400 *selector = mV;
401
402 /* all DCDCs have same mV bits */
403 val = wm8350_reg_read(wm8350, volt_reg) & ~WM8350_DC1_VSEL_MASK;
404 wm8350_reg_write(wm8350, volt_reg, val | mV);
405 return 0;
406 }
407
wm8350_dcdc_get_voltage_sel(struct regulator_dev * rdev)408 static int wm8350_dcdc_get_voltage_sel(struct regulator_dev *rdev)
409 {
410 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
411 int volt_reg, dcdc = rdev_get_id(rdev);
412
413 switch (dcdc) {
414 case WM8350_DCDC_1:
415 volt_reg = WM8350_DCDC1_CONTROL;
416 break;
417 case WM8350_DCDC_3:
418 volt_reg = WM8350_DCDC3_CONTROL;
419 break;
420 case WM8350_DCDC_4:
421 volt_reg = WM8350_DCDC4_CONTROL;
422 break;
423 case WM8350_DCDC_6:
424 volt_reg = WM8350_DCDC6_CONTROL;
425 break;
426 case WM8350_DCDC_2:
427 case WM8350_DCDC_5:
428 default:
429 return -EINVAL;
430 }
431
432 /* all DCDCs have same mV bits */
433 return wm8350_reg_read(wm8350, volt_reg) & WM8350_DC1_VSEL_MASK;
434 }
435
wm8350_dcdc_list_voltage(struct regulator_dev * rdev,unsigned selector)436 static int wm8350_dcdc_list_voltage(struct regulator_dev *rdev,
437 unsigned selector)
438 {
439 if (selector > WM8350_DCDC_MAX_VSEL)
440 return -EINVAL;
441 return wm8350_dcdc_val_to_mvolts(selector) * 1000;
442 }
443
wm8350_dcdc_set_suspend_voltage(struct regulator_dev * rdev,int uV)444 static int wm8350_dcdc_set_suspend_voltage(struct regulator_dev *rdev, int uV)
445 {
446 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
447 int volt_reg, mV = uV / 1000, dcdc = rdev_get_id(rdev);
448 u16 val;
449
450 dev_dbg(wm8350->dev, "%s %d mV %d\n", __func__, dcdc, mV);
451
452 if (mV && (mV < 850 || mV > 4025)) {
453 dev_err(wm8350->dev,
454 "DCDC%d suspend voltage %d mV out of range\n",
455 dcdc, mV);
456 return -EINVAL;
457 }
458 if (mV == 0)
459 mV = 850;
460
461 switch (dcdc) {
462 case WM8350_DCDC_1:
463 volt_reg = WM8350_DCDC1_LOW_POWER;
464 break;
465 case WM8350_DCDC_3:
466 volt_reg = WM8350_DCDC3_LOW_POWER;
467 break;
468 case WM8350_DCDC_4:
469 volt_reg = WM8350_DCDC4_LOW_POWER;
470 break;
471 case WM8350_DCDC_6:
472 volt_reg = WM8350_DCDC6_LOW_POWER;
473 break;
474 case WM8350_DCDC_2:
475 case WM8350_DCDC_5:
476 default:
477 return -EINVAL;
478 }
479
480 /* all DCDCs have same mV bits */
481 val = wm8350_reg_read(wm8350, volt_reg) & ~WM8350_DC1_VSEL_MASK;
482 wm8350_reg_write(wm8350, volt_reg,
483 val | wm8350_dcdc_mvolts_to_val(mV));
484 return 0;
485 }
486
wm8350_dcdc_set_suspend_enable(struct regulator_dev * rdev)487 static int wm8350_dcdc_set_suspend_enable(struct regulator_dev *rdev)
488 {
489 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
490 int dcdc = rdev_get_id(rdev);
491 u16 val;
492
493 switch (dcdc) {
494 case WM8350_DCDC_1:
495 val = wm8350_reg_read(wm8350, WM8350_DCDC1_LOW_POWER)
496 & ~WM8350_DCDC_HIB_MODE_MASK;
497 wm8350_reg_write(wm8350, WM8350_DCDC1_LOW_POWER,
498 wm8350->pmic.dcdc1_hib_mode);
499 break;
500 case WM8350_DCDC_3:
501 val = wm8350_reg_read(wm8350, WM8350_DCDC3_LOW_POWER)
502 & ~WM8350_DCDC_HIB_MODE_MASK;
503 wm8350_reg_write(wm8350, WM8350_DCDC3_LOW_POWER,
504 wm8350->pmic.dcdc3_hib_mode);
505 break;
506 case WM8350_DCDC_4:
507 val = wm8350_reg_read(wm8350, WM8350_DCDC4_LOW_POWER)
508 & ~WM8350_DCDC_HIB_MODE_MASK;
509 wm8350_reg_write(wm8350, WM8350_DCDC4_LOW_POWER,
510 wm8350->pmic.dcdc4_hib_mode);
511 break;
512 case WM8350_DCDC_6:
513 val = wm8350_reg_read(wm8350, WM8350_DCDC6_LOW_POWER)
514 & ~WM8350_DCDC_HIB_MODE_MASK;
515 wm8350_reg_write(wm8350, WM8350_DCDC6_LOW_POWER,
516 wm8350->pmic.dcdc6_hib_mode);
517 break;
518 case WM8350_DCDC_2:
519 case WM8350_DCDC_5:
520 default:
521 return -EINVAL;
522 }
523
524 return 0;
525 }
526
wm8350_dcdc_set_suspend_disable(struct regulator_dev * rdev)527 static int wm8350_dcdc_set_suspend_disable(struct regulator_dev *rdev)
528 {
529 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
530 int dcdc = rdev_get_id(rdev);
531 u16 val;
532
533 switch (dcdc) {
534 case WM8350_DCDC_1:
535 val = wm8350_reg_read(wm8350, WM8350_DCDC1_LOW_POWER);
536 wm8350->pmic.dcdc1_hib_mode = val & WM8350_DCDC_HIB_MODE_MASK;
537 wm8350_reg_write(wm8350, WM8350_DCDC1_LOW_POWER,
538 WM8350_DCDC_HIB_MODE_DIS);
539 break;
540 case WM8350_DCDC_3:
541 val = wm8350_reg_read(wm8350, WM8350_DCDC3_LOW_POWER);
542 wm8350->pmic.dcdc3_hib_mode = val & WM8350_DCDC_HIB_MODE_MASK;
543 wm8350_reg_write(wm8350, WM8350_DCDC3_LOW_POWER,
544 WM8350_DCDC_HIB_MODE_DIS);
545 break;
546 case WM8350_DCDC_4:
547 val = wm8350_reg_read(wm8350, WM8350_DCDC4_LOW_POWER);
548 wm8350->pmic.dcdc4_hib_mode = val & WM8350_DCDC_HIB_MODE_MASK;
549 wm8350_reg_write(wm8350, WM8350_DCDC4_LOW_POWER,
550 WM8350_DCDC_HIB_MODE_DIS);
551 break;
552 case WM8350_DCDC_6:
553 val = wm8350_reg_read(wm8350, WM8350_DCDC6_LOW_POWER);
554 wm8350->pmic.dcdc6_hib_mode = val & WM8350_DCDC_HIB_MODE_MASK;
555 wm8350_reg_write(wm8350, WM8350_DCDC6_LOW_POWER,
556 WM8350_DCDC_HIB_MODE_DIS);
557 break;
558 case WM8350_DCDC_2:
559 case WM8350_DCDC_5:
560 default:
561 return -EINVAL;
562 }
563
564 return 0;
565 }
566
wm8350_dcdc25_set_suspend_enable(struct regulator_dev * rdev)567 static int wm8350_dcdc25_set_suspend_enable(struct regulator_dev *rdev)
568 {
569 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
570 int dcdc = rdev_get_id(rdev);
571 u16 val;
572
573 switch (dcdc) {
574 case WM8350_DCDC_2:
575 val = wm8350_reg_read(wm8350, WM8350_DCDC2_CONTROL)
576 & ~WM8350_DC2_HIB_MODE_MASK;
577 wm8350_reg_write(wm8350, WM8350_DCDC2_CONTROL, val |
578 WM8350_DC2_HIB_MODE_ACTIVE);
579 break;
580 case WM8350_DCDC_5:
581 val = wm8350_reg_read(wm8350, WM8350_DCDC5_CONTROL)
582 & ~WM8350_DC2_HIB_MODE_MASK;
583 wm8350_reg_write(wm8350, WM8350_DCDC5_CONTROL, val |
584 WM8350_DC5_HIB_MODE_ACTIVE);
585 break;
586 default:
587 return -EINVAL;
588 }
589 return 0;
590 }
591
wm8350_dcdc25_set_suspend_disable(struct regulator_dev * rdev)592 static int wm8350_dcdc25_set_suspend_disable(struct regulator_dev *rdev)
593 {
594 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
595 int dcdc = rdev_get_id(rdev);
596 u16 val;
597
598 switch (dcdc) {
599 case WM8350_DCDC_2:
600 val = wm8350_reg_read(wm8350, WM8350_DCDC2_CONTROL)
601 & ~WM8350_DC2_HIB_MODE_MASK;
602 wm8350_reg_write(wm8350, WM8350_DCDC2_CONTROL, val |
603 WM8350_DC2_HIB_MODE_DISABLE);
604 break;
605 case WM8350_DCDC_5:
606 val = wm8350_reg_read(wm8350, WM8350_DCDC5_CONTROL)
607 & ~WM8350_DC2_HIB_MODE_MASK;
608 wm8350_reg_write(wm8350, WM8350_DCDC5_CONTROL, val |
609 WM8350_DC2_HIB_MODE_DISABLE);
610 break;
611 default:
612 return -EINVAL;
613 }
614 return 0;
615 }
616
wm8350_dcdc_set_suspend_mode(struct regulator_dev * rdev,unsigned int mode)617 static int wm8350_dcdc_set_suspend_mode(struct regulator_dev *rdev,
618 unsigned int mode)
619 {
620 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
621 int dcdc = rdev_get_id(rdev);
622 u16 *hib_mode;
623
624 switch (dcdc) {
625 case WM8350_DCDC_1:
626 hib_mode = &wm8350->pmic.dcdc1_hib_mode;
627 break;
628 case WM8350_DCDC_3:
629 hib_mode = &wm8350->pmic.dcdc3_hib_mode;
630 break;
631 case WM8350_DCDC_4:
632 hib_mode = &wm8350->pmic.dcdc4_hib_mode;
633 break;
634 case WM8350_DCDC_6:
635 hib_mode = &wm8350->pmic.dcdc6_hib_mode;
636 break;
637 case WM8350_DCDC_2:
638 case WM8350_DCDC_5:
639 default:
640 return -EINVAL;
641 }
642
643 switch (mode) {
644 case REGULATOR_MODE_NORMAL:
645 *hib_mode = WM8350_DCDC_HIB_MODE_IMAGE;
646 break;
647 case REGULATOR_MODE_IDLE:
648 *hib_mode = WM8350_DCDC_HIB_MODE_STANDBY;
649 break;
650 case REGULATOR_MODE_STANDBY:
651 *hib_mode = WM8350_DCDC_HIB_MODE_LDO_IM;
652 break;
653 default:
654 return -EINVAL;
655 }
656
657 return 0;
658 }
659
wm8350_ldo_set_suspend_voltage(struct regulator_dev * rdev,int uV)660 static int wm8350_ldo_set_suspend_voltage(struct regulator_dev *rdev, int uV)
661 {
662 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
663 int volt_reg, mV = uV / 1000, ldo = rdev_get_id(rdev);
664 u16 val;
665
666 dev_dbg(wm8350->dev, "%s %d mV %d\n", __func__, ldo, mV);
667
668 if (mV < 900 || mV > 3300) {
669 dev_err(wm8350->dev, "LDO%d voltage %d mV out of range\n",
670 ldo, mV);
671 return -EINVAL;
672 }
673
674 switch (ldo) {
675 case WM8350_LDO_1:
676 volt_reg = WM8350_LDO1_LOW_POWER;
677 break;
678 case WM8350_LDO_2:
679 volt_reg = WM8350_LDO2_LOW_POWER;
680 break;
681 case WM8350_LDO_3:
682 volt_reg = WM8350_LDO3_LOW_POWER;
683 break;
684 case WM8350_LDO_4:
685 volt_reg = WM8350_LDO4_LOW_POWER;
686 break;
687 default:
688 return -EINVAL;
689 }
690
691 /* all LDOs have same mV bits */
692 val = wm8350_reg_read(wm8350, volt_reg) & ~WM8350_LDO1_VSEL_MASK;
693 wm8350_reg_write(wm8350, volt_reg,
694 val | wm8350_ldo_mvolts_to_val(mV));
695 return 0;
696 }
697
wm8350_ldo_set_suspend_enable(struct regulator_dev * rdev)698 static int wm8350_ldo_set_suspend_enable(struct regulator_dev *rdev)
699 {
700 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
701 int volt_reg, ldo = rdev_get_id(rdev);
702 u16 val;
703
704 switch (ldo) {
705 case WM8350_LDO_1:
706 volt_reg = WM8350_LDO1_LOW_POWER;
707 break;
708 case WM8350_LDO_2:
709 volt_reg = WM8350_LDO2_LOW_POWER;
710 break;
711 case WM8350_LDO_3:
712 volt_reg = WM8350_LDO3_LOW_POWER;
713 break;
714 case WM8350_LDO_4:
715 volt_reg = WM8350_LDO4_LOW_POWER;
716 break;
717 default:
718 return -EINVAL;
719 }
720
721 /* all LDOs have same mV bits */
722 val = wm8350_reg_read(wm8350, volt_reg) & ~WM8350_LDO1_HIB_MODE_MASK;
723 wm8350_reg_write(wm8350, volt_reg, val);
724 return 0;
725 }
726
wm8350_ldo_set_suspend_disable(struct regulator_dev * rdev)727 static int wm8350_ldo_set_suspend_disable(struct regulator_dev *rdev)
728 {
729 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
730 int volt_reg, ldo = rdev_get_id(rdev);
731 u16 val;
732
733 switch (ldo) {
734 case WM8350_LDO_1:
735 volt_reg = WM8350_LDO1_LOW_POWER;
736 break;
737 case WM8350_LDO_2:
738 volt_reg = WM8350_LDO2_LOW_POWER;
739 break;
740 case WM8350_LDO_3:
741 volt_reg = WM8350_LDO3_LOW_POWER;
742 break;
743 case WM8350_LDO_4:
744 volt_reg = WM8350_LDO4_LOW_POWER;
745 break;
746 default:
747 return -EINVAL;
748 }
749
750 /* all LDOs have same mV bits */
751 val = wm8350_reg_read(wm8350, volt_reg) & ~WM8350_LDO1_HIB_MODE_MASK;
752 wm8350_reg_write(wm8350, volt_reg, WM8350_LDO1_HIB_MODE_DIS);
753 return 0;
754 }
755
wm8350_ldo_set_voltage(struct regulator_dev * rdev,int min_uV,int max_uV,unsigned * selector)756 static int wm8350_ldo_set_voltage(struct regulator_dev *rdev, int min_uV,
757 int max_uV, unsigned *selector)
758 {
759 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
760 int volt_reg, ldo = rdev_get_id(rdev), mV, min_mV = min_uV / 1000,
761 max_mV = max_uV / 1000;
762 u16 val;
763
764 if (min_mV < 900 || min_mV > 3300)
765 return -EINVAL;
766 if (max_mV < 900 || max_mV > 3300)
767 return -EINVAL;
768
769 if (min_mV < 1800) {
770 /* step size is 50mV < 1800mV */
771 mV = (min_mV - 851) / 50;
772 if (wm8350_ldo_val_to_mvolts(mV) > max_mV)
773 return -EINVAL;
774 BUG_ON(wm8350_ldo_val_to_mvolts(mV) < min_mV);
775 } else {
776 /* step size is 100mV > 1800mV */
777 mV = ((min_mV - 1701) / 100) + 16;
778 if (wm8350_ldo_val_to_mvolts(mV) > max_mV)
779 return -EINVAL;
780 BUG_ON(wm8350_ldo_val_to_mvolts(mV) < min_mV);
781 }
782
783 switch (ldo) {
784 case WM8350_LDO_1:
785 volt_reg = WM8350_LDO1_CONTROL;
786 break;
787 case WM8350_LDO_2:
788 volt_reg = WM8350_LDO2_CONTROL;
789 break;
790 case WM8350_LDO_3:
791 volt_reg = WM8350_LDO3_CONTROL;
792 break;
793 case WM8350_LDO_4:
794 volt_reg = WM8350_LDO4_CONTROL;
795 break;
796 default:
797 return -EINVAL;
798 }
799
800 *selector = mV;
801
802 /* all LDOs have same mV bits */
803 val = wm8350_reg_read(wm8350, volt_reg) & ~WM8350_LDO1_VSEL_MASK;
804 wm8350_reg_write(wm8350, volt_reg, val | mV);
805 return 0;
806 }
807
wm8350_ldo_get_voltage_sel(struct regulator_dev * rdev)808 static int wm8350_ldo_get_voltage_sel(struct regulator_dev *rdev)
809 {
810 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
811 int volt_reg, ldo = rdev_get_id(rdev);
812
813 switch (ldo) {
814 case WM8350_LDO_1:
815 volt_reg = WM8350_LDO1_CONTROL;
816 break;
817 case WM8350_LDO_2:
818 volt_reg = WM8350_LDO2_CONTROL;
819 break;
820 case WM8350_LDO_3:
821 volt_reg = WM8350_LDO3_CONTROL;
822 break;
823 case WM8350_LDO_4:
824 volt_reg = WM8350_LDO4_CONTROL;
825 break;
826 default:
827 return -EINVAL;
828 }
829
830 /* all LDOs have same mV bits */
831 return wm8350_reg_read(wm8350, volt_reg) & WM8350_LDO1_VSEL_MASK;
832 }
833
wm8350_ldo_list_voltage(struct regulator_dev * rdev,unsigned selector)834 static int wm8350_ldo_list_voltage(struct regulator_dev *rdev,
835 unsigned selector)
836 {
837 if (selector > WM8350_LDO1_VSEL_MASK)
838 return -EINVAL;
839 return wm8350_ldo_val_to_mvolts(selector) * 1000;
840 }
841
wm8350_dcdc_set_slot(struct wm8350 * wm8350,int dcdc,u16 start,u16 stop,u16 fault)842 int wm8350_dcdc_set_slot(struct wm8350 *wm8350, int dcdc, u16 start,
843 u16 stop, u16 fault)
844 {
845 int slot_reg;
846 u16 val;
847
848 dev_dbg(wm8350->dev, "%s %d start %d stop %d\n",
849 __func__, dcdc, start, stop);
850
851 /* slot valid ? */
852 if (start > 15 || stop > 15)
853 return -EINVAL;
854
855 switch (dcdc) {
856 case WM8350_DCDC_1:
857 slot_reg = WM8350_DCDC1_TIMEOUTS;
858 break;
859 case WM8350_DCDC_2:
860 slot_reg = WM8350_DCDC2_TIMEOUTS;
861 break;
862 case WM8350_DCDC_3:
863 slot_reg = WM8350_DCDC3_TIMEOUTS;
864 break;
865 case WM8350_DCDC_4:
866 slot_reg = WM8350_DCDC4_TIMEOUTS;
867 break;
868 case WM8350_DCDC_5:
869 slot_reg = WM8350_DCDC5_TIMEOUTS;
870 break;
871 case WM8350_DCDC_6:
872 slot_reg = WM8350_DCDC6_TIMEOUTS;
873 break;
874 default:
875 return -EINVAL;
876 }
877
878 val = wm8350_reg_read(wm8350, slot_reg) &
879 ~(WM8350_DC1_ENSLOT_MASK | WM8350_DC1_SDSLOT_MASK |
880 WM8350_DC1_ERRACT_MASK);
881 wm8350_reg_write(wm8350, slot_reg,
882 val | (start << WM8350_DC1_ENSLOT_SHIFT) |
883 (stop << WM8350_DC1_SDSLOT_SHIFT) |
884 (fault << WM8350_DC1_ERRACT_SHIFT));
885
886 return 0;
887 }
888 EXPORT_SYMBOL_GPL(wm8350_dcdc_set_slot);
889
wm8350_ldo_set_slot(struct wm8350 * wm8350,int ldo,u16 start,u16 stop)890 int wm8350_ldo_set_slot(struct wm8350 *wm8350, int ldo, u16 start, u16 stop)
891 {
892 int slot_reg;
893 u16 val;
894
895 dev_dbg(wm8350->dev, "%s %d start %d stop %d\n",
896 __func__, ldo, start, stop);
897
898 /* slot valid ? */
899 if (start > 15 || stop > 15)
900 return -EINVAL;
901
902 switch (ldo) {
903 case WM8350_LDO_1:
904 slot_reg = WM8350_LDO1_TIMEOUTS;
905 break;
906 case WM8350_LDO_2:
907 slot_reg = WM8350_LDO2_TIMEOUTS;
908 break;
909 case WM8350_LDO_3:
910 slot_reg = WM8350_LDO3_TIMEOUTS;
911 break;
912 case WM8350_LDO_4:
913 slot_reg = WM8350_LDO4_TIMEOUTS;
914 break;
915 default:
916 return -EINVAL;
917 }
918
919 val = wm8350_reg_read(wm8350, slot_reg) & ~WM8350_LDO1_SDSLOT_MASK;
920 wm8350_reg_write(wm8350, slot_reg, val | ((start << 10) | (stop << 6)));
921 return 0;
922 }
923 EXPORT_SYMBOL_GPL(wm8350_ldo_set_slot);
924
wm8350_dcdc25_set_mode(struct wm8350 * wm8350,int dcdc,u16 mode,u16 ilim,u16 ramp,u16 feedback)925 int wm8350_dcdc25_set_mode(struct wm8350 *wm8350, int dcdc, u16 mode,
926 u16 ilim, u16 ramp, u16 feedback)
927 {
928 u16 val;
929
930 dev_dbg(wm8350->dev, "%s %d mode: %s %s\n", __func__, dcdc,
931 mode ? "normal" : "boost", ilim ? "low" : "normal");
932
933 switch (dcdc) {
934 case WM8350_DCDC_2:
935 val = wm8350_reg_read(wm8350, WM8350_DCDC2_CONTROL)
936 & ~(WM8350_DC2_MODE_MASK | WM8350_DC2_ILIM_MASK |
937 WM8350_DC2_RMP_MASK | WM8350_DC2_FBSRC_MASK);
938 wm8350_reg_write(wm8350, WM8350_DCDC2_CONTROL, val |
939 (mode << WM8350_DC2_MODE_SHIFT) |
940 (ilim << WM8350_DC2_ILIM_SHIFT) |
941 (ramp << WM8350_DC2_RMP_SHIFT) |
942 (feedback << WM8350_DC2_FBSRC_SHIFT));
943 break;
944 case WM8350_DCDC_5:
945 val = wm8350_reg_read(wm8350, WM8350_DCDC5_CONTROL)
946 & ~(WM8350_DC5_MODE_MASK | WM8350_DC5_ILIM_MASK |
947 WM8350_DC5_RMP_MASK | WM8350_DC5_FBSRC_MASK);
948 wm8350_reg_write(wm8350, WM8350_DCDC5_CONTROL, val |
949 (mode << WM8350_DC5_MODE_SHIFT) |
950 (ilim << WM8350_DC5_ILIM_SHIFT) |
951 (ramp << WM8350_DC5_RMP_SHIFT) |
952 (feedback << WM8350_DC5_FBSRC_SHIFT));
953 break;
954 default:
955 return -EINVAL;
956 }
957
958 return 0;
959 }
960 EXPORT_SYMBOL_GPL(wm8350_dcdc25_set_mode);
961
wm8350_dcdc_enable(struct regulator_dev * rdev)962 static int wm8350_dcdc_enable(struct regulator_dev *rdev)
963 {
964 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
965 int dcdc = rdev_get_id(rdev);
966 u16 shift;
967
968 if (dcdc < WM8350_DCDC_1 || dcdc > WM8350_DCDC_6)
969 return -EINVAL;
970
971 shift = dcdc - WM8350_DCDC_1;
972 wm8350_set_bits(wm8350, WM8350_DCDC_LDO_REQUESTED, 1 << shift);
973 return 0;
974 }
975
wm8350_dcdc_disable(struct regulator_dev * rdev)976 static int wm8350_dcdc_disable(struct regulator_dev *rdev)
977 {
978 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
979 int dcdc = rdev_get_id(rdev);
980 u16 shift;
981
982 if (dcdc < WM8350_DCDC_1 || dcdc > WM8350_DCDC_6)
983 return -EINVAL;
984
985 shift = dcdc - WM8350_DCDC_1;
986 wm8350_clear_bits(wm8350, WM8350_DCDC_LDO_REQUESTED, 1 << shift);
987
988 return 0;
989 }
990
wm8350_ldo_enable(struct regulator_dev * rdev)991 static int wm8350_ldo_enable(struct regulator_dev *rdev)
992 {
993 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
994 int ldo = rdev_get_id(rdev);
995 u16 shift;
996
997 if (ldo < WM8350_LDO_1 || ldo > WM8350_LDO_4)
998 return -EINVAL;
999
1000 shift = (ldo - WM8350_LDO_1) + 8;
1001 wm8350_set_bits(wm8350, WM8350_DCDC_LDO_REQUESTED, 1 << shift);
1002 return 0;
1003 }
1004
wm8350_ldo_disable(struct regulator_dev * rdev)1005 static int wm8350_ldo_disable(struct regulator_dev *rdev)
1006 {
1007 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
1008 int ldo = rdev_get_id(rdev);
1009 u16 shift;
1010
1011 if (ldo < WM8350_LDO_1 || ldo > WM8350_LDO_4)
1012 return -EINVAL;
1013
1014 shift = (ldo - WM8350_LDO_1) + 8;
1015 wm8350_clear_bits(wm8350, WM8350_DCDC_LDO_REQUESTED, 1 << shift);
1016 return 0;
1017 }
1018
force_continuous_enable(struct wm8350 * wm8350,int dcdc,int enable)1019 static int force_continuous_enable(struct wm8350 *wm8350, int dcdc, int enable)
1020 {
1021 int reg = 0, ret;
1022
1023 switch (dcdc) {
1024 case WM8350_DCDC_1:
1025 reg = WM8350_DCDC1_FORCE_PWM;
1026 break;
1027 case WM8350_DCDC_3:
1028 reg = WM8350_DCDC3_FORCE_PWM;
1029 break;
1030 case WM8350_DCDC_4:
1031 reg = WM8350_DCDC4_FORCE_PWM;
1032 break;
1033 case WM8350_DCDC_6:
1034 reg = WM8350_DCDC6_FORCE_PWM;
1035 break;
1036 default:
1037 return -EINVAL;
1038 }
1039
1040 if (enable)
1041 ret = wm8350_set_bits(wm8350, reg,
1042 WM8350_DCDC1_FORCE_PWM_ENA);
1043 else
1044 ret = wm8350_clear_bits(wm8350, reg,
1045 WM8350_DCDC1_FORCE_PWM_ENA);
1046 return ret;
1047 }
1048
wm8350_dcdc_set_mode(struct regulator_dev * rdev,unsigned int mode)1049 static int wm8350_dcdc_set_mode(struct regulator_dev *rdev, unsigned int mode)
1050 {
1051 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
1052 int dcdc = rdev_get_id(rdev);
1053 u16 val;
1054
1055 if (dcdc < WM8350_DCDC_1 || dcdc > WM8350_DCDC_6)
1056 return -EINVAL;
1057
1058 if (dcdc == WM8350_DCDC_2 || dcdc == WM8350_DCDC_5)
1059 return -EINVAL;
1060
1061 val = 1 << (dcdc - WM8350_DCDC_1);
1062
1063 switch (mode) {
1064 case REGULATOR_MODE_FAST:
1065 /* force continuous mode */
1066 wm8350_set_bits(wm8350, WM8350_DCDC_ACTIVE_OPTIONS, val);
1067 wm8350_clear_bits(wm8350, WM8350_DCDC_SLEEP_OPTIONS, val);
1068 force_continuous_enable(wm8350, dcdc, 1);
1069 break;
1070 case REGULATOR_MODE_NORMAL:
1071 /* active / pulse skipping */
1072 wm8350_set_bits(wm8350, WM8350_DCDC_ACTIVE_OPTIONS, val);
1073 wm8350_clear_bits(wm8350, WM8350_DCDC_SLEEP_OPTIONS, val);
1074 force_continuous_enable(wm8350, dcdc, 0);
1075 break;
1076 case REGULATOR_MODE_IDLE:
1077 /* standby mode */
1078 force_continuous_enable(wm8350, dcdc, 0);
1079 wm8350_clear_bits(wm8350, WM8350_DCDC_SLEEP_OPTIONS, val);
1080 wm8350_clear_bits(wm8350, WM8350_DCDC_ACTIVE_OPTIONS, val);
1081 break;
1082 case REGULATOR_MODE_STANDBY:
1083 /* LDO mode */
1084 force_continuous_enable(wm8350, dcdc, 0);
1085 wm8350_set_bits(wm8350, WM8350_DCDC_SLEEP_OPTIONS, val);
1086 break;
1087 }
1088
1089 return 0;
1090 }
1091
wm8350_dcdc_get_mode(struct regulator_dev * rdev)1092 static unsigned int wm8350_dcdc_get_mode(struct regulator_dev *rdev)
1093 {
1094 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
1095 int dcdc = rdev_get_id(rdev);
1096 u16 mask, sleep, active, force;
1097 int mode = REGULATOR_MODE_NORMAL;
1098 int reg;
1099
1100 switch (dcdc) {
1101 case WM8350_DCDC_1:
1102 reg = WM8350_DCDC1_FORCE_PWM;
1103 break;
1104 case WM8350_DCDC_3:
1105 reg = WM8350_DCDC3_FORCE_PWM;
1106 break;
1107 case WM8350_DCDC_4:
1108 reg = WM8350_DCDC4_FORCE_PWM;
1109 break;
1110 case WM8350_DCDC_6:
1111 reg = WM8350_DCDC6_FORCE_PWM;
1112 break;
1113 default:
1114 return -EINVAL;
1115 }
1116
1117 mask = 1 << (dcdc - WM8350_DCDC_1);
1118 active = wm8350_reg_read(wm8350, WM8350_DCDC_ACTIVE_OPTIONS) & mask;
1119 force = wm8350_reg_read(wm8350, reg) & WM8350_DCDC1_FORCE_PWM_ENA;
1120 sleep = wm8350_reg_read(wm8350, WM8350_DCDC_SLEEP_OPTIONS) & mask;
1121
1122 dev_dbg(wm8350->dev, "mask %x active %x sleep %x force %x",
1123 mask, active, sleep, force);
1124
1125 if (active && !sleep) {
1126 if (force)
1127 mode = REGULATOR_MODE_FAST;
1128 else
1129 mode = REGULATOR_MODE_NORMAL;
1130 } else if (!active && !sleep)
1131 mode = REGULATOR_MODE_IDLE;
1132 else if (sleep)
1133 mode = REGULATOR_MODE_STANDBY;
1134
1135 return mode;
1136 }
1137
wm8350_ldo_get_mode(struct regulator_dev * rdev)1138 static unsigned int wm8350_ldo_get_mode(struct regulator_dev *rdev)
1139 {
1140 return REGULATOR_MODE_NORMAL;
1141 }
1142
1143 struct wm8350_dcdc_efficiency {
1144 int uA_load_min;
1145 int uA_load_max;
1146 unsigned int mode;
1147 };
1148
1149 static const struct wm8350_dcdc_efficiency dcdc1_6_efficiency[] = {
1150 {0, 10000, REGULATOR_MODE_STANDBY}, /* 0 - 10mA - LDO */
1151 {10000, 100000, REGULATOR_MODE_IDLE}, /* 10mA - 100mA - Standby */
1152 {100000, 1000000, REGULATOR_MODE_NORMAL}, /* > 100mA - Active */
1153 {-1, -1, REGULATOR_MODE_NORMAL},
1154 };
1155
1156 static const struct wm8350_dcdc_efficiency dcdc3_4_efficiency[] = {
1157 {0, 10000, REGULATOR_MODE_STANDBY}, /* 0 - 10mA - LDO */
1158 {10000, 100000, REGULATOR_MODE_IDLE}, /* 10mA - 100mA - Standby */
1159 {100000, 800000, REGULATOR_MODE_NORMAL}, /* > 100mA - Active */
1160 {-1, -1, REGULATOR_MODE_NORMAL},
1161 };
1162
get_mode(int uA,const struct wm8350_dcdc_efficiency * eff)1163 static unsigned int get_mode(int uA, const struct wm8350_dcdc_efficiency *eff)
1164 {
1165 int i = 0;
1166
1167 while (eff[i].uA_load_min != -1) {
1168 if (uA >= eff[i].uA_load_min && uA <= eff[i].uA_load_max)
1169 return eff[i].mode;
1170 }
1171 return REGULATOR_MODE_NORMAL;
1172 }
1173
1174 /* Query the regulator for it's most efficient mode @ uV,uA
1175 * WM8350 regulator efficiency is pretty similar over
1176 * different input and output uV.
1177 */
wm8350_dcdc_get_optimum_mode(struct regulator_dev * rdev,int input_uV,int output_uV,int output_uA)1178 static unsigned int wm8350_dcdc_get_optimum_mode(struct regulator_dev *rdev,
1179 int input_uV, int output_uV,
1180 int output_uA)
1181 {
1182 int dcdc = rdev_get_id(rdev), mode;
1183
1184 switch (dcdc) {
1185 case WM8350_DCDC_1:
1186 case WM8350_DCDC_6:
1187 mode = get_mode(output_uA, dcdc1_6_efficiency);
1188 break;
1189 case WM8350_DCDC_3:
1190 case WM8350_DCDC_4:
1191 mode = get_mode(output_uA, dcdc3_4_efficiency);
1192 break;
1193 default:
1194 mode = REGULATOR_MODE_NORMAL;
1195 break;
1196 }
1197 return mode;
1198 }
1199
wm8350_dcdc_is_enabled(struct regulator_dev * rdev)1200 static int wm8350_dcdc_is_enabled(struct regulator_dev *rdev)
1201 {
1202 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
1203 int dcdc = rdev_get_id(rdev), shift;
1204
1205 if (dcdc < WM8350_DCDC_1 || dcdc > WM8350_DCDC_6)
1206 return -EINVAL;
1207
1208 shift = dcdc - WM8350_DCDC_1;
1209 return wm8350_reg_read(wm8350, WM8350_DCDC_LDO_REQUESTED)
1210 & (1 << shift);
1211 }
1212
wm8350_ldo_is_enabled(struct regulator_dev * rdev)1213 static int wm8350_ldo_is_enabled(struct regulator_dev *rdev)
1214 {
1215 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
1216 int ldo = rdev_get_id(rdev), shift;
1217
1218 if (ldo < WM8350_LDO_1 || ldo > WM8350_LDO_4)
1219 return -EINVAL;
1220
1221 shift = (ldo - WM8350_LDO_1) + 8;
1222 return wm8350_reg_read(wm8350, WM8350_DCDC_LDO_REQUESTED)
1223 & (1 << shift);
1224 }
1225
1226 static struct regulator_ops wm8350_dcdc_ops = {
1227 .set_voltage = wm8350_dcdc_set_voltage,
1228 .get_voltage_sel = wm8350_dcdc_get_voltage_sel,
1229 .list_voltage = wm8350_dcdc_list_voltage,
1230 .enable = wm8350_dcdc_enable,
1231 .disable = wm8350_dcdc_disable,
1232 .get_mode = wm8350_dcdc_get_mode,
1233 .set_mode = wm8350_dcdc_set_mode,
1234 .get_optimum_mode = wm8350_dcdc_get_optimum_mode,
1235 .is_enabled = wm8350_dcdc_is_enabled,
1236 .set_suspend_voltage = wm8350_dcdc_set_suspend_voltage,
1237 .set_suspend_enable = wm8350_dcdc_set_suspend_enable,
1238 .set_suspend_disable = wm8350_dcdc_set_suspend_disable,
1239 .set_suspend_mode = wm8350_dcdc_set_suspend_mode,
1240 };
1241
1242 static struct regulator_ops wm8350_dcdc2_5_ops = {
1243 .enable = wm8350_dcdc_enable,
1244 .disable = wm8350_dcdc_disable,
1245 .is_enabled = wm8350_dcdc_is_enabled,
1246 .set_suspend_enable = wm8350_dcdc25_set_suspend_enable,
1247 .set_suspend_disable = wm8350_dcdc25_set_suspend_disable,
1248 };
1249
1250 static struct regulator_ops wm8350_ldo_ops = {
1251 .set_voltage = wm8350_ldo_set_voltage,
1252 .get_voltage_sel = wm8350_ldo_get_voltage_sel,
1253 .list_voltage = wm8350_ldo_list_voltage,
1254 .enable = wm8350_ldo_enable,
1255 .disable = wm8350_ldo_disable,
1256 .is_enabled = wm8350_ldo_is_enabled,
1257 .get_mode = wm8350_ldo_get_mode,
1258 .set_suspend_voltage = wm8350_ldo_set_suspend_voltage,
1259 .set_suspend_enable = wm8350_ldo_set_suspend_enable,
1260 .set_suspend_disable = wm8350_ldo_set_suspend_disable,
1261 };
1262
1263 static struct regulator_ops wm8350_isink_ops = {
1264 .set_current_limit = wm8350_isink_set_current,
1265 .get_current_limit = wm8350_isink_get_current,
1266 .enable = wm8350_isink_enable,
1267 .disable = wm8350_isink_disable,
1268 .is_enabled = wm8350_isink_is_enabled,
1269 .enable_time = wm8350_isink_enable_time,
1270 };
1271
1272 static struct regulator_desc wm8350_reg[NUM_WM8350_REGULATORS] = {
1273 {
1274 .name = "DCDC1",
1275 .id = WM8350_DCDC_1,
1276 .ops = &wm8350_dcdc_ops,
1277 .irq = WM8350_IRQ_UV_DC1,
1278 .type = REGULATOR_VOLTAGE,
1279 .n_voltages = WM8350_DCDC_MAX_VSEL + 1,
1280 .owner = THIS_MODULE,
1281 },
1282 {
1283 .name = "DCDC2",
1284 .id = WM8350_DCDC_2,
1285 .ops = &wm8350_dcdc2_5_ops,
1286 .irq = WM8350_IRQ_UV_DC2,
1287 .type = REGULATOR_VOLTAGE,
1288 .owner = THIS_MODULE,
1289 },
1290 {
1291 .name = "DCDC3",
1292 .id = WM8350_DCDC_3,
1293 .ops = &wm8350_dcdc_ops,
1294 .irq = WM8350_IRQ_UV_DC3,
1295 .type = REGULATOR_VOLTAGE,
1296 .n_voltages = WM8350_DCDC_MAX_VSEL + 1,
1297 .owner = THIS_MODULE,
1298 },
1299 {
1300 .name = "DCDC4",
1301 .id = WM8350_DCDC_4,
1302 .ops = &wm8350_dcdc_ops,
1303 .irq = WM8350_IRQ_UV_DC4,
1304 .type = REGULATOR_VOLTAGE,
1305 .n_voltages = WM8350_DCDC_MAX_VSEL + 1,
1306 .owner = THIS_MODULE,
1307 },
1308 {
1309 .name = "DCDC5",
1310 .id = WM8350_DCDC_5,
1311 .ops = &wm8350_dcdc2_5_ops,
1312 .irq = WM8350_IRQ_UV_DC5,
1313 .type = REGULATOR_VOLTAGE,
1314 .owner = THIS_MODULE,
1315 },
1316 {
1317 .name = "DCDC6",
1318 .id = WM8350_DCDC_6,
1319 .ops = &wm8350_dcdc_ops,
1320 .irq = WM8350_IRQ_UV_DC6,
1321 .type = REGULATOR_VOLTAGE,
1322 .n_voltages = WM8350_DCDC_MAX_VSEL + 1,
1323 .owner = THIS_MODULE,
1324 },
1325 {
1326 .name = "LDO1",
1327 .id = WM8350_LDO_1,
1328 .ops = &wm8350_ldo_ops,
1329 .irq = WM8350_IRQ_UV_LDO1,
1330 .type = REGULATOR_VOLTAGE,
1331 .n_voltages = WM8350_LDO1_VSEL_MASK + 1,
1332 .owner = THIS_MODULE,
1333 },
1334 {
1335 .name = "LDO2",
1336 .id = WM8350_LDO_2,
1337 .ops = &wm8350_ldo_ops,
1338 .irq = WM8350_IRQ_UV_LDO2,
1339 .type = REGULATOR_VOLTAGE,
1340 .n_voltages = WM8350_LDO2_VSEL_MASK + 1,
1341 .owner = THIS_MODULE,
1342 },
1343 {
1344 .name = "LDO3",
1345 .id = WM8350_LDO_3,
1346 .ops = &wm8350_ldo_ops,
1347 .irq = WM8350_IRQ_UV_LDO3,
1348 .type = REGULATOR_VOLTAGE,
1349 .n_voltages = WM8350_LDO3_VSEL_MASK + 1,
1350 .owner = THIS_MODULE,
1351 },
1352 {
1353 .name = "LDO4",
1354 .id = WM8350_LDO_4,
1355 .ops = &wm8350_ldo_ops,
1356 .irq = WM8350_IRQ_UV_LDO4,
1357 .type = REGULATOR_VOLTAGE,
1358 .n_voltages = WM8350_LDO4_VSEL_MASK + 1,
1359 .owner = THIS_MODULE,
1360 },
1361 {
1362 .name = "ISINKA",
1363 .id = WM8350_ISINK_A,
1364 .ops = &wm8350_isink_ops,
1365 .irq = WM8350_IRQ_CS1,
1366 .type = REGULATOR_CURRENT,
1367 .owner = THIS_MODULE,
1368 },
1369 {
1370 .name = "ISINKB",
1371 .id = WM8350_ISINK_B,
1372 .ops = &wm8350_isink_ops,
1373 .irq = WM8350_IRQ_CS2,
1374 .type = REGULATOR_CURRENT,
1375 .owner = THIS_MODULE,
1376 },
1377 };
1378
pmic_uv_handler(int irq,void * data)1379 static irqreturn_t pmic_uv_handler(int irq, void *data)
1380 {
1381 struct regulator_dev *rdev = (struct regulator_dev *)data;
1382 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
1383
1384 mutex_lock(&rdev->mutex);
1385 if (irq == WM8350_IRQ_CS1 || irq == WM8350_IRQ_CS2)
1386 regulator_notifier_call_chain(rdev,
1387 REGULATOR_EVENT_REGULATION_OUT,
1388 wm8350);
1389 else
1390 regulator_notifier_call_chain(rdev,
1391 REGULATOR_EVENT_UNDER_VOLTAGE,
1392 wm8350);
1393 mutex_unlock(&rdev->mutex);
1394
1395 return IRQ_HANDLED;
1396 }
1397
wm8350_regulator_probe(struct platform_device * pdev)1398 static int wm8350_regulator_probe(struct platform_device *pdev)
1399 {
1400 struct wm8350 *wm8350 = dev_get_drvdata(&pdev->dev);
1401 struct regulator_dev *rdev;
1402 int ret;
1403 u16 val;
1404
1405 if (pdev->id < WM8350_DCDC_1 || pdev->id > WM8350_ISINK_B)
1406 return -ENODEV;
1407
1408 /* do any regulatior specific init */
1409 switch (pdev->id) {
1410 case WM8350_DCDC_1:
1411 val = wm8350_reg_read(wm8350, WM8350_DCDC1_LOW_POWER);
1412 wm8350->pmic.dcdc1_hib_mode = val & WM8350_DCDC_HIB_MODE_MASK;
1413 break;
1414 case WM8350_DCDC_3:
1415 val = wm8350_reg_read(wm8350, WM8350_DCDC3_LOW_POWER);
1416 wm8350->pmic.dcdc3_hib_mode = val & WM8350_DCDC_HIB_MODE_MASK;
1417 break;
1418 case WM8350_DCDC_4:
1419 val = wm8350_reg_read(wm8350, WM8350_DCDC4_LOW_POWER);
1420 wm8350->pmic.dcdc4_hib_mode = val & WM8350_DCDC_HIB_MODE_MASK;
1421 break;
1422 case WM8350_DCDC_6:
1423 val = wm8350_reg_read(wm8350, WM8350_DCDC6_LOW_POWER);
1424 wm8350->pmic.dcdc6_hib_mode = val & WM8350_DCDC_HIB_MODE_MASK;
1425 break;
1426 }
1427
1428 /* register regulator */
1429 rdev = regulator_register(&wm8350_reg[pdev->id], &pdev->dev,
1430 pdev->dev.platform_data,
1431 dev_get_drvdata(&pdev->dev));
1432 if (IS_ERR(rdev)) {
1433 dev_err(&pdev->dev, "failed to register %s\n",
1434 wm8350_reg[pdev->id].name);
1435 return PTR_ERR(rdev);
1436 }
1437
1438 /* register regulator IRQ */
1439 ret = wm8350_register_irq(wm8350, wm8350_reg[pdev->id].irq,
1440 pmic_uv_handler, 0, "UV", rdev);
1441 if (ret < 0) {
1442 regulator_unregister(rdev);
1443 dev_err(&pdev->dev, "failed to register regulator %s IRQ\n",
1444 wm8350_reg[pdev->id].name);
1445 return ret;
1446 }
1447
1448 return 0;
1449 }
1450
wm8350_regulator_remove(struct platform_device * pdev)1451 static int wm8350_regulator_remove(struct platform_device *pdev)
1452 {
1453 struct regulator_dev *rdev = platform_get_drvdata(pdev);
1454 struct wm8350 *wm8350 = rdev_get_drvdata(rdev);
1455
1456 wm8350_free_irq(wm8350, wm8350_reg[pdev->id].irq, rdev);
1457
1458 regulator_unregister(rdev);
1459
1460 return 0;
1461 }
1462
wm8350_register_regulator(struct wm8350 * wm8350,int reg,struct regulator_init_data * initdata)1463 int wm8350_register_regulator(struct wm8350 *wm8350, int reg,
1464 struct regulator_init_data *initdata)
1465 {
1466 struct platform_device *pdev;
1467 int ret;
1468 if (reg < 0 || reg >= NUM_WM8350_REGULATORS)
1469 return -EINVAL;
1470
1471 if (wm8350->pmic.pdev[reg])
1472 return -EBUSY;
1473
1474 if (reg >= WM8350_DCDC_1 && reg <= WM8350_DCDC_6 &&
1475 reg > wm8350->pmic.max_dcdc)
1476 return -ENODEV;
1477 if (reg >= WM8350_ISINK_A && reg <= WM8350_ISINK_B &&
1478 reg > wm8350->pmic.max_isink)
1479 return -ENODEV;
1480
1481 pdev = platform_device_alloc("wm8350-regulator", reg);
1482 if (!pdev)
1483 return -ENOMEM;
1484
1485 wm8350->pmic.pdev[reg] = pdev;
1486
1487 initdata->driver_data = wm8350;
1488
1489 pdev->dev.platform_data = initdata;
1490 pdev->dev.parent = wm8350->dev;
1491 platform_set_drvdata(pdev, wm8350);
1492
1493 ret = platform_device_add(pdev);
1494
1495 if (ret != 0) {
1496 dev_err(wm8350->dev, "Failed to register regulator %d: %d\n",
1497 reg, ret);
1498 platform_device_put(pdev);
1499 wm8350->pmic.pdev[reg] = NULL;
1500 }
1501
1502 return ret;
1503 }
1504 EXPORT_SYMBOL_GPL(wm8350_register_regulator);
1505
1506 /**
1507 * wm8350_register_led - Register a WM8350 LED output
1508 *
1509 * @param wm8350 The WM8350 device to configure.
1510 * @param lednum LED device index to create.
1511 * @param dcdc The DCDC to use for the LED.
1512 * @param isink The ISINK to use for the LED.
1513 * @param pdata Configuration for the LED.
1514 *
1515 * The WM8350 supports the use of an ISINK together with a DCDC to
1516 * provide a power-efficient LED driver. This function registers the
1517 * regulators and instantiates the platform device for a LED. The
1518 * operating modes for the LED regulators must be configured using
1519 * wm8350_isink_set_flash(), wm8350_dcdc25_set_mode() and
1520 * wm8350_dcdc_set_slot() prior to calling this function.
1521 */
wm8350_register_led(struct wm8350 * wm8350,int lednum,int dcdc,int isink,struct wm8350_led_platform_data * pdata)1522 int wm8350_register_led(struct wm8350 *wm8350, int lednum, int dcdc, int isink,
1523 struct wm8350_led_platform_data *pdata)
1524 {
1525 struct wm8350_led *led;
1526 struct platform_device *pdev;
1527 int ret;
1528
1529 if (lednum >= ARRAY_SIZE(wm8350->pmic.led) || lednum < 0) {
1530 dev_err(wm8350->dev, "Invalid LED index %d\n", lednum);
1531 return -ENODEV;
1532 }
1533
1534 led = &wm8350->pmic.led[lednum];
1535
1536 if (led->pdev) {
1537 dev_err(wm8350->dev, "LED %d already allocated\n", lednum);
1538 return -EINVAL;
1539 }
1540
1541 pdev = platform_device_alloc("wm8350-led", lednum);
1542 if (pdev == NULL) {
1543 dev_err(wm8350->dev, "Failed to allocate LED %d\n", lednum);
1544 return -ENOMEM;
1545 }
1546
1547 led->isink_consumer.dev = &pdev->dev;
1548 led->isink_consumer.supply = "led_isink";
1549 led->isink_init.num_consumer_supplies = 1;
1550 led->isink_init.consumer_supplies = &led->isink_consumer;
1551 led->isink_init.constraints.min_uA = 0;
1552 led->isink_init.constraints.max_uA = pdata->max_uA;
1553 led->isink_init.constraints.valid_ops_mask
1554 = REGULATOR_CHANGE_CURRENT | REGULATOR_CHANGE_STATUS;
1555 led->isink_init.constraints.valid_modes_mask = REGULATOR_MODE_NORMAL;
1556 ret = wm8350_register_regulator(wm8350, isink, &led->isink_init);
1557 if (ret != 0) {
1558 platform_device_put(pdev);
1559 return ret;
1560 }
1561
1562 led->dcdc_consumer.dev = &pdev->dev;
1563 led->dcdc_consumer.supply = "led_vcc";
1564 led->dcdc_init.num_consumer_supplies = 1;
1565 led->dcdc_init.consumer_supplies = &led->dcdc_consumer;
1566 led->dcdc_init.constraints.valid_modes_mask = REGULATOR_MODE_NORMAL;
1567 led->dcdc_init.constraints.valid_ops_mask = REGULATOR_CHANGE_STATUS;
1568 ret = wm8350_register_regulator(wm8350, dcdc, &led->dcdc_init);
1569 if (ret != 0) {
1570 platform_device_put(pdev);
1571 return ret;
1572 }
1573
1574 switch (isink) {
1575 case WM8350_ISINK_A:
1576 wm8350->pmic.isink_A_dcdc = dcdc;
1577 break;
1578 case WM8350_ISINK_B:
1579 wm8350->pmic.isink_B_dcdc = dcdc;
1580 break;
1581 }
1582
1583 pdev->dev.platform_data = pdata;
1584 pdev->dev.parent = wm8350->dev;
1585 ret = platform_device_add(pdev);
1586 if (ret != 0) {
1587 dev_err(wm8350->dev, "Failed to register LED %d: %d\n",
1588 lednum, ret);
1589 platform_device_put(pdev);
1590 return ret;
1591 }
1592
1593 led->pdev = pdev;
1594
1595 return 0;
1596 }
1597 EXPORT_SYMBOL_GPL(wm8350_register_led);
1598
1599 static struct platform_driver wm8350_regulator_driver = {
1600 .probe = wm8350_regulator_probe,
1601 .remove = wm8350_regulator_remove,
1602 .driver = {
1603 .name = "wm8350-regulator",
1604 },
1605 };
1606
wm8350_regulator_init(void)1607 static int __init wm8350_regulator_init(void)
1608 {
1609 return platform_driver_register(&wm8350_regulator_driver);
1610 }
1611 subsys_initcall(wm8350_regulator_init);
1612
wm8350_regulator_exit(void)1613 static void __exit wm8350_regulator_exit(void)
1614 {
1615 platform_driver_unregister(&wm8350_regulator_driver);
1616 }
1617 module_exit(wm8350_regulator_exit);
1618
1619 /* Module information */
1620 MODULE_AUTHOR("Liam Girdwood");
1621 MODULE_DESCRIPTION("WM8350 voltage and current regulator driver");
1622 MODULE_LICENSE("GPL");
1623 MODULE_ALIAS("platform:wm8350-regulator");
1624