]> git.openfabrics.org - ~shefty/rdma-dev.git/blob - drivers/regulator/tps6586x-regulator.c
regulator: tps6586x: Fix TPS6586X_DVM to store goreg/bit
[~shefty/rdma-dev.git] / drivers / regulator / tps6586x-regulator.c
1 /*
2  * Regulator driver for TI TPS6586x
3  *
4  * Copyright (C) 2010 Compulab Ltd.
5  * Author: Mike Rapoport <mike@compulab.co.il>
6  *
7  * Based on da903x
8  * Copyright (C) 2006-2008 Marvell International Ltd.
9  * Copyright (C) 2008 Compulab Ltd.
10  *
11  * This program is free software; you can redistribute it and/or modify
12  * it under the terms of the GNU General Public License version 2 as
13  * published by the Free Software Foundation.
14  */
15
16 #include <linux/kernel.h>
17 #include <linux/init.h>
18 #include <linux/err.h>
19 #include <linux/slab.h>
20 #include <linux/platform_device.h>
21 #include <linux/regulator/driver.h>
22 #include <linux/regulator/machine.h>
23 #include <linux/mfd/tps6586x.h>
24
25 /* supply control and voltage setting  */
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 /* converter settings  */
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
56 struct tps6586x_regulator {
57         struct regulator_desc desc;
58
59         int volt_reg;
60         int volt_shift;
61         int volt_nbits;
62         int enable_bit[2];
63         int enable_reg[2];
64
65         int *voltages;
66
67         /* for DVM regulators */
68         int go_reg;
69         int go_bit;
70 };
71
72 static inline struct device *to_tps6586x_dev(struct regulator_dev *rdev)
73 {
74         return rdev_get_dev(rdev)->parent->parent;
75 }
76
77 static int tps6586x_ldo_list_voltage(struct regulator_dev *rdev,
78                                      unsigned selector)
79 {
80         struct tps6586x_regulator *info = rdev_get_drvdata(rdev);
81
82         return info->voltages[selector] * 1000;
83 }
84
85
86 static int __tps6586x_ldo_set_voltage(struct device *parent,
87                                       struct tps6586x_regulator *ri,
88                                       int min_uV, int max_uV)
89 {
90         int val, uV;
91         uint8_t mask;
92
93         for (val = 0; val < ri->desc.n_voltages; val++) {
94                 uV = ri->voltages[val] * 1000;
95
96                 /* LDO0 has minimal voltage 1.2 rather than 1.25 */
97                 if (ri->desc.id == TPS6586X_ID_LDO_0 && val == 0)
98                         uV -= 50 * 1000;
99
100                 /* use the first in-range value */
101                 if (min_uV <= uV && uV <= max_uV) {
102
103                         val <<= ri->volt_shift;
104                         mask = ((1 << ri->volt_nbits) - 1) << ri->volt_shift;
105
106                         return tps6586x_update(parent, ri->volt_reg, val, mask);
107                 }
108         }
109
110         return -EINVAL;
111 }
112
113 static int tps6586x_ldo_set_voltage(struct regulator_dev *rdev,
114                                     int min_uV, int max_uV)
115 {
116         struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
117         struct device *parent = to_tps6586x_dev(rdev);
118
119         return __tps6586x_ldo_set_voltage(parent, ri, min_uV, max_uV);
120 }
121
122 static int tps6586x_ldo_get_voltage(struct regulator_dev *rdev)
123 {
124         struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
125         struct device *parent = to_tps6586x_dev(rdev);
126         uint8_t val, mask;
127         int ret;
128
129         ret = tps6586x_read(parent, ri->volt_reg, &val);
130         if (ret)
131                 return ret;
132
133         mask = ((1 << ri->volt_nbits) - 1) << ri->volt_shift;
134         val = (val & mask) >> ri->volt_shift;
135
136         if (val >= ri->desc.n_voltages)
137                 BUG();
138
139         return ri->voltages[val] * 1000;
140 }
141
142 static int tps6586x_dvm_set_voltage(struct regulator_dev *rdev,
143                                     int min_uV, int max_uV)
144 {
145         struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
146         struct device *parent = to_tps6586x_dev(rdev);
147         int ret;
148
149         ret = __tps6586x_ldo_set_voltage(parent, ri, min_uV, max_uV);
150         if (ret)
151                 return ret;
152
153         return tps6586x_set_bits(parent, ri->go_reg, 1 << ri->go_bit);
154 }
155
156 static int tps6586x_regulator_enable(struct regulator_dev *rdev)
157 {
158         struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
159         struct device *parent = to_tps6586x_dev(rdev);
160
161         return tps6586x_set_bits(parent, ri->enable_reg[0],
162                                  1 << ri->enable_bit[0]);
163 }
164
165 static int tps6586x_regulator_disable(struct regulator_dev *rdev)
166 {
167         struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
168         struct device *parent = to_tps6586x_dev(rdev);
169
170         return tps6586x_clr_bits(parent, ri->enable_reg[0],
171                                  1 << ri->enable_bit[0]);
172 }
173
174 static int tps6586x_regulator_is_enabled(struct regulator_dev *rdev)
175 {
176         struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
177         struct device *parent = to_tps6586x_dev(rdev);
178         uint8_t reg_val;
179         int ret;
180
181         ret = tps6586x_read(parent, ri->enable_reg[0], &reg_val);
182         if (ret)
183                 return ret;
184
185         return !!(reg_val & (1 << ri->enable_bit[0]));
186 }
187
188 static struct regulator_ops tps6586x_regulator_ldo_ops = {
189         .list_voltage = tps6586x_ldo_list_voltage,
190         .get_voltage = tps6586x_ldo_get_voltage,
191         .set_voltage = tps6586x_ldo_set_voltage,
192
193         .is_enabled = tps6586x_regulator_is_enabled,
194         .enable = tps6586x_regulator_enable,
195         .disable = tps6586x_regulator_disable,
196 };
197
198 static struct regulator_ops tps6586x_regulator_dvm_ops = {
199         .list_voltage = tps6586x_ldo_list_voltage,
200         .get_voltage = tps6586x_ldo_get_voltage,
201         .set_voltage = tps6586x_dvm_set_voltage,
202
203         .is_enabled = tps6586x_regulator_is_enabled,
204         .enable = tps6586x_regulator_enable,
205         .disable = tps6586x_regulator_disable,
206 };
207
208 static int tps6586x_ldo_voltages[] = {
209         1250, 1500, 1800, 2500, 2700, 2850, 3100, 3300,
210 };
211
212 static int tps6586x_ldo4_voltages[] = {
213         1700, 1725, 1750, 1775, 1800, 1825, 1850, 1875,
214         1900, 1925, 1950, 1975, 2000, 2025, 2050, 2075,
215         2100, 2125, 2150, 2175, 2200, 2225, 2250, 2275,
216         2300, 2325, 2350, 2375, 2400, 2425, 2450, 2475,
217 };
218
219 static int tps6586x_sm2_voltages[] = {
220         3000, 3050, 3100, 3150, 3200, 3250, 3300, 3350,
221         3400, 3450, 3500, 3550, 3600, 3650, 3700, 3750,
222         3800, 3850, 3900, 3950, 4000, 4050, 4100, 4150,
223         4200, 4250, 4300, 4350, 4400, 4450, 4500, 4550,
224 };
225
226 static int tps6586x_dvm_voltages[] = {
227          725,  750,  775,  800,  825,  850,  875,  900,
228          925,  950,  975, 1000, 1025, 1050, 1075, 1100,
229         1125, 1150, 1175, 1200, 1225, 1250, 1275, 1300,
230         1325, 1350, 1375, 1400, 1425, 1450, 1475, 1500,
231 };
232
233 #define TPS6586X_REGULATOR(_id, vdata, _ops, vreg, shift, nbits,        \
234                            ereg0, ebit0, ereg1, ebit1)                  \
235         .desc   = {                                                     \
236                 .name   = "REG-" #_id,                                  \
237                 .ops    = &tps6586x_regulator_##_ops,                   \
238                 .type   = REGULATOR_VOLTAGE,                            \
239                 .id     = TPS6586X_ID_##_id,                            \
240                 .n_voltages = ARRAY_SIZE(tps6586x_##vdata##_voltages),  \
241                 .owner  = THIS_MODULE,                                  \
242         },                                                              \
243         .volt_reg       = TPS6586X_##vreg,                              \
244         .volt_shift     = (shift),                                      \
245         .volt_nbits     = (nbits),                                      \
246         .enable_reg[0]  = TPS6586X_SUPPLY##ereg0,                       \
247         .enable_bit[0]  = (ebit0),                                      \
248         .enable_reg[1]  = TPS6586X_SUPPLY##ereg1,                       \
249         .enable_bit[1]  = (ebit1),                                      \
250         .voltages       = tps6586x_##vdata##_voltages,
251
252 #define TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit)                      \
253         .go_reg = TPS6586X_##goreg,                                     \
254         .go_bit = (gobit),
255
256 #define TPS6586X_LDO(_id, vdata, vreg, shift, nbits,                    \
257                      ereg0, ebit0, ereg1, ebit1)                        \
258 {                                                                       \
259         TPS6586X_REGULATOR(_id, vdata, ldo_ops, vreg, shift, nbits,     \
260                            ereg0, ebit0, ereg1, ebit1)                  \
261 }
262
263 #define TPS6586X_DVM(_id, vdata, vreg, shift, nbits,                    \
264                      ereg0, ebit0, ereg1, ebit1, goreg, gobit)          \
265 {                                                                       \
266         TPS6586X_REGULATOR(_id, vdata, dvm_ops, vreg, shift, nbits,     \
267                            ereg0, ebit0, ereg1, ebit1)                  \
268         TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit)                      \
269 }
270
271 static struct tps6586x_regulator tps6586x_regulator[] = {
272         TPS6586X_LDO(LDO_0, ldo, SUPPLYV1, 5, 3, ENC, 0, END, 0),
273         TPS6586X_LDO(LDO_3, ldo, SUPPLYV4, 0, 3, ENC, 2, END, 2),
274         TPS6586X_LDO(LDO_5, ldo, SUPPLYV6, 0, 3, ENE, 6, ENE, 6),
275         TPS6586X_LDO(LDO_6, ldo, SUPPLYV3, 0, 3, ENC, 4, END, 4),
276         TPS6586X_LDO(LDO_7, ldo, SUPPLYV3, 3, 3, ENC, 5, END, 5),
277         TPS6586X_LDO(LDO_8, ldo, SUPPLYV1, 5, 3, ENC, 6, END, 6),
278         TPS6586X_LDO(LDO_9, ldo, SUPPLYV6, 3, 3, ENE, 7, ENE, 7),
279         TPS6586X_LDO(LDO_RTC, ldo, SUPPLYV4, 3, 3, ENE, 7, ENE, 7),
280         TPS6586X_LDO(LDO_1, dvm, SUPPLYV1, 0, 5, ENC, 1, END, 1),
281         TPS6586X_LDO(SM_2, sm2, SUPPLYV2, 0, 5, ENC, 1, END, 1),
282
283         TPS6586X_DVM(LDO_2, dvm, LDO2BV1, 0, 5, ENA, 3, ENB, 3, VCC2, 6),
284         TPS6586X_DVM(LDO_4, ldo4, LDO4V1, 0, 5, ENC, 3, END, 3, VCC1, 6),
285         TPS6586X_DVM(SM_0, dvm, SM0V1, 0, 5, ENA, 1, ENB, 1, VCC1, 2),
286         TPS6586X_DVM(SM_1, dvm, SM1V1, 0, 5, ENA, 0, ENB, 0, VCC1, 0),
287 };
288
289 /*
290  * TPS6586X has 2 enable bits that are OR'ed to determine the actual
291  * regulator state. Clearing one of this bits allows switching
292  * regulator on and of with single register write.
293  */
294 static inline int tps6586x_regulator_preinit(struct device *parent,
295                                              struct tps6586x_regulator *ri)
296 {
297         uint8_t val1, val2;
298         int ret;
299
300         ret = tps6586x_read(parent, ri->enable_reg[0], &val1);
301         if (ret)
302                 return ret;
303
304         ret = tps6586x_read(parent, ri->enable_reg[1], &val2);
305         if (ret)
306                 return ret;
307
308         if (!(val2 & (1 << ri->enable_bit[1])))
309                 return 0;
310
311         /*
312          * The regulator is on, but it's enabled with the bit we don't
313          * want to use, so we switch the enable bits
314          */
315         if (!(val1 & (1 << ri->enable_bit[0]))) {
316                 ret = tps6586x_set_bits(parent, ri->enable_reg[0],
317                                         1 << ri->enable_bit[0]);
318                 if (ret)
319                         return ret;
320         }
321
322         return tps6586x_clr_bits(parent, ri->enable_reg[1],
323                                  1 << ri->enable_bit[1]);
324 }
325
326 static inline struct tps6586x_regulator *find_regulator_info(int id)
327 {
328         struct tps6586x_regulator *ri;
329         int i;
330
331         for (i = 0; i < ARRAY_SIZE(tps6586x_regulator); i++) {
332                 ri = &tps6586x_regulator[i];
333                 if (ri->desc.id == id)
334                         return ri;
335         }
336         return NULL;
337 }
338
339 static int __devinit tps6586x_regulator_probe(struct platform_device *pdev)
340 {
341         struct tps6586x_regulator *ri = NULL;
342         struct regulator_dev *rdev;
343         int id = pdev->id;
344         int err;
345
346         dev_dbg(&pdev->dev, "Probing reulator %d\n", id);
347
348         ri = find_regulator_info(id);
349         if (ri == NULL) {
350                 dev_err(&pdev->dev, "invalid regulator ID specified\n");
351                 return -EINVAL;
352         }
353
354         err = tps6586x_regulator_preinit(pdev->dev.parent, ri);
355         if (err)
356                 return err;
357
358         rdev = regulator_register(&ri->desc, &pdev->dev,
359                                   pdev->dev.platform_data, ri);
360         if (IS_ERR(rdev)) {
361                 dev_err(&pdev->dev, "failed to register regulator %s\n",
362                                 ri->desc.name);
363                 return PTR_ERR(rdev);
364         }
365
366         platform_set_drvdata(pdev, rdev);
367
368         return 0;
369 }
370
371 static int __devexit tps6586x_regulator_remove(struct platform_device *pdev)
372 {
373         struct regulator_dev *rdev = platform_get_drvdata(pdev);
374
375         regulator_unregister(rdev);
376         return 0;
377 }
378
379 static struct platform_driver tps6586x_regulator_driver = {
380         .driver = {
381                 .name   = "tps6586x-regulator",
382                 .owner  = THIS_MODULE,
383         },
384         .probe          = tps6586x_regulator_probe,
385         .remove         = __devexit_p(tps6586x_regulator_remove),
386 };
387
388 static int __init tps6586x_regulator_init(void)
389 {
390         return platform_driver_register(&tps6586x_regulator_driver);
391 }
392 subsys_initcall(tps6586x_regulator_init);
393
394 static void __exit tps6586x_regulator_exit(void)
395 {
396         platform_driver_unregister(&tps6586x_regulator_driver);
397 }
398 module_exit(tps6586x_regulator_exit);
399
400 MODULE_LICENSE("GPL");
401 MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
402 MODULE_DESCRIPTION("Regulator Driver for TI TPS6586X PMIC");
403 MODULE_ALIAS("platform:tps6586x-regulator");