This source file includes following definitions.
- rpm_reg_write
- rpm_reg_set_mV_sel
- rpm_reg_set_uV_sel
- rpm_reg_get_voltage
- rpm_reg_mV_enable
- rpm_reg_uV_enable
- rpm_reg_switch_enable
- rpm_reg_mV_disable
- rpm_reg_uV_disable
- rpm_reg_switch_disable
- rpm_reg_is_enabled
- rpm_reg_set_load
- rpm_reg_set
- rpm_reg_of_parse_freq
- rpm_reg_of_parse
- rpm_reg_probe
- rpm_reg_init
- rpm_reg_exit
1
2
3
4
5
6
7 #include <linux/module.h>
8 #include <linux/platform_device.h>
9 #include <linux/of.h>
10 #include <linux/of_device.h>
11 #include <linux/regulator/driver.h>
12 #include <linux/regulator/machine.h>
13 #include <linux/regulator/of_regulator.h>
14 #include <linux/mfd/qcom_rpm.h>
15
16 #include <dt-bindings/mfd/qcom-rpm.h>
17
18 #define MAX_REQUEST_LEN 2
19
20 struct request_member {
21 int word;
22 unsigned int mask;
23 int shift;
24 };
25
26 struct rpm_reg_parts {
27 struct request_member mV;
28 struct request_member uV;
29 struct request_member ip;
30 struct request_member pd;
31 struct request_member ia;
32 struct request_member fm;
33 struct request_member pm;
34 struct request_member pc;
35 struct request_member pf;
36 struct request_member enable_state;
37 struct request_member comp_mode;
38 struct request_member freq;
39 struct request_member freq_clk_src;
40 struct request_member hpm;
41 int request_len;
42 };
43
44 #define FORCE_MODE_IS_2_BITS(reg) \
45 (((reg)->parts->fm.mask >> (reg)->parts->fm.shift) == 3)
46
47 struct qcom_rpm_reg {
48 struct qcom_rpm *rpm;
49
50 struct mutex lock;
51 struct device *dev;
52 struct regulator_desc desc;
53 const struct rpm_reg_parts *parts;
54
55 int resource;
56 u32 val[MAX_REQUEST_LEN];
57
58 int uV;
59 int is_enabled;
60
61 bool supports_force_mode_auto;
62 bool supports_force_mode_bypass;
63 };
64
65 static const struct rpm_reg_parts rpm8660_ldo_parts = {
66 .request_len = 2,
67 .mV = { 0, 0x00000FFF, 0 },
68 .ip = { 0, 0x00FFF000, 12 },
69 .fm = { 0, 0x03000000, 24 },
70 .pc = { 0, 0x3C000000, 26 },
71 .pf = { 0, 0xC0000000, 30 },
72 .pd = { 1, 0x00000001, 0 },
73 .ia = { 1, 0x00001FFE, 1 },
74 };
75
76 static const struct rpm_reg_parts rpm8660_smps_parts = {
77 .request_len = 2,
78 .mV = { 0, 0x00000FFF, 0 },
79 .ip = { 0, 0x00FFF000, 12 },
80 .fm = { 0, 0x03000000, 24 },
81 .pc = { 0, 0x3C000000, 26 },
82 .pf = { 0, 0xC0000000, 30 },
83 .pd = { 1, 0x00000001, 0 },
84 .ia = { 1, 0x00001FFE, 1 },
85 .freq = { 1, 0x001FE000, 13 },
86 .freq_clk_src = { 1, 0x00600000, 21 },
87 };
88
89 static const struct rpm_reg_parts rpm8660_switch_parts = {
90 .request_len = 1,
91 .enable_state = { 0, 0x00000001, 0 },
92 .pd = { 0, 0x00000002, 1 },
93 .pc = { 0, 0x0000003C, 2 },
94 .pf = { 0, 0x000000C0, 6 },
95 .hpm = { 0, 0x00000300, 8 },
96 };
97
98 static const struct rpm_reg_parts rpm8660_ncp_parts = {
99 .request_len = 1,
100 .mV = { 0, 0x00000FFF, 0 },
101 .enable_state = { 0, 0x00001000, 12 },
102 .comp_mode = { 0, 0x00002000, 13 },
103 .freq = { 0, 0x003FC000, 14 },
104 };
105
106 static const struct rpm_reg_parts rpm8960_ldo_parts = {
107 .request_len = 2,
108 .uV = { 0, 0x007FFFFF, 0 },
109 .pd = { 0, 0x00800000, 23 },
110 .pc = { 0, 0x0F000000, 24 },
111 .pf = { 0, 0xF0000000, 28 },
112 .ip = { 1, 0x000003FF, 0 },
113 .ia = { 1, 0x000FFC00, 10 },
114 .fm = { 1, 0x00700000, 20 },
115 };
116
117 static const struct rpm_reg_parts rpm8960_smps_parts = {
118 .request_len = 2,
119 .uV = { 0, 0x007FFFFF, 0 },
120 .pd = { 0, 0x00800000, 23 },
121 .pc = { 0, 0x0F000000, 24 },
122 .pf = { 0, 0xF0000000, 28 },
123 .ip = { 1, 0x000003FF, 0 },
124 .ia = { 1, 0x000FFC00, 10 },
125 .fm = { 1, 0x00700000, 20 },
126 .pm = { 1, 0x00800000, 23 },
127 .freq = { 1, 0x1F000000, 24 },
128 .freq_clk_src = { 1, 0x60000000, 29 },
129 };
130
131 static const struct rpm_reg_parts rpm8960_switch_parts = {
132 .request_len = 1,
133 .enable_state = { 0, 0x00000001, 0 },
134 .pd = { 0, 0x00000002, 1 },
135 .pc = { 0, 0x0000003C, 2 },
136 .pf = { 0, 0x000003C0, 6 },
137 .hpm = { 0, 0x00000C00, 10 },
138 };
139
140 static const struct rpm_reg_parts rpm8960_ncp_parts = {
141 .request_len = 1,
142 .uV = { 0, 0x007FFFFF, 0 },
143 .enable_state = { 0, 0x00800000, 23 },
144 .comp_mode = { 0, 0x01000000, 24 },
145 .freq = { 0, 0x3E000000, 25 },
146 };
147
148
149
150
151 static const struct regulator_linear_range pldo_ranges[] = {
152 REGULATOR_LINEAR_RANGE( 750000, 0, 59, 12500),
153 REGULATOR_LINEAR_RANGE(1500000, 60, 123, 25000),
154 REGULATOR_LINEAR_RANGE(3100000, 124, 160, 50000),
155 };
156
157 static const struct regulator_linear_range nldo_ranges[] = {
158 REGULATOR_LINEAR_RANGE( 750000, 0, 63, 12500),
159 };
160
161 static const struct regulator_linear_range nldo1200_ranges[] = {
162 REGULATOR_LINEAR_RANGE( 375000, 0, 59, 6250),
163 REGULATOR_LINEAR_RANGE( 750000, 60, 123, 12500),
164 };
165
166 static const struct regulator_linear_range smps_ranges[] = {
167 REGULATOR_LINEAR_RANGE( 375000, 0, 29, 12500),
168 REGULATOR_LINEAR_RANGE( 750000, 30, 89, 12500),
169 REGULATOR_LINEAR_RANGE(1500000, 90, 153, 25000),
170 };
171
172 static const struct regulator_linear_range ftsmps_ranges[] = {
173 REGULATOR_LINEAR_RANGE( 350000, 0, 6, 50000),
174 REGULATOR_LINEAR_RANGE( 700000, 7, 63, 12500),
175 REGULATOR_LINEAR_RANGE(1500000, 64, 100, 50000),
176 };
177
178 static const struct regulator_linear_range smb208_ranges[] = {
179 REGULATOR_LINEAR_RANGE( 375000, 0, 29, 12500),
180 REGULATOR_LINEAR_RANGE( 750000, 30, 89, 12500),
181 REGULATOR_LINEAR_RANGE(1500000, 90, 153, 25000),
182 REGULATOR_LINEAR_RANGE(3100000, 154, 234, 25000),
183 };
184
185 static const struct regulator_linear_range ncp_ranges[] = {
186 REGULATOR_LINEAR_RANGE(1500000, 0, 31, 50000),
187 };
188
189 static int rpm_reg_write(struct qcom_rpm_reg *vreg,
190 const struct request_member *req,
191 const int value)
192 {
193 if (WARN_ON((value << req->shift) & ~req->mask))
194 return -EINVAL;
195
196 vreg->val[req->word] &= ~req->mask;
197 vreg->val[req->word] |= value << req->shift;
198
199 return qcom_rpm_write(vreg->rpm,
200 QCOM_RPM_ACTIVE_STATE,
201 vreg->resource,
202 vreg->val,
203 vreg->parts->request_len);
204 }
205
206 static int rpm_reg_set_mV_sel(struct regulator_dev *rdev,
207 unsigned selector)
208 {
209 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
210 const struct rpm_reg_parts *parts = vreg->parts;
211 const struct request_member *req = &parts->mV;
212 int ret = 0;
213 int uV;
214
215 if (req->mask == 0)
216 return -EINVAL;
217
218 uV = regulator_list_voltage_linear_range(rdev, selector);
219 if (uV < 0)
220 return uV;
221
222 mutex_lock(&vreg->lock);
223 if (vreg->is_enabled)
224 ret = rpm_reg_write(vreg, req, uV / 1000);
225
226 if (!ret)
227 vreg->uV = uV;
228 mutex_unlock(&vreg->lock);
229
230 return ret;
231 }
232
233 static int rpm_reg_set_uV_sel(struct regulator_dev *rdev,
234 unsigned selector)
235 {
236 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
237 const struct rpm_reg_parts *parts = vreg->parts;
238 const struct request_member *req = &parts->uV;
239 int ret = 0;
240 int uV;
241
242 if (req->mask == 0)
243 return -EINVAL;
244
245 uV = regulator_list_voltage_linear_range(rdev, selector);
246 if (uV < 0)
247 return uV;
248
249 mutex_lock(&vreg->lock);
250 if (vreg->is_enabled)
251 ret = rpm_reg_write(vreg, req, uV);
252
253 if (!ret)
254 vreg->uV = uV;
255 mutex_unlock(&vreg->lock);
256
257 return ret;
258 }
259
260 static int rpm_reg_get_voltage(struct regulator_dev *rdev)
261 {
262 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
263
264 return vreg->uV;
265 }
266
267 static int rpm_reg_mV_enable(struct regulator_dev *rdev)
268 {
269 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
270 const struct rpm_reg_parts *parts = vreg->parts;
271 const struct request_member *req = &parts->mV;
272 int ret;
273
274 if (req->mask == 0)
275 return -EINVAL;
276
277 mutex_lock(&vreg->lock);
278 ret = rpm_reg_write(vreg, req, vreg->uV / 1000);
279 if (!ret)
280 vreg->is_enabled = 1;
281 mutex_unlock(&vreg->lock);
282
283 return ret;
284 }
285
286 static int rpm_reg_uV_enable(struct regulator_dev *rdev)
287 {
288 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
289 const struct rpm_reg_parts *parts = vreg->parts;
290 const struct request_member *req = &parts->uV;
291 int ret;
292
293 if (req->mask == 0)
294 return -EINVAL;
295
296 mutex_lock(&vreg->lock);
297 ret = rpm_reg_write(vreg, req, vreg->uV);
298 if (!ret)
299 vreg->is_enabled = 1;
300 mutex_unlock(&vreg->lock);
301
302 return ret;
303 }
304
305 static int rpm_reg_switch_enable(struct regulator_dev *rdev)
306 {
307 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
308 const struct rpm_reg_parts *parts = vreg->parts;
309 const struct request_member *req = &parts->enable_state;
310 int ret;
311
312 if (req->mask == 0)
313 return -EINVAL;
314
315 mutex_lock(&vreg->lock);
316 ret = rpm_reg_write(vreg, req, 1);
317 if (!ret)
318 vreg->is_enabled = 1;
319 mutex_unlock(&vreg->lock);
320
321 return ret;
322 }
323
324 static int rpm_reg_mV_disable(struct regulator_dev *rdev)
325 {
326 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
327 const struct rpm_reg_parts *parts = vreg->parts;
328 const struct request_member *req = &parts->mV;
329 int ret;
330
331 if (req->mask == 0)
332 return -EINVAL;
333
334 mutex_lock(&vreg->lock);
335 ret = rpm_reg_write(vreg, req, 0);
336 if (!ret)
337 vreg->is_enabled = 0;
338 mutex_unlock(&vreg->lock);
339
340 return ret;
341 }
342
343 static int rpm_reg_uV_disable(struct regulator_dev *rdev)
344 {
345 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
346 const struct rpm_reg_parts *parts = vreg->parts;
347 const struct request_member *req = &parts->uV;
348 int ret;
349
350 if (req->mask == 0)
351 return -EINVAL;
352
353 mutex_lock(&vreg->lock);
354 ret = rpm_reg_write(vreg, req, 0);
355 if (!ret)
356 vreg->is_enabled = 0;
357 mutex_unlock(&vreg->lock);
358
359 return ret;
360 }
361
362 static int rpm_reg_switch_disable(struct regulator_dev *rdev)
363 {
364 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
365 const struct rpm_reg_parts *parts = vreg->parts;
366 const struct request_member *req = &parts->enable_state;
367 int ret;
368
369 if (req->mask == 0)
370 return -EINVAL;
371
372 mutex_lock(&vreg->lock);
373 ret = rpm_reg_write(vreg, req, 0);
374 if (!ret)
375 vreg->is_enabled = 0;
376 mutex_unlock(&vreg->lock);
377
378 return ret;
379 }
380
381 static int rpm_reg_is_enabled(struct regulator_dev *rdev)
382 {
383 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
384
385 return vreg->is_enabled;
386 }
387
388 static int rpm_reg_set_load(struct regulator_dev *rdev, int load_uA)
389 {
390 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
391 const struct rpm_reg_parts *parts = vreg->parts;
392 const struct request_member *req = &parts->ia;
393 int load_mA = load_uA / 1000;
394 int max_mA = req->mask >> req->shift;
395 int ret;
396
397 if (req->mask == 0)
398 return -EINVAL;
399
400 if (load_mA > max_mA)
401 load_mA = max_mA;
402
403 mutex_lock(&vreg->lock);
404 ret = rpm_reg_write(vreg, req, load_mA);
405 mutex_unlock(&vreg->lock);
406
407 return ret;
408 }
409
410 static struct regulator_ops uV_ops = {
411 .list_voltage = regulator_list_voltage_linear_range,
412
413 .set_voltage_sel = rpm_reg_set_uV_sel,
414 .get_voltage = rpm_reg_get_voltage,
415
416 .enable = rpm_reg_uV_enable,
417 .disable = rpm_reg_uV_disable,
418 .is_enabled = rpm_reg_is_enabled,
419
420 .set_load = rpm_reg_set_load,
421 };
422
423 static struct regulator_ops mV_ops = {
424 .list_voltage = regulator_list_voltage_linear_range,
425
426 .set_voltage_sel = rpm_reg_set_mV_sel,
427 .get_voltage = rpm_reg_get_voltage,
428
429 .enable = rpm_reg_mV_enable,
430 .disable = rpm_reg_mV_disable,
431 .is_enabled = rpm_reg_is_enabled,
432
433 .set_load = rpm_reg_set_load,
434 };
435
436 static struct regulator_ops switch_ops = {
437 .enable = rpm_reg_switch_enable,
438 .disable = rpm_reg_switch_disable,
439 .is_enabled = rpm_reg_is_enabled,
440 };
441
442
443
444
445 static const struct qcom_rpm_reg pm8018_pldo = {
446 .desc.linear_ranges = pldo_ranges,
447 .desc.n_linear_ranges = ARRAY_SIZE(pldo_ranges),
448 .desc.n_voltages = 161,
449 .desc.ops = &uV_ops,
450 .parts = &rpm8960_ldo_parts,
451 .supports_force_mode_auto = false,
452 .supports_force_mode_bypass = false,
453 };
454
455 static const struct qcom_rpm_reg pm8018_nldo = {
456 .desc.linear_ranges = nldo_ranges,
457 .desc.n_linear_ranges = ARRAY_SIZE(nldo_ranges),
458 .desc.n_voltages = 64,
459 .desc.ops = &uV_ops,
460 .parts = &rpm8960_ldo_parts,
461 .supports_force_mode_auto = false,
462 .supports_force_mode_bypass = false,
463 };
464
465 static const struct qcom_rpm_reg pm8018_smps = {
466 .desc.linear_ranges = smps_ranges,
467 .desc.n_linear_ranges = ARRAY_SIZE(smps_ranges),
468 .desc.n_voltages = 154,
469 .desc.ops = &uV_ops,
470 .parts = &rpm8960_smps_parts,
471 .supports_force_mode_auto = false,
472 .supports_force_mode_bypass = false,
473 };
474
475 static const struct qcom_rpm_reg pm8018_switch = {
476 .desc.ops = &switch_ops,
477 .parts = &rpm8960_switch_parts,
478 };
479
480
481
482
483 static const struct qcom_rpm_reg pm8058_pldo = {
484 .desc.linear_ranges = pldo_ranges,
485 .desc.n_linear_ranges = ARRAY_SIZE(pldo_ranges),
486 .desc.n_voltages = 161,
487 .desc.ops = &mV_ops,
488 .parts = &rpm8660_ldo_parts,
489 .supports_force_mode_auto = false,
490 .supports_force_mode_bypass = false,
491 };
492
493 static const struct qcom_rpm_reg pm8058_nldo = {
494 .desc.linear_ranges = nldo_ranges,
495 .desc.n_linear_ranges = ARRAY_SIZE(nldo_ranges),
496 .desc.n_voltages = 64,
497 .desc.ops = &mV_ops,
498 .parts = &rpm8660_ldo_parts,
499 .supports_force_mode_auto = false,
500 .supports_force_mode_bypass = false,
501 };
502
503 static const struct qcom_rpm_reg pm8058_smps = {
504 .desc.linear_ranges = smps_ranges,
505 .desc.n_linear_ranges = ARRAY_SIZE(smps_ranges),
506 .desc.n_voltages = 154,
507 .desc.ops = &mV_ops,
508 .parts = &rpm8660_smps_parts,
509 .supports_force_mode_auto = false,
510 .supports_force_mode_bypass = false,
511 };
512
513 static const struct qcom_rpm_reg pm8058_ncp = {
514 .desc.linear_ranges = ncp_ranges,
515 .desc.n_linear_ranges = ARRAY_SIZE(ncp_ranges),
516 .desc.n_voltages = 32,
517 .desc.ops = &mV_ops,
518 .parts = &rpm8660_ncp_parts,
519 };
520
521 static const struct qcom_rpm_reg pm8058_switch = {
522 .desc.ops = &switch_ops,
523 .parts = &rpm8660_switch_parts,
524 };
525
526
527
528
529 static const struct qcom_rpm_reg pm8901_pldo = {
530 .desc.linear_ranges = pldo_ranges,
531 .desc.n_linear_ranges = ARRAY_SIZE(pldo_ranges),
532 .desc.n_voltages = 161,
533 .desc.ops = &mV_ops,
534 .parts = &rpm8660_ldo_parts,
535 .supports_force_mode_auto = false,
536 .supports_force_mode_bypass = true,
537 };
538
539 static const struct qcom_rpm_reg pm8901_nldo = {
540 .desc.linear_ranges = nldo_ranges,
541 .desc.n_linear_ranges = ARRAY_SIZE(nldo_ranges),
542 .desc.n_voltages = 64,
543 .desc.ops = &mV_ops,
544 .parts = &rpm8660_ldo_parts,
545 .supports_force_mode_auto = false,
546 .supports_force_mode_bypass = true,
547 };
548
549 static const struct qcom_rpm_reg pm8901_ftsmps = {
550 .desc.linear_ranges = ftsmps_ranges,
551 .desc.n_linear_ranges = ARRAY_SIZE(ftsmps_ranges),
552 .desc.n_voltages = 101,
553 .desc.ops = &mV_ops,
554 .parts = &rpm8660_smps_parts,
555 .supports_force_mode_auto = true,
556 .supports_force_mode_bypass = false,
557 };
558
559 static const struct qcom_rpm_reg pm8901_switch = {
560 .desc.ops = &switch_ops,
561 .parts = &rpm8660_switch_parts,
562 };
563
564
565
566
567 static const struct qcom_rpm_reg pm8921_pldo = {
568 .desc.linear_ranges = pldo_ranges,
569 .desc.n_linear_ranges = ARRAY_SIZE(pldo_ranges),
570 .desc.n_voltages = 161,
571 .desc.ops = &uV_ops,
572 .parts = &rpm8960_ldo_parts,
573 .supports_force_mode_auto = false,
574 .supports_force_mode_bypass = true,
575 };
576
577 static const struct qcom_rpm_reg pm8921_nldo = {
578 .desc.linear_ranges = nldo_ranges,
579 .desc.n_linear_ranges = ARRAY_SIZE(nldo_ranges),
580 .desc.n_voltages = 64,
581 .desc.ops = &uV_ops,
582 .parts = &rpm8960_ldo_parts,
583 .supports_force_mode_auto = false,
584 .supports_force_mode_bypass = true,
585 };
586
587 static const struct qcom_rpm_reg pm8921_nldo1200 = {
588 .desc.linear_ranges = nldo1200_ranges,
589 .desc.n_linear_ranges = ARRAY_SIZE(nldo1200_ranges),
590 .desc.n_voltages = 124,
591 .desc.ops = &uV_ops,
592 .parts = &rpm8960_ldo_parts,
593 .supports_force_mode_auto = false,
594 .supports_force_mode_bypass = true,
595 };
596
597 static const struct qcom_rpm_reg pm8921_smps = {
598 .desc.linear_ranges = smps_ranges,
599 .desc.n_linear_ranges = ARRAY_SIZE(smps_ranges),
600 .desc.n_voltages = 154,
601 .desc.ops = &uV_ops,
602 .parts = &rpm8960_smps_parts,
603 .supports_force_mode_auto = true,
604 .supports_force_mode_bypass = false,
605 };
606
607 static const struct qcom_rpm_reg pm8921_ftsmps = {
608 .desc.linear_ranges = ftsmps_ranges,
609 .desc.n_linear_ranges = ARRAY_SIZE(ftsmps_ranges),
610 .desc.n_voltages = 101,
611 .desc.ops = &uV_ops,
612 .parts = &rpm8960_smps_parts,
613 .supports_force_mode_auto = true,
614 .supports_force_mode_bypass = false,
615 };
616
617 static const struct qcom_rpm_reg pm8921_ncp = {
618 .desc.linear_ranges = ncp_ranges,
619 .desc.n_linear_ranges = ARRAY_SIZE(ncp_ranges),
620 .desc.n_voltages = 32,
621 .desc.ops = &uV_ops,
622 .parts = &rpm8960_ncp_parts,
623 };
624
625 static const struct qcom_rpm_reg pm8921_switch = {
626 .desc.ops = &switch_ops,
627 .parts = &rpm8960_switch_parts,
628 };
629
630 static const struct qcom_rpm_reg smb208_smps = {
631 .desc.linear_ranges = smb208_ranges,
632 .desc.n_linear_ranges = ARRAY_SIZE(smb208_ranges),
633 .desc.n_voltages = 235,
634 .desc.ops = &uV_ops,
635 .parts = &rpm8960_smps_parts,
636 .supports_force_mode_auto = false,
637 .supports_force_mode_bypass = false,
638 };
639
640 static int rpm_reg_set(struct qcom_rpm_reg *vreg,
641 const struct request_member *req,
642 const int value)
643 {
644 if (req->mask == 0 || (value << req->shift) & ~req->mask)
645 return -EINVAL;
646
647 vreg->val[req->word] &= ~req->mask;
648 vreg->val[req->word] |= value << req->shift;
649
650 return 0;
651 }
652
653 static int rpm_reg_of_parse_freq(struct device *dev,
654 struct device_node *node,
655 struct qcom_rpm_reg *vreg)
656 {
657 static const int freq_table[] = {
658 19200000, 9600000, 6400000, 4800000, 3840000, 3200000, 2740000,
659 2400000, 2130000, 1920000, 1750000, 1600000, 1480000, 1370000,
660 1280000, 1200000,
661
662 };
663 const char *key;
664 u32 freq;
665 int ret;
666 int i;
667
668 key = "qcom,switch-mode-frequency";
669 ret = of_property_read_u32(node, key, &freq);
670 if (ret) {
671 dev_err(dev, "regulator requires %s property\n", key);
672 return -EINVAL;
673 }
674
675 for (i = 0; i < ARRAY_SIZE(freq_table); i++) {
676 if (freq == freq_table[i]) {
677 rpm_reg_set(vreg, &vreg->parts->freq, i + 1);
678 return 0;
679 }
680 }
681
682 dev_err(dev, "invalid frequency %d\n", freq);
683 return -EINVAL;
684 }
685
686 static int rpm_reg_of_parse(struct device_node *node,
687 const struct regulator_desc *desc,
688 struct regulator_config *config)
689 {
690 struct qcom_rpm_reg *vreg = config->driver_data;
691 struct device *dev = config->dev;
692 const char *key;
693 u32 force_mode;
694 bool pwm;
695 u32 val;
696 int ret;
697
698 key = "bias-pull-down";
699 if (of_property_read_bool(node, key)) {
700 ret = rpm_reg_set(vreg, &vreg->parts->pd, 1);
701 if (ret) {
702 dev_err(dev, "%s is invalid", key);
703 return ret;
704 }
705 }
706
707 if (vreg->parts->freq.mask) {
708 ret = rpm_reg_of_parse_freq(dev, node, vreg);
709 if (ret < 0)
710 return ret;
711 }
712
713 if (vreg->parts->pm.mask) {
714 key = "qcom,power-mode-hysteretic";
715 pwm = !of_property_read_bool(node, key);
716
717 ret = rpm_reg_set(vreg, &vreg->parts->pm, pwm);
718 if (ret) {
719 dev_err(dev, "failed to set power mode\n");
720 return ret;
721 }
722 }
723
724 if (vreg->parts->fm.mask) {
725 force_mode = -1;
726
727 key = "qcom,force-mode";
728 ret = of_property_read_u32(node, key, &val);
729 if (ret == -EINVAL) {
730 val = QCOM_RPM_FORCE_MODE_NONE;
731 } else if (ret < 0) {
732 dev_err(dev, "failed to read %s\n", key);
733 return ret;
734 }
735
736
737
738
739
740
741
742
743 switch (val) {
744 case QCOM_RPM_FORCE_MODE_NONE:
745 force_mode = 0;
746 break;
747 case QCOM_RPM_FORCE_MODE_LPM:
748 force_mode = 1;
749 break;
750 case QCOM_RPM_FORCE_MODE_HPM:
751 if (FORCE_MODE_IS_2_BITS(vreg))
752 force_mode = 2;
753 else
754 force_mode = 3;
755 break;
756 case QCOM_RPM_FORCE_MODE_AUTO:
757 if (vreg->supports_force_mode_auto)
758 force_mode = 2;
759 break;
760 case QCOM_RPM_FORCE_MODE_BYPASS:
761 if (vreg->supports_force_mode_bypass)
762 force_mode = 4;
763 break;
764 }
765
766 if (force_mode == -1) {
767 dev_err(dev, "invalid force mode\n");
768 return -EINVAL;
769 }
770
771 ret = rpm_reg_set(vreg, &vreg->parts->fm, force_mode);
772 if (ret) {
773 dev_err(dev, "failed to set force mode\n");
774 return ret;
775 }
776 }
777
778 return 0;
779 }
780
781 struct rpm_regulator_data {
782 const char *name;
783 int resource;
784 const struct qcom_rpm_reg *template;
785 const char *supply;
786 };
787
788 static const struct rpm_regulator_data rpm_pm8018_regulators[] = {
789 { "s1", QCOM_RPM_PM8018_SMPS1, &pm8018_smps, "vdd_s1" },
790 { "s2", QCOM_RPM_PM8018_SMPS2, &pm8018_smps, "vdd_s2" },
791 { "s3", QCOM_RPM_PM8018_SMPS3, &pm8018_smps, "vdd_s3" },
792 { "s4", QCOM_RPM_PM8018_SMPS4, &pm8018_smps, "vdd_s4" },
793 { "s5", QCOM_RPM_PM8018_SMPS5, &pm8018_smps, "vdd_s5" },
794
795 { "l2", QCOM_RPM_PM8018_LDO2, &pm8018_pldo, "vdd_l2" },
796 { "l3", QCOM_RPM_PM8018_LDO3, &pm8018_pldo, "vdd_l3" },
797 { "l4", QCOM_RPM_PM8018_LDO4, &pm8018_pldo, "vdd_l4" },
798 { "l5", QCOM_RPM_PM8018_LDO5, &pm8018_pldo, "vdd_l5" },
799 { "l6", QCOM_RPM_PM8018_LDO6, &pm8018_pldo, "vdd_l7" },
800 { "l7", QCOM_RPM_PM8018_LDO7, &pm8018_pldo, "vdd_l7" },
801 { "l8", QCOM_RPM_PM8018_LDO8, &pm8018_nldo, "vdd_l8" },
802 { "l9", QCOM_RPM_PM8018_LDO9, &pm8921_nldo1200,
803 "vdd_l9_l10_l11_l12" },
804 { "l10", QCOM_RPM_PM8018_LDO10, &pm8018_nldo, "vdd_l9_l10_l11_l12" },
805 { "l11", QCOM_RPM_PM8018_LDO11, &pm8018_nldo, "vdd_l9_l10_l11_l12" },
806 { "l12", QCOM_RPM_PM8018_LDO12, &pm8018_nldo, "vdd_l9_l10_l11_l12" },
807 { "l14", QCOM_RPM_PM8018_LDO14, &pm8018_pldo, "vdd_l14" },
808
809 { "lvs1", QCOM_RPM_PM8018_LVS1, &pm8018_switch, "lvs1_in" },
810
811 { }
812 };
813
814 static const struct rpm_regulator_data rpm_pm8058_regulators[] = {
815 { "l0", QCOM_RPM_PM8058_LDO0, &pm8058_nldo, "vdd_l0_l1_lvs" },
816 { "l1", QCOM_RPM_PM8058_LDO1, &pm8058_nldo, "vdd_l0_l1_lvs" },
817 { "l2", QCOM_RPM_PM8058_LDO2, &pm8058_pldo, "vdd_l2_l11_l12" },
818 { "l3", QCOM_RPM_PM8058_LDO3, &pm8058_pldo, "vdd_l3_l4_l5" },
819 { "l4", QCOM_RPM_PM8058_LDO4, &pm8058_pldo, "vdd_l3_l4_l5" },
820 { "l5", QCOM_RPM_PM8058_LDO5, &pm8058_pldo, "vdd_l3_l4_l5" },
821 { "l6", QCOM_RPM_PM8058_LDO6, &pm8058_pldo, "vdd_l6_l7" },
822 { "l7", QCOM_RPM_PM8058_LDO7, &pm8058_pldo, "vdd_l6_l7" },
823 { "l8", QCOM_RPM_PM8058_LDO8, &pm8058_pldo, "vdd_l8" },
824 { "l9", QCOM_RPM_PM8058_LDO9, &pm8058_pldo, "vdd_l9" },
825 { "l10", QCOM_RPM_PM8058_LDO10, &pm8058_pldo, "vdd_l10" },
826 { "l11", QCOM_RPM_PM8058_LDO11, &pm8058_pldo, "vdd_l2_l11_l12" },
827 { "l12", QCOM_RPM_PM8058_LDO12, &pm8058_pldo, "vdd_l2_l11_l12" },
828 { "l13", QCOM_RPM_PM8058_LDO13, &pm8058_pldo, "vdd_l13_l16" },
829 { "l14", QCOM_RPM_PM8058_LDO14, &pm8058_pldo, "vdd_l14_l15" },
830 { "l15", QCOM_RPM_PM8058_LDO15, &pm8058_pldo, "vdd_l14_l15" },
831 { "l16", QCOM_RPM_PM8058_LDO16, &pm8058_pldo, "vdd_l13_l16" },
832 { "l17", QCOM_RPM_PM8058_LDO17, &pm8058_pldo, "vdd_l17_l18" },
833 { "l18", QCOM_RPM_PM8058_LDO18, &pm8058_pldo, "vdd_l17_l18" },
834 { "l19", QCOM_RPM_PM8058_LDO19, &pm8058_pldo, "vdd_l19_l20" },
835 { "l20", QCOM_RPM_PM8058_LDO20, &pm8058_pldo, "vdd_l19_l20" },
836 { "l21", QCOM_RPM_PM8058_LDO21, &pm8058_nldo, "vdd_l21" },
837 { "l22", QCOM_RPM_PM8058_LDO22, &pm8058_nldo, "vdd_l22" },
838 { "l23", QCOM_RPM_PM8058_LDO23, &pm8058_nldo, "vdd_l23_l24_l25" },
839 { "l24", QCOM_RPM_PM8058_LDO24, &pm8058_nldo, "vdd_l23_l24_l25" },
840 { "l25", QCOM_RPM_PM8058_LDO25, &pm8058_nldo, "vdd_l23_l24_l25" },
841
842 { "s0", QCOM_RPM_PM8058_SMPS0, &pm8058_smps, "vdd_s0" },
843 { "s1", QCOM_RPM_PM8058_SMPS1, &pm8058_smps, "vdd_s1" },
844 { "s2", QCOM_RPM_PM8058_SMPS2, &pm8058_smps, "vdd_s2" },
845 { "s3", QCOM_RPM_PM8058_SMPS3, &pm8058_smps, "vdd_s3" },
846 { "s4", QCOM_RPM_PM8058_SMPS4, &pm8058_smps, "vdd_s4" },
847
848 { "lvs0", QCOM_RPM_PM8058_LVS0, &pm8058_switch, "vdd_l0_l1_lvs" },
849 { "lvs1", QCOM_RPM_PM8058_LVS1, &pm8058_switch, "vdd_l0_l1_lvs" },
850
851 { "ncp", QCOM_RPM_PM8058_NCP, &pm8058_ncp, "vdd_ncp" },
852 { }
853 };
854
855 static const struct rpm_regulator_data rpm_pm8901_regulators[] = {
856 { "l0", QCOM_RPM_PM8901_LDO0, &pm8901_nldo, "vdd_l0" },
857 { "l1", QCOM_RPM_PM8901_LDO1, &pm8901_pldo, "vdd_l1" },
858 { "l2", QCOM_RPM_PM8901_LDO2, &pm8901_pldo, "vdd_l2" },
859 { "l3", QCOM_RPM_PM8901_LDO3, &pm8901_pldo, "vdd_l3" },
860 { "l4", QCOM_RPM_PM8901_LDO4, &pm8901_pldo, "vdd_l4" },
861 { "l5", QCOM_RPM_PM8901_LDO5, &pm8901_pldo, "vdd_l5" },
862 { "l6", QCOM_RPM_PM8901_LDO6, &pm8901_pldo, "vdd_l6" },
863
864 { "s0", QCOM_RPM_PM8901_SMPS0, &pm8901_ftsmps, "vdd_s0" },
865 { "s1", QCOM_RPM_PM8901_SMPS1, &pm8901_ftsmps, "vdd_s1" },
866 { "s2", QCOM_RPM_PM8901_SMPS2, &pm8901_ftsmps, "vdd_s2" },
867 { "s3", QCOM_RPM_PM8901_SMPS3, &pm8901_ftsmps, "vdd_s3" },
868 { "s4", QCOM_RPM_PM8901_SMPS4, &pm8901_ftsmps, "vdd_s4" },
869
870 { "lvs0", QCOM_RPM_PM8901_LVS0, &pm8901_switch, "lvs0_in" },
871 { "lvs1", QCOM_RPM_PM8901_LVS1, &pm8901_switch, "lvs1_in" },
872 { "lvs2", QCOM_RPM_PM8901_LVS2, &pm8901_switch, "lvs2_in" },
873 { "lvs3", QCOM_RPM_PM8901_LVS3, &pm8901_switch, "lvs3_in" },
874
875 { "mvs", QCOM_RPM_PM8901_MVS, &pm8901_switch, "mvs_in" },
876 { }
877 };
878
879 static const struct rpm_regulator_data rpm_pm8921_regulators[] = {
880 { "s1", QCOM_RPM_PM8921_SMPS1, &pm8921_smps, "vdd_s1" },
881 { "s2", QCOM_RPM_PM8921_SMPS2, &pm8921_smps, "vdd_s2" },
882 { "s3", QCOM_RPM_PM8921_SMPS3, &pm8921_smps },
883 { "s4", QCOM_RPM_PM8921_SMPS4, &pm8921_smps, "vdd_s4" },
884 { "s7", QCOM_RPM_PM8921_SMPS7, &pm8921_smps, "vdd_s7" },
885 { "s8", QCOM_RPM_PM8921_SMPS8, &pm8921_smps, "vdd_s8" },
886
887 { "l1", QCOM_RPM_PM8921_LDO1, &pm8921_nldo, "vdd_l1_l2_l12_l18" },
888 { "l2", QCOM_RPM_PM8921_LDO2, &pm8921_nldo, "vdd_l1_l2_l12_l18" },
889 { "l3", QCOM_RPM_PM8921_LDO3, &pm8921_pldo, "vdd_l3_l15_l17" },
890 { "l4", QCOM_RPM_PM8921_LDO4, &pm8921_pldo, "vdd_l4_l14" },
891 { "l5", QCOM_RPM_PM8921_LDO5, &pm8921_pldo, "vdd_l5_l8_l16" },
892 { "l6", QCOM_RPM_PM8921_LDO6, &pm8921_pldo, "vdd_l6_l7" },
893 { "l7", QCOM_RPM_PM8921_LDO7, &pm8921_pldo, "vdd_l6_l7" },
894 { "l8", QCOM_RPM_PM8921_LDO8, &pm8921_pldo, "vdd_l5_l8_l16" },
895 { "l9", QCOM_RPM_PM8921_LDO9, &pm8921_pldo, "vdd_l9_l11" },
896 { "l10", QCOM_RPM_PM8921_LDO10, &pm8921_pldo, "vdd_l10_l22" },
897 { "l11", QCOM_RPM_PM8921_LDO11, &pm8921_pldo, "vdd_l9_l11" },
898 { "l12", QCOM_RPM_PM8921_LDO12, &pm8921_nldo, "vdd_l1_l2_l12_l18" },
899 { "l14", QCOM_RPM_PM8921_LDO14, &pm8921_pldo, "vdd_l4_l14" },
900 { "l15", QCOM_RPM_PM8921_LDO15, &pm8921_pldo, "vdd_l3_l15_l17" },
901 { "l16", QCOM_RPM_PM8921_LDO16, &pm8921_pldo, "vdd_l5_l8_l16" },
902 { "l17", QCOM_RPM_PM8921_LDO17, &pm8921_pldo, "vdd_l3_l15_l17" },
903 { "l18", QCOM_RPM_PM8921_LDO18, &pm8921_nldo, "vdd_l1_l2_l12_l18" },
904 { "l21", QCOM_RPM_PM8921_LDO21, &pm8921_pldo, "vdd_l21_l23_l29" },
905 { "l22", QCOM_RPM_PM8921_LDO22, &pm8921_pldo, "vdd_l10_l22" },
906 { "l23", QCOM_RPM_PM8921_LDO23, &pm8921_pldo, "vdd_l21_l23_l29" },
907 { "l24", QCOM_RPM_PM8921_LDO24, &pm8921_nldo1200, "vdd_l24" },
908 { "l25", QCOM_RPM_PM8921_LDO25, &pm8921_nldo1200, "vdd_l25" },
909 { "l26", QCOM_RPM_PM8921_LDO26, &pm8921_nldo1200, "vdd_l26" },
910 { "l27", QCOM_RPM_PM8921_LDO27, &pm8921_nldo1200, "vdd_l27" },
911 { "l28", QCOM_RPM_PM8921_LDO28, &pm8921_nldo1200, "vdd_l28" },
912 { "l29", QCOM_RPM_PM8921_LDO29, &pm8921_pldo, "vdd_l21_l23_l29" },
913
914 { "lvs1", QCOM_RPM_PM8921_LVS1, &pm8921_switch, "vin_lvs1_3_6" },
915 { "lvs2", QCOM_RPM_PM8921_LVS2, &pm8921_switch, "vin_lvs2" },
916 { "lvs3", QCOM_RPM_PM8921_LVS3, &pm8921_switch, "vin_lvs1_3_6" },
917 { "lvs4", QCOM_RPM_PM8921_LVS4, &pm8921_switch, "vin_lvs4_5_7" },
918 { "lvs5", QCOM_RPM_PM8921_LVS5, &pm8921_switch, "vin_lvs4_5_7" },
919 { "lvs6", QCOM_RPM_PM8921_LVS6, &pm8921_switch, "vin_lvs1_3_6" },
920 { "lvs7", QCOM_RPM_PM8921_LVS7, &pm8921_switch, "vin_lvs4_5_7" },
921
922 { "usb-switch", QCOM_RPM_USB_OTG_SWITCH, &pm8921_switch, "vin_5vs" },
923 { "hdmi-switch", QCOM_RPM_HDMI_SWITCH, &pm8921_switch, "vin_5vs" },
924 { "ncp", QCOM_RPM_PM8921_NCP, &pm8921_ncp, "vdd_ncp" },
925 { }
926 };
927
928 static const struct of_device_id rpm_of_match[] = {
929 { .compatible = "qcom,rpm-pm8018-regulators",
930 .data = &rpm_pm8018_regulators },
931 { .compatible = "qcom,rpm-pm8058-regulators", .data = &rpm_pm8058_regulators },
932 { .compatible = "qcom,rpm-pm8901-regulators", .data = &rpm_pm8901_regulators },
933 { .compatible = "qcom,rpm-pm8921-regulators", .data = &rpm_pm8921_regulators },
934 { }
935 };
936 MODULE_DEVICE_TABLE(of, rpm_of_match);
937
938 static int rpm_reg_probe(struct platform_device *pdev)
939 {
940 const struct rpm_regulator_data *reg;
941 const struct of_device_id *match;
942 struct regulator_config config = { };
943 struct regulator_dev *rdev;
944 struct qcom_rpm_reg *vreg;
945 struct qcom_rpm *rpm;
946
947 rpm = dev_get_drvdata(pdev->dev.parent);
948 if (!rpm) {
949 dev_err(&pdev->dev, "unable to retrieve handle to rpm\n");
950 return -ENODEV;
951 }
952
953 match = of_match_device(rpm_of_match, &pdev->dev);
954 if (!match) {
955 dev_err(&pdev->dev, "failed to match device\n");
956 return -ENODEV;
957 }
958
959 for (reg = match->data; reg->name; reg++) {
960 vreg = devm_kmalloc(&pdev->dev, sizeof(*vreg), GFP_KERNEL);
961 if (!vreg)
962 return -ENOMEM;
963
964 memcpy(vreg, reg->template, sizeof(*vreg));
965 mutex_init(&vreg->lock);
966
967 vreg->dev = &pdev->dev;
968 vreg->resource = reg->resource;
969 vreg->rpm = rpm;
970
971 vreg->desc.id = -1;
972 vreg->desc.owner = THIS_MODULE;
973 vreg->desc.type = REGULATOR_VOLTAGE;
974 vreg->desc.name = reg->name;
975 vreg->desc.supply_name = reg->supply;
976 vreg->desc.of_match = reg->name;
977 vreg->desc.of_parse_cb = rpm_reg_of_parse;
978
979 config.dev = &pdev->dev;
980 config.driver_data = vreg;
981 rdev = devm_regulator_register(&pdev->dev, &vreg->desc, &config);
982 if (IS_ERR(rdev)) {
983 dev_err(&pdev->dev, "failed to register %s\n", reg->name);
984 return PTR_ERR(rdev);
985 }
986 }
987
988 return 0;
989 }
990
991 static struct platform_driver rpm_reg_driver = {
992 .probe = rpm_reg_probe,
993 .driver = {
994 .name = "qcom_rpm_reg",
995 .of_match_table = of_match_ptr(rpm_of_match),
996 },
997 };
998
999 static int __init rpm_reg_init(void)
1000 {
1001 return platform_driver_register(&rpm_reg_driver);
1002 }
1003 subsys_initcall(rpm_reg_init);
1004
1005 static void __exit rpm_reg_exit(void)
1006 {
1007 platform_driver_unregister(&rpm_reg_driver);
1008 }
1009 module_exit(rpm_reg_exit)
1010
1011 MODULE_DESCRIPTION("Qualcomm RPM regulator driver");
1012 MODULE_LICENSE("GPL v2");