xref: /linux/drivers/regulator/qcom_rpm-regulator.c (revision 52990390f91c1c39ca742fc8f390b29891d95127)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (c) 2014, Sony Mobile Communications AB.
4  * Copyright (c) 2012-2013, The Linux Foundation. All rights reserved.
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;		/* used if voltage is in mV */
28 	struct request_member uV;		/* used if voltage is in uV */
29 	struct request_member ip;		/* peak current in mA */
30 	struct request_member pd;		/* pull down enable */
31 	struct request_member ia;		/* average current in mA */
32 	struct request_member fm;		/* force mode */
33 	struct request_member pm;		/* power mode */
34 	struct request_member pc;		/* pin control */
35 	struct request_member pf;		/* pin function */
36 	struct request_member enable_state;	/* NCP and switch */
37 	struct request_member comp_mode;	/* NCP */
38 	struct request_member freq;		/* frequency: NCP and SMPS */
39 	struct request_member freq_clk_src;	/* clock source: SMPS */
40 	struct request_member hpm;		/* switch: control OCP and SS */
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  * Physically available PMIC regulator voltage ranges
150  */
151 static const struct 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 linear_range nldo_ranges[] = {
158 	REGULATOR_LINEAR_RANGE( 750000,   0,  63, 12500),
159 };
160 
161 static const struct 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 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 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 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 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 const 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 const 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 const 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  * PM8018 regulators
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  * PM8058 regulators
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  * PM8901 regulators
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  * PM8921 regulators
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_ncp = {
608 	.desc.linear_ranges = ncp_ranges,
609 	.desc.n_linear_ranges = ARRAY_SIZE(ncp_ranges),
610 	.desc.n_voltages = 32,
611 	.desc.ops = &uV_ops,
612 	.parts = &rpm8960_ncp_parts,
613 };
614 
615 static const struct qcom_rpm_reg pm8921_switch = {
616 	.desc.ops = &switch_ops,
617 	.parts = &rpm8960_switch_parts,
618 };
619 
620 static const struct qcom_rpm_reg smb208_smps = {
621 	.desc.linear_ranges = smb208_ranges,
622 	.desc.n_linear_ranges = ARRAY_SIZE(smb208_ranges),
623 	.desc.n_voltages = 235,
624 	.desc.ops = &uV_ops,
625 	.parts = &rpm8960_smps_parts,
626 	.supports_force_mode_auto = false,
627 	.supports_force_mode_bypass = false,
628 };
629 
630 static int rpm_reg_set(struct qcom_rpm_reg *vreg,
631 		       const struct request_member *req,
632 		       const int value)
633 {
634 	if (req->mask == 0 || (value << req->shift) & ~req->mask)
635 		return -EINVAL;
636 
637 	vreg->val[req->word] &= ~req->mask;
638 	vreg->val[req->word] |= value << req->shift;
639 
640 	return 0;
641 }
642 
643 static int rpm_reg_of_parse_freq(struct device *dev,
644 				 struct device_node *node,
645 				 struct qcom_rpm_reg *vreg)
646 {
647 	static const int freq_table[] = {
648 		19200000, 9600000, 6400000, 4800000, 3840000, 3200000, 2740000,
649 		2400000, 2130000, 1920000, 1750000, 1600000, 1480000, 1370000,
650 		1280000, 1200000,
651 
652 	};
653 	const char *key;
654 	u32 freq;
655 	int ret;
656 	int i;
657 
658 	key = "qcom,switch-mode-frequency";
659 	ret = of_property_read_u32(node, key, &freq);
660 	if (ret) {
661 		dev_err(dev, "regulator requires %s property\n", key);
662 		return -EINVAL;
663 	}
664 
665 	for (i = 0; i < ARRAY_SIZE(freq_table); i++) {
666 		if (freq == freq_table[i]) {
667 			rpm_reg_set(vreg, &vreg->parts->freq, i + 1);
668 			return 0;
669 		}
670 	}
671 
672 	dev_err(dev, "invalid frequency %d\n", freq);
673 	return -EINVAL;
674 }
675 
676 static int rpm_reg_of_parse(struct device_node *node,
677 			    const struct regulator_desc *desc,
678 			    struct regulator_config *config)
679 {
680 	struct qcom_rpm_reg *vreg = config->driver_data;
681 	struct device *dev = config->dev;
682 	const char *key;
683 	u32 force_mode;
684 	bool pwm;
685 	u32 val;
686 	int ret;
687 
688 	key = "bias-pull-down";
689 	if (of_property_read_bool(node, key)) {
690 		ret = rpm_reg_set(vreg, &vreg->parts->pd, 1);
691 		if (ret) {
692 			dev_err(dev, "%s is invalid", key);
693 			return ret;
694 		}
695 	}
696 
697 	if (vreg->parts->freq.mask) {
698 		ret = rpm_reg_of_parse_freq(dev, node, vreg);
699 		if (ret < 0)
700 			return ret;
701 	}
702 
703 	if (vreg->parts->pm.mask) {
704 		key = "qcom,power-mode-hysteretic";
705 		pwm = !of_property_read_bool(node, key);
706 
707 		ret = rpm_reg_set(vreg, &vreg->parts->pm, pwm);
708 		if (ret) {
709 			dev_err(dev, "failed to set power mode\n");
710 			return ret;
711 		}
712 	}
713 
714 	if (vreg->parts->fm.mask) {
715 		force_mode = -1;
716 
717 		key = "qcom,force-mode";
718 		ret = of_property_read_u32(node, key, &val);
719 		if (ret == -EINVAL) {
720 			val = QCOM_RPM_FORCE_MODE_NONE;
721 		} else if (ret < 0) {
722 			dev_err(dev, "failed to read %s\n", key);
723 			return ret;
724 		}
725 
726 		/*
727 		 * If force-mode is encoded as 2 bits then the
728 		 * possible register values are:
729 		 * NONE, LPM, HPM
730 		 * otherwise:
731 		 * NONE, LPM, AUTO, HPM, BYPASS
732 		 */
733 		switch (val) {
734 		case QCOM_RPM_FORCE_MODE_NONE:
735 			force_mode = 0;
736 			break;
737 		case QCOM_RPM_FORCE_MODE_LPM:
738 			force_mode = 1;
739 			break;
740 		case QCOM_RPM_FORCE_MODE_HPM:
741 			if (FORCE_MODE_IS_2_BITS(vreg))
742 				force_mode = 2;
743 			else
744 				force_mode = 3;
745 			break;
746 		case QCOM_RPM_FORCE_MODE_AUTO:
747 			if (vreg->supports_force_mode_auto)
748 				force_mode = 2;
749 			break;
750 		case QCOM_RPM_FORCE_MODE_BYPASS:
751 			if (vreg->supports_force_mode_bypass)
752 				force_mode = 4;
753 			break;
754 		}
755 
756 		if (force_mode == -1) {
757 			dev_err(dev, "invalid force mode\n");
758 			return -EINVAL;
759 		}
760 
761 		ret = rpm_reg_set(vreg, &vreg->parts->fm, force_mode);
762 		if (ret) {
763 			dev_err(dev, "failed to set force mode\n");
764 			return ret;
765 		}
766 	}
767 
768 	return 0;
769 }
770 
771 struct rpm_regulator_data {
772 	const char *name;
773 	int resource;
774 	const struct qcom_rpm_reg *template;
775 	const char *supply;
776 };
777 
778 static const struct rpm_regulator_data rpm_pm8018_regulators[] = {
779 	{ "s1",  QCOM_RPM_PM8018_SMPS1, &pm8018_smps, "vdd_s1" },
780 	{ "s2",  QCOM_RPM_PM8018_SMPS2, &pm8018_smps, "vdd_s2" },
781 	{ "s3",  QCOM_RPM_PM8018_SMPS3, &pm8018_smps, "vdd_s3" },
782 	{ "s4",  QCOM_RPM_PM8018_SMPS4, &pm8018_smps, "vdd_s4" },
783 	{ "s5",  QCOM_RPM_PM8018_SMPS5, &pm8018_smps, "vdd_s5" },
784 
785 	{ "l2",  QCOM_RPM_PM8018_LDO2,  &pm8018_pldo, "vdd_l2" },
786 	{ "l3",  QCOM_RPM_PM8018_LDO3,  &pm8018_pldo, "vdd_l3" },
787 	{ "l4",  QCOM_RPM_PM8018_LDO4,  &pm8018_pldo, "vdd_l4" },
788 	{ "l5",  QCOM_RPM_PM8018_LDO5,  &pm8018_pldo, "vdd_l5" },
789 	{ "l6",  QCOM_RPM_PM8018_LDO6,  &pm8018_pldo, "vdd_l7" },
790 	{ "l7",  QCOM_RPM_PM8018_LDO7,  &pm8018_pldo, "vdd_l7" },
791 	{ "l8",  QCOM_RPM_PM8018_LDO8,  &pm8018_nldo, "vdd_l8" },
792 	{ "l9",  QCOM_RPM_PM8018_LDO9,  &pm8921_nldo1200,
793 						      "vdd_l9_l10_l11_l12" },
794 	{ "l10", QCOM_RPM_PM8018_LDO10, &pm8018_nldo, "vdd_l9_l10_l11_l12" },
795 	{ "l11", QCOM_RPM_PM8018_LDO11, &pm8018_nldo, "vdd_l9_l10_l11_l12" },
796 	{ "l12", QCOM_RPM_PM8018_LDO12, &pm8018_nldo, "vdd_l9_l10_l11_l12" },
797 	{ "l14", QCOM_RPM_PM8018_LDO14, &pm8018_pldo, "vdd_l14" },
798 
799 	{ "lvs1", QCOM_RPM_PM8018_LVS1, &pm8018_switch, "lvs1_in" },
800 
801 	{ }
802 };
803 
804 static const struct rpm_regulator_data rpm_pm8058_regulators[] = {
805 	{ "s0",   QCOM_RPM_PM8058_SMPS0,  &pm8058_smps, "vdd_s0" },
806 	{ "s1",   QCOM_RPM_PM8058_SMPS1,  &pm8058_smps, "vdd_s1" },
807 	{ "s2",   QCOM_RPM_PM8058_SMPS2,  &pm8058_smps, "vdd_s2" },
808 	{ "s3",   QCOM_RPM_PM8058_SMPS3,  &pm8058_smps, "vdd_s3" },
809 	{ "s4",   QCOM_RPM_PM8058_SMPS4,  &pm8058_smps, "vdd_s4" },
810 
811 	{ "l0",   QCOM_RPM_PM8058_LDO0,   &pm8058_nldo, "vdd_l0_l1_lvs"	},
812 	{ "l1",   QCOM_RPM_PM8058_LDO1,   &pm8058_nldo, "vdd_l0_l1_lvs" },
813 	{ "l2",   QCOM_RPM_PM8058_LDO2,   &pm8058_pldo, "vdd_l2_l11_l12" },
814 	{ "l3",   QCOM_RPM_PM8058_LDO3,   &pm8058_pldo, "vdd_l3_l4_l5" },
815 	{ "l4",   QCOM_RPM_PM8058_LDO4,   &pm8058_pldo, "vdd_l3_l4_l5" },
816 	{ "l5",   QCOM_RPM_PM8058_LDO5,   &pm8058_pldo, "vdd_l3_l4_l5" },
817 	{ "l6",   QCOM_RPM_PM8058_LDO6,   &pm8058_pldo, "vdd_l6_l7" },
818 	{ "l7",   QCOM_RPM_PM8058_LDO7,   &pm8058_pldo, "vdd_l6_l7" },
819 	{ "l8",   QCOM_RPM_PM8058_LDO8,   &pm8058_pldo, "vdd_l8" },
820 	{ "l9",   QCOM_RPM_PM8058_LDO9,   &pm8058_pldo, "vdd_l9" },
821 	{ "l10",  QCOM_RPM_PM8058_LDO10,  &pm8058_pldo, "vdd_l10" },
822 	{ "l11",  QCOM_RPM_PM8058_LDO11,  &pm8058_pldo, "vdd_l2_l11_l12" },
823 	{ "l12",  QCOM_RPM_PM8058_LDO12,  &pm8058_pldo, "vdd_l2_l11_l12" },
824 	{ "l13",  QCOM_RPM_PM8058_LDO13,  &pm8058_pldo, "vdd_l13_l16" },
825 	{ "l14",  QCOM_RPM_PM8058_LDO14,  &pm8058_pldo, "vdd_l14_l15" },
826 	{ "l15",  QCOM_RPM_PM8058_LDO15,  &pm8058_pldo, "vdd_l14_l15" },
827 	{ "l16",  QCOM_RPM_PM8058_LDO16,  &pm8058_pldo, "vdd_l13_l16" },
828 	{ "l17",  QCOM_RPM_PM8058_LDO17,  &pm8058_pldo, "vdd_l17_l18" },
829 	{ "l18",  QCOM_RPM_PM8058_LDO18,  &pm8058_pldo, "vdd_l17_l18" },
830 	{ "l19",  QCOM_RPM_PM8058_LDO19,  &pm8058_pldo, "vdd_l19_l20" },
831 	{ "l20",  QCOM_RPM_PM8058_LDO20,  &pm8058_pldo, "vdd_l19_l20" },
832 	{ "l21",  QCOM_RPM_PM8058_LDO21,  &pm8058_nldo, "vdd_l21" },
833 	{ "l22",  QCOM_RPM_PM8058_LDO22,  &pm8058_nldo, "vdd_l22" },
834 	{ "l23",  QCOM_RPM_PM8058_LDO23,  &pm8058_nldo, "vdd_l23_l24_l25" },
835 	{ "l24",  QCOM_RPM_PM8058_LDO24,  &pm8058_nldo, "vdd_l23_l24_l25" },
836 	{ "l25",  QCOM_RPM_PM8058_LDO25,  &pm8058_nldo, "vdd_l23_l24_l25" },
837 
838 	{ "lvs0", QCOM_RPM_PM8058_LVS0, &pm8058_switch, "vdd_l0_l1_lvs" },
839 	{ "lvs1", QCOM_RPM_PM8058_LVS1, &pm8058_switch, "vdd_l0_l1_lvs" },
840 
841 	{ "ncp",  QCOM_RPM_PM8058_NCP, &pm8058_ncp, "vdd_ncp" },
842 	{ }
843 };
844 
845 static const struct rpm_regulator_data rpm_pm8901_regulators[] = {
846 	{ "s0",   QCOM_RPM_PM8901_SMPS0, &pm8901_ftsmps, "vdd_s0" },
847 	{ "s1",   QCOM_RPM_PM8901_SMPS1, &pm8901_ftsmps, "vdd_s1" },
848 	{ "s2",   QCOM_RPM_PM8901_SMPS2, &pm8901_ftsmps, "vdd_s2" },
849 	{ "s3",   QCOM_RPM_PM8901_SMPS3, &pm8901_ftsmps, "vdd_s3" },
850 	{ "s4",   QCOM_RPM_PM8901_SMPS4, &pm8901_ftsmps, "vdd_s4" },
851 
852 	{ "l0",   QCOM_RPM_PM8901_LDO0, &pm8901_nldo, "vdd_l0" },
853 	{ "l1",   QCOM_RPM_PM8901_LDO1, &pm8901_pldo, "vdd_l1" },
854 	{ "l2",   QCOM_RPM_PM8901_LDO2, &pm8901_pldo, "vdd_l2" },
855 	{ "l3",   QCOM_RPM_PM8901_LDO3, &pm8901_pldo, "vdd_l3" },
856 	{ "l4",   QCOM_RPM_PM8901_LDO4, &pm8901_pldo, "vdd_l4" },
857 	{ "l5",   QCOM_RPM_PM8901_LDO5, &pm8901_pldo, "vdd_l5" },
858 	{ "l6",   QCOM_RPM_PM8901_LDO6, &pm8901_pldo, "vdd_l6" },
859 
860 	{ "lvs0", QCOM_RPM_PM8901_LVS0, &pm8901_switch, "lvs0_in" },
861 	{ "lvs1", QCOM_RPM_PM8901_LVS1, &pm8901_switch, "lvs1_in" },
862 	{ "lvs2", QCOM_RPM_PM8901_LVS2, &pm8901_switch, "lvs2_in" },
863 	{ "lvs3", QCOM_RPM_PM8901_LVS3, &pm8901_switch, "lvs3_in" },
864 
865 	{ "mvs", QCOM_RPM_PM8901_MVS, &pm8901_switch, "mvs_in" },
866 	{ }
867 };
868 
869 static const struct rpm_regulator_data rpm_pm8921_regulators[] = {
870 	{ "s1",  QCOM_RPM_PM8921_SMPS1, &pm8921_smps, "vdd_s1" },
871 	{ "s2",  QCOM_RPM_PM8921_SMPS2, &pm8921_smps, "vdd_s2" },
872 	{ "s3",  QCOM_RPM_PM8921_SMPS3, &pm8921_smps },
873 	{ "s4",  QCOM_RPM_PM8921_SMPS4, &pm8921_smps, "vdd_s4" },
874 	{ "s7",  QCOM_RPM_PM8921_SMPS7, &pm8921_smps, "vdd_s7" },
875 	{ "s8",  QCOM_RPM_PM8921_SMPS8, &pm8921_smps, "vdd_s8"  },
876 
877 	{ "l1",  QCOM_RPM_PM8921_LDO1, &pm8921_nldo, "vdd_l1_l2_l12_l18" },
878 	{ "l2",  QCOM_RPM_PM8921_LDO2, &pm8921_nldo, "vdd_l1_l2_l12_l18" },
879 	{ "l3",  QCOM_RPM_PM8921_LDO3, &pm8921_pldo, "vdd_l3_l15_l17" },
880 	{ "l4",  QCOM_RPM_PM8921_LDO4, &pm8921_pldo, "vdd_l4_l14" },
881 	{ "l5",  QCOM_RPM_PM8921_LDO5, &pm8921_pldo, "vdd_l5_l8_l16" },
882 	{ "l6",  QCOM_RPM_PM8921_LDO6, &pm8921_pldo, "vdd_l6_l7" },
883 	{ "l7",  QCOM_RPM_PM8921_LDO7, &pm8921_pldo, "vdd_l6_l7" },
884 	{ "l8",  QCOM_RPM_PM8921_LDO8, &pm8921_pldo, "vdd_l5_l8_l16" },
885 	{ "l9",  QCOM_RPM_PM8921_LDO9, &pm8921_pldo, "vdd_l9_l11" },
886 	{ "l10", QCOM_RPM_PM8921_LDO10, &pm8921_pldo, "vdd_l10_l22" },
887 	{ "l11", QCOM_RPM_PM8921_LDO11, &pm8921_pldo, "vdd_l9_l11" },
888 	{ "l12", QCOM_RPM_PM8921_LDO12, &pm8921_nldo, "vdd_l1_l2_l12_l18" },
889 	{ "l14", QCOM_RPM_PM8921_LDO14, &pm8921_pldo, "vdd_l4_l14" },
890 	{ "l15", QCOM_RPM_PM8921_LDO15, &pm8921_pldo, "vdd_l3_l15_l17" },
891 	{ "l16", QCOM_RPM_PM8921_LDO16, &pm8921_pldo, "vdd_l5_l8_l16" },
892 	{ "l17", QCOM_RPM_PM8921_LDO17, &pm8921_pldo, "vdd_l3_l15_l17" },
893 	{ "l18", QCOM_RPM_PM8921_LDO18, &pm8921_nldo, "vdd_l1_l2_l12_l18" },
894 	{ "l21", QCOM_RPM_PM8921_LDO21, &pm8921_pldo, "vdd_l21_l23_l29" },
895 	{ "l22", QCOM_RPM_PM8921_LDO22, &pm8921_pldo, "vdd_l10_l22" },
896 	{ "l23", QCOM_RPM_PM8921_LDO23, &pm8921_pldo, "vdd_l21_l23_l29" },
897 	{ "l24", QCOM_RPM_PM8921_LDO24, &pm8921_nldo1200, "vdd_l24" },
898 	{ "l25", QCOM_RPM_PM8921_LDO25, &pm8921_nldo1200, "vdd_l25" },
899 	{ "l26", QCOM_RPM_PM8921_LDO26, &pm8921_nldo1200, "vdd_l26" },
900 	{ "l27", QCOM_RPM_PM8921_LDO27, &pm8921_nldo1200, "vdd_l27" },
901 	{ "l28", QCOM_RPM_PM8921_LDO28, &pm8921_nldo1200, "vdd_l28" },
902 	{ "l29", QCOM_RPM_PM8921_LDO29, &pm8921_pldo, "vdd_l21_l23_l29" },
903 
904 	{ "lvs1", QCOM_RPM_PM8921_LVS1, &pm8921_switch, "vin_lvs1_3_6" },
905 	{ "lvs2", QCOM_RPM_PM8921_LVS2, &pm8921_switch, "vin_lvs2" },
906 	{ "lvs3", QCOM_RPM_PM8921_LVS3, &pm8921_switch, "vin_lvs1_3_6" },
907 	{ "lvs4", QCOM_RPM_PM8921_LVS4, &pm8921_switch, "vin_lvs4_5_7" },
908 	{ "lvs5", QCOM_RPM_PM8921_LVS5, &pm8921_switch, "vin_lvs4_5_7" },
909 	{ "lvs6", QCOM_RPM_PM8921_LVS6, &pm8921_switch, "vin_lvs1_3_6" },
910 	{ "lvs7", QCOM_RPM_PM8921_LVS7, &pm8921_switch, "vin_lvs4_5_7" },
911 
912 	{ "usb-switch", QCOM_RPM_USB_OTG_SWITCH, &pm8921_switch, "vin_5vs" },
913 	{ "hdmi-switch", QCOM_RPM_HDMI_SWITCH, &pm8921_switch, "vin_5vs" },
914 	{ "ncp", QCOM_RPM_PM8921_NCP, &pm8921_ncp, "vdd_ncp" },
915 	{ }
916 };
917 
918 static const struct rpm_regulator_data rpm_smb208_regulators[] = {
919 	{ "s1a",  QCOM_RPM_SMB208_S1a, &smb208_smps, "vin_s1a" },
920 	{ "s1b",  QCOM_RPM_SMB208_S1b, &smb208_smps, "vin_s1b" },
921 	{ "s2a",  QCOM_RPM_SMB208_S2a, &smb208_smps, "vin_s2a" },
922 	{ "s2b",  QCOM_RPM_SMB208_S2b, &smb208_smps, "vin_s2b" },
923 	{ }
924 };
925 
926 static const struct of_device_id rpm_of_match[] = {
927 	{ .compatible = "qcom,rpm-pm8018-regulators",
928 		.data = &rpm_pm8018_regulators },
929 	{ .compatible = "qcom,rpm-pm8058-regulators", .data = &rpm_pm8058_regulators },
930 	{ .compatible = "qcom,rpm-pm8901-regulators", .data = &rpm_pm8901_regulators },
931 	{ .compatible = "qcom,rpm-pm8921-regulators", .data = &rpm_pm8921_regulators },
932 	{ .compatible = "qcom,rpm-smb208-regulators", .data = &rpm_smb208_regulators },
933 	{ }
934 };
935 MODULE_DEVICE_TABLE(of, rpm_of_match);
936 
937 static int rpm_reg_probe(struct platform_device *pdev)
938 {
939 	const struct rpm_regulator_data *reg;
940 	const struct of_device_id *match;
941 	struct regulator_config config = { };
942 	struct regulator_dev *rdev;
943 	struct qcom_rpm_reg *vreg;
944 	struct qcom_rpm *rpm;
945 
946 	rpm = dev_get_drvdata(pdev->dev.parent);
947 	if (!rpm) {
948 		dev_err(&pdev->dev, "unable to retrieve handle to rpm\n");
949 		return -ENODEV;
950 	}
951 
952 	match = of_match_device(rpm_of_match, &pdev->dev);
953 	if (!match) {
954 		dev_err(&pdev->dev, "failed to match device\n");
955 		return -ENODEV;
956 	}
957 
958 	for (reg = match->data; reg->name; reg++) {
959 		vreg = devm_kmalloc(&pdev->dev, sizeof(*vreg), GFP_KERNEL);
960 		if (!vreg)
961 			return -ENOMEM;
962 
963 		memcpy(vreg, reg->template, sizeof(*vreg));
964 		mutex_init(&vreg->lock);
965 
966 		vreg->dev = &pdev->dev;
967 		vreg->resource = reg->resource;
968 		vreg->rpm = rpm;
969 
970 		vreg->desc.id = -1;
971 		vreg->desc.owner = THIS_MODULE;
972 		vreg->desc.type = REGULATOR_VOLTAGE;
973 		vreg->desc.name = reg->name;
974 		vreg->desc.supply_name = reg->supply;
975 		vreg->desc.of_match = reg->name;
976 		vreg->desc.of_parse_cb = rpm_reg_of_parse;
977 
978 		config.dev = &pdev->dev;
979 		config.driver_data = vreg;
980 		rdev = devm_regulator_register(&pdev->dev, &vreg->desc, &config);
981 		if (IS_ERR(rdev)) {
982 			dev_err(&pdev->dev, "failed to register %s\n", reg->name);
983 			return PTR_ERR(rdev);
984 		}
985 	}
986 
987 	return 0;
988 }
989 
990 static struct platform_driver rpm_reg_driver = {
991 	.probe          = rpm_reg_probe,
992 	.driver  = {
993 		.name  = "qcom_rpm_reg",
994 		.probe_type = PROBE_PREFER_ASYNCHRONOUS,
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");
1013