Loading...
1/*
2 * Regulator Driver for Freescale MC13892 PMIC
3 *
4 * Copyright 2010 Yong Shen <yong.shen@linaro.org>
5 *
6 * Based on draft driver from Arnaud Patard <arnaud.patard@rtp-net.org>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
11 */
12
13#include <linux/mfd/mc13892.h>
14#include <linux/regulator/machine.h>
15#include <linux/regulator/driver.h>
16#include <linux/platform_device.h>
17#include <linux/kernel.h>
18#include <linux/slab.h>
19#include <linux/init.h>
20#include <linux/err.h>
21#include <linux/module.h>
22#include "mc13xxx.h"
23
24#define MC13892_REVISION 7
25
26#define MC13892_POWERCTL0 13
27#define MC13892_POWERCTL0_USEROFFSPI 3
28#define MC13892_POWERCTL0_VCOINCELLVSEL 20
29#define MC13892_POWERCTL0_VCOINCELLVSEL_M (7<<20)
30#define MC13892_POWERCTL0_VCOINCELLEN (1<<23)
31
32#define MC13892_SWITCHERS0_SWxHI (1<<23)
33
34#define MC13892_SWITCHERS0 24
35#define MC13892_SWITCHERS0_SW1VSEL 0
36#define MC13892_SWITCHERS0_SW1VSEL_M (0x1f<<0)
37#define MC13892_SWITCHERS0_SW1HI (1<<23)
38#define MC13892_SWITCHERS0_SW1EN 0
39
40#define MC13892_SWITCHERS1 25
41#define MC13892_SWITCHERS1_SW2VSEL 0
42#define MC13892_SWITCHERS1_SW2VSEL_M (0x1f<<0)
43#define MC13892_SWITCHERS1_SW2HI (1<<23)
44#define MC13892_SWITCHERS1_SW2EN 0
45
46#define MC13892_SWITCHERS2 26
47#define MC13892_SWITCHERS2_SW3VSEL 0
48#define MC13892_SWITCHERS2_SW3VSEL_M (0x1f<<0)
49#define MC13892_SWITCHERS2_SW3HI (1<<23)
50#define MC13892_SWITCHERS2_SW3EN 0
51
52#define MC13892_SWITCHERS3 27
53#define MC13892_SWITCHERS3_SW4VSEL 0
54#define MC13892_SWITCHERS3_SW4VSEL_M (0x1f<<0)
55#define MC13892_SWITCHERS3_SW4HI (1<<23)
56#define MC13892_SWITCHERS3_SW4EN 0
57
58#define MC13892_SWITCHERS4 28
59#define MC13892_SWITCHERS4_SW1MODE 0
60#define MC13892_SWITCHERS4_SW1MODE_AUTO (8<<0)
61#define MC13892_SWITCHERS4_SW1MODE_M (0xf<<0)
62#define MC13892_SWITCHERS4_SW2MODE 10
63#define MC13892_SWITCHERS4_SW2MODE_AUTO (8<<10)
64#define MC13892_SWITCHERS4_SW2MODE_M (0xf<<10)
65
66#define MC13892_SWITCHERS5 29
67#define MC13892_SWITCHERS5_SW3MODE 0
68#define MC13892_SWITCHERS5_SW3MODE_AUTO (8<<0)
69#define MC13892_SWITCHERS5_SW3MODE_M (0xf<<0)
70#define MC13892_SWITCHERS5_SW4MODE 8
71#define MC13892_SWITCHERS5_SW4MODE_AUTO (8<<8)
72#define MC13892_SWITCHERS5_SW4MODE_M (0xf<<8)
73#define MC13892_SWITCHERS5_SWBSTEN (1<<20)
74
75#define MC13892_REGULATORSETTING0 30
76#define MC13892_REGULATORSETTING0_VGEN1VSEL 0
77#define MC13892_REGULATORSETTING0_VDIGVSEL 4
78#define MC13892_REGULATORSETTING0_VGEN2VSEL 6
79#define MC13892_REGULATORSETTING0_VPLLVSEL 9
80#define MC13892_REGULATORSETTING0_VUSB2VSEL 11
81#define MC13892_REGULATORSETTING0_VGEN3VSEL 14
82#define MC13892_REGULATORSETTING0_VCAMVSEL 16
83
84#define MC13892_REGULATORSETTING0_VGEN1VSEL_M (3<<0)
85#define MC13892_REGULATORSETTING0_VDIGVSEL_M (3<<4)
86#define MC13892_REGULATORSETTING0_VGEN2VSEL_M (7<<6)
87#define MC13892_REGULATORSETTING0_VPLLVSEL_M (3<<9)
88#define MC13892_REGULATORSETTING0_VUSB2VSEL_M (3<<11)
89#define MC13892_REGULATORSETTING0_VGEN3VSEL_M (1<<14)
90#define MC13892_REGULATORSETTING0_VCAMVSEL_M (3<<16)
91
92#define MC13892_REGULATORSETTING1 31
93#define MC13892_REGULATORSETTING1_VVIDEOVSEL 2
94#define MC13892_REGULATORSETTING1_VAUDIOVSEL 4
95#define MC13892_REGULATORSETTING1_VSDVSEL 6
96
97#define MC13892_REGULATORSETTING1_VVIDEOVSEL_M (3<<2)
98#define MC13892_REGULATORSETTING1_VAUDIOVSEL_M (3<<4)
99#define MC13892_REGULATORSETTING1_VSDVSEL_M (7<<6)
100
101#define MC13892_REGULATORMODE0 32
102#define MC13892_REGULATORMODE0_VGEN1EN (1<<0)
103#define MC13892_REGULATORMODE0_VGEN1STDBY (1<<1)
104#define MC13892_REGULATORMODE0_VGEN1MODE (1<<2)
105#define MC13892_REGULATORMODE0_VIOHIEN (1<<3)
106#define MC13892_REGULATORMODE0_VIOHISTDBY (1<<4)
107#define MC13892_REGULATORMODE0_VIOHIMODE (1<<5)
108#define MC13892_REGULATORMODE0_VDIGEN (1<<9)
109#define MC13892_REGULATORMODE0_VDIGSTDBY (1<<10)
110#define MC13892_REGULATORMODE0_VDIGMODE (1<<11)
111#define MC13892_REGULATORMODE0_VGEN2EN (1<<12)
112#define MC13892_REGULATORMODE0_VGEN2STDBY (1<<13)
113#define MC13892_REGULATORMODE0_VGEN2MODE (1<<14)
114#define MC13892_REGULATORMODE0_VPLLEN (1<<15)
115#define MC13892_REGULATORMODE0_VPLLSTDBY (1<<16)
116#define MC13892_REGULATORMODE0_VPLLMODE (1<<17)
117#define MC13892_REGULATORMODE0_VUSB2EN (1<<18)
118#define MC13892_REGULATORMODE0_VUSB2STDBY (1<<19)
119#define MC13892_REGULATORMODE0_VUSB2MODE (1<<20)
120
121#define MC13892_REGULATORMODE1 33
122#define MC13892_REGULATORMODE1_VGEN3EN (1<<0)
123#define MC13892_REGULATORMODE1_VGEN3STDBY (1<<1)
124#define MC13892_REGULATORMODE1_VGEN3MODE (1<<2)
125#define MC13892_REGULATORMODE1_VCAMEN (1<<6)
126#define MC13892_REGULATORMODE1_VCAMSTDBY (1<<7)
127#define MC13892_REGULATORMODE1_VCAMMODE (1<<8)
128#define MC13892_REGULATORMODE1_VCAMCONFIGEN (1<<9)
129#define MC13892_REGULATORMODE1_VVIDEOEN (1<<12)
130#define MC13892_REGULATORMODE1_VVIDEOSTDBY (1<<13)
131#define MC13892_REGULATORMODE1_VVIDEOMODE (1<<14)
132#define MC13892_REGULATORMODE1_VAUDIOEN (1<<15)
133#define MC13892_REGULATORMODE1_VAUDIOSTDBY (1<<16)
134#define MC13892_REGULATORMODE1_VAUDIOMODE (1<<17)
135#define MC13892_REGULATORMODE1_VSDEN (1<<18)
136#define MC13892_REGULATORMODE1_VSDSTDBY (1<<19)
137#define MC13892_REGULATORMODE1_VSDMODE (1<<20)
138
139#define MC13892_POWERMISC 34
140#define MC13892_POWERMISC_GPO1EN (1<<6)
141#define MC13892_POWERMISC_GPO2EN (1<<8)
142#define MC13892_POWERMISC_GPO3EN (1<<10)
143#define MC13892_POWERMISC_GPO4EN (1<<12)
144#define MC13892_POWERMISC_PWGT1SPIEN (1<<15)
145#define MC13892_POWERMISC_PWGT2SPIEN (1<<16)
146#define MC13892_POWERMISC_GPO4ADINEN (1<<21)
147
148#define MC13892_POWERMISC_PWGTSPI_M (3 << 15)
149
150#define MC13892_USB1 50
151#define MC13892_USB1_VUSBEN (1<<3)
152
153static const unsigned int mc13892_vcoincell[] = {
154 2500000, 2700000, 2800000, 2900000, 3000000, 3100000,
155 3200000, 3300000,
156};
157
158static const unsigned int mc13892_sw1[] = {
159 600000, 625000, 650000, 675000, 700000, 725000,
160 750000, 775000, 800000, 825000, 850000, 875000,
161 900000, 925000, 950000, 975000, 1000000, 1025000,
162 1050000, 1075000, 1100000, 1125000, 1150000, 1175000,
163 1200000, 1225000, 1250000, 1275000, 1300000, 1325000,
164 1350000, 1375000
165};
166
167/*
168 * Note: this table is used to derive SWxVSEL by index into
169 * the array. Offset the values by the index of 1100000uV
170 * to get the actual register value for that voltage selector
171 * if the HI bit is to be set as well.
172 */
173#define MC13892_SWxHI_SEL_OFFSET 20
174
175static const unsigned int mc13892_sw[] = {
176 600000, 625000, 650000, 675000, 700000, 725000,
177 750000, 775000, 800000, 825000, 850000, 875000,
178 900000, 925000, 950000, 975000, 1000000, 1025000,
179 1050000, 1075000, 1100000, 1125000, 1150000, 1175000,
180 1200000, 1225000, 1250000, 1275000, 1300000, 1325000,
181 1350000, 1375000, 1400000, 1425000, 1450000, 1475000,
182 1500000, 1525000, 1550000, 1575000, 1600000, 1625000,
183 1650000, 1675000, 1700000, 1725000, 1750000, 1775000,
184 1800000, 1825000, 1850000, 1875000
185};
186
187static const unsigned int mc13892_swbst[] = {
188 5000000,
189};
190
191static const unsigned int mc13892_viohi[] = {
192 2775000,
193};
194
195static const unsigned int mc13892_vpll[] = {
196 1050000, 1250000, 1650000, 1800000,
197};
198
199static const unsigned int mc13892_vdig[] = {
200 1050000, 1250000, 1650000, 1800000,
201};
202
203static const unsigned int mc13892_vsd[] = {
204 1800000, 2000000, 2600000, 2700000,
205 2800000, 2900000, 3000000, 3150000,
206};
207
208static const unsigned int mc13892_vusb2[] = {
209 2400000, 2600000, 2700000, 2775000,
210};
211
212static const unsigned int mc13892_vvideo[] = {
213 2700000, 2775000, 2500000, 2600000,
214};
215
216static const unsigned int mc13892_vaudio[] = {
217 2300000, 2500000, 2775000, 3000000,
218};
219
220static const unsigned int mc13892_vcam[] = {
221 2500000, 2600000, 2750000, 3000000,
222};
223
224static const unsigned int mc13892_vgen1[] = {
225 1200000, 1500000, 2775000, 3150000,
226};
227
228static const unsigned int mc13892_vgen2[] = {
229 1200000, 1500000, 1600000, 1800000,
230 2700000, 2800000, 3000000, 3150000,
231};
232
233static const unsigned int mc13892_vgen3[] = {
234 1800000, 2900000,
235};
236
237static const unsigned int mc13892_vusb[] = {
238 3300000,
239};
240
241static const unsigned int mc13892_gpo[] = {
242 2750000,
243};
244
245static const unsigned int mc13892_pwgtdrv[] = {
246 5000000,
247};
248
249static struct regulator_ops mc13892_gpo_regulator_ops;
250static struct regulator_ops mc13892_sw_regulator_ops;
251
252
253#define MC13892_FIXED_DEFINE(name, reg, voltages) \
254 MC13xxx_FIXED_DEFINE(MC13892_, name, reg, voltages, \
255 mc13xxx_fixed_regulator_ops)
256
257#define MC13892_GPO_DEFINE(name, reg, voltages) \
258 MC13xxx_GPO_DEFINE(MC13892_, name, reg, voltages, \
259 mc13892_gpo_regulator_ops)
260
261#define MC13892_SW_DEFINE(name, reg, vsel_reg, voltages) \
262 MC13xxx_DEFINE(MC13892_, name, reg, vsel_reg, voltages, \
263 mc13892_sw_regulator_ops)
264
265#define MC13892_DEFINE_REGU(name, reg, vsel_reg, voltages) \
266 MC13xxx_DEFINE(MC13892_, name, reg, vsel_reg, voltages, \
267 mc13xxx_regulator_ops)
268
269static struct mc13xxx_regulator mc13892_regulators[] = {
270 MC13892_DEFINE_REGU(VCOINCELL, POWERCTL0, POWERCTL0, mc13892_vcoincell),
271 MC13892_SW_DEFINE(SW1, SWITCHERS0, SWITCHERS0, mc13892_sw1),
272 MC13892_SW_DEFINE(SW2, SWITCHERS1, SWITCHERS1, mc13892_sw),
273 MC13892_SW_DEFINE(SW3, SWITCHERS2, SWITCHERS2, mc13892_sw),
274 MC13892_SW_DEFINE(SW4, SWITCHERS3, SWITCHERS3, mc13892_sw),
275 MC13892_FIXED_DEFINE(SWBST, SWITCHERS5, mc13892_swbst),
276 MC13892_FIXED_DEFINE(VIOHI, REGULATORMODE0, mc13892_viohi),
277 MC13892_DEFINE_REGU(VPLL, REGULATORMODE0, REGULATORSETTING0,
278 mc13892_vpll),
279 MC13892_DEFINE_REGU(VDIG, REGULATORMODE0, REGULATORSETTING0,
280 mc13892_vdig),
281 MC13892_DEFINE_REGU(VSD, REGULATORMODE1, REGULATORSETTING1,
282 mc13892_vsd),
283 MC13892_DEFINE_REGU(VUSB2, REGULATORMODE0, REGULATORSETTING0,
284 mc13892_vusb2),
285 MC13892_DEFINE_REGU(VVIDEO, REGULATORMODE1, REGULATORSETTING1,
286 mc13892_vvideo),
287 MC13892_DEFINE_REGU(VAUDIO, REGULATORMODE1, REGULATORSETTING1,
288 mc13892_vaudio),
289 MC13892_DEFINE_REGU(VCAM, REGULATORMODE1, REGULATORSETTING0,
290 mc13892_vcam),
291 MC13892_DEFINE_REGU(VGEN1, REGULATORMODE0, REGULATORSETTING0,
292 mc13892_vgen1),
293 MC13892_DEFINE_REGU(VGEN2, REGULATORMODE0, REGULATORSETTING0,
294 mc13892_vgen2),
295 MC13892_DEFINE_REGU(VGEN3, REGULATORMODE1, REGULATORSETTING0,
296 mc13892_vgen3),
297 MC13892_FIXED_DEFINE(VUSB, USB1, mc13892_vusb),
298 MC13892_GPO_DEFINE(GPO1, POWERMISC, mc13892_gpo),
299 MC13892_GPO_DEFINE(GPO2, POWERMISC, mc13892_gpo),
300 MC13892_GPO_DEFINE(GPO3, POWERMISC, mc13892_gpo),
301 MC13892_GPO_DEFINE(GPO4, POWERMISC, mc13892_gpo),
302 MC13892_GPO_DEFINE(PWGT1SPI, POWERMISC, mc13892_pwgtdrv),
303 MC13892_GPO_DEFINE(PWGT2SPI, POWERMISC, mc13892_pwgtdrv),
304};
305
306static int mc13892_powermisc_rmw(struct mc13xxx_regulator_priv *priv, u32 mask,
307 u32 val)
308{
309 struct mc13xxx *mc13892 = priv->mc13xxx;
310 int ret;
311 u32 valread;
312
313 BUG_ON(val & ~mask);
314
315 mc13xxx_lock(priv->mc13xxx);
316 ret = mc13xxx_reg_read(mc13892, MC13892_POWERMISC, &valread);
317 if (ret)
318 goto out;
319
320 /* Update the stored state for Power Gates. */
321 priv->powermisc_pwgt_state =
322 (priv->powermisc_pwgt_state & ~mask) | val;
323 priv->powermisc_pwgt_state &= MC13892_POWERMISC_PWGTSPI_M;
324
325 /* Construct the new register value */
326 valread = (valread & ~mask) | val;
327 /* Overwrite the PWGTxEN with the stored version */
328 valread = (valread & ~MC13892_POWERMISC_PWGTSPI_M) |
329 priv->powermisc_pwgt_state;
330
331 ret = mc13xxx_reg_write(mc13892, MC13892_POWERMISC, valread);
332out:
333 mc13xxx_unlock(priv->mc13xxx);
334 return ret;
335}
336
337static int mc13892_gpo_regulator_enable(struct regulator_dev *rdev)
338{
339 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
340 int id = rdev_get_id(rdev);
341 u32 en_val = mc13892_regulators[id].enable_bit;
342 u32 mask = mc13892_regulators[id].enable_bit;
343
344 dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id);
345
346 /* Power Gate enable value is 0 */
347 if (id == MC13892_PWGT1SPI || id == MC13892_PWGT2SPI)
348 en_val = 0;
349
350 if (id == MC13892_GPO4)
351 mask |= MC13892_POWERMISC_GPO4ADINEN;
352
353 return mc13892_powermisc_rmw(priv, mask, en_val);
354}
355
356static int mc13892_gpo_regulator_disable(struct regulator_dev *rdev)
357{
358 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
359 int id = rdev_get_id(rdev);
360 u32 dis_val = 0;
361
362 dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id);
363
364 /* Power Gate disable value is 1 */
365 if (id == MC13892_PWGT1SPI || id == MC13892_PWGT2SPI)
366 dis_val = mc13892_regulators[id].enable_bit;
367
368 return mc13892_powermisc_rmw(priv, mc13892_regulators[id].enable_bit,
369 dis_val);
370}
371
372static int mc13892_gpo_regulator_is_enabled(struct regulator_dev *rdev)
373{
374 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
375 int ret, id = rdev_get_id(rdev);
376 unsigned int val;
377
378 mc13xxx_lock(priv->mc13xxx);
379 ret = mc13xxx_reg_read(priv->mc13xxx, mc13892_regulators[id].reg, &val);
380 mc13xxx_unlock(priv->mc13xxx);
381
382 if (ret)
383 return ret;
384
385 /* Power Gates state is stored in powermisc_pwgt_state
386 * where the meaning of bits is negated */
387 val = (val & ~MC13892_POWERMISC_PWGTSPI_M) |
388 (priv->powermisc_pwgt_state ^ MC13892_POWERMISC_PWGTSPI_M);
389
390 return (val & mc13892_regulators[id].enable_bit) != 0;
391}
392
393
394static struct regulator_ops mc13892_gpo_regulator_ops = {
395 .enable = mc13892_gpo_regulator_enable,
396 .disable = mc13892_gpo_regulator_disable,
397 .is_enabled = mc13892_gpo_regulator_is_enabled,
398 .list_voltage = regulator_list_voltage_table,
399 .set_voltage = mc13xxx_fixed_regulator_set_voltage,
400};
401
402static int mc13892_sw_regulator_get_voltage_sel(struct regulator_dev *rdev)
403{
404 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
405 int ret, id = rdev_get_id(rdev);
406 unsigned int val, selector;
407
408 dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id);
409
410 mc13xxx_lock(priv->mc13xxx);
411 ret = mc13xxx_reg_read(priv->mc13xxx,
412 mc13892_regulators[id].vsel_reg, &val);
413 mc13xxx_unlock(priv->mc13xxx);
414 if (ret)
415 return ret;
416
417 /*
418 * Figure out if the HI bit is set inside the switcher mode register
419 * since this means the selector value we return is at a different
420 * offset into the selector table.
421 *
422 * According to the MC13892 documentation note 59 (Table 47) the SW1
423 * buck switcher does not support output range programming therefore
424 * the HI bit must always remain 0. So do not do anything strange if
425 * our register is MC13892_SWITCHERS0.
426 */
427
428 selector = val & mc13892_regulators[id].vsel_mask;
429
430 if ((mc13892_regulators[id].vsel_reg != MC13892_SWITCHERS0) &&
431 (val & MC13892_SWITCHERS0_SWxHI)) {
432 selector += MC13892_SWxHI_SEL_OFFSET;
433 }
434
435 dev_dbg(rdev_get_dev(rdev), "%s id: %d val: 0x%08x selector: %d\n",
436 __func__, id, val, selector);
437
438 return selector;
439}
440
441static int mc13892_sw_regulator_set_voltage_sel(struct regulator_dev *rdev,
442 unsigned selector)
443{
444 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
445 int volt, mask, id = rdev_get_id(rdev);
446 u32 reg_value;
447 int ret;
448
449 volt = rdev->desc->volt_table[selector];
450 mask = mc13892_regulators[id].vsel_mask;
451 reg_value = selector;
452
453 /*
454 * Don't mess with the HI bit or support HI voltage offsets for SW1.
455 *
456 * Since the get_voltage_sel callback has given a fudged value for
457 * the selector offset, we need to back out that offset if HI is
458 * to be set so we write the correct value to the register.
459 *
460 * The HI bit addition and selector offset handling COULD be more
461 * complicated by shifting and masking off the voltage selector part
462 * of the register then logical OR it back in, but since the selector
463 * is at bits 4:0 there is very little point. This makes the whole
464 * thing more readable and we do far less work.
465 */
466
467 if (mc13892_regulators[id].vsel_reg != MC13892_SWITCHERS0) {
468 mask |= MC13892_SWITCHERS0_SWxHI;
469
470 if (volt > 1375000) {
471 reg_value -= MC13892_SWxHI_SEL_OFFSET;
472 reg_value |= MC13892_SWITCHERS0_SWxHI;
473 } else {
474 reg_value &= ~MC13892_SWITCHERS0_SWxHI;
475 }
476 }
477
478 mc13xxx_lock(priv->mc13xxx);
479 ret = mc13xxx_reg_rmw(priv->mc13xxx, mc13892_regulators[id].vsel_reg,
480 mask, reg_value);
481 mc13xxx_unlock(priv->mc13xxx);
482
483 return ret;
484}
485
486static struct regulator_ops mc13892_sw_regulator_ops = {
487 .list_voltage = regulator_list_voltage_table,
488 .map_voltage = regulator_map_voltage_ascend,
489 .set_voltage_sel = mc13892_sw_regulator_set_voltage_sel,
490 .get_voltage_sel = mc13892_sw_regulator_get_voltage_sel,
491};
492
493static int mc13892_vcam_set_mode(struct regulator_dev *rdev, unsigned int mode)
494{
495 unsigned int en_val = 0;
496 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
497 int ret, id = rdev_get_id(rdev);
498
499 if (mode == REGULATOR_MODE_FAST)
500 en_val = MC13892_REGULATORMODE1_VCAMCONFIGEN;
501
502 mc13xxx_lock(priv->mc13xxx);
503 ret = mc13xxx_reg_rmw(priv->mc13xxx, mc13892_regulators[id].reg,
504 MC13892_REGULATORMODE1_VCAMCONFIGEN, en_val);
505 mc13xxx_unlock(priv->mc13xxx);
506
507 return ret;
508}
509
510static unsigned int mc13892_vcam_get_mode(struct regulator_dev *rdev)
511{
512 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
513 int ret, id = rdev_get_id(rdev);
514 unsigned int val;
515
516 mc13xxx_lock(priv->mc13xxx);
517 ret = mc13xxx_reg_read(priv->mc13xxx, mc13892_regulators[id].reg, &val);
518 mc13xxx_unlock(priv->mc13xxx);
519
520 if (ret)
521 return ret;
522
523 if (val & MC13892_REGULATORMODE1_VCAMCONFIGEN)
524 return REGULATOR_MODE_FAST;
525
526 return REGULATOR_MODE_NORMAL;
527}
528
529static struct regulator_ops mc13892_vcam_ops;
530
531static int mc13892_regulator_probe(struct platform_device *pdev)
532{
533 struct mc13xxx_regulator_priv *priv;
534 struct mc13xxx *mc13892 = dev_get_drvdata(pdev->dev.parent);
535 struct mc13xxx_regulator_platform_data *pdata =
536 dev_get_platdata(&pdev->dev);
537 struct mc13xxx_regulator_init_data *mc13xxx_data;
538 struct regulator_config config = { };
539 int i, ret;
540 int num_regulators = 0;
541 u32 val;
542
543 num_regulators = mc13xxx_get_num_regulators_dt(pdev);
544
545 if (num_regulators <= 0 && pdata)
546 num_regulators = pdata->num_regulators;
547 if (num_regulators <= 0)
548 return -EINVAL;
549
550 priv = devm_kzalloc(&pdev->dev, sizeof(*priv) +
551 num_regulators * sizeof(priv->regulators[0]),
552 GFP_KERNEL);
553 if (!priv)
554 return -ENOMEM;
555
556 priv->num_regulators = num_regulators;
557 priv->mc13xxx_regulators = mc13892_regulators;
558 priv->mc13xxx = mc13892;
559 platform_set_drvdata(pdev, priv);
560
561 mc13xxx_lock(mc13892);
562 ret = mc13xxx_reg_read(mc13892, MC13892_REVISION, &val);
563 if (ret)
564 goto err_unlock;
565
566 /* enable switch auto mode (on 2.0A silicon only) */
567 if ((val & 0x0000FFFF) == 0x45d0) {
568 ret = mc13xxx_reg_rmw(mc13892, MC13892_SWITCHERS4,
569 MC13892_SWITCHERS4_SW1MODE_M |
570 MC13892_SWITCHERS4_SW2MODE_M,
571 MC13892_SWITCHERS4_SW1MODE_AUTO |
572 MC13892_SWITCHERS4_SW2MODE_AUTO);
573 if (ret)
574 goto err_unlock;
575
576 ret = mc13xxx_reg_rmw(mc13892, MC13892_SWITCHERS5,
577 MC13892_SWITCHERS5_SW3MODE_M |
578 MC13892_SWITCHERS5_SW4MODE_M,
579 MC13892_SWITCHERS5_SW3MODE_AUTO |
580 MC13892_SWITCHERS5_SW4MODE_AUTO);
581 if (ret)
582 goto err_unlock;
583 }
584 mc13xxx_unlock(mc13892);
585
586 /* update mc13892_vcam ops */
587 memcpy(&mc13892_vcam_ops, mc13892_regulators[MC13892_VCAM].desc.ops,
588 sizeof(struct regulator_ops));
589 mc13892_vcam_ops.set_mode = mc13892_vcam_set_mode,
590 mc13892_vcam_ops.get_mode = mc13892_vcam_get_mode,
591 mc13892_regulators[MC13892_VCAM].desc.ops = &mc13892_vcam_ops;
592
593 mc13xxx_data = mc13xxx_parse_regulators_dt(pdev, mc13892_regulators,
594 ARRAY_SIZE(mc13892_regulators));
595
596 for (i = 0; i < priv->num_regulators; i++) {
597 struct regulator_init_data *init_data;
598 struct regulator_desc *desc;
599 struct device_node *node = NULL;
600 int id;
601
602 if (mc13xxx_data) {
603 id = mc13xxx_data[i].id;
604 init_data = mc13xxx_data[i].init_data;
605 node = mc13xxx_data[i].node;
606 } else {
607 id = pdata->regulators[i].id;
608 init_data = pdata->regulators[i].init_data;
609 }
610 desc = &mc13892_regulators[id].desc;
611
612 config.dev = &pdev->dev;
613 config.init_data = init_data;
614 config.driver_data = priv;
615 config.of_node = node;
616
617 priv->regulators[i] = devm_regulator_register(&pdev->dev, desc,
618 &config);
619 if (IS_ERR(priv->regulators[i])) {
620 dev_err(&pdev->dev, "failed to register regulator %s\n",
621 mc13892_regulators[i].desc.name);
622 return PTR_ERR(priv->regulators[i]);
623 }
624 }
625
626 return 0;
627
628err_unlock:
629 mc13xxx_unlock(mc13892);
630 return ret;
631}
632
633static struct platform_driver mc13892_regulator_driver = {
634 .driver = {
635 .name = "mc13892-regulator",
636 },
637 .probe = mc13892_regulator_probe,
638};
639
640static int __init mc13892_regulator_init(void)
641{
642 return platform_driver_register(&mc13892_regulator_driver);
643}
644subsys_initcall(mc13892_regulator_init);
645
646static void __exit mc13892_regulator_exit(void)
647{
648 platform_driver_unregister(&mc13892_regulator_driver);
649}
650module_exit(mc13892_regulator_exit);
651
652MODULE_LICENSE("GPL v2");
653MODULE_AUTHOR("Yong Shen <yong.shen@linaro.org>");
654MODULE_DESCRIPTION("Regulator Driver for Freescale MC13892 PMIC");
655MODULE_ALIAS("platform:mc13892-regulator");
1/*
2 * Regulator Driver for Freescale MC13892 PMIC
3 *
4 * Copyright 2010 Yong Shen <yong.shen@linaro.org>
5 *
6 * Based on draft driver from Arnaud Patard <arnaud.patard@rtp-net.org>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
11 */
12
13#include <linux/mfd/mc13892.h>
14#include <linux/regulator/machine.h>
15#include <linux/regulator/driver.h>
16#include <linux/platform_device.h>
17#include <linux/kernel.h>
18#include <linux/slab.h>
19#include <linux/init.h>
20#include <linux/err.h>
21#include <linux/module.h>
22#include "mc13xxx.h"
23
24#define MC13892_REVISION 7
25
26#define MC13892_POWERCTL0 13
27#define MC13892_POWERCTL0_USEROFFSPI 3
28#define MC13892_POWERCTL0_VCOINCELLVSEL 20
29#define MC13892_POWERCTL0_VCOINCELLVSEL_M (7<<20)
30#define MC13892_POWERCTL0_VCOINCELLEN (1<<23)
31
32#define MC13892_SWITCHERS0_SWxHI (1<<23)
33
34#define MC13892_SWITCHERS0 24
35#define MC13892_SWITCHERS0_SW1VSEL 0
36#define MC13892_SWITCHERS0_SW1VSEL_M (0x1f<<0)
37#define MC13892_SWITCHERS0_SW1HI (1<<23)
38#define MC13892_SWITCHERS0_SW1EN 0
39
40#define MC13892_SWITCHERS1 25
41#define MC13892_SWITCHERS1_SW2VSEL 0
42#define MC13892_SWITCHERS1_SW2VSEL_M (0x1f<<0)
43#define MC13892_SWITCHERS1_SW2HI (1<<23)
44#define MC13892_SWITCHERS1_SW2EN 0
45
46#define MC13892_SWITCHERS2 26
47#define MC13892_SWITCHERS2_SW3VSEL 0
48#define MC13892_SWITCHERS2_SW3VSEL_M (0x1f<<0)
49#define MC13892_SWITCHERS2_SW3HI (1<<23)
50#define MC13892_SWITCHERS2_SW3EN 0
51
52#define MC13892_SWITCHERS3 27
53#define MC13892_SWITCHERS3_SW4VSEL 0
54#define MC13892_SWITCHERS3_SW4VSEL_M (0x1f<<0)
55#define MC13892_SWITCHERS3_SW4HI (1<<23)
56#define MC13892_SWITCHERS3_SW4EN 0
57
58#define MC13892_SWITCHERS4 28
59#define MC13892_SWITCHERS4_SW1MODE 0
60#define MC13892_SWITCHERS4_SW1MODE_AUTO (8<<0)
61#define MC13892_SWITCHERS4_SW1MODE_M (0xf<<0)
62#define MC13892_SWITCHERS4_SW2MODE 10
63#define MC13892_SWITCHERS4_SW2MODE_AUTO (8<<10)
64#define MC13892_SWITCHERS4_SW2MODE_M (0xf<<10)
65
66#define MC13892_SWITCHERS5 29
67#define MC13892_SWITCHERS5_SW3MODE 0
68#define MC13892_SWITCHERS5_SW3MODE_AUTO (8<<0)
69#define MC13892_SWITCHERS5_SW3MODE_M (0xf<<0)
70#define MC13892_SWITCHERS5_SW4MODE 8
71#define MC13892_SWITCHERS5_SW4MODE_AUTO (8<<8)
72#define MC13892_SWITCHERS5_SW4MODE_M (0xf<<8)
73#define MC13892_SWITCHERS5_SWBSTEN (1<<20)
74
75#define MC13892_REGULATORSETTING0 30
76#define MC13892_REGULATORSETTING0_VGEN1VSEL 0
77#define MC13892_REGULATORSETTING0_VDIGVSEL 4
78#define MC13892_REGULATORSETTING0_VGEN2VSEL 6
79#define MC13892_REGULATORSETTING0_VPLLVSEL 9
80#define MC13892_REGULATORSETTING0_VUSB2VSEL 11
81#define MC13892_REGULATORSETTING0_VGEN3VSEL 14
82#define MC13892_REGULATORSETTING0_VCAMVSEL 16
83
84#define MC13892_REGULATORSETTING0_VGEN1VSEL_M (3<<0)
85#define MC13892_REGULATORSETTING0_VDIGVSEL_M (3<<4)
86#define MC13892_REGULATORSETTING0_VGEN2VSEL_M (7<<6)
87#define MC13892_REGULATORSETTING0_VPLLVSEL_M (3<<9)
88#define MC13892_REGULATORSETTING0_VUSB2VSEL_M (3<<11)
89#define MC13892_REGULATORSETTING0_VGEN3VSEL_M (1<<14)
90#define MC13892_REGULATORSETTING0_VCAMVSEL_M (3<<16)
91
92#define MC13892_REGULATORSETTING1 31
93#define MC13892_REGULATORSETTING1_VVIDEOVSEL 2
94#define MC13892_REGULATORSETTING1_VAUDIOVSEL 4
95#define MC13892_REGULATORSETTING1_VSDVSEL 6
96
97#define MC13892_REGULATORSETTING1_VVIDEOVSEL_M (3<<2)
98#define MC13892_REGULATORSETTING1_VAUDIOVSEL_M (3<<4)
99#define MC13892_REGULATORSETTING1_VSDVSEL_M (7<<6)
100
101#define MC13892_REGULATORMODE0 32
102#define MC13892_REGULATORMODE0_VGEN1EN (1<<0)
103#define MC13892_REGULATORMODE0_VGEN1STDBY (1<<1)
104#define MC13892_REGULATORMODE0_VGEN1MODE (1<<2)
105#define MC13892_REGULATORMODE0_VIOHIEN (1<<3)
106#define MC13892_REGULATORMODE0_VIOHISTDBY (1<<4)
107#define MC13892_REGULATORMODE0_VIOHIMODE (1<<5)
108#define MC13892_REGULATORMODE0_VDIGEN (1<<9)
109#define MC13892_REGULATORMODE0_VDIGSTDBY (1<<10)
110#define MC13892_REGULATORMODE0_VDIGMODE (1<<11)
111#define MC13892_REGULATORMODE0_VGEN2EN (1<<12)
112#define MC13892_REGULATORMODE0_VGEN2STDBY (1<<13)
113#define MC13892_REGULATORMODE0_VGEN2MODE (1<<14)
114#define MC13892_REGULATORMODE0_VPLLEN (1<<15)
115#define MC13892_REGULATORMODE0_VPLLSTDBY (1<<16)
116#define MC13892_REGULATORMODE0_VPLLMODE (1<<17)
117#define MC13892_REGULATORMODE0_VUSB2EN (1<<18)
118#define MC13892_REGULATORMODE0_VUSB2STDBY (1<<19)
119#define MC13892_REGULATORMODE0_VUSB2MODE (1<<20)
120
121#define MC13892_REGULATORMODE1 33
122#define MC13892_REGULATORMODE1_VGEN3EN (1<<0)
123#define MC13892_REGULATORMODE1_VGEN3STDBY (1<<1)
124#define MC13892_REGULATORMODE1_VGEN3MODE (1<<2)
125#define MC13892_REGULATORMODE1_VCAMEN (1<<6)
126#define MC13892_REGULATORMODE1_VCAMSTDBY (1<<7)
127#define MC13892_REGULATORMODE1_VCAMMODE (1<<8)
128#define MC13892_REGULATORMODE1_VCAMCONFIGEN (1<<9)
129#define MC13892_REGULATORMODE1_VVIDEOEN (1<<12)
130#define MC13892_REGULATORMODE1_VVIDEOSTDBY (1<<13)
131#define MC13892_REGULATORMODE1_VVIDEOMODE (1<<14)
132#define MC13892_REGULATORMODE1_VAUDIOEN (1<<15)
133#define MC13892_REGULATORMODE1_VAUDIOSTDBY (1<<16)
134#define MC13892_REGULATORMODE1_VAUDIOMODE (1<<17)
135#define MC13892_REGULATORMODE1_VSDEN (1<<18)
136#define MC13892_REGULATORMODE1_VSDSTDBY (1<<19)
137#define MC13892_REGULATORMODE1_VSDMODE (1<<20)
138
139#define MC13892_POWERMISC 34
140#define MC13892_POWERMISC_GPO1EN (1<<6)
141#define MC13892_POWERMISC_GPO2EN (1<<8)
142#define MC13892_POWERMISC_GPO3EN (1<<10)
143#define MC13892_POWERMISC_GPO4EN (1<<12)
144#define MC13892_POWERMISC_PWGT1SPIEN (1<<15)
145#define MC13892_POWERMISC_PWGT2SPIEN (1<<16)
146#define MC13892_POWERMISC_GPO4ADINEN (1<<21)
147
148#define MC13892_POWERMISC_PWGTSPI_M (3 << 15)
149
150#define MC13892_USB1 50
151#define MC13892_USB1_VUSBEN (1<<3)
152
153static const int mc13892_vcoincell[] = {
154 2500000, 2700000, 2800000, 2900000, 3000000, 3100000,
155 3200000, 3300000,
156};
157
158static const int mc13892_sw1[] = {
159 600000, 625000, 650000, 675000, 700000, 725000,
160 750000, 775000, 800000, 825000, 850000, 875000,
161 900000, 925000, 950000, 975000, 1000000, 1025000,
162 1050000, 1075000, 1100000, 1125000, 1150000, 1175000,
163 1200000, 1225000, 1250000, 1275000, 1300000, 1325000,
164 1350000, 1375000
165};
166
167static const int mc13892_sw[] = {
168 600000, 625000, 650000, 675000, 700000, 725000,
169 750000, 775000, 800000, 825000, 850000, 875000,
170 900000, 925000, 950000, 975000, 1000000, 1025000,
171 1050000, 1075000, 1100000, 1125000, 1150000, 1175000,
172 1200000, 1225000, 1250000, 1275000, 1300000, 1325000,
173 1350000, 1375000, 1400000, 1425000, 1450000, 1475000,
174 1500000, 1525000, 1550000, 1575000, 1600000, 1625000,
175 1650000, 1675000, 1700000, 1725000, 1750000, 1775000,
176 1800000, 1825000, 1850000, 1875000
177};
178
179static const int mc13892_swbst[] = {
180 5000000,
181};
182
183static const int mc13892_viohi[] = {
184 2775000,
185};
186
187static const int mc13892_vpll[] = {
188 1050000, 1250000, 1650000, 1800000,
189};
190
191static const int mc13892_vdig[] = {
192 1050000, 1250000, 1650000, 1800000,
193};
194
195static const int mc13892_vsd[] = {
196 1800000, 2000000, 2600000, 2700000,
197 2800000, 2900000, 3000000, 3150000,
198};
199
200static const int mc13892_vusb2[] = {
201 2400000, 2600000, 2700000, 2775000,
202};
203
204static const int mc13892_vvideo[] = {
205 2700000, 2775000, 2500000, 2600000,
206};
207
208static const int mc13892_vaudio[] = {
209 2300000, 2500000, 2775000, 3000000,
210};
211
212static const int mc13892_vcam[] = {
213 2500000, 2600000, 2750000, 3000000,
214};
215
216static const int mc13892_vgen1[] = {
217 1200000, 1500000, 2775000, 3150000,
218};
219
220static const int mc13892_vgen2[] = {
221 1200000, 1500000, 1600000, 1800000,
222 2700000, 2800000, 3000000, 3150000,
223};
224
225static const int mc13892_vgen3[] = {
226 1800000, 2900000,
227};
228
229static const int mc13892_vusb[] = {
230 3300000,
231};
232
233static const int mc13892_gpo[] = {
234 2750000,
235};
236
237static const int mc13892_pwgtdrv[] = {
238 5000000,
239};
240
241static struct regulator_ops mc13892_gpo_regulator_ops;
242/* sw regulators need special care due to the "hi bit" */
243static struct regulator_ops mc13892_sw_regulator_ops;
244
245
246#define MC13892_FIXED_DEFINE(name, reg, voltages) \
247 MC13xxx_FIXED_DEFINE(MC13892_, name, reg, voltages, \
248 mc13xxx_fixed_regulator_ops)
249
250#define MC13892_GPO_DEFINE(name, reg, voltages) \
251 MC13xxx_GPO_DEFINE(MC13892_, name, reg, voltages, \
252 mc13892_gpo_regulator_ops)
253
254#define MC13892_SW_DEFINE(name, reg, vsel_reg, voltages) \
255 MC13xxx_DEFINE(MC13892_, name, reg, vsel_reg, voltages, \
256 mc13892_sw_regulator_ops)
257
258#define MC13892_DEFINE_REGU(name, reg, vsel_reg, voltages) \
259 MC13xxx_DEFINE(MC13892_, name, reg, vsel_reg, voltages, \
260 mc13xxx_regulator_ops)
261
262static struct mc13xxx_regulator mc13892_regulators[] = {
263 MC13892_DEFINE_REGU(VCOINCELL, POWERCTL0, POWERCTL0, mc13892_vcoincell),
264 MC13892_SW_DEFINE(SW1, SWITCHERS0, SWITCHERS0, mc13892_sw1),
265 MC13892_SW_DEFINE(SW2, SWITCHERS1, SWITCHERS1, mc13892_sw),
266 MC13892_SW_DEFINE(SW3, SWITCHERS2, SWITCHERS2, mc13892_sw),
267 MC13892_SW_DEFINE(SW4, SWITCHERS3, SWITCHERS3, mc13892_sw),
268 MC13892_FIXED_DEFINE(SWBST, SWITCHERS5, mc13892_swbst),
269 MC13892_FIXED_DEFINE(VIOHI, REGULATORMODE0, mc13892_viohi),
270 MC13892_DEFINE_REGU(VPLL, REGULATORMODE0, REGULATORSETTING0, \
271 mc13892_vpll),
272 MC13892_DEFINE_REGU(VDIG, REGULATORMODE0, REGULATORSETTING0, \
273 mc13892_vdig),
274 MC13892_DEFINE_REGU(VSD, REGULATORMODE1, REGULATORSETTING1, \
275 mc13892_vsd),
276 MC13892_DEFINE_REGU(VUSB2, REGULATORMODE0, REGULATORSETTING0, \
277 mc13892_vusb2),
278 MC13892_DEFINE_REGU(VVIDEO, REGULATORMODE1, REGULATORSETTING1, \
279 mc13892_vvideo),
280 MC13892_DEFINE_REGU(VAUDIO, REGULATORMODE1, REGULATORSETTING1, \
281 mc13892_vaudio),
282 MC13892_DEFINE_REGU(VCAM, REGULATORMODE1, REGULATORSETTING0, \
283 mc13892_vcam),
284 MC13892_DEFINE_REGU(VGEN1, REGULATORMODE0, REGULATORSETTING0, \
285 mc13892_vgen1),
286 MC13892_DEFINE_REGU(VGEN2, REGULATORMODE0, REGULATORSETTING0, \
287 mc13892_vgen2),
288 MC13892_DEFINE_REGU(VGEN3, REGULATORMODE1, REGULATORSETTING0, \
289 mc13892_vgen3),
290 MC13892_FIXED_DEFINE(VUSB, USB1, mc13892_vusb),
291 MC13892_GPO_DEFINE(GPO1, POWERMISC, mc13892_gpo),
292 MC13892_GPO_DEFINE(GPO2, POWERMISC, mc13892_gpo),
293 MC13892_GPO_DEFINE(GPO3, POWERMISC, mc13892_gpo),
294 MC13892_GPO_DEFINE(GPO4, POWERMISC, mc13892_gpo),
295 MC13892_GPO_DEFINE(PWGT1SPI, POWERMISC, mc13892_pwgtdrv),
296 MC13892_GPO_DEFINE(PWGT2SPI, POWERMISC, mc13892_pwgtdrv),
297};
298
299static int mc13892_powermisc_rmw(struct mc13xxx_regulator_priv *priv, u32 mask,
300 u32 val)
301{
302 struct mc13xxx *mc13892 = priv->mc13xxx;
303 int ret;
304 u32 valread;
305
306 BUG_ON(val & ~mask);
307
308 ret = mc13xxx_reg_read(mc13892, MC13892_POWERMISC, &valread);
309 if (ret)
310 return ret;
311
312 /* Update the stored state for Power Gates. */
313 priv->powermisc_pwgt_state =
314 (priv->powermisc_pwgt_state & ~mask) | val;
315 priv->powermisc_pwgt_state &= MC13892_POWERMISC_PWGTSPI_M;
316
317 /* Construct the new register value */
318 valread = (valread & ~mask) | val;
319 /* Overwrite the PWGTxEN with the stored version */
320 valread = (valread & ~MC13892_POWERMISC_PWGTSPI_M) |
321 priv->powermisc_pwgt_state;
322
323 return mc13xxx_reg_write(mc13892, MC13892_POWERMISC, valread);
324}
325
326static int mc13892_gpo_regulator_enable(struct regulator_dev *rdev)
327{
328 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
329 int id = rdev_get_id(rdev);
330 int ret;
331 u32 en_val = mc13892_regulators[id].enable_bit;
332 u32 mask = mc13892_regulators[id].enable_bit;
333
334 dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id);
335
336 /* Power Gate enable value is 0 */
337 if (id == MC13892_PWGT1SPI || id == MC13892_PWGT2SPI)
338 en_val = 0;
339
340 if (id == MC13892_GPO4)
341 mask |= MC13892_POWERMISC_GPO4ADINEN;
342
343 mc13xxx_lock(priv->mc13xxx);
344 ret = mc13892_powermisc_rmw(priv, mask, en_val);
345 mc13xxx_unlock(priv->mc13xxx);
346
347 return ret;
348}
349
350static int mc13892_gpo_regulator_disable(struct regulator_dev *rdev)
351{
352 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
353 int id = rdev_get_id(rdev);
354 int ret;
355 u32 dis_val = 0;
356
357 dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id);
358
359 /* Power Gate disable value is 1 */
360 if (id == MC13892_PWGT1SPI || id == MC13892_PWGT2SPI)
361 dis_val = mc13892_regulators[id].enable_bit;
362
363 mc13xxx_lock(priv->mc13xxx);
364 ret = mc13892_powermisc_rmw(priv, mc13892_regulators[id].enable_bit,
365 dis_val);
366 mc13xxx_unlock(priv->mc13xxx);
367
368 return ret;
369}
370
371static int mc13892_gpo_regulator_is_enabled(struct regulator_dev *rdev)
372{
373 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
374 int ret, id = rdev_get_id(rdev);
375 unsigned int val;
376
377 mc13xxx_lock(priv->mc13xxx);
378 ret = mc13xxx_reg_read(priv->mc13xxx, mc13892_regulators[id].reg, &val);
379 mc13xxx_unlock(priv->mc13xxx);
380
381 if (ret)
382 return ret;
383
384 /* Power Gates state is stored in powermisc_pwgt_state
385 * where the meaning of bits is negated */
386 val = (val & ~MC13892_POWERMISC_PWGTSPI_M) |
387 (priv->powermisc_pwgt_state ^ MC13892_POWERMISC_PWGTSPI_M);
388
389 return (val & mc13892_regulators[id].enable_bit) != 0;
390}
391
392
393static struct regulator_ops mc13892_gpo_regulator_ops = {
394 .enable = mc13892_gpo_regulator_enable,
395 .disable = mc13892_gpo_regulator_disable,
396 .is_enabled = mc13892_gpo_regulator_is_enabled,
397 .list_voltage = mc13xxx_regulator_list_voltage,
398 .set_voltage = mc13xxx_fixed_regulator_set_voltage,
399 .get_voltage = mc13xxx_fixed_regulator_get_voltage,
400};
401
402static int mc13892_sw_regulator_get_voltage(struct regulator_dev *rdev)
403{
404 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
405 int ret, id = rdev_get_id(rdev);
406 unsigned int val, hi;
407
408 dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id);
409
410 mc13xxx_lock(priv->mc13xxx);
411 ret = mc13xxx_reg_read(priv->mc13xxx,
412 mc13892_regulators[id].vsel_reg, &val);
413 mc13xxx_unlock(priv->mc13xxx);
414 if (ret)
415 return ret;
416
417 hi = val & MC13892_SWITCHERS0_SWxHI;
418 val = (val & mc13892_regulators[id].vsel_mask)
419 >> mc13892_regulators[id].vsel_shift;
420
421 dev_dbg(rdev_get_dev(rdev), "%s id: %d val: %d\n", __func__, id, val);
422
423 if (hi)
424 val = (25000 * val) + 1100000;
425 else
426 val = (25000 * val) + 600000;
427
428 return val;
429}
430
431static int mc13892_sw_regulator_set_voltage_sel(struct regulator_dev *rdev,
432 unsigned selector)
433{
434 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
435 int hi, value, mask, id = rdev_get_id(rdev);
436 u32 valread;
437 int ret;
438
439 value = mc13892_regulators[id].voltages[selector];
440
441 mc13xxx_lock(priv->mc13xxx);
442 ret = mc13xxx_reg_read(priv->mc13xxx,
443 mc13892_regulators[id].vsel_reg, &valread);
444 if (ret)
445 goto err;
446
447 if (value > 1375000)
448 hi = 1;
449 else if (value < 1100000)
450 hi = 0;
451 else
452 hi = valread & MC13892_SWITCHERS0_SWxHI;
453
454 if (hi) {
455 value = (value - 1100000) / 25000;
456 value |= MC13892_SWITCHERS0_SWxHI;
457 } else
458 value = (value - 600000) / 25000;
459
460 mask = mc13892_regulators[id].vsel_mask | MC13892_SWITCHERS0_SWxHI;
461 valread = (valread & ~mask) |
462 (value << mc13892_regulators[id].vsel_shift);
463 ret = mc13xxx_reg_write(priv->mc13xxx, mc13892_regulators[id].vsel_reg,
464 valread);
465err:
466 mc13xxx_unlock(priv->mc13xxx);
467
468 return ret;
469}
470
471static struct regulator_ops mc13892_sw_regulator_ops = {
472 .is_enabled = mc13xxx_sw_regulator_is_enabled,
473 .list_voltage = mc13xxx_regulator_list_voltage,
474 .set_voltage_sel = mc13892_sw_regulator_set_voltage_sel,
475 .get_voltage = mc13892_sw_regulator_get_voltage,
476};
477
478static int mc13892_vcam_set_mode(struct regulator_dev *rdev, unsigned int mode)
479{
480 unsigned int en_val = 0;
481 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
482 int ret, id = rdev_get_id(rdev);
483
484 if (mode == REGULATOR_MODE_FAST)
485 en_val = MC13892_REGULATORMODE1_VCAMCONFIGEN;
486
487 mc13xxx_lock(priv->mc13xxx);
488 ret = mc13xxx_reg_rmw(priv->mc13xxx, mc13892_regulators[id].reg,
489 MC13892_REGULATORMODE1_VCAMCONFIGEN, en_val);
490 mc13xxx_unlock(priv->mc13xxx);
491
492 return ret;
493}
494
495static unsigned int mc13892_vcam_get_mode(struct regulator_dev *rdev)
496{
497 struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
498 int ret, id = rdev_get_id(rdev);
499 unsigned int val;
500
501 mc13xxx_lock(priv->mc13xxx);
502 ret = mc13xxx_reg_read(priv->mc13xxx, mc13892_regulators[id].reg, &val);
503 mc13xxx_unlock(priv->mc13xxx);
504
505 if (ret)
506 return ret;
507
508 if (val & MC13892_REGULATORMODE1_VCAMCONFIGEN)
509 return REGULATOR_MODE_FAST;
510
511 return REGULATOR_MODE_NORMAL;
512}
513
514
515static int __devinit mc13892_regulator_probe(struct platform_device *pdev)
516{
517 struct mc13xxx_regulator_priv *priv;
518 struct mc13xxx *mc13892 = dev_get_drvdata(pdev->dev.parent);
519 struct mc13xxx_regulator_platform_data *pdata =
520 dev_get_platdata(&pdev->dev);
521 struct mc13xxx_regulator_init_data *mc13xxx_data;
522 struct regulator_config config = { };
523 int i, ret;
524 int num_regulators = 0;
525 u32 val;
526
527 num_regulators = mc13xxx_get_num_regulators_dt(pdev);
528 if (num_regulators <= 0 && pdata)
529 num_regulators = pdata->num_regulators;
530 if (num_regulators <= 0)
531 return -EINVAL;
532
533 priv = devm_kzalloc(&pdev->dev, sizeof(*priv) +
534 num_regulators * sizeof(priv->regulators[0]),
535 GFP_KERNEL);
536 if (!priv)
537 return -ENOMEM;
538
539 priv->num_regulators = num_regulators;
540 priv->mc13xxx_regulators = mc13892_regulators;
541 priv->mc13xxx = mc13892;
542 platform_set_drvdata(pdev, priv);
543
544 mc13xxx_lock(mc13892);
545 ret = mc13xxx_reg_read(mc13892, MC13892_REVISION, &val);
546 if (ret)
547 goto err_unlock;
548
549 /* enable switch auto mode */
550 if ((val & 0x0000FFFF) == 0x45d0) {
551 ret = mc13xxx_reg_rmw(mc13892, MC13892_SWITCHERS4,
552 MC13892_SWITCHERS4_SW1MODE_M |
553 MC13892_SWITCHERS4_SW2MODE_M,
554 MC13892_SWITCHERS4_SW1MODE_AUTO |
555 MC13892_SWITCHERS4_SW2MODE_AUTO);
556 if (ret)
557 goto err_unlock;
558
559 ret = mc13xxx_reg_rmw(mc13892, MC13892_SWITCHERS5,
560 MC13892_SWITCHERS5_SW3MODE_M |
561 MC13892_SWITCHERS5_SW4MODE_M,
562 MC13892_SWITCHERS5_SW3MODE_AUTO |
563 MC13892_SWITCHERS5_SW4MODE_AUTO);
564 if (ret)
565 goto err_unlock;
566 }
567 mc13xxx_unlock(mc13892);
568
569 mc13892_regulators[MC13892_VCAM].desc.ops->set_mode
570 = mc13892_vcam_set_mode;
571 mc13892_regulators[MC13892_VCAM].desc.ops->get_mode
572 = mc13892_vcam_get_mode;
573
574 mc13xxx_data = mc13xxx_parse_regulators_dt(pdev, mc13892_regulators,
575 ARRAY_SIZE(mc13892_regulators));
576 for (i = 0; i < num_regulators; i++) {
577 struct regulator_init_data *init_data;
578 struct regulator_desc *desc;
579 struct device_node *node = NULL;
580 int id;
581
582 if (mc13xxx_data) {
583 id = mc13xxx_data[i].id;
584 init_data = mc13xxx_data[i].init_data;
585 node = mc13xxx_data[i].node;
586 } else {
587 id = pdata->regulators[i].id;
588 init_data = pdata->regulators[i].init_data;
589 }
590 desc = &mc13892_regulators[id].desc;
591
592 config.dev = &pdev->dev;
593 config.init_data = init_data;
594 config.driver_data = priv;
595 config.of_node = node;
596
597 priv->regulators[i] = regulator_register(desc, &config);
598 if (IS_ERR(priv->regulators[i])) {
599 dev_err(&pdev->dev, "failed to register regulator %s\n",
600 mc13892_regulators[i].desc.name);
601 ret = PTR_ERR(priv->regulators[i]);
602 goto err;
603 }
604 }
605
606 return 0;
607err:
608 while (--i >= 0)
609 regulator_unregister(priv->regulators[i]);
610 return ret;
611
612err_unlock:
613 mc13xxx_unlock(mc13892);
614 return ret;
615}
616
617static int __devexit mc13892_regulator_remove(struct platform_device *pdev)
618{
619 struct mc13xxx_regulator_priv *priv = platform_get_drvdata(pdev);
620 int i;
621
622 platform_set_drvdata(pdev, NULL);
623
624 for (i = 0; i < priv->num_regulators; i++)
625 regulator_unregister(priv->regulators[i]);
626
627 return 0;
628}
629
630static struct platform_driver mc13892_regulator_driver = {
631 .driver = {
632 .name = "mc13892-regulator",
633 .owner = THIS_MODULE,
634 },
635 .remove = __devexit_p(mc13892_regulator_remove),
636 .probe = mc13892_regulator_probe,
637};
638
639static int __init mc13892_regulator_init(void)
640{
641 return platform_driver_register(&mc13892_regulator_driver);
642}
643subsys_initcall(mc13892_regulator_init);
644
645static void __exit mc13892_regulator_exit(void)
646{
647 platform_driver_unregister(&mc13892_regulator_driver);
648}
649module_exit(mc13892_regulator_exit);
650
651MODULE_LICENSE("GPL v2");
652MODULE_AUTHOR("Yong Shen <yong.shen@linaro.org>");
653MODULE_DESCRIPTION("Regulator Driver for Freescale MC13892 PMIC");
654MODULE_ALIAS("platform:mc13892-regulator");