1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/kernel.h>
14#include <linux/module.h>
15#include <linux/init.h>
16#include <linux/err.h>
17#include <linux/of.h>
18#include <linux/slab.h>
19#include <linux/platform_device.h>
20#include <linux/regulator/driver.h>
21#include <linux/regulator/machine.h>
22#include <linux/regulator/of_regulator.h>
23#include <linux/mfd/tps6586x.h>
24
25
26#define TPS6586X_SUPPLYENA 0x10
27#define TPS6586X_SUPPLYENB 0x11
28#define TPS6586X_SUPPLYENC 0x12
29#define TPS6586X_SUPPLYEND 0x13
30#define TPS6586X_SUPPLYENE 0x14
31#define TPS6586X_VCC1 0x20
32#define TPS6586X_VCC2 0x21
33#define TPS6586X_SM1V1 0x23
34#define TPS6586X_SM1V2 0x24
35#define TPS6586X_SM1SL 0x25
36#define TPS6586X_SM0V1 0x26
37#define TPS6586X_SM0V2 0x27
38#define TPS6586X_SM0SL 0x28
39#define TPS6586X_LDO2AV1 0x29
40#define TPS6586X_LDO2AV2 0x2A
41#define TPS6586X_LDO2BV1 0x2F
42#define TPS6586X_LDO2BV2 0x30
43#define TPS6586X_LDO4V1 0x32
44#define TPS6586X_LDO4V2 0x33
45
46
47#define TPS6586X_SUPPLYV1 0x41
48#define TPS6586X_SUPPLYV2 0x42
49#define TPS6586X_SUPPLYV3 0x43
50#define TPS6586X_SUPPLYV4 0x44
51#define TPS6586X_SUPPLYV5 0x45
52#define TPS6586X_SUPPLYV6 0x46
53#define TPS6586X_SMODE1 0x47
54#define TPS6586X_SMODE2 0x48
55
56struct tps6586x_regulator {
57 struct regulator_desc desc;
58
59 int enable_bit[2];
60 int enable_reg[2];
61};
62
63static struct regulator_ops tps6586x_rw_regulator_ops = {
64 .list_voltage = regulator_list_voltage_table,
65 .map_voltage = regulator_map_voltage_ascend,
66 .get_voltage_sel = regulator_get_voltage_sel_regmap,
67 .set_voltage_sel = regulator_set_voltage_sel_regmap,
68
69 .is_enabled = regulator_is_enabled_regmap,
70 .enable = regulator_enable_regmap,
71 .disable = regulator_disable_regmap,
72};
73
74static struct regulator_ops tps6586x_rw_linear_regulator_ops = {
75 .list_voltage = regulator_list_voltage_linear,
76 .get_voltage_sel = regulator_get_voltage_sel_regmap,
77 .set_voltage_sel = regulator_set_voltage_sel_regmap,
78
79 .is_enabled = regulator_is_enabled_regmap,
80 .enable = regulator_enable_regmap,
81 .disable = regulator_disable_regmap,
82};
83
84static struct regulator_ops tps6586x_ro_regulator_ops = {
85 .list_voltage = regulator_list_voltage_table,
86 .map_voltage = regulator_map_voltage_ascend,
87 .get_voltage_sel = regulator_get_voltage_sel_regmap,
88
89 .is_enabled = regulator_is_enabled_regmap,
90 .enable = regulator_enable_regmap,
91 .disable = regulator_disable_regmap,
92};
93
94static struct regulator_ops tps6586x_sys_regulator_ops = {
95};
96
97static const unsigned int tps6586x_ldo0_voltages[] = {
98 1200000, 1500000, 1800000, 2500000, 2700000, 2850000, 3100000, 3300000,
99};
100
101static const unsigned int tps6586x_ldo_voltages[] = {
102 1250000, 1500000, 1800000, 2500000, 2700000, 2850000, 3100000, 3300000,
103};
104
105static const unsigned int tps658640_rtc_voltages[] = {
106 2500000, 2850000, 3100000, 3300000,
107};
108
109#define TPS6586X_REGULATOR(_id, _ops, _pin_name, vdata, vreg, shift, nbits, \
110 ereg0, ebit0, ereg1, ebit1, goreg, gobit) \
111 .desc = { \
112 .supply_name = _pin_name, \
113 .name = "REG-" #_id, \
114 .ops = &tps6586x_## _ops ## _regulator_ops, \
115 .type = REGULATOR_VOLTAGE, \
116 .id = TPS6586X_ID_##_id, \
117 .n_voltages = ARRAY_SIZE(vdata##_voltages), \
118 .volt_table = vdata##_voltages, \
119 .owner = THIS_MODULE, \
120 .enable_reg = TPS6586X_SUPPLY##ereg0, \
121 .enable_mask = 1 << (ebit0), \
122 .vsel_reg = TPS6586X_##vreg, \
123 .vsel_mask = ((1 << (nbits)) - 1) << (shift), \
124 .apply_reg = (goreg), \
125 .apply_bit = (gobit), \
126 }, \
127 .enable_reg[0] = TPS6586X_SUPPLY##ereg0, \
128 .enable_bit[0] = (ebit0), \
129 .enable_reg[1] = TPS6586X_SUPPLY##ereg1, \
130 .enable_bit[1] = (ebit1),
131
132#define TPS6586X_REGULATOR_LINEAR(_id, _ops, _pin_name, n_volt, min_uv, \
133 uv_step, vreg, shift, nbits, ereg0, \
134 ebit0, ereg1, ebit1, goreg, gobit) \
135 .desc = { \
136 .supply_name = _pin_name, \
137 .name = "REG-" #_id, \
138 .ops = &tps6586x_## _ops ## _regulator_ops, \
139 .type = REGULATOR_VOLTAGE, \
140 .id = TPS6586X_ID_##_id, \
141 .n_voltages = n_volt, \
142 .min_uV = min_uv, \
143 .uV_step = uv_step, \
144 .owner = THIS_MODULE, \
145 .enable_reg = TPS6586X_SUPPLY##ereg0, \
146 .enable_mask = 1 << (ebit0), \
147 .vsel_reg = TPS6586X_##vreg, \
148 .vsel_mask = ((1 << (nbits)) - 1) << (shift), \
149 .apply_reg = (goreg), \
150 .apply_bit = (gobit), \
151 }, \
152 .enable_reg[0] = TPS6586X_SUPPLY##ereg0, \
153 .enable_bit[0] = (ebit0), \
154 .enable_reg[1] = TPS6586X_SUPPLY##ereg1, \
155 .enable_bit[1] = (ebit1),
156
157#define TPS6586X_LDO(_id, _pname, vdata, vreg, shift, nbits, \
158 ereg0, ebit0, ereg1, ebit1) \
159{ \
160 TPS6586X_REGULATOR(_id, rw, _pname, vdata, vreg, shift, nbits, \
161 ereg0, ebit0, ereg1, ebit1, 0, 0) \
162}
163
164#define TPS6586X_LDO_LINEAR(_id, _pname, n_volt, min_uv, uv_step, vreg, \
165 shift, nbits, ereg0, ebit0, ereg1, ebit1) \
166{ \
167 TPS6586X_REGULATOR_LINEAR(_id, rw_linear, _pname, n_volt, \
168 min_uv, uv_step, vreg, shift, nbits, \
169 ereg0, ebit0, ereg1, ebit1, 0, 0) \
170}
171
172#define TPS6586X_FIXED_LDO(_id, _pname, vdata, vreg, shift, nbits, \
173 ereg0, ebit0, ereg1, ebit1) \
174{ \
175 TPS6586X_REGULATOR(_id, ro, _pname, vdata, vreg, shift, nbits, \
176 ereg0, ebit0, ereg1, ebit1, 0, 0) \
177}
178
179#define TPS6586X_DVM(_id, _pname, n_volt, min_uv, uv_step, vreg, shift, \
180 nbits, ereg0, ebit0, ereg1, ebit1, goreg, gobit) \
181{ \
182 TPS6586X_REGULATOR_LINEAR(_id, rw_linear, _pname, n_volt, \
183 min_uv, uv_step, vreg, shift, nbits, \
184 ereg0, ebit0, ereg1, ebit1, goreg, \
185 gobit) \
186}
187
188#define TPS6586X_SYS_REGULATOR() \
189{ \
190 .desc = { \
191 .supply_name = "sys", \
192 .name = "REG-SYS", \
193 .ops = &tps6586x_sys_regulator_ops, \
194 .type = REGULATOR_VOLTAGE, \
195 .id = TPS6586X_ID_SYS, \
196 .owner = THIS_MODULE, \
197 }, \
198}
199
200static struct tps6586x_regulator tps6586x_regulator[] = {
201 TPS6586X_SYS_REGULATOR(),
202 TPS6586X_LDO(LDO_0, "vinldo01", tps6586x_ldo0, SUPPLYV1, 5, 3, ENC, 0,
203 END, 0),
204 TPS6586X_LDO(LDO_3, "vinldo23", tps6586x_ldo, SUPPLYV4, 0, 3, ENC, 2,
205 END, 2),
206 TPS6586X_LDO(LDO_5, "REG-SYS", tps6586x_ldo, SUPPLYV6, 0, 3, ENE, 6,
207 ENE, 6),
208 TPS6586X_LDO(LDO_6, "vinldo678", tps6586x_ldo, SUPPLYV3, 0, 3, ENC, 4,
209 END, 4),
210 TPS6586X_LDO(LDO_7, "vinldo678", tps6586x_ldo, SUPPLYV3, 3, 3, ENC, 5,
211 END, 5),
212 TPS6586X_LDO(LDO_8, "vinldo678", tps6586x_ldo, SUPPLYV2, 5, 3, ENC, 6,
213 END, 6),
214 TPS6586X_LDO(LDO_9, "vinldo9", tps6586x_ldo, SUPPLYV6, 3, 3, ENE, 7,
215 ENE, 7),
216 TPS6586X_LDO(LDO_RTC, "REG-SYS", tps6586x_ldo, SUPPLYV4, 3, 3, V4, 7,
217 V4, 7),
218 TPS6586X_LDO_LINEAR(LDO_1, "vinldo01", 32, 725000, 25000, SUPPLYV1,
219 0, 5, ENC, 1, END, 1),
220 TPS6586X_LDO_LINEAR(SM_2, "vin-sm2", 32, 3000000, 50000, SUPPLYV2,
221 0, 5, ENC, 7, END, 7),
222 TPS6586X_DVM(LDO_2, "vinldo23", 32, 725000, 25000, LDO2BV1, 0, 5,
223 ENA, 3, ENB, 3, TPS6586X_VCC2, BIT(6)),
224 TPS6586X_DVM(LDO_4, "vinldo4", 32, 1700000, 25000, LDO4V1, 0, 5,
225 ENC, 3, END, 3, TPS6586X_VCC1, BIT(6)),
226 TPS6586X_DVM(SM_0, "vin-sm0", 32, 725000, 25000, SM0V1, 0, 5,
227 ENA, 1, ENB, 1, TPS6586X_VCC1, BIT(2)),
228 TPS6586X_DVM(SM_1, "vin-sm1", 32, 725000, 25000, SM1V1, 0, 5,
229 ENA, 0, ENB, 0, TPS6586X_VCC1, BIT(0)),
230};
231
232static struct tps6586x_regulator tps658623_regulator[] = {
233 TPS6586X_LDO_LINEAR(SM_2, "vin-sm2", 32, 1700000, 25000, SUPPLYV2,
234 0, 5, ENC, 7, END, 7),
235};
236
237static struct tps6586x_regulator tps658640_regulator[] = {
238 TPS6586X_LDO(LDO_3, "vinldo23", tps6586x_ldo0, SUPPLYV4, 0, 3,
239 ENC, 2, END, 2),
240 TPS6586X_LDO(LDO_5, "REG-SYS", tps6586x_ldo0, SUPPLYV6, 0, 3,
241 ENE, 6, ENE, 6),
242 TPS6586X_LDO(LDO_6, "vinldo678", tps6586x_ldo0, SUPPLYV3, 0, 3,
243 ENC, 4, END, 4),
244 TPS6586X_LDO(LDO_7, "vinldo678", tps6586x_ldo0, SUPPLYV3, 3, 3,
245 ENC, 5, END, 5),
246 TPS6586X_LDO(LDO_8, "vinldo678", tps6586x_ldo0, SUPPLYV2, 5, 3,
247 ENC, 6, END, 6),
248 TPS6586X_LDO(LDO_9, "vinldo9", tps6586x_ldo0, SUPPLYV6, 3, 3,
249 ENE, 7, ENE, 7),
250 TPS6586X_LDO_LINEAR(SM_2, "vin-sm2", 32, 2150000, 50000, SUPPLYV2,
251 0, 5, ENC, 7, END, 7),
252
253 TPS6586X_FIXED_LDO(LDO_RTC, "REG-SYS", tps658640_rtc, SUPPLYV4, 3, 2,
254 V4, 7, V4, 7),
255};
256
257static struct tps6586x_regulator tps658643_regulator[] = {
258 TPS6586X_LDO_LINEAR(SM_2, "vin-sm2", 32, 1025000, 25000, SUPPLYV2,
259 0, 5, ENC, 7, END, 7),
260};
261
262
263
264
265
266
267static inline int tps6586x_regulator_preinit(struct device *parent,
268 struct tps6586x_regulator *ri)
269{
270 uint8_t val1, val2;
271 int ret;
272
273 if (ri->enable_reg[0] == ri->enable_reg[1] &&
274 ri->enable_bit[0] == ri->enable_bit[1])
275 return 0;
276
277 ret = tps6586x_read(parent, ri->enable_reg[0], &val1);
278 if (ret)
279 return ret;
280
281 ret = tps6586x_read(parent, ri->enable_reg[1], &val2);
282 if (ret)
283 return ret;
284
285 if (!(val2 & (1 << ri->enable_bit[1])))
286 return 0;
287
288
289
290
291
292 if (!(val1 & (1 << ri->enable_bit[0]))) {
293 ret = tps6586x_set_bits(parent, ri->enable_reg[0],
294 1 << ri->enable_bit[0]);
295 if (ret)
296 return ret;
297 }
298
299 return tps6586x_clr_bits(parent, ri->enable_reg[1],
300 1 << ri->enable_bit[1]);
301}
302
303static int tps6586x_regulator_set_slew_rate(struct platform_device *pdev,
304 int id, struct regulator_init_data *p)
305{
306 struct device *parent = pdev->dev.parent;
307 struct tps6586x_settings *setting = p->driver_data;
308 uint8_t reg;
309
310 if (setting == NULL)
311 return 0;
312
313 if (!(setting->slew_rate & TPS6586X_SLEW_RATE_SET))
314 return 0;
315
316
317 switch (id) {
318 case TPS6586X_ID_SM_0:
319 reg = TPS6586X_SM0SL;
320 break;
321 case TPS6586X_ID_SM_1:
322 reg = TPS6586X_SM1SL;
323 break;
324 default:
325 dev_err(&pdev->dev, "Only SM0/SM1 can set slew rate\n");
326 return -EINVAL;
327 }
328
329 return tps6586x_write(parent, reg,
330 setting->slew_rate & TPS6586X_SLEW_RATE_MASK);
331}
332
333static struct tps6586x_regulator *find_regulator_info(int id, int version)
334{
335 struct tps6586x_regulator *ri;
336 struct tps6586x_regulator *table = NULL;
337 int num;
338 int i;
339
340 switch (version) {
341 case TPS658623:
342 case TPS658624:
343 table = tps658623_regulator;
344 num = ARRAY_SIZE(tps658623_regulator);
345 break;
346 case TPS658640:
347 case TPS658640v2:
348 table = tps658640_regulator;
349 num = ARRAY_SIZE(tps658640_regulator);
350 break;
351 case TPS658643:
352 table = tps658643_regulator;
353 num = ARRAY_SIZE(tps658643_regulator);
354 break;
355 }
356
357
358 if (table) {
359 for (i = 0; i < num; i++) {
360 ri = &table[i];
361 if (ri->desc.id == id)
362 return ri;
363 }
364 }
365
366 for (i = 0; i < ARRAY_SIZE(tps6586x_regulator); i++) {
367 ri = &tps6586x_regulator[i];
368 if (ri->desc.id == id)
369 return ri;
370 }
371 return NULL;
372}
373
374#ifdef CONFIG_OF
375static struct of_regulator_match tps6586x_matches[] = {
376 { .name = "sys", .driver_data = (void *)TPS6586X_ID_SYS },
377 { .name = "sm0", .driver_data = (void *)TPS6586X_ID_SM_0 },
378 { .name = "sm1", .driver_data = (void *)TPS6586X_ID_SM_1 },
379 { .name = "sm2", .driver_data = (void *)TPS6586X_ID_SM_2 },
380 { .name = "ldo0", .driver_data = (void *)TPS6586X_ID_LDO_0 },
381 { .name = "ldo1", .driver_data = (void *)TPS6586X_ID_LDO_1 },
382 { .name = "ldo2", .driver_data = (void *)TPS6586X_ID_LDO_2 },
383 { .name = "ldo3", .driver_data = (void *)TPS6586X_ID_LDO_3 },
384 { .name = "ldo4", .driver_data = (void *)TPS6586X_ID_LDO_4 },
385 { .name = "ldo5", .driver_data = (void *)TPS6586X_ID_LDO_5 },
386 { .name = "ldo6", .driver_data = (void *)TPS6586X_ID_LDO_6 },
387 { .name = "ldo7", .driver_data = (void *)TPS6586X_ID_LDO_7 },
388 { .name = "ldo8", .driver_data = (void *)TPS6586X_ID_LDO_8 },
389 { .name = "ldo9", .driver_data = (void *)TPS6586X_ID_LDO_9 },
390 { .name = "ldo_rtc", .driver_data = (void *)TPS6586X_ID_LDO_RTC },
391};
392
393static struct tps6586x_platform_data *tps6586x_parse_regulator_dt(
394 struct platform_device *pdev,
395 struct of_regulator_match **tps6586x_reg_matches)
396{
397 const unsigned int num = ARRAY_SIZE(tps6586x_matches);
398 struct device_node *np = pdev->dev.parent->of_node;
399 struct device_node *regs;
400 const char *sys_rail = NULL;
401 unsigned int i;
402 struct tps6586x_platform_data *pdata;
403 int err;
404
405 regs = of_get_child_by_name(np, "regulators");
406 if (!regs) {
407 dev_err(&pdev->dev, "regulator node not found\n");
408 return NULL;
409 }
410
411 err = of_regulator_match(&pdev->dev, regs, tps6586x_matches, num);
412 of_node_put(regs);
413 if (err < 0) {
414 dev_err(&pdev->dev, "Regulator match failed, e %d\n", err);
415 return NULL;
416 }
417
418 pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
419 if (!pdata)
420 return NULL;
421
422 for (i = 0; i < num; i++) {
423 uintptr_t id;
424 if (!tps6586x_matches[i].init_data)
425 continue;
426
427 pdata->reg_init_data[i] = tps6586x_matches[i].init_data;
428 id = (uintptr_t)tps6586x_matches[i].driver_data;
429 if (id == TPS6586X_ID_SYS)
430 sys_rail = pdata->reg_init_data[i]->constraints.name;
431
432 if ((id == TPS6586X_ID_LDO_5) || (id == TPS6586X_ID_LDO_RTC))
433 pdata->reg_init_data[i]->supply_regulator = sys_rail;
434 }
435 *tps6586x_reg_matches = tps6586x_matches;
436 return pdata;
437}
438#else
439static struct tps6586x_platform_data *tps6586x_parse_regulator_dt(
440 struct platform_device *pdev,
441 struct of_regulator_match **tps6586x_reg_matches)
442{
443 *tps6586x_reg_matches = NULL;
444 return NULL;
445}
446#endif
447
448static int tps6586x_regulator_probe(struct platform_device *pdev)
449{
450 struct tps6586x_regulator *ri = NULL;
451 struct regulator_config config = { };
452 struct regulator_dev *rdev;
453 struct regulator_init_data *reg_data;
454 struct tps6586x_platform_data *pdata;
455 struct of_regulator_match *tps6586x_reg_matches = NULL;
456 int version;
457 int id;
458 int err;
459
460 dev_dbg(&pdev->dev, "Probing regulator\n");
461
462 pdata = dev_get_platdata(pdev->dev.parent);
463 if ((!pdata) && (pdev->dev.parent->of_node))
464 pdata = tps6586x_parse_regulator_dt(pdev,
465 &tps6586x_reg_matches);
466
467 if (!pdata) {
468 dev_err(&pdev->dev, "Platform data not available, exiting\n");
469 return -ENODEV;
470 }
471
472 version = tps6586x_get_version(pdev->dev.parent);
473
474 for (id = 0; id < TPS6586X_ID_MAX_REGULATOR; ++id) {
475 reg_data = pdata->reg_init_data[id];
476
477 ri = find_regulator_info(id, version);
478
479 if (!ri) {
480 dev_err(&pdev->dev, "invalid regulator ID specified\n");
481 return -EINVAL;
482 }
483
484 err = tps6586x_regulator_preinit(pdev->dev.parent, ri);
485 if (err) {
486 dev_err(&pdev->dev,
487 "regulator %d preinit failed, e %d\n", id, err);
488 return err;
489 }
490
491 config.dev = pdev->dev.parent;
492 config.init_data = reg_data;
493 config.driver_data = ri;
494
495 if (tps6586x_reg_matches)
496 config.of_node = tps6586x_reg_matches[id].of_node;
497
498 rdev = devm_regulator_register(&pdev->dev, &ri->desc, &config);
499 if (IS_ERR(rdev)) {
500 dev_err(&pdev->dev, "failed to register regulator %s\n",
501 ri->desc.name);
502 return PTR_ERR(rdev);
503 }
504
505 if (reg_data) {
506 err = tps6586x_regulator_set_slew_rate(pdev, id,
507 reg_data);
508 if (err < 0) {
509 dev_err(&pdev->dev,
510 "Slew rate config failed, e %d\n", err);
511 return err;
512 }
513 }
514 }
515
516 platform_set_drvdata(pdev, rdev);
517 return 0;
518}
519
520static struct platform_driver tps6586x_regulator_driver = {
521 .driver = {
522 .name = "tps6586x-regulator",
523 },
524 .probe = tps6586x_regulator_probe,
525};
526
527static int __init tps6586x_regulator_init(void)
528{
529 return platform_driver_register(&tps6586x_regulator_driver);
530}
531subsys_initcall(tps6586x_regulator_init);
532
533static void __exit tps6586x_regulator_exit(void)
534{
535 platform_driver_unregister(&tps6586x_regulator_driver);
536}
537module_exit(tps6586x_regulator_exit);
538
539MODULE_LICENSE("GPL");
540MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
541MODULE_DESCRIPTION("Regulator Driver for TI TPS6586X PMIC");
542MODULE_ALIAS("platform:tps6586x-regulator");
543
