sfc: Fix DMA mapping cleanup in case of an error in TSO
[linux/fpc-iii.git] / drivers / regulator / da903x.c
blobb8b89ef10a84abdbc44573e30f0fb7c7d545b16d
1 /*
2 * Regulators driver for Dialog Semiconductor DA903x
4 * Copyright (C) 2006-2008 Marvell International Ltd.
5 * Copyright (C) 2008 Compulab Ltd.
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
12 #include <linux/kernel.h>
13 #include <linux/init.h>
14 #include <linux/err.h>
15 #include <linux/platform_device.h>
16 #include <linux/regulator/driver.h>
17 #include <linux/regulator/machine.h>
18 #include <linux/mfd/da903x.h>
20 /* DA9030 Registers */
21 #define DA9030_INVAL (-1)
22 #define DA9030_LDO1011 (0x10)
23 #define DA9030_LDO15 (0x11)
24 #define DA9030_LDO1416 (0x12)
25 #define DA9030_LDO1819 (0x13)
26 #define DA9030_LDO17 (0x14)
27 #define DA9030_BUCK2DVM1 (0x15)
28 #define DA9030_BUCK2DVM2 (0x16)
29 #define DA9030_RCTL11 (0x17)
30 #define DA9030_RCTL21 (0x18)
31 #define DA9030_LDO1 (0x90)
32 #define DA9030_LDO23 (0x91)
33 #define DA9030_LDO45 (0x92)
34 #define DA9030_LDO6 (0x93)
35 #define DA9030_LDO78 (0x94)
36 #define DA9030_LDO912 (0x95)
37 #define DA9030_BUCK (0x96)
38 #define DA9030_RCTL12 (0x97)
39 #define DA9030_RCTL22 (0x98)
40 #define DA9030_LDO_UNLOCK (0xa0)
41 #define DA9030_LDO_UNLOCK_MASK (0xe0)
42 #define DA9034_OVER1 (0x10)
44 /* DA9034 Registers */
45 #define DA9034_INVAL (-1)
46 #define DA9034_OVER2 (0x11)
47 #define DA9034_OVER3 (0x12)
48 #define DA9034_LDO643 (0x13)
49 #define DA9034_LDO987 (0x14)
50 #define DA9034_LDO1110 (0x15)
51 #define DA9034_LDO1312 (0x16)
52 #define DA9034_LDO1514 (0x17)
53 #define DA9034_VCC1 (0x20)
54 #define DA9034_ADTV1 (0x23)
55 #define DA9034_ADTV2 (0x24)
56 #define DA9034_AVRC (0x25)
57 #define DA9034_CDTV1 (0x26)
58 #define DA9034_CDTV2 (0x27)
59 #define DA9034_CVRC (0x28)
60 #define DA9034_SDTV1 (0x29)
61 #define DA9034_SDTV2 (0x2a)
62 #define DA9034_SVRC (0x2b)
63 #define DA9034_MDTV1 (0x32)
64 #define DA9034_MDTV2 (0x33)
65 #define DA9034_MVRC (0x34)
67 struct da903x_regulator_info {
68 struct regulator_desc desc;
70 int min_uV;
71 int max_uV;
72 int step_uV;
73 int vol_reg;
74 int vol_shift;
75 int vol_nbits;
76 int update_reg;
77 int update_bit;
78 int enable_reg;
79 int enable_bit;
82 static inline struct device *to_da903x_dev(struct regulator_dev *rdev)
84 return rdev_get_dev(rdev)->parent->parent;
87 static inline int check_range(struct da903x_regulator_info *info,
88 int min_uV, int max_uV)
90 if (min_uV < info->min_uV || min_uV > info->max_uV)
91 return -EINVAL;
93 return 0;
96 /* DA9030/DA9034 common operations */
97 static int da903x_set_ldo_voltage(struct regulator_dev *rdev,
98 int min_uV, int max_uV)
100 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
101 struct device *da9034_dev = to_da903x_dev(rdev);
102 uint8_t val, mask;
104 if (check_range(info, min_uV, max_uV)) {
105 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
106 return -EINVAL;
109 val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
110 val <<= info->vol_shift;
111 mask = ((1 << info->vol_nbits) - 1) << info->vol_shift;
113 return da903x_update(da9034_dev, info->vol_reg, val, mask);
116 static int da903x_get_voltage(struct regulator_dev *rdev)
118 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
119 struct device *da9034_dev = to_da903x_dev(rdev);
120 uint8_t val, mask;
121 int ret;
123 ret = da903x_read(da9034_dev, info->vol_reg, &val);
124 if (ret)
125 return ret;
127 mask = ((1 << info->vol_nbits) - 1) << info->vol_shift;
128 val = (val & mask) >> info->vol_shift;
130 return info->min_uV + info->step_uV * val;
133 static int da903x_enable(struct regulator_dev *rdev)
135 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
136 struct device *da9034_dev = to_da903x_dev(rdev);
138 return da903x_set_bits(da9034_dev, info->enable_reg,
139 1 << info->enable_bit);
142 static int da903x_disable(struct regulator_dev *rdev)
144 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
145 struct device *da9034_dev = to_da903x_dev(rdev);
147 return da903x_clr_bits(da9034_dev, info->enable_reg,
148 1 << info->enable_bit);
151 static int da903x_is_enabled(struct regulator_dev *rdev)
153 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
154 struct device *da9034_dev = to_da903x_dev(rdev);
155 uint8_t reg_val;
156 int ret;
158 ret = da903x_read(da9034_dev, info->enable_reg, &reg_val);
159 if (ret)
160 return ret;
162 return !!(reg_val & (1 << info->enable_bit));
165 /* DA9030 specific operations */
166 static int da9030_set_ldo1_15_voltage(struct regulator_dev *rdev,
167 int min_uV, int max_uV)
169 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
170 struct device *da903x_dev = to_da903x_dev(rdev);
171 uint8_t val, mask;
172 int ret;
174 if (check_range(info, min_uV, max_uV)) {
175 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
176 return -EINVAL;
179 val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
180 val <<= info->vol_shift;
181 mask = ((1 << info->vol_nbits) - 1) << info->vol_shift;
182 val |= DA9030_LDO_UNLOCK; /* have to set UNLOCK bits */
183 mask |= DA9030_LDO_UNLOCK_MASK;
185 /* write twice */
186 ret = da903x_update(da903x_dev, info->vol_reg, val, mask);
187 if (ret)
188 return ret;
190 return da903x_update(da903x_dev, info->vol_reg, val, mask);
193 static int da9030_set_ldo14_voltage(struct regulator_dev *rdev,
194 int min_uV, int max_uV)
196 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
197 struct device *da903x_dev = to_da903x_dev(rdev);
198 uint8_t val, mask;
199 int thresh;
201 if (check_range(info, min_uV, max_uV)) {
202 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
203 return -EINVAL;
206 thresh = (info->max_uV + info->min_uV) / 2;
207 if (min_uV < thresh) {
208 val = (thresh - min_uV + info->step_uV - 1) / info->step_uV;
209 val |= 0x4;
210 } else {
211 val = (min_uV - thresh + info->step_uV - 1) / info->step_uV;
214 val <<= info->vol_shift;
215 mask = ((1 << info->vol_nbits) - 1) << info->vol_shift;
217 return da903x_update(da903x_dev, info->vol_reg, val, mask);
220 static int da9030_get_ldo14_voltage(struct regulator_dev *rdev)
222 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
223 struct device *da903x_dev = to_da903x_dev(rdev);
224 uint8_t val, mask;
225 int ret;
227 ret = da903x_read(da903x_dev, info->vol_reg, &val);
228 if (ret)
229 return ret;
231 mask = ((1 << info->vol_nbits) - 1) << info->vol_shift;
232 val = (val & mask) >> info->vol_shift;
234 if (val & 0x4)
235 return info->min_uV + info->step_uV * (3 - (val & ~0x4));
236 else
237 return (info->max_uV + info->min_uV) / 2 +
238 info->step_uV * (val & ~0x4);
241 /* DA9034 specific operations */
242 static int da9034_set_dvc_voltage(struct regulator_dev *rdev,
243 int min_uV, int max_uV)
245 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
246 struct device *da9034_dev = to_da903x_dev(rdev);
247 uint8_t val, mask;
248 int ret;
250 if (check_range(info, min_uV, max_uV)) {
251 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
252 return -EINVAL;
255 val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
256 val <<= info->vol_shift;
257 mask = ((1 << info->vol_nbits) - 1) << info->vol_shift;
259 ret = da903x_update(da9034_dev, info->vol_reg, val, mask);
260 if (ret)
261 return ret;
263 ret = da903x_set_bits(da9034_dev, info->update_reg,
264 1 << info->update_bit);
265 return ret;
268 static int da9034_set_ldo12_voltage(struct regulator_dev *rdev,
269 int min_uV, int max_uV)
271 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
272 struct device *da9034_dev = to_da903x_dev(rdev);
273 uint8_t val, mask;
275 if (check_range(info, min_uV, max_uV)) {
276 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
277 return -EINVAL;
280 val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
281 val = (val > 7 || val < 20) ? 8 : val - 12;
282 val <<= info->vol_shift;
283 mask = ((1 << info->vol_nbits) - 1) << info->vol_shift;
285 return da903x_update(da9034_dev, info->vol_reg, val, mask);
288 static int da9034_get_ldo12_voltage(struct regulator_dev *rdev)
290 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
291 struct device *da9034_dev = to_da903x_dev(rdev);
292 uint8_t val, mask;
293 int ret;
295 ret = da903x_read(da9034_dev, info->vol_reg, &val);
296 if (ret)
297 return ret;
299 mask = ((1 << info->vol_nbits) - 1) << info->vol_shift;
300 val = (val & mask) >> info->vol_shift;
302 if (val >= 8)
303 return 2700000 + info->step_uV * (val - 8);
305 return info->min_uV + info->step_uV * val;
308 static struct regulator_ops da903x_regulator_ldo_ops = {
309 .set_voltage = da903x_set_ldo_voltage,
310 .get_voltage = da903x_get_voltage,
311 .enable = da903x_enable,
312 .disable = da903x_disable,
313 .is_enabled = da903x_is_enabled,
316 /* NOTE: this is dedicated for the insane DA9030 LDO14 */
317 static struct regulator_ops da9030_regulator_ldo14_ops = {
318 .set_voltage = da9030_set_ldo14_voltage,
319 .get_voltage = da9030_get_ldo14_voltage,
320 .enable = da903x_enable,
321 .disable = da903x_disable,
322 .is_enabled = da903x_is_enabled,
325 /* NOTE: this is dedicated for the DA9030 LDO1 and LDO15 that have locks */
326 static struct regulator_ops da9030_regulator_ldo1_15_ops = {
327 .set_voltage = da9030_set_ldo1_15_voltage,
328 .get_voltage = da903x_get_voltage,
329 .enable = da903x_enable,
330 .disable = da903x_disable,
331 .is_enabled = da903x_is_enabled,
334 static struct regulator_ops da9034_regulator_dvc_ops = {
335 .set_voltage = da9034_set_dvc_voltage,
336 .get_voltage = da903x_get_voltage,
337 .enable = da903x_enable,
338 .disable = da903x_disable,
339 .is_enabled = da903x_is_enabled,
342 /* NOTE: this is dedicated for the insane LDO12 */
343 static struct regulator_ops da9034_regulator_ldo12_ops = {
344 .set_voltage = da9034_set_ldo12_voltage,
345 .get_voltage = da9034_get_ldo12_voltage,
346 .enable = da903x_enable,
347 .disable = da903x_disable,
348 .is_enabled = da903x_is_enabled,
351 #define DA903x_LDO(_pmic, _id, min, max, step, vreg, shift, nbits, ereg, ebit) \
353 .desc = { \
354 .name = "LDO" #_id, \
355 .ops = &da903x_regulator_ldo_ops, \
356 .type = REGULATOR_VOLTAGE, \
357 .id = _pmic##_ID_LDO##_id, \
358 .owner = THIS_MODULE, \
359 }, \
360 .min_uV = (min) * 1000, \
361 .max_uV = (max) * 1000, \
362 .step_uV = (step) * 1000, \
363 .vol_reg = _pmic##_##vreg, \
364 .vol_shift = (shift), \
365 .vol_nbits = (nbits), \
366 .enable_reg = _pmic##_##ereg, \
367 .enable_bit = (ebit), \
370 #define DA9034_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
372 .desc = { \
373 .name = #_id, \
374 .ops = &da9034_regulator_dvc_ops, \
375 .type = REGULATOR_VOLTAGE, \
376 .id = DA9034_ID_##_id, \
377 .owner = THIS_MODULE, \
378 }, \
379 .min_uV = (min) * 1000, \
380 .max_uV = (max) * 1000, \
381 .step_uV = (step) * 1000, \
382 .vol_reg = DA9034_##vreg, \
383 .vol_shift = (0), \
384 .vol_nbits = (nbits), \
385 .update_reg = DA9034_##ureg, \
386 .update_bit = (ubit), \
387 .enable_reg = DA9034_##ereg, \
388 .enable_bit = (ebit), \
391 #define DA9034_LDO(_id, min, max, step, vreg, shift, nbits, ereg, ebit) \
392 DA903x_LDO(DA9034, _id, min, max, step, vreg, shift, nbits, ereg, ebit)
394 #define DA9030_LDO(_id, min, max, step, vreg, shift, nbits, ereg, ebit) \
395 DA903x_LDO(DA9030, _id, min, max, step, vreg, shift, nbits, ereg, ebit)
397 static struct da903x_regulator_info da903x_regulator_info[] = {
398 /* DA9030 */
399 DA9030_LDO( 1, 1200, 3200, 100, LDO1, 0, 5, RCTL12, 1),
400 DA9030_LDO( 2, 1800, 3200, 100, LDO23, 0, 4, RCTL12, 2),
401 DA9030_LDO( 3, 1800, 3200, 100, LDO23, 4, 4, RCTL12, 3),
402 DA9030_LDO( 4, 1800, 3200, 100, LDO45, 0, 4, RCTL12, 4),
403 DA9030_LDO( 5, 1800, 3200, 100, LDO45, 4, 4, RCTL12, 5),
404 DA9030_LDO( 6, 1800, 3200, 100, LDO6, 0, 4, RCTL12, 6),
405 DA9030_LDO( 7, 1800, 3200, 100, LDO78, 0, 4, RCTL12, 7),
406 DA9030_LDO( 8, 1800, 3200, 100, LDO78, 4, 4, RCTL22, 0),
407 DA9030_LDO( 9, 1800, 3200, 100, LDO912, 0, 4, RCTL22, 1),
408 DA9030_LDO(10, 1800, 3200, 100, LDO1011, 0, 4, RCTL22, 2),
409 DA9030_LDO(11, 1800, 3200, 100, LDO1011, 4, 4, RCTL22, 3),
410 DA9030_LDO(12, 1800, 3200, 100, LDO912, 4, 4, RCTL22, 4),
411 DA9030_LDO(14, 2760, 2940, 30, LDO1416, 0, 3, RCTL11, 4),
412 DA9030_LDO(15, 1100, 2650, 50, LDO15, 0, 5, RCTL11, 5),
413 DA9030_LDO(16, 1100, 2650, 50, LDO1416, 3, 5, RCTL11, 6),
414 DA9030_LDO(17, 1800, 3200, 100, LDO17, 0, 4, RCTL11, 7),
415 DA9030_LDO(18, 1800, 3200, 100, LDO1819, 0, 4, RCTL21, 2),
416 DA9030_LDO(19, 1800, 3200, 100, LDO1819, 4, 4, RCTL21, 1),
417 DA9030_LDO(13, 2100, 2100, 0, INVAL, 0, 0, RCTL11, 3), /* fixed @2.1V */
419 /* DA9034 */
420 DA9034_DVC(BUCK1, 725, 1500, 25, ADTV1, 5, VCC1, 0, OVER1, 0),
421 DA9034_DVC(BUCK2, 725, 1500, 25, CDTV1, 5, VCC1, 2, OVER1, 1),
422 DA9034_DVC(LDO2, 725, 1500, 25, SDTV1, 5, VCC1, 4, OVER1, 2),
423 DA9034_DVC(LDO1, 1700, 2075, 25, MDTV1, 4, VCC1, 6, OVER3, 4),
425 DA9034_LDO( 3, 1800, 3300, 100, LDO643, 0, 4, OVER3, 5),
426 DA9034_LDO( 4, 1800, 2900,1100, LDO643, 4, 1, OVER3, 6),
427 DA9034_LDO( 6, 2500, 2850, 50, LDO643, 5, 3, OVER2, 0),
428 DA9034_LDO( 7, 2700, 3050, 50, LDO987, 0, 3, OVER2, 1),
429 DA9034_LDO( 8, 2700, 2850, 50, LDO987, 3, 2, OVER2, 2),
430 DA9034_LDO( 9, 2700, 3050, 50, LDO987, 5, 3, OVER2, 3),
431 DA9034_LDO(10, 2700, 3050, 50, LDO1110, 0, 3, OVER2, 4),
432 DA9034_LDO(11, 1800, 3300, 100, LDO1110, 4, 4, OVER2, 5),
433 DA9034_LDO(12, 1700, 3050, 50, LDO1312, 0, 4, OVER3, 6),
434 DA9034_LDO(13, 1800, 3300, 100, LDO1312, 4, 4, OVER2, 7),
435 DA9034_LDO(14, 1800, 3300, 100, LDO1514, 0, 4, OVER3, 0),
436 DA9034_LDO(15, 1800, 3300, 100, LDO1514, 4, 4, OVER3, 1),
437 DA9034_LDO(5, 3100, 3100, 0, INVAL, 0, 0, OVER3, 7), /* fixed @3.1V */
440 static inline struct da903x_regulator_info *find_regulator_info(int id)
442 struct da903x_regulator_info *ri;
443 int i;
445 for (i = 0; i < ARRAY_SIZE(da903x_regulator_info); i++) {
446 ri = &da903x_regulator_info[i];
447 if (ri->desc.id == id)
448 return ri;
450 return NULL;
453 static int __devinit da903x_regulator_probe(struct platform_device *pdev)
455 struct da903x_regulator_info *ri = NULL;
456 struct regulator_dev *rdev;
458 ri = find_regulator_info(pdev->id);
459 if (ri == NULL) {
460 dev_err(&pdev->dev, "invalid regulator ID specified\n");
461 return -EINVAL;
464 /* Workaround for the weird LDO12 voltage setting */
465 if (ri->desc.id == DA9034_ID_LDO12)
466 ri->desc.ops = &da9034_regulator_ldo12_ops;
468 if (ri->desc.id == DA9030_ID_LDO14)
469 ri->desc.ops = &da9030_regulator_ldo14_ops;
471 if (ri->desc.id == DA9030_ID_LDO1 || ri->desc.id == DA9030_ID_LDO15)
472 ri->desc.ops = &da9030_regulator_ldo1_15_ops;
474 rdev = regulator_register(&ri->desc, &pdev->dev,
475 pdev->dev.platform_data, ri);
476 if (IS_ERR(rdev)) {
477 dev_err(&pdev->dev, "failed to register regulator %s\n",
478 ri->desc.name);
479 return PTR_ERR(rdev);
482 platform_set_drvdata(pdev, rdev);
483 return 0;
486 static int __devexit da903x_regulator_remove(struct platform_device *pdev)
488 struct regulator_dev *rdev = platform_get_drvdata(pdev);
490 regulator_unregister(rdev);
491 return 0;
494 static struct platform_driver da903x_regulator_driver = {
495 .driver = {
496 .name = "da903x-regulator",
497 .owner = THIS_MODULE,
499 .probe = da903x_regulator_probe,
500 .remove = __devexit_p(da903x_regulator_remove),
503 static int __init da903x_regulator_init(void)
505 return platform_driver_register(&da903x_regulator_driver);
507 subsys_initcall(da903x_regulator_init);
509 static void __exit da903x_regulator_exit(void)
511 platform_driver_unregister(&da903x_regulator_driver);
513 module_exit(da903x_regulator_exit);
515 MODULE_LICENSE("GPL");
516 MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>"
517 "Mike Rapoport <mike@compulab.co.il>");
518 MODULE_DESCRIPTION("Regulator Driver for Dialog Semiconductor DA903X PMIC");
519 MODULE_ALIAS("platform:da903x-regulator");